发布时间 : 星期日 文章声音导引与定位系统 - 图文更新完毕开始阅读6efcec2d3169a4517723a3af
软件流程图--逼近法
开始AS是否大于CS系统初始化YN左转90度右转90度AS是否大于BSNY停止5~10sN直走后退直走NAS是否等于BSAS是否等于CSYY声光提示声光提示停止停止结束图4.2 逼近法程序流程图
第 25 页共 55 页4.2
4.3 软件流程图--坐标法
N 开 始 S1是否按下 Y
结束声光提示 图4.3 坐标法程序框图
小车动作后反馈 Y 发送Y轴运行时间 N 发送X轴运行时间 A接收计时T0 B接收计时T1 B接收计时T2 小车停止并蜂鸣器动作 小车停止并蜂鸣器动作 小车停止并蜂鸣器动作 机载MCU发送“停止”信号 机载MCU发送“停止”信号 机载MCU发送“停止”信号 机载MCU计算坐标
第 26 页 共 55 页
4.4两个系统的简单介绍
坐标法与逼近法各有各的比较：
坐标法能利用三点之间定出坐标，从而计算出到X=50cm距离，到Y=50cm的距离。然后通过计算能算出小车行走的时间。
C X=50 S(X,Y)
22Y=50 A B 图4.4 坐标图
SA?X?Y
SB??X-100??YSC?X?Y2222222 （式4-1）
TX?340200222??Ta?Tb????VV车 （式4-2）
T?340200y222??Ta?Tc????车由此计算出了车走的时间，通过数据传输，让车按计算好的途径运动。 逼近法：
是不停的发声，来检测两点接收时间的大小来判断车子是否到了X轴的中线，Ta>Tb时，车子在X轴的右边；车子继续向左走，当Ta 此种方法需要不断的查询，占用了单片机的大量资源，而且在运动过程中距离是变化的。很难准确的让车子刚好停在中线上，这个方案的精度要求很高，而声音 第 27 页 共 55 页 导引模块很难做到如此的精准。 逼近法改进方案： 不是不停的在行进中发声，而是在停止的时候发声，来测量车子的位置，Ta-Tb>500us时，车子在X轴的右边，让车子向前走10cm，停止后再发声测量车子的位置；Ta-Tb<500us时，车子在X轴附近，在误差允许范围；Ta-Tb<0；车子在X轴的右边，让车子倒退5cm。这种方法的优点是控制起来方便，对运算速度要求不高，缺点是车子运行的速度慢。 第 28 页 共 55 页