利用红外发射接收传感器进行距离检测Word下载.docx
- 文档编号:17391345
- 上传时间:2022-12-01
- 格式:DOCX
- 页数:21
- 大小:726.80KB
利用红外发射接收传感器进行距离检测Word下载.docx
《利用红外发射接收传感器进行距离检测Word下载.docx》由会员分享,可在线阅读,更多相关《利用红外发射接收传感器进行距离检测Word下载.docx(21页珍藏版)》请在冰豆网上搜索。
另一个角度来考虑就是最高灵敏度的频率可以探测最远距离的物体,较低灵敏度的频率可以探测距离较近的物体。
这使得距离探测就简单了。
选择5个不同频率,然后从最高灵敏度到最低灵敏度进行测试。
首先尝试最髙灵敏度频率,如果物体被探测到了,就让仅次于它的高灵敏度频率测试,观察是否可以探测到。
依赖于探测器不能再检测到物体的红外线频率,我们就可以推断物体的大概位垃。
图9-2探测区域
例程:
TestLeftFrequencySweep.c
例程要做两件事情:
首先,测试IRLED/探测器(分別与P1_3和P1_2连接)以确认它们的距离探测功能正常:
然后,完成图9-2所示的频率扫描。
ffinclude<
BoeBot.h>
ttinclude<
uart.h>
tfdefineLeftIRP(_2II左边红外接受连接鈿/_2
tfdefineLeftLaunchP/_3//左边红外发射连接到P/_3
unsignedinttime;
11定时时间值
intleftdistance;
H左边的距离
intdistanceLeft,irDetectLeft;
unsignedintfrequency[5]={29370,31230,33050,35700,38460};
voidtimerjnit(void)
{
圧二0x82;
//开总中雌,允许定时器0中耐0
TMOD1=0X0/;
//宦时器0工作在模式I:
\6位定时器模式
voidFreqOutfunsignedintFreq)
time=256-(500000/Freq);
11根据频率汁算初值
THO=OXFF;
TLO=time;
TRO二1;
delay_nus(800);
TRO=0;
//為7(位如
11低八位根据公式计算H启动定时器
II延时
1丨停止左时器
}
voidTimerOJnterrupt(void)interruptI11左时器中断
LeftLaunch=-LeftLaunch;
11取反
THO=OxFF;
11重新设值
TLO=time;
voidGet_lr_Distances()
unsignedintcount;
leftdistance=0;
II初始化左边的距禽
for(count=0;
count<
5;
count^)
FyqOut(frcqucncy(count]);
口发射频率irDetectLeft=LeftIR;
printfCirDetectLeft=96dn,irDetectLeft);
if(irDetectLeft==1)
leftdistance++;
intmain(void)
uartjnitf);
timerjnit();
printfC'
ProsamRunning!
\nn);
printfCFREQENCYETECTEDXn1);
while⑴
Get」r_Distances();
printf(udistanceLeft=96d\n\leftdistance);
-\n"
);
delay_nms(1000);
Tips:
TestLeftFrequencySweep.c是如何工作的?
还记得“数组”吗?
这里你将用整数型数组存储五个频率值:
uartjnit();
串口的初始化,这个函数已多次用到。
timerjnitf);
泄时器的初始化。
此例程使立时器0工作在模式1,16位泄时模式,不具备自动重载功能。
注意,timer_init()并没有开启泄时器。
Get_lr_Distances();
机器人要发射某一频率,该给定时器设定多大的值呢?
频率为f时,周期T=1/f,高低电平持续时间为t=1/(2T),根据公式TC=2n-CC可算泄时器初值time:
曲”亠=65536-竺巴
1x10"
f
但实际上,time值并未占满低八位,所以你可以这样简化计算:
高八位设OxFF,低八位根据n=8时汁算,即函数FreqOut(frequency[count])中用的time=256-(500000/Freq)来计算。
当低八位计满后,整个寄存器将溢岀。
根据图6-2所示的描述原理,如果检测结果irDetectLeft为1,即没有发现物体,则距藹leftdistance^lUo循环描述,当5个频率描完后,可根^leftdistance的值来判断物体离机器人的大致距离。
运行程序时,在机器人前端放一白纸,前后移动白纸,调试终端将会显示白纸所在的区域,如图9-3所示。
图9-3距离探测输出实例
程序通过计算“1”出现的数量,就可以确定目标在哪个区域。
紧记,这种距离测量方法是相对的而非绝对地精确。
然而,它为机器人跟随,跟踪和苴他行为提供了一个足够好的探测距离的能力。
•输入、保存并运行程序TestLeftFrequencySweep.c
•用一张纸或卡片而对IRLED/探测器做距离探测
•改变纸片与机器人距离,记录使distanceLeft变化的位宜
该你了一一测试右边的IRLED/探测器
•修改程序TestLeftFrequencySweep.c,对右边的IRLED/探测器做距离探测测试
•运行该程序,检验这对IRLED/探测器能否测量同样的距离。
你可参考教材配套光盘对应例程中的注释部分。
DisplayBothDistances.c
•修改程序TestLeftFrequencySv/eep.c,添加右边IRLED/探测器部分
•输入、保存并运行程序DisplayBothDistances.c
•用纸片重复对每个IRLED进行距离探测,然后对两个IRLED同时进行测试
该你了一一更多的距离测试
•尝试测量不同物体的距离,弄淸物体的颜色和(或)材质是否会造成距离测疑的差异
2.尾随小车
让一个宝贝车跟随另一个宝贝车行走,跟随的宝贝车,也叫尾随车,必须知道距离引导车有多远。
如果尾随车落在后而,它必须能察觉并加速。
如果尾随车距离引导车太近,它也要能察觉并减速。
如果当前距离正好合适,它会等待直到测量距离变远或变近。
距离仅仅是由机器人和其它自动化机器需要控制一种数值之一。
当一个机器被设计用来自动维持某一数值,比如距离、压力或液位等,它一般都包含一个控制系统。
这些系统有时由传感器和阀门组成,或者由传感器和电机组成。
在宝贝车里面,由传感器和连续旋转电机组成。
还必须有某些处理器可以接受传感器的测疑结果并把它们转化为机械运动。
必须对处理器编程来基于传感器的输入做岀决左,从而控制机械输出。
闭环控制是一种常用的维持控制目标数据的方法,它很好地帮助宝贝车保持与一个物体之间的距离。
闭环控制算法类型多种多样,最常用的有滞后、比例、积分以及微分控制。
所有这些控制方法都将在《过程控制》教材中详细介绍。
事实上,图9-4所示的方框图描述了宝贝车用到的比例控制过程的步骤,即宝贝车用右边的IRLED/探测器探测距离并用右边的伺服电机调节机器人之间的位置以维持适当的距离。
Centerpulsewidth
1500
图9-4右边的伺服电机及IRLED/探测器的比例控制方框图
让我们仔细观察一下图9-4的数字,学习一下比例控制是如何工作的。
这个特殊的例子是右边的IRLED/探测器和右边的伺服电机的比例控制方框图。
设左位置为2,说明我们想宝贝车维持它和任何它探测到的物体之间的距藹是2。
测疑的距离为4,距离太远。
误差是设定值减去测量值的差,即2-4=-2,这在圆圈的左方以符号的形式指岀,这个圆圈叫求和点。
接着,误差传入一个操作框。
这个操作框显示,误差将乘以一个比例常数Kp。
Kp的值为70。
该操作框的输出显示为-2X70=-140,这叫输出校正。
这个输出校正结果输入到另一个求和点,这时它与电机的零点脉冲宽度1500相加。
相加的结果是1360,这个脉宽可以让电机大约以3/4全速顺时针旋转。
这让宝贝车右轮向前、朝着物体的方向旋转。
第二次经过闭环,测量距离可能发生变化,但是没有问题,因为不管测量距离如何变,这个控制环路将会计算出一个数值,让电机旋转来纠正任何误差。
修正值与误差总是成比例关系,该误差就是设定位置和测量位置的关系的偏差。
控制环都有一组方程来主导系统行为。
图9-4中的方框图是对该组方程的可视化描述方法。
下而是从方框图中归纳出来的方程关系及结果:
Error=Rightdistancesetpoint-Measuredrightdistance
=2-4
Outputadjus=error•Kp
=-2•70
=-140
Rightservooutput=Outputadjust+Centerpulsev/idth
=-140+1500
=1360
通过一些苣换,上而三个等式可被简化为一个,提供你相同的结果:
Rightservooutput=(Rightdistaneesetpoint-Measuredrightdistance)Kp+Center
pulsewidth
代入数值,我们可以看到结果一致:
=((2-4)*70)+1500
左边的IRLED/探测器以及左边的伺服电机的控制框图如图9-5所示,与右边的运算法则类似。
不同的是比例系数Kp的值由+70变为为-70。
假设与右边的测量值一样,输出修正的脉冲宽度应该为1640.下面是该框图的计算等式:
Leftservooutput=(Leftdistancesetpoint-Measuredleftdistance)Kp+Centerpulsewidth
=((2-4)•(-70))+1500
图9-5机器人左伺服电机及IRLed/探测器的比例控制方框图
FollowingRobot.c
该例程实现刚才讨论过的各个伺服脉冲比例控制。
换句话说,在每个脉冲发送之前,需要测量距离,决左误差信号,然后将误差值乘以比例系数Kp,再将结果加上(或减去)发送到左(或右)伺服电机的脉冲宽度值。
•输入.保存并运行程序FollowingRobot.c
•把大小为20X28cm的纸片置于机器人的前而,就像障碍物墙。
机器人应该维持它和纸片之间的距离为预定的距离
•尝试轻轻旋转一下纸片,机器人应该跟随之旋转
•尝试用纸片引导机器人四处运动,机器人应该跟随它
•移动纸片距离机器人特别近时,机器人应该后退,远离纸片
tfinclude<
BoeBot.h>
#include<
P/_2//左边红外接受连接到P\JL
P3_511右边红外接收连接至陀3主
PL3//左边红外发射连接到Pi_3
tfdefineKpl70
tfdefineKpr70
tfdefineSetPoint2
tfdefineCenterPulse1500
intleftdistance,rishtdistance;
//左边和右边的距离
intdelayCount,distanceLeft.distanceRightJrDetectLeftJrDetectRight;
unsignedintfrequency[5]={29370f31230,33050,35700,38460};
IE=0x82;
H开总中,允许圭时器0中耐0
TA\OD|=0X0/;
I丨定时器0工作在模式I:
(6位宦时器模式
time=256•(50000/Freq);
TLO=time;
TR0=1;
delay_nus(800);
voidTimerOJnterrupt(void)interruptI
RishtLaunch=~RightLaunch;
voidGet_lr_Distances()
unsignedcharcount;
//初始化左边的距离
rightdistance=0;
II初始化右边的距离
FreqOut(frequency[count]);
irDetectRight=RightIR;
irDetectLeft=LeftIR;
if(irDetectLeft==I)
if(irDetectRight==I)rightdistance^;
voidSend_Pulse(unsisnedintpulseLeft,unsignedintpulseRight)
PL口;
delay_nus(pulseLeft);
P/./=0;
PI_O"
;
delay_nus(pulseRight);
P1_0=0;
delay_nms(18);
intmain(void)
unsignedintpulseLeft,pulseRight;
timerjnit();
while
(1)
pulseLeft=(SetPoint-leftdistance)^Kpl+CenterPulse;
pulseRisht=(SetPoint-rightdistance)'
tKpr^CenterPulse;
Send_Pulse(pulseLeft,pulseRight);
FollowingRobot.c是如何工作的?
主程序做的第一件事是调用Get_lr_Distances子函数。
Get_lr_Distances函数运行完成之后,变量leftdistance和rightdistance分别包含一个与区域相对应的数值,该区域里的目标被左、右红外线探测器探测到。
随后两行代码对每个电机执行比例控制计算:
pulseLeft=(SetPoint-leftdistance)*Kpl+CenterPulsepulseRight-(SetPoint-rishtdistance)*Kpr+CenterPulse最后调用子函数Send_Pulse对电机的速度进行调节。
因为你要做的实验是尾随,串口线的连接影响了机器人的运动,故可去掉。
该你了
图9・6所示是引导车和尾随车。
引导车运行的程序是FastlrRoaming.c修改后的版本,尾随车运行的程序是FollowingRobot.co比例控制让尾随车成为忠实的追随者。
一个引导车可以引导一串大槪6到7个尾随车。
只需要把导引车的侧而板和后挡板加到英它的尾随车上。
图9-6导引机器人(左)和尾随机器人(右)
•如果你是班级成员之一,把纸板安装在导引小车的两侧和尾部,参考图9-6
•如果你不属于班级成员的一部分(并且只有一个机器人),可以让尾随车跟随一张纸或你的手来运动,就和跟随导引车一样
•用阻值为1kQ或2kQ的电阻替换掉连接机器人红外线发光二极管的470Q电阻
•使用程序FastlrRoaming.c修改后的版本对导引机器人编程来做避障试验,打开程序
FastlrRoaming.c重命名为Slov/erlrRoamingForLeadRobot.c
•对程序Slov/erlrRoamingForLeadRobot.c做以下修改:
■把1300的增加为1420
■把1700的减少为1580
•尾随车运行程序FollovvingRobot.c,不用做任何修改
•机器人都运行自己的程序,把尾随车放在引导车的后而。
尾随车应该跟随一个固泄的距离,只要它不被其它的诸如手或附近墙壁等引开
你可以通过调整SetPoint和比例常数来改变尾随车的行为。
用手或一张纸片来引导尾随车,做下而练习:
•尝试用30到100范囤内的常量Kpr和Kpl来运行程序FollowingRobot.c,注意机器人在跟随目标运动的时候的响应有何差异
•尝试调肖常量SetPoint的值,范国从0到4
3.跟踪条纹带
图9-8是你可以搭建的一个路径并编程使机器人跟它运动的例子。
路径中每个条纹带是由三条1/4英寸宽的聚乙烯绝缘带边对边并行放置在白色招贴板上组成的,绝缘带条纹之间不能漏岀白色板。
D搭建和测试路线
为了成功跟踪该路径,测试和调节机器人是必要的。
需要的材料:
(1)-张招贴板一一大槪尺寸:
22X28英寸(56X71cm)
(2)1/4英寸(19mm)宽黑色聚乙烯绝缘带一卷
•参考图9・7用白色招贴板和绝缘带搭建运行路径
2)测试条纹带
调节IRLED/探测器的位置向下和向外,如图6・8所示
确保绝缘带路径不受荧光灯干扰
用你电阻代替与IRLED串联的470Q电阻,使机器人更加近视
运行程序DisplayBothDistances.ee机器人与串口电缆相连,以便你能看到显示的距
图9・9低区域测试俯视图
•如果在你的绝缘带路径上很难获得比较髙的读数值,参考绝缘带路径排错部分
3)绝缘带路径排错
如果当IRLED/检测器指向绝缘带路径的中心的时候你不能获得比较髙的读数值,代替原来三条绝缘带用四条绝缘带搭建路径。
如果区域读数仍然低,确认你是用1kO电阻串联在IRLED上。
你可以试用2kQ电阻使机器人更加近视。
如果都不行,试试不同的绝缘带。
调整IRLED/探测器,使它们指向更靠近或更远离机器人的前部可能有帮助。
如果当读白色表面时你的低区域测试有问题。
试试将IRLED/探测器朝机器人的方向再向下调整,但是要注意不要让底盘带来干扰。
你也可以试试一个更低阻值的电阻。
如果你用老的缩小包装的IRLED代替带套筒的IRLED,当IRLED/探测器聚焦在白色背景上时你要得到一个低区域的值可能有问题。
这些IRLED可能需要串联220Q电阻。
也要确保IRLED的脚没有相互接触。
•现在,将机器人放在绝缘带路径上,它的轮子正好跨在黑色线上。
IR探测器应该稍稍向外,如图9-12。
验证两个距离读数是否又是0或者仁如果读数较高,意味着IR探测器需要再稍微朝远离绝缘帯边缘的方向向外调整一下
图9-12IR检测器朝向放大图
当你把机器人沿图中双箭头所示的任何一个方向移动,两个IR中的一个会指向绝缘带上。
当你做了这些后,这个指向绝缘带上的IR的读数应该增加到4或5。
记住如果你将机器人向左移动,右边检测器的值会增加,如果你将机器人向右移动,左边检测器的值会升髙。
•调整IRLED/检测器直到机器人通过这个最后的测试,然后你可以试验下而的例程使机器人沿着条纹带行走
4)编程跟踪条纹带
你只需对程序Follov/ingRobot.c做一点小小的调整,就可以使机器人跟踪条纹带行走。
首先,机器人应当向目标靠近,以使到目标的距离比SetPoint要小:
或远离目标,以使距离比SetPoint大,这同程序FollowingRobot.c的表现相反。
当机器人离物体的距离不在SetPoint的范囤内时,让机器人向相反的方向运动。
只需简单地更改Kpl和Kpr•的符号,换句话说,将Kpl由-70改为70;
由Kpr由70改为-70。
你应该做试验,当SetPoint从2到4时,看哪个值使系统工作稳定。
下而的例程将SetPoint值改为3。
StripeFollowingRobot.c
•打开程序FollowingRobot.c另存为StripeFollowingRobot.c
•将SetPoint的值由2改为3
•将Kpl由-70改为70
•将Kpr由70改为-70
•运行程序
•将机器人放在图9-7所示的“Start”位亂机器人将静此如果你把手放在IR组前而,然后它会向前移动,当它走过了开始的条纹带时,把手移开,它会沿着条纹带行泄。
当它看到“Finish”条纹带时,它应该停止不动
•假立你从绝缘带获得的距离读数为5,从白色招贴板获得的读数为0,SetPoint的常量值为2、3以及4时都可以正常工作。
尝试不同的SetPoint值,注意机器人在条纹带上运行时的性能
附录:
定时/计数器的运用
实验需要用到单片机更精确的左时功能,因此再回顾一下51单片机泄时/汁数器的使用方法。
单片机的宦时/计数器能够提供更精确的时间。
前而已经介绍了几种延时方法,除了空操作函数_nop_()外
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 利用 红外 发射 接收 传感器 进行 距离 检测