工业机器人技术基础-第3章 工业机器人运动学与动力学PPT文档格式.pptx

1、,在工业机器人控制中，先根据工作任务的要求确定手部要到达的目 标位姿，然后根据逆向运动学求出关节变量，控制器以求出的关节变量 为目标值，对各关节的驱动元件发出控制命令，驱动关节运动，使手部 到达并呈现目标位姿。,逆向运动学工业机器人控制的基础,正向运动学又是逆向运动学的基础,工业机器人相邻连杆之间的相对运动旋转运动、平移运动这种运动体现在连接两个连杆的关节上,坐标变换物理上的旋转运动或平移运动 在数学上可以用矩阵代数来表达,旋转运动 旋转变换平移运动 平移变换,坐标系之间的运动关系可以用矩阵之间的乘法运算来表达。用坐标 变换来描述坐标系（刚体）之间的运动关系是工业机器人运动学分析的基 础。在工

2、业机器人运动学分析中要注意下面四个问题：,工业机器人操作臂可以看成是一个开式运动链，开链的一端固定在机座上，另一端是自由的。在开链机构简图中，关节符号只表示了运动关系。为了研究操作臂各连杆之间的位移关系，可在每个连杆上固连一个坐标系，然后描述这些坐标系之间的关系。在轨迹规划时，人们最感兴趣的是手部相对于固定坐标系的位姿。,图3-1 点的位置描述,1、点的位置描述,2、坐标系的方位描述,3、齐次坐标,规 定,4、刚体的位姿描述,图3-2 刚体的位姿描述,图3-3 刚体的位姿,5、机器人末端操作臂的位姿描述,图3-4 机器人手部的位姿,表示了机器人的姿态代表了机械手的位置 描述了机器人的位姿,在工

3、业机器人中，连杆的运动包括平移运动、旋转运动和复合（平移加旋转）运动。我们把每次简单的运动用一个变换矩阵来表示，因此，多次运动即可用多个变换矩阵的积来表示，表示这个积的矩阵 称为齐次变换矩阵。,通过多个连杆位姿的传递，我们可以得到机器人末端操作器的位姿，即进行机器人正运动学分析。,2、平移变换,图3-5 点的平移变 换,或写成如下形式：,（3-12）,算子左乘点的平移是相对固定坐标系 进行的坐标变换,算子右乘点的平移是相对动坐标系 进行的坐标变换,图-点的旋转变换,Y,O,x,x X,A（x，y，z）A（x，yy，y z）,Zz z,2、平移变换,或写成如下形式：,（3-16）,O图3-7 点

4、的一般旋转变换,图3-8 两次旋转变换,X,Y,O,U,ZW,旋转加平移的变换,X,Y,Z,O,U,W,E,平移变换和旋转变换可以组合在一起，计算时只要用旋转算子乘上 平移算子就可以实现在旋转上加平移。,3、复合变换,平移加旋转的 复合变换矩阵,旋转加平移的变换,X,Y,Z,O,U,W,E,1、连杆参数,图3-9 连杆的几何参 数,连 杆n,关 节n,关 节n+1,n,假设连杆两端的关节轴线平行 那么连杆为平面结构则扭角n=0,图3-10 连杆的关系参数,n,dn,Z,n-,1,X,Xn-1n,n,关 节n+1n+1,连 杆n+1,关节nn,连 杆n,关节n-1 n-1,连 杆n-1,关 节n

5、-2,已知 各个关节 变量的值推 导手部坐标 系的位姿,1、连杆参数,旋转关节 n,选取 n=0 时，使 Xn 与 Xn-1 重合，坐标系 n 的原点选择使 dn=0,移动关节 n,坐标系 n 的选取使 n=0，且当 dn=0 时，Xn与 Xn-1 重合,建立连杆坐标系 n 的规则连杆 n 坐标系的坐标原点位于 n+1 关节轴线上，是关节n+1 的关节轴线与 n 和 n+1 关节轴线公垂线的交点；Z 轴与 n+1 关节轴线重合；X 轴与公垂线重合，从 n 指向 n+1 关节；Y 轴按右手法则确定。,表3-1 连杆参数及坐标系,3、连杆坐标系之间的齐次变换,1、运动学方程,（1）SCARA机器人

6、,（2）STANFORD机器,1、运动学方程正向运动学主要解决机器人运动学方程的建立及手部位姿的求解，即已知各个关节的变量，求手部的位姿。下面给出建立机器人运动学方 程的方法及两个实例。,（1）平面关节型机器人的运动学方程,（a）坐标系一,（b）坐标系二图3-11 SCARA装配机器人坐标 系,表3-2 连杆参数及坐标系,（2）斯坦福（STANFORD）机器人的运动学方程,表3-3斯坦福（STANFORD）机器人的连杆参数,图3-14 斯坦福机器人手腕关节,3、逆运动学实例分析,图3-16 工作域外逆解不存在,图3-17 逆解的多重性,图3-18 避免碰撞的一个可能实现的解,障 碍,图3-19

7、 PUMA560 机器人的四个逆解,应该根据具体情况，在避免碰撞的前提下，按“最短行程”的原则来择优，使每个关节的移动量最 小。由于工业机器人连杆的尺寸大小不同，因此，应遵 循“多移动小关节，少移动大关节”的原则。,机器人是一个复杂的动力学系统，机器人动力学研究包含两类 问题：一类是已知机器人各关节的作用力矩（或力）时，求解机器 人的运动轨迹，即正动力学分析问题；另一类是已知机器人运动轨 迹，求解所需要的关节驱动力矩（或力），即逆动力学分析问题。,本 节 导 入,求解比较困难 较长时间的运算,正动力学问题,我们只对,进行详细分析,逆动力学,了解机器人动力学，也就是了解决定机器人动态特性的运动方

8、程式，即机器人的动力学方程。它表示机器人各关节的关节变量对时间的一阶 导数、二阶导数、各执行器驱动力或力矩之间的关系，是机器人机械系 统的运动方程，其实际动力学模型可以根据已知的物理定律求得。,逆动力学问题即机器人在关节变量空间的轨迹已确 定，或末端执行器在笛卡尔空间的轨 迹已确定（轨迹已被规划），求解机器 人各执行器的驱动力或力矩。,正动力学问题即机器人各执行器的驱动力或力矩为 已知，求解机器人关节变量在关节变 量空间的轨迹或末端执行器在笛卡尔 空间的轨迹。,机器人运动方程的求解可分为两种不同性质的向题,人们研究动力学的重要目的之一是对机器人的运动进行有效控制，以实现预期的运动轨迹。常用的方

9、法有牛顿-欧拉法、拉格朗日法、凯 恩动力学法等，在本节中只介绍拉格朗日法。,拉格朗日法是引入拉格朗日方程直接获得机器人动力学方程的解析公式，并可得到其递推计算方法一般来说，拉格朗日法运算量最大，牛顿-欧拉法次之凯恩动力学法运算量最小、效率最高，在处理闭链机构的机器人动力学方面有一定的优势,本 节 导 入本节是在工业机器人运动学和动力学基础上，讨论工业机器人在 执行作业任务之前，应该预先在关节空间或者作业空间规定它的操 作顺序、行动步骤和作业进程，即对工业机器人进行运动轨迹规划。,起始点,结束点,中间点,TCP,一个基本的机器人规划系统能自动生成一系列避免与障碍物发生碰 撞的机器人动作轨迹。机器

10、人的运动轨迹规划能力应力争最优，就是 依据某个或某些优化准则（如工作代价最小、行走路线最短、行走时间 最短等），在其工作空间中找到一条能避开障碍物的最优轨迹。,运动规划分为路径规划、轨迹生成两部分路径规划是找到一系列要经过的路径点，这些点只是空间中的一些位置或者关节角度轨迹生成是形成一系列运动连续的参考点，需要确定怎么走，走多快,图3-22 机器人在路径上的依次运动,机器人的轨迹规划是指根据机器人作业任务的要求（作业规划），对 机器人末端操作器在工作过程中位姿变化的路径、取向及其变化速度和 加速度进行人为设定。,轨迹规划的一般有三个问题对机器人的任务进行描述，即运动轨迹的描述；根据已经确定的轨

11、迹参数，在计算机上模拟所要求的轨迹；对轨迹进行实际计算，即在运行时间内按一定的速率计算出位置、速度和加速度，从而生成运动轨迹。,图3-23 关节空间轨迹规划原理框图,已知作业 轨迹点,轨迹规划,实际作 业轨迹,机器人 各关节角度,运动学 逆分析,驱动机器人 各关节,已知作业 轨迹点,轨迹 规划,实际作 业轨迹,机器人 各关节角度,运动学 逆分析,驱动机器人 各关节,传感器图3-24 关节轨迹跟踪控制原理框图,图3-26 直角坐标空间轨迹规划的问题,2、作业空间轨迹规划,所有用于关节空间的规划方法都可以用于作业空间（或直角坐标空间）轨迹规划。,图3-27 作业空间轨迹规划原理框图,规划作 业轨迹,实际作 业轨迹,机器人 各关节角度,运动学 逆分析,驱动机器人 各关节,图3-28 末端轨迹跟踪控制原理框图,规划作 业轨迹,实际作 业轨迹,机器人 各关节角度,运动学 逆分析,驱动机器人 各关节,传感器,2020/03/23,