关键词:全方位移动机器人;远程脑;Zigbee技术; 麦卡纳姆轮
Ding ru1, Zheng tong1,2, Zhao li1
(1.Automation Engineering Department, Tianjin University of Technology and Education, Tianjin 300222, China;State Key Laboratory of Precision Measuring Technology and Instruments, Tianjin University, Tianjin 300072, China)
丁茹1, 郑桐1,2,赵丽1
(1.天津工程师范学院自动化工程系,天津 300222;2.天津大学精密测试技术及仪器国家重点实验室 天津 300072)
Abstract: The conception of remote- cerebellum based on remote-brained conception is present in this paper. According to it, the Omni-directional mobile robot based on Zigbee Technology is designed. And the hardware design scheme of each function module in the robot is introduced in detail. This paper also analyzes and demonstrates the realization scheme.
Keywords: Omni-directional mobile robot; Remote-brained ;Zigbee Technology; Mecanum wheel
1.引言
1998年日本东京大学井上研究所提出的“远程脑”[1-2]概念,是移动机器人控制体系结构的进步。近年来,移动机器人的应用领域和应用范围正逐渐拓宽,全方位移动机器人由于具有平面运动的全部三个自由度,理论上可以在任何角度以任何速度在机器人所处平面上运动,因此具有广阔的应用前景和良好的社会效益[3]。本文在远程脑的基础上,提出了远程小脑的概念,将远程脑概念分为远程大脑和远程小脑两部分。远程大脑同样安装在机器人体外,远程小脑则安装在机器人体内,两者之间以及机器人之间采用Zigbee模块构建通讯网络。这样,远程大脑控制远程小脑,向远程小脑下达各项指令和命令,再由远程小脑控制机器人体内的各个功能模块,指挥机器人完成各项任务,并且机器人之间可以通过Zigbee组网,实现信息交换和资源共享。
2.全方位移动机器人本体设计
基于远程脑的类人机器人本体采用模块化设计,其结构框图如图1所示,包括智能模块(小脑)、无线通讯模块、机械手控制及驱动模块、车体运动控制及驱动模块、传感器信号采集及处理模块、语音模块等。
图1 机器人本体结构框图
Fig.1. The configuration diagram of the robot body
2.1 无线通讯模块
由于机器人大小脑分离,且机器人有一定的活动范围,因此,本设计采用无线通信模块进行远程大脑和机器人小脑之间的信息传输,省掉了通信线缆,便于机器人移动。远程大脑处理操作者的命令,并将处理后的控制指令进行编码后,通过无线传输模块发送到小脑,小脑接收命令后,经过分析、判断,将分解的指令传送至各运动模块的控制器,同时小脑将采集的各种信息编码后通过无线通讯模块传送至大脑。考虑到远程大脑和小脑之间命令传输的准确性、快速性以及通讯距离的远近等要求,本设计选用了Chipcon公司的基于ZigBee协议的CC2420EM射频模块。ZigBee是一种新型的短距离无线接入技术,与蓝牙相比,它具有低成本、低功耗、组网方便、可实现自路由功能和数据的可靠传输等优点[4]。CC2420是Chipcon公司推出的首款基于ZigBee技术的射频收发器。它只需极少数外部元器件,性能稳定且功耗极低,可确保短距离通信的有效性和可靠性。利用此芯片开发的无线通信设备支持数据传输率高达250kbps,可以实现多点对多点的快速组网[5]。CC2420EM模块集成了CC2420及其所需的外围电路。机器人小脑与射频模块的具体接口电路如图2所示。单片机通过4线SPI总线(STE1、SIMO1、SOMI1、UCLK1)控制和设置芯片的工作模式,并实现读/写缓存数据,读/写状态寄存器等。通过控制FIFO和FIFOP引脚接口的状态可设置发射/接收缓存器,FIFOP引脚必须连接到单片机的中断引脚。通过CCA引脚状态可以得到空闲信道估计。通过SFD引脚状态可以得到发射帧和接收帧的定时信息从而判断系统的工作状态,SFD引脚应该接到单片机的时钟捕捉引脚。
图2 单片机与CC2420的接口电路
Fig.2 Interface of MCU and CC2420
2.2 车体运动控制及驱动模块
本文所研究的行走载体,由麦卡纳姆轮系(Mecanum wheels)构成。麦卡纳姆轮系是移动机器人中常用的全方位移动机构,它可沿任意平面方向灵活运动,尤其具有左右横移和原地仅以自身半径转动的独一无二的功能[6-7]。
车体采用四轮移动机构,四个麦卡纳姆车轮分别由四个直流电机独立驱动,通过对这四个电机转速的控制,就可以实现其横向、纵向、绕自身中心旋转以及斜向等移动。每个麦卡纳姆车轮由两部分组成:主动的轮毂和轮毂外缘按一定倾斜方向均匀分布的多个被动滚轮组成。
图3 麦卡纳姆车轮结构与速度示意图
Fig.3. Sketch map of Mecanum wheels’ configuration and speed
该机器人运动控制的核心为一块Atmega128。每个麦卡纳姆车轮由一台直流电机配合减速器独立驱动,每个电机由4个功率器件VMOS(IRLZ44N)组成桥式电路,为了获得较好的动态性能和低速的平稳性,故采用H型PWM调速方式,同时实现了正、反转运行以及制动。
2.3 机械手控制及驱动模块
机械手部分采用专门的两块模块分别控制两个机械手。驱动模块控制机械手的动作,位姿检测装置实时检测动作关节的位置与姿态,反馈给小脑,小脑判断是否完成用户指令。当没有完成用户指令时,继续执行用户指令;当已经完成用户指令时,机器人小脑通过无线传输模块通知远程脑已经完成用户指令。
2.4 传感器信号采集及处理模块
对于机器人而言,传感器就像它的眼、耳、鼻,能够帮助机器人正确分辨它所处的环境,为机器人顺利完成自己的工作提供帮助。传感器的数量和种类很多,本文根据设计需要,采用了探底光电传感器、探边光电传感器和超声波测距传感器。机器人上所有传感器由一单独的单片机进行控制采集,并通过小脑实时向上位机发送信息。当上位机发出指令使机器人向某个方向运动时,会同时发给传感器模块对应信息,则传感器模块会查询对应方向的传感器信号,并及时将其反馈给上位机进行处理,当出现紧急情况,如将要撞到墙壁或物体,则传感器模块会首先发给车体控制模块一个中断信号,使其停车,然后再反馈上位机进行处理,并继续查询。各传感器有效距离如表1所示。
Table1. Efficiency distance of used sensor
2.5 语音模块
从人性化设计方面考虑,本设计增加了语音模块,这样在遇到人员阻挡或者是遇到障碍的时候,机器人可以根据上位机指令要求或外部输入信号发出的要求,通过语言模块发出警报,通知操作者或提示障碍源,从而避免发生事故。机器人语音模块结构如图4所示。
图4语音模块结构框图 图5 全方位移动机器人实物图
Fig.4. Speech module frame Fig.5. Omnidirectional mobile robot
3.实验研究及分析
全方位移动机器人的样机如图5所示。经行驶试验,全方位移动机器人可以实现前、后、左、右、左前、右前、左后、右后、逆时针、顺时针的平稳运动。直线行驶具有良好的线性度,原地旋转任意角度后,位置误差较小。由于该机器人采用的电机为带减速箱的减速电机,故其在小角度斜平面上可以自锁停滞,也可以慢速移动。机器人运动灵活平稳,且运动不受限于所处工作空间,可使其应用范围更为广泛。但由于未考虑的总体重量以及外形尺寸,机器人的体积与重量还有变化的空间。
4.总结
本文在“远程脑”的基础上,提出了“远程小脑”的概念,二者之间采用Zigbee技术进行通信,并采用Mecanum式全向移动轮及模块化设计方法,实现了全方位移动机器人的本体设计,最大限度地提高了机器人的自主性。由于该机器人具有无线通讯、全方位移动、自动避障和机器手夹取等功能,因此可以用于很多路面相对平坦的工作场合,而且以此机器人为平台,可以开发出更先进更完善的机器人。
参考文献
[1] MASAYUKI INABA. Remote-brained humumanoid project [J]. Advanced Robotics, 1997, 11(6):605-620.
[2] JAMES J. Dynamically-Stable Motion Planning for Humanoid Robots [J]. Autonomous Robots, 2002, 12: 105-118.
[3] 熊蓉,张翮,褚健等.四轮全方位移动机器人的建模和最优控制[J].控制理论与应用.2006,23(1):93-98
[4] 金纯,蒋小宇,罗祖秋.ZigBee与蓝牙的分析与比较[J].标准与技术追踪.2004,6:17-20
[5] Chipcon, CC2420 2.4GHz IEEE 802.15.4/ZigBee-ready RF Transceiver Data Sheet
[6] 石为亮,王兴松,贾茜.基于Mecanum轮的全向移动机器人的研制[J].机械工程师.2007,9:18-21
[7] 吕伟文.全方位轮移动机构的结构设计[J].机械与电子.2006,12:63-65
基金资助:面向太空服务机器人感知的多模式微型化人机接口技术研究,国家高技术研究发展计划(863计划)项目(2007AA04Z254)
作者简介:
丁茹:(1977-)女,吉林省农安人,讲师,硕士,主要研究方向:测控技术及仪器。电话:1382114603,Email:huangjiaxiang@gmail.com 或 jydr_2002@eyou.com