第2章_工业机器人运动学.ppt

2.3.3 平移加旋转的齐次变换 平移变换算子和旋转变换算子可以组合在一个(4×4)的矩阵中。 若例2-5中的点W还要作4i-3j+7k的平移，如图2-15所示，则只要再左乘上平移变换算子，即可得到最后E点的列阵表达式。 这个矩阵就是W点的 平移加旋转的复合变换矩阵。 其 前3列只与转动角度有关， 第4列只与平移有关 [例2-7] 楔块Q的初始状态如图2-8 (a)所示，楔块先绕固定坐标系OXYZ的Z轴旋转90?，再绕Y轴旋转90?，最后沿X轴方向平移4后的状态如图2-8(b)所示。 在图(a)情况下描述它的齐次矩阵为： 证明：因为楔块从图(a)至图(b)的所有变换都是相对于固定坐标系OXYZ进行的，所以各坐标变换算子应该依次左乘，即： 2.4工业机器人正向运动学 工业机器人可以认为是一系列通过关节连接起来的连杆组成的开链机构。手部相对固定坐标系的位姿与各连杆之间的相互关系直接相关。因此，在研究手部相对于机座的几何关系时，首先要分析相邻两个连杆之间的关系，这种关系可以用固连于相邻两个连杆上的坐标系之间的关系来描述。 2.4.1 工业机器人连杆坐标系的建立及其齐次变换矩阵 在进行工业机器人正向运动学分析时，首先必须建立连杆坐标系，并给出相邻两个连杆坐标系之间的齐次变换矩阵。 下面我们介绍一种由Denavit和Hartenberg提出的通用方法，即D—H法。 2.4.1.1 连杆参数及连杆坐标系的建立 工业机器人相邻连杆之间的关系，与连杆自身的特征和连杆之间的连接方式有关。因此，我们首先应该清楚如何对连杆的特征和连接方式进行描述。 一、连杆特征的描述 如图2-16所示，连杆i两端有关节i和i+1。该连杆的特征可以用两个量来描述：一个是两个关节轴线沿公垂线的距离li，称为连杆长度；另一个是在垂直于公垂线的平面内两个轴线的夹角?i，称为连杆扭角。这两个参数为表述连杆特征的尺寸参数。 连杆长度：li 连杆扭角：?i 两个参数为表述连杆特征的尺寸参数 二、连杆连接方式的描述 如图2-17所示，连杆i与连杆i-1通过关节i相连，因此，关节i的轴线有两条公垂线与它垂直。两条公垂线的相对位置可用两个参数di和?i来确定。 di是沿关节i轴线两个公垂线与i轴线交点的距离，当关节轴线相交时，di为i轴线两交点的距离。 ?i是在关节i轴线的垂直平面内两个公垂线的夹角，当公垂线不存在时，对旋转关节?i仍然存在。 di和?i是表达相邻连杆连接关系的两个参数。 di和?i都可正、可负 。 这样，相邻两个连杆之间的关系可以由四个参数所描述：其中两个参数（li和?i）描述连杆i的尺寸；另外两个参数（di和?i）描述连杆i和连杆i-1之间的连接关系。 对于旋转关节，?i是关节变量，其它三个参数固定不变； 对于移动关节，di是关节变量，其它三个参数固定不变 。 三、连杆坐标系的建立 D-H法要求按下面规则建立连杆i的坐标系{i}： 1）坐标系{i}与连杆i固连。Zi轴与关节i+1的轴线重合，指向任意；Xi轴与连杆i的两个关节轴线的公垂线重合，方向从关节i指向关节i+1。当li＝0时，取Xi＝?Zi-1×Zi，但Xi轴取向影响?i正负； 2）Yi轴按右手法则规定，即Yi＝Zi×Xi； 3）原点Oi取在Xi和Zi的交点上。当关节i的轴线与关节i+1的轴线相交时，原点Oi取在两轴线的交点上；当关节i的轴线与关节i+1的轴线平行时，原点Oi取在使di＝0的地方 。 在建立连杆坐标系时，下面四点值得注意： 1）连杆坐标系的建立不是唯一的。例如，虽然Zi轴与关节i+1的轴线重合，但Zi轴的指向有两种选择；当Zi轴与Zi-1轴相交时，Xi轴的指向也有两种选择； 2）{i}系也可以建立在关节i的轴线上，并使{i}系的Zi轴与关节i的轴线重合； 3）建立不同的连杆坐标系，相应的连杆参数将会不同。应使描述连杆i的四个参数中尽可能多地为零； 4）与机座固连的{0}系原则上可以任意规定，但是，为了方便计算，一般应将{0}系建立在连杆1的关节1的轴线上，并使{0}系与{1}系尽量靠近或重合。 表2-1a 连杆i的参数 表2-1b 连杆i的坐标系OiXiYiZi 2.4.1.2 相邻两个连杆坐标系之间的齐次变换矩阵 一、i系所作的变换分析 假设i系（动系）和i-1系原来是重合的。 1)先令i系绕Zi轴旋转?i角，即Rot(z，?i) ； 2)再沿Zi轴平移di ，即Trans( z， di) ； 3)然后沿Xi轴平移li ，即Trans( x， li) ； 4)最后绕Xi轴旋转?i角，即Rot(x， ? i) ； 最后i系到达了实际的位姿。 二、i系相对i-1系的齐次变换矩阵Ai 用一个变换矩阵Ai来综合表示