工业机器人第二章

第二章位姿描述与齐次变换§2.1操作机器人工作过程分析一、操作机器人：具有和人类上肢相似的动作功能，用于操作作业的机器人，称为～。二、人类操作过程分析(先看人！）： 板擦黑板→讲台：（眼）定位（手）到位(手）抓取（手臂）运动（手臂）停止（手）松开…工作方法？手眼协调！（可用于机器人吗？）关键：位置（＋姿态），动作顺序，动作要求三、机器人的典型工作分析（如何让机器人完成？）：

1、轴孔类装配

两个基本问题： （1）动作顺序及要求； （2）位置及姿态要求。

2、弧焊作业： 也需要解决上述两个基本问题！

3、搬运作业（例如码垛） （结论同上）

4、其它操作作业（喷漆、上下料、点焊、…）

操作机器人工作任务描述两个基本问题！ 关键：位姿描述！四、位姿定义：

位置和姿态合称～。 （Position)(orientation)(pose)一、位姿表达

1、表达方式： 位置＋姿态

§2.2位姿描述与变换位姿可以用一个直角坐标系表达，简记为：三个坐标轴空间点坐标原点空间方位（线、面、体）2、特点：

位姿描述是相对的！

坐标系在坐标系中的位置：点在中的坐标值。二、位置描述数学表达式：参考坐标系描述对象矢量表达形式坐标值形式三、姿态描述为了方便起见，先以平面坐标系为例进行讲解，然后推广到三维情况！如右图所示，先将平移到，然后绕旋转得到现在求的两个坐标轴在坐标系中的姿态。坐标轴的姿态值可用其单位矢量在参考坐标系中的投影值表示！注意！ 由于笛卡儿坐标系各个坐标轴之间存在内部约束，因此坐标系的姿态描述一般是冗余的。例如在平面坐标系情况下，只有一个独立量

已知某点在中的位置，试求其在中的位置值。四、绝对描述由几何学可知，要求出一点在绝对坐标系中的位置，关键是求出其在中的位置，然后与坐标原点值相加即可得到该点绝对位置。由几何法，得：写成矩阵形式？相对坐标值分析：

该矩阵的出现是由于相对于旋转造成的，即是由姿态引起的；（1）矩阵第一列：在中的姿态；（2）矩阵第二列：在中的姿态。五、姿态矩阵由坐标系三个坐标轴的姿态构成的矩阵，称为～。六、齐次表达根据几何学知识，上面第四小节中给定点的绝对位置为：

比较此矩阵与在中的姿态表达式，可知：

在中姿态，记作。写成三维形式，有：

在中位置，记作分成两块，不便于记忆！若写成如下齐次形式，有：齐次变换矩阵七、齐次变换矩阵1.构成：分为4块。左上角是姿态矩阵，为一单位正交矩阵；右上角为对象坐标系原点位置值；左下角为三个000，简记为0；右下角为1。（1）相对于描述的的位姿（从数学角度）；（2）把变换到的结果（从运动角度）。位姿描述的关键是求得其齐次变换矩阵！八、基本变换矩阵（应牢记！！！）1.平移矩阵：2.含义：参考坐标系未标出，原因？2.绕X轴旋转角（学生课堂推导！）3.绕Y轴旋转角（课堂推导！）4.绕Z轴旋转角（课堂推导！）四个基本变换，要牢记！（如何记？）九、多次变换机器人一般由多个杆件构成，为了到达某一位姿往往需要各个杆件都做出运动，因此存在多次变换问题；第四节中的绝对变换结果是通过几何法求得的，不能总用此法计算机器人位姿（？）。如何计算多次变换结果？1.几何法计算结果：分析：2.运动过程分析从运动到，可以分解成如下几个基本变换：平移变换：绕旋转：3.试按照运动顺序计算相关基本变换矩阵相乘结果4.计算结果比较两种方法结果相同！但后一种方法简单！问题：是否仅仅按照运动变换顺序将相关的基本变换矩阵相乘，即可以得到齐次变换阵？5.验证计算（绘图即可）结论：

多次变换结果不仅与变换顺序有关，而且与相对的坐标系有关！ （1）必须正确确定变换顺序！ （2）必须正确确定每次变换所相对的坐标系的性质！

若每次变换都是相对于前一个坐标系进行的，则变换结果等于各个基本变换矩阵顺序相乘；若每次变换都是相对于参考坐标系进行的，则变换结果等于各个基本变换矩阵逆序相乘；问题：上述结论只是根据2次变换得到的，适应于多次吗？十、相对变换、绝对变换相对变换：若变换是相对于上一次变换得到的坐标系进行的，则称为～。绝对变换：若变换是相对于参考坐标系进行的，则称为～。相对变换结果：

顺序相乘！绝对变换结果：

逆序相乘！十一、左乘、右乘左乘：在某一变换矩阵左面乘以一个矩阵绝对变换右乘：在某一变换矩阵右面乘以一个矩阵相对变换若确定了变换性质，就没必要再标出所相对的坐标系了！十二、逆变换已知，求物理含义：已知，问如把再变回到，其齐次变换矩阵＝？用途：机器人运动控制！求法： （1）矢量法（不讲，请同学自己做，作业） （2）解析法设：由于其逆变换阵仍然为齐次矩阵，因此可以假设：此外，有：∵∴有：即：利用矩阵块乘法，得：（利用单位正交矩阵性质）则：§2.3非直角坐标系描述前面讲的是如何用直角坐标系进行位姿描述及变换，其方法适用于所有机器人。但对某些机器人，用其它非直角坐标系描述可能更为方便。一、圆柱坐标系圆柱坐标机器人（图2－1）典型应用场合：机床上下料位姿描述参数：图2－1主要特点：机构特点：运动特点：优缺点：P-R-P水平面内相对姿态不变特别适合搬运，占地大，平衡性差，…二、极坐标系极坐标机器人（图2－2）典型应用场合：空间运用位姿描述参数：图2－2主要特点：机构特点：运动特点：优缺点：R-R-P极坐标式运动占地小，工作空间大，运动控制较复杂，…坐标系选择原则：

视方便而定。一般情况下，上述两种机器人采用专用坐标系更方便。三、RPY(Roll,Pitch,Yaw)角直角坐标系位姿描述法： 位置：坐标原点，3个参数； 姿态：3根坐标轴，3×3矩阵，9个参数。姿态矩阵9个参数中只有3个是独立的！可否只用3个量完成姿态描述？如何求得？RPY角（图2－3）：Roll:（绕本身纵轴－Z轴）侧滚Pitch:（前后-绕Y轴）俯仰Yaw:偏航（绕X轴）侧滚俯仰偏航RPY变换过程：各运动均是相对于当前参考坐标系进行的！图2－3RPY变换结果（绝对变换）：四、欧拉角变换过程1（Z-Y-X)：变换过程2(Z-Y-Z)