机器人模型与控制-3运动学速度关系.ppt
3.微分运动与雅可比（速度关系）,3.1 引例,例3-1 图示R-P平面机械手，有两个关节，一个旋转关节（），一个移动关节（r）。,运动方程为方程两边对时间 t 求导 写成矩阵形式,运动方程为方程两边对时间 t 求导 写成矩阵形式,例3-2 图示2R平面机械手，有两个平行的转动关节(1,2),运动方程为方程两边对时间 t 求导 写成矩阵形式,逆雅可比矩阵为，即20或时处于奇异状态，此时完全伸直或完全缩回。当l1l2时，可达工作空间为两个同心圆中间的部分，半径分别为l1l2和l1-l2。在边界上机器人处于奇异形位（singular configuration），速度关系方程变为(若20)退化为一个自由度，其末端只能沿圆切线方向运动。,逆雅可比矩阵为，即20或时处于奇异状态，此时完全伸直或完全缩回。当l1l2时，可达工作空间为两个同心圆中间的部分，半径分别为l1l2和l1-l2。在边界上机器人处于奇异形位（singular configuration），速度关系方程变为(若20)退化为一个自由度，其末端只能沿圆切线方向运动。,逆雅可比矩阵为，即20或时处于奇异状态，此时完全伸直或完全缩回。当l1l2时，可达工作空间为两个同心圆中间的部分，半径分别为l1l2和l1-l2。在边界上机器人处于奇异形位（singular configuration），速度关系方程变为(若20)退化为一个自由度，其末端只能沿圆切线方向运动。,从例子可以看出：（1）将机器人的运动学方程对时间求导，即可得到它的雅可比矩阵和逆雅可比矩阵；（2）雅可比矩阵表示从关节空间运动到操作空间运动速度传递的广义传动比；（3）用雅可比矩阵可以判别机器人的奇异形位；（4）用雅可比矩阵可以分析机器人的运动特征和动力学特征。,雅可比矩阵具有如下特点：（1）依赖于机器人形位q的线性变换矩阵；（2）不一定是方阵，可能是长矩阵（冗余驱动），也可能是高矩阵（欠驱动或少自由度）；（3）其行数等于机器人在操作空间的维数（平面3行，空间6行），列数等于关节数；,对于一般的6自由度机器人，其雅可比矩阵的计算比较复杂。操作空间与关节空间之间的速度具有如下形式,雅可比矩阵的含义：（1）空间操作臂雅可比矩阵的前3行代表对手爪线速度的传递，后3行代表对手爪角速度的传递，每一列代表相应的关节速度对手爪线速度和角速度的影响。,（2）手爪的线速度和角速度为关节速度的线性函数（3）机器人的雅可比矩阵可写成分块的形式式中：JLi代表第i个关节的速度引起的手爪的线速度；JAi代表第i个关节的速度引起的手爪的角速度。,雅可比矩阵的确定通常采用两种构造性的方法：（1）矢量积法基于矢量的叉积推导机器人的雅可比，是相对于基坐标系表示的；（2）微分变换法利用操作空间与关节空间中的微分运动关系构造机器人的雅可比，是相对于运动坐标系（通常为末端坐标系）表示的。在给出两种构造性方法之前，分别先介绍相关的理论基础。,3.2 变换矩阵的导数,3.2.1 反对称矩阵 设S是一个 nn的矩阵，如果S满足，则称S为反对称矩阵。反对称矩阵的对角线矩阵为0，只有n个独立元素；定义33反对称矩阵空间so(3)，有如下形式,反对称矩阵与矢量有如下关系,其中：，S可看作是对矢量a的运算算子,反对称矩阵的性质（1）算子S的运算是线性的，即对于，和任意标量，有（2）反对称矩阵与矢量叉乘的关系：对于，有（3）对于旋转矩阵 和，有,反对称矩阵的性质（1）算子S的运算是线性的，即对于，和任意标量，有（2）反对称矩阵与矢量叉乘的关系：对于，有（3）对于旋转矩阵 和，有,旋转矩阵，满足以下性质：的各列（各行）是互相垂直的 的每一列（每一行）都是单位向量,反对称矩阵的性质（1）算子S的运算是线性的，即对于，和任意标量，有（2）反对称矩阵与矢量叉乘的关系：对于，有（3）对于旋转矩阵 和，有 证明：利用 和性质（2），有（4）对于，有,3.2.2 旋转矩阵的导数 设旋转矩阵R是关于单变量的函数（旋转变换通式），有,将上式两边对求导，得,定义矩阵S为,因为，有，所以,将矩阵S 右乘旋转矩阵R，得到,用定义式求解S,同理，当RRy,和 RRz,分别有 和,对于RRx,，有,对于一般情况RRK,，利用旋转变换通式，有,3.2.3 角速度 设旋转矩阵R是关于单变量的函数，对时间求导有,其中,对于多级旋转变换,利用，得到,进一步扩展，得到,对于齐次变换矩阵,由其中的旋转矩阵 即可求得上述角速度关系式，它表示末端连杆角速度与各相邻连杆间角速度的关系。,3.2.4 线速度 设末端手抓在坐标系n中的位置矢量为，通过齐次变换得到,将 展开,将其求导得到末端手抓的线速度,3.2.5 机械臂末端手爪的速度 末端手抓的角速度与连杆n的角速度一样；末端手抓的线速度是指手爪上的点e的速度；,当关节i为移动关节时，上面(1)式中 上面(2)式中,当关节i为转动关节时，上面(2)式中,当关节i为移动关节时,当关节i为转动关节时,以关节i为研究对象；根据关节运动形式的不同：（1）移动关节i以速度 运动，末端手爪的线速度与Zi轴方向相同，角速度为零雅可比矩阵的第i列（移动关节）Zi通过计算 并取其第3列前3个元素组成矢量来获得,3.3 矢量积法求雅可比,1972年Whitney基于参考坐标系的概念提出来的。,（2）转动关节i以速度 运动，末端手爪产生的角速度为，产生的线速度为雅可比矩阵的第i列(移动关节)为末端手爪坐标原点相对坐标系i的位置矢量在0中的表示；为末端手爪坐标原点相对坐标系i的位置矢量在i中的表示；可通过取 中的位置矢量获得，进而通过公式 获得 Zi通过计算 并取其第3列前3个元素组成矢量来获得,矢量积法求雅可比矩阵的步骤：建立连杆坐标系，求得 从关节0开始计算 按照上面的方法对移动关节和转动关节分别求得 然后组成矢量积法得到的雅可比矩阵是相对于参考坐标系的；如果想获得动坐标系（手爪坐标系）的速度，可进一步做如下变换,3.4 微分转动与角速度,绕X轴、Y轴或Z轴转角的旋转变换矩阵分别是,角度很小时，把它当成微量，称为微分转动。绕X、Y、Z轴转动的微分角度记为x、y、z。根据下列性质微分转动变换为,微分转动变换可以看成是以上三个变换的复合作用，将三个矩阵相乘，并略去高阶（2）微量，得 根据旋转变换通式，得到微分转动变换的另一种形式二者是等价的,对比两种微分转动变换矩阵，可以得到如下关系微分旋转变换具有以下性质：（1）具有交换律（一般旋转变换不具有这一性质）（2）绕任一矢量的微分转动与绕X、Y和Z轴的微分转动等价。,利用微分转动推导旋转变换矩阵的导数 可看成是 经过微分旋转变换得到的进一步,称为微分旋转算子旋转矩阵的导数角速度算子矩阵如果已知旋转变换矩阵表达式，计算，并与 对应元素相等，可得刚体的角速度,3.5 微分运动与广义速度,微分运动：微分移动和微分转动对应广义速度（线速度和角速度）操作臂由位姿T(t)经过微分转动和微分移动后到达T(t+t)相对于参考系的微分运动为 微分运动算子定义微分运动矢量广义速度为,相对于动坐标系，微分变换矩阵为相应的微分运动为 微分运动算子微分运动矢量广义速度为,齐次变换的导数 如果齐次变换矩阵已知，由式 和 可以求得相对参考系和动系的广义速度,例 手爪的位姿为相对于基坐标系的微分移动和微分转动分别为1 0 0.5T和0.1 0 0T，求相对于基系微分运动。,如果相对于动坐标系的微分移动和微分转动分别为1 0 0.5T和0.1 0 0T，求相对于动系的微分运动。,3.6 微分运动的等价坐标变换,利用齐次变换矩阵求导来求广义速度的方法，需要求齐次变换矩阵的导数和逆，在实际中对于复杂模型难于应用。微分变换法：利用同一微分运动在不同坐标系下的描述的等价关系求广义速度。,求解，实际上是对 做相似变换,矢量三重混合积的性质各方向矢量间的正交性和规一化条件同一微分运动在动系和基系下的微分运动算子之间的关系可以化简为,根据前面定义将两式右边对应元素相等可得到动系和基系下微分运动的等价坐标变换,写成矩阵形式简写为,进一步推广，得到任意两坐标系A和B中微分运动矢量的等价变换两个坐标系中的速度等价关系,例 手爪的位姿为相对于基坐标系的微分移动和微分转动分别为 1 0 0.5T和0.1 0 0T，求相对于动系的等价微分运动。,3.7 微分变换法求雅克比,根据微分运动的等价坐标变换，速度在动系和基系之间存在如下等价变换关系利用上述速度等价关系，我们来推导微分变换法求雅克比的算法。根据关节运动形式不同，分为两种情况：,（1）对于转动关节i，若关节速度为，则连杆i的速度和角速度矢量在坐标系i为 根据速度等价关系，该关节速度产生的手爪的速度（在动系中）,（2）对于移动关节i，若关节速度为，则连杆i的速度和角速度矢量在坐标系i为 根据速度等价关系，该关节速度产生的手爪的速度（在动系中）,（1）和（2）中n,o,a,P的是 的4个列矢量 雅可比（相对于动系）的第i列为 转动关节：移动关节：组合起来,这种计算雅可比的方法是构造性的，从n到1依次计算齐次变换矩阵,使用其中的矢量按上面公式可构造雅克比的各列，不需要求导或解方程。,3.8 两个实例（自学）,一、XHK5140换刀机械手的雅可比矩阵二、PUMA560机器人的的雅可比矩阵,3.9 逆雅可比矩阵和奇异性,矢量积法和微分变换法得到速度正解，是由关节速度求末端手爪速度。如果已知手爪速度求关节速度，称为速度逆解，即 速度逆解的性质取决于雅克比矩阵的性质。下面介绍雅克比矩阵的性质。,一、雅克比的性质,操作空间与关节空间的速度关系反映的是n维关节空间向m维操作空间的线性映射。,线性映射的域空间R(J)是操作空间Rm的子空间，代表机器人所能达到的操作速度的集合。线性映射的零空间N(J)是关节空间Rn的子空间，代表不产生操作速度的关节速度的的集合。域空间R(J)和零空间N(J)的维数之和dimR(J)+dimN(J)=n（1）当nm，且J是行满秩时，机器人为冗余自由度，冗余度为N(J)的维数；（2）当nm，且J是满秩时，机器人为满自由度；（3）当nm，机器人为欠自由度。,二、雅可比矩阵奇异,det（J）0时，机器人处于奇异位形。机器人处于奇异位形时：（1）自由度将减少；（2）速度反解不存在；（3）在奇异位形附近，速度反解可能非常大，解不可行。机器人奇异位形分类：（1）机器人工作空间边界上的位形；（2）机器人工作空间内部的位形，通常是由于两个或多个关节轴线重合造成的。,3.10 操作臂的灵巧度,灵巧度的度量指标：（1）条件数通常定义为最大最小奇异值的比值，反映操作臂的各向同性性，1，条件数越小，各向同性越好，灵巧度越高；（2）最小奇异值反映所需关节速度上限，最小奇异值越大，操作臂末端对关节运动的反应越快；（3）可操作度，等于各奇异值的乘积。（w值越大，灵活性越好；当w=0时，发生奇异状态。）,冗余度机器人：从运动学的观点是指完成某一特定任务时，机器人具有多余的自由度。冗余度机器人的优点：冗余度机器人增加灵活性 躲避障碍物 改善动力学性能的规划算法 优化动力学控制算法,3.11 冗余度机器人,习题,图示3R空间机械手具有3个旋转关节。分别用矢量积法和微分变换法求雅克比矩阵。,
