工业机器人的运动学ppt课件

工业机器人 湖北工业大学机械工程学院主讲 张铮 第2章工业机器人的运动学 2 1齐次坐标及对象物的描述2 2齐次变换及运算2 3工业机器人连杆参数及其齐次变换矩2 4工业机器人运动学方程 2 1齐次坐标及对象物的描述 一 点的位置描述在选定的直角坐标系 A 中 空间任一点P的位置可用3 1的位置矢量p表示 其左上标代表选定的参考坐标系 pxp pypz 式中 px py pz是点P在坐标系 A 中的三个位置坐标分量 如图 二 齐次坐标 如用四个数组成的 4 1 列阵 PxP PyPz1 表示三维空间直角坐标系 A 中点P 则列阵 PxPyPz1 称为三维空间点P的齐次坐标 必须注意 齐次坐标的表示不是惟一的 我们将其各元素同乘一非零因子w后 仍然代表同一点P 即PxaP Py bPzc1w式中 a wpx b wpy c wpz 三 坐标轴方向的描述 如图所示 i j k分别是直角坐标系中X Y Z坐标轴的单位向量 若用齐次坐标来描述X Y Z轴的方向 则X 1000 TY 0100 TZ 0010 T从上可知 我们规定 4 1 列阵 abc0 T中第四个元素为零 且a2 b2 c2 1 则表示某轴 某矢量 的方向 4 1 列阵 abcw T中第四个元素不为零 则表示空间某点的位置 图中矢量v的方向用 4 1 列阵可表达为v abc0 Ta cos b cos c cos 图中矢量v所坐落的点O为坐标原点 可用 4 1 列 例2 1用齐次坐标写出图2 3中矢量u v w的方向列阵 解矢量u cos 0 cos 0 7071067 cos 0 7071067u 00 70710670 70710670 T矢量v cos 0 7071067 cos 0 cos 0 7071067v 0 707106700 70710670 T矢量w cos 0 5 cos 0 5 cos 0 7071067w 0 50 50 70710670 T 四 动坐标系位姿的描述动坐标系位姿的描述就是对动坐标系原点位置的描述以及对动坐标系各坐标轴方向的描述 1 刚体位置和姿态的描述 设有一刚体Q 如图2 4所示 O 为刚体上任一点 O X Y Z 为与刚体固连的一个坐标系 称为动坐标系刚体Q在固定坐标系OXYZ中的位置可用齐次坐标形式的一个 4 1 列阵表示为 x0p y0z01 刚体的姿态可由动坐标系的坐标轴方向来表示 令n o a分别为X Y Z 坐标轴的单位方向矢量 每个单位方向矢量在固定坐标系上的分量为动坐标系各坐标轴的方向余弦 用齐次坐标形式的 4 1 列阵分别表示为 n nxnynz0 T o oxoyoz0 T a axayaz0 T 因此 图2 4中刚体的位姿可用下面 4 4 矩阵来描述 nxoxaxx0T noap nyoyayy0nzozazz00001 很明显 对刚体Q位姿的描述就是对固连于刚体Q的坐标系O X Y Z 位姿的描述 例2 2图2 5表示固连于刚体的坐标系 B 位于OB点 xb 10 yb 5 zb 0 ZB轴与画面垂直 坐标系 B 相对固定坐标系 A 有一个30 的偏转 试写出表示刚体位姿的坐标系 B 的 4 4 矩阵表达式 解XB的方向列阵 n cos30 cos60 cos90 0 T 0 8660 5000 0000 TYB的方向列阵 o cos120 cos30 cos90 0 T 0 5000 8660 0000 T ZB的方向列阵 a 0 0000 0001 0000 T坐标系 B 的位置列阵 p 10 05 00 01 T所以 坐标系 B 的 4 4 矩阵表达式为 0 866 0 5000 00010 0TT 0 5000 8660 0005 00 0000 0001 0000 00001 2 手部位置和姿态的表示机器人手部的位置和姿态也可以用固连于手部的坐标系 B 的位姿来表示 如图所示 手部的位姿可用 4 4 矩阵表示为 nxoxaxpx noap nyoyaypynzozazpz0001 例2 3图表示手部抓握物体Q 物体为边长2个单位的正立方体 写出表达该手部位姿的矩阵式 解因为物体Q形心与手部坐标系O X Y Z 的坐标原点O 相重合 所以手部位置的 4 1 列阵为 p 1111 T 手部坐标系X 轴的方向可用单位矢量n来表示 90 180 90 n nx cos 0ny cos 1nz cos 0 同理 手部坐标系Y 轴与Z 轴的方向可分别用单位矢量o和a来表示 根据式 2 8 可知 手部位姿可用矩阵表达为0 101T noap 100100 110001 2 2齐次变换及运算刚体的运动是由转动和平移组成的 为了能用同一矩阵表示转动和平移 有必要引入 4 4 的齐次坐标变换矩阵 一 平移的齐次变换首先 我们介绍点在空间直角坐标系中的平移 如图所示 空间某一点A 坐标为 x y z 当它平移至A 点后 坐标为 x y z x x xy y yz z z 或写成 x 100 xxy 010 yyz 001 zz100011也可以简写为A Trans x y z A式中 Trans x y z 表示齐次坐标变换的平移算子 例2 4有下面两种情况 如图所示 动坐标系 A 相对于固定坐标系的X0 Y0 Z0轴作 1 2 2 平移后到 A 动坐标系 A 相对于自身坐标系 即动系 的X Y Z轴分别作 1 2 2 平移后到 A 已知写出 A A 矩阵表达式 0 101A 100100 110001 解动坐标系 A 的两个平移坐标变换算子均为 100 1Trans x y z 010200120001 A 坐标系是动系 A 沿固定坐标系作平移变换得来的 因此算子左乘 A 的矩阵表达式为 A Trans 1 2 2 A0 100 100300 130001 A 坐标系是动系 A 沿自身坐标系作平移变换得来的 因此算子右乘 A 的矩阵表达式为 A ATrans 1 2 2 0 10 1 100200 1 10001 二 旋转的齐次变换首先我们介绍点在空间直角坐标系中的旋转 如图2 10所示 空间某一点A 坐标为 x y z 当它绕Z轴旋转 角后至A 点 坐标为 x y z A 点和A点的坐标关系为 x cos x sin yy sin x cos yz z 或用矩阵表示为x cos sin 0 xy sin cos 0yz 001z x cos sin 00 xy sin cos 00yz 0010z100011 A 点和A点的齐次坐标分别为 x y z 1 T和 xyz1 T 因此A点的旋转齐次变换过程为 a Rot z a Rot z 表示齐次坐标变换时绕Z轴的旋转算子 算子左乘表示相对于固定坐标系进行变换 下图所示为点A绕任意过原点的单位矢量k旋转 角的情况 kx ky kz分别为k矢量在固定参考系坐标轴X Y Z上的三个分量 且kx2 ky2 kz2 1 可以证得 绕任意过原点的单位矢量k转 角的旋转齐次变换公式为 kxkxvers c kykxvers kzs kzkxvers kys 0Rot k kxkyvers kzs kykyvers c kzkyvers kxs 0kxkzvers kys kykzvers kxs kzkzvers c 00001 式中 vers 1 cos 值的正负号由右手螺旋法则决定 上式称为一般旋转齐次变换通式 它概括了绕X Y Z轴进行旋转齐次变换的各种特殊情况 三 平移加旋转的齐次变换平移变换和旋转变换可以组合在一个齐次变换中 点W若还要作4i 3j 7k的平移 则如图2 14所示 只要左乘上平移变换算子 即可得到最后E点的列阵表达式 e Trans 4 3 7 Rot y 90 Rot z 90 u 100400107 010 310003001701002000100011001476 100 33 40107210000111 0014100 301070001 其中 为平移加旋转的一般齐次变换矩阵 2 3工业机器人连杆参数及其齐次变换矩阵 如图1所示 连杆两端有关节n和n 1 该连杆尺寸可以用两个量来描述 一个是两个关节轴线沿公垂线的距离an 称为连杆长度 另一个是垂于an的平面内两个轴线的夹角 n 称为连杆扭角 这两个参数为连杆的尺寸参数 一 连杆参数及连杆坐标系的建立 再考虑连杆n与相邻连杆n 1的关系 若它们通过关节相连 如图2所示 其相对位置可用两个参数dn和 n来确定 其中dn是沿关节n轴线两个公垂线的公距离 n是垂直于关节n轴线的平面内两个公垂线的夹角 这是表达相邻杆件关系的两个参数 图1 图2 二 连杆坐标系之间的变换矩阵 建立了各连杆坐标系后 n 1系与n系间的变换关系可以用坐标系的平移 旋转来实现从n 1系到n系的变换 可先令n 1系绕Zn 1轴旋转 n角 再沿Zn 1轴平移dn 然后沿Xn轴平移an 最后绕Xn轴旋转 n角 使得n 1系与n系重合 于是连杆n的齐次变换矩阵为 An Rot z n Trans 0 0 dn Trans an 0 0 Rot x n c n s n00100an1000 s nc n0001000c n s n00010001dn0s nc n0000100010001c n s nc ns ns nanc n s nc nc n c ns nans n0s nc ndn0001 2 4工业机器人运动学方程 一机器人运动学方程 通常把描述坐标系与下一个连杆间的相对关系的齐次变换矩阵叫做A变换矩阵或A矩阵 如果A1矩阵表示第一个连杆坐标系相对于固定的坐标系的位置 A2矩阵表示第二个连杆坐标系相对第一连杆坐标系的位置 那么第二个连杆坐标系在固定坐标系中的位置可用A1和A2的乘积来表示 T2 A1A2 若A3矩阵表示第三个连杆坐标系相对于第二个连杆坐标系的位置 则有 T3 A1A2A3 如此类推 对于六连杆机器人 有下列T6矩阵 T6 A1A2A3A4A5A6 计算结果T6是一个 4 4 矩阵 即nxoxaxpxT6 nyoyaypynzozazpz0001 式中 前三列表示手部的姿态 第四列表示手部的位置 二 正向运动学及实例 1 平面关节型机器人的运动学方程 下图1所示为具有一个肩关节 一个肘关节和一个腕关节的SCARA机器人 机器人连杆的参数如表1所示 机器人坐标系图2所示 图1 图2 表1 该平面关节型机器人的运动学方程为T3 A1A2A3式中 A1表示连杆1的坐标系 1 相对于固定坐标系 0 的齐次变换矩阵 A2表示连杆2的坐标系 2 相对于连杆1的坐标系 1 的齐次变换矩阵 A3表示连杆3的坐标系即手部坐标系 3 相对于连杆2的坐标系 2 的齐次变换矩阵 参考图2 于是有A1 Rot z0 1 Trans l1 0 0 A2 Rot z1 2 Trans l2 0 0 c 1 s 10l1c 1c 2 s 20l2c 2 s 1c 10l1s 1 s 2c 20l2s 20010001000010001A3 Rot z2 3 Trans l3 0 0 c 3 s 30l3c 3 s 3c 30l3s 300100001 c123 s1230l3c123 l2c12 l1c1T3 s123c1230l3s123 l2s12 l1s100100001 T3是A1 A2 A3连乘的结果 表示手部坐标系 3 即手部 的位置和姿态 nxoxaxpxT3 nyoyaypynzozazpz0001 于是 可写出手部位置 4 1 列阵为 pxl3c123 l2c12 l1c1P py l3s123 l3s12 l1s1pz011 表示手部姿态的方向矢量n o a分别为 nxc123n ny s123nz000 ox s123o oy c123oz000 ax0a ay 0az100 当转角变量 1 2 3给定时 可以算出具体数值 2 斯坦福机器人的运动学方程 表2 3斯坦福机器人杆件参数 矩阵Ai 1 系与 0 系是旋转关节连接 如上图 a 所示 坐标系 1 相对于固定坐标系 0 的Z0轴的旋转为变量 1 然后绕自身坐标系X1轴作 1的旋转变换 1 90 所以 c10 s10A1 Rot z0 1 Rot x1 1 s10c100 1000001 同理得A2 A3 A4 A5 A6 斯坦福机器人手臂坐标系 这样 所有杆的A矩阵已建立 如果要知道非相邻杆件间的关系 只要用相应的A矩阵连乘即可 如 c5