声音导引与定位系统 - 图文 下载本文

软件流程图--逼近法

开始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 页