2024年12月28日星期六智能与控制工程研究所1第五章微分变换ChapterⅤDifferentialRelationships5.1引言5.2微分矩阵5.3微分平移和旋转变换5.4微分旋转5.5坐标系之间的微分变换5.6机械手的微分变换方程——雅可比方程5.7雅可比逆矩阵5.8本章小结2024年12月28日星期六智能与控制工程研究所25.1引言(Introduction)微分变换在机器人视觉、动力学和机器人控制(如力控、刚度控制、阻抗控制、顺应控制等)中十分重要。例如当摄像机或其它传感装置检测到机器人末端执行器的位置和方向的微小变化时,需要将该微小变化从摄像机或其它传感装置坐标转换到基坐标或参考坐标系。在机器人刚度控制中,需要获得在控制坐标系中力与位置的微分变换。又如将直角坐标的微分变换转化为关节坐标的微分变换,还有在下一章介绍的机器人动力学问题时,也会用到微分变换。本章将介绍微分变换的基本原理和方法,包括微分平移、微分旋转、坐标系之间的微分变换、雅可比矩阵和逆雅可比矩阵及其应用。2024年12月28日星期六智能与控制工程研究所35.2微分矩阵(DerivativeMatrixes)给出一个4×4的矩阵A(5.1)矩阵A的微分就是对矩阵A中的每一个元素对自变量x的微分,结果如下(5.2)44434241343332312423222114131211aaaaaaaaaaaaaaaaAdxxaxaxaxaxaxaxaxaxaxaxaxaxaxaxaxadA444342413433323124232221141312112024年12月28日星期六智能与控制工程研究所45.3微分平移和旋转变换(DifferentialTranslationandRotation)微分平移和旋转变换可以是针对基坐标或参考坐标系,也可以是针对某个指定的坐标系进行。例如对于一个变换矩阵T,它对基坐标的微分变换可表示为(5.3)式中是在基坐标的x,y,z轴向上分别平移dx,dy,dz;和绕基坐标的向量k旋转dθ角。由此可得到(5.4)如果上述微分变换不是针对基坐标而是针对坐标系T,那么微分变换的结果可表示为(5.5)此时,式中是在T坐标的x,y,z轴向上分别平移dx,dy,dz;是绕T坐标的向量k旋转dθ角。由此可得到(5.6)TdkRotdzdydxTransdTT),(),,(TIdkRotdzdydxTransdT)),(),,((),(),,(dkRotdzdydxTransTdTT)),(),,((IdkRotdzdydxTransTdT),,(dzdydxTrans),(dkRot2024年12月28日星期六智能与控制工程研究所5我们用符号来表示式(5.4)和式(5.6)中的并将它称为微分变换算子(5.6)这样式(5.4)和式(5.6)就可写成如下形式(5.7)和(5.8)式(5.7)中的微分变换算子是针对基坐标的,而式(5.8)中的微分变换算子则是针对T坐标的。在第二章我们给出了平移和一般性旋转变换的齐次变换矩阵表达式,平移变换矩阵是100a010bTrans(a,b,c)=001c(5.9)0001)),(),,((IdkRotdzdydxTransIdkRotdzdydxTrans),(),,(TdTTTdTT2024年12月28日星期六智能与控制工程研究所6当平移向量是微分向量d=dxi+dyj+dzk时,微分平移矩阵为100dx010dyTrans(d)=001dz(5.10)0001一般性旋转变换的变换矩阵是kxkxversθ+cosθkykxversθ-kzsinθkzkxversθ+kysinθ0kxkyversθ+kzsinθkykyversθ+cosθkzkyversθ-kxsinθ0Rot(k,θ)=kxkzversθ-kysinθkykzversθ+kxsinθkzkzversθ+cosθ0(5.11)0001当进行微分旋转变换时,旋转角dθ极小,此时有如下关系dsinlim01coslim00lim0vers2024年12月28日星期六智能与控制工程研究所7将上述关系代入式(5.11)可得1-kzdθkydθ0kzdθ1-kxdθ0Rot(k,dθ)=-kydθkxdθ10(5.12)0001由式(5.6)可得(5.13)100001000010000110000101011000100010001dkdkdkdkdkdkdddxyxzyzzyx0000000zxyyxzxyzddkdkddkdkddkdk2024年12月28日星期六智能与控制工程研究所85.4微分旋转(DifferentialRotations)式(5.13)给出的微分变换算子是基于微分旋转角dθ的微分平移和旋转变换表达式,下面讨论绕坐标...