轮式移动机器人课程设计2.docx

1、轮式移动机器人课程设计2摘 要 移动机器人是机器人家族中的一个重要的分支，也是进一步扩展机器人应用领域的重要研究发展方向。自上世纪九十年代以来，人们广泛开展了对机器人移动功能的研制和开发，为适应各种工作环境的不同要求而开发出各种移动机构。论文容包括四个部分：简要介绍了移动机器人研究现状、对所设计移动机器人系统进行了描述、视觉导航轮式移动机器人底层硬件设计和视觉轮式移动移动机器人的底层控制。论文详细地介绍了移动机器人底层硬件系统元件的选型和原理电路图的设计。我们选用PIC16F877单片机作为下位机接收上位机传来的命令和产生驱动信号。步进电机的驱动电路采用两个步进电机驱动器-L298，驱动程序写

2、入PIC16F877单片机，通过程序控制步进电机的转速和转向。采用Propel设计了底层控制系统的原理图和PCB版图，采用Proteus进行程序和硬件系统的仿真。仿真结果表明：步进电机运行稳定、可靠性高，实现了对步进电机的预期控制。关键词：移动机器人；运动控制；PIC16F877；步进电机1.移动机器人技术发展概况1.1 机器人研究意义及应用领域1.1.1 机器人的研究意义 人们对于未知的探索总是充满危险，而且人类的研究活动领域已由陆地扩展到海底和空间，所以机器人的产生解决人类这一大难题。利用移动机器人进行空间探测和开发，己成为21世纪世界各主要科技发达国家开发空间资源的主要手段之一。研究和发

3、展月球探测移动机器人技术，对包括移动机器人在的相关前沿技术的研究将产生巨大的推动作用。 移动机器人是一种能够通过传感器感知外界环境和自身状态，实现在有障碍物的环境中面向目标的自主运动，从而完成一定作业功能的机器人系统。本课题选用轮式作为机器人平台设计研究1，两轮式机器人在国外还处于刚刚起步阶段，其前景广阔，适用性较广，在教学、科研、野外作业、民用运输方面有着广泛的应用前景，在反恐及其它尖端领域具有重大的应用价值。已经初步做出了简单的实验模型，解决了轮式机器人的传动机构难题。该轮式机器人运动响应迅速，具有高机动的零半径转向能力，并且在运动过程中不存在失稳状态。摄像头的密封式结构可以将部器件密封保

4、护起来，免受外界环境的影响，非常适合在潮湿、多尘土、多辐射或有毒的环境中执行任务。1.1.2 机器人的应用领域从最早出现的机器人到现在涌现出的形态各异的移动小车，其移动机构的形式层出不穷，以美国、俄罗斯、法国和日本为首的西方发达国家己经研制出了多种复杂奇特的三维移动机构，有的已经进入了实用化和商业化阶段。面对21世纪深空探测的挑战，对各种自主系统的研制是必须的，而移动机构又是各种自主系统的最基本和最关键的环节。这些应用围包括工业生产、海空探索、康复和军事等。此外，机器人已逐渐在医院、家庭和一些服务行业获得应用。根据其功能可分为以下几个功能： 工业机器人、探索机器人、服务机器人、军事机器人 。制

5、造工业部门应用机器人的主要目的在于削减人员编制和提高产品质量。与传统的机器相比，它具有两个主要优点： 1生产过程的几乎完全自动化；2生产设备的高度适应能力。现在工业机器人主要用于汽车工业、机电工业（包括电讯工业）、通用机械工业、建筑业、金属加工、铸造以及其它重型工业和轻工业部门。在农业方面，已把机器人用于水果和蔬菜嫁接、收获、检验与分类，剪羊毛和挤牛奶等。这是一个潜在的产业机器人应用领域。机器人除了在工农业上广泛应用之外，还用于进行探索，即在恶劣或不适于人类工作的环境中执行任务。研制其用来为病人看病、护理病人和协助病残人员康复的机器人能够极大地改善伤残疾病人员的状态2，以及改善瘫痪者（包括下肢

6、及四肢瘫痪者）和被截肢者的生活条件。地面军用机器人分为两类：一类是智能机器人，包括自主和半自主车辆；另一类是遥控机器人，即各种用途的遥控无人驾驶车辆。美国海军有一个独立的水下机器人分队，这支由精锐人员和水下机器人组成的分队，可以在全世界海域进行搜索、定位、援救和回收工作。水下机器人在美国海军中的另一个主要用途是扫雷，如MINS水下机器人系统，它可以用来发现、分类、排除水下残物及系留的水雷。1.2 移动机器人的发展概况1.2.1 移动机器人的国发展概况机器人在我国已被广泛地用于生产和生活的许多领域,按其拥有智能的水平可以分为三个层次。一是工业机器人,它只能死板地按照人给它规定的程序工作,不管外界

7、条件有何变化,自己都不能对程序也就是对所做的工作作相应的调整.如果要改变机器人所做的工作,必须由人对程序作相应的改变,因此它是毫无智能的.二是初级智能机器人.它和工业机器人不一样,具有象人那样的感受,识别,推理和判断能力.可以根据外界条件的变化,在一定围自行修改程序,也就是它能适应外界条件变化对自己怎样作相应调整.不过,修改程序的原则由人预先给以规定.这种初级智能机器人已拥有一定的智能,虽然还没有自动规划能力,但这种初级智能机器人也开始走向成熟,达到实用水平.三是高级智能机器人.它和初级智能机器人一样,具有感觉,识别,推理和判断能力,同样可以根据外界条件的变化,在一定围自行修改程序.所不同的是

8、,修改程序的原则不是由人规定的,面是机器人自己通过学习,总结经验来获得修改程序的原则.所以它的智能高出初能智能机器人.这种机器人已拥有一定的自动规划能力,能够自己安排自己的工作.这种机器人可以不要人的照料,完全独立的工作,故称为高级自律机器人.这种机器人也开始走向实用.1.2.2 移动机器人的国外发展概况轮式移动机构具有运动速度快、能量利用率高、结构简单、控制方便和能借鉴至今已很成熟的汽车技术等优点，只是越野性能不太强。但随着各种各样的车轮底盘的出现，如日本NASDA的六轮柔性底盘月球漫游车LRTV，俄罗斯TRANSMASH的六轮三体柔性框架移动机器人Marsokohod，美国CMU的六轮三体

9、柔性机器人Robby系列以及美国JPL的六轮摇臂悬吊式行星漫游车Rocky系列，已使轮式机器人越野能力大大增加，可以和腿式机器人相媲美。于是人们对机器人机构研究的重心也随之转移到轮式机构上来，特别是最近日本开发出一种结构独特的五点支撑悬吊结构Micros，其卓越的越野能力较腿式机器人有过之而不及。轮式结构按轮的数量分可分为二轮机构、三轮机构、四轮机构、六轮以及多轮机构。二轮移动机构的结构非常简单，但是在静止和低速时非常不稳定。三轮机构的特点是机构组成容易，旋转中心是在连接两驱动轮的直线上，可以实现零回转半径。四轮机构的运动特性基本上与三轮机构相同，由于增加了一个支撑轮，运动更加平稳。以上几种轮

10、式移动机构的共同特点是它们所有的轮子在行驶过程中，只能固定在一个平面上，不能作上下调整，因此，地面适用能力差。一般的六轮机构主要就是为了提高移动机器人的地面适应能力而在其结构上作了改进，增加了摇臂结构，使得机器人在行驶过程中，其轮子可以根据地形高低作上下调整，从而提高了移动机器人的越野能力。 欧盟在20002004年启动的信息社会技术计划中开展了探测火山环境的机器人、用来评估地振危险性的爬行机器人(ROBOSENSE)、借助机器人的交互式博物馆临场感(TOURBOT)等项目研究。在火山爆发的发作阶段观测和测量火山活动的相关变量最有意义，但对研究人员也是最危险的时刻。在1993年的一次火山口考察

11、中，8名火山研究人员遇难。ROBOVOLC将开发和测试一个自动化机器人系统，在火山环境下进行探测与测量，可以帮助科学家远离危险环境进行分析研究。ROBOSENSE将开发一台能够携带探伤仪器的移动机器人，对地振造成的建筑物结构性损害进行检测。TOURBOT的目标是发一个交互式导游机器人，通过因特网实现个性化的临场感，同时TOURBOT能够在现场引导参观游客。此外欧盟还开展了移动机器人应用于人道主义排雷等研究。法国国家科学研究中心)于2001年中期，提出了一项有关机器人技术的大型国家计划，称作“机器人与人工体”。这项跨学科的计划涵盖了机器人学中信息科学与技术方面的主要研究领域。Robe计划对“感知

12、器执行器”与认知功能进行跨学科的研究。实现这些功能在智能系统的集成，能够在开放的、变化的环境中自主完成各种任务，实现智能机器人与人交互、通过学习改进其行为的功能。具体开展了移动式操作手，移动机器人视觉定位，行星机器人1以及多移动机器人协作等研究。前苏联曾经在移动机器人技术方面居于世界领先的地位，Lunokhod-1是最早登上月球的遥控式移动机器人。俄罗斯作为前苏联的继承者，在机器人技术领域依然具有当雄厚的技术基础，ROVER科技有限公(Rover Science & Technology Joint-stock Company Ltd., RCL)把在开发空间机器人中获得的经验应用于开发地面机

13、器人系统，如极坐标平面移动车、爬行移动机器人、球形机器人、工作伙伴平台以及ROSA-2移动车等。日本经济产业省(Ministry of Economy, Trade and Industry, M ETI)1998年开始启动了人形机器人技术研究计划(HRP)。在这一年，日本本田(Honda)公司展出了人形移动机器人的一个主要目标就是开发一个开放体系结构的人形机器人平台(简称Open HRP)，用来探索人形机器人的各种应用.METI从2002年又启动了一项国家项目一一“21世纪机器人挑战”,其中一个三年的子项目是开发应用于机器人开放式结构的中间件)。中间件能够对市场上销售的各种机器人零件实现标准

14、化，并且能够更加容易地对这些零件进行系统集成。更长远的预期在于到2009年，实现机器人商品化(Commercialize),将机器人的应用领域扩展到家庭(Home)，医疗服务(Medical care)、灾害救助(Disaster relief)。日本科技署(Japan Science and Technology Agency, JST)于2002年10月启动了一项5年期限的项目，用于开发人道主义排雷的机器人技术，日本产业界已开发出能实际应用的排雷机器人，并送往柬埔寨进行现场试验。此外，日本也一直进行着有关月球探测的研究，计划于2015-2020年在月球上建立一个小型基地，与该计划相应的行星

15、漫游车研究也很活跃。 韩国科学技术部(Ministry of Science and Technology，MOST)于1999年启动的“21世纪尖端研究发展计划”(21Century Frontier R&D Program)，包括了服务机器人、恶劣环境中的机器人、微型机器人以及排雷机器人项目韩国信息与通讯部(Ministry of Information and Communication , MIC)发布了旨在促进IT增长的9个优先发展领域(Top 9 IT Growth Sectors)，其中智能化的服务机器人被列为首位。美国在行星移动机器人以及军用移动机器人的研究与应用方面投入了大量

16、资金与科研力量。如:美国NASA支持的火星探测计划、美国国防部支持的无人战车研究计划UGV(Unmanned Ground Vehicle)美国能源部的核废料等危险品搜集、搬运自主车研究计划等项目，吸收JPL, MIT AI Lab. CMU Robotics Institute、Georgia Tech Mobile Robot Lab, Naval Warfare Systems Center of San Diego以Stanford Robotics Institute等许多知名大学与研究所的科研人员参与。最近的突出成果是2003年发射的火星漫游机器人“勇气”号与“机遇”号，它们的顶部

17、装有全景照相机及具有红外探测能力的微型热辐射分光计，携带多种分析仪器对火星岩石纹理及其成分进行探测。2.轮式移动机器人的结构设计 现在主流的移动方式基本是轮式，腿式，和履带式，但由于其各有各的优点与缺点，现在的科学家越来越追求综合性能的提高。轮式移动机构具有运动速度快、能量利用率高、结构简单、控制方便和能借鉴至今已很成熟的汽车技术等优点。 2.1移动机器人的系统结构整体车身结构是本小型轮式智能移动机器人所采用得。车身通过轴与前后四个车轮连接，使车身及承载物的重量能被四个车轮平均承受，再平均分配给每个车轮，从而使各车轮的受力均衡，提高整个车辆的承载能力。机器人的主要运动结构为前后四个车轮及其相关

18、机构。前车轮为万向轮，后车轮连接电机，可以分别实现转向和滚动。四个车轮的接地点呈矩形分布，使车身具有一定的稳定性。各个车轮各自通过一根轴跟车身相连，通过简单的机构传动，可以使车实现协调的运动。在车体上设有中央控制单元，实现对电机的运行控制。控制模式考虑采用自主导航和远距离控制相结合的模式。车上设有传感系统、导航系统、控制系统，机器人本身具有一定自主导航能力，可以实现自动避障。机器人自带蓄电池等能源设备，可以在一定时间段实现能源的自动供给，保证机器人在失去外部电源的情况下能自动返回出发地。图2-1 系统结构原理图2.2 轮式移动机器人主要结构车轮：一般来说，机器人越重，要求车轮的结构越坚固。 小

19、于2磅的轻型机器人，可以使用软性泡沫塑料车轮。 由于机器人的重量轻，软性材料的变形还不至于太严重，而且 能在摩擦力很小时工作良好。超过 2磅机器人，需要选用 质地更为坚硬的材料做车轮，不充气的中空橡胶轮胎能够在 610磅下工作。超过 l0磅，就要考虑实心橡胶轮胎或者充 气轮胎。而类似割草机的车轮，不管是实心的还是充气的，在 机器人的重量接近 40磅的场合都可以成为选择的方案。机器人超过40磅时，可以考虑试用诸如小型机车轮、手推车轮，或者其他相似的高效率的充气轮胎。按照车辆理论的分析，车轮的直径增大可以明显提高机器人的越障能力。但是，车轮直径变大的同时，车轮表面所受的电机转矩却会下降。根据车辆地

20、面力学理论，刚性车轮的宽度越宽，车轮的土壤沉陷量越小，土壤的压实阻力也就越小。不过，车轮变宽后，机器人的转向阻力也会变大。另外，增加车轮的直径比增加车轮宽度对减小压实阻力更为有效。因此，必须根据实际情况设定车轮直径和宽度，不能盲目加大车轮直径和宽度。如图2-2所示。 图2-2 车轮示意 2、摄像头：摄像头对于基于视觉导航的机器人来说是至关重要的。它要根据系统要求准确地分辨目标物（调色板），尽量降低误判，漏判的机率，并有一定的抗干扰能力。能对目标物定位，为机器人的运动控制提供参照物、障碍物的位置信息，并能满足精度要求。满足系统实时性的要求。机器人摄像机每秒钟要从比赛场地上摄取30帧图像数据，如果

21、视觉子系统达不到实时的要求，则系统所处理的前后两帧图像数据差异太大，不仅影响识别跟踪的顺利完成，而且也使动作表现为反应迟钝，所以视觉子系统的实时性越好，则系统反应越快。如图2-3所示。 图2-3机器人摄像头 3、万向轮：万向轮能够在许多不同的方向移动，左右车轮的小光盘将全力推出，但也将极大的方便横向滑动。这是一个建立完整的驱动器的方法。全轮可以像一个正常的车轮或使用滚轮的辊侧向滚动。其胶辊提供了极大的扣人心弦。它适用於在使用机器人，手推车，转移输送机，货运车，行。全方位车轮将提供完善的性能，当集成与传统的车轮。例如，您可以使用两种传统的车轮中心车轴和四个全方位前轴和后轴车轮，以建立一个六轮车辆

22、。全方位轮移动和旋转，这是很容易的方向控制和跟踪，并尽可能快地转动。全方位轮无需润滑或现场维护和安装选项是非常简单和稳定。全方位轮通常可以大致可以分为2种类型：一类是单盘的全方位轮，一个是双排的全方位轮。单盘全方位轮的被动辊的单盘，而双板的全方位轮被动辊有两个板块是相互尊重，旋转稍。相比单盘的全方位轮，双板的全方位轮滚筒之间没有死区的优势。如图2-4所示。 图2-4 万向轮 3.轮式移动机器人的控制系统移动机器人的运动控制系统是机器人系统的执行机构，对系统精确地完成各项任务起着重要作用，有时也可作为一个简单的控制器。构成机器人运动控制系统的要素有:计算机硬件系统及控制软件、输入/输出设备、驱动

23、器、传感器系统。3.1 控制系统硬件选型与配置3.1.1 驱动电机的选型步进电机是数字控制电机，它将脉冲信号转变成角位移，即给一个脉冲信号，步进电机就转动一个角度，因此非常适合于单片机控制。步进电机可分为反应式步进电机（简称VR）、永磁式步进电机（简称PM）和混合式步进电机（简称HB）。步进电机区别于其他控制电机的最大特点是，它是通过输入脉冲信号来进行控制的，即电机的总转动角度由输入脉冲数决定，而电机的转速由脉冲信号频率决定。步进电机的驱动电路根据控制信号工作，控制信号由单片机产生。其基本原理作用如下： (1)控制换相顺序 通电换相这一过程称为脉冲分配。例如：三相步进电机的三拍工作方式，其各相

24、通电顺序为A-B-CD,通电控制脉冲必须严格按照这一顺序分别控制A,B,C，D相的通断。 (2)控制步进电机的转向 如果给定工作方式正序换相通电，步进电机正转，如果按反序通电换相，则电机就反转。 (3)控制步进电机的速度如果给步进电机发一个控制脉冲，它就转一步，再发一个脉冲，它会再转一步。两个脉冲的间隔越短，步进电机就转得越快。调整单片机发出的脉冲频率，就可以对步进电机进行调速。步进电机是依靠有序的步进脉冲运动的，利用单片机控制步进电机运动是非常适合的。整个系统包含PIC16F877，步进电机驱动器L298和步进电机。本设计是单片机控制两台步进电机。PIC16f877单片机的作用是接受命令，完

25、成相应的功能，并作为脉冲逻辑分配器，输出步进电机所需要的时序脉冲。步进电机可以向任意方向旋转和停止，实现了所谓“位置控制”的动作。每个输入脉冲决定了步进电机转动的角度。步进电机只是根据输入脉冲数旋转和停止，适合于位置控制，把运动所必需的脉冲数，以动作所需要的速度输入给电机，就能够正确的控制位置而运动。步进电机的运行要有一个电子装置进行控制，这个装置就是步进电机驱动器，它是将控制系统发出的脉冲信号放大以驱动步进电机。步进电机的转速与脉冲信号的频率成正比，控制脉冲信号的频率可以对电机精确调整；控制脉冲数可以对电机精确定位。选择步进电机为移动机器人驱动电机。上层系统计算移动机器人的角度和距离等信息传

26、给下层系统，通过分析得到机器人的运动状态，计算等到轮子的步数等。完成软件的编写，实现了对步进电机的预期控移动机器人的两个重要部分（视觉处理和运动控制）。3.1.2 伺服电机的选型所有的主控制功能是微处理器，驱动为DA模拟转换器，以产生一个模拟扭矩需求信号。从这个角度上，这台机器非常很像一个模拟伺服放大器。反馈的信息是来自隶属该电机轴的一个编码器。编码器生成脉冲流可确定传输路程，并通过计算脉冲频率，是可以测定转速的。 数码驱动通过求解一系列的方程式，履行同样类似的功能。微处理器是与数学模型（或“算法）的等效的编程模拟系统。这模型预测系统的行为。它响应一个给定输入的信号并产生速度。它同样也考虑到额

27、外信息如输出速度，速率转变中的投入和各种调校设定。解决所有方程需数额需有限的时间，即使是一个快速的处理器一次处理通常也是100ms和2ms之间。在此之间，在改变输入或输出，先前的计算值将有没有回应时，扭矩要求必须保持恒定。因此更新时间成为数字伺服和一台高性能系统关键的因素，它必须保持及时更新4。调试数字伺服电机可按钮或从一个计算机或终端调试。电位器调整是涉及的。调试数据是设置在伺服算法的各种系数，因此，它决定了系统的性能。即使如果调谐进行使用按钮，终值也可以上传到终端，让其进行简单的重复。在某些应用中，因负载惯量各异，例如一个机器手臂卸载后又带有沉重的负荷。改变惯性可能是一个系数为20或以上，

28、而这样的变化需要该驱动器重新调整，以保持其稳定。这只不过是在操作系统的适当点通过发送新的调试参数来实现的。3.1.3 轮毂电机的选型图3-2为轮子的示意图，设移动机器人与跟踪物体的原始距离为，上层系统传送移动机器人与跟踪物体的距离为，则移动机器人运动的距离为L=-。设计选用步进角为1.8的步进电机。轮子转动的角度为：（3-1）步进电机的步数位： （3-2）当=时，机器人不运动，步进电机没有转动。图3-3为移动机器人直线运动示意图，当移动机器人的上层传达一个角度为a=0时，在直角坐标系上，没有往X轴上有分量，移动机器人则直线运动。当L0时，移动机器人前进。当L0”的命令时，则移动机器人从X1-Y

29、1坐标系运动到X2-Y2坐标系。 移动机器人先完成转弯在进行前进。在转弯时，从图可知左轮为正转，右轮为反转。轮子移动的距离为：S=ar（3-4）则轮子移动的角度为：（3-5）则驱动步进电机的脉冲数为：（3-6）转弯完成后，移动机器人为直线运动。左轮为正转，右轮为正转。公式参考4-3.移动机器人前进左转和后退转弯时，我们可以参照前进右转时计算。对本类移动机器人的控制就是通过控制算法求出轮子的步速，通过改变单片机输出的脉冲波，完成对移动机器人的底层控制。3.2 轮式移动机器人控制系统框架控制系统总体设计方案：(1)微处理器模块:是控制系统的核心，包括微控制器及其相关外围电路主要进行各种信息、数据的

30、处理，协调系统中各功能模块完成预定的任务；(2)驱动模块:控制机器人系统中的舵机和传感器模块预定的任务;实现舵机速度和位置的控制，完成前进、后退、直行、转弯、避障、抓取等动作；(3)传感器模块:有速度、位置、距离、声音等传感器，主要负责移动机器人移动过程中的障碍物、声音等检测;(4)电源模块:负责整个移动机器人的电源供给，使系统能离线运动，主要由12V蓄电池及相关调压稳压电路组成；(5)串口通信模块:根据RS232通信标准与上位机进行串口通信;(6)JTAG调试:可以实现在线编程、调试仿真。图3-5运动控制系统流程图4.结论和总结经过我阅读一些关于移动机器人的文献资料，设计出了一种轮式移动机器

31、人。移动机器人技术是当今科学研究领域的前沿，在这方面的研究工作，也正随着移动机器人越来越多地走进人类的世界，而更加受到了国外科学家和研究学者们的关心和热爱。研究与开发集环境感知、动态决策与规划、行为控制与执行等多种功能于一体的移动机器人的综合控制系统，势在必行。本文针对基于多传感器的轮式移动机器人行为控制技术，对移动机器人硬件和软件体系结构、机器人结构设计、运动控制零部件等方面展开了深入的研究和探讨，提出了一个运动控制的方案，并应用于移动机器人行为控制系统。 本论文学习了一个轮式移动机器人的一些基本结构以及轮式移动机器人的一些用途。本论文完成的主要工作包括以下几个方面: 1、简要的介绍了移动机器人的历史和在国外的现状。从总体上介绍了视觉导航； 2、选择步进电机为移动机器人驱动电机。上层系统计算移动机器人的角度和距离等信息传给下层系统，通过分析得到机器人的运动状态，计算等到轮子的步数等。完成软件的编写，实现了对步进电机的预期控移动机器人的两个重要部分（视觉处理和运动控制）。3、选择电路元件单片机PIC16F877、步进电机驱动器L298、稳压电源LM7805。完成了底层控制原理图的设计。设计应用了propel99SE软件制作