《[工学]慧鱼机器人毕业论文.doc》由会员分享，可在线阅读，更多相关《[工学]慧鱼机器人毕业论文.doc（34页珍藏版）》请在三一办公上搜索。
1、摘 要摘 要智能机器人被人们称为第三代机器人，是能利用感觉和识别功能做决策行动的机器人。本文以慧鱼创意组合模型为平台，设计出一种智能机器人循迹边界识别小车。小车利用微动开关检测边界，利用光电管进行循迹。小车采用慧鱼智能接口板进行控制，用直流电动机驱动。该智能小车的机械结构可以实现反复拆装，无限组合。控制软件为ROBO Pro，控制机器人完成一系列复杂动作：如寻找轨迹沿轨迹行走遇到边界停止回避边界继续寻找轨迹继续沿轨迹行走等。本文首先对小车的总体结构进行分析，确定驱动方案和传动方案，然后按照模块化设计方法组装搭建小车结构，最后对智能小车的循迹和边界识别的控制系统进行了研究，完成了智能小车硬件设计
2、及软件设计，成功实现了主动循迹和边界识别功能。关键词 ：智能机器人 慧鱼 循迹 边界识别 ITitle Tracking and boundary identification of the smart car AbstractIntelligent 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 combination of Fischertechnik m
3、odel 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 structure can be repeated disassemb
4、ly, 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, the first analysis the overall
5、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 the Smart car hardware produc
6、tion and software design, and successfully implemented the function of tracking and avoiding the cliff.Keywords : Robot; Fischertechnik ;Tour Line;Boundary identification 7- -目录目 录摘 要IABSTRACTII第1章 绪论11.1选题背景及意义11.2国内外机器人的发展现状21.3慧鱼机器人的前景3第2章 智能小车的总体设计52.1智能小车实现功能52.1.1边界识别功能62.1.2循迹功能62.1.3循迹加边界识别功
7、能62.2小车驱动方案的对比分析及选择62.3智能小车传动方案的对比分析及选择72.4小车控制系统的总体设计72.5 循迹边界识别小车总体设计简图82.6 本章小结9第3章 智能循线避障机器人结构设计103.1硬件设计103.2硬件的选择103.3智能车本体结构133.3.1机器人各部分设计133.3.2机器人硬件安装143.4小结15第4章 智能小车的软件设计164.1软件设计实现要求164.2控制程序模块化164.3 主程序174.4边界识别子程序17边界返回方法的最优化184.5寻找轨迹子程序194.6进、后退、停止、左右转子程序204.7沿轨迹行走子程序204.8 LLWin3.0控制
8、系统的调试214.8.1调试前的准备工作214.8.2程序调试224.8.3运行结果224.9小结22结 论23致 谢24参考文献25第1章 绪 论第1章 绪 论1.1选题背景及意义 “慧鱼创意组合模型”又称“工程积木”，“智慧魔方”，简称“慧鱼”。它是由德国发明家Artur Fisher博士于1964年发明的。它具有一般机械所具有的零部件，如齿轮、电机、电气开关等，通过声、光、电和辅助技术的配合，能够模拟各种机械运动和机械设备的自动控制，而且有比较真实的功能1。慧鱼创意组合模型是对各种工业机器人的模型，通过对模型的仿真来实现机器人的设计工作。机器人技术是综合了计算机、控制论、机构学、信息和传
9、感技术、人工智能、仿生学等多门学科而形成的高新技术。国际标准化组织（ISO）对机器人的定义:机器人是一种自动的、位置可控的、具有编程能力的多功能操作机，这种操作机具有几个轴，能够借助可编程操作来处理各种材料、零件、工具和专用装置，以执行各种任务2。工业机器人是机器人的主要研究类型，它并不是简单意义上代替人工的劳动，而是综合了人的特长和机器特长的一种拟人的电子机械装置，既有人对环境状态的快速反应和分析判断能力，又有机器可长时间持续工作、精确度高、抗恶劣环境的能力。从某种意义上来说，机器人是机器进化过程的产物，是工业以及非产业界的重要生产和服务性设备，也是先进制造技术领域不可缺少的自动化设备。工业
10、机器人由机械本体、控制器、伺服驱动系统和检测传感装置构成，是一种仿人操作、自动控制、可重复编程、能在三维空间完成各种作业的机电一体化自动设备，适合于多品种、变批量的柔性生产。它对稳定和提高产品质量，提高生产效率，改善劳动条件和产品的快速更新换代起着重要的作用。从20世纪80年代以来，机器人技术的不断进步，其在各个领域的应用日益广泛，引起了各国专家学者的普遍关注。许多发达国家均把机器人技术的开发和研究列入国家高新技术发展计划。世界各国普遍在高等院校为大学本科生及研究生开设机器人技术的有关课程。为了培养机器人开发、设计、生产、维护方面的人才，我国很多高校也为本科生和研究生开设了机器人学课程。因此，
11、教学型机器人越来越受到科研单位以及高校的重视。教育机器人是一类应用于教育领域的机器人，它一般具备以下特点：首先是教学适用性，符合教学使用的相关需求；其次是具有良好的性能价格比，特定的教学用户群决定了其价位不能过高；再次就是它的开放性和可扩展性，可以根据需要方便地增、减功能模块，进行自主创新；此外它还应当有友好的人机交互界面3。目前国内的教育机器人产品近20种，包括上海广茂达公司生产的能力风暴智能机器人、西觅亚科技生产的乐高机器人、慧鱼公司生产的慧鱼机器人等。1.2国内外机器人的发展现状机器人从20世纪50年代诞生以来，在短短的50多年里得到了迅速的发展，经历了第一代工业机器人的研究、实用化和普
12、及，第二代感知功能机器人的研究、实用化，以及第三代智能机器人的研究等各个阶段。第三代机器人，也是我们机器人学中一个理想的所追求的最高级的阶段，叫智能机器人，那么只要告诉它做什么，不用告诉它怎么去做，它就能完成任务。知思维和人机通讯的这种功能和机能，目前的发展还是相对的只是在局部有这种智能的概念和含义，但真正完整意义的这种智能机器人实际上并没有存在，而只是随着我们科学技术的不断发展，智能的概念越来越丰富，它内涵越来越宽泛4。1954年，美国的George.Devol首先把远程控制器的杆结构与数控铣床的伺服轴结合起来，研制出了第一台通用机械手。这种机械手可以通过让其沿一系列点运动，将运动位置以数字
13、形式存储起来，动作执行时，使伺服系统驱动机械手各关节轴来再现这些位置，从而让机械手完成一些简单的工作。正是由于这个机械手具有了编程示教再现功能，因此许多人把它作为现代工业机器人产生的标志5。在随后的生产应用中，为了适应各种不同用途需要，相继出现了直角坐标、关节坐标、极坐标等许多种不同结构的机器人。与第一代示教再现型机器人不同，第二代机器人是具有感觉功能的适应控制机器人。这种机器人带有传感器，能感知环境和对象的情况以控制自身动作的变化。智能机器人的研究是一个艰巨而又广泛的问题，随着研究的不断深入，相关科学的飞速发展，智能机器人在不久的将来一定会出现。据UNECE(联合国欧洲经济委员会)和IFR(
14、国际机器人联合会)统计，从20世纪70年代起，世界机器人产业一直保持着稳步增长的良好势头。进入90年代，机器人产品发展速度加快，年销售量增长率平均在10左右；2004年增长率达到了创记录的20，其中，亚洲机器人增长幅度最为突出，增长436-8。我国的机器人研究开发工作始于上世纪70年代初，到现在已经历了30多年的历程。前10年处于研究单位自行开展研究工作状态，发展比较缓慢。1985年后开始列入国家有关计划，发展比较快。特别是在“七五”、“八五”、“九五”机器人技术国家攻关和“863”高技术发展计划的重点支持下，我国的机器人技术取得了重大发展。在机器人基础技术方面：诸如机器人机构的运动学、动力学
15、分析与综合研究，机器人运动的控制算法及机器人编程语言的研究，机器人内外部传感器的研究与开发，具有多传感器控制系统的研究，离线编程技术、遥控机器人的控制技术等均取得长足进展，并在实际工作中得到应用。在机器人操作机研制方面：已开发出一些先进的操作机和特种机器人，如自动导引车AGV，壁面爬行机器人，重复定位精度为0.024mm的装配机器人；可潜入海底6000m的水下机器人，移动遥控机器人，主从操作机器人等，有些已达实用化水平并用于实际工程。在机器人的应用工程方面：目前国内已建立了多条弧焊机器人生产线，装配机器人生产线，喷涂生产线和焊装生产线。国内的机器人技术研发力量已经具备了大型机器人工程设计和实施
16、的能力，整体性能已达到国际同类产品的先进水平，而整体价格仅为国外同类产品的三分之二甚至一半，具有很好的性能价格比和市场竞争力9-11。综上所述，我国机器人发展已跨过了起步阶段，走上了进步和发展的道路。今后的任务是把机器人技术推广到更多的工业自动化生产领域和其他更广泛的应用领域，大力开展跨国区域交流合作，与国际接轨，早日跻身于世界先进行列。目前我们国家比较有代表性的研究有：工业机器人，水下机器人，空间机器人，核工业的机器人，都在国际上处于领先水平，总体上我们国家与发达国家相比，还存在着很大的差距，但是在上述这些水下、空间、核工业，一些特殊机器人方面，我们还是取得了很多有特色的研究成就12。 随着
17、电子技术和计算机技术的发生，PLC的功能越来越强大，其概念和内涵也不断扩展。上世纪80年代至90年代中期，是PLC发展最快的时期，年增长率一直保持为3040%13。在这时期，PLC在处理模拟量能力、数字运算能力、人机接口能力和网络能力得到大幅度提高，PLC逐渐进入过程控制领域，在某些应用上取代了在过程控制领域处于统治地位的DCS系统14。近年，工业计算机技术（IPC）和现场总线技术（FCS）发展迅速，挤占了一部分PLC市场，PLC增长速度出现渐缓的趋势，但其在工业自动化控制特别是顺序控制中的地位，在可预见的将来，是无法取代的15。1.3慧鱼机器人的前景慧鱼创意组合模型主要提供组合包、培训模型、
18、工业模型三大系列。集能源（包括太阳能）、机械、液压、气动、遥控、自控、程控等多种学科知识于一身，利用工业标准的基本构件（机械元件、电气元件、气动元件），辅以传感器、控制器、执行器和软件的配合，运用设计构思和实践分析，可以实现任何技术过程的还原，更可以实现工业生产和大型机械设备操作的模拟，从而为实验教学、科研创新和生产流水线可行性论证提供了可能16。“慧鱼理想教具”作为广大用户和各方面的创新教育专家所给予慧鱼模型的评价和期许，慧鱼模型就是利用“六面可拼接体”这种开放的零件，来构建或者模拟现实发挥你的创意，来完成机电一体化的工业设计为主的模型组建。慧鱼创意组合模型已在欧洲和美洲的各大、中专学校广泛
19、应用。它进入中国市场以来，也在清华大学、同济大学、浙江大学等众多高校中日益广泛应用，它以浓厚的趣味性、创新性和教学过程中的启发性，使学生能够很直观地把抽象复杂的理论通过模型运动及其控制得以实现。采用该模型进行试验教学能够培养和提高学生的学习热情，大大激发了学生的创新意识，提高了动手能力，较好的解决学生在学习过程中书本知识与实践脱节的问题，对于学生理解机械运动及机械设备工业控制具有很大的益处，是很好的机电一体化教学模型。相信慧鱼会成为中国创新教育的理想教具17。第2章 智能小车的总体设计第2章 智能小车的总体设计本课题所研究的循迹边界识别智能小车系统是一个典型的机电一体化系统。所谓的机电一化系统
20、是指在系统的主功能、信息处理功能和控制功能等方面引了电子技术，并把机械装置、执行部件、计算机等电子设备以及软件等有机结合构成的系统，即机械、执行、信息处理、接口和软件等部分在电子技术的支配下以系统的观点进行组合而形成的一种新型机械系统。机电一体化系统由机械部分、传感部分、控制部分三大部分组成。这三大部分可分为驱动系统、机械结构系统、感受系统、智能小车环境交互系统、人机交互系统、控制系统六个子系统。该智能小车的设计就是依据机电体一化系统的组成原则进行的。 控制系统驱动系统机械结构系统感受系统图2-1 循迹边界识别小车的系统组成2.1智能小车实现功能本课题所研究的智能小车按功能可分为循迹功能和边界
21、识别功能。循迹功能可细分为寻找轨迹和循迹前进，边界识别功能可细分为边界识别和边界返回。智能小车主要任务要求为：先寻找轨迹沿轨迹行走遇到边界停止回避边界继续寻找轨迹继续沿轨迹行走。本课题难点在于循迹功能和边界识别功能的有机结合。智能小车实现功能分类如图2-2。智能小车实现功能分类循迹功能边界识别功能边界分类边界返回循迹前进寻找轨迹图2-2智能小车实现功能分类2.1.1边界识别功能小车能自动识别边界及越过边界继续前进，完成一系列复杂动作如：边界识别小车后退指定方向旋转小车前进。2.1.2循迹功能小车能主动跟踪循迹，完成一系列复杂动作如：寻找轨迹沿轨迹前进判断是否偏离轨迹有偏离轨迹相应方向旋转继续前
22、进。2.1.3循迹加边界识别功能小车能同时完成循迹跟踪和边界识别，完成一系列复杂动作如：寻找轨迹沿轨迹行走遇到边界停止小车后退指定方向旋转小车前进继续寻找轨迹继续沿轨迹行走。2.2小车驱动方案的对比分析及选择通常，小车的驱动方式有以下几类：（1）气压驱动使用压力通常在0.40.6Mpa，最高可达1Mpa。气压驱动主要优点是气源方便（一般工厂都由压缩空气站供应压缩空气），驱动系统具有缓冲作用，结构简单，成本低；缺点是功率质量比小，装置体积大，气源装置存在噪声问题，定位精度也不高。（2）液压驱动系统的功率质量比大，驱动平稳，同时液压驱动调速比较简单，能在很大范围内实现无级调速；缺点是易漏油，这不仅
23、影响工作稳定性和定位精度，而且污染环境。液压驱动多用于要求输出力较大，运动速度较低的场合21。（3）电气驱动是利用各种电机产生的力或转矩，直接或经过减速机构去驱动负载，以获得要求的小车运动。由于具有易于控制、运动精度高、使用方便、成本低廉、驱动效率高、不污染环境等诸多优点，电气驱动是最普遍，应用最多的驱动方式。综合考虑各种驱动方式的优缺点，最后采用电气驱动。电动机根据输出形式分，可以分为旋转型和直线型。电动机在智能小车中应用时，应主要关注电动机的如下基本性能：能实现启动、停止、连续的正反转运行，且具有良好的响应特性；正转与反转时的特性相同，且运行特性稳定；维护容易，而且不用保养；具有良好的抗干
24、扰能力，且相对于输出来说，体积小，重量轻。在小车中，采用比较多的是直流电动机。因为它可以达到很大的力矩，精度高，加速迅速，可靠性高，在正反两个方向连续旋转运动平滑。因此，小车的前进、和后退及转弯都采用直流电动机。2.3智能小车传动方案的对比分析及选择传动装置的作用是将驱动元件的动力传递给智能小车的执行部件，以实现各种预定的运动。目前常用的传动方式有：皮带轮传动、蜗轮蜗杆传动、齿轮传动、谐波减速传动以及螺旋传动等。谐波齿轮传动具有体积小、结构紧凑、效率高、能获得大的传动比等优点，但存在扭转刚度较低且传动比不能太小的缺点。蜗轮蜗杆机构常用于要求有大的传动比且传动过程中要求机构自锁的场合，这种方式安
25、全性能高，但同样存在齿侧间隙，而且效率较低。皮带轮传动可以实现过载保护，可是存在弹性滑动，和链传动一样使用一段时间后易松弛，传动运转过程中还产生动载荷，因此常用于传动精度要求不高的场合。螺旋传动是将回转运动变换为直线运动的重要传动方式，有滑动螺旋传动和滚动螺旋传动。滑动螺旋传动是连续的面接触，传动中不会产生冲击，传动平稳、无噪声、能够自锁，且螺旋升角较小但螺纹工艺性较差强度较低。滚动螺旋传动的效率一般在90以上，它不自锁，具有传动的可逆性。但其结构复杂，制造精度要求高，成本高，抗冲击性能差等原因不予考虑。齿轮传动具有结构紧凑、效率高的优点，适用于中等减速比传动。经过考虑直接使用齿轮传动比较合适
26、。小车精度要求不是很高，在满足性能要求的基础上应考虑到经济性要求。因此，小车传动选用齿轮传动，由两个9V2.4瓦大功率马达带动如图23所示。电机车轮图2-3小车驱动与传动方案简图2.4小车控制系统的总体设计采用LLWin3.0软件进行控制系统设计时，可以一边做硬件电路，一边编制控制程序，做好后再与设备联机调试，可以缩短工期，可靠性高。控制系统的应用设计一般应按照图24的几个步骤进行系统规划设计阶段是应用系统设计的关键阶段，应详细了解被控对象的全部功能，例如：机械部件的动作顺序、动作条件、动作完成时间，响应时间及如何同时实现循迹和边界识别功能等。课题的难点在于如何使循迹与边界识别之间不发生冲突。
27、系统规划硬件设计软件设计在线模拟测试调整硬件调整软件现场运行并调试N N是否符合要求 Y图2-4 小车控制系统整体设计2.5 循迹边界识别小车总体设计简图按照任务要求，小车需要具有循迹和边界识别两个功能。边界识别功能要I5I6探测腿I4 I3车轮万向轮电机M1、M2循迹装置I7、I8、M3接触开关I1图2-5循迹边界识别小车总体设计简图求小车的四个方向都能识别并避开边界，所以小车的四个角都应装有边界识别装置，即探测腿。循迹功能则要求小车能够先找到轨迹，再沿着该轨迹行走。因此轨迹探测装置装在小车的头部正下方。循迹边界识别小车总体设计如图2-5所示。2.6 本章小结本章根据智能小车的任务要求，从智
28、能小车本体结构和控制方法对比分析入手，初步确定智能小车的运动形式、驱动方案、传动方案和控制方案，并设计出小车的总设计简图。第3章 智能避障循线机器人结构设计第3章 智能循线避障机器人结构设计机器人要实现自动导引功能和避障功能就必须要感知导引线和障碍物，而感知导引线相当于给机器人一个视觉功能。智能循线和避障是基于智能导引小车系统，采用超声波距离传感器传感器判断并检测障碍物，采用轨迹传感器进行寻线。因此本章对智能小车的循线和避障进行了研究。3.1硬件设计智能车采用履带驱动，前后各用一个直流双向电机驱动，调制两个轮子的转速从而达到控制转向的目的。将轨迹传感器装在车体前部的下方，当传感器I3检测到黑线
29、的边界时，控制系统控制左轮电机减速，车向右修正，当车的右边传感器I4检测到黑线时，控制系统控制右轮电机减速，车向左修正，黑线在车体的中间时，传感器一直检测到黑线，当偏离黑线时就开始修正，从而使小车沿着黑色的轨道行走。避障的原理和循线一样，在车头的前方装了超声波距离传感器，当传感器检测到障碍物时，智能车停止1S之后后退，经脉冲计数器设定的额定数值之后车体向左转，再通过脉冲计数器设定数值，到达数值之后继续前进，依次循环从而避开障碍物。3.2硬件的选择和数字量输入返回1和0值不同，模拟量输入可以分辨连续的输入，所有的模拟量输入返回一个0-1023之间的值。而ROBO接口板有各种不同的模拟量输入接口来
30、测量不同的物理量。具体来说，模拟量输入可以适应用来测量电阻，测量电压和测量距离的不同的传感器如表3-1所示。通常的慧鱼传感器中，温度传感器和光电传感器将被测量装换成电阻值。所以必须将这些传感器接到AX和AY输入端。电压输入端A1和A2设计用来连接所有产生0到10V电压的传感器。在ROBO接口板上没有针对AV输入端的端口。它通常和接口板的电源电压相关联。距离传感器输入端D1和D2可以接到慧鱼特殊传感器，可以测量障碍物的距离。- 1 -第3章 智能循线避障机器人总体设计表3-1 模拟量输入输入端输入类型测量范围A1,A2电压输入0-1023VAX,AY电阻输入0-5.5KD1,D2距离传感器输入C
31、a.0-50cmAV电源电压0-10V3.2.1超声波距离传感器机器人避障的关键问题之一是在运动过程中如何利用传感器对环境的感知。任何类型的传感器都有各自的优点和不足.选用时需要仔细考虑各种因素。在机器人运动规划过程中传感器主要为系统提供两种信息：机器人附近障碍物的存在信息；障碍物与机器人之间的距离。超声波距离传感器是靠发射某种频率的声波信号，利用物体界面上超声反射，散射检测物体的存在与否，如图3-2所示。超声波在空气中传播时如果遇到其它媒介，则因两种媒质的声阻抗不同而产生反射。因此，向空气中的被测物体发射超声波，检测反射波并进行分析，从而获到障碍物的信息。超声波使由换能晶片在电压的激励下发生
32、振动产生的，它具有频率高、波长短、绕射现象小，特别是方向性好、能够成为射线而定向传播等特点。超声波对液体、固体的穿透本领很大，尤其是在阳光不透明的固体中，它可穿透几十米的深度。超声波碰到杂质或分界面会产生显著反射形成反射成回波，碰到活动物体能产生多普勒效应超声波探头主要由压电晶片组成，既可以发射超声波，也可以接收超声波。小功率超声探头多作探测作用。3.2.2轨迹传感器如图3-3，轨迹传感器可以寻找到白色表面的黑色轨道。传感器检测表面应为5mm-30mm，它包含两个发射和两个接收装置，连接该传感器需要有两个数字量输入端和9V电源端。轨迹传感器中的光敏二极管的外型与一般二极管一样，只是它的管壳上开
33、有一个嵌着玻璃的窗口，以便于光线射入，为增加受光面积，PN结的面积做得较大,光敏二极管工作在反向偏置的工作状态下，并与负载电阻相串联，当无光照时它与普通二极管一样，反向电流很小,称为光敏二极管的暗电流；当有光照时，载流子被激发，产生电子-空穴，称为光电载流子。在外电场的作用下，光电载流子参于导电，形成比暗电流大得多的反向电流，该反向电流称为光电流。光电流的大小与光照强度成正比，于是在负载电阻上就能得到随光照强度变化而变化的电信号。图3-3 轨迹传感器图3-2 超声波距离传感器图3-4 接触式传感器及其原理图3.2.3接触式传感器按键开关式（接触式）传感器是数字传感器的一种。数据仅能设定为两个不
34、同的值，分别用0和1来表示。如图3-4所示，传感器显示“0”，表示在接触点之间没有电流通过；“1”则意味着有电流通过。慧鱼模型中的接触传感器是一个三向开关式的。因此，就有三个端点。红色按钮按下，1和3端点接通，同时常闭状态下的1和2端点之间的连接断开。这样起始位置就可以任意选择：常闭状态（端点1、2接通）；常开状态（端点1、3接通）。如果接口板上输入端口电气上是闭合的，则数字量的橙色连接上会返回一个数值“1”，否则会返回一个数值“0”。3.2.4大功率马达：两个大功率直流电机（9V，2.4W），内置齿轮箱，以50：1减速比驱动移动机器人（即马达旋转50转的同时，其输出轴只旋转一次）。一个马达输
35、出通常使用两个接口板接口，而灯输出只用一个接口。接口板的输出可以是马达，也可以是灯或者电磁铁。对于马达，可以设置它的转向和速度。马达输出模块可以用表3-5中的指令来处理：表3-2 马达指令指令值动作向右1-8马达以速度1到8顺时针旋转向左1-8马达以速度1到8逆时针旋转停止None马达停止3.3智能车本体结构图3-6是本次设计机器人的电路框图。其中智能接口板为电路的中央处理器，处理超声波传感器和轨迹传感器采集来的数据，处理完毕之后随即去控制电机驱动部分来驱动电机。其中电源部分为9V直流电源，为整个电路模块提供电源，以便能正常工作。ROBO智能接口板电机驱动超声波传感器轨迹传感器电源图3-5 智
36、能避障循线机器人电路图3.3.1机器人各部分设计1.行走部分：由于设计的是避障机器人，因此机器人运行的路面情况会很复杂，采用履带式行走结构,如图3-6所示。这种移动方式支撑面积大、接地比压小，同时由于履带支撑面上有履齿，不易打滑，牵引附着性好。机器人两侧的履带分别由一个带有齿轮的直流电动机驱动。功率2.4W、额定转速为400r/min。2.避障部分：由于慧鱼创意组合模型中自带有超声波距离传感器，因此将超声波距离传感器固定在机器人的正前方，用于机器人避障。距离传感器反映机器人与障碍物的距离大小，测量距离约为4m，相应的检测数值以cm在程序检测界面显示。将其直接连到智能接口板的D1或D2端即可。3
37、.循线部分：机器人循线的功能由轨迹传感器进行控制，可以找到白色表面的黑色轨道。传感器检测表面应为5mm-30mm，它包含两个发射和两个接收装置，连接这个传感器需要两个数字量输入端和9v电源端。图3-6 智能车行走部分设计3.3.2机器人硬件安装首先，通过慧鱼创意组合模型包中的机械构架将智能小车的基本模型的框架搭建起来，然后将驱动装置（2个9V双向直流电动机）放置在框架内并固定起来。再将电气元件脉冲计数器固定在基本模型内。设定电动机M1、M2以及脉冲计数器I1、I2。并预先将导线连接在电动机和数字传感装置上，以防以后安装不便。结构设计时已经考虑到传感器的安装问题：首先将轨迹传感器安装在智能车车头
38、位置的正下方，使轨迹传感器距离与被搜寻位置的距离减小，提高反映效率。其次将超声波距离传感器装在车的正前方，以便能探测到智能车行驶前方的障碍并顺利避障。最后将两个指示灯安装在车前方的左右两端，当轨迹传感器搜寻到轨迹时灯M3(绿灯)亮，当智能车遇到障碍时灯M4（红灯）亮。这样可以保证两个传感器不会发生冲突，使整体显得协调。最后将智能接口板固定在智能车的基本模型上，用导线将各部分器件连接到接口板的各插槽中。如图3-7所示的示意图进行接口连接：1.超声波距离传感器的导线两端分别插在智能接口板的D1位置的两端口：2.脉冲计数器I1和I2的导线两端分别接在智能接口板对应的I1、I2位置；3.轨迹传感器的绿
39、色和红色导线的两端分别插在智能接口板的接地和+极输入端，将蓝色和黄色导线的两端分别接在智能接口板的I3、I4位置；4.直流电动机M1、M2导线接在智能接口板对应的M1、M2端口；5.将灯输出M3（绿灯）接在接口板的M3位置，灯输出M4（红灯）接在M4位置；超声波传感器D1脉冲计数器I1脉冲计数器I2轨迹传感器I3轨迹传感器I4直流电动机M1直流电动机M2绿色灯管M3红色灯管M4扩展板接口USB接线口电源输入智能接口板接地线端口图3-7接线示意图6.用USB接线将智能接口板连接在电脑上。注意事项：1、装配时要确保构件到位、不滑动；2、电子构件装配时要注意电子构件的正负极性，接线稳定可靠没有松动；
40、3、整个模型完成后要考虑模型的美观，整理布线要规范。3.4小结本章按照模块化的设计方法，将机器人本体结构分为行走部分、避障部分和循线部分，并分别对这三部分进行了规划设计，并选择关键的电气元件。同时使用慧鱼创意组合模型对各个部分结构进行组装，完成机器人的机械结构设计。第4章 智能小车的软件设计智能小车控制系统由软件和硬件两大部分组成，只有硬件系统是不能运行的，软件和硬件相互配合才能完成任务。在进行控制系统设计时，除了系统硬件设计外，大量的工作就是如何根据每个生产对象的实际需要设计应用程序。因此，软件设计在小车的控制系统设计中占重要地位。对于本系统，软件更为重要。在智能小车控制系统中，控制系统软件
41、可采用慧鱼自带的LLWin3.0控制软件。控制程序以及流程图和数字流程图可以生成图形化的用户界面，简单方便实用。4.1软件设计实现要求按照任务要求，小车完成一系列复杂动作如: 寻找轨迹沿轨迹行走遇到边界小车停止小车后退指定方向旋转小车前进继续寻找轨迹继续沿轨迹行走。4.2控制程序模块化软件设计的程序大体可分为循迹和边界识别两大部分。本系统软件采用模块化结构，由主程序寻找轨迹子程序、沿轨迹行走子程序边界识别子程序边界返回子程序和其他子程序构成。各模块如图41所示划分。主程序循迹边界识别前进后退左转右转停止寻找轨迹边界分类边界返回沿 轨迹行走图4-1 小车程序模块化第4章 智能小车的软件设计4.3
42、 主程序主程序开始，灯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种，并以数字形式记入value中。子程序“返回”根据value中所记的数字，选择最好的方法避开边界。程序循环运行直到数据
43、A0，如图4-3.图4-3 边界识别子程序边界返回方法的最优化按照任务要求，小车需要识别和回避所有的边界，因此需要将所有边界情况分成16种，并对每种边界进行回避,如表4-1所示。这样小车可以避免做重复而不必要的动作，提高小车的性能。表4-1小车可能遇到的所有边界情况及反应序号右前方(I3)左前方(I4)右后方(I5)左后方(I6)小车反应0向前直行1停止2向右旋转少许3向左旋转少许4向左旋转少许5向右旋转少许6先后退，再右转7向左旋转少许8向左旋转少许9向右旋转少许10向右旋转少许11向右旋转少许12先后退，再向左转13先后退，再向右转14前进少许15前进少许小车按可能遇到的所有边界情况（24
44、 =16）种设计成一个表格。如表4-1。其中表示探测腿由于遇到边界时伸出，即该限位开关I=0。如果格内为空，则表示该位置探测腿没有遇到边界，该限位开关处于导通，即I=1。例如表4-1中，序号0，I3=I4=I5=I6=1,为小车四条探测腿都没遇到边界，处于平稳状态，即小车反应为“向前直行”。小车I3=I4=I5=I6=0时，小车的反应动作为停止，即小车被抬起时停止。4.5寻找轨迹子程序程序中光电管I7装在小车头部的左侧，I8在右侧，I1为装在小车右侧用于脉冲记数的接触试传感器。程序中先往左转并循环记数5次，直到I7=0或5次后再前进5次，直到I7=8或者I8=0或者I7=I8=0时子程序完成返
45、回主程序，否则继续寻找轨迹。寻找轨迹程序如图4-4。图4-4 寻找轨迹程序4.6进、后退、停止、左右转子程序 其他程序如前进、后退、左转等，程序简单且格式相似，这里就不于累述。右转子程序，如图4-5。4.7沿轨迹行走子程序沿轨迹行走子程序中，程序首先进入寻找轨迹子程序，寻找到轨迹后，判断数据A是否图4-5 小车右转子程序=0，如果为0，程序直接退出并进入边界识别子程序，如果不为0，程序继续运行。接着程序判断I7是否=0，如果为0，程序继续判断I8是否=0，再根据I7和I8的值决定左转还是右转，如果I7=I8=1，则程序进入寻找轨迹子程序。沿轨迹行走子程序如图4-6。图4-6 沿轨迹行走程序4.8 LLWin3.0控制系统的调试4.8.1调试前的准备工作外部连线的检查：包括对输入输出信号的接线的正确性检查，对地的绝缘检查，屏蔽接线检查等；供电系统的检查：包括对接口板的供电电源接线的检查和电压检查、外部供电电的检查等；检测元件和开关的运行检查：检测元件和开关是接口板输入信号的来源，要对检测元件、开关、按钮等信号在运行后的响应进行检查，了解它们的状态是否有相应的变化等。4.8.2程序调试输入信号调试：输入信号调试前，对信号的供电应再一次进行检查，防止因供电电压不符造成元件的损
