机构学和机器人学-3运动学中的矩阵法教材教学课件.pptVIP

这里有两种特殊情况，①如 即位移只沿u方向能移动s： u方向： ②当 时 s和p则由该式求得。 由上式可方便地求得 五、数值位移矩阵的建立 [D1j]为刚体E从第一位置E1 运动到第j位置的位移矩阵。 已知刚体E上不共面的四个点 P、Q、R和G在位置1和位置 j时的坐标值。 －1 做平面运动的刚体，其位移能用运动平面上任取的不共线的 A、B、C三点的位移完全确定下来。假设： 三个位移方程可合并成： 如果知道平面上任意两点的位移，如何构成刚体的数值位移矩阵？ 六、位移矩阵的逆 对于平面旋转矩阵，可用α角所构成的逆位移来构成 ，于是: 对于上式： ∵ [R]是正交矩阵，∴对于空间旋转矩阵仍成立。 对于位移矩阵，可将位移分解成位移和转动二部分，通过依次位移矩阵来描述，即： ∵ ∴ 平面： 空间4×4： 去计算逆位移矩阵 应用以上等式很容易由位移矩阵元素 的各元素，当需要反复计算逆阵时可节省数值计算时间。 一、坐标变换矩阵 设有两个原点不重合的坐标系Ⅰ和Ⅱ如图，其中点p在 坐标系Ⅰ中的坐标 §3-3 坐 标 变 换 ，在坐标系Ⅱ中的坐标为 ，若坐标系Ⅱ的原点O2在坐标系中的坐标为 由图： （3—37） 上式可用两坐标系中的轴间夹角的余弦表示： （3—38） 将上式写成齐次的矩阵形式得： （3—39） （3—40） [T21]称为由Ⅱ系变到Ⅰ系的坐标变换矩阵，其中16个元素只有12个有实际意义，左上角前三列的3×3矩阵描述坐标系Ⅱ在系Ⅰ中的方位，其九个元素只有均不在同一行（或同一列）上的三个元素是独立的。第四列前三个元素表示坐标系Ⅱ原点O2在系Ⅰ中的位置（坐标）。 当两坐标的原点重合，即其原点的坐标变换时，一般仍可用（3—39）式，只是第四列改为（0、0、0、1）即可，若z1与z2重合如图，则Ⅱ系到Ⅰ系的坐标变换矩阵为： （3—40） 共原点 Z轴重合共原点 将上式与式（3—2）比较它们形式大致相同，前面3×3矩阵完全相同，所不同的只是 对平面也适合，其原点坐标变换矩阵为（3×3）： 若已知R点在坐标系Ⅱ里的坐标 则R点在Ⅰ系里的坐标可用（3—41）式求出即： （3—41） 所以从Ⅱ系变到Ⅰ系的坐标变换矩阵即为坐标系Ⅰ绕z轴转过α角使其与坐标系Ⅱ重合的旋转矩阵[R]。 位置不同。 同样若已知R点在Ⅰ系里的坐标 ，求R点在Ⅱ点的坐标，则： 所以： Ⅱ→Ⅰ相当于Ⅰ绕z转α到Ⅱ重合。 （3—42） 对于不共原点坐标变换，可用同样办法讨论。 如图有两个坐标系 若已知P点在Ⅱ系的坐标： o2点在Ⅰ系里坐标： 则： 写成矩阵形式： （3—43） 另一方面可以将坐标系Ⅱ看作 经绕z轴转α角， 所形成的，可以把 写出由Ⅰ系到Ⅱ系的位移矩阵为： 所以： 以上是平面情况，同样适用于空间坐标系。 又随参考系由 点当成参考点， （3—44） 二、D—H矩阵—相对位姿矩阵 若从空间机构中任取两相邻构件i和i+1，如在每个构件上固连一个坐标系，则i+1构件上某点p在坐标系i+1和i中的坐标变换可用式(3-39)坐标变换矩阵来描述，对于不共原点两个任意方位的坐标系，会有六个独立参数: 哈登伯格（Hartenberg）和迪纳维特（Denavit）提出D—H法，可使六个独立参数减少到四个。该法称为D—H矩阵或位姿矩阵。 按D—H表示法，图示五级副（转动副或移动副）组成的空间机构，两个相邻构件1和2中，坐标系取法为： ① 有效的方法为先选定各个坐标系的Z轴，对于转动副，移动副，螺旋副及Ⅳ级副，圆柱副，Z轴取与运动副轴线相重合； ② Z轴确定后，沿两个相邻Z轴（如Z1、Z2）的最短公垂线即最短距离线确定X轴，图中X2取在Z1、 Z2轴最短d1的延长线上，Y轴由右手规则决定。 第三章 运动学中的矩阵法 描述刚体转动有三种方法: 1）用绕右手直角坐标系的一组转动来描述。 刚体转动可以几只旋转矩阵来表示，这几只旋转矩阵都是以绕x、y、z轴的转动为基础而导出的。我们称绕x、y、z轴转动的旋转矩阵为基本旋转矩阵。 2）用绕空间 轴的转动来描述。 3）用欧拉角描述。 一、三只基本旋转矩阵 1、绕z轴的旋转矩阵，若固连刚体上的定长矢量 绕z轴旋转α角，旋转前设： 旋转后： 由图： （3-1） 写成矩阵形式： 简写成： 则： 称为绕z轴的旋转矩阵。 （3-2） （3-3） 对于平面： 2、 轴旋转γ角的矩阵表示 旋转矩阵: （3-4） （3-5） （3-6） 3、 旋转β角的矩阵表示 式中