基于双单片机的悬挂物体寻迹控制系统－－速度传感器与控制技术

文章摘要： 采用带脉冲调制功能的红外线反射传感器检测黑线轨迹，电路如图4所示。电路中锁相音频译码器LM567既作为红外线发射部分的信号发生电路，也作为接收部分的检测电路，只有检测到的输入信号的频率和本身的锁相中心频率相同时，才使输出端为低电平。该电路容易滤除外界干扰，电路的稳定性和抗干扰能力强，同时可以调节译码器不同的中心频率，使得在同一设备使用多个红外线传感器而不会相互干扰。 3．3步进电机驱动电路 控制系统中的电机采用VEXTA公司的PX245-01A步进电机，额定电压4 V，静态电流1．2 A，步距角1．8°。步进电机的驱动电路如图5所示。达林顿管起功率放大作用，增

基于双单片机的悬挂物体寻迹控制系统－－速度传感器与控制技术,标签：单片机开发,单片机原理,单片机教程,http://www.88dzw.com

      采用带脉冲调制功能的红外线反射传感器检测黑线轨迹，电路如图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 软件设计

      系统中悬挂物体寻迹采用双单片机控制方案，黑线检测模块和悬挂物体控制模块各自具有单片机系统，通过通信模块实现协同控制，完成悬挂物体寻迹任务。

      5 测试方法与结果

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

      结语

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

　　信息来源：ＩＣ７２

上一页  [1] [2]