工业机器人-3

null第3章 机器人运动学第3章 机器人运动学3.1 坐标变换 3.2 运动学方程 习 题 快递公司问题件快递公司问题件货款处理关于圆的周长面积重点题型关于解方程组的题及答案关于南海问题 *第3章 机器人运动学第3章 机器人运动学*运动学研究的问题： 手在空间的运动与各个关节的运动之间的关系。 正问题：已知关节运动，求 手的运动。 逆问题：已知手的运动，求 关节运动。第3章 机器人运动学第3章 机器人运动学*数学模型： 手的运动→位姿变化→位姿矩阵M 关节运动→参数变化→关节变量qi，i=1，…，n 运动学方程： M=f(qi)， i=1，…，n 正问题：已知qi，求M。 逆问题：已知M，求qi。第3章 机器人运动学第3章 机器人运动学*预备知识 １、机器人位姿的 表 关于同志近三年现实表现材料材料类招标技术评分表图表与交易pdf视力表打印pdf用图表说话 pdf 示 ２、机器人的坐标系 　　第3章 机器人运动学第3章 机器人运动学*１、机器人位姿的表示 　　机器人的位姿主要是指机器人手部在空间的位置和姿态，有时也会用到其它各个活动杆件在空间的位置和姿态。 　　 第3章 机器人运动学第3章 机器人运动学*１、机器人位姿的表示 　　位置可以用一个3×1的位置矩阵来描述。 第3章 机器人运动学第3章 机器人运动学*１、机器人位姿的表示 　　姿态可以用坐标系 三个坐标轴两两夹角的 余弦值组成3×3的姿态 矩阵来描述。 第3章 机器人运动学第3章 机器人运动学*１、机器人位姿的表示 例：右图所示两坐标系的姿态为：第3章 机器人运动学第3章 机器人运动学*2、机器人的坐标系 手部坐标系——参考机器人手部的坐标系，也称机器人位姿坐标系，它表示机器人手部在指定坐标系中的位置和姿态。 机座坐标系——参考机器人机座的坐标系，它是机器人各活动杆件及手部的公共参考坐标系。 杆件坐标系——参考机器人指定杆件的坐标系，它是在机器人每个活动杆件上固定的坐标系，随杆件的运动而运动。 绝对坐标系——参考工作现场地面的坐标系，它是机器人所有构件的公共参考坐标系。　 第3章 机器人运动学第3章 机器人运动学*2、机器人的坐标系 手部坐标系{h} 机座坐标系{0} 杆件坐标系{i} i=1，…，n 绝对坐标系{B}　 3.1 坐标变换3.1 坐标变换1、直角坐标变换 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换1、直角坐标变换*坐标之间的变换关系： 平移变换 旋转变换3.1 坐标变换3.1 坐标变换（1）平移变换 设坐标系{i}和坐标系{j}具有相同的姿态，但它俩的坐标原点不重合，若用 矢量表示坐标系{i}和坐标系{j}原点之间的矢量，则坐标系{j}就可以看成是由坐标系{i}沿矢量 平移变换而来的，所以称矢量 为平移变换矩阵，它是一个3×1的矩阵，即： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换1、直角坐标变换*（1）平移变换 若空间有一点在坐标系{i}和坐标系{j}中分别用矢量 和 表示，则它们之间有以下关系： 称上式为坐标平移方程。 3.1 坐标变换3.1 坐标变换（2）旋转变换 设坐标系{i}和坐标系{j}的原点重合，但它俩的姿态不同，则坐标系{j}就可以看成是由坐标系{i}旋转变换而来的，旋转变换矩阵比较复杂，最简单的是绕一根坐标轴的旋转变换，下面以此来对旋转变换矩阵作以说明。 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 绕z轴旋转θ角 坐标系{i}和坐标系{j}的原点重合，坐标系{j}的 坐标轴方向相对于坐标系{i}绕轴旋转了一个θ角。θ 角的正负一般按右手法则确定，即由z轴的矢端看，逆 时钟为正。1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 绕z轴旋转θ角 若空间有一点p，则其 在坐标系{i}和坐标系{j}中 的坐标分量之间就有以下关系： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 绕z轴旋转θ角 若补齐所缺的有些项，再作适当变形，则有： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 绕z轴旋转θ角 将上式写成矩阵的形式，则有： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 绕z轴旋转θ角 再将其写成矢量形式，则有： 称上式为坐标旋转方程，式中： ——p点在坐标系{i}中的坐标列阵（矢量）； ——点在坐标系{j}中的坐标列阵（矢量）； ——坐标系{j}变换到坐标系{i}的旋转变换矩阵，也称为方向余弦矩阵。 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 ——旋转变换矩阵，也称为方向余弦矩阵， 是一个3×3的矩阵，其中的每个元素就是坐标系{i}和 坐标系{j}相应坐标轴夹角的余弦值，它表明坐标系{j} 相对于坐标系{i}的姿态（方向）。1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 绕x轴旋转α角的 旋转变换矩阵为： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 绕y轴旋转β角的 旋转变换矩阵为： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 旋转变换矩阵的逆矩阵 旋转变换矩阵的逆矩阵既可以用线性代数的方法求 出，也可以用逆向的坐标变换求出。以绕z轴旋转θ角 为例，其逆向变换即为绕z轴旋转-θ角，则其旋转变换 矩阵就为： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（2）旋转变换 旋转变换矩阵的逆矩阵 比较以下两式： 结论： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（3）联合变换 设坐标系{i}和坐标系{j}之间存在先平移变换，后旋转变换，则空间任一点在坐标系{i}和坐标系{j}中的矢量之间就有以下关系： 称上式为直角坐标系中的坐标联合变换方程。1、直角坐标变换*3.1 坐标变换3.1 坐标变换（3）联合变换 若坐标系{i}和坐标系{j}之间是先平移变换，后旋转变换，则上述关系是应如何变化？1、直角坐标变换*3.1 坐标变换3.1 坐标变换例：已知坐标系{B}的初始位置与坐标系{A}重合，首先 坐标系{B}沿坐标系{A}的x轴移动12个单位，并沿坐 标系{A}的y轴移动6个单位，再绕坐标系{A}的z轴旋 转30°，求平移变换矩阵和旋转变换矩阵。假设某 点在坐标系{B}中的矢量为 ，求该点 在坐标系{A}中的矢量。 1、直角坐标变换*3.1 坐标变换3.1 坐标变换解：由题意可得平移变换矩阵和旋转变换矩阵分别为： ， 则： 1、直角坐标变换*3.1 坐标变换3.1 坐标变换（1）齐次坐标的定义 空间中任一点在直角坐标系中的三个坐标分量用 表示，若有四个不同时为零的数 与三个直角坐标分量之间存在以下关系： 则称 是空间该点的齐次坐标。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（1）齐次坐标的定义 齐次坐标的性质 Ⅰ.空间中的任一点都可用齐次坐标表示； Ⅱ.空间中的任一点的直角坐标是单值的，但其对应的齐次坐标是多值的； Ⅲ.k是比例坐标，它表示直角坐标值与对应的齐次坐标值之间的比例关系； Ⅳ.若比例坐标k=1，则空间任一点(x, y, z)的齐次坐标为(x, y, z) ，以后用到齐次坐标时，一律默认k=1 。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） 若坐标系{j}是{i}先沿矢量 平移，再绕z轴旋转θ角得到的，则空间任一点在坐标系{i}和坐标系{j}中的矢量和对应的变换矩阵之间就有 ，写成矩阵形式则为： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） 再用坐标分量等式表示，则有： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） 引入齐次坐标，补齐所缺各项，再适当变形，则有： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） 再将其写成矩阵形式则有： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） 由此可得联合变换的齐次坐标方程为： 式中， ——齐次坐标变换矩阵， 它是一个4×4的矩阵。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ①齐次坐标变换矩阵的意义 若将齐次坐标变换矩阵分块，则有： 意义：左上角的3×3矩阵是两个坐标系之间的旋转变换矩阵，它描述了姿态关系；右上角的3×1矩阵是两个坐标系之间的平移变换矩阵，它描述了位置关系，所以齐次坐标变换矩阵又称为位姿矩阵。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ①齐次坐标变换矩阵的意义 齐次变换矩阵的通式为： 式中， ——{j}的原点在{i}中的坐标分量； ——{j}的x轴对{i}的三个方向余弦； ——{j}的y轴对{i}的三个方向余弦； ——{j}的z轴对{i}的三个方向余弦。2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ②单独的平移或旋转齐次坐标变换矩阵 平移变换的齐次矩阵为：2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ②单独的平移或旋转齐次坐标变换矩阵 旋转变换的齐次矩阵为：2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ②单独的平移或旋转齐次坐标变换矩阵 同理可得：2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ③联合变换与单步齐次变换矩阵的关系 观察以下三个齐次变换矩阵的关系： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ③联合变换与单步齐次变换矩阵的关系 经观察可得： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ③联合变换与单步齐次变换矩阵的关系 任何一个齐次坐标变换矩阵均可分解为一个平移变 换矩阵与一个旋转变换矩阵的乘积，即： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ③联合变换与单步齐次矩阵的关系 当空间有任意多个坐标系时，若已知相邻坐标系之间的齐次坐标变换矩阵，则由坐标变换原理可知： 由此可知，建立机器人的坐标系，可以通过齐次坐标变换，将机器人手部在空间的位置和姿态用齐次坐标变换矩阵描述出来，从而建立机器人的运动学方程。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ④相对变换 两个坐标系之间总的齐次坐标变换矩阵等于每次单独变换的齐次坐标变换矩阵的乘积，而相对变换则决定这些矩阵相乘的顺序，称其为左乘和右乘原则： Ⅰ.若坐标系之间的变换是始终相对于原来的参考坐标系，则齐次坐标变换矩阵左乘； Ⅱ.若坐标系之间的变换是相对于当前新的坐标系，则齐次坐标变换矩阵右乘。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ④相对变换 例：已知坐标系{B}是绕坐标系{A}的zA轴旋转90°，再绕{A}的xA轴旋转90°，最后沿矢量 平移得到的，求坐标系{A}与坐标系{B}之间的齐次坐标变换矩阵。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ④相对变换 解：由于变换始终是相对于原来的参考坐标系，所以满足左乘原则，即有： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ④相对变换 解：若例中的变换是相对于每次变换后新的当前坐标系，其就满足右乘原则，即有： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ⑤逆变换 已知{i}通过先平移， 后旋转变成{j}，则变换 矩阵为： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ⑤逆变换 逆变换时： 变换顺序颠倒； 先平移，后旋转→先旋转，后平移。 变换参数取反。 旋转（θ） →（ -θ）， 平移（px，py，pz） →（-px，-py，-pz）。 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ⑤逆变换 则{j}到{i}的变换矩阵为： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ⑤逆变换2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ⑤逆变换2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ⑤逆变换 若齐次坐标变换矩阵为： 则： 2、齐次坐标变换*3.1 坐标变换3.1 坐标变换（2）齐次变换矩阵（D-H矩阵） ⑤逆变换 若齐次坐标变换矩阵为：2、齐次坐标变换*3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤 （1）建立坐标系 （2）确定参数 （3）相邻杆件的位姿矩阵 （4）建立方程 2、运动学方程的解*3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*运动学方程的模型： M=f(qi)， i=1，…，n M——机器人手在空间的位姿 qi——机器人各个关节变量 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（1）建立坐标系 ①机座坐标系{0} ②杆件坐标系{i} i=1，2，…，n ③手部坐标系{h}3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（1）建立坐标系 ①机座坐标系{0} 建立原则： z轴垂直， x轴水平， 方向指向手部所在平面。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（1）建立坐标系 ②杆件坐标系{i}，i=1，2，…，n 建立原则： z轴与关节轴线重合， x轴与两关节轴线的 距离重合，方向指向下一个杆件。 杆件坐标系有两种： 第一种： z轴与i+1关节轴线重合； 第二种： z轴与i关节轴线重合。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（1）建立坐标系 ②杆件坐标系{i} 第一种坐标系： z轴与i+1关节轴线重合。0123关节1关节2关节33.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（1）建立坐标系 ②杆件坐标系{i} 第二种坐标系： z轴与i关节轴线重合。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（1）建立坐标系 ③手部坐标系{h} 在第一种杆件坐标系下，{h}与{n}坐标系重合。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（1）建立坐标系 ③手部坐标系{h} 在第二种杆件坐标系下，{h}与{n}坐标系的方向保持一致。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（2）确定参数 ①杆件几何参数（不变） I、杆件长度li： 两关节轴线的距离。 II、杆件扭角αi： 两关节轴线的夹角。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（2）确定参数 ②关节运动参数 I、关节平移量di： 相邻杆件的长度在关节轴线上的距离。 II、关节回转量θi： 相邻杆件的长度在关节轴线上的夹角。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（2）确定参数 ②关节运动参数 关节变量： di——平移关节； θi——回转关节。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ①第一种坐标系 建立坐标系{i-1}、{i}，试分析{i-1}→{i}的变换过程。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ①第一种坐标系 I、{i-1}→{i}变换过程 a、Trans（0，0，di）； b、Rot（z，θi）； c、Trans（li，0，0）； d、Rot（x，αi）。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ①第一种坐标系 II、单步齐次变换矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ①第一种坐标系 III、相邻杆件的位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ①第一种坐标系 III、相邻杆件的位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ①第一种坐标系 注意：特例！！！ 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ②第二种坐标系 建立坐标系{i-1}、{i}，试分析{i-1}→{i}的变换过程。3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ②第二种坐标系 I、{i-1}→{i}变换过程 a、Trans（li-1，0，0）； b、Rot（x，αi-1）； c、Trans（0，0，di）； d、Rot（z，θi）。ili-1i-1θi关节idiXi-1Z i-1Oi-1XiZiOiαi-13.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ②第二种坐标系 II、单步齐次变换矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ②第二种坐标系 III、相邻杆件的位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（3）相邻杆件位姿矩阵 ②第二种坐标系 III、相邻杆件的位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*（4）建立方程3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*例：已知三自由度平面关节机器人如图所示，设机器人杆件1、2、3的长度为l1，l2，l3。建立机器人的运动学方程。 l1l3l23.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（1）建立坐标系(第一种) a、机座坐标系｛0｝ b、杆件坐标系｛i｝ c、手部坐标系｛h｝ （与末端杆件坐标系 ｛n｝重合） 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（2）确定参数θ3θ2θ13.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（3）相邻杆件位姿矩阵θ3θ2θ13.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（3）相邻杆件位姿矩阵θ3θ2θ13.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（3）相邻杆件位姿矩阵θ3θ2θ13.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（4）建立方程 将相邻杆件位姿矩阵依次相乘，则有： 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（4）建立方程 若用矩阵形式表示，则为： 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（4）建立方程 若用方程组形式表示，则为： 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（1）建立坐标系(第二种) a、机座坐标系｛0｝ b、杆件坐标系｛i｝ c、手部坐标系｛h｝ （与末端杆件坐标系 ｛n｝方向一致） 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（2）确定参数3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（3）相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（3）相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（3）相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（3）相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（4）建立方程 将相邻杆件位姿矩阵依次相乘，则有： 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（4）建立方程 若用矩阵形式表示，则为： 3.2 运动学方程的建立3.2 运动学方程的建立1、运动学方程建立步骤*解：（4）建立方程 若用方程组形式表示，则为： 3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*运动学方程的模型： M0h=f(qi)， i=1，…，n 正问题：已知关节变量qi的值，求手在空间的位姿M0h。 逆问题：已知手在空间的位姿M0h，求关节变量qi的值。 3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*（1）运动学方程的正解 正问题：已知关节变量qi的值，求手在空间的位姿M0h。 正解特征：唯一性。 用处：检验、校准机器人。 3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*（2）运动学方程的逆解 逆问题：已知手在空间的位姿M0h，求关节变量qi的值。 逆解特征分三种情况：多解、唯一解、无解。 多解的选择原则：最近原则。 计算方法：递推逆变换法，即3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*例：已知四轴平面关节SCARA机器人如图所示，试计算： （1）机器人的运动学方程； （2）当关节变量取 qi=[30°，-60°，－120，90°]T 时，机器人手部的位置和姿态； （3）机器人运动学逆解的数学 表达式。 3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（1）运动学方程 a、建立坐标系（第一种） 机座坐标系｛0｝ 杆件坐标系｛i｝ 手部坐标系｛h｝3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（1）运动学方程 b、确定参数3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（1）运动学方程 c、相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（1）运动学方程 c、相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（1）运动学方程 c、相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（1）运动学方程 c、相邻杆件位姿矩阵3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（1）运动学方程 d、建立方程 3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（2）已知qi=[30°，-60°，－120，90°]T，则：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 已知运动学方程，用通式表示为：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 联立方程：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 由上面（a）、（b）两式可得 ：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 由上面（c）、（d）两式平方再相加可得 ：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 由上面（c）、（d）两式展开可得 ：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 由上面两式可得 ：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 由上面两式可得 ：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 已知θ1，θ2可得 ：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 最后由（e)式可得 ：3.2 运动学方程的建立3.2 运动学方程的建立2、运动学方程的解*解：（3）逆解数学表达式 逆解数学表达式为：第3章 习 题第3章 习 题什么是齐次坐标？与直角坐标有何区别？ 其次变换矩阵的意义是什么? 联合变换与单步变换的关系是什么？ 已知齐次变换矩阵，如何计算逆变换矩阵？ 机器人运动学解决什么问题?什么是正问题和逆问题？ 机器人的坐标系有哪些？如何建立？ 建立运动学方程需要确定哪些参数？如何辨别关节变量？ 第一种和第二种杆件坐标系下，相邻杆件位姿矩阵计算有何区别？ 机器人运动学方程的正解和逆解有何特征？各应用在什么场合？逆解如何计算？*第3章 习 题第3章 习 题*第3章 习 题第3章 习 题*第3章完！第3章完！