机器人轨迹规划

第四章机器人轨迹规划2222-2-工业机器人技术基础2016/9/25本章主要内容•4.1机器人轨迹规划概述•4.2插补方式分类与轨迹控制•4.3机器人轨迹插补计算•4.4轨迹的实时生成3333-3-工业机器人技术基础2016/9/25所谓机器人的规划(P1anning)，指的是——机器人根据自身的任务，求得完成这一任务的解决方案的过程。这里所说的任务，具有广义的概念，既可以指机器人要完成的某一具体任务，也可以是机器人的某个动作，比如手部或关节的某个规定的运动等。4.1机器人轨迹规划概述一、机器人规划的概念4444-4-工业机器人技术基础2016/9/25为说明机器人规划的概念，我们举下面的例子：在一些老龄化比较严重的国家，开发了各种各样的机器人专门用于伺候老人，这些机器人有不少是采用声控的方式．比如主人用声音命令机器人“给我倒一杯开水”，我们先不考虑机器人是如何识别人的自然语言，而是着重分析一下机器人在得到这样一个命令后，如何来完成主人交给的任务。一、机器人规划的概念5555-5-工业机器人技术基础2016/9/25首先，机器人应该把任务进行分解，把主人交代的任务分解成为“取一个杯子”、“找到水壶”、“打开瓶塞”、“把水倒人杯中”、“把水送给主人”等一系列子任务。这一层次的规划称为任务规划(Taskplanning)，它完成总体任务的分解。然后再针对每一个子任务进行进一步的规划。以“把水倒入杯中”这一子任务为例，可以进一步分解成为一系列动作，这一层次的规划称为动作规划，它把实现每一个子任务的过程分解为一系列具体的动作。取一个杯子找到水壶打开水壶把水倒入杯中把水送给主人给主人倒一杯水把水倒入杯中提起水壶到杯口上方把水壶倾斜把水壶竖直把水壶放回原处6666-6-工业机器人技术基础2016/9/25为了实现每一个动作，需要对手部的运动轨迹进行必要的规定，这是手部轨迹规划(Handtrajectoryplanning)。为了使手部实现预定的运动，就要知道各关节的运动规律，这是关节轨迹规划(Jointtrajectoryplanning)。最后才是关节的运动控制(Motioncontrol)。取一个杯子找到水壶打开水壶把水倒入杯中把水送给主人给主人倒一杯水提起水壶到杯口上方把水壶倾斜把水壶竖直把水壶放回原处手部从A点移到B点关节从C点移到D点7777-7-工业机器人技术基础2016/9/25上述例子可以看出，机器人的规划是分层次的，从高层的任务规划，动作规划到手部轨迹规划和关节轨迹规划。在上述例子中，我们没有讨论力的问题，实际上，对有些机器人来说，力的大小也是要控制的，这时，除了手部或关节的轨迹规划，还要进行手部和关节输出力的规划。智能化程度越高，规划的层次越多，操作就越简单。轨迹规划的目的是将操作人员输入的简单的任务描述变为详细的运动轨迹描述。例如，对一般的工业机器人来说，操作员可能只输入机械手末端的目标位置和方位，而规划的任务便是要确定出达到目标的关节轨迹的形状、运动的时间和速度等。这里所说的轨迹是指随时间变化的位置、速度和加速度。8888-8-工业机器人技术基础2016/9/25简言之，机器人的工作过程，就是通过规划，将要求的任务变为期望的运动和力，由控制环节根据期望的运动和力的信号，产生相应的控制作用，以使机器人输出实际的运动和力，从而完成期望的任务。如下图所示。这里，机器人实际运动的情况通常还要反馈给规划级和控制级，以便对规划和控制的结果做出适当的修正。人机接口规划控制机器人本体要求的任务期望的运动和力实际的运动和力控制作用要求的任务由操作人员输入给机器人，为了使机器人操作方便、使用简单，必须允许操作人员给出尽量简单的描述。期望的运动和力是进行机器人控制所必需的输入量，它们是机械手末端在每一个时刻的位姿和速度，对于绝大多数情况，还要求给出每一时刻期望的关节位移和速度，有些控制方法还要求给出期望的加速度等。9999-9-工业机器人技术基础2016/9/254.1机器人轨迹规划概述轨迹规划？机器人在作业空间要完成给定的任务，其手部运动必须按一定的轨迹(trajectory)进行。轨迹的生成一般是先给定轨迹上的若干个点，将其经运动学反解映射到关节空间，对关节空间中的相应点建立运动方程，然后按这些运动方程对关节进行插值，从而实现作业空间的运动要求，这一过程通常称为轨迹规划。10101010-10-工业机器人技术基础2016/9/25二、轨迹规划的一般性问题工业机器人的作业可以描述成工具坐标系{T}相对于工件坐标系{S}的一系列运动。图4.1机器人将销插入工件孔中的作业描述图4.1所示的将销插入工件孔中的作业，可以借助工具坐标系的一系列位姿Pi(i=1，2，…，n)来描述。11111111-11-工业机器人技术基础2016/9/25二、轨迹规划的一般性问题用工具坐标系相对于工件坐标系的运动来描述作业路径是一种通用的作业描述方法。它把作业路径描述与具体的机器人、手爪或工具分离开来，形成了模型化的作业描述方法，从而使这种描述既适用于不同的机器人，也适用于在同一机器人上装夹不同规格的工具。图4.2机器人的初始状态和终止状态12121212-12-工业机器人技术基础2016/9/25对点位作业(pickandplaceoperation)的机器人，需要描述它的起始状态和目标状态，即工具坐标系的起始值{T0}，目标值{Tf}。在此，用“点”这个词表示工具坐标系的位置和姿态(简称位姿)。13131313-13-工业机器人技术基础2016/9/25对于另外一些作业，如弧焊和曲面加工等，不仅要规定操作臂的起始点和终止点，而且要指明两点之间的若干中间点(称路径点)，必须沿特定的路径运动(路径约束)。这类称为连续路径运动(continuous—Pathmotion)或轮廓运动(contourmotion)。在规划机器人的运动时．还需要弄清楚在其路径上是否存在障碍物(障碍约束)。主要讨论连续路径的无障碍的轨迹规划方法。轨迹规划器可形象地看成为一个黑箱，其输入包括路径的“设定”和“约束”，输出的是操作臂末端手部的“位姿序列”，表示手部在各离散时刻的中间形位。14141414-14-工业机器人技术基础2016/9/25•轨迹规划既可在关节空间也可在直角空间中进行，但是所规划的轨迹函数都必须连续和平滑，使机器人的运动平稳，不平稳的运动将加剧机械部件的磨损，并导致机器人的振动和冲击。为此，要求所选择的运动轨迹描述函数必须连续，而且它的一阶导数(速度)，有时甚至二阶导数(加速度)也应该连续。•在关节空间进行规划时是将关节变量表示成时间的函数，并规划它的一阶和二阶时间导数。•在直角空间进行规划是指将手部位姿、速度和加速度表示为时间的函数。而相应的关节位移、速度和加速度由手部的信息导出。通常通过运动学反解得出关节位移、用逆稚可比求出关节速度，用逆雅可比及其导数求解关节加速度。15151515-15-工业机器人技术基础2016/9/25三、轨迹的生成方式(1)示教-再现运动。这种运动由人手把手示教机器人，定时记录各关节变量，得到沿路径运动时各关节的位移时间函数q(t)；再现时，按内存中记录的各点的值产生序列动作。(2)关节空间运动。这种运动直接在关节空间里进行。由于动力学参数及其极限值直接在关节空间里描述，所以用这种方式求最短时间运动很方便。(3)空间直线运动。这是一种直角空间里的运动，它便于描述空间操作，计算量小，适宜简单的作业。(4)空间曲线运动。这是一种在描述空间中用明确的函数表达的运动，如圆周运动、螺旋运动等16161616-16-工业机器人技术基础2016/9/254.2插补方式分类与轨迹控制一、插补方式分类•点位作业（PTP=point-to-pointmotion）•连续路径作业（CP=continuous-pathmotion）路径控制不插补关节插补(平滑)空间插补点位控制PTP(1)各轴独立快速到达。(2)各关节最大加速度限制(1)各轴协调运动定时插补。(2)各关节最大加速度限制连续路径控制CP(1)在空间插补点间进行关节定时插补。(2)用关节的低阶多项式拟合空间直线使各轴协调运动。(3)各关节最大加速度限制(1)直线、圆弧、曲线等距插补。(2)起停线速度、线加速度给定，各关节速度、加速度限制17171717-17-工业机器人技术基础2016/9/25二、机器人轨迹控制过程图4.3机器人轨迹控制过程机器人的基本操作方式是示教-再现，即首先教机器人如何做，机器人记住了这个过程，于是它可以根据需要重复这个动作。操作过程中，不可能把空间轨迹的所有点都示教一遍使机器人记住，这样太繁琐，也浪费很多计算机内存。实际上，对于有规律的轨迹，仅示教几个特征点，计算机就能利用插补算法获得中间点的坐标，如直线需要示教两点，圆弧需要示教三点，通过机器人逆向运动学算法由这些点的坐标求出机器人各关节的位置和角度(1,…,n)，然后由后面的角位置闭环控制系统实现要求的轨迹上的一点。继续插补并重复上述过程，从而实现要求的轨迹。18181818-18-工业机器人技术基础2016/9/254.3机器人轨迹插值计算一、直线插补空间直线插补是在已知该直线始末两点的位置和姿态的条件下，求各轨迹中间点(插补点)的位置和姿态。已知直线始末两点的坐标值P0(X0，Y0，Z0)、Pe(Xe，Ye，Ze)及姿态，其中P0、Pe是相对于基坐标系的位置。这些已知的位置和姿态通常是通过示教方式得到的。设v为要求的沿直线运动的速度；ts为插补时间间隔。直线长度222e0e0e0LXXYYZZ直线插补和圆弧插补是机器人系统中的基本插补算法。对于非直线和圆弧轨迹，可用直线或圆弧逼近，以实现这些轨迹。19191919-19-工业机器人技术基础2016/9/25ts间隔内行程d=vts；插补总步数N为L/d+1的整数部分；各轴增量：e0e0e0///XXXNYYYNZZZN各插补点坐标值：111iiiiiiXXiXYYiYZZiZ式中：i=0，1，2，…，N。可见，两个插补点之间的距离正比于要求的运动速度，只有插补点之间的距离足够小，才能满足一定的轨迹控制精度要求。机器人控制系统易于实现定时插补，例如采用定时中断方式每隔ts中断一次进行一次插补，计算一次逆向运动学，输出一个给定值。由于ts仅为几毫秒，机器人沿着要求轨迹的速度一般不会很高，且机器人总的运动精度不高，故大多数工业机器人采用定时插补方式。20202020-20-工业机器人技术基础2016/9/25二、圆弧插补•1.平面圆弧插补•平面圆弧是指圆弧平面与基坐标系的三大平面之一重合，以XOY平面圆弧为例。已知不在一条直线上的三点P1、P2、P3及这三点对应的机器人手端的姿态，如图4.5及图4.6所示。图4.5由已知的三点P1、P2、P3决定的圆弧图4.6圆弧插补21212121-21-工业机器人技术基础2016/9/25•设v为沿圆弧运动速度；ts为插补时时间隔。•(1)由P1、P2、P3决定的圆弧半径R。•(2)总的圆心角=1+2，即222212121222223232arccos()2/2arccos()2/2XXYYRRXXYYRR(3)ts时间内角位移量θ=tsv/R22222222-22-工业机器人技术基础2016/9/25•(4)总插补步数(取整数)•N=/θ+1•对Pi+1点的坐标，有•式中：Xi=Rcosθi；Yi=Rsinθi。1cos()coscossinsincossiniiiiiiXRRRXY1sin()sincoscossincossiniiiiiiYRRRYX•由θi+1=θi+θ可判断是否到插补终点。若θi+1，则继续插补下去；当θi+1时，则修正最后一步的步长θ,故平面圆弧位置插