下载本文档
版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
【Word版本下载可任意编辑】采用超声波的移动机器人导航设计方法1引言
在项目开发中采用从英国进口的SRF05超声波传感器,它的回波反应与测距方式与通常使用的超声波传感器相比较特别,在ARM中实现也稍有难度,但该传感器精度很高可到达1cm,因此用该传感器去掉了用于近距离测距的红外测距模块节约了硬件资源。
该机器人的系统为,触摸屏模块,超声波模块,摄像头图像采集模块,直流电机闭环控制系统,在整个系统中测距是总要的一环,它直接影响电机运行距离的精度,在有效范围内的图像采集控制。整个系统都是在ARM9与linux平台中完成,每个模块都是用设备驱动的方式实现使得模块的控制更加方便。
2SRF05超声波测距方法
提供一个10us的脉冲触发超声波传感器,SRF05会发出8个周期的频率为40khz的超频脉冲,此时在echo也是就回波口上的电平变为高,此时定时器开始计时,等到echo变为低电平证明有障碍物此时停止计时,高脉冲的宽度有测距的距离成正比,该超声波的有效测距范围为1cm~4m,因此如果没有障碍物或障碍物大于4m,echo依然会变为低电平此时定时器的时间为30ms,因此在测距时定时器的周期应大于30ms这样才能有效测距。
原理如图1所示。
3超声波测距软件实现
如图2为超声波测距的流程图。
3.1回波检测的采集方法
超声波的回波的检测是个难点,因为在ARM中一个端口设置中断只能设置一种触发方式,如果设为上升沿触发可以打开定时器定时但无法捕获下降沿,也就无法关闭定时器,从而不能测距,因此用软件的方式实现。首先设置两个时间延迟函数usdelay()和msdelay(),这样可以在给出高脉冲10us后等超声波触发再打开定时期计时,在设置一个外部中断eint1接到超声波传感器的echo口并设置为下降沿触发,等下降沿来临关闭定时器读出值既为脉宽的时间长度,然后根据障碍物的距离=(ECHO高电平的时间)*声纳速度/2得出距离。空气中v与温度关系:v=331.5√1+T/273m/s,T为摄氏温度。一般情况下超声波速近似声速,在室内温度影响下取约343.2m/s.
3.2超声波触发的实现
利用数字示波器设计一个软件计时函数usdelay(),具体实现如下。
则usdelay(1)既为10us,该函数用于在给出激发高脉冲后延续10us然后关脉冲。
还要设计一个msdelay()用于控制整个测距周期的时间值。
msdelay(1000)在主函数数中用于延迟1s,这样定时器可以完全有足够的回波检测时间同时也不会对其它三路超声波信号造成干扰。
如下所示。
3.3超声波回波检测的实现
回波检测计算脉宽的时间需要用到定时器和外部中断,外部中断接超声波的echo并设置为下降沿触发。定时器的初始化如下。
rTCFG0=0x9595;//预分频值为95
rTCFG1=0x00000;//分割值1/2
rTCNTB0=10000;/
根据T=/50MHZ得出定时器的周期为60ms在这个时间段里足以计算回波时间。
外部中断1初始化如下
rGPFCON=0xaa;//GPF1设置为EINT1
rINTMOD=0x0;//设置为普通中断
rGPFUP=0xf;//禁止GPF0上拉电阻
pISR_EINT1=(unsigned)Eint1Handler;//建立中断向量
EnableIrq(BIT_EINT1);//使能中断
rEXTINT0=0x492;//EINT1下降沿触发
根据T=/50MHZ得出定时器的周期为60ms在这个时间段里足以计算回波时间。
3.4在外部中断中计算机距离
3.5循环控制与轮询测距
由于超声波之间有干扰,采用轮询的方式依次打开超声波,每次只测一个,这样可以有效地防止干扰,为了提高实时性可以控制定时器周期,比方设置为35ms,这样四路超声波轮询大约为140ms,足以满足实时要求。
4机器人控制的实现
图3为利用超声波的反应信息控制机器人直流电机闭环系统的总体构造图。
linux系统中超声波传感器为只读的字符设备,具体应用为在应用程序下打开超声波设备,然后在驱动中测距,测得的数据传到应用程序,应用程序中有超声波的避障算法,根据算法判断障碍物的位置给直流电机控制信号开展避障导航。
触摸屏中的图形界面中含有机器人的指令设置,可以设置运行速度,图像采集与超声波模块的打开与关闭,是否开启机器人模糊算法运行轨迹还是使用普通的PID调节,这使得机器人有很多种方案可以选择。
机器人的每行为都是根据超声波传感器测得的值和当前机器人运行的即时速度来来给出将要运行的时间,在遇到障碍物时(0<t<30us等于30微秒时到达超声波的探测距离),开启摄像头图像采集模块,这时摄像头会拍下障碍物的图像,并利用无线MODEM把图像传回控制电脑,这样用户就可以知道前方是什么障碍物,该系统实现了移动机器人的自主避障和采集障碍物信息的作用,可以用来探测未知环境。
5结论
本文采用新型的超声波传感器,在ARM9与嵌入式linux为平台的移动机器人上实现了超声波的测距,并利用超声波传感器控制运动系统和图像采集系统。该机器人目前已经
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 期末(试题)-2023-2024学年人教PEP版英语五年级上册
- 2 生活在自然的怀抱里 教案
- 小学信息技术上册 第1课 信息与信息技术教案 苏科版
- 六年级下册语文14《文言文二则》《学弈》教学设计
- 2022年湖北荆州中考满分作文《从一次有意义的对话说起》
- 2022年黑龙江牡丹江中考满分作文《我的世界因你而美丽》3
- Unit 4 Cartoons and comic strips 重点单词、短语、句子2023-2024学年八年级下册英语单元知识要点教学设计(牛津深圳版)
- 2024-2025学年小学生积极心理与安全意识培养设计
- 2024年九年级数学下册 第30章 二次函数30.5二次函数与一元二次方程的关系 2用二次函数的图像解一元二次方程说课稿(新版)冀教版
- 2024-2025学年高一语文上学期同步课堂教学设计(高教版2023·基础模块上册)
- 环境及安全运行检查记录表(每月)
- 签证申请资料翻译样板大全
- iSCSI协议及其应用
- 新生入学教育考试试卷答案精品精编资料
- 西师版三年级上册数学第二单元测试卷
- 《人像摄影》PPT课件(完整版)
- 地方课程六年级上册
- 湖北幼儿师范高等专科学校校长办公会议事清单
- 校园参观解说词(5篇)
- 粮库安全生产费用提取和使用管理制度
- TheAdventuresofTomSawyer汤姆索亚历险记 PPT课件
评论
0/150
提交评论