第4章 工业机器人运动轨迹规划

数化轨迹，对结点进行插值，并满足约束条件。
第二种方法要求用户给出运动路径的解析式：如直角坐标空间中的直线路径，轨迹 规划器在关节空间或直角坐标空间中确定一条轨迹来逼近预定的路径。 二、插补方法分类 点位控制，即PTP控制，通常没有路径约束，多以关节坐标运动表示。点位控制只 要求满足起终点位姿，在轨迹中间只有关节的几何限制、最大速度和加速度约束，为了 保证运动的连续性，要求速度连续，各轴协调。
培养严谨认真、规范操作的意识。
培养合作学习、团结协作的精神。
任务1 轨迹规划问题与性能指标
【任务描述】 在本次任务中需要了解清楚轨迹规划的重要性，轨迹规划的基本概念和方式。路径 和轨迹规划与受到控制的机器人从一个位置移动到另一个位置的方法有关。路径与轨迹 规划既要用到机器人的运动学相关知识，也要用到机器人的动力学。本任务主要讨论机 器人的轨迹规划问题和性能指标。
任务3 机器人运动轨迹规划基本方法
【任务描述】 本任务主要讨论连续路径的无障碍的轨迹规划方法。轨迹规划器可形象地看成为一 个黑箱如图4-8所示，其输入包括路径的“设定”和“约束”，输出的是操作臂末端手部的“位 姿序列”，表示手部在各离散时刻的中间形位。
路径约束
路径设定
路径规划器
动力学约束
图4-8 路径规划示意图
② 插补方式：机器人再现时，从前一程序点移动到当前程序点的动作类型。
③ 再现速度：机器人再现时，从前一程序点移动到当前程序点的速度。 ④ 空走点：指从当前程序点移动到下一程序点的整个过程不需要实施作业，用于示教除 作业开始点和作业中间点之外的程序点。 ⑤ 作业点：指从当前程序点移动到下一程序点的整个过程需要实施作业，用于作业开始 点和作业中间点。
任务2 常用机器人路径控制方式
【知识储备】 三、常用轨迹运动控制指令 2. MoveJ －通过关节移动移动机器人 当运动不必是直线的时候，MoveJ用来快速将机器人从一个点运动到另一个点，如 图4-6示意。机器人和外部轴沿着一个非直线的路径移动到目标点，所有轴同时到达目标
点。该指令只能用在主任务T_ROB1中，或者在多运动系统中的运动任务中。
图4-9 机器人轨迹控制过程
任务3 机器人运动轨迹规划基本方法
【拓展与提高】 一、直线插补 工业机器人轨迹控制的算法主要有直线轨迹插补算法以及和圆弧轨迹插补算法，对 于非直线和圆弧轨迹，可以采用直线或圆弧逼近的方式实现这些轨迹。 在有些情况下要求变化姿态，这就需要姿态插补，可仿照下面介绍的位置插补原理
[ \Conc ]：并发事件，数据类型：switch
ToPoint：数据类型为robtarget [ \ID ]：同步ID，数据类型：identno Speed：数据类型为speeddata [\V]：速度，数据类型：num [\T]：时间，数据类型：num Zone：数据类型为zonedata
任务2 常用机器人路径控制方式
C B
D E
A
图4-4 连续轨迹控制方式示意图
任务2 常用机器人路径控制方式
【知识储备】 三、常用轨迹运动控制指令 1. MoveL－让机器人作直线运动 MoveL用来让机器人TCP直线运动到给定的目标位置，如图4-5示意。当TCP仍旧固 定的时候，该指令也可以重新给工具定方向。该指令只能用在主任务T_ROB1，或者多运
教的重点。从运动方式上看，工业机器人具有点到点（PTP）运动和连续路径（CP）运
动2种形式。按运动路径种类区分，工业机器人具有直线和圆弧2种动作类型。
任务2 常用机器人路径控制方式
【知识储备】 一、点位控制方式(Point To Point) 这种控制方式的特点是只控制工业机器人末端执行器在作业空间中某些规定的离散 点上的位姿，如图4-3所示。控制时只要求工业机器人快速、准确地实现相邻各点之间的 运动,而对达到目标点的运动轨迹则不作任何规定。
任务3 机器人运动轨迹规划基本方法
【知识储备】 三、工业机器人轨迹控制过程 机器人的基本操作方式是示教-再现，即首先教机器人如何做，机器人记住了这个过 程，于是它可以根据需要重复这个动作。 实际上，对于有规律的轨迹，仅示教几个特征点，计算机就能利用插补算法获得中
间点的坐标，如直线需要示教两点，圆弧需要示教三点，通过机器人逆向运动学算法由
l，2，3，4，5)为气动手爪必须经过的直角坐标结点。参照这些结点的位姿将作业描述为
如表4-2所示的手部的一连串运动和动作。
图4-2机器人插螺栓作业的轨迹
任务2 常用机器人路径控制方式
【任务描述】 本次任务主要是了解工业机器人控制中的路径生成问题，以及路径控制的分类。针 对ABB的工业机器人路径运动，主要介绍其运动控制指令。 【知识储备】 运动轨迹是机器人为完成某一作业，工具中心点（TCP）所掠过的路径，是机器示
12所示。
图4-11 由已知的三点P1、P2、P3决定的圆弧
图4-12 圆弧插补
任务3 机器人运动轨迹规划基本方法
【拓展与提高】 二、圆弧插补 2. 空间圆弧插补 空间圆弧是指三维空间任一平面内的圆弧，此为空间一般平面的圆弧问题。 空间圆弧插补可分三步来处理：
处理，也可参照圆弧的姿态插补方法解决，如图4-10所示。
图4-10 空间直线插补
任务3 机器人运动轨迹规划基本方法
【拓展与提高】 二、圆弧插补 1．平面圆弧插补 平面圆弧是指圆弧平面与基坐标系的三大平面之一重合，以XOY平面圆弧为例。已 知不在一条直线上的三点P1、P2、P3及这三点对应的机器人手端的姿态，如图4-11及图4-
图4-7 圆弧运动示意图
任务2 常用机器人路径控制方式
【拓展与提高】 在进行轨迹示教时，直线轨迹示教2个程序点（直线起始点和直线结束点）；圆弧轨 迹示教3个程序点（圆弧起始点、圆弧中间点和圆弧结束点）。 机器人运动轨迹的示教主要是确认程序点的属性。每个程序点主要包含： ① 位置坐标：描述机器人TCP的6个自由度（3个平动自由度和3个转动自由度）。
这些点的坐标求出机器人各关节的位置和角度(1, …, n)，然后由后面的角位置闭环控制 系统实现要求的轨迹上的一点。继续插补并重复上述过程，从而实现要求的轨迹。 机器人轨迹控制过程如图4-9所示。
轨迹上示教点的位置及姿态 插补算法 机器人 逆运算学
Θ1,…,θn
n个角度位 要求的位置、姿态 置 控制系统
中的运动任务中使用。
该指令的基本范例说明如下： MoveC [\Conc] CirPoint ToPoint [\ID] Speed [\V] | [\T] Zone [\z] [\Inpos] Tool [\Wobj] [\Corr]
p1起点 p1终点
p2圆弧上 的点
ห้องสมุดไป่ตู้
图4-7 圆弧运动示意图
任务2 常用机器人路径控制方式
MoveJ [\Conc] ToPoint [\ID] Speed [\V] | [\T] Zone [\Z] [\Inpos] Tool [\WObj]
p1
p2
图4-6 关节运动示意图
任务2 常用机器人路径控制方式
【知识储备】 三、常用轨迹运动控制指令 3. MoveC— 让机器人做圆弧运动 该指令用来让机器人TCP沿圆弧运动到一个给定的目标点，如图4-7示意。在运动过 程中，相对圆的方向通常保持不变。该指令只能在主任务T_ROB1中使用，在多运动系统
动系统的运动任务中。
p1
p2
图4-5 直线运动示意图
任务2 常用机器人路径控制方式
【知识储备】 三、常用轨迹运动控制指令 1. MoveL－让机器人作直线运动 指令书写格式为： MoveL [\Conc] ToPoint [\ID] Speed [\V] | [ \T] Zone [\Z] [\Inpos] Tool [\WObj] [\Corr]
【知识储备】 三、常用轨迹运动控制指令 1. MoveL－让机器人作直线运动 指令书写格式为： [\Z]：Zone，数据类型：num
[\Inpos ]：到位，数据类型：stoppointdata（停止点数据）
Tool：数据类型为tooldata [\Wobj]：工作对象，数据类型为wobjdata [ \Corr ]：改正，数据类型：switch
C B D
A
E
图4-3 点位控制方式示意图
任务2 常用机器人路径控制方式
【知识储备】 二、连续轨迹控制方式(Continuous Point) 这种控制方式的特点是连续地控制工业机器人末端执行器在作业空间中的位姿，如
图4-4所示。要求其严格按照预定的轨迹和速度在一定的精度范围内运动，而且速度可控， 轨迹光滑，运动平稳，以完成作业任务。
任务1 轨迹规划问题与性能指标
【知识储备】 一、轨迹规划问题 工业机器人广泛的被用在各种行业应用中来实现快速、精确和高质量的生产任务。 在抓取和放置操作，工业机器人的法兰盘工具必须在工作空间中两个特定的位置之间移 动，而它在两者之间的路径却不被关心。在路径追踪应用中，比如焊接，切削，喷涂等，
法兰盘末端工具必须在尽可能保持额定的速度下，在三维空间中遵循特定的轨迹运动。
3. 最大冲击：机器人冲击最大值的大小对机器人系统的动力特性有很大的影响，会直接 影响机器人系统的残余振动，影响机器人的动力学特性。 4. 轨迹规划曲线的高阶导数：加速度曲线能不能连续决定了轨迹规划曲线能否接受刚性 和柔性的冲击，而加速度的导数曲线一一冲击曲线是否连续，若其不连续，则冲击曲 线的改变值的多少对机器人动力特性有很大的影响。
用工具坐标系相对于工件坐标系的运动来描述作业路径是一种通用的作业描述方法。 它把作业路径描述与具体的工业机器人、手爪或工具分离开来，形成了模型化的作业描 述方法，从而使这种描述既适用于不同的机器人，也适用于在同一机器人上装夹不同规 格的工具。 关节空间中拾取操作的轨迹规划，只是限定轨迹函数的启动和终止两个极限位置， 对于函数曲线没有强制性，因此，我们也就有很大的自由度选择轨迹函数。
任务1 轨迹规划问题与性能指标
【知识储备】 二、轨迹规划性能指标分析 在进行轨迹规划时，运动学的要求是工业机器人工作考虑的首要因素，同时还要综 合考虑工业机器人的工作转速、质量以及载荷的大小等多种因素。 1. 最大速度：机器人运动的速度。
2. 最大加速度：机器人运动加速度最大值的大小，是影响机器人动力特性的主要因素。
【知识储备】 三、常用轨迹运动控制指令 4. MoveAbsJ—把机器人移动到绝对轴位置 MoveAbsJ（绝对关节移动）用来把机器人或者外部轴移动到一个绝对位置，该位 置在轴定位中定义。机器人和外部轴沿着一个非直线的路径移动到目标位置，所有轴在
同一时间运动到目标位置。
MoveAbsJ指令中机器人的最终位置，既不受工具或者工作对象的影响，也不受激 活程序更换的影响，但是机器人要用到这些数据来计算负载、TCP 速度和转角点。相同 的工具可以被用在相邻的运动指令中。该指令只能被用在主任务T_ROB1中，或者在多运 动系统中的运动任务中。
任务1 轨迹规划问题与性能指标
【拓展与提高】 机器人的作业过程可用手部位姿结点序列来规定，每个结点可用工具坐标系相对于 作业坐标系的齐次变换来描述。相应的关节变量可用运动学反解程序计算。 如图4-2所示的机器人插螺栓作业，要求把螺栓从槽中取出并放入托架的一个孔中，
用符号表示沿轨迹运动的各结点的位姿，使机器人能沿虚线运动并完成作业。设定Pi (i=0，
第4章
工业机器人运动轨迹规划
主要内容
1 2 3 4
轨迹规划问题与性能指标
常用机器人路径控制方式
机器人运动轨迹规划基本方法
机器人轨迹规划实例
2017/1/13
【学习目标】 1. 知识目标 了解机器人轨迹规划的基本概念。 熟悉机器人轨迹规划的性能指标。 掌握机器人的路径控制方式。 掌握机器人运动轨迹规划的基本方法。 2. 技能目标 能够进行点位运动轨迹示教及程序编写与调试。 能够进行连续路径轨迹示教及程序的编写与调试。 能够进行复杂轨迹的程序编写与调试。 3. 情感目标
任务3 机器人运动轨迹规划基本方法
【知识储备】 一、轨迹规划基本方法分类 在工业机器人末端执行工具的轨迹路径控制方法中，最常用的轨迹规划方法有两种： 第—种方法要求用户对于选定的轨迹结点(插值点)上的位姿、速度和加速度给出一组 显式约束(例如连续性和光滑程度等)，轨迹规划器从一类函数(例如n次多项式)中选取参