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

发布于：2007/3/2 16:04:13 | 1196 次阅读

[转载]原文链接：

历届全国电子设计竞赛的题目可以分为电源类、信号源类、无线电类、放大器类、仪器仪表类、数据采集与处理类和自动控制类，在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所示，系统主要由控制模块、黑线检测模块和通信模块组成。其中，控制模块由ATmega128L单片机最小系统1、键盘输入电路、液晶显示电路和步进电机驱动电路组成；检测模块由ATmega128L单片机最小系统2、红外线反射电路和微步进电机驱动电路组成。

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

3 硬件设计

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

参与讨论

登录后参与讨论

//评论区

推荐阅读

智能网联汽车国际标准法规协调专家组（HEAG）召开工作会议

近年来智能网联汽车快速发展，新技术不断涌现，与相关产业融合度持续提升，正在推动全球汽车产业发生深刻变革。为应对此种形势，欧、美、日等汽车工业发达国家和地区都加大了智能网联汽车的国际标准法规协调的参与力度，在联合国世界车辆法规论坛(UN/WP.29)和国际标准化组织(ISO)层面，智能网联汽车相关国际标准法规协调活动正快速推进。为更有效地支撑上述组织的国际标准法规协调活动，2017年全国汽车标准

0215jiejie | 发布于：2022-12-01 0评论 0赞

苹果推出搭载M2芯片的新款iPad Pro 799美元起售

据苹果官网，苹果推出搭载M2芯片的新款iPadPro。 11英寸wifi版起售价为799美元，wifi+蜂窝网络版起售价为999美元；12.9英寸wifi版起售价为1099美元，wifi+蜂窝网络版起售价为1299美元。

0215jiejie | 发布于：2022-10-19 0评论 0赞

新能源汽车领衔 “中国智造”加速登陆欧洲市场

全球五大车展之一巴黎车展时隔四年再度启幕。在这场被视为“全球汽车行业风向标”的盛会上，国内外汽车品牌云集，长城汽车、比亚迪等再次领衔中国汽车出海。长城汽车欧洲区域总裁孟祥军表示：“欧洲是长城汽车最重要的海外市场之一，巴黎车展是长城汽车向欧洲市场展示GWM品牌和产品的最佳机会。长城汽车正在研究汽车行业碳排放的整个生命周期，到2025年，将推出50多款新能源产品，全力支持可再生能源使用，为全球用户

0215jiejie | 发布于：2022-10-19 0评论 0赞

严监管时代来临，电子烟“通配”大战走向何方？

针对通配烟弹厂商的一系列诉讼的结果，将对生产通配烟弹的品牌未来在电子烟行业的发展产生深远影响。 10月1日，《电子烟强制性国家标准》正式实施，中国电子烟监管全面生效。而在电子烟行业进入规范化、法治化阶段前夕，一场围绕着通配烟弹的争论在行业里发酵。 “通配”是电子烟从业者约定俗成的概念。换弹式电子烟由烟杆和烟弹组成，“通配”烟弹指的是非品牌商生产、可与品牌烟杆匹配使用的烟弹。多位业内人士表示，被

0215jiejie | 发布于：2022-10-19 0评论 0赞

Bourns 全新大功率分流电阻器

采用金属感应引脚，专用于大电流应用中进行精确测量全新分流电阻器专为电池管理系统、大电流工业控制和电动汽车充电站提供高可靠性、高成本效益的解决方案美国柏恩Bourns全球知名电子组件领导制造供货商，宣布新增12款CSM2F系列功率分流电阻器，扩展其产品组合。全新系列采用铆接通孔金属传感引脚，可满足大电流应用中对电压测试点精确定位日益增长的需求。最新型Bourns?CSM2F系列分流电阻器

0215jiejie | 发布于：2022-10-18 0评论 0赞

请尊重元宇宙“这个筐”

元宇宙是个筐，啥都往里装，但区别在于有的像聚宝盆，有的像垃圾桶。国庆假期刚结束，中青宝“90后”董事长李逸伦便亲自上阵，玩起了元宇宙婚礼。靠着老板首秀和代言，中青宝顺势推出“MetaLove元囍”App，正式进军元宇宙婚礼赛道。就产品而言，如同其他元宇宙产品，李逸伦的元宇宙婚礼“新奇与吐槽齐飞”：有人说是有趣的尝试，有人则认为像QQ炫舞结婚系统。要知道，QQ炫舞是一款推出了十余年的老游戏。

0215jiejie | 发布于：2022-10-13 0评论 0赞

边缘计算：突围商业模式痛点

截至8月末，中国5G基站总数达210.2万个，中国5G发展已经进入下半场。随着5G加速融入千行百业，互动直播、vCDN、安防监控等场景率先大规模落地，车联网、云游戏、工业互联网、智慧园区、智慧物流等场景也快速走向成熟，这些更大流量、更低时延、更高性能的场景涌现，对边缘计算的刚性需求势必爆发。 GrandViewResearch预测，即使在新型冠状病毒肺炎疫情肆虐全球的背景下，边缘计算和5G网络市

0215jiejie | 发布于：2022-10-13 0评论 0赞

商务部回应美商务部升级半导体等领域对华出口管制并调整出口管制“未经验证清单”

商务部新闻发言人10日就美商务部升级半导体等领域对华出口管制并调整出口管制“未经验证清单”应询答记者问。有记者问：近日，美国商务部在半导体制造和先进计算等领域对华升级出口管制措施。同时，在将9家中国实体移出“未经验证清单”过程中，又将31家中国实体列入，请问中方对此有何回应？对此，商务部新闻发言人回应称，中方注意到相关情况。首先，通过中美双方前一阶段共同努力，9家中国实体zui终

0215jiejie | 发布于：2022-10-13 0评论 0赞

TCL华星官宣与奔驰合作：推出全球首款横贯A柱的车载显示屏

今年1月，奔驰带来了VISIONEQSS概念车，其中控台采用了一块完全无缝的47.5英寸曲面显示屏，横贯整个A柱，令人印象深刻。今天，TCL华星正式官宣与奔驰达成合作，并认领了VISIONEQSS上这块全球首款横贯整个A柱曲面的车载显示屏。根据TCL介绍，这款显示屏采用了完全无缝的超薄一体化设计，将仪表盘、中控与副驾娱乐显示融为一体，并能够与3D实时导航系统相辅相成。同时，这块显示屏还采用

0215jiejie | 发布于：2022-10-12 0评论 0赞

半导体板块暴跌谁最受伤

国庆假期后首日开盘，上证综指时隔5个月再次失守3000点，与此同时，半导体板块也再度走低，其中，北方华创、雅克科技等个股跌停。10月11日早盘期间，半导体板块持续下挫，北方华创、雅克科技再度跌停。截至下午收盘，北方华创、雅克科技维持跌停状态，华海清科、拓荆科技-U、盛美上海、清溢光电、海光信息的跌幅则超10%。同日，半导体板块中的119只个股中超五成呈现下跌趋势。在半导体板块遭遇下挫的同时，北

0215jiejie | 发布于：2022-10-12 0评论 0赞

unionblog

关注