超声波 红外避障.docx

移动机器人的多传感器测距系统设计一、 引言在自主移动机器人的实时避障和路径规划过程中，机器人须依赖于外部环境信息 的获取，感知障碍物的存在，测量障碍物的距离目前，机器人避障和测距传感器有 红外、超声波、激光及视觉传感器激光传感器和视觉传感器价格贵，对控制器的要 求较高，因而，在移动机器人系统中多采用红外及超声波传感器多数系统采用单一传感器进行信息采集，但超声波传感器因为存在测量盲区的问题， 测距范围一般在30〜300cm之间；而红外测距传感器的探测距离较短，一般在几十厘 米之内，它可以在一定程度上弥补超声波传感器近距离无法测量的缺点因而，本系 统采用多路红外和超声波传感器进行距离信息的测量和采集二、 测距原理及方法（一）超声波传感器超声波是指谐振频率高于20 Hz的声波，频率越高反射能力越强超声波传感器 价格低廉，其性能几乎不受光线、粉尘、烟雾、电磁干扰的影响，并且，金属、木材、 混凝土、玻璃、橡胶和纸等可以反射近乎 100%的超声波，因而，可以用来探测物体 超声波测距的方法为回声探测法，发射换能器不断发射声脉冲，声波遇到障碍物后反 射回来被接收换能器接收，根据声速及时间差计算出障碍物的距离。

距离与声速、时 间的关系表示为式中：s为与障碍物间的距离，m; c为声速，m/s； t为第一个回波到达的时刻与 发射脉冲时刻的时间差，sc与温度有关，空气中声速与温度的关系可表示为式中c为声速，m/s; 0为环境温度，°C二）提高超声波测距精度的方法1 •采用合适的频率和波长：使用超声波传感器测距，频率取得太低;外界杂音干 扰较多；频率取得太高，在传播过程中衰减较大并且，超声波传感器在测量过程中 容易产生盲区，接收端易接收到泄漏波改善这一缺点，须减少发射波串的长度，增 高发射波频率但发射波串长度过短会使得发射换能器不能被激振或激振达不到最大 值；发射波频率过高则衰减大，作用距离下降、有试验表明：使用40 kHz的超声波， 发射脉冲群含有10-20个脉冲，具有较好的传播性能2•提高系统的计时精度也可提高超声波的测距精度，计时器的计数频率越高， 则由于时间的量化误差所引起的测距误差就越小3•对系统电路的时间延迟进行补偿可以减小测距误差，提高测距精度延迟时 间餐7〕式中At为延迟时间，s;s1,s2为2个已知的测量距离，m； tl, t2为对应的测量时 间，s三）红外避障传感器红外线是介于可见光和微波之间的一种电磁波，因此，它不仅具有可见光直线传 播、反射、折射等特性，还具有微波的某些特性，如较强的穿透能力和能贯穿某些不 透明物质等。

红外传感器包括红外发射器件和红外接收器件自然界的所有物体只要 温度高于绝对零度都会辐射红外线，因而，红外传感器须具有更强的发射和接收能力红外传感器的的测距基本原理为发光管发出红外光，光敏接收管接收前方物体反 射光，据此判断前方是否有障碍物根据发射光的强弱可以判断物体的距离，它的原 理是接收管接收的光强随反射物体的距离而变化的，距离近则反射光强，距离远则 反射光弱目前，使用较多的一种传感器-红外光电开关，它的发射频率一般为38 kHz左右， 探测距离一般比较短，通常被用作近距离障碍目标的识别本系统采用的即为此种传 感器四）红外测距的缺陷 受器件特性的影响，一般的红外光电开关抗干扰性差，受环境光影响较大；并且，探 测物体的颜色、表面光滑程度不同，反射回的红外线强弱就会有所不同三、硬件系统构成（一） 系统组成滋烛.：•氐辱辽咛冲门出i 『 JUf-SFl—> I ■fl' ■Mllw.-IB该测距系统由单片机、超声波发射接收电路、红外发射接收电路、数码显示电路 及串口通信电路等模块组成，见图1控制核心为凌阳16位单片机SPCE061 A,芯片 上集成有2个16位可编程定时器/计时器，14个中断源，32位通用可编程输人/输出通 道，7通道10位A/D转换器。

移动机器人的前方、左方、右方各安装一套超声波及红外传感器，使机器人能够 感知3个方位的障碍信息单片机在接收到传感器的信息后，将传感器的信号转换为 距离信息，在LED数码管上显示，并通过串口 RS - 232接 口与上位PC机通信，传输 距离信息二） 超声波传感器电路凌阳单片机的I/O9-I/O11 口接三路超声波发射电路，I/O3-I/O5接三路超声波接 收电路单片机产生的40 kHz信号由I/O输出，经反相器4049B组成的升压放大电路， 最后，由超声波发射换能器UCM40T发射；声波遇到障碍物返回，被接收换能器UCM40R 接收，信号经OP07组成的两级放大电路放大，通过锁相环音频译码器LM567选频， 滤除干扰信号，最后，通过I/O 口输入单片机单片机通过声波的传输时间计算障碍 物距离三） 红外传感器电路凌阳单片机的I/O0~I/O6可作为10位A/D转换器本系统中，凌阳单片机的 I/O0〜I/O2 口作为A/D转换器使用，I/O6〜I/O8接三路红外发射电路，I/O0〜I/O2 接三路红外接收电路单片机I/O 口输出高电平时与红外发光管TLN205导通，发射 红外光；光波在遇到障碍物后反射，被红外接收管TPS708接收，产生一个与光强相 对应的电流，电流经LM358组成的两级放大电路放大后，输出一个0〜3V的模拟电压， 经A/D 口输人单片机。

单片机通过 电压的大小计算、判断障碍物的距离四、软件设计单片机SPCE061 A选用系统时钟频率fosc = 20.480MHz, CPU时钟频率（CPUCLK） 为fosc/2 = 10. 24 MHz,时钟源A选用频率32768 Hz,时钟源B选用频率1 Hz,,SPCE061A 提供2个16位的定时/计数器：TimerA和TimerBTimerA的时钟源由时钟源A和时 钟源B进行与操作形成；TimerB的时钟源仅为时钟源A40 kHz的超声波脉冲为高低电平各占12.5p s的方波，CPU时钟计数延迟123个指 令周期即为12.5p s单片机通过不断的交替产生12.5p s的高低电平即可产生40 kHz 的脉冲信号，每次发射20个脉冲的脉冲群，持续0.5 ms，脉冲发射、间隔时间至少20 ms,从I/O 口输出系统选用定时器A作为产生20 ms的定时中断，选用定时器B作 为超声波计数器由于超声波传感器存在测量盲区，因而，在程序设计中，将远于30 cm的测距由 超声波传感器完成，30 cm以内由红外传感器完成红外测距过程中，选用定时器A产生0.1S的中断进行A/D采样，并将采样的电压 值转换为距离信息。

主程序中，首先，进入红外探测子程序，如果探测到障碍物，则进人数据传输、 显示及运动控制子程序；没有探测到障碍物，则进入超声波探测子程序超声波探测 到障碍物，则进人数据传输、显示及运动控制子程序，没有探测到障碍物，则循环进行红外探测图2、图3分别为红外及超声波探测子程序I皿V •小皿卜-Hi VI-五、测量结果试验过程中，采用同大小、质地、颜色的障碍物进行测量试验表明：系统在0〜200 cm的范围间测距精度在1%之内，能够较为准确对障碍物进行测距在30 cm以 内的测距由红外传感器完成，30〜200 cm之间的测距由超声波传感器完成，试验结 果见表1AlTaa 1 TbHWJE4<*；■；■■■：:«iA AS占血l.M>W. F■恳W“ wE>腐1』13口 m° IMi m ar-t訥LLtLIHIJILHl.'Af•J.曲0梶j>Si御巳w 4fTruri-1:Man.K4豪UP六、结束语本文研究了一种低成本、低功耗、高效能的移动机器人侧距系统，采用超声波和红外传感 器的多传感器系统，有效地解决了单一传感器测距系统中测量盲区的缺陷问题；并且，采用3 组传感器组装配在机器人的3个不同位置，使得机器人可完成3个不同方位的测距任务。

信息来源：传感器与微系统VCCVCCU?□ptoisolatorl1R43MGXD我认为这里一个重要的东西就是LM339（比较器），LM339芯片内部装有四 个独立的电压比较器，是很常见的集成电路利用lm339可以方便的组成各种电压比 较器电路和振荡器电路引脚图如下：Otrlpui 1 _2_Vqc L3.两 Output 312J GND* InpuL? fhpuL2 t Pnit j * lnpiX4 函-3nput4 门■+ Irtpii 3*3 - InputsLM339总共有四个电压比较器，功能都相同其中，3号引脚VCC,12号引脚GND1、 功能为正引脚的电压如果高于负引脚的电压，贝U输出端口的电压为高电平2、 正引脚的电压低于负引脚的电压，输出端口的电压为低电平根据以上的特性，我们就可以将其利用在红外传感电路中下面我来分析下，为什么 我们电路这样设计1、 红外接收管，我们接了个3M的电阻，很大用来分压，这样红外接收管部分的电 压就会很低，则LM339的4号管脚，就会是低电平5号管脚的电平会高于4号管脚的 最终，2号管脚输出的就是低电平2、 在输出管脚线上，我接了一个发光二极管，这样可以很明显的感受到2号输出管脚 的高低电平。

只有当2号输出管脚为低电平时才发光若当接收管收到了信号但是， 二极管却没有发光我们可以调节-滑动变阻器来调节电压值。