超声波避障果园喷雾机器人自动避障设计论文

《超声波避障果园喷雾机器人自动避障设计论文》由会员分享，可在线阅读，更多相关《超声波避障果园喷雾机器人自动避障设计论文（25页珍藏版）》请在装配图网上搜索。

1、. . . . 毕 业 论 文（设 计）题目：果园喷雾机器人自动避障设计 摘 要果园喷雾机器人在工作的时候不可避免地受到障碍物的干扰，障碍物会严重影响机器人的工作效率，严重会使机器人损坏，机器人还会对身边工作人员造成安全威胁，所以实现机器人的自动避障非常重要，由于果园机器人体型比较大，需要检测到远距离的障碍物，因此设计方法非常重要，本论文采用单片机80C51为核心，用T/R-40-12型超声波测距的方法检测障碍物，通过单片机对信号的处理，驱动电机的转向，前进与后退，从而达到自动避障的功能。通过实践得出超声波的测距误差在5%之，该设计的性能稳定，果园喷雾机器人能够绕开障碍物去实现对果树喷雾的目的

2、。关键词 80C51单片机，果园喷雾机器人，超声波传感器，超声波测距AbstractOrchard spray when the robot at work inevitably be interference from obstructions, obstacles will seriously affect the efficiency of the robot, the robot would seriously damage, the robot will be on staff around a security threat, so to achieve automatic obs

3、tacle avoidance robot is very important, because relatively large size fruit robot needs to detect the distance of the barrier, so design is important In this thesis, 80C51 microcontroller core, with T/R-40-12 ultrasonic range finder to detect obstacles, the signal processing through the MCU to driv

4、e the motor turning, forward and backward, so as to achieve automatic obstacle avoidance function. Obtained through the practice of ultrasonic range error within 5% of the design of stable, orchard spraying robot can bypass the obstacles to achieving the purpose fruit spray. Keywords 80C51 microcont

5、roller, orchard spray robot, ultrasonic sensors，ultrasonic ranging22 / 25 目录1绪论11.1 激光传感器11.2 视觉避障11.3 超声传感器11.4避障系统设计思想22系统设计32.1总系统设计32.2单片机输出电路的设计32.3障碍物的信息的采集43 超声波测距设计53.1超声波测距工作原理53.2超声波测距系统硬件设计53.3测距算法设计93.4程序流程103.5避障的实现114总结12致13参考文献14附录151绪论移动机器人是机器人的重要研究领域，人们很早就开始移动机器人的研究。斯坦福研究院(SRI)的Nils

6、 Nilssen 和CharlesRosen 等人1，在1996 年至1972 年中研制了Shakey 的自主移动机器人2，目的是应用人工智能技术研究机器人在复杂环境下的自主推理、规划和控制。20 世纪70 年代末，随着计算机的应用和传感技术的发展，移动机器人的研究又出现了新的高潮。20 世纪90 年代以来，以研制高水平的环境信息传感器和信息处理技术，高适应性的移动机器人控制技术，真实环境下的规划技术为标准，开展了移动机器人更高层次的研究。避障是智能移动机器人基本的功能，具体的实现方法多种多样。避障使用的传感器主要有超声传感器、视觉传感器、红外传感器、激光传感器、接近觉传感器等传感器1.1 激

7、光传感器激光测距传感器的方向性特别好，对一般应用可以认为是理想的直线。激光测距传感器的波束很窄，所以方向性好，因此可得到障碍物的准确位置。激光测距的精确度很高，但是激光测距的技术复杂，实现难度较大，而且一些激光传感器发射的激光，对人的眼睛有伤害3。1.2 视觉避障视觉避障的优点是探测围广，可以获得物体的形状、速度等信息4。实际应用中使用多个摄像机，或是利用一个摄像机的序列图像来计算目标的距离和速度，还可采用SSD算法，根据一个摄像机的运动图像来计算机器人与目标的相对位移，并用自适应滤波对测量数据进行处理，以减小因环境不稳定性造成的测量误差。在图像处理中，边缘锐化、特征提取等图像处理方法计算量大

8、，实时性差，对中央处理机要求高，不适合在较小的自主移动机器人上使用。视觉测距法检测不能检测到玻璃等透明障碍物的存在，另外受视场光线强弱、烟雾的影响很大5。1.3 超声传感器超声传感器的成本低，实现方法简单，技术成熟，是机器人避障的常用传感器。机器人是利用超声测距来探测障碍的位置，超声波测距采用时间差测距法，即超声波发射器向某一方向发射超声波，在发射时刻的同时开始计时，超声波在空气中传播，途中碰到障碍物就立即返回来，超声波接收器收到反射波就立即停止计时，根据超声波在空气中的传播速度和计时器记录的时间6，就可以计算出发射点距障碍物的距离。由于超声波在空气中的速度和空气的温度湿度有关，在比较精确的测

9、量中，可以把温度的变化和其它因素考虑进去。因为单超声传感器避障存在由于超声波的方向性不好造成对障碍物的定位不精确，存在探测盲区等缺点。1.4避障系统设计思想要想实现移动机器人避障行走的自主控制, 所面临的基本问题是一方面要求有充分的环境信息, 另一方面要求能处理所获得的环境信息使其转化成控制信息。环境信息的获得移动机器人的避障行走, 首先是解决静态障碍物的避障, 此时环境信息主要是距离信息7。通过对激光、红外线、超声波等现有测距方法的比较可知, 超声波指向性强, 能量消耗缓慢, 在介质中传播的距离较远, 利用声波检测往往比较迅速、方便、计算简单、易于做到实时控制, 并且在测量精度方面能达到工业

10、实用的要求8。本系统采用超声波测距方法, 为果园喷雾机器人识别其运动的前方环境提供一个准确的运动距离信息。2系统设计2.1总系统设计自动避障系统的硬件电路主要由超声波发射电路、超声波接收电路、单片机启与外围电路、从转换电路和机器人行走控制电路组成9, 原理方框图如图2.1所示 图2.1 系统硬件图单片机P1.0端口接超声波发射电路的输人端, 通过单片机执行定时中断服务子程序, 以一定的时间间隔在P1.0端口输出一个40KHz的方波10, 驱动超声波传感器UCM40T, 发出40K的脉冲超声波。在启动发射电路的同时启动单片机的定时器T0利用定时器的计数功能记录超声波发射的时间和收到反射波的时间。

11、超声波接收电路输出端接单片机外部中断INT011, 当收到超声波反射波时, 接收电路输出端产生一个负跳变, 则INT0端产生一个中断请求信号, 单片机响应外部中断请求, 执行外部中断服务子程序, 读取超声波自发射至接收的往返时间, 计算出机器人距障碍物的距离。2.2单片机输出电路的设计单片机对所获得的距离信息经过避障算法运算, 转换出的控制信息经D/A输出。D/A换单元选用DAC0832, 工作于双缓冲器的方式, 同步输出二路模拟量, 分别为转角控制量Va和速度控制量Vv12, 送给机器人控制电路输人端, 转角控制电路以电压Va实时控制机器人的转向角, 速度控制电路以电压Vv实时控制机器人的行

12、走速度.2.3障碍物的信息的采集障碍物的信息包括超声波传感器中心到障碍物的最短距离和障碍物相对于车体的方位12。移动机器人运行过程中, 实时采集每个方向上超声波传感器中心到障碍物的边界距离, 进行比较划分找到其中最短的距离与方位作为车体到障碍物的最短距离和方位。避障算法如下移动机器人以某一速度前进, 如果某一传感器检测到的距离小于dc, 这个距离是预定义编程的临界距离, 那么机器人以某一角度偏转13, 从而绕开障碍物;否则继续前进。避障软件实现的步骤包括主程序、测距程序、显示程序、电机转向控制程序14如图2.2所示 图2.2 避障步骤图3 超声波测距设计超声波测距部分是机器人避障的核心部分。3

13、.1超声波测距工作原理利用超声波作为定位技术是蝙蝠等一些无目视能力的生物作为防御与捕捉猎物生存的手段, 也就是由引言生物体发射不被人们听到的超声波以上的机械波, 借助空气媒质传播, 由被待捕捉的猎物或障随着机器人技术的发展, 自主移动机器人以其灵碍物反射回来的时间间隔长短与被反射的超声波的强活性和智能性等特点, 在人们的生产、生活中的应用越弱判断猎物性质或障碍物位置的方法。由于超声波的来越广泛。自主移动机器人通过各种传感器系统感知速度相对于光速要小得多, 超声波与光波不同, 它是一外界环境和自身状态, 在复杂的已知或者未知环境中种弹性机械波, 可以在气体、液体和固体中传播。我们自主移动并完成相

14、应的任务。而在多种探测手段知道, 电磁波的传播速度为“, 而超声波在空中, 超声波传感器系统由于具有成本低, 安装方便, 不气中的传播速度为, 其速度相对电磁波是非常易受电磁、光线、被测对象颜色、烟雾等影响, 时间信息慢的。超声波在一样的传播媒体里大气条件传播速直观等特点, 对于被测物处于黑暗、有灰尘、烟雾、电磁度一样, 即在相当大的频率围声速不随频率变化,干扰、有毒等恶劣的环境下有一定的适应能力, 因此在波动的传播方向与振动方向一致, 是纵向振动的弹性移动机器人领域有着广泛的应用。机械波, 它是借助于传播介质的分子运动而传播的, 其传播时间就比较容易检测, 并且易于定向发射, 方向性超声波工

15、作原理好, 强度好控制, 因而人类采用仿真技能利用超声波测距, 它是一种利用声波特性、电子计数、光电开关相结15。3.2超声波测距系统硬件设计本设计采用AT89C51或AT89S51单片机,晶振:12M,单片机用P1.0口输出超声波换能器所需的40K方波信号,利用外中断0口监测超声波接收电路输出的返回信号,显示电路采用简单的4位共阳LED数码管,断码用74LS244,位码用8550驱动. 采用AT89S51来实现对CX20106A红外接收芯片和TCT40-10系列超声波转换模块的控制。单片机通过P1.0引脚经反相器来控制超声波的发送，然后单片机不停的检测INT0引脚，当INT0引脚的电平由高电

16、平变为低电平时就认为超声波已经返回。计数器所计的数据就是超声波所经历的时间，通过换算就可以得到传感器与障碍物之间的距离。本设计包括超声波接收电路、超声波发送电路、距离显示电路组成16，如图3.1 图3.1超声波发送电路图 图3.2超声波接收电路部分： 图3.3超声波接受电路图使用CX20106A集成电路对接收探头受到的信号进行放大、滤波。其总放大增益80db。表1是CX20106A的主要引脚注释17。 表1引脚功能1超声信号输入端，该脚的输入阻抗约为40k2该脚与地之间连接RC串联网络，它们是负反馈串联网络的一个组成部分，改变它们的数值能改变前置放大器的增益和频率特性。增大电阻R1或减小C1,

17、将使负反馈量增大，放大倍数下降，反之则放大倍数增大。但C的改变会影响到频率特性，一般在实际使用中不必改动，推荐选用参数为R1=4.7，C1=1F 3该脚与地之间连接检波电容，电容量大为平均值检波，瞬间相应灵敏度低；若容量小，则为峰值检波，瞬间相应灵敏度高，但检波输出的脉冲宽度变动大，易造成误动作，推荐参数为3.3f4接地端5该脚与电源间接入一个电阻，用以设置带通滤波器的中心频率f0，阻值越大，中心频率越低。例如，取R=200kR=200k时，f042kHz，若取R=220k，则中心频率f038kHz6该脚与地之间接一个积分电容，标准值为330pF，如果该电容取得太大，会使探测距离变短7遥控命令

18、输出端，它是集电极开路输出方式，因此该引脚必须接上一个上拉电阻到电源端，推荐阻值为22k，没有接受信号是该端输出为高电平，有信号时则产生下降测距显示电路：单片机采用89S51或其兼容系列。采用12MHz高精度的晶振，以获得较稳定的时钟频率，减小测量误差。单片机用P1.0端口输出超声波转化器所需的40KHz方波信号，利用外中断0口检测超声波接受电路输出的返回信号。显示电路采用简单实用的4位共阳LED数码管，段码用74LS244驱动，位码用PNP三极管驱动。单片机系统与显示电路18如图3.4所示.3.3测距算法设计超声波在空气中传播速度为每秒钟340米（15时）19。X2是声波返回的时刻，X1是声

19、波发声的时刻，X2-X1得出的是一个时间差的绝对值，假定X2-X1=0.03S，则有340m0.03S=10.2m。由于在这10.2m的时间里，超声波发出到遇到返射物返回的距离， 图3.4 算法演示图3.4程序流程系统开始由超声波发送电路发出超声波，当超声波接收电路接收到回波时，单片机根据算法算出障碍物距离，显示在数码管上面。 图 3.5测距程序流程图超声波测距系统的测试结果： 表2障碍物距离（cm） 显示距离（cm）25 27.8 26 27.7 27 27.6 290 29.1 300 300.4 400 400.2 4500 400.1 1000 400.2由表可见，超声波测试的距离围在

20、27cm到4m之间，经计算，误差在5%之3.5避障的实现机器人在行使过程中如果遇到障碍物，它的超声波测距系统马上计算出机器人与障碍物的距离d，若ddc(避障的临界距离)，电机左右转向控制将驱动，从而绕过障碍物实现避障的效果20,程序流程图如图3.5所示开始初始化左是否 有障碍右是否有障碍距离ddc? 机器人前进距离ddc? 返回机器人右转机器人左转 YNNYNYY N图3.5避障程序流程图4总结本文实现了利用超声波测距信息来实现移动机器人的顺利行走, 是因为超声波测距仪信息处理简单、速度快, 但它也具有一定的局限性, 主要表现在探测波束角过大、方向性差、只能获得目标的距离信息, 而不能准确地提

21、供目标的边界信息等, 故需要对数据的融合算法进行进一步的研究, 以消除它的缺陷。致历时三个月的毕业设计已经告一段落。经过自己不断的搜索努力以与胡博士耐心指导和热情帮助，本设计已经基本完成。通过这次毕业设计，使我深刻地认识到学好专业知识的重要性，也理解了理论联系实际的含义，并且检验了大学四年的学习成果。虽然在这次设计中对于知识的运用和衔接还不够熟练。但是我将在以后的工作和学习中继续努力、不断完善。这三个月的设计是对过去所学知识的系统提高和扩充的过程，为今后的发展打下了良好的基础。由于自身水平有限，设计中一定存在很多不足之处，敬请各位老师批评指正。参考文献1 Intille S S. Design

22、ing a home of the futureJ. IEEE PervasiveComputing, 2002,1(2):80-86.2 Chris Chambers. Smart home: How home automation works andwhat it can doJ.22-233东鹤，喜昂.智能移动机器人的超声避障研究J。机器人，2003,1(2):80-86.4 宗光华机器人的创意设计与实践 M 航空航天大学，2004.45-565何立民,单片机应用系统设计.：航天航空大学,2005.30-676毅刚，喜元.新编MCS-51单片机应用设计.第一版，工业大学,2003,252

23、7,4114177 徐颖.Protel 99 SE EDA 技术与应用.机械工业M2005.23-458 何希才.传感器与其应用.国防工业M2001.22-459 高钟毓.机电控制工程.清华大学M2003.68-9810 Harvey L ,Coles G S V ,Watson J . The development of an envi2ronment chamber for the characterization of gas sensorsJ . Sen2sors and Actuators ,1989 ,16 :393 - 405.11路锦正, 王建勤, 绍国, 珂, 太飞.超声波

24、测距仪的设计J.2006.1-512 凡.微机原理与接口技术.交通大学M2003.20-2513 戴胜华.单片机原理与应用.交通大学M2005.36-4414 侯建军.数字电子技术基础.:高等教育M2003.22-3815 进棋,诸静.移动机器人多路超声波数据采集系统的J.2005.12-1816 喜昂.基于多超声波的安全避障J.2004.2-717谭进怀，地耘，立万.超声波语音测距系统在车辆避障中的应用J.2004.34-3818宋立中.基于单片机的超声波测距仪LED显示电路的设计J2006.2-819玉芹敬文.超声波测距仪在移动机器人避障中的应用J2005.10-2020 侯丽春,志强,陆

25、荣 .红外线再机器人避障中的应用J2007.2-5附录超声波测试程序：; USE BY : 超声波测距器 ; IC :AT89C51 ; TEL : ; OSCCAL :XT (12M) ; display :共阳LED显示 ; Updata :2008/03/12; NAME : ;/;测距围7CM-11M，堆栈在4FH以上，20H用于标志;显示缓冲单元在40H-43H，使用存44H、45H、46H用于计算距离; VOUT EQU P1.0 ; 红外脉冲输出端口speakequp1.1;*;* 中断入口程序 *;*; ORG 0000H LJMP START ORG 0003H LJMP P

26、INT0 ORG 000BH reti ORG 0013H RETI ORG 001BH LJMP INTT1 ORG 0023H RETI ORG 002BH RETI ;*;* 主 程 序 *;*; START: MOV SP,#4FH MOV R0,#40H ;40H-43H为显示数据存放单元（40H为最高位） MOV R7,#0BH CLEARDISP: MOV R0,#00H INC R0 DJNZ R7,CLEARDISP MOV 20H,#00H MOV TMOD,#11H ;T1为 T0为16位定时器 MOV TH0,#00H ;65毫秒初值 MOV TL0,#00H MOV

27、TH1,#00H MOV TL1,#00H MOV P0,#0FFH MOV P1,#0FFH MOV P2,#0FFH MOV P3,#0FFH MOV R4,#04H ;超声波肪冲个数控制（为赋值的一半） SETB PX0 SETB ET1 SETB EA SETB TR1 ;开启测距定时器 start1: LCALL DISPLAY JNB 00H,START1 ;收到反射信号时标志位为1 CLR EA LCALL WORK ;计算距离子程序 clr EA MOV R2,#32h;#64H ;测量间隔控制（约4*100=400MS）LOOP: LCALL DISPLAY DJNZ R2,

28、LOOP CLR 00H setb et0 mov th0,00h mov tl0,00h SETB TR1 ;重新开启测距定时器 SETB EA SJMP Start1;*;* 中断程序* *;*;T1中断，发超声波用 ;T1中断，65毫秒中断一次INTT1: CLR EA CLR TR0 clr ex0 MOV TH0,#00H MOV TL0,#00H MOV TH1,#00H MOV TL1,#00H SETB ET0 SETB EA SETB TR0 ;启动计数器T0，用以计intt11: CPL VOUT ;40KHZ nop nop nop nop nop nop nop nop

29、 nop DJNZ R4,intt11 ;超声波发送完毕， MOV R4,#04H lcall delay_250 ;延时，避开发射的直达声波信号 SETB EX0 ;开启接收回波中断RETIOUT: RETI;外中断0，收到回波时进入PINT0: nop p3.2,pint0_exit CLR TR0 ;关计数器 CLR EA ; CLR EX0 ; MOV 44H,TL0 ;将计数值移入处理单元 MOV 45H,TH0 ; mov th0,#00h mov tl0,#00h jnb p3.2,$ SETB 00H ;接收成功标志pint0_exit: RETI;*;* 显示程序 *;*;

30、40H为最高位，43H为最低位，先扫描高位 DISPLAY: MOV R1,#40H;G MOV R5,#7fH;G PLAY: MOV A,R5 MOV P0,#0FFH MOV P2,A MOV A,R1 MOV DPTR,#TAB MOVC A,A+DPTR MOV P0,A LCALL DL1MS INC R1 MOV A,R5 JNB ACC.4,ENDOUT;G RR A MOV R5,A AJMP PLAY ENDOUT: MOV P2,#0FFH MOV P0,#0FFH RET; TAB: DB 0C0h, 0F9h, 0A4h, 0B0h, 99h, 92h, 82h, 0

31、F8h, 80h, 90h,0ffh ;共阳段码表 0 1 2 3 4 56 7 8 9 不亮A-;*;* 延时程序 *;*; DL1MS: push 06h push 07h MOV R6,#14H DL1: MOV R7,#19H DL2: DJNZ R7,DL2 DJNZ R6,DL1 pop 07h pop 06h RET;*;* 距离计算程序 (=计数值*17/1000cm) *;*;work: PUSH ACC PUSH PSW PUSH B MOV PSW, #18h MOV R3, 45H MOV R2, 44H MOV R1, #00D MOV R0, #17D LCALL

32、MUL2BY2 MOV R3, #03H MOV R2, #0E8H LCALL DIV4BY2 LCALL DIV4BY2 MOV 40H, R4 MOV A,40H JNZ JJ0 MOV 40H,#0AH ;最高位为零，不点亮JJ0: MOV A, R0 MOV R4, A MOV A, R1 MOV R5, A MOV R3, #00D MOV R2, #100D LCALL DIV4BY2 MOV 41H, R4 MOV A,41H JNZ JJ1 MOV A,40H ;次高位为0，先看最高位是否为不亮 SUBB A,#0AH JNZ JJ1 MOV 41H,#0AH ;最高位不亮，

33、次高位也不亮JJ1: MOV A, R0 MOV R4, A MOV A, R1 MOV R5, A MOV R3, #00D MOV R2, #10D LCALL DIV4BY2 MOV 42H, R4 MOV A,42H JNZ JJ2 MOV A,41H ;次次高位为0，先看次高位是否为不亮 SUBB A,#0AH JNZ JJ2 MOV 42H,#0AH ;次高位不亮，次次高位也不亮JJ2: MOV 43H, R0 POP B POP PSW POP ACC RET;*;* 两字节无符号数乘法程序 *;*; R7R6R5R4 = R3R2 * R1R0;MUL2BY2: CLR A M

34、OV R7, A MOV R6, A MOV R5, A MOV R4, A MOV 46H, #10HMULLOOP1: CLR C MOV A, R4 RLC A MOV R4, A MOV A, R5 RLC A MOV R5, A MOV A, R6 RLC A MOV R6, A MOV A, R7 RLC A MOV R7, A MOV A, R0 RLC A MOV R0, A MOV A, R1 RLC A MOV R1, A JNC MULLOOP2 MOV A, R4 ADD A, R2 MOV R4, A MOV A, R5 ADDC A, R3 MOV R5, A MO

35、V A, R6 ADDC A, #00H MOV R6, A MOV A, R7 ADDC A, #00H MOV R7, AMULLOOP2: DJNZ 46H, MULLOOP1 RET;*;* 四字节/两字节无符号数除法程序 *;*;R7R6R5R4/R3R2=R7R6R5R4(商).R1R0(余数);DIV4BY2: MOV 46H, #20H MOV R0, #00H MOV R1, #00HDIVLOOP1: MOV A, R4 RLC A MOV R4, A MOV A, R5 RLC A MOV R5, A MOV A, R6 RLC A MOV R6, A MOV A, R7

36、 RLC A MOV R7, A MOV A, R0 RLC A MOV R0, A MOV A, R1 RLC A MOV R1, A CLR C MOV A, R0 SUBB A, R2 MOV B, A MOV A, R1 SUBB A, R3 JC DIVLOOP2 MOV R0, B MOV R1, ADIVLOOP2: CPL C DJNZ 46H, DIVLOOP1 MOV A, R4 RLC A MOV R4, A MOV A, R5 RLC A MOV R5, A MOV A, R6 RLC A MOV R6, A MOV A, R7 RLC A MOV R7, A RET;delay_250: push psw push 07h mov r7,#0ffhdelay_250_1: nop nop nop nop djnz r7,delay_250_1 pop 07h pop psw ret ;- END