第三章 位姿描述和齐次变换.ppt

单击此处编辑母版标题样式,*,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,第三章,位姿描述和齐次变换,一、行列式和矩阵,1.行列式按照行（或列）展开法则,：行列式等于它的任意一行（或列）各元素与其对应的代数余子式乘积之和。,3.1,相关知识回顾,3.列矩阵,4.矩阵相等：,两同型矩阵（行数和列数都相等）对应元素相等。,2.行矩阵,（2）矩阵与数相乘：,该数与矩阵各元素相乘。,5.单位矩阵：,主对角线元素为1，其它所有的元素都为0的方阵。,6.矩阵的运算,（1）矩阵的加法：,两同型矩阵的对应元素相加。,（3）矩阵与矩阵相乘：,（4）矩阵的转置：,把矩阵的行换成同序数的列，记为,7.矩阵的逆（逆矩阵）,8.分块矩阵：,分块后的矩阵与普通矩阵的运算相同。,9.正交矩阵：,如果 ，则,A,为正交矩阵。它满足：,如果 是正交矩阵，则,行列式和矩阵的区别：,矩阵是按一定方式排成的数表；行列式是一个数。,（,b）,左手坐标系,（,a）,右手坐标系,二、直角坐标系,若基矢量相互正交，即它们在原点,o,处两两相交成直角，则它们构成,直角坐标系或笛卡儿坐标系。,斜角坐标系,若按右手法则绕,oz,轴转90,0,可以使,ox,轴转向,oy,轴，则称为右手坐标系,；,按左手法则形成的坐标系称左手坐标系,。,本课程使用右手坐标系,。,其中,是,a,和,b,两矢量间的夹角，如图所示,。,三、矢量的点积（内乘积或标量积）,换句话说：,一个矢量在另一个矢量上的投影等于该矢量与另一矢量方向上单位矢量的点积。,再令,a=j（j,为,a,方向上的单位矢量），则,即两矢量方向上单位矢量的点乘等于两矢量夹角的余弦。,标量积,令,b=i（i,为,b,方向上的单位矢量），则,四、矢量的叉积（矢量积或叉乘积）,其中矢量,c,的模为:,其中,是,a,和,b,间小于等于180,0,的夹角，若将,a,按右手法则绕,c,转,角至,b，,右手拇指指向为,c,的正方向（如上图所示,），c,与,a、b,两者垂直。,则,叉乘积,若,a,和,b,用分量的形式表示为:,a,和,b,的点乘为：,将点乘和叉乘应用于右手笛卡尔坐标系的单位矢量,i，j，k，,有：,3.2,位姿描述与坐标变换,3.2.1刚体位置姿态（,位姿,）描述,a),位置的描述,采用直角坐标描述点的位置，因此，刚体,F,的位置描述，即,O,B,点在,A,中描述可用一个31的列矢量（位置矢量）表示，即,其中,P,x,、P,y,和,P,z,是点,O,B,在,A,系中的三个坐标分量。,b),姿态（方位）的描述,采用旋转矩阵来表示刚体姿态（方位），即由,B,系的三个单位主矢量相对于坐标系,A,的方向余弦组成：,既表示了刚体,F,在,A,系中的方位，也描述了,B,系在,A,系中的姿态。,其中：,x,B,y,B,z,B,x,A,y,A,z,A,3.2.2 坐标变换,如图所示，坐标系,B,与,A,方向相同，但原点不重合。,坐标平移,一、坐标平移,此式称为,平移方程,。其中 是,B,系中的原点在,A,系中的表示。,二、坐标旋转,坐标旋转,如图所示，,B,与,A,有共同的坐标原点，但方位不同。令,和 分别是,A,和,B,中的单位主矢量，点,P,在两坐标系中各坐标轴上的坐标分量分别为：,和,利用点乘的性质和上式共同求解得,将 代入上面三式中并写成矩阵形式得,所以有,上式简写为：,此式称为,坐标旋转方程,。其中旋转矩阵 表示了坐标系,B,相对于,A,的方位，正好与刚体姿态的描述相同。同理也可得,和 都是正交矩阵，因此满足,由 与 互逆，可得,旋转矩阵的几何意义旋转矩阵在几何上表示了发生相互旋转的两坐标系各主轴之间的相互方位关系。,若把 写成行向量的形式 ，则其中每一个元素都是一个列向量。容易得出 满足六个约束条件（称正交条件）：,因此写出三个基本的旋转矩阵，即分别绕,x、y,和,z,轴转,角的旋转矩阵：,x y z,x,y,z,x y z,x,y,z,x y z,x,y,z,例3.1,若从基坐标系,(B),到手爪坐标系,(E),的旋转变换矩阵为 。（1）画出两坐标系的相互方位关系（不考虑,E,的原点位置）；（2）如果给出,O,E,(E,系的原点）在,B,中的位置矢量为（1，2，,2,），画出两坐标系的相对位姿关系；（3）求,a，b，c,的值。,解：,x,E,y,E,z,E,x,B,y,B,z,B,(1),(2),(3),a=0,，,b=1,，,c=0,三、一般变换,一般的情况：坐标系,B,的原点既不与,A,重合，方位也不相同。,C,系与系原点重合，但方位不同，所以得,C,系与,A,系原点不重合，但方位相同，所以得,进而有,和,例3.2,已知坐标系,B,初始位姿与,A,重合，首先,B,相对,A,的,z,A,轴转30，再沿,A,的,x,A,轴移动10个单位，并沿,A,的,y,A,轴移动5个单位。求位置矢量 和旋转矩阵 。若 ,求 。,解：,所以有：,最后得：,3.3 齐次坐标与齐次变换,复合变换式 可以表示成等价的齐次变换式。,简写成,综合地表示了平移和旋转变换。,3.3.1 齐次坐标,一般来说，以,N+1,维矢量表达,N,维位置矢量的方法称为,齐次坐标表示法。,在三维直角坐标系中，一个点可以表示 为,，,它的齐次坐标就是 ，即满足,Px,=,Px/，Py,=,Py/，Pz,=,Pz/（,是非零整数）。可以看出，在三维直角坐标系中，由于,取值的不同，一个点的齐次坐标的表达不唯一。,齐次坐标不仅可以规定点的位置（,为非零整数），还可以用来规定矢量的方向（第四个元素为零时）。列向量 (）表示空间的无穷远点，,a，b,和,c,称为它的方向数。,分别代表了,ox，oy,和,oz,轴的无穷远点，用它们分别表示这三个坐标轴的方向。另外，代表坐标原点，没有意义。,注意：,位置矢量 究竟是31的直角坐标还是41的齐次坐标，应根据上下文而定。,在机器人研究中,，齐次变换矩阵,T,为：,3.3.2 齐次变换,齐次变换矩阵是44的矩阵，它的完整形式可以看成是由四个子矩阵组成：,纯旋转的齐次变换矩阵,中,P,31,为零矩阵，即 ，因此写出绕,x，y,和,z,轴旋转,角的基本齐次变换矩阵为：,纯平移的齐次变换矩阵,中,R,33,=I,33,（,单位阵），因此可以写出沿,x，y,和,z,轴移动,Px，Py,和,Pz,单位的基本平移变换阵：,从而定义复合变换 。,给定坐标系,A，B,和,C，,已知,B,相对,A,的描述为 ，,C,相对,B,的描述为 ，则有,同理得出：,即,一个坐标系变换至另一坐标系的齐次变换矩阵等于依次经历中间坐标系各齐次变换矩阵的连乘积。,例3.4 已知 ，画出,A,和,B,的相互位姿关系图。,结论：,齐次变换 不仅可以表示同一点相对不同坐标系,B,和,A,中的变换，也可用来描述坐标系,B,相对于另一坐标系,A,的位姿，同时还可用来作为点的运动算子。,例：书上,P20,例2.4。,3.4 齐次变换的性质,1、绕固定坐标系依次进行的坐标系转换，各齐次变换矩阵按“从右向左”依次相乘原则进行运算（右乘）。,一.变换过程的相对性,=,RPY,角,R,P,Y,RPY,角反解：,2、绕动坐标系依次进行的齐次变换，按“从左向右”的原则依次相乘(左乘）。,=,z-y-x,欧拉角：,相对于固定坐标系运动,相对于活动坐标系运动,齐次变换的相对性,齐次坐标变换过程是可逆的.若有 ，则逆变换 。,二.变换过程的可逆性,所以有,对应元素相等得,所以得,三.变换过程的封闭性,因此有,由上面两式得变换方程：,画出空间尺寸链图为:,例 3.5,如图所示，从0系到3系依次经过1系和2系的变换,用两种方法求 和 ，第一种根据齐次变换矩阵的几何意义求解，另一种采用坐标系依次变换的方法；求 （用两种方法）；画出0到3的空间尺寸链图。,空间尺寸链图：,3.5 旋转变换通式,一.旋转变换通式,如果不是，要采用其对应的单位方向矢量,令 是过,A系原点的,单位矢量,，求绕,K,旋,转,角到,B,系的旋转矩阵,R(K,)，,即 。,因此,将上式展开得,尺寸链图,把上式右端相乘，并利用旋转矩阵的正交性质,进行化简整理后得,其中，,s=sin;c=,cos;Vers,=(1-cos),。,如果 与坐标轴重合，则可得到绕,x,y,和,z,轴旋转的基本旋转矩阵。,例：,求绕过原点的轴线 转动120,0,的旋转矩阵,二.等效转轴与等效转角,对于给定的旋转矩阵,R,令,R=R(K,)，,得,任何一组经过有限次基本旋转变换后的复合旋转总可以等效成绕某一过原点的轴线转,角的单一旋转。,将方程两边的主对角线元素分别相加，得,于是可得：,再把方程两边的非对角元素成对相减得：,将上式两边平方后再相加得：,于是：,两点注意:,多值性：,K,和,的值不唯一。实际上，对于任意一组,K,和,，,都对应另一组-,K,和-,，(K,),和,(k,+n360),对应的转动效果相同，,的取值也有多种，一般取在0到180之间。,例：,求复合变换 的等效转轴,k,和转角,。,病态情况：,当转角,很小时，转轴难确定；当,接近0或 180时，转轴完全不能确定，需另寻解法。,Class is over.Bye-Bye!,