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

摘要 设计一种基于双单片机的悬挂物体寻迹控制系统。系统由具有独立单片机的寻迹检测模块和悬挂物体运动控制模块组成，通过无线通信模块进行数据和命令的相互通信，实现协调控制以厦悬挂物体寻迹控制功能。测试结果表明，该系统运动速度快、寻迹偏差小。关键词 悬挂物体双单片机轨迹跟踪 ??? 历届全国电子设计竞赛的题目可以分为电源类、信号源类．无线电类、放大器类、仪器仪表类、数据采集与处理类和自动控制类，在2005年全国大学生电子设计竞赛中，悬挂物体控制系统就是一道典型的自动控制类赛题。本文着莺介绍一种基于双单片机的悬挂物体沿板上标出的任意曲线运动的控制系统方案。1 系统设计要求和设计思路??? 题目要求控制物体沿板上标出的任意曲线运动，如图1所示。曲线在测试时现场标出，线宽1．5cm～1．8cm。总长度约50cm，颜色为黑色；曲线的前一部分是连续的，长约30cm；后一部分是两段总长约20cm的间断线段，间断距离不大于1cm；沿连续曲线运动限定在200s内完成，沿间断曲线运动限定在300s内完成。 ??? 根据题目的要求，系统主要实现黑线和断点检测、悬挂物体运动控制等功能。为了说明系统可以实现任意曲线、任意方向的寻迹，以圆形轨迹作为寻迹对象。寻迹原理如图2所示。 ??? 悬挂物体初始点A的坐标由键盘输入，初始时刻安装红外探头，由微型步进电机控制的摇臂处于水平位置。系统启动后，微型步进电机驱动摇臂顺时针旋转，最大转角为180°。红外探头的运动轨迹与黑色圆弧会有一个交点B，并记录步进电机转动的角度。通过系统起始点A的坐标和步进电机转动的角度，可求得运动控制下一点B的坐标。求得B点坐标后，控制悬挂物体向该点作直线运动，同时摇臂作逆时针旋转90°，以保证下一个检测交点在其180°搜索范围内。若摇臂旋转180°，仍没有交点，则认为曲线在此处有断点，系统控制悬挂物体按原方向继续前进一个步长，再次进行扫描，以求得下一个检测点的位置。若悬挂物体偏离轨迹，如图2中C点的位置，系统也可通过下一个点的检测让悬挂物体自动回复到轨迹点，因此，本方法可有效纠正轨迹偏差，实现寻迹控制的能力。 2 系统方案设计??? 悬挂物体运动控制系统的基本方案方框图如图3所示，系统主要由控制模块、黑线检测模块和通信模块组成。其中，控制模块由ATmegal28L单片机最小系统l、键盘输入电路、液晶显示电路和步进电机驱动电路组成；检测模块由ATmegal28L单片机最小系统2、红外线反射电路和微步进电机驱动电路组成。 ??? 黑线检测模块中的单片机系统控制微型步进电机，带动装有红外探头的摇臂巡回摆动，检测板上的黑线，得出微型步进电机的转动角度。角度数据经过编码后，通过无线传输模块发送给控制模块单片机系统。控制模块中的单片机系统接收到角度数据后，进行数据校验。若数据准确，则通过控制步进电机驱动电路控制悬挂物体从当前坐标沿转动角度移动固定距离，然后，向检测模块发出下一轮检测命令；若数据传输有误，则向检测模块发出数据重发命令，等待下一轮角度数据接收。 3 硬件设计3.1 ATmegal28L单片机最小系统??? 单片机是整个悬挂物体运动控制系统的核心，控制系统所有电路。本系统采用Atmel公司的ATmegal28L单片机，有如下特点：??? 工作电压为2．7～5．5V，可承受的电压波动范围较大，可有效克服由于模块内的微型步进电机导致的电源电压不稳定所带来的干扰，使系统能在一个较宽的电平范围内正常工作。??? 片内资源丰富。ATmegal28L存储器容量大，有128 KB Flash，4KB E2PROM和4KBRAM，可以满足系统复杂的运算和一定量的数据存储要求；53个I／0端口，可满足系统多传感输入和多控制输出端口要求；I／O口具有大电流输出的特点，驱动能力强；内置看门狗，提高系统的抗干扰能力。??? 可在线编程，方便系统的调试。3.2 红外线反射电路??? 采用带脉冲调制功能的红外线反射传感器检测黑线轨迹，电路如图4所示。电路中锁相音频译码器LM567既作为红外线发射部分的信号发生电路，也作为接收部分的检测电路，只有检测到的输入信号的频率和本身的锁相中心频率相同时，才使输出端为低电平。该电路容易滤除外界干扰，电路的稳定性和抗干扰能力强，同时可以调节译玛器不同的中心频率，使得在同一设备使用多个红外线传感器而不会相互干扰。 3．3 步进电机驱动电路??? 控制系统中的电机采用VEXTA公司的PX245-01A步进电机，额定电压4V，静态电流1．2A，步距角1．8°。步进电机的驱动电路如图5所示。达林顿管起功率放大作用，增强步进电机的驱动能力。电路中使用光电耦合器将控制和驱动信号加以隔离，有效降低外部干扰对系统的影响，提高系统的可靠性。 3.4 输入与显示电路???