基于双单片机的悬挂物体寻迹控制系统

2 系统方案设计

    悬挂物体运动控制系统的基本方案方框图如图3所示，系统主要由控制模块、黑线检测模块和通信模块组成。其中，控制模块由ATmega128L单片机最小系统1、键盘输入电路、液晶显示电路和步进电机驱动电路组成；检测模块由ATmega128L单片机最小系统2、红外线反射电路和微步进电机驱动电路组成。

    黑线检测模块中的单片机系统控制微型步进电机，带动装有红外探头的摇臂巡回摆动，检测板上的黑线，得出微型步进电机的转动角度。角度数据经过编码后，通过无线传输模块发送给控制模块单片机系统。控制模块中的单片机系统接收到角度数据后．进行数据校验。若数据准确，则通过控制步进电机驱动电路控制悬挂物体从当前坐标沿转动角度移动固定距离，然后，向检测模块发出下一轮检测命令；若数据传输有误，则向检测模块发出数据重发命令，等待下一轮角度数据接收。

3．1 ATmega128L单片机最小系统

    单片机是整个悬挂物体运动控制系统的核心，控制系统所有电路。本系统采用Atmel公司的ATmega128L单片机，有如下特点：

    ①工作电压为2．7～5．5 V，可承受的电压波动范围较大，可有效克服由于模块内的微型步进电机导致的电源电压不稳定所带来的干扰，使系统能在一个较宽的电平范围内正常工作。

    ②片内资源丰富。ATmega128L存储器容量大，有128 KB Flash，4 KB E2PROM和4 KB RAM，可以满足系统复杂的运算和一定量的数据存储要求；53个I／O端口，可满足系统多传感输入和多控制输出端口要求；I／O口具有大电流输出的特点，驱动能力强；内置看门狗，提高系统的抗干扰能力。

    ③可在线编程，方便系统的凋试。

3．2红外线反射电路

    采用带脉冲调制功能的红外线反射传感器检测黑线轨迹，电路如图4所示。电路中锁相音频译码器LM567既作为红外线发射部分的信号发生电路，也作为接收部分的检测电路，只有检测到的输入信号的频率和本身的锁相中心频率相同时，才使输出端为低电平。该电路容易滤除外界干扰，电路的稳定性和抗干扰能力强，同时可以调节译码器不同的中心频率，使得在同一设备使用多个红外线传感器而不会相互干扰。

3．3步进电机驱动电路

    控制系统中的电机采用VEXTA公司的PX245-01A步进电机，额定电压4 V，静态电流1．2 A，步距角1．8°。步进电机的驱动电路如图5所示。达林顿管起功率放大作用，增强步进电机的驱动能力。电路中使用光电耦合器将控制和驱动信号加以隔离，有效降低外部干扰对系统的影响，提高系统的可靠性。

3．4输入与显示电路

    本设计采用4×4矩阵扫描非编码键盘方式实现悬挂物体初始点坐标输入和控制命令输入。系统控制参数和悬挂物体运行轨迹图可在点阵式液晶LCD12864显示。

3．5无线通信模块

    本没计采用无线Modem RF2000实现系统检测模块与系统控制模块之间数据和命令的双向传输，电路如图6所示。RF2000采用Nordic公司的nRF401芯片，采用抗干扰能力强的FSK调制方式，可以通过TXEN引脚控制收发方式。无线传输过程中，容易受到外界电磁波和步进电机转动产生的电磁干扰，而出现较高的误码率。为确保数据传输的可靠性，本设计通过编码加强系统的纠错能力。数据或命令以8位数据，即一个字节进行编码，并分为高4位和低4位进行无线传输。以低4位数据的传输为例。其发送的数据结构各位的定义格式如下：

    该传输进行了两级误码校验。DO～D3是传输数据的低4位数据，D4～D6置O，D7为低4位数据的CRC检验。

4 软件设计

    系统中悬挂物体寻迹采用双单片机控制方案，黑线检测模块和悬挂物体控制模块各自具有单片机系统，通过通信模块实现协同控制，完成悬挂物体寻迹任务。黑线检测程序流程和控制模块程序流程分别如图7和图8所示，通信误码校正流程如图9所示。

?

5 测试方法与结果

    为了使悬挂物体可以沿任意曲线运动，本系统采用圆周曲线作为测试途径。圆周曲线包含4个方向的转折点，具有一定的代表性，圆周直径为30 cm，圆周长约94 cm，大于设计要求的80 cm。测试结果如表2所列。

结语

    本设计以2片ATmega128L单片机分别为黑线检测和悬挂物体运动控制的核心，仿照雷达扫描跟踪系统，利用微型步进电机和红外线传感器进行黑线的扫描跟踪，实现系统的连续黑线和断续黑线寻迹。黑线检测和运动控制两个核心通过无线数传模块实现检测数据和控制命令的相互通信。测试结果表明，本系统控制精度高，响应时间短，具有较强的断线寻迹能力。