1、为了控制工业机器人(机械臂)的运动，首先需要在机器人中建立相应的坐标系。机器人运动学主要研究机器人各个坐标系之间的运动关系，是机器人进行运动控制的基础。那么，机器人运动学研究包含哪些问题呢？我们该如何去解决呢？本 节 导 入在工业机器人控制中，先根据工作任务的要求确定手部要到达的目标位姿，然后根据逆向运动学求出关节变量，控制器以求出的关节变量为目标值，对各关节的驱动元件发出控制命令，驱动关节运动，使手部到达并呈现目标位姿。工业机器人控制的基础又是逆向运动学的基础旋转运动、平移运动这种运动体现在连接两个连杆的关节上物理上的旋转运动或平移运动在数学上可以用矩阵代数来表达旋转运动 旋转变换 平移运动
2、 平移变换坐标系之间的运动关系可以用矩阵之间的乘法运算来表达。用坐标变换来描述坐标系(刚体)之间的运动关系是工业机器人运动学分析的基础。在工业机器人运动学分析中要注意下面四个问题：工业机器人操作臂可以看成是一个开式运动链，开链的一端固定在机座上，另一端是自由的。在开链机构简图中，关节符号只表示了运动关系。为了研究操作臂各连杆之间的位移关系，可在每个连杆上固连一个坐标系，然后描述这些坐标系之间的关系。在轨迹规划时，人们最感兴趣的是手部相对于固定坐标系的位姿。图3-1 点的位置描述1、点的位置描述2、坐标系的方位描述3、齐次坐标4、刚体的位姿描述图3-2 刚体的位姿描述 图3-3 刚体的位姿5、机
3、器人末端操作臂的位姿描述图3-4 机器人手部的位姿表示了机器人的姿态代表了机械手的位置描述了机器人的位姿在工业机器人中，连杆的运动包括平移运动、旋转运动和复合（平移加旋转）运动。我们把每次简单的运动用一个变换矩阵来表示，因此，多次运动即可用多个变换矩阵的积来表示，表示这个积的矩阵称为齐次变换矩阵。通过多个连杆位姿的传递，我们可以得到机器人末端操作器的位姿，即进行机器人正运动学分析。连杆的初始位姿矩阵齐次变换矩阵经过多次变换后该连杆的最终位姿矩阵2、平移变换图3-5 点的平移变换或写成如下形式：（3-12）点的平移是相对固定坐标系进行的坐标变换点的平移是相对动坐标系进行的坐标变换图-点的旋转变换
4、X XY YZ ZO OA A（x x，y y，z z）A A（x x，y y，z z）x xx xy yy y z zz z2、平移变换或写成如下形式：（3-16）图3-7 点的一般旋转变换O图3-8 两次旋转变换X XY YZ ZO OU UWW 旋转加平移的变换X XY YZ ZO OU UWWE E平移变换和旋转变换可以组合在一起，计算时只要用旋转算子乘上平移算子就可以实现在旋转上加平移。3、复合变换平移加旋转的复合变换矩阵旋转加平移的变换X XY YZ ZO OU UWWE E1、连杆参数图3-9 连杆的几何参数连杆n n关节n n关节n+1n+1 n n假设连杆两端的关节轴线平行那
5、么连杆为平面结构则扭角 n n=0=0图3-10 连杆的关系参数 n nd dn nZ Zn-1n-1X Xn-1n-1X Xn n n n n+1n+1 n-1n-1 n n关节n+n+1 1连杆n+n+1 1关节n n连杆n n关节n-n-1 1连杆n-n-1 1关节n-n-2 2已知各个关节变量的值推导1、连杆参数旋转关节 n n选取 n n =0=0 时，使 X Xn n 与 X Xn-1 n-1 重合，坐标系 n n 的原点选择使 d dn n =0=0移动关节 n n坐标系 n n 的选取使 n n=0 =0，且当 d dn n=0 =0 时，X Xn n与 X Xn-1n-1 重
6、合连杆 n n 坐标系的坐标原点位于 n+1 n+1 关节轴线上，是关节 n+1 n+1 的关节轴线与 n n 和 n+1 n+1 关节轴线公垂线的交点；Z Z 轴与 n+1 n+1 关节轴线重合；X X 轴与公垂线重合，从 n n 指向 n+1 n+1 关节；Y Y 轴按右手法则确定。名 称含 义“”号性 质 n n转角连杆n n 绕关节n n 的Z Zn-1 n-1 轴的转角右手法则转动关节为变量移动关节为常量距离连杆n n 绕关节n n 的Z Zn-1 n-1 轴的位移沿Z Zn-1n-1 正向为+转动关节为常量移动关节为变量长度沿X Xn n 方向上，连杆n n 的长度，尺寸参数与X
7、Xn n 正向一致常量扭角连杆n n 两关节轴线之间的扭角，尺寸参数右手法则常量连 杆 n n 的 坐 标 系 O On n Z Zn n X Xn n Y Yn n 原 点 O On n 轴 Z Zn n 轴 X Xn n 轴 Y Yn n 位于关节 n+1n+1 轴线与连杆 n n 两关节轴线的公垂线的交点处与关节 n+1n+1 轴线重合沿连杆n n 两关节轴线之公垂线，并指向 n+1n+1关节按右手法则确定3、连杆坐标系之间的齐次变换1、运动学方程正向运动学主要解决机器人运动学方程的建立及手部位姿的求解，即已知各个关节的变量，求手部的位姿。下面给出建立机器人运动学方程的方法及两个实例。1
8、、运动学方程（1）平面关节型机器人的运动学方程（a）坐标系一（b）坐标系二图3-11 SCARA装配机器人坐标系连杆（2）斯坦福（STANFORD）机器人的运动学方程杆号 表3-33-3斯坦福（STANFORDSTANFORD）机器人的连杆参数图3-14 斯坦福机器人手腕关节3、逆运动学实例分析图3-16 3-16 工作域外逆解不存在 图3-17 3-17 逆解的多重性图3-18 3-18 避免碰撞的一个可能实现的解障 碍 图3-19 PUMA560 3-19 PUMA560 机器人的四个逆解 由于工业机器人连杆的尺寸大小不同，因此，应遵循“”的原则。应该根据具体情况，在避免碰撞的前提下，按“
9、”的原则来择优，使每个关节的移动量最小。机器人是一个复杂的动力学系统，机器人动力学研究包含两类问题：一类是已知机器人各关节的作用力矩（或力）时，求解机器人的运动轨迹，即；另一类是已知机器人运动轨迹，求解所需要的关节驱动力矩（或力），即。本 节 导 入求解比较困难较长时间的运算正动力学问题我们只对 进行详细分析逆动力学了解机器人动力学，也就是了解决定机器人动态特性的运动方程式，即机器人的动力学方程。它表示机器人各关节的关节变量对时间的一阶导数、二阶导数、各执行器驱动力或力矩之间的关系，是机器人机械系统的运动方程，其实际动力学模型可以根据已知的物理定律求得。逆动力学问题 即机器人在关节变量空间的轨
10、迹已确定，或末端执行器在笛卡尔空间的轨迹已确定(轨迹已被规划)，求解机器人各执行器的驱动力或力矩。正动力学问题 即机器人各执行器的驱动力或力矩为已知，求解机器人关节变量在关节变量空间的轨迹或末端执行器在笛卡尔空间的轨迹。机器人运动方程的求解可分为两种不同性质的向题人们研究动力学的重要目的之一是对机器人的运动进行有效控制，以实现预期的运动轨迹。常用的方法有牛顿-欧拉法、拉格朗日法、凯恩动力学法等，在本节中只介绍拉格朗日法。运算量最小、效率最高，在处理闭链机构的机器人动力学方面有一定的优势是引入拉格朗日方程直接获得机器人动力学方程的解析公式，并可得到其递推计算方法一般来说，拉格朗日法运算量最大，牛
11、顿-欧拉法次之本节是在工业机器人运动学和动力学基础上，讨论工业机器人在执行作业任务之前，应该预先在关节空间或者作业空间规定它的操作顺序、行动步骤和作业进程，即对工业机器人进行运动轨迹规划。本 节 导 入一个基本的机器人规划系统能自动生成一系列避免与障碍物发生碰撞的机器人动作轨迹。机器人的运动轨迹规划能力应力争最优，就是依据某个或某些优化准则(如工作代价最小、行走路线最短、行走时间最短等)，在其工作空间中找到一条能避开障碍物的最优轨迹。运动规划分为路径规划、轨迹生成两部分是找到一系列要经过的路径点，这些点只是空间中的一些位置或者关节角度是形成一系列运动连续的参考点，需要确定怎么走，走多快图3-2
12、2 机器人在路径上的依次运动机器人的轨迹规划是指根据机器人作业任务的要求（作业规划)，对机器人末端操作器在工作过程中位姿变化的路径、取向及其变化速度和加速度进行人为设定。对机器人的任务进行描述，即运动轨迹的描述；根据已经确定的轨迹参数，在计算机上模拟所要求的轨迹；对轨迹进行实际计算，即在运行时间内按一定的速率计算出位置、速度和加速度，从而生成运动轨迹。图3-23 关节空间轨迹规划原理框图已知作业轨迹点轨迹规划实际作业轨迹机器人各关节角度运动学逆分析驱动机器人各关节图3-24 关节轨迹跟踪控制原理框图已知作业轨迹点轨迹规划实际作业轨迹机器人各关节角度运动学逆分析驱动机器人各关节传感器图3-26 直角坐标空间轨迹规划的问题2、作业空间轨迹规划所有用于关节空间的规划方法都可以用于作业空间（或直角坐标空间）轨迹规划。图3-27 作业空间轨迹规划原理框图规划作业轨迹实际作业轨迹机器人各关节角度运动学逆分析驱动机器人各关节图3-28 末端轨迹跟踪控制原理框图规划作业轨迹实际作业轨迹机器人各关节角度运动学逆分析驱动机器人各关节传感器2020/03/23
