全向移动机器人驱动万向轮的设计与实现

2017-01-05王慰军杨桂林陈庆盈

工程设计学报 2016年6期

关键词：全向轮子移动机器人

王慰军，杨桂林，张驰，陈庆盈

(中国科学院宁波材料技术与工程研究所，浙江省机器人与智能制造装备技术重点实验室, 浙江宁波 315201)

全向移动机器人驱动万向轮的设计与实现

王慰军，杨桂林，张驰，陈庆盈

(中国科学院宁波材料技术与工程研究所，浙江省机器人与智能制造装备技术重点实验室, 浙江宁波 315201)

全向移动机器人使用无解耦机构的驱动万向轮在转向时会派生出额外的滚轮滚动输出，这会导致运动的不稳定以及增加控制算法复杂性.为了解决驱动万向轮转向运动与驱动运动之间的耦合问题，通过在驱动万向轮内加入差速行星齿轮机构，合理地设置该行星齿轮组的输出传动比，可以将转向时的派生滚动输出从转向运动中解耦，实现了对机器人运动的精确控制，提高了机器人运动平稳性.最后通过对机器人进行运动学分析，得到了输入转速与机器人运动速度之间的关系，验证了机器人的全向移动功能，并为机器人运动控制提供了依据.

全向移动机器人；差速行星齿轮；运动学分析；解耦；驱动万向轮

全向轮式移动机器人因比腿式移动机器人更易于加工制造，承载能力和效率更高，运动灵活以及能在狭窄和拥挤的环境中运行，而得到了越来越广泛的应用[1].目前轮式移动机器人常采用的轮子有3种：普通轮、全向轮以及球形轮[2].普通轮就是日常所见的在各类车辆上使用的轮子；全向轮是在普通轮的圆周上再安装上一定数量的滚子，又被称为麦克纳母轮；球形轮是一种形状为球形的滚轮[3].三者之中普通轮结构最简单，但是其不能提供全向移动功能.麦克纳母轮的设计以及控制较为繁琐，由于轮子的圆周上均匀分布着许多小的滚子，在运动时不可避免地产生振动和打滑，而球形轮的运动控制又较为困难[4].基于上述原因，在设计全向移动机器人时考虑采用另外一种形式的轮子，即：万向轮作为移动机器人的移动基础部件[5].因其具有2个运动自由度，运动过程又可保持连续，所以它可提供完全的机动性与灵活性并且能实现全向移动功能.

1 驱动万向轮结构设计

所要设计的驱动万向轮[6-8]具有绕水平轮轴滚动和绕垂直轴转动的自由度，通过2个电机分别给这2个方向的运动自由度提供动力，只要控制这2个电机就可以实现对该万向轮的控制[9-12].基本设计思路是：一个电机(称为驱动电机)通过传动系统把运动传递给滚轮，使它滚动；另一个电机(称为转向电机)通过传动系统把运动传递给支撑框架，使它带动滚轮实现转向运动[13-15].其具体原理如图1所示，图中数字表示万向轮上各个齿轮和滚轮的标号.

图1 驱动万向轮传动原理Fig.1 Driven principle of powered caster wheel

但此时会出现一个问题，从图1中可以看出齿轮6通过支撑轴安装在转向框架上，转向电机通过传动齿轮带动滚轮绕垂直轴线转向时会使齿轮6在绕齿轮5转动的同时绕自身支撑轴旋转，这样会使滚轮在转向时产生额外的滚动输出，形成转向运动与滚动输出的运动耦合.这部分额外的滚轮运动将会造成驱动万向轮的运动不稳定，并且将增加控制算法的复杂性，使得整体协调控制难度加大.为了解决上述问题，必须设法从结构设计上消除这部分额外的滚动输出.为此，考虑在驱动传动系统和转向传动系统之间加入一个差速行星齿轮组，利用该差速行星齿轮组具有的1个输入可以产生2个输出的特性，使转向电机的运动分为2个部分：一部分通过传动系统带动滚轮转向，另一部分通过传动系统带动滚轮转动，这样只要这2个运动获得一定的匹配就可以把额外的滚动输出消除，使得额外的滚动输出运动从转向运动中得到解耦.具体原理如图2所示，数字表示各个齿轮标号.

图2 加入解耦机构的驱动万向轮传动原理Fig.2 Driven principle of powered caster wheel with decoupled mechanism

下面对驱动万向轮的运动解耦原理进行分析.此处设驱动电机的输入转速为nd，转向电机输入转速为ns，驱动电机通过传动系统传递给轮子的输出转速为ndr，转向电机通过传动系统传递给框架转向时的转速为nsk，由转向所引起的轮子额外转速为nsr，轮子最终的滚动转速为nr.

其中各组齿轮传动比表示如下:

由此可得各转速如下：

nr=ndr+nsr，

(1)

(2)

(3)

(4)

(5)

由以上关系式可见，只要合理设置各个齿轮的齿数使得关系式(6)得到满足，就可以消除转向电机对于轮子滚动输出的影响，达到运动解耦的目的.

(6)

图3 驱动万向轮结构图Fig.3 The structure diagram of powered caster wheel

2 全向移动机器人结构设计

在移动机器人本体上将驱动万向轮进行合理布局，这里采用2个驱动万向轮和2个随动辅助万向轮的组合形式，对角线对称布置，最后设计形成的移动机器人的外形结构如图4所示.

该全向移动机器人主要由本体、2个驱动万向轮、2个随动辅助万向轮以及连接本体和各个万向轮的悬架结构所组成.4个万向轮安装在本体底部并呈对角线对称布置，保证整个机器人在执行直行、侧行、斜行、原地旋转等运动时的平稳性和可靠性.因底部采用了四轮布局方式，所以本体与各个万向轮需要通过悬架连接在一起，这样能保证机器人在凹凸不平的路面上平稳行走以及四轮同时着地，通过悬架结构中的弹簧能有效减少和降低机器人在运行过程中的振动与噪音，并能根据实时路况做到相应的自适应调节.其中驱动万向轮与本体的连接采用四点支撑、两点导向悬架，随动辅助万向轮与本体连接采用单点支撑、单点导向悬架.整个机器人的运动由2个驱动万向轮的驱动电机(如图5所示)通过传动系统来实现，机器人的运行方向变换由安装在2个驱动万向轮上的转向电机(如图5所示)通过传动系统来实现.因此，我们可以对驱动万向轮上的各个电机作运动控制，通过各电机的联动就可以实现整个机器人在不改变运动姿势的前提下实现直行、侧行、斜行、原地旋转等各种运动，这样就实现了所要求的全向移动.

3 全向移动机器人运动学分析

如图6所示，建立移动机器人在平面内的位姿坐标系，其中全局坐标为XOY，固定在机器人上的局部坐标为XROYR，P点为移动机器人的质心，θ为

图4 全向移动机器人外形结构Fig.4 The outline structure of omnidirectional mobile robot

图5 全向移动机器人万向轮布局Fig.5 Caster wheel configuration of omnidirectional mobile robot

图6 移动机器人位姿Fig.6 The position and posture of mobile robot

机器人的转动角度.因此，该机器人在平面上的位姿可以表示为ξ=[xyθ]T.假设机器人本体以及轮子是刚体，所设计的全向移动机器人应用于室内环境，通过上述结构设计使得每个轮子都与地面垂直，每个轮子与地面只有1个接触点.因此，当满足轮子与地面纯滚动和无相对滑动的条件时，轮子与地面接触点处的速度为0，即：该点在垂直于轮子平面方向的速度和沿着运动方向上的速度为0.由此得到轮子在纯滚动和无相对滑动的条件为[16]：

(7)

(8)

(9)

式中:R(θ)为全局坐标系转化为机器人局部坐标系的变换矩阵；[lα]为各轮子在机器人本体上的支撑点在机器人坐标系中的极坐标位置；β为每个轮子相对于机器人本体的转向角度；e为万向轮水平轴线相对于垂直轴线的偏置距离；r为轮子半径；

所设计的全向移动机器人由4个万向轮组成，它们的布局位置为对角线对称布置.由式(7)和式(8)可以得到移动机器人的运动学方程如下：

(10)

(11)

式中is,id为驱动万向轮内部转向和驱动传动系统传动比.

4 结论

基于驱动万向轮设计了一种全新的全向移动机器人.其中所设计的驱动万向轮可以提供连续顺滑的运动，使得机器人在不改变自身姿态的情况下可以沿平面内任意方向运动，真正实现了全向移动.同时利用差速行星齿轮机构对驱动万向轮在转向时所引起的轮子额外滚动运动进行解耦，使得驱动万向轮在转向时无额外的轮子滚动输出，这样保证了控制精度，提高了机器人运动稳定性.最后，通过建立移动机器人的运动学模型，分析得到了控制电机输入转速与机器人运动速度之间的关系，验证了机器人所具备的全向移动功能以及驱动轮的正确设置方式，并为机器人运动控制提供了依据.

[1] BISCHOFF Rainer. Field and service robotics[M]. London: Springer， 1998: 485-492．

[2] HOLMBERG R. Design and development for powered-caster holonomic mobile robot[D]. Palo Alto: Stanford University， Department of Mechanical Engineering, 2000:8-17．

[3] SAHA S K， ANGELES J， DARCOVICH J. The design of kinematically isotropic rolling robots with omnidirectional wheels[J]. Mechanism and Machine Theory， 1995， 30(8): 1127-1137．

[4] GOSSELIN C， ANGELES J. Singularity analysis of closed-loop kinematic chains[J]. IEEE Transactions on Robotics and Automations， 1990， 6(3):281-290．

[5] LI Yuan-ping. Slip modelling estimation and control of omnidirectional wheel mobile robots with powered caster wheel[D]. Singapore: National University of Singapore， Department of Mechanical Engineering, 2009: 5-15．

[6] CAMPION G， BASTIN G， D’ ANDREA-NOVEL B. Structural properties and classification of kinematic and dynamic models of wheeled mobile robots[J]. IEEE Transactions on Robotics and Automations， 1996， 12(1):47-62．

[7] 曹其新，张蕾. 轮式自主移动机器人[M].上海：上海交通大学出版社，2012:40-48． CAO Qi-xin， ZHANG Lei， Wheeled autonomous mobile robot[M]. Shanghai: Shanghai Jiaotong University press， 2012:40-48．

[8] 王曙光. 移动机器人原理与设计[M]. 北京：人民邮电出版社,2013:32-38． WANG Shu-guang. Principle and design of mobile robot[M]. Beijing: People’s Posts and Telecommunications Press， 2013:32-38．

[9] PIN F G， KILLOUGH S M. A new family of omnidirectional and holonomic wheeled platforms for mobile robots[J]. IEEE Transactions on Robotics and Automation， 1994， 10(4):480-489．

[10] YI B J， KIM W K.The kinematics for redundantly actuated omnidirectional mobile robots[J]. Journal of Robotic Systems， 2002， 19(6):255-267．

[11] MUIR P F， NEWMAN C P. Kinematic modeling of wheeled mobile robots[J]. Journal of Robotic Systems， 1987， 4(2):281-340．

[12] AGULLO J， CARDONA S， VIVANCOS J. Kinematics of vehicles with directional sliding wheels[J]. Mechanism and Machine Theory， 1987， 22(4):295-301．

[13] SONG J B， BYUN K S. Design and control of a four-wheeled omnidirectional mobile robot with steerable omnidirectional wheels[J]. Journal of Robotic Systems， 2004， 21(4):193-208．

[14] ALEXANDER J C， MADDOCKS J H. On the kinematics of wheeled mobile robots[J]. International Journal of Robotics Research， 1989， 8(5):15-27．

[15] ZHAO Y， BEMENT S L. Kinematics， dynamics and control of wheeled mobile robots[J]. IEEE International Conference on Robotics & Automation， 1992， 1(1):91-96．

[16] WADA M， TAKAGI A， MORI S. A mobile platform with a dual-wheel caster-drive mechanism for holonomic and omnidirectional mobile robots[J]. Journal of the Robotics Society of Japan， 2000， 18(8):1166-1172．

[17] WADA M， TAKAGI A， MORI S. Caster drive mechanisms for holonomic and omnidirectional mobile platforms with no over constraint[J]. IEEE International Conference on Robotics & Automation， 2000， 2(2):1531-1538．

[18] WADA M. A synchro-caster drive system for holonomic and omnidirectional mobile robots[C]. 26th Annual Conference of the IEEE Industrial Electronics Society， Nagoya, Aichi, Oct. 22-28, 2000．

Design and realization of powered caster wheel for omnidirectional mobile robot

WANG Wei-jun, YANG Gui-lin, ZHANG Chi, CHEN Qing-ying

(Key Laboratory of Robotics and Intelligent Manufacturing Equipment Technology of Zhejiang Province, Ningbo Institute of Material and Engineering Technology， Chinese Academy of Science， Ningbo 315201， China)

The powered caster wheel without special decoupled mechanism that is used by the omnidirectional mobile robot can produce an extra rolling motion output of the wheel when it is making the wheel turn. It is due to the motion couple between the steering motion and driving motion. This phenomenon can lead to the motion instability and increase the complexity of the robot’s motion control algorithm， which is not beneficial to the mobile robot’s practical application and maneuverability. In order to solve the powered caster wheel’s motion couple problem between the steering motion and driving motion， a differential planet gear was mounted between the steering transmission system and driving transmission system. By setting reasonable output transmission ratio and right motion orientation of the differential planet gear， the extra rolling motion could be decoupled from the steering motion， which could make a great contribution to the stability of the robot’s motion and accurate motion control. Finally， the kinematics of the robot had been analyzed， from which the relationship of the input motor speed and the robot’s velocity could be obtained. Through utilizing, the result of kinematics analyzing the robot’s ability of the omnidirectional mobility can be testified and the foundation of the robot’s motion control can be provided．

omnidirectional mobile robot; differential planet gear; kinematics analysis; decouple; powered caster wheel