机器人距离探测

《机器人距离探测》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、深圳稻草人机器人职业应用培训机器人距离探测在第六讲中，你学会了用红外传感器探测是否有物体挡在机器人的前方路线上而不用接触物体。接下来你有没有想到，要是能探测到距离障碍物有多远不是更好吗？非接触探测物体距离通常是声纳完成的任务：它发送出一组超声波脉冲，然后记录下被物体反射回来的声波所需的时间，然后乘以超声波的传播速度的一半，就可以计算出距离物体有多远。本章并不使用声纳传感器，仍旧采用前面章节中所使用过的非常类似的电路与红外线传感器来探测物体的距离。由于机器人可以检测到物体的距离，你就可以编程让机器人跟随物体行走而不会碰上它。你也可以编程让机器人沿着白色背景上的黑色轨迹行走。下

2、面将用同前第六讲中一样的IRLED/探测电路来探测距离。l如果该电路仍然完好的在你的机器人上，确认红外线LED电路中含有1k欧姆的电阻。l如果你已经拆掉了该电路，请参照第六讲的内容重新搭建。新增工具和原料：(1)尺子(2)一张白纸任务1：测试扫描频率图7-1显示的是一个特殊品牌红外线传感器数据表（PanasonicPNA4602M）的频率特性图。这个特性图显示了红外线传感器在接收到不同于38.5kHz频率红外线信号时其敏感程度随频率变化的曲线图。例如，当你发送频率为40kHz的信号给传感器时，它的灵敏度是频率为38.5kHz的50%。如果红外LED发送频率为42kHz，探测

3、器的灵敏度是频率为38.5kHz的20%左右。因此当你采用让探测器灵敏度很底的频率的红外线时，为了让探测器探测到红外线的反射，物体必须离探测器更近以便让反射的红外光更强。从另一个角度来考虑就是，使用最高灵敏度红外线频率可以探测最远距离的物体，较低灵敏度的频率可以探测较近距离物体。这样，采用红外线探测距离就简单了。选择5个不同频率的红外线，从最高灵敏度频率到最低灵敏度进行扫描测试。首先用最高灵敏度频率，如果物体被探测到了，就让仅次于它的高灵敏度频率测试，观察是否可以探测到，当探测器检测不到的相应的红外线频率时，你就可以以此推断机器人到物体的距离。用频率扫描进行编程做距离探测下

4、面用图7-2说明机器人如何用红外发射频率扫描进行距离探测。在这个例子中，目标物体在区域3。也就是说，当机器人发送37500Hz和38250Hz频率的红外线时能发现物体，发送39500Hz、40500Hz以及41500Hz频率的红外线就不能发现物体。如果你移动物体到区域2，那么发送37500Hz、38250Hz以及39500Hz的红外线可以发现物体，而发送40500Hz和41500Hz频率的红外线就不能发现物体。为了对红外线频率进行扫描，你要用FREQOUT命令发送5种不同的频率的红外线信号并测试在每种频率下红外线探测器是否可以发现目标。由于每种频率之间的间隔不均匀，因此不宜

5、使用FOR…NEXT循环的STEP算子。你可以用DATA和READ，但会比较麻烦。你也可以用深圳稻草人机器人职业应用培训五种不同的FREQOUT命令，但这样会浪费程序空间。最好的办法采用LOOKUP指令，它可以储存一小段你想要依次用到的频率数值到一个列表中，然后通过一个索引使用表中的数值。命令LOOKUP的用法定义如下：LOOKUPIndex,[Value0,Value1,…ValueN],Variable如果变量Index的取值为0，那么方括号中Value0的值将被赋给变量Variable。如果变量Index的取值为1，那么方括号中Value1的值将被赋给变量Variab

6、le。列表中可以储存256个数值，但对于下面的例程而言，你只需要5个数值。下面是怎样使用它的例子：FORfreqSelect=0TO4LOOKUPfreqSelect,[37500,38250,39500,40500,41500],irFrequencyFREQOUT8,1,irFrequencyirDetect=IN9'Commandsnotshown...NEXT在FOR…NEXT循环语句第一次执行时，freqSelect的值为0，所以LOOKUP命令把37500赋予变量irFrequency。因为在执行命令LOOKUP之后，变量irFrequency值为37500,所

7、以FREQOUT发送该频率到与P8连接的红外线发光二极管上。和前面章节中一样，数值IN9保存到变量irDetect。在FOR…NEXT循环语句第二次执行时，freqSelect的值为1，所以LOOKUP命令把38250赋予变量irFrequency。第三次重复上述工作时，把39500赋予变量irFrequency，依次类推。例程――TestLeftFrequencySweep.bs2TestLeftFrequencySweep.bs2要做两件事情。首先，它测试左边的IRLED/探测器（与P8和P9连接）以确认它们的