麦克纳姆轮的运动控制

1.麦克纳姆轮的原理麦克纳姆轮是瑞典麦克纳姆公司的专利，图3-6为它的结构简图。在它的轮缘上斜向分布着许多小滚子，故轮子可以横向滑移。小滚子的母线很特殊。当轮子绕着固定的轮心轴转动时，各个小滚子的包络线为圆柱面,所以该轮能够连续地向前滚动。麦克纳姆轮结构紧凑、运动灵活，是很成功的一种全方位轮。由四个这种轮加以组合，可以使机构实现全方位移动功能。2.麦克纳姆全向行走底盘构造的运动学分析1、系统运动学解析为了得到一般情况下的四轮全方位系统运动学方程，设四轮的布局形式是随意排列的，每轮在系统中既有相对机体中心的位置，也有姿态角度。设第i轮在机体坐标系中的位姿如图3-8所示。设第i轮的结构示意如图3-9所示。各结构参数和运动参数定义如下：系统逆运动学方程雅克比矩阵为：2、系统运动性能的判定条件当系统逆运动学雅克比矩阵列不满秩时，系统中存在奇异位形，使系统的运动自由度减少。对于麦克纳姆轮四轮全方位运动系统，因逆运动学方程反映四个轮转速与系统中心速度的映射关系，雅可比矩阵的性质也反映了系统的运动特性。对全方位行走系统来说，若系统逆运动学方程的雅克比矩阵列不满秩时，系统也具有奇异位形，反映在运动学上就是失去部分自由度，即系统不能实现全方位运动。因此为使系统确保有三个自由度的全方位运动。针对四轮运动系统，可得到系统实现全方位运动的必要条件如下：1.雅可比矩阵R列满秩，即rank()3R，则系统具有实现全方位运动的能力。2.雅克比矩阵列不满秩，即rank()3R，系统中存在奇异位形，不能实现全方位运动。3、满足系统驱动性能的结构条件对于具有实际用途的四轮系统，系统仅满足运动学必有条件还不够，系统必须具有很好的驱动性能和控制性。为了使系统制造经济合理，所有麦克纳姆轮的辊子偏置角ai取相同的数值，且将轮结构对称设计，安装时只要采用正反安装法，就可得到实际上的大小相等而方向相反的两种辊子偏置角(+-a)。另外，为实现各轮的载荷均匀，系统的支撑结构稳定，一般常采取四个轮子关于车体几何中心（坐标系xoy）对称布置的轮结构布局形式。即使这样规定，但四轮系统的布局结构仍然有许多种组合形式。各种形式中驱动性能有很大的区别。因麦克纳姆轮全方位系统在某些运动方向上存在欠驱动是其自身的特点，系统驱动性能的好坏的设计原则是：1.在三个自由度方向上，若系统的四个轮都是驱动轮则驱动性能良好。2.即使有欠驱动，欠驱动的方向应处于次要的运动方向上。4、麦克纳姆轮布局结构形式选择1)主要介绍六种典型四轮系统结构形式图3-12列举出六种典型的具有代表性的轮组结构布局方式，图中标号1、2、3、4的方框表示四个轮子，方框中斜线表示各轮接触地面时棍子偏置角方向（在俯视图上接触地面的辊子方向与轮子上表面的棍子方向相反）。6种布局下的结构参数及相应的逆运动学雅可比矩阵R的秩rank()R数值计算列于表1。2)运动学特性选择系统结构形式的优选首先看是否能满足全方位运动的必有条件。从表3-1知：六种结构中只有图(a)，图(b)、图(d)三种结构形式的逆运动学雅可比矩阵的秩rank(R)=3，也就是列满秩，存在广义逆阵。其它3种结构形式的雅可比矩阵均不满秩，因此系统中必存在奇异位形，因而在某些方向上不能实现运动，也即是不能实现全方位运动。另外从矩阵不满秩的3种情况可以观察出其共同特点是：轮子上辊子的方向都是同向安装的，很显然系统不能实现平面三自由度全方位运动，必有条件同实际相符。3)驱动性能选择对上述满足系统运动学必有条件的三种结构形式再结合系统驱动性能选择说明如下：图3-10(a)布局结构形式中，当四个轮呈正方形布局，且辊子偏置角全部取45时，则系统失去了定轴旋转能力。原因是在正方形布局结构形式下，因四个轮的速度方向v1,v2,v3,v4与运动中心共线，无论各轮的速度大小如何改变，都不能实现绕O点的旋转运动。因而系统不能实现全方位运动。也就是说这种布局结构虽然系统逆运动学雅克比矩阵的秩rank()3R，列满秩，但仍然具有局限性。因而不是最优结构。图3-10(d)的四轮布局结构形式，虽然能实现全方位运动，但从系统驱动性能方面考虑，效果较差一些，当实现x，y方向的运动时，必有两轮作为驱动，其余两个轮处于与地面的滑动摩擦状态，显然对系统的运动起到了阻碍作用，使得系统的驱动效果较差。如系统要沿x方向运动时，只有轮1，2是驱动轮，轮3，4必须处于零转速，滑动摩擦状态。沿y轴运动时，轮运动状态正好相反。综合运动可行性及系统驱动性能，最好的四轮结构布局形式是图3-10(b)的结构形式。图3-10(b)的结构形式实现全方位运动的原理如图3-5所示。由图3-5显然可见系统能实现x，y方向的直线运动，也能实现绕中心O点的定点旋转。三个方向的运动中，系统所有轮都是驱动轮。系统不仅能实现全方位运动，且驱动性能较好，是最优结构布局形式。   四轮麦克纳姆轮全方位运动系统的轮组布局形式多种多样，并不是每一种布局形式都能实现全方位运动，判定系统实现全方位运动性能优劣的必要条件是：系统逆运动学雅克比矩阵是否列满秩。满足必要条件后还必须根据系统的驱动性能综合优选其结构布局形式。从运动性能和驱动性能两方面综合选择，六种常见的布局结构形式中最优的布局结构形式如图3-11(b)所示。麦克纳姆轮结构特点决定了麦克纳姆轮系统具有上述的特殊运动性能和结构特征。