机电系统控制与机器人控制实验

1轮式机器人关键技术及其应用分析1、引言随着电子技术和计算机技术的快速发展，机器人技术的研究和发展受到了越来越多的关注。机器人是当代自动化技术和人工智能技术发展的典型体现，是高新技术的代表，它融合了精密机械、电子信息、传感器、计算机、人工智能、自动控制等许多学科的知识，涉及到当今许多科技前沿领域的技术，可应用到宇宙探测、海洋开发、工厂自动化、建筑、采矿、军事、农业等各个领域。2、轮式机器人机器人就驱动方式而言，可以分为轮式机器人、履带式移动机器人、腿式移动机器人等。本文中主要介绍的是轮式机器人。轮式机器人(WheeledMobileRobot)是移动机器人的一个重要分支，其应用领域广泛，应用前景十分可观。轮式机器人的运动形式机构具有自重轻、承载大、机构简单、行走速度快、工作效率高、驱动和控制相对方便、机动灵活等众多优点。轮式机器人按照车轮数目的同步又有不同的分类，本文主要讲和实验相同的四轮机器人。当在平整地面上行走时，这种机器人是最合适的选择。3、轮式机器人关键技术3.1轮式机器人系统概述轮式移动机器人系统主要包括：机械结构、电器结构和控制系统等。轮式机器人车体由车架、电池组、直流电机、车轮和传感器等组成，是整个机器人的基础部分，车体机构如下图所示。23.1.1机械系统其机械部分包括传动系统、转向系统、行驶系统和传感器支架等。智能车机械系统，对智能车是至关重要的一部分，机械系统的发挥空间很大。机械系统主要包括转向舵机、传感器机械结构、车辆悬架系统等。其中涉及的工作包括转向舵机改装、车模刚度调校、差速器调整等。车模舵机原始支架不符合汽车转向关系，需要对其进行改装使其符合汽车转向关系。传感器支架需要吸收车模震动对传感器的干扰，也需要减少车的转动惯量。传感器会改变车模重心，让车模重心远离地面或车中心，这样会影响到车模轮胎附着力分配，影响车模加速和转向性能。车模悬架系统调校可以使车模远离共振，有更好的地面附着性能。车模整体刚度调整让车模转向灵敏也不超调。试验中舵机安装如下：舵机安装3舵机是智能车的转向执行部分，对车模来说，转矩越大越好，原装舵机的支撑方面不能发挥出舵机转矩的极限，可以改装舵机使车模的转向系统更加灵敏。目前舵机主要有三种安装方法：卧式（可前置、后置）、扣式和立式。三种方式各有优缺点，实际安装视具体情况而定。动力传动系统由电机、电机齿、差速器和半轴。动力传送系统在智能车运行中可以实现倒车功能，减速增扭，还具有差速作用，在必要时还可以中断动力，使汽车停下来。转向系统如下图所示，包括舵机、舵机支架、舵机圆盘、舵机连片、拉杆、车轮、车轮支撑臂。转向系统是比较复杂的一个系统，转向系统调校的好，小车的行驶会特别顺畅和轻盈。汽车转向系分为机械转向系和动力转向系两大类。机械转向系以驾驶员的体力作为转向能源，传力件都是机械的；而动力转向系以发动机或电动机的动力作为主要转向能源，转向轻松省力。主要有液压助力转向和电动助力转向两种类型。智能车转向系统为机械转向系，结构上与汽车的转向结构类似。汽车的转向系统因前悬挂不同分为非独立转向系统和独立式转向系统，智能车前悬架为独立式悬架，转向系统是参考汽车独立悬架转向系统设计的。转向系统汽车行驶系统包括：车架、车轮、悬架和车桥。车架主要是接受传动系统的动力，通过驱动轮与路面的作用产生牵引力，使汽车正常行驶，要求具有足够的强度和适当的刚度即可。车轮则通过和汽车悬架共同缓冲减振，从而保证汽车具有良好的乘坐舒适性和行驶平顺性，使用中保证车轮具有良好的附着性，与路面相互作用产生驱动力、制动力和侧向力，以提高汽车的牵引性、制动性和通过性，车轮同时还承受汽车重力，并传递其他方向的力和力矩，降低滚动阻力，提高汽车的燃油经济性。汽车前悬架最重要的是前轮定位，前轮定位参数是转向轮、主销和路面之间的相互位置关系。具有自动回正作用，保证汽车直线行驶的稳定的作用。4电机是车模前进的动力装置，车模加减速特性、行驶过程中的速度响应都由电机特性决定。驱动系统包括电机、主减速器、差速器、电机驱动板、速度传感器及其支架。该系统中电机是车模行驶快慢和反应响应的关键，驱动系统中车速传感器是速度闭环控制的关键，对车速传感器的要求是车辆在行驶过程中，速度记录丢失在5%以内。电机驱动电流满足电机最大过载电流，通态电阻越小越好。车轮差速器是车辆转向时的轮速差实现机构，需要经常维护。电机驱动系统传感器固定支架在智能车中不可缺少，设计传感器支架需要在结构、自由度以及材料上下功夫。结构方面在满足功能的情况下，尽量将支架设计的更小、更巧妙。这样不仅可以降低整车重量还可以有效避免支架与周边的干涉风险。自由度方面主要考虑需要几个可调节的量、几个自由度，比如摄像头在做智能车的前期阶段是不能确定高度和仰角的。此时需要设计可上下调节高度，同时可以调节俯仰角的支架。材料方面需考虑加工方便、价格便宜且质量小，所以首选铝质材料。对于不需要折边的支架可以选用PCB加工。3.1.2电器系统电器部分包括核心板、电源模块和驱动模块。我们用到的是5225核心板，5225是目前客户使用比较少的芯片，中文资料比少，使用的用户不是特别多，主频一般是80M。其外形如下图所示。核心板必须使用下载器，不同的核心板需要不同的下载器。下载器是系统板必需的调试工具，在使用下载器时，需要查看系统板的BDM脚和下载器定义的BDM下载脚。55225核心板电源模块把电池电压稳定地转换到系统各个部件需要的电压。该电源模块把7.2V电压转化到3.3V、5V、6V、12V电压。电源模块进行稳压时，特别是对传感器进行供电的电压，随着电池电压变化的幅度越小越好。而转接模块是核心板与传感器、驱动模块、电源模块连接的桥梁，具有很好的通用性。转接模块如下右图所示。电源模块转接模块传感器是车模识别系统的关键，不同类别的传感器其识别原理不一样。有光感传感器和磁感传感器。主要目的是能够识别路径，尽量少丢线。在智能车的制作过程中，传感器的图像识别需要做大量的工作。光感传感器在识别路径时，外部光线变化和车模振动会导致图像识别误差。传感器支架需要能够减少车模振动对传感器的影响，同时也是越轻越好。电机驱动模块是连接单片机、电池和电机的模块，能够由单片机控制驱动电机的输出电流，来控制电机驱动力。电机驱动模块能够满足驱动电机正转、反转、能耗制动功能要求。电机驱动模块能够提供的电流必须大于电机的最大电流，这6样才能发挥电机的驱动力。一般小车的驱动模块是BTN7970H桥或者是33886组成的H桥。33886BTN7970H桥4、轮式机器人的模糊控制避障模块研究智能轮式机器人在行走过程中，会面临复杂变化环境，精确的数学模型较为难以建立，因此模糊控制方法非常适用于智能轮式机器人建立环境模型。4.1智能轮式机器人系统设计智能轮式机器人系统由硬件系统和软件系统两部分组成。硬件系统主要由电源模块、超声波测距模块和电机驱动模块成。该轮式机器人有2个直流电机，分别驱动左右两个车轮。直流电机得到正反相电压，分别产生正反转。运用左右轮的不同正反转组合，驱动智能轮式机器人前后移动以及左右转向。同时，电机驱动模块通过PWM脉宽对电机进行调速。4.1.1硬件结构电源模块采用嵌入式主控系统和非主控系统分别进行供电的方式。使用2块15V的电池，每块电池分别使用LM2678芯片将电源电压降至5V，输出端分别接入嵌入式主控系统和非主控系统。超声波驱动部分以嵌入式控制器为核心，包括超声波发射驱动和超声波接收中断驱动。在超声波发射驱动部分，嵌入式控制器产生40kHz的方波信号，通过74HC14M芯片的调制，由超声波发射换能器发射超声波。由于超声波在传输过程中，会产生能量衰减，因此需要在接收超声波回波后进行放大操作。在超声波接收驱动电路中，由接收换能器接收回波，进行两级放大电路。前级使用NE5532电路进行放大和滤波，将信号放大10000倍。后级使用LM311比较器，获得超声波信号触发嵌入式控制器中断，最后由74HC14进行调制，嵌入式控制器获得信号并进行相应处理。智能轮式机器人的电机驱动模块采用左右轮驱动。左右轮前后转动组合以及机器人运动方向关系为：71）左轮正转，右轮正转，机器人前进；2）左轮反转，右轮反转，机器人后退；3）左轮正转，右轮反转，机器人右转；4）左轮反转，右轮正转，机器人左转。左右轮各由一个24W直流电机驱动。电机驱动芯片选择ST公司的L298N芯片，该芯片包含2个并联的H桥，进行电流闭环控制以提高控制效率。嵌入式控制器控制PWM脉宽，经过施密特触发器74HC14进行调制，对电机进行速度调节。4.1.2避障模糊控制器1）采集障碍物信息。智能轮式机器人通过传感器采集障碍物的方向、距离等信息。控制器根据采集到的障碍物信息和自身运行状态，调整电机运行动作，完成避障功能。2）建立模糊控制规则。智能轮式机器人的转向和速度分别与障碍物的分布、距离相关。因此建立模糊控制规则为速度变量v和转角变量φ。不同方位的障碍物信息，改变转角变量φ，障碍物的距离改变速度变量v。3）去模糊化处理。为了获得确定控制信息，需要将模糊量转换为精确量，因此将模糊变量进行去模糊化处理。本文使用加权平均算法得到转角变量φ的最终输出量。对于速度变量v可做同样处理。4.1.3软件系统首先，嵌入式控制器对GPIO进行初始化。嵌入式控制器输出40kHz的信号后，打开中断，同时，定时器开始计数。如果定时器计数溢出，说明在预定的距离内没有障碍物，智能轮式机器人不需要进行避障行为。如果外部中断产生，说明预定距离内有障碍物，此时关闭中断。从定时器获得时间T。时间T就是超声波的传播时间。根据测距公式计算出智能轮式机器人和障碍物之间距离。超声波在空气中的传播速度需要考虑温度的影响。速度v=331.5+t/273（m/s），其中，t为空气温度。在室温下，取超声波速度约为343.2m/s。智能轮式机器人通过5路超声波传感器（前侧、左前侧、右前侧、左侧、右侧）探测到的障碍物信息，根据障碍物距离与即时速度，经过通过模糊控制算法计算后，控制直流电机执行自主避障动作。根据不同的方向的障碍物，驱动智能轮式机器人进行左转或右转动作。经过恒速试验，智能轮式机器人避障动作正确，可以完成避障效果。5、收获心得通过课程的学习，让我对轮式机器人有了略微详细的了解，对运动形成的流程有了比较清晰的认识。通过自己动手组装，对具体的机械部件和各个控制模块有了更深的了解。我总结的是：控制系统＝宏观构想＋硬件开发＋软件调试＋系8统联调。如果把轮式机器人比作有思想的活机器的话，那么软件的调试和硬件电路板的开发就是它的灵魂，系统模块化的设计构建就是它的基础。但是在几周实验课程上，在软件的调试上我还只是停留在通过设置来使用系统自动生成的程序，要自己来编译程序还是有很大的困难，语言的学习还是有待加强。值得一提的是，在学习新东西的过程中，难免会遇到一些难题，但是现在都能够自己耐心寻找解决方法，循序渐进的学习也是继续科研的必备技能之一。轮式机器人的开发是一门很深奥的学科，仅仅这几周的学习肯定是远远不够的，但是在这段时间的学习中也收获了很多，不仅仅对智能车有了进一步的认识，更学会了思考问题，培养了自己对轮式机器人的兴趣。参考文献：[1]赵冬斌,易建强.全方位移动机器人导论.北京：科学出版社，2010.[2]张毅,罗元，郑太雄.移动机器人技术及应用.北京：电子工业出版社，2007.[3]李磊，叶涛.移动机器人技术研究现状与未来[J].机器人,2002,24(5):475-480.[4]常勇等.轮式移动机器人运动学建模方法[J].机械工程学报,2010,46(5)：30-36.[5]蔡自兴.智能控制及移动机器人研究进展.中南南大学学报,2005,36(5)：721-726.[6]孙炜等.模糊小波基神经网络的机器人轨迹跟踪控制[J].控制理论与应用,2003,20(1)：49-53.9机器人控制实验报告一、实验目的掌握XS128单片机普通I/O口输出功能的使用。二、实验原理MCU的很多引脚和片上功能模块复用。当引脚的复用功能未使用到时，那么引脚作为普通I/O口使