历史上的今天
今天是:2025年03月15日(星期六)
2020年03月15日 | 基于单片机及传感器为控制器核心的智能机器人控制系统设计
2020-03-15 来源:工控网
1 前 言
机器人技术是融合了机械、、、、人工智能等许多学科的知识,涉及到当今许多前沿领域的技术。一些发达国家已把机器人制作比赛作为创新教育的战略性手段。如日本每年都要举行诸如“NHK杯大学生机器人大赛”、“全日本机器人相扑大会”、“机器人足球赛”等各种类型的机器人制作比赛,参加者多为学生,旨在通过大赛全面培养学生的动手能力、创造能力、合作能力和进取精神,同时也普及智能机器人的知识。
开展机器人的制作活动,是培养大学生的创新精神和实践能力的最佳实践活动之一,特别是机电专业学生开展综合知识训练的最佳平台。本文针对具有引导线环境下的路径跟踪这一热点问题,基于控制及传感器原理,通过硬件制作和编程,制作了一个机器人,实现了机器人的路径跟踪和自动纠偏的功能,并能探测金属,实时显示距离。
2 机器人要完成的功能
选取一块光滑地板或木板,上面铺设白纸,白纸上画任意黑色线条(线条不要交叉),作为机器人行走的轨迹,引导机器人自主行走。纸下沿黑线轨迹随机埋藏几片薄铁片,铁片厚度为0.5~1.0mm。机器人沿轨迹行走一周,探测出埋藏在纸下铁片,发出声光报警,并显示铁片距离起点的位置。
3 硬件设计方案
机器人总体构成
图1 机器人总体构成
如图1所示,以微处理器为核心,接受传感器传来外部信息,进行处理,控制机器人的运行。
系统供电部分
由于机器人,传感器及系统等部分均采用+5V供电,考虑电动车功率和车载质量及摩擦阻力问题,电源我们采用电动车自带组,功耗小、体积小和质量轻,安装较为方便。
电机驱动及部分
机器人需控制在一个合适的速度行驶,速度太快,因单片机对各传感器传来的信号有一个响应、处理时间,小车极易偏离轨道。小车的速度是由后轮直流电机转速控制,改变直流电机转速通常采用调压、调磁等方式来实现。其中,调压方式原理简单,易与实现。
采用由组成的H型PWM调制电路。通过图2所示PWM调制电路,用单片机控制管使之工作在占空比可调状态,实现调速。
图2 电机驱动电路
令单片机P1.7口为低电平,P1.6口为高电平,此时Q1、Q4导通控制工程网版权所有,Q2、Q3截止,正常工作。改变P1.6口高电平周期,即改变PWM调制脉冲占空比,可以实现精确调速。脉冲频率对电机转速有影响,脉冲频率高连续性好,但带负载能力差;脉冲频率低则反之。经实验发现,脉冲频率在30Hz以上,电机转动平稳,但小车行驶时,由于摩擦力使电机转速降低很快,甚至停转;脉冲频率在10Hz以下,电机转动有跳跃现象,实验证明脉冲频率在25~35Hz效果最佳。我们选取脉冲频率为30Hz。
引导线检测模块
根据白纸和黑线反射系数不同,通过以光电传感器为核心的光电检测电路将路面两种颜色进行区分,转化为不同电平信号,将此电平信号送单片机,由单片机控制转向电机作相应的转向,保证小车沿引导线行驶。考虑到小车与路面的相对位置,采用反射式光电检测电路。光电传感器TCRT1000,它是一种光电子扫描,光电发射,接收并输出的装置。它的特点是尺寸小、使用方便、信号高输出、工作状态受温度影响小。它的外围电路简单,(如图3所示)。二极管的C端和三极管的E端接地,二极管的A端通过一和电源相接,组成偏置电路;三极管的C端也通过一电阻和电源相接,组成输出电路。当检测器检测到白色时,其输出低电平;当检测到黑色时,则输出高电平。
为提高检测精度,采用了多传感器信息融合技术。设计中,在车头均匀布置三个光电传感器,其中,中间一个(Q1)安装在小车正中央。Q1的输出经一级和非门,接单片机的P1.3脚.Q1左右两端分别布置一个传感器,经与图3相同的电路后也连接到单片机P1口。若两侧某一传感器检测到黑线,表明小车正脱离轨道,将3个检测点的结果融合后作为单片机的输入,机器人按照单片机P1口信息进行判断调整,实现路径跟踪和自动纠偏。
图3 光电检测转换电路
金属探测部分
图4 金属探测电路
如图4所示,金属探测器使用一接近,探测有效距离约为4mm ,将它固定在机器人上,当探测到金属片时,探测器输出端输出低电平,经反向器后接一发光二极管和一,发出声光指示信号。同时输出反向后接单片机,对探测到的金属片个数进行计数。
霍尔元件测距设计
霍尔集成片内部由三片霍尔金属板组成,当磁铁正对金属板时,根据霍尔效应,金属板发生横向导通,因此可以在车轮上安装磁片,而将霍尔集成片安装在固定轴上,通过对脉冲计数进行距离。小车后轮每转一圈,霍尔元件产生的脉冲送入单片机的T0口进行计数,单片机完成脉冲数到距离的转换。在后轮安装一个磁极,测量误差是一个车轮的周长,可在软件中给予补偿。
LCD显示
器以其微功耗、体积小、显示内容丰富、超薄轻巧的诸多优点,在袖珍式仪表和低功耗应用系统中得到越来越广泛的应用。 这里采用2行16个字的DM-162液晶模块,通过与单片机连接,编程,完成显示功能。
4 系统软件流程
系统软件流程如图5所示。
图5 系统软件流程图
5 结 论
本文基于单片机及传感器原理,以单片机为控制器的核心,小型直流电机作为驱动元件,配置不同类型的传感器,通过软件编程,制作出了一个价格低廉、结构的小型机器人。大量的行走实验证明,该机器人能够顺利路径跟踪和自动纠偏自主行走,并完成探测、显示等功能。
本文创新点:本文针对具有引导线环境下的路径跟踪这一热点问题,采用多传感器信息融合技术,通过单片机控制,实现了机器人的路径跟踪和自动纠偏的功能,方法简单,易于实现,造价低廉,效果较好。
责任编辑;zl
史海拾趣
|
程序中,duty为控制占空比的参数;count为控制分频的参数。通过改变duty和count两个参数,得到占空比及分频数可调的时钟信号,极为方便。 2.2 其他模块的实现 其他控制模块包括地址发生器、DAC控制电路、并/串转换电路。存储数据 ...… 查看全部问答> |
|
哪位大侠能提供一下nor flash M29W128G 的fast program 的代码 nor flash M29W128G 可以32个words fast program, 哪位大哥有这个写的代码,能否给小弟一下,谢谢了。… 查看全部问答> |
|
平台:6410+WINCE6.0 新开一个贴,再讨论一下这个CAMERA应用开发,因为本人一直是做驱动的,现在要写应用,而且是COM接口的directshow,所以有很多东西要向大家请教, 用640X480分辩进行preview 和 拍照都没有问题,但是,我驱动给di ...… 查看全部问答> |
|
我主要想知道硬件编解码之前的数据是什么格式或者封装的?之后应该就是H.264,MPEG-4之类的吧。之前呢?通过以太网接口的以太网数据帧(应该包含视频流的)能直接通过硬件编解码进行播放吗? 还有TV-in,进来的是什么数据?那个接口是接什么的? ...… 查看全部问答> |
|
第一次来这里,谢谢大家 刚开始做做BSP5.0移植到6.0 现在编出来的内核打印信息如下: Windows CE Kernel for ARM (Thumb Enabled) Built on Sep 6 2006 at 19:14:27 INFO:OALLogSetZones: dpCurSettings.ulZoneMask: 0xb OEM: Not ...… 查看全部问答> |
|
想写一个过滤驱动,实现禁用蓝牙,红外线等设备, 请问要将过滤驱动挂载在注册表的什么地方? 我发现过载在 注册表HKEY_LOCAL_MACHINE\\SYSTEM\\CurrentConrolSet\\Control\\Class\\{E0CBF06C-CD8B-4647-BB8A-263B43F0F974},在这个位置并不能完 ...… 查看全部问答> |
|
野火STM32开发板,买的是428的套餐,买到手里1个多月,没用过,就是刚到手里的时候吧包装拆开了,现打算350包邮出,有意的可以直接拍下,帮我同学卖的,不刀,要的可以联系我QQ 99044007 照片就不上了,没有任何的使用,所以也不需要看 ...… 查看全部问答> |




