割草机器人自动避障系统设计.doc

《割草机器人自动避障系统设计.doc》由会员分享，可在线阅读，更多相关《割草机器人自动避障系统设计.doc（47页珍藏版）》请在三一办公上搜索。

1、 本科生毕业设计 毕业设计题目 割草机器人自动避障系统设计 学 生 姓 名 专 业 机械设计制造及其自动化 班 级 指 导 教 师 完 成 日 期 2014 年 5 月 31日 摘 要自动避障系统是割草机器人关键模块之一，是割草机器人自主、安全行走前提。本文首先对国内外市场上现存的智能割草机器人进行了介绍和比较，指出了现在智能割草机器人研制过程中需要注意的关键技术，并结合以往的成功经验和现在的实际需求，选择易于实验的小车结构。STC89C52单片机是宏晶科技推出的新一代高速/低功耗/超强抗干扰的单片机，指令代码完全兼容传统8051单片机，12时钟/机器周期和6时钟/机器周期可以任意选择。本课题

2、以设计割草机器人自动避障为目的，采用STC89C52单片机作为控制核心，采用超声波传感器来检查路面上的障碍，来控制执行机构的自动避障，从而使执行机构完成左转、右转和后退的动作。其中采用的技术主要有：（1）超声波传感器的有效应用，（2）显示器的使用，（3）通过编程来控制执行机构的运动。关键词：STC89C52单片机，超声波传感器，执行机构，显示器AbstractAutomatic obstacle avoidance system is one of the key module robot mowers mowing robot, is independent, safe walking pr

3、emise. This paper firstly introduced and compared to the domestic and foreign existing in the market of intelligent robot mowers, points out the key technologies in the development process of the Intelligent Robot Mower now, combined with the successful experiences and actual demand now, select the

4、vehicle structure is easy to experiment.STC89C52SCM is the macro crystal technology, the introduction of a new generation of high / low power / super anti-jamming MCU, the instruction code is fully compatible with traditional 8051 SCM, 12 clock / machine cycle and 6 clock / machine cycle can be arbi

5、trarily chosen.The design of automatic obstacle avoidance for Robot Mower, using STC89C52 micro-controller as control core, using ultrasonic sensors to check the road barriers, automatic obstacle avoidance control actuator, the actuator to complete the left, right and back action. The main technolog

6、y:(1)The effective application of ultrasonic sensor.(2) The use of the monitor. (3)Programmed to control the car.Key words: STC89C52microcontroller, ultrasonic sensor, actuator , display目录中文摘要 IAbstract II第一章 绪论 11.1选题背景及意义 11.1.1自动割草机器人概述 1 1.1.2自动割草机器人优点 11.2割草机器人的发展简史及其研究现状 21.2.1发展简史 2 1.2.2国外的研

7、究现状 2 1.2.3国内的研究现状 3 1.3割草机器人自动避障系统 3第二章 总体方案设计 52.1主要研究内容 52.2具体方案介绍 5第三章 超声波测距 73.1超声波测距设计思路 73.1.1超声波测距原理 73.1.2超声波测距方法 73.1.3超声波模块的选择 73.1.4显示器的选择 8第四章 超声波模块的硬件结构设计 94.1超声波模块电路设计 94.1.1 超声波模块的特点 94.1.2 超声波模块的工作原理 94.1.3模块参数 104.1.4超声波时序图 10 4.1.5超声波发送与接收 114.2 STC89C52单片机功能及特点 124.2.1 STC89C52单片

8、机参数 124.2.2 STC89C52单片机特性 134.3显示电路设计 154.3.1 1602液晶屏的优点 154.3.2 1602管脚定义 154.3.3 1602操作时序 16第五章 超声波测距模块软件设计 185.1超声波测距算法设计 185.2主程序流程 185.2.1系统初始化程序 185.2.2超声波启动程序 195.2.3超声波计时程序 195.2.4测距程序 205.3实验结果 20第六章 实验用执行机构硬件设计 226.1执行机构底盘 226.2执行机构驱动模块 226.2.1 L298N驱动模块说明 226.2.2 L298N参数 236.3 SG90舵机 246.3

9、.1什么是舵机 246.3.2舵机工作原理 246.3.3利用单片机实现舵机转角控制 25第七章 执行机构软件设计 267.1执行机构行走程序 267.2舵机转动控制执行机构行走程序 27结论 30致谢 31参考文献 32附录1超声波避障舵机转动编程 33附录2 电路原理图 40第一章 绪论1.1选题背景及意义1.1.1自动割草机器人概述随着经济的发展,各国城市建设逐渐深化,城区的绿化程度也随之提高,大量的公园草坪、足球场草坪、GOFL球场草坪等公共绿地均需要进行维护。在各种草坪维护作业中,以草皮修剪工作最为繁重,不仅枯燥,而且重复性强,通常需要消耗大量的人力和物力。为了降低草坪维护作业的劳动

10、强度和成本,近年来一些西方国家提出用现代电子技术和智能控制技术改造和提升草坪机械产业的战略,希望在不久的将来用智能的自动割草机器人取代传统的割草机。自动割草机器人属于民用户外移动机器人领域,从系统科学的角度来讲,它是集环境感知、路径动态规划与决策、行为控制与执行等多种功能于一体的综合机器人系统。感知系统实时监测外界环境变量、移动机构及割草机构运行参数,并将结果输送到控制系统；控制系统将获得的数据与自身的数据库做比较,并参照路径规划对移动机构和割草机构发出修正指令,以获得稳定的运行情况。与传统的草坪修剪机械相比,自动割草机器人具有环保、人力消耗低和高安全性等特点。1.1.2 自动割草机器人优点自

11、动割草机器人与传统的割草机相比有着众多的优点。 1.自动割草机器人可自主工作,仅仅需要少量的人工干预甚至不需要人工干预。传统的割草机需要人的全程干预，割草任务相当繁重。 2.自动割草机器人更加安全。自动割草机器人采用了传感器技术和单片机控制技术，灵敏度更高，应用范围更广，检测精度也更高。也不会因为操作人员的疲劳导致各种意外事故。 3.自动割草机器人有利于保护环境。传统的割草机通过内燃机进行工作，会产生很大的噪声和废弃，这将严重影响操作人员的身体健康并且会污染环境。而割草机器人具有体积小、重量轻和所需功率小等特点,因此在太阳光充足的地方完全可以使用太阳能电池来提供能量，有利于环境保护。1.2割草

12、机器人的发展简史及其研究现状1.2.1发展简史1805年英国人普拉克内特发明了第一台收割谷物并可以切割杂草的机器，由人推动机器，通过齿轮传动带动旋刀割草，这就是割草机的雏形。1830年，英国纺织工程师比尔-布丁取得了滚筒剪草机的专利。1832年，兰塞姆斯农机公司开始批量生产滚筒式割草机。1902年英国人伦敦恩斯制造了内燃机作动力的滚筒式割草机，其原理延用至今。从20世纪80年代开始，各种技术都日瑧成熟，链传动，齿轮传动，皮带轮组无级变速，电传动，静液压无级变速全都在割草机上使用，特别是静液压无级变速的驱动单元不仅减轻了司机的操作劳动强度而且还给他们带来了操作的乐趣，加之现代机械设计理念使割草机

13、的结构设计越来越简洁，外形越来越美观，割草机产业显得比以往任何一个时候都更为兴旺。1.2.2国外的研究现状国外对智能割草机器人的研究已经有很长一段时间，在一些草坪拥有量比较的发达国家，他们将智能割草机器人作为商品出售，并且销量很好。出售的智能割草机器人已经达到了中等水平，极大的提高了人们的劳动效率，同时也促进了国外割草机器人的研究与发展。国外的科研机构对割草机器人展开的研究主要偏向割草机器人的智能控制技术，导航技术和路径规划等方向,而针对割草机器人的系统设计相对较少。美国专利US4919224采用了蓄电池供电,能在预定时间启动,具有避障，防盗及自动充电等功能,采用三根导线来进行导航,当遇到下雨

14、，湿地及电源不足等以外情况时,返回车库,该专利采用超声波来探测障碍,用震荡探测器及密码来防止非法用户操作机器。美国专利US5204814采用了优化的导航技术,综合利用存储的路径及环境信息，无磁无电流的金属导线和埋在地下的金属导线三种方式来指导割草机器人的移动,该专利还选用了内燃机做动力,配合发电机及电池组使用,采用分布式控制方式。其它类似的专利有美国专利US4679152，美国专利US4800978，美国专利US3800902及法国专利2631466,美国专利US4777785提供了一种导航新方法即沿未割及已割区域的边缘行走,从而完成导航任务。1.2.3国内的研究现状国内的研究机构对自动割草机

15、器人的研究起步相对较晚，但仍有一定的积累。南京理工大学机械电子工程专业的王华坤教授早在2000年就展开了智能割草机器人的研究，其研究生李杏春的硕士论文移动割草机器人总体方案和控制系统设计与研究对割草机器人的总体设计、路径规划、避障!定位系统、控制系统等从理论上进行了较全面的研究，进而提出了一种廉价实用的总体方案，为进一步深入研究割草机器人打下了基础；其研究生陈正江的硕士论文户外自主移动机器人体系结构与控制系统研制主要研究户外自主移动机器人的运动控制系统与体系结构，并设计制造了自主移动机器人样机MORO一I，实现了机器人的导航和自主行走控制；其博士生祖莉的博士论文智能割草机器人全区域覆盖运行的控

16、制和动力学特性研究将移动机器人的导航定位、智能控制、规划避障等方面的技术和理论运用到割草机器人平台上，进行了相关的实验，并讨论了割草机器人在户外移动机器人中的特殊性；江苏大学也对割草机器人做了一定的研究，研究生周宁的硕士论文割草机器人割台设计与运动控制研究就割草机器人的设计及运动控制等方面展开了一系列的研究工作，并根据中国草坪的特点完成了割台部分的设计，最后得到割草机器人割台的主要性能参数；研究生丁毅的硕士论文基于GPS和数字罗盘的割草机器人导航定位方法的研究提出了利用GPS和数字罗盘进行割草机器人导航的新思路。1.3割草机器人自动避障系统避障对于割草机器人自主导航，路径规划是不可缺少的,它是

17、割草机器人智能化的体现。割草机器人避障系统的好坏直接影响到割草机器人执行各项任务的能力。一个好的避障系统是完成割草机器人避障任务的前提。一般来说,一个完整的避障系统主要包括三个方面:避障探测系统，避障信息的处理和避障策略。避障探测系统是由各种传感器和控制器组成的探测障碍物信息的系统，整个避障探测系统是机器人感知外部环境信息的唯一途径,传感器的选择将成为割草机器人收集环境信息正确与否的关键。采用视觉系统避障可以获得较完整的环境信息,但图像处理运算量大,对设备的性能要求高,从而会使机器人在避障时实时性比较差。近年来,为了解决这个问题,人们开始研究采用非摄像类传感器探测环境信息，但单一的传感器由于受

18、其固有的缺陷等因素的影响,使其在探测环境信息时,不能够提供准确，全面的环境信息。因此,在实际应用中,采用多传感融合技术来实现对环境信息的探测,如何提高测量精度就成为了研究热点。通常应用于机器人距离探测的传感器有激光传感器，视觉传感器，红外传感器和超声波传感器等。红外传感器工作原理是采用发射固定波长红外线并接收同一回波的主动方式。其优点是探测角较小,方向性强,测量精度高,反应速度快,但其缺点是受环境影响较大,红外探测头稍微被灰尘污染,其测量精度就会大大下降,而且探测距离较近。超声波传感器对环境的适应能力强,在阴影，灰尘，烟雾，水汽等环境下,其性能指标不受任何影响,即使遇到工作环境异常恶劣的场合,

19、其性能指标所受的影响也微乎其微。而且超声波传感器相比于激光测距仪来说要便宜的多,不易损坏。超声波传感器具有成本低廉,信息，数据采集快,重量轻，体积小,易于安装等优点。综合考虑，用超声波传感器易于实现草坪上障碍物的探测。第二章 总体方案设计2.1主要研究内容本课题主要研究的是智能割草机器人的自动避障系统，自然就包括了障碍物的检测，检测信息的处理以及如何将这些数据反馈到执行机构上。障碍物的检测需要用到传感器，然而传感器的种类繁多，应用最为广泛的是超声波传感器和红外线传感器。超声波传感器和红外线传感器的优缺点已经在上述部分列出，所以本课题采用超声波传感器来测量与障碍物之间的距离。超声波测距一般采用时

20、间飞跃法（TOF）。首先测出超声波发出到碰到障碍物返回的时间，再乘以声速就得到2倍的障碍物距离。再利用单片机控制技术完成信号采集与控制，进而提出控制策略，通过执行机构实施达到障碍物的规避目的。图2.1割草机器人系统构成框图2.2 具体方案介绍本课题的重点也是难点是障碍物距离的检测，打算采用STC89C52型号的单片机作为控制核心，型号为HC-SR04的超声波模块以及1602的液晶屏来实现测距功能。该系统包括了超声波发射与接收模块，复位电路，液晶显示等。并且，在超声波传感器下安装一个S90舵机，利用舵机来控制超声波传感器左右转动，从而使超声波传感器测量出前方、左侧以及右侧三个方向的障碍物距离。然

21、后，在单片机中写入具体点编程，使整个系统能够运行。其中舵机的优点就能很好的呈现出来，当超声波传感器检测到障碍物时，若左右检测距离均小于20cm，则执行机构后退；若左侧小于右侧，则右转；反之，则左转。第三章 超声波测距3.1超声波测距设计思路3.1.1超声波测距原理通过超声波发射装置发出超声波，根据接收器接到超声波时的时间差就可以知道距离了。这与雷达测距原理相似。 超声波发射器向某一方向发射超声波，在发射时刻的同时开始计时，超声波在空气中传播，途中碰到障碍物就立即返回来，超声波接收器收到反射波就立即停止计时。（超声波在空气中的传播速度为340m/s，根据计时器记录的时间t，就可以计算出发射点距障

22、碍物的距离(s)，即：s=340t/2）。3.1.2超声波测距方法超声波指向性强，在介质中传播的距离较远，因而超声波经常用于距离的测量，如测距仪和物 位测量仪等都可以通过超声波来实现。利用超声波检测往往比较迅速、方便、计算简单、易于做到实时控制，并且在测量精度方面能达到工业实用的要求，因此在移 动机器人的研制上也得到了广泛的应用。一般测距采用时间飞跃法（TOF），即测出超声波发出到碰到障碍物返回的时间，再乘以声速就得到2倍的障碍物距离。本系统测距过程大致如下：单片机发出40khz的信号来驱使超声波传感器，当发射器将第一个超声波脉冲发射后，计数器开始计数，接收器检测到第一个回波后停止计数。利用接

23、收到的时间以及测距公式可以将距离显示在1602液晶屏上。3.1.3超声波模块的选择超声波模块选择了市面上运用广泛的HC-SR04型号的芯片。HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能，测距精度可达3mm;模块包括超声波发射器、接收器与控制电路。基本工作原理：（1）采用IO 口TRIG 触发测距，给至少10US 的高电平信号；（2）模块自动发送8 个40KHz 的方波，自动检测是否有信号返回；（3）有信号返回，通过IO 口ECH0 输出一个高电平，高电平持续的时间就是超声波从发射到返回的时间。测试距离=（高电平时间*声速(340M/S)）/2；3.1.4显示器的选

24、择 显示模块选择1602液晶显示屏，因为液晶显示器以其微功耗、体积小、显示内容丰富、超薄轻巧的诸多优点，在各类仪表和低功耗系统中得到广泛的应用。并且相比于数码管该模块有以下几个优点：（1） 位数多，可以显示32位，32个数码管而言体积很大。（2） 显示内容丰富，可显示所有数字和大小写字母。程序简单，如果用数码管动态显示，会占用很多时间来刷新，1602能自动完成刷新。第四章 超声波模块的硬件结构设计硬件电路的设计主要包括单片机系统，超声波发射部分，超声波接收部分以及显示部分。单片机芯片采用STC89C52系列或其兼容系列，因为其采用Flash存贮器技术，降低了制造成本，其软件、硬件与MCS-51

25、完全兼容，且采用高密度非易失存储器制造技术制造，将多功能8位CPU和闪烁存储器组合在单个芯片中，有利于操作。单片机P2.0管脚触发控制信号的输入，P2.1管脚控制回响信号的输出。显示部分采用1602液晶屏显示。4.1超声波模块电路设计超声波模块采用型号为HC-SR04型号产品。HC-SR04超声波测距模块2cm-400cm的非接触式测距感测功能，测距精度可达3mm。模块包括超声波发射器，接收器和控制电路。4.1.1 超声波模块的特点1.典型工作用电压：5V。2.超小静态工作电流：小于2mA。3.感应角度：不大于15度。4.探测距离：2cm-400cm5.高精度：可达0.3cm。6.盲区（2cm

26、）超近。7.完全谦容GH-311防盗模块。4.1.2 超声波模块的工作原理(1)采用IO口TRIG触发测距，给至少10us的高电平信号。(2)模块自动发送8个40khz的方波，自动检测是否有信号返回。(3)有信号返回，通过IO口ECHO输出一高电平，高电平持续的时间就是超声波从发射到返回的时间测试距离=(高电平时间*声速(340M/S)/2。 即控制口发一个10US以上的高电平，就可以在接收口等待高电平输出。 一有输出就可以开定时器计时，当此口变为低电平时就可以读定时器的 值，此为次测距的时间，方可算出距离。如此不断的周期测，就可以达 到你移动测量的值。4.1.3模块参数图4.1 HC-SR0

27、4外观图4.1.4超声波时序图图4.14超声波时序图上面的时序图表示只要你提供一个10us以上的脉冲触发信号，模块内部就会循环发出8个40KHz的脉冲，打开计时器，当检测到回波信号是打开输出回响信号，回响电平输出与检测距离成正比，通过该间隔时间可计算出距离。4.1.5超声波发送与接收图4.15超声波模块信号发射与接收4.2 STC89C52单片机功能及特点STC89C52是STC公司生产的一种低功耗、高性能CMOS8位微控制器，具有 8K 在系统可编程Flash存储器。STC89C52使用经典的MCS-51内核，但做了很多的改进使得芯片具有传统51单片机不具备的功能。在单芯片上，拥有灵巧的8

28、位CPU 和在系统可编程Flash，使得STC89C52为众多嵌入式控制应用系统提供高灵活、超有效的解决方案。 具有以下标准功能： 8k字节Flash，512字节RAM， 32 位I/O 口线，看门狗定时器，内置4KB EEPROM，MAX810复位电路，3个16 位定时器/计数器，4个外部中断，一个7向量4级中断结构（兼容传统51的5向量2级中断结构），全双工串行口。另外 STC89C52可降至0Hz 静态逻辑操作，支持2种软件可选择节电模式。空闲模式下，CPU 停止工作，允许RAM、定时器/计数器、串口、中断继续工作。掉电保护方式下，RAM内容被保存，振荡器被冻结，单片机一切工作停止，直到

29、下一个中断或硬件复位为止。最高运作频率35MHz，6T/12T可选。4.2.1 STC89C52单片机参数1.增强型8051单片机，6 时钟/机器周期和12 时钟/机器周期可以任意 选择指令代码完全兼容传统8051。2.工作电压：5.5V3.3V（5V单片机）/3.8V2.0V（3V 单片机）。3.工作频率范围：040MHz，相当于普通8051的080MHz，实际工作频率可达48MHz。4.用户应用程序空间为8K字节。5.片上集成512 字节RAM。6.通用I/O 口（32 个），复位后为：P0/P1/P2/P3 是准双向口/弱上拉， P0 口是漏极开路输出，作为总线扩展用时，不用加上拉电阻，

30、作为 I/O 口用时，需加上拉电阻。7.ISP（在系统可编程）/IAP（在应用可编程），无需专用编程器，无需专用仿真器，可通过串口（RxD/P3.0,TxD/P3.1）直接下载用户程序，数秒即可完成一片。8.具有EEPROM 功能。9.共3 个16 位定时器/计数器。即定时器T0、T1、T2。10.外部中断4 路，下降沿中断或低电平触发电路，Power Down 模式可 由外部中断低电平触发中断方式唤醒。11.通用异步串行口（UART），还可用定时器软件实现多个UART。12.工作温度范围：-40+85（工业级）/075（商业级）。13.PDIP封装。4.2.2 STC89C52单片机特性1.

31、8K字节程序存储空间；2.512字节数据存储空间；3.内带2K字节EEPROM存储空间;4.可直接使用串口下载；STC89C52具体介绍如下： 主电源引脚（2根）VCC(Pin40)：电源输入，接5V电源GND(Pin20)：接地线 外接晶振引脚（2根）XTAL1(Pin19)：片内振荡电路的输入端XTAL2(Pin20)：片内振荡电路的输出端控制引脚（4根）RST/VPP(Pin9)：复位引脚，引脚上出现2个机器周期的高电平将使单片机复位。ALE/PROG(Pin30)：地址锁存允许信号PSEN(Pin29)：外部存储器读选通信号EA/VPP(Pin31)：程序存储器的内外部选通，接低电平从

32、外部程序存储器读指令，如果接高电平则从内部程序存储器读指令。可编程输入/输出引脚（32根）STC89C52单片机有4组8位的可编程I/O口，分别位P0、P1、P2、P3口，每个口有8位（8根引脚），共32根。PO口（Pin39Pin32）：8位双向I/O口线，名称为P0.0P0.7P1口（Pin1Pin8）：8位准双向I/O口线，名称为P1.0P1.7P2口（Pin21Pin28）：8位准双向I/O口线，名称为P2.0P2.7P3口（Pin10Pin17）：8位准双向I/O口线，名称为P3.0P3.7单片机引脚分配示意：P00-P07 4位数码管的段码数据线，共阳数码管LCD数据并行总线P10

33、-P1 数码管位控制（共阳）P10-P13 LCD功能控制引脚P14 继电器 控制引脚P15 蜂鸣器 控制引脚P15、P16、P17 ISP下载器接口P20-P27 8路LED发光二极管，共阳接法P30 串行通信 RXD 通过短接帽连接P31 串行通信 TXD通过短接帽连接P32 温感接口数据引脚P33 红外接口数据引脚P32-P37 6键独立键盘与中断按钮图4.2 STC89C52单片机4.3显示电路设计液晶显示器以其微功耗、体积小、显示内容丰富、超薄轻巧的诸多优点，在各类仪表和低功耗系统中得到广泛的应用。根据显示内容可以分为字符型液晶，图形液晶。根据显示容量又可以分为单行16字，2行16字

34、，两行20字等等。鉴于本过程只需显示实时距离，显示单元部分采用1602液晶显示屏。用于将超声波模块接收到的数据通过单片机中的程序运算将与障碍物的具体距离显示出来。4.3.1 1602液晶屏的优点1.位数多，可以显示32位，32个数码管而言体积很大。2.显示内容丰富，可显示所有数字和大小写字母。3.程序简单，如果用数码管动态显示，会占用很多时间来刷新，1602能自新。4.3.2 1602管脚定义字符型LCD1602通常有14条引脚线或16条引脚线的LCD，多出来的2条线是背光电源线VCC(15脚)和地线GND(16脚)，其控制原理与14脚的LCD完全一样，但是编程用到的主要管脚不过三个，分别为：

35、RS(数据命令选择端),R/W（读写选择端）,E（使能信号）。以后编程便主要围绕这三个管脚展开进行初始化，写命令，写数据。以下具体阐述这三个管脚：RS为寄存器选择，高电平选择数据寄存器，低电平选择指令寄存器。R/W为读写选择，高电平进行读操作，低电平进行写操作。E端为使能端，后面和时序联系在一起。除此外，D0D7分别为8位双向数据线。详细来讲，第1脚：VSS为地电源第2脚：VDD接5V正电源第3脚：V0为液晶显示器对比度调整端，接正电源时对比度最弱，接地电源对比度最高，对比度过高时会产生“鬼影”，使用时可以通过一个10K的电位器调整对比度（建议接地，弄不好有的模块会不显示）第4脚：RS为寄存器

36、选择，高电平时选择数据寄存器、低电平时选择指令寄存器。第5脚：RW为读写信号线，高电平时进行读操作，低电平时进行写操作。第6脚：E端为使能端，当E端由高电平跳变成低电平时，液晶模块执行命令。第714脚：D0D7为8位双向数据线。第1516脚：空脚（有的用来接背光）。4.3.3 1602操作时序RSR/W操作说明00写入指令码D0D701读取输出的D0D7状态字10写入数据D0D711从D0D7读取数据注：关于E=H脉冲开始时初始化E为0，然后置E为1，再清0。读取状态字时，注意D7位，D7=1，禁止读写操作；D7=0，允许读写操作；所以对控制器每次进行读写操作前，必须进行读写检测。图4.3 1

37、602电路引脚接线第五章 超声波测距模块软件设计超声波测距的软件设计主要是对硬件部分得到的数据进行处理和应用，大致包括主程序，超声波启动程序，超声波中断计时程序以及显示程序。编程时选择C语言编程，因为C语言是一种编译型程序设计语言，它兼顾了多种高级语言的特点，并具备汇编语言的功能。C语言有功能丰富的库函数、运算速度快、编译效率高、有良好的可移植性，而且可以直接实现对系统硬件的控制。5.1超声波测距算法设计控制口发一个10US以上的高电平，就可以在接收口等待高电平输出。一有输出就可以开定时器计时，当此口变为低电平时就可以读定时器的值，此为次测距的时间，方可算出距离。如此不断的周期测，就可以达到你

38、移动测量的值。公式为：d=Ct/2d表示被测物体与传感器的直线距离，单位是m 。t表示发射信号和接受间隔时间，C为声波在空气中的传播速度,单位是m/s，t为声波发射信号和回声的时间间隔,单位s。5.2主程序流程5.2.1系统初始化程序void LCDInit(void) LCD_Data = 0; WriteCommandLCD(0x38,0); /三次模式设置，不检测忙信号 WriteCommandLCD(0x38,1); /显示模式设置,开始要求每次检测忙信号 WriteCommandLCD(0x08,1); /关闭显示 WriteCommandLCD(0x01,1); /显示清屏 Wri

39、teCommandLCD(0x06,1); /显示光标移动设置 WriteCommandLCD(0x0C,1);5.2.2超声波启动程序void StartModule() /启动模块 unsigned char nop; TX=1; /启动一次模块 for(nop=0;nop21;nop+) _nop_(); TX=0;TX端为1，给Trig引脚上10us的脉冲信号，程序执行空语句延时，完成超声波的发射。5.2.3超声波计时程序while(1) StartModule(); while(!RX);/当RX为零时等待 TR0=1; /开启计数 while(RX);/当RX为1计数并等待 TR0

40、=0;/关闭计数 Conut();/计算 for (i=0;i10;i+)Delay5Ms(); /延时50MS当RX=0是while语句空循环，即原地等待。TR0口为1时，计数器开始工作。Count为计数函数。5.2.4测距程序void Conut(void) time=TH0*256+TL0;/转为16进制 TH0=0; TL0=0; S=(time*1.7)/100;/值为cm单片机初始化设置T0工作方式超声波发射测试距离显示距离结束开始图5.1系统程序流程图5.3实验结果实验所用到的道具：STC89C52单片机，HCSR04型号的超声波传感器，LCD1602显示器，障碍物，尺子。将单片

41、机、传感器以及显示器连接好后，打开单片机电源开关，利用障碍物和尺子得到实验的显示距离和实际距离。超声波测距数据：（单位/cm）实际距离2468101214161820测试距离2468101214161820误差0000000000实际距离22242628303234363840测试距离22242628293133353739误差0000111111图5.3.1超声波测距图图5.3.2实验实物图第六章 实验用执行机构硬件设计由于条件限制，我们将采用型号为ZK-4WD的小车底盘作为割草机器人的执行机构。ZK-4WD小车底盘的主要组成部分分别为：小车底盘、驱动模块、控制器（即STC89C52单片机）

42、、小车所需的能源、超声波传感器、SG90舵机和红外遥控传感器等。通过实验，很好的向我们呈现了智能割草机器人自动避障的样子。6.1执行机构底盘小车底盘是机器人最重要的载体，相当于人体的躯干，ZK-4WD小车平台采用差速转弯非常灵活可以实现原地打转。小车平台大小刚好，可以承载一些如驱动器、控制器、电池、传感器等。图6.1执行机构底盘6.2执行机构驱动模块6.2.1 L298N驱动模块说明 L298N 驱动模块，采用 ST 公司原装全新的 L298N 芯片，采用SMT工艺稳定性高，采用高质量铝电解电容，使电路稳定工作。可以直接驱动两路 3-16V 直流电机，并提供了 5V 输出接口（输入最低只要6V

43、），可以给5V单片机电路系统供电 （低纹波系数）,支持3.3V MCU ARM 控制，可以方便的控制直流电机速度和方向，也可以控制2 相步进电机，5 线4相步进电机。是智能小车必备利器。6.2.2 L298N参数1.驱动芯片：L298N双H 桥直流电机驱动芯片 2.驱动部分端子供电范围Vs：5V12V ； 如需要板内取电，则供电范围Vs：+6V+12V 3.驱动部分峰值电流Io：2A 4.逻辑部分端子供电范围Vss：5V7V（可板内取电5V） 5.逻辑部分工作电流范围:036mA 6.控制信号输入电压范围（IN1 IN2 IN3 IN4）： 低电平：0.3VVin1.5V 高电平：2.3VVi

44、nVss 7.使能信号输入电压范围（ENA ENB）： 低电平：0.3Vin1.5V（控制信号无效） 高电平：2.3VVinVss（控制信号有效） 8.最大功耗：20W（温度T75时） 9.存储温度：25130 10.驱动板尺寸:55mm*45mm*33mm(带固定铜柱和散热片高度) 11.其他扩展：控制方向指示灯、逻辑部分板内取电接口。 图6.2 L298驱动模块原理图6.3 SG90舵机6.3.1什么是舵机 在机器人机电控制系统中，舵机控制效果是性能的重要影响因素。舵机可以在微机电系统和航模中作为基本的输出执行机构，其简单的控制和输出使得单片机系统非常容易与之接口。 舵机是一种位置（角度）伺服的驱动器，适用于那些需要角度不断变化并可以保持的控制系统。目前在高档遥控玩具，如航模，包括飞机模型，潜艇模型；遥控机器人中已经使用得比较普遍。舵机是一种俗称，其实是一种伺服马达。图6.3舵机实物图6.3.2舵机工作原理控制信号由接收机