采用超声波的移动机器人导航设计方法

【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为平台的移动机器人上实现了超声波的测距，并利用超声波传感器控制运动系统和图像采集系统。该机器人目前已经