移动机器人运动控制系统设计

1、移动机器人运动控制系统设计Design for motion control system of mobilerobot摘要：移动机器人是一种由传感器、遥控操作器和自动控制的移动载体组成的机 器人系统。它具有移动功能，在代替人从事危险、恶劣（如辐射、有毒等）环境下 作业和人所不及的（如宇宙空间、水下等）环境作业方面，比一般机器人有更大的机 动性、灵活性。移动机器人的关键技术是机器人的控制， 其中运动控制技术又是 重中之重，成为当今自动化领域技术发展的热点之一。 本文以移动机械手作为研 究对象，设计了一种准确抓取物体的运动控制系统， 利用模糊控制算法控制移动 机械手准确停在适当抓取位置。关键词：

2、移动机械手、运动控制、模糊控制算法AbstractMobile robot is a kind of robot system which consists of sensor, remote control and automatic control mobile carrier. Because it has mobile function, it more mobilityand flexibility tha n com monly robot on in stead of people work in dan ger, bad (such ais erethe radiati on,

3、 toxic etc) and not suitable for people to stay (such as space, un derwatetc) en vir onment. The key tech no logy of mobile robot is the con trol of the robot. Themotio n con trol tech no logy of robot is the top priority, and it has bee n became onehotspot of the automati on field developme nt tech

4、 no logy. This paper based on mobilerobot arm as research object, desig ned a moti on con trol system of accurately graspngobject, using fuzzy control algorithm control mobile robot arm accurately stop in theproper grasp ing positi on.Keywords: Mobile robot arm; motio n con trol; Fuzzy con trol algo

5、rithm;1、引言移动机械手是一种简单的移动机器人， 可以完成一些简单的任务，比如在排 爆上的应用，可以代替人把危险爆炸物抓取到指定地点。本文以市面上的儿童车 为基础，通过改装儿童小车来搭建移动机械手， 移动机械手工作于遥控模式或自 动模式。遥控模式下，移动机械手的运动控制通过无线遥控来实现；自动模式下机械手臂通过超声波距离传感器来提取抓取物位置信息，以抓取物位置信息作为 模糊控制算法的输入，通过模糊控制算法来驱动移动机械手运动。2、总体设计本文所设计的移动机械手运动控制系统主要由单片机(STM32F103)、显示屏、电机驱动器、无线遥控器、超声波测距传感器和透射式光电传感器等组成。 单片机

6、用来管理各模块工作，同时完成模糊控制算法运算。显示屏主要是用来显 示移动机械手运动时的一些信息，比如处于何种工作模式、是在前行还是在后退、 转弯角度和抓取物距离等信息；电机驱动器主要用于驱动改装后的儿童小车； 无 线遥控模块主要用来给运动控制系统发送控制命令，包括模式的选择、车体运动 控制等控制命令；超声波测距模块主要用于探测物体距离，当然在移动机械手移 动的时候也可以用于探测障碍物防止移动机械手在运动时发生机械碰撞；透射式光电传感器主要用于记录脉冲数，和编码盘配套使用后用于提取转弯角度和移动 机械手相对位移信息。运动控制系统工作过程如下：运动控制系统初始化后处于 模式选择界面，如果抓取物离的

7、远，先选取遥控模式通过遥控器来控制移动机械 手靠近抓取物。当距离达到指定的范围内后，退出遥控模式进入自动模式，用模 糊控制算法分析超声波测距传感器得到的抓取物信息后自动控制移动机械手到 达合适的抓取位置。移动机械手运动控制系统方案框图如图一所示。图一移动机械手运动控制系统方案框图图二RO3BS接收模块实物图+5V%100沱间随意调整3、硬件设计3.1部分硬件介绍A :无线遥控器无线遥控器采用南京普闻视听电子公司的 R03BS无线遥控器，它包括发送和接收模块。该无 线遥控器为四路遥控器，信号输出可以是单路也可 以是双路，工作频率为 315MHz，遥控最大距离为 80M。图二为R03B骸收模块实物

8、图，图中可以一共 有7个引脚，其中+5V和G是电源接入端，D0D3 为接受信号的输出端。B:电机驱动模块mi nilBT电机驱动器是专为智能车、模型车及 工业产品等而设计的高性能直流有刷电机全桥驱动 器。输入端包括电源输入端口、电机连接端和信号 控制端。其控制信号很简单，只有片选 (EN)、正转 (RPWM和反转(LPWM信号。正、反转控制信号可以 为高电平也可 以为PWMI号，PWMI号占空比可以在C:超声波差距模块HCSR04超声波测距模块可提供2cm 400cm的非接触式距离感测功能， 测量精度可达3mm。它一共有四个引脚，分别是+5V、GND、触发信号输入和 回响信号输出，其控制方式比

9、较简单，只要给触发信号（至少10us的高电平信号） 就会有信号输出。其测试距离的计算如下：测试距离二高电平时间*声速/2（其中声速为340m/s）D:透射式光电传感器图三 GK102电路图GK102是透射式光电传感器，其电路图如图三所示。 左边为发光二极管，右边为光电三极管，当左边加正向电 压时右边导通，当左边加反向电压时右边截止。 与编码盘 配合使用可以用于检测转弯角度信号和机械手臂移动位 移信号。其获取信号的原理如下：首先编码盘是一块边缘 均匀打着小洞的圆盘，把圆盘的边缘放在 GK102的凹槽 里，当圆盘转动的时候，由于小洞的存在 GK102发光二 极管发出的光有时通过小洞射到光电三极管上

10、，三极管导 通得到一个信号。3.2硬件连接根据儿童车的双后驱和独立转弯模式可知儿童车有三个电机要驱动，所以移动机械手运动控制系统需要三个 minilBT。三个minilBT全部采用PWM信号控 制，STM32F103单片机有4个定时器，每个定时器有4个通道，每个通道都可 以方便的产生PWM波。本设计中选用通道1和通道4分别作为minilBT的RPWM 和LPWM ； TIM2控制转弯电机、TIM3控制左轮电机、TIM4控制右轮电机。三 个minilBT的EN分别由PD0 PD2控制；无线遥控器的D0D3分别与PC0- PC3相连；由于需要判断抓取物的相对位置，抓取物的相对位置包括距离和方向 信

11、息，其中距离信息可以直接从 HCSR04超声波测距模块反馈信号得到，但 是方向信息却不能单从HC SR04中得到。所以设计中使用3个HCSR04,分 别安装在车头的中间、左边和右边，通过对比 3个HCSR04返回的信号就可 以得出方向信息。比如抓取物在车声左边边，那么左边的HCSR04返回的距离信息比中间和右边的HC SR04返回的距离信息就要短。HCSR04的触发信 号采用脉冲触发，每60ms发送一次脉冲，回响信号的捕获采用定时器的输入捕 获功能，STM32F103每个定时器的通道2都具有输入捕获功能。触发信号与定 时器通道3连接、回响信号与定时器通道2连接，TIM2 TIM4分别对应左、中

12、、 右三个HCSR04超声波测距模块；运动控制系统中要控制转弯角度和相对位 移，所以在设计中采用2个GK102透射式光电传感器，编码盘一个安装在方向 盘上一个安装在车轮上用于提取转弯角度信号和位移信号。两个GK102的输出引脚与PC8和PC9相连，与PC8相连的用来获取转弯角度， 与PC9相连的用来 获取位相对位移。4、模糊控制算法的设计模糊控制是一种基于规则的控制，它直接采用语言型控制规则，出发点是现 场操作人员的控制经验或相关专家的知识， 在设计中不需要建立被控对象的精确 的数学模型。移动机械手的运动系统和汽车驾驶系统很相似，汽车驾驶是一个比较复杂的问题，难以建立精确的数学模型和用数学解析

13、式描述 ；有经验的驾驶 员能把汽车驾驶的很好，这主要是依靠他们的经验。依据这个思路，采用模糊控 制算法，解决移动机械手的运动是一个很还的解决方案。根据硬件电路设计可知，HC SR04的距离信号可以用来判断抓取物的距离 和方向信息，转弯角度和移动机械手运动相对位移是用来控制移动机械手和抓取 物的相对位置。本设计中采用两个独立的模糊控制器来控制转弯角度和运动相对位移，输入量分别是距离和方向信息。为了实现的简便性与快速性，在本系统中 都采用二维模糊控制器结构形式，即输入量E和变化率Eco控制转弯角度的模糊 控制器设定输入变量方向(E1)和方向变化率(E1c)语言值的模糊子集为负大，负 小，零，正小，

14、正大(负代表左，正代表右)，并简记为NB，NS，Z，PS, PB ， 输出量转弯角度(K1)的模糊子集为NB，NM，NS，Z，PS, PM， PB ;同理 控制运动相对位移的模糊控制器设定输入变量相对位移(E2)和相对位移变化率(E2c)语言值的模糊子集为负大，负小，零，正小，正大(负代表远，正代表近)， 并简记为NB，NS，Z，PS，PB ，输出量运动相对位移(K2)的模糊子集为NB， NM，NS，Z，PS， PM， PB 。输入变量的隶属函数的论域定为-2，2，输出 变量的隶属函数的论域定为-3，3。隶属函数均选为灵敏度高且在论域范围内均 匀分布、等距离的三角形函数。根据驾驶汽车的经验，E

15、1、E1c和K1应满足以下规律：(1) 当|E1较大时，同时|E1c|较大时，应取较大的K1 ;(2) 当|E1|中等时，应取适当的K1 ;当|E1较小时，同时|E1c|较小时，应取较小的 K1 oE2、E2c和K2应满足以下规律：(1) 当|E2较大时，同时|EN|较大时，应取较大的 K1；(2) 当|E2|中等时，应取适当的K1 ;(3) 当|E2较小时，同时|E1c|较小时，应取较小的 K1 o基于上述考虑，将E和变化率Ec作为模糊控制器的输入，K1和K2的模糊NBNSZPSPBNBPBPBPBPBPMNSPMPMPSPSPSZPSZZZNSPSNSNSNSNMNMPBNMNBNBNBN

16、B控制规则分别如表1、表3所示 表3 K1模糊控制规则表NBNSZPSPBNBPBPBPBPMPMNSPMPMPSPSPSZPSZZZNSPSNSNSNSNMNMPBNMNMNBNBNB表3 K2模糊控制规则表5、系统软件设计根据移动机械手运动控制系统可知，系统软件要实现对显示屏、mi nilBT电 机驱动器、RO3BS无线接收模块、HCSR04超声波测距模块和GK102透射式 光电传感器等器件的控制(包括初始化、控制信号的输出和返回信号的获取等 ); 还包括信息显示、传感器信号的处理和模糊控制算法等一些事件的完成。系统软 件设计采用模块化设计方法，整个系统主要由系统主程序和各功能子程序组成。

17、主程序主要完成系统初始化、界面的显示 （包括欢迎界面、模式选择界面和模式 信息界面等）、各模式之间的切换、遥控信号的接受等功能。各功能子程序主要 包括遥控驱动、读取遥控信号、抓取物相对位置获取、模糊控制算法和自动驱动 等子程序。主程序流程如四所示。6、结论通过多次对不同距离、不同环境目标物抓取试验后，移动机械手能在正常条 件下顺利完成抓取位置的停靠，达到设计要求。遥控模式下运动控制系统运行稳 定，能正常响应控制命令； 自动模式下如果目标物在开阔的环境中系统能很快的 找到目标物， 顺利的完成抓取位置的停靠。 但是在比较复杂的环境中寻找目标物 会比较慢甚至是失败， 在这方面运动控制系统还有待改进。 总体来看移动机械手 运动控制系统还是达到设计要求，可以胜任正常条件下的物体抓取任务。参考文献：1 张毅, 罗元, 郑太雄 . 移动机器人技术及其应用 M. 北京: 电子工业出版 社 , 20072 王英健 , 王玉凤, 范必双 . 基于智能模糊控制的汽车自动驾驶系统 J. 微机 发展, 2004, 14(12):19-23.3 董宗祥 . 基于 ARM 的自寻迹机器人小车的研发 J. 东华大学硕士学位论文 , 2010.作者信息：王平