[工学]慧鱼机器人毕业论文.doc

《[工学]慧鱼机器人毕业论文.doc》由会员分享，可在线阅读，更多相关《[工学]慧鱼机器人毕业论文.doc（36页珍藏版）》请在三一文库上搜索。

1、摘 要 智能机器人被人们称为第三代机器人，是能利用感觉和识别功能做决策行 动的机器人。本文以慧鱼创意组合模型为平台，设计出一种智能机器人循 迹边界识别小车。小车利用微动开关检测边界，利用光电管进行循迹。小车采 用慧鱼智能接口板进行控制，用直流电动机驱动。该智能小车的机械结构可以 实现反复拆装，无限组合。控制软件为 ROBO Pro，控制机器人完成一系列复杂 动作：如寻找轨迹沿轨迹行走遇到边界停止回避边界继续寻 找轨迹继续沿轨迹行走等。本文首先对小车的总体结构进行分析，确定驱 动方案和传动方案，然后按照模块化设计方法组装搭建小车结构，最后对智能 小车的循迹和边界识别的控制系统进行了研究，完成了智

2、能小车硬件设计及软 件设计，成功实现了主动循迹和边界识别功能。 关键词关键词 ：智能机器人 慧鱼 循迹 边界识别 东北电力大学本科毕业论文 - - Title Tracking and boundary identification of the smart car Abstract Intelligent robots are known as the third-generation robot, it is able to utilize to feel and identify decision-making action. In this paper, the creative co

3、mbination of Fischertechnik model as a platform to design an intelligent robot - car tracking to avoid the cliff. Car use micro-switches test the cliff and use photocell cell for tracking. The cars adopt Fischertechnik Intelligent board with two DC motor drive. The intelligent cars mechanical struct

4、ure can be repeated disassembly, infinite combinations. Control system can identify ROBO PRO as the core. Such as the searching for the track、walking along the tracks、stopping to face cliff、avoiding the cliff 、continuing to look for the track and continuing to walk along the track. In this paper, th

5、e first analysis the overall structure of the car to determine the driver program and drive program, establish the car in accordance with the method of modular design structure and finally research the car control system. In this paper, study the smart car tracking and avoiding the cliff, completed

6、the Smart car hardware production and software design, and successfully implemented the function of tracking and avoiding the cliff. Keywords : Robot; Fischertechnik ; Tour Line; Boundary identification 东北电力大学本科毕业论文 - - 目 录 摘 要.I ABSTRACTII 第 1 章 绪论 1 1.1 选题背景及意义.1 1.2 国内外机器人的发展现状 2 1.3 慧鱼机器人的前景 3 第

7、 2 章 智能小车的总体设计 5 2.1 智能小车实现功能.5 2.1.1 边界识别功能 6 2.1.2 循迹功能 6 2.1.3 循迹加边界识别功能 6 2.2 小车驱动方案的对比分析及选择.6 2.3 智能小车传动方案的对比分析及选择.7 2.4 小车控制系统的总体设计.7 2.5 循迹边界识别小车总体设计简图8 2.6 本章小结9 第 3 章 智能循线避障机器人结构设计 10 3.1 硬件设计.10 3.2 硬件的选择 10 3.3 智能车本体结构.13 3.3.1 机器人各部分设计 13 3.3.2 机器人硬件安装 14 3.4 小结.15 第 4 章 智能小车的软件设计 16 4.1

8、 软件设计实现要求.16 4.2 控制程序模块化.16 4.3 主程序17 4.4 边界识别子程序.17 边界返回方法的最优化 .18 4.5 寻找轨迹子程序.19 4.6 进、后退、停止、左右转子程序.20 4.7 沿轨迹行走子程序.20 4.8 LLWIN3.0 控制系统的调试.21 4.8.1 调试前的准备工作 21 4.8.2 程序调试 22 目录 - -I 4.8.3 运行结果 22 4.9 小结.22 结 论 23 致 谢 24 参考文献 25 东北电力大学本科毕业论文 - - 0 - 第第 1 1 章章 绪绪 论论 1.1 选题背景及意义选题背景及意义 “慧鱼创意组合模型”又称“

9、工程积木” ， “智慧魔方” ，简称“慧鱼” 。它 是由德国发明家 Artur Fisher 博士于 1964 年发明的。它具有一般机械所具有 的零部件，如齿轮、电机、电气开关等，通过声、光、电和辅助技术的配合， 能够模拟各种机械运动和机械设备的自动控制，而且有比较真实的功能1。 慧鱼创意组合模型是对各种工业机器人的模型，通过对模型的仿真来实现 机器人的设计工作。机器人技术是综合了计算机、控制论、机构学、信息和传 感技术、人工智能、仿生学等多门学科而形成的高新技术。国际标准化组织 （ISO）对机器人的定义:机器人是一种自动的、位置可控的、具有编程能力的 多功能操作机，这种操作机具有几个轴，能够

10、借助可编程操作来处理各种材料、 零件、工具和专用装置，以执行各种任务2。 工业机器人是机器人的主要研究类型，它并不是简单意义上代替人工的劳 动，而是综合了人的特长和机器特长的一种拟人的电子机械装置，既有人对环 境状态的快速反应和分析判断能力，又有机器可长时间持续工作、精确度高、 抗恶劣环境的能力。从某种意义上来说，机器人是机器进化过程的产物，是工 业以及非产业界的重要生产和服务性设备，也是先进制造技术领域不可缺少的 自动化设备。工业机器人由机械本体、控制器、伺服驱动系统和检测传感装置 构成，是一种仿人操作、自动控制、可重复编程、能在三维空间完成各种作业 的机电一体化自动设备，适合于多品种、变批

11、量的柔性生产。它对稳定和提高 产品质量，提高生产效率，改善劳动条件和产品的快速更新换代起着重要的作 用。 从 20 世纪 80 年代以来，机器人技术的不断进步，其在各个领域的应用日 益广泛，引起了各国专家学者的普遍关注。许多发达国家均把机器人技术的开 发和研究列入国家高新技术发展计划。世界各国普遍在高等院校为大学本科生 及研究生开设机器人技术的有关课程。为了培养机器人开发、设计、生产、维 护方面的人才，我国很多高校也为本科生和研究生开设了机器人学课程。因此， 教学型机器人越来越受到科研单位以及高校的重视。教育机器人是一类应用于 教育领域的机器人，它一般具备以下特点：首先是教学适用性，符合教学使

12、用 的相关需求；其次是具有良好的性能价格比，特定的教学用户群决定了其价位 不能过高；再次就是它的开放性和可扩展性，可以根据需要方便地增、减功能 模块，进行自主创新；此外它还应当有友好的人机交互界面3。目前国内的教 育机器人产品近 20 种，包括上海广茂达公司生产的能力风暴智能机器人、西 觅亚科技生产的乐高机器人、慧鱼公司生产的慧鱼机器人等。 第 1 章 绪 论 - - 1 - 1.2 国内外机器人的发展现状国内外机器人的发展现状 机器人从 20 世纪 50 年代诞生以来，在短短的 50 多年里得到了迅速的发 展，经历了第一代工业机器人的研究、实用化和普及，第二代感知功能机器人 的研究、实用化，

13、以及第三代智能机器人的研究等各个阶段。第三代机器人， 也是我们机器人学中一个理想的所追求的最高级的阶段，叫智能机器人，那么 只要告诉它做什么，不用告诉它怎么去做，它就能完成任务。知思维和人机通 讯的这种功能和机能，目前的发展还是相对的只是在局部有这种智能的概念和 含义，但真正完整意义的这种智能机器人实际上并没有存在，而只是随着我们 科学技术的不断发展，智能的概念越来越丰富，它内涵越来越宽泛4。1954 年， 美国的 George.Devol 首先把远程控制器的杆结构与数控铣床的伺服轴结合起来， 研制出了第一台通用机械手。这种机械手可以通过让其沿一系列点运动，将运 动位置以数字形式存储起来，动作

14、执行时，使伺服系统驱动机械手各关节轴来 再现这些位置，从而让机械手完成一些简单的工作。正是由于这个机械手具有 了编程示教再现功能，因此许多人把它作为现代工业机器人产生的标志5。在 随后的生产应用中，为了适应各种不同用途需要，相继出现了直角坐标、关节 坐标、极坐标等许多种不同结构的机器人。与第一代示教再现型机器人不同， 第二代机器人是具有感觉功能的适应控制机器人。这种机器人带有传感器，能 感知环境和对象的情况以控制自身动作的变化。智能机器人的研究是一个艰巨 而又广泛的问题，随着研究的不断深入，相关科学的飞速发展，智能机器人在 不久的将来一定会出现。 据 UNECE(联合国欧洲经济委员会)和 IF

15、R(国际机器人联合会)统计，从 20 世纪 70 年代起，世界机器人产业一直保持着稳步增长的良好势头。进入 90 年 代，机器人产品发展速度加快，年销售量增长率平均在 10左右；2004 年增 长率达到了创记录的 20，其中，亚洲机器人增长幅度最为突出，增长 436-8。我国的机器人研究开发工作始于上世纪 70 年代初，到现在已经历了 30 多年的历程。前 10 年处于研究单位自行开展研究工作状态，发展比较缓慢。 1985 年后开始列入国家有关计划，发展比较快。特别是在“七五” 、 “八五” 、 “九五”机器人技术国家攻关和“863”高技术发展计划的重点支持下，我国 的机器人技术取得了重大发展

16、。在机器人基础技术方面：诸如机器人机构的运 动学、动力学分析与综合研究，机器人运动的控制算法及机器人编程语言的研 究，机器人内外部传感器的研究与开发，具有多传感器控制系统的研究，离线 编程技术、遥控机器人的控制技术等均取得长足进展，并在实际工作中得到应 用。 在机器人操作机研制方面：已开发出一些先进的操作机和特种机器人，如 东北电力大学本科毕业论文 - - 2 - 自动导引车 AGV，壁面爬行机器人，重复定位精度为0.024mm 的装配机器 人；可潜入海底 6000m 的水下机器人，移动遥控机器人，主从操作机器人等， 有些已达实用化水平并用于实际工程。在机器人的应用工程方面：目前国内已 建立了

17、多条弧焊机器人生产线，装配机器人生产线，喷涂生产线和焊装生产线。 国内的机器人技术研发力量已经具备了大型机器人工程设计和实施的能力，整 体性能已达到国际同类产品的先进水平，而整体价格仅为国外同类产品的三分 之二甚至一半，具有很好的性能价格比和市场竞争力9-11。综上所述，我国机 器人发展已跨过了起步阶段，走上了进步和发展的道路。今后的任务是把机器 人技术推广到更多的工业自动化生产领域和其他更广泛的应用领域，大力开展 跨国区域交流合作，与国际接轨，早日跻身于世界先进行列。 目前我们国家比较有代表性的研究有：工业机器人，水下机器人，空间机 器人，核工业的机器人，都在国际上处于领先水平，总体上我们国

18、家与发达国 家相比，还存在着很大的差距，但是在上述这些水下、空间、核工业，一些特 殊机器人方面，我们还是取得了很多有特色的研究成就12。 随着电子技术和计算机技术的发生，PLC 的功能越来越强大，其概念和内 涵也不断扩展。上世纪 80 年代至 90 年代中期，是 PLC 发展最快的时期，年 增长率一直保持为 3040%13。在这时期，PLC 在处理模拟量能力、数字运算 能力、人机接口能力和网络能力得到大幅度提高，PLC 逐渐进入过程控制领域， 在某些应用上取代了在过程控制领域处于统治地位的 DCS 系统14。 近年，工业计算机技术（IPC）和现场总线技术（FCS）发展迅速，挤占 了一部分 PL

19、C 市场，PLC 增长速度出现渐缓的趋势，但其在工业自动化控制 特别是顺序控制中的地位，在可预见的将来，是无法取代的15。 1.31.3 慧鱼机器人的前景慧鱼机器人的前景 慧鱼创意组合模型主要提供组合包、培训模型、工业模型三大系列。集能 源（包括太阳能） 、机械、液压、气动、遥控、自控、程控等多种学科知识于 一身，利用工业标准的基本构件（机械元件、电气元件、气动元件） ，辅以传 感器、控制器、执行器和软件的配合，运用设计构思和实践分析，可以实现任 何技术过程的还原，更可以实现工业生产和大型机械设备操作的模拟，从而为 实验教学、科研创新和生产流水线可行性论证提供了可能16。 “慧鱼理想教具 ”作

20、为广大用户和各方面的创新教育专家所给予 慧鱼 模型的评价和期许，慧鱼模型就是利用 “六面可拼接体 ”这种开放的零件， 来构建或者模拟现实发挥你的创意，来完成机电一体化的工业设计为主的模 型组建。慧鱼创意组合模型已在欧洲和美洲的各大、中专学校广泛应用。它 第 1 章 绪 论 - - 3 - 进入中国市场以来，也在清华大学、同济大学、浙江大学等众多高校中日益 广泛应用，它以浓厚的趣味性、创 新性和教学过程中的启发性，使学 生能 够很直观地把抽象复杂的理论通过 模型运动及其控制得以实现。采用该模 型进行试验教学能够培养和提高学生的学习热情，大大激发了学生的创新意 识，提高了动手能力，较好的解决学生在

21、学习过程中书本知识与实践脱节的 问题，对于学生理解机械运动及机械设备工业控制具有很大的益处，是很好 的机电一体化教学模型。 相信慧鱼会成为中国创新教育的理想教具 17。 东北电力大学本科毕业论文 - -4 第 2 章 智能小车的总体设计 本课题所研究的循迹边界识别智能小车系统是一个典型的机电一体化系统。 所谓的机电一化系统是指在系统的主功能、信息处理功能和控制功能等方面引 了电子技术，并把机械装置、执行部件、计算机等电子设备以及软件等有机结 合构成的系统，即机械、执行、信息处理、接口和软件等部分在电子技术的支 配下以系统的观点进行组合而形成的一种新型机械系统。 机电一体化系统由机械部分、传感部

22、分、控制部分三大部分组成。这三大 部分可分为驱动系统、机械结构系统、感受系统、智能小车环境交互系统、 人机交互系统、控制系统六个子系统。该智能小车的设计就是依据机电体一化 系统的组成原则进行的。 控制系统 驱动系统 机械结构系统 感受 系统 图 2-1 循迹边界识别小车的系统组成 2.1 智能智能小车实现功能小车实现功能 本课题所研究的智能小车按功能可分为循迹功能和边界识别功能。循迹功 能可细分为寻找轨迹和循迹前进，边界识别功能可细分为边界识别和边界返回。 智能小车主要任务要求为：先寻找轨迹沿轨迹行走遇到边界停止回避边 界继续寻找轨迹继续沿轨迹行走。本课题难点在于循迹功能和边界识别功 能的有机

23、结合。智能小车实现功能分类如图 2-2。 智能小车实现功能分类 循迹功能边界识别功能 边界分类边界返回循迹前进寻找轨迹 图 2-2 智能小车实现功能分类 第 2 章 智能小车的总体设计 - -5 2.1.1 边界识别功能 小车能自动识别边界及越过边界继续前进，完成一系列复杂动作如：边界 识别小车后退指定方向旋转小车前进。 2.1.2 循迹功能 小车能主动跟踪循迹，完成一系列复杂动作如：寻找轨迹沿轨迹前进 判断是否偏离轨迹有偏离轨迹相应方向旋转继续前进。 2.1.3 循迹加边界识别功能循迹加边界识别功能 小车能同时完成循迹跟踪和边界识别，完成一系列复杂动作如：寻找轨迹 沿轨迹行走遇到边界停止小车

24、后退指定方向旋转小车前进继续寻 找轨迹继续沿轨迹行走。 2.2 小车驱动方案的对比分析及选择 通常，小车的驱动方式有以下几类： （1）气压驱动使用压力通常在 0.40.6Mpa，最高可达 1Mpa。气压驱动主 要优点是气源方便（一般工厂都由压缩空气站供应压缩空气） ，驱动系统具有 缓冲作用，结构简单，成本低；缺点是功率质量比小，装置体积大，气源装置 存在噪声问题，定位精度也不高。 （2）液压驱动系统的功率质量比大，驱动平稳，同时液压驱动调速比较简 单，能在很大范围内实现无级调速；缺点是易漏油，这不仅影响工作稳定性和 定位精度，而且污染环境。液压驱动多用于要求输出力较大，运动速度较低的 场合21

25、。 （3）电气驱动是利用各种电机产生的力或转矩，直接或经过减速机构去驱 动负载，以获得要求的小车运动。由于具有易于控制、运动精度高、使用方便、 成本低廉、驱动效率高、不污染环境等诸多优点，电气驱动是最普遍，应用最 多的驱动方式。 综合考虑各种驱动方式的优缺点，最后采用电气驱动。 电动机根据输出形式分，可以分为旋转型和直线型。电动机在智能小车中 应用时，应主要关注电动机的如下基本性能： 能实现启动、停止、连续的正反转运行，且具有良好的响应特性； 正转与反转时的特性相同，且运行特性稳定； 维护容易，而且不用保养； 具有良好的抗干扰能力，且相对于输出来说，体积小，重量轻。 在小车中，采用比较多的是直

26、流电动机。因为它可以达到很大的力矩，精 东北电力大学本科毕业论文 - -6 度高，加速迅速，可靠性高，在正反两个方向连续旋转运动平滑。因此，小车 的前进、和后退及转弯都采用直流电动机。 2.3 智能小车传动方案的对比分析及选择 传动装置的作用是将驱动元件的动力传递给智能小车的执行部件，以实现 各种预定的运动。目前常用的传动方式有：皮带轮传动、蜗轮蜗杆传动、齿轮 传动、谐波减速传动以及螺旋传动等。谐波齿轮传动具有体积小、结构紧凑、 效率高、能获得大的传动比等优点，但存在扭转刚度较低且传动比不能太小的 缺点。蜗轮蜗杆机构常用于要求有大的传动比且传动过程中要求机构自锁的场 合，这种方式安全性能高，但

27、同样存在齿侧间隙，而且效率较低。皮带轮传动 可以实现过载保护，可是存在弹性滑动，和链传动一样使用一段时间后易松弛， 传动运转过程中还产生动载荷，因此常用于传动精度要求不高的场合。螺旋传 动是将回转运动变换为直线运动的重要传动方式，有滑动螺旋传动和滚动螺旋 传动。滑动螺旋传动是连续的面接触，传动中不会产生冲击，传动平稳、无噪 声、能够自锁，且螺旋升角较小但螺纹工艺性较差强度较低 。滚动螺旋传动 的效率一般在 90以上，它不自锁，具有传动的可逆性 。但其结构复杂， 制造精度要求高， 成本高，抗冲击性能差 等原因不予考虑 。齿轮传动具有 结构紧凑、效率高的优点，适用于中等减速比传动。经过考虑直接使用

28、齿轮传 动比较合适。 小车精度要求不是很高，在满足性能要求的基础上应考虑到经济性要求。 因此，小车传动选用齿轮传动，由两个 9V2.4 瓦大功率马达带动如图 23 所示。 电机 车轮 图 2-3 小车驱动与传动方案简图 2.4 小车控制系统的总体设计 采用 LLWin3.0 软件进行控制系统设计时，可以一边做硬件电路，一边编 制控制程序，做好后再与设备联机调试，可以缩短工期，可靠性高。控制系统 的应用设计一般应按照图 24 的几个步骤进行 系统规划设计阶段是应用系统设计的关键阶段，应详细了解被控对象的全部功 能，例如：机械部件的动作顺序、动作条件、动作完成时间，响应时间及如何 第 2 章 智能

29、小车的总体设计 - -7 同时实现循迹和边界识别功能等。课题的难点在于如何使循迹与边界识别之间 不发生冲突。 系统规划 硬件设计软件设计 在线模拟测试 调整硬件调整软件 现场运行并调试 N N 是否符合要求 Y 图 2-4 小车控制系统整体设计 2.5 循迹边界识别小车总体设计简图 按照任务要求，小车需要具有循迹和边界识别两个功能。边界识别功能要 I5I6 探测腿 I4 I3 车轮 万向轮 电机 M1、M2 循迹装置 I7、I8、M3 接触开关 I1 图 2-5 循迹边界识别小车总体设计简图 东北电力大学本科毕业论文 - -8 求小车的四个方向都能识别并避开边界，所以小车的四个角都应装有边界识

30、别 装置，即探测腿。循迹功能则要求小车能够先找到轨迹，再沿着该轨迹行走。 因此轨迹探测装置装在小车的头部正下方。循迹边界识别小车总体设计如图 2- 5 所示。 2.6 本章小结 本章根据智能小车的任务要求，从智能小车本体结构和控制方法对比分析 入手，初步确定智能小车的运动形式、驱动方案、传动方案和控制方案，并设 计出小车的总设计简图。 东北电力大学本科毕业论文 - 0 - 第 3 章 智能循线避障机器人结构设计 机器人要实现自动导引功能和避障功能就必须要感知导引线和障碍物，而 感知导引线相当于给机器人一个视觉功能。智能循线和避障是基于智能导引小 车系统，采用超声波距离传感器传感器判断并检测障碍

31、物，采用轨迹传感器进 行寻线。因此本章对智能小车的循线和避障进行了研究。 3.1 硬件设计硬件设计 智能车采用履带驱动，前后各用一个直流双向电机驱动，调制两个轮子的 转速从而达到控制转向的目的。将轨迹传感器装在车体前部的下方，当传感器 I3检测到黑线的边界时，控制系统控制左轮电机减速，车向右修正，当车的右 边传感器I4检测到黑线时，控制系统控制右轮电机减速，车向左修正，黑线在 车体的中间时，传感器一直检测到黑线，当偏离黑线时就开始修正，从而使小 车沿着黑色的轨道行走。 避障的原理和循线一样，在车头的前方装了超声波距离传感器，当传感器 检测到障碍物时，智能车停止1S之后后退，经脉冲计数器设定的额

32、定数值之后 车体向左转，再通过脉冲计数器设定数值，到达数值之后继续前进，依次循环 从而避开障碍物。 3.23.2 硬件的选择硬件的选择 和数字量输入返回1和0值不同，模拟量输入可以分辨连续的输入，所有的 模拟量输入返回一个0-1023之间的值。而ROBO接口板有各种不同的模拟量输 入接口来测量不同的物理量。具体来说，模拟量输入可以适应用来测量电阻， 测量电压和测量距离的不同的传感器如表3-1所示。 通常的慧鱼传感器中，温度传感器和光电传感器将被测量装换成电阻值。 所以必须将这些传感器接到AX和AY输入端。电压输入端A1和A2设计用来连 接所有产生0到10V电压的传感器。在ROBO接口板上没有针

33、对AV输入端的端 口。它通常和接口板的电源电压相关联。距离传感器输入端D1和D2可以接到 慧鱼特殊传感器，可以测量障碍物的距离。 东北电力大学本科毕业论文 - 0 - 表 3-1 模拟量输入 输入端输入类型测量范围 A1,A2电压输入0-1023V AX,AY电阻输入 0-5.5K D1,D2距离传感器输入Ca.0-50cm AV电源电压0-10V 3.2.13.2.1超声波距离传感器超声波距离传感器 机器人避障的关键问题之一是在运动过程中如何利用传感器对环境的感知。 任何类型的传感器都有各自的优点和不足.选用时需要仔细考虑各种因素。在 机器人运动规划过程中传感器主要为系统提供两种信息：机器人

34、附近障碍物的 存在信息；障碍物与机器人之间的距离。超声波距离传感器是靠发射某种频率 的声波信号，利用物体界面上超声反射，散射检测物体的存在与否，如图3-2 所示。超声波在空气中传播时如果遇到其它媒介，则因两种媒质的声阻抗不同 而产生反射。因此，向空气中的被测物体发射超声波，检测反射波并进行分析， 从而获到障碍物的信息。超声波使由换能晶片在电压的激励下发生振动产生 的，它具有频率高 、波长短、绕射现象小，特别是方向性好、能够成为射 线而定向传播等特点。超声波对液体、固体的穿透本领很大，尤其是在阳光 不透明的固体中，它可穿透几十米的深度。超声波碰到杂质或分界面会产生 显著反射形成反射成回波，碰到活

35、动物体能产生多普勒效应超声波探头主要 由压电晶片组成，既可以发射超声波，也可以接收超声波。小功率超声探头 多作探测作用。 3 3. .2 2. .2 2轨轨迹迹传传感感器器 如图3-3，轨迹传感器可以寻找到白色表面的黑色轨道。传感器检测表面 应为5mm-30mm，它包含两个发射和两个接收装置，连接该传感器需要有两个 数字量输入端和9V电源端。轨迹传感器中的光敏二极管的外型与一般二极管 一样，只是它的管壳上开有一个嵌着玻璃的窗口，以便于光线射入，为增加 受光面积，PN结的面积做得较大 ,光敏二极管工作在反向偏置的工作状态 下，并与负载电阻相串联，当无光照时它与普通二极管一样，反向电流很小,称 为

36、光敏二极管的暗电流；当有光照时，载流子被激发，产生电子-空穴， 称为光电载流子。在外电场的作用下，光电载流子参于导电，形成比暗电流 大得多的反向电流，该反向电流称为光电流。光电流的大小与光照强度成正 比，于是在负载电阻上就能得到随光照强度变化而变化的电信号。 图 3-2 超声波距离 传感器 图 3-3 轨迹传感器 第 3 章 智能循线避障机器人总体设计 - 1 - 3 3. .2 2. .3 3接接触触式式传传感感器器 按键开关式（接触式）传感 器是数字传感器的一种。数据仅 能设定为两个不同的值，分别用 0和1来表示。如图3-4所示，传 感器显示“0” ，表示在接触点之 间没有电流通过；“1”

37、则意味 着有电流通过。慧鱼模型中的接触传感器是一个三向开关式的。因此，就有三 个端点。红色按钮按下，1和3端点接通，同时常闭状态下的1和2端点之间的连 接断开。这样起始位置就可以任意选择： 常闭状态（端点1、2接通） ； 常开状态（端点1、3接通） 。 如果接口板上输入端口电气上是闭合的，则数字量的橙色连接上会返回一个数 值“1”，否则会返回一个数值“0”。 3.2.43.2.4大功率马达大功率马达： 两个大功率直流电机（9V，2.4W） ，内置齿轮箱，以50：1减速比驱动移 动机器人（即马达旋转50转的同时，其输出轴只旋转一次） 。一个马达输出通 常使用两个接口板接口，而灯输出只用一个接口。

38、接口板的输出可以是马达， 也可以是灯或者电磁铁。对于马达，可以设置它的转向和速度。马达输出模块 可以用表3-5中的指令来处理： 表 3-2 马达指令 指令值动作 向右 1-8 马达以速度1到8顺时针旋转 向左 1-8 马达以速度1到8逆时针旋转 停止 None 马达停止 图 3-4 接触式传感器及其原理图 东北电力大学本科毕业论文 - 2 - 3.3 智能车本体结构智能车本体结构 图3-6是本次设计机器人的电路框图。其中智能接口板为电路的中央处理 器，处理超声波传感器和轨迹传感器采集来的数据，处理完毕之后随即去控制 电机驱动部分来驱动电机。其中电源部分为9V直流电源，为整个电路模块提供 电源，

39、以便能正常工作。 3.3.1 机器人各部分设计机器人各部分设计 1.行走部分：由于设计的是避障机器人，因此机器人运行的路面情况会很 复杂，采用履带式行走结构,如图3-6所示。这种移动方式支撑面积大、接地比 压小，同时由于履带支撑面上有履齿，不易打滑，牵引附着性好。机器人两侧 的履带分别由一个带有齿轮的直流电动机驱动。功率2.4W、额定转速为 400r/min。 2.避障部分：由于慧鱼创意组合模型中自带有超声波距离传感器，因此将 超声波距离传感器固定在机器人的正前方，用于机器人避障。距离传感器反映 机器人与障碍物的距离大小，测量距离约为4m，相应的检测数值以cm在程序 检测界面显示。将其直接连到

40、智能接口板的D1或D2端即可。 3.循线部分：机器人循线的功能由轨迹传感器进行控制，可以找到白色表 面的黑色轨道。传感器检测表面应为5mm-30mm，它包含两个发射和两个接收 装置，连接这个传感器需要两个数字量输入端和9v电源端。 ROBO 智 能 接 口 板 电机驱动 超声波传感器 轨迹传感器 电源 图 3-5 智能避障循线机器人电路图 第 3 章 智能循线避障机器人总体设计 - 3 - 3.3.2 机器人硬件安装机器人硬件安装 首先，通过慧鱼创意组合模型包中的机械构架将智能小车的基本模型的框 架搭建起来，然后将驱动装置（2 个 9V 双向直流电动机）放置在框架内并固定 起来。再将电气元件脉

41、冲计数器固定在基本模型内。设定电动机 M1、M2 以及 脉冲计数器 I1、I2。并预先将导线连接在电动机和数字传感装置上，以防以后 安装不便。结构设计时已经考虑到传感器的安装问题：首先将轨迹传感器安装 在智能车车头位置的正下方，使轨迹传感器距离与被搜寻位置的距离减小，提 高反映效率。其次将超声波距离传感器装在车的正前方，以便能探测到智能车 行驶前方的障碍并顺利避障。最后将两个指示灯安装在车前方的左右两端，当 轨迹传感器搜寻到轨迹时灯 M3(绿灯)亮，当智能车遇到障碍时灯 M4（红灯） 亮。这样可以保证两个传感器不会发生冲突，使整体显得协调。最后将智能接 口板固定在智能车的基本模型上，用导线将各

42、部分器件连接到接口板的各插槽 中。 如图3-7所示的示意图进行接口连接： 1.超声波距离传感器的导线两端分别插在智能接口板的D1位置的两端口： 2.脉冲计数器I1和I2的导线两端分别接在智能接口板对应的I1、I2位置； 3.轨迹传感器的绿色和红色导线的两端分别插在智能接口板的接地和+极 输入端，将蓝色和黄色导线的两端分别接在智能接口板的I3、I4位置； 4.直流电动机M1、M2导线接在智能接口板对应的M1、M2端口； 5.将灯输出M3（绿灯）接在接口板的M3位置，灯输出M4（红灯）接在 M4位置； 图 3-6 智能车行走部分设计 东北电力大学本科毕业论文 - 4 - 6.用USB接线将智能接口

43、板连接在电脑上。 注意事项： 1、装配时要确保构件到位、不滑动； 2、电子构件装配时要注意电子构件的正负极性，接线稳定可靠没有松动； 3、整个模型完成后要考虑模型的美观，整理布线要规范。 3.4 小结小结 本章按照模块化的设计方法，将机器人本体结构分为行走部分、避障部分 和循线部分，并分别对这三部分进行了规划设计，并选择关键的电气元件。同 时使用慧鱼创意组合模型对各个部分结构进行组装，完成机器人的机械结构设 计。 超声波传感器 D1 脉冲计数器 I1 脉冲计数器 I2 轨迹传感器 I3 轨迹传感器 I4 直流电动机 M1 直流电动机 M2 绿色灯管 M3 红色灯管 M4 扩展板接口 USB 接

44、线口 电源输入 智智 能能 接接 口口 板板 接地线端口 图 3-7 接线示意图 第 3 章 智能循线避障机器人总体设计 - 5 - 第 4 章 智能小车的软件设计 智能小车控制系统由软件和硬件两大部分组成，只有硬件系统是不能运行 的，软件和硬件相互配合才能完成任务。在进行控制系统设计时，除了系统硬 件设计外，大量的工作就是如何根据每个生产对象的实际需要设计应用程序。 因此，软件设计在小车的控制系统设计中占重要地位。对于本系统，软件更为 重要。 在智能小车控制系统中，控制系统软件可采用慧鱼自带的 LLWin3.0 控制 软件。控制程序以及流程图和数字流程图可以生成图形化的用户界面，简单方 便实

45、用。 4.1 软件设计实现要求软件设计实现要求 按照任务要求，小车完成一系列复杂动作如: 寻找轨迹沿轨迹行走遇 到边界小车停止小车后退指定方向旋转小车前进继续寻找轨迹继续 沿轨迹行走。 4.2 控制程序模块化控制程序模块化 软件设计的程序大体可分为循迹和边界识别两大部分。本系统软件采用模 块化结构，由主程序寻找轨迹子程序、沿轨迹行走子程序边界识别子程序 边界返回子程序和其他子程序构成。各模块如图 41 所示划分。 主程序 循迹边界识别 前进 后退 左转 右转 停止 寻 找 轨 迹 边 界 分 类 边 界 返 回 沿 轨 迹 行 走 图 4-1 小车程序模块化 东北电力大学本科毕业论文 - 0

46、- 4.3 主程序 主程序开始，灯 M3 导通，并延时 1S，然后判断数据 A 是否为 0（A 为 I3、I4、I5、I6 的逻辑与关系） ，为 0 则进入循迹子程序；为 1 则进入循迹子程 序。程序中，延时 1S 是因为小车在启动时，光电管初始状态为 0，而寻找到 黑线的标记也为 0，程序无法正常运行，延时 1S 后光电管初始状态变为 1，程 序正常运行。 图 4-2 循迹边界识别小车主程序 4.4 边界识别子程序边界识别子程序 程序中 FR 为右前，FL 为左前，BR 为右后，BL 左后，ML 及 MR 为 左右两个电机。子程序“边界识别”把小车可能遇到的边界情况分成 16 种， 并以数字

47、形式记入 value 中。子程序“返回”根据 value 中所记的数字，选 择最好的方法避开边界。程序循环运行直到数据 A0，如图 4-3. 第 4 章 智能小车的软件设计 - 1 - 图 4-3 边界识别子程序 边界返回方法的最优化边界返回方法的最优化 按照任务要求，小车需要识别和回避所有的边界，因此需要将所有边界情 况分成 16 种，并对每种边界进行回避,如表 4-1 所示。这样小车可以避免做重 复而不必要的动作，提高小车的性能。 表 4-1 小车可能遇到的所有边界情况及反应 序 号 右前方 (I3) 左前方 (I4) 右后方 (I5) 左后方 (I6) 小车反应 0向前直行 1 停止 2

48、 向右旋转少许 3 向左旋转少许 东北电力大学本科毕业论文 - 2 - 4 向左旋转少许 5 向右旋转少许 6 先后退，再右转 7 向左旋转少许 8 向左旋转少许 9 向右旋转少许 10 向右旋转少许 11 向右旋转少许 12 先后退，再向左 转 13 先后退，再向右 转 14 前进少许 15 前进少许 小车按可能遇到的所有边界情况（24 =16）种设计成一个表格。如表 4-1。 其中表示探测腿由于遇到边界时伸出，即该限位开关 I=0。如果格内为空， 则表示该位置探测腿没有遇到边界，该限位开关处于导通，即 I=1。例如表 4-1 中，序号 0，I3=I4=I5=I6=1,为小车四条探测腿都没遇

49、到边界，处于平稳状态， 即小车反应为“向前直行” 。小车 I3=I4=I5=I6=0 时，小车的反应动作为停止， 即小车被抬起时停止。 4.5 寻找轨迹子程序寻找轨迹子程序 程序中光电管 I7 装在小车头部的左侧，I8 在右侧，I1 为装在小车右侧用 于脉冲记数的接触试传感器。程序中先往左转并循环记数 5 次，直到 I7=0 或 5 次后再前进 5 次，直到 I7=8 或者 I8=0 或者 I7=I8=0 时子程序完成返回主程 序，否则继续寻找轨迹。寻找轨迹程序如图 4-4。 第 4 章 智能小车的软件设计 - 3 - 图 4-4 寻找轨迹程序 4.6 进、后退、停止、左右转子程序进、后退、停止、左右转子程序 其他程序如前进、后退、左转等，程序简 单且格式相似，这里就不于累述。右转子程序， 如图 4-5。 4.7 沿轨迹行走子程序沿轨迹行走子程序 沿轨迹行走子程序中，程序首先进入寻找 轨迹子程序，寻找到轨迹后，判断数据 A 是否 =0，如果为 0，程序直