超声波移动机器人导航设计方法
扫描二维码
随时随地手机看文章
摘要: 采用新型的超声波传感器,设计并开发基于ARM9 与嵌入式linux 为平台的轮式移动机器人平台的下的未知环境的避障导航系统。本文重点介绍该超声波传感器的实现原理以及在机器人平台中的整个软件实现流程以及控制机器人行走的实现方法。
1 引言
在项目开发中采用从英国进口的SRF05 超声波传感器,它的回波反馈与测距方式与通常使用的超声波传感器相比较特别, 在ARM中实现也稍有难度, 但该传感器精度很高可达到1cm, 因此用该传感器去掉了用于近距离测距的红外测距模块节约了硬件资源。
该机器人的最小系统为,触摸屏模块,超声波模块,摄像头图像采集模块,直流电机闭环控制系统,在整个系统中测距是最总要的一环,它直接影响电机运行距离的精度,在有效范围内的图像采集控制。整个系统都是在ARM9 与linux 平台中完成,每个模块都是用设备驱动的方式实现使得模块的控制更加方便。
2 SRF05 超声波测距方法
提供一个10us 的脉冲触发超声波传感器,SRF05 会发出8 个周期的频率为40khz 的超频脉冲,此时在echo 也是就回波口上的电平变为高,此时定时器开始计时,等到echo 变为低电平证明有障碍物此时停止计时,高脉冲的宽度有测距的距离成正比,该超声波的有效测距范围为1cm~4m, 因此如果没有障碍物或障碍物大于4m,echo 依然会变为低电平此时定时器的时间为30ms, 因此在测距时定时器的周期应大于30ms 这样才能有效测距。
原理如图1 所示。
3 超声波测距软件实现
如图2 为超声波测距的流程图。