工业机器人轨迹规划

单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,2019/12/16,#,机器人轨迹规划,6.1,机器人轨迹规划概述,6.1.1,机器人轨迹的概念,机器人轨迹泛指工业机器人在运动过程中的,运动轨迹,，即,运动点的位移、速度和加速度,。,机器人在作业空间要完成给定的任务，其手部运动必须按一定的轨迹进行。轨迹的生成一般是先给定轨迹上的若干个,点,，将其经运动学反解映射到,关节空间,，对关节空间中的相应点建立,运动方程,，然后按这些运动方程对关节进行,插值,，从而实现作业空间的运动要求，这一过程通常称为,轨迹规划,。本章仅讨论在关节空间或笛卡尔空间中工业机器人运动的轨迹规划和轨迹生成方法。,机器人运动轨迹的描述一般是对其手部位姿的描述，此,位姿值可与关节变量相互转换,。控制轨迹也就是,按时间,控制手部或工具中心走过的空间路径。,在轨迹规划中，为叙述方便，也常用,点,来表示机器人的,状态,，或用它来表示工具坐标系的,位姿,。,更详细地描述运动时不仅要规定机器人的,起始点,和,终止点,，而且要给出介于起始点和终止点之间的中间点，也称,路径点,。这时，运动轨迹除了位姿约束外，还存在着各路径点之间的时间分配问题。,机器人的运动应当平稳，不平稳的运动将加剧机械部件的磨损，并导致机器人的振动和冲击。为此，要求所选择的运动轨迹描述函数必须连续，而且它的一阶导数,(,速度,),，有时甚至二阶导数,(,加速度,),也应该连续。,轨迹规划既可以在关节空间中进行，也可以在直角坐标空间中进行。,在关节空间中进行轨迹规划,是指将所有关节变量表示为时间的函数，用这些关节函数及其一阶、二阶导数描述机器人预期的运动；,在直角坐标空间中进行轨迹规划,是指将手爪位姿、速度和加速度表示为时间的函数，而相应的关节位置、速度和加速度由手爪信息通过逆运动学导出。,6.1.3,轨迹规划涉及的主要问题,为了描述一个完整的作业，往往需要将上述运动进行组合。通常这种规划涉及到以下几方面的问题：,(1),对工作对象及作业进行描述，用示教方法给出轨迹上若干个结点。,(2),用一条轨迹通过或逼近结点，此轨迹可按一定的原则优化，如加速度平滑得到直角空间的位移时间函数,X,(,t,),或关节空间的位移时间函数,q,(,t,),；在结点之间如何进行插补，即根据轨迹表达式在每一个采样周期实时计算轨迹上点的位姿和各关节变量值。,(,3,),规划机器人的运动轨迹时，需明确其路径上是否存在障碍约束的组合。,本章主要讨论连续路径的无障碍轨迹规划方法。,6.2,插补方式分类与轨迹控制,6.2.1,插补方式分类,点位控制,(PTP,控制,),通常没有路径约束，多以关节坐标运动表示。点位控制只要求满足起终点位姿，在轨迹中间只有关节的几何限制、最大速度和加速度约束；为了保证运动的连续性，要求速度连续，各轴协调。如,MOVJ,连续轨迹控制,(CP,控制,),有路径约束，因此要对路径进行设计，如,MOVL,。,6.2.2,机器人轨迹控制过程,机器人的,基本操作方式,是,示教,-,再现,。对于有规律的轨迹，仅示教几个特征点，计算机就能利用,插补算法,获得中间点的坐标，如直线需要示教两点，圆弧需要示教三点，通过机器人逆向运动学算法由这些点的坐标求出机器人各关节的位置和角度,(,1,n,),，然后由后面的角位置闭环控制系统实现要求的轨迹上的一点。继续插补并重复上述过程，从而实现要求的轨迹。,机器人轨迹控制过程如图,6.3,所示。,图,6.3,机器人轨迹控制过程,6.3,机器人轨迹插值计算,给出各个路径结点后，轨迹规划的任务包含解变换方程，进行运动学反解和插值计算。在关节空间进行规划时，需进行的大量工作是对关节变量的插值计算。,6.3.1,直线插补,(MOVL),直线插补和圆弧插补是机器人系统中的基本插补算法。,空间直线插补是在已知该直线始末两点的位置和姿态的条件下，求各轨迹中间点,(,插补点,),的位置和姿态。下面介绍位置插补原理，如图,6.4,所示。已知直线始末两点的坐标值,P,0,(,X,0,，,Y,0,，,Z,0,),、,P,e,(,X,e,，,Y,e,，,Z,e,),及姿态。这些已知的位置和姿态通常是通过示教方式得到的。设,v,为要求的沿直线运动的速度；,t,s,为插补时间间隔。,直线长度：,t,s,间隔内行程,d,=,vt,s,；,插补总步数,N,为,L,/,d,+1,的整数部分；,各轴增量：,各插补点坐标值,图,6.4,式中的,i,=l,，,2,，,N,6.3.2,圆弧插补,(MOVC),一、平面圆弧插补,平面圆弧是指圆弧平面与基坐标系的三大平面之一重合，以,XOY,平面圆弧为例。已知不在一条直线上的三点,P,1,、,P,2,、,P,3,及这三点对应的机器人手端的姿态，如图,6.5,及图,6.6,所示。,图,6.5,由已知的三点,P,1,、,P,2,、,P,3,决定的圆弧,图6.6 圆弧插补,设,v,为沿圆弧运动速度；,t,s,为插补时时间隔。类似直线插补情况计算出：,(1),由,P,1,、,P,2,、,P,3,决定的圆弧半径,R,。,(2),总的圆心角,=,1,+,2,，即,(3),t,s,时间内角位移量,=,t,s,v,/,R,，据图,6.4,所示的几何关系求各插补点坐标。,(4),总插补步数,(,取整数,),N,=,/,+1,对,P,i,+1,点的坐标，有,式中：,X,i,=,R,cos,i,；,Y,i,=,R,sin,i,。,同理有,由,i+,1,=,i,+,可判断是否到插补终点。若,i+,1,，则继续插补下去；当,i+,1,时，则修正最后一步的步长,，并以,表示，,，故平面圆弧位置插补为,二、空间圆弧插补,(MOVC),空间圆弧是指三维空间任一平面内的圆弧，此为空间一般平面的圆弧问题。,空间圆弧插补可分三步来处理：,(1),把三维问题转化成二维，找出圆弧所在平面。,(2),利用二维平面插补算法求出插补点坐标,(,X,i,+1,Y,i,+1,),。,(3),把该点的坐标值转变为基础坐标系下的值，如图,6.7,所示。,图,6.7,基础坐标与空间圆弧平面的关系,通过不在同一直线上的三点,P,1,、,P,2,、,P,3,可确定一个圆及三点间的圆弧，其圆心为,O,R,半径为,R,，圆弧所在平面与基础坐标系平面的交线分别为,AB,、,BC,、,CA,。,建立圆弧平面插补坐标系，即把,O,R,X,R,Y,R,Z,R,坐标系原点与圆心,O,R,重合，设,O,R,X,R,Y,R,Z,R,平面为圆弧所在平面，且保持,Z,R,为外法线方向。这样，一个三维问题就转化成平面问题，可以应用平面圆弧插补的结论。,求解两坐标系,(,图,6.7),的转换矩阵。令,T,R,表示由圆弧坐标,O,R,X,R,Y,R,Z,R,至基础坐标系,OX,0,Y,0,Z,0,的转换矩阵。用,T,R,可以将圆弧坐标下的点转换成基础坐标系下的点。,6.3.3,定时插补与定距插补,由上述可知，机器人实现一个空间轨迹的过程即是,实现轨迹离散的过程,，如果这些离散点间隔很大，则机器人运动轨迹与要求轨迹可能有较大误差。只有这些插补得到的离散点彼此距离很近，才有可能使机器人轨迹以足够的精确度逼近要求的轨迹。模拟,CP,控制实际上是多次执行插补点的,PTP,控制，插补点越密集，越能逼近要求的轨迹曲线。,插补点要多么密集才能保证轨迹不失真和运动连续平滑呢？可采用,定时插补,和,定距插补,方法来解决。,一、定时插补,从轨迹控制过程知道，每插补出一轨迹点的坐标值，就要转换成相应的关节角度值并加到位置伺服系统以实现这个位置，这个过程每隔一个时间间隔,t,s,完成一次。为保证运动的平稳，显然,t,s,不能太长。,由于关节型机器人的机械结构大多属于开链式，刚度不高，,t,s,一般不超过,25 ms(40 Hz),，这样就产生了,t,s,的,上限值,。当然,t,s,越小越好，但它的下限值受到计算量限制，即对于机器人的控制，计算机要在,t,s,时间里完成一次插补运算和一次逆向运动学计算。对于目前的大多数机器人控制器，完成这样一次计算约需几毫秒。这样产生了,t,s,的,下限值,。当然，,应当选择,t,s,接近或等于它的下限值，这样可保证较高的轨迹精度和平滑的运动过程。,以一个,XOY,平面里的直线轨迹为例说明定时插补的方法。,设机器人需要的运动轨迹为直线，运动速度为,v,(mm/s),，时间间隔为,t,s,(ms),，则每个,t,s,间隔内机器人应走过的距离为,P,i,P,i,+1,=,v,t,s,可见两个插补点之间的距离正比于要求的运动速度，两点之间的轨迹不受控制，只有插补点之间的距离足够小，才能满足一定的轨迹精度要求。,机器人控制系统易于实现定时插补，例如采用定时中断方式每隔,t,s,中断一次进行一次插补，计算一次逆向运动学，输出一次给定值。由于,t,s,仅为几毫秒，机器人沿着要求轨迹的速度一般不会很高，且机器人总的运动精度不如数控机床、加工中心高，故大多数工业机器人采用定时插补方式。,当要求以,更高的精度,实现运动轨迹时，可采用定距插补,。,二、定距插补,v,是要求的运动速度，它不能变化，如果要两插补点的距离,P,i,P,i,+1,恒为一个足够小的值，以保证轨迹精度，,t,s,就要变化。也就是在此方式下，插补点距离不变，但,t,s,要随着不同工作速度,v,的变化而变化。,这两种插补方式的基本算法相同，只是前者固定,t,s,，易于实现，后者保证轨迹插补精度，但,t,s,要随之变化，实现起来比前者困难。,6.3.4,关节空间插补,(MOVJ),在关节空间中进行轨迹规划，需要给定机器人在,起始点和终止点手臂的位形,。对关节进行插值时应满足一系列的,约束条件,，例如抓取物体时手部的运动方向,(,初始点,),、提升物体离开的方向,(,提升点,),、放下物体,(,下放点,),和停止点等结点上的位姿、速度和加速度的要求；与此相应的各个关节位移、速度、加速度在整个时间间隔内的连续性要求以及其极值必须在各个关节变量的容许范围之内等。满足所要求的约束条件之后，可以选取不同类型的关节插值函数，生成不同的轨迹。常用的关节空间插补有以下方法：,1,、三次多项式插值,2,、过路径点的三次多项式插值,3,、高阶多项式插值,4,、用抛物线过渡的线性插值,一、三次多项式插值,在机器人运动过程中，若末端执行器的起始和终止位姿已知，由逆向运动学即可求出对应于两位姿的各个关节角度。末端执行器实现两位姿的运动轨迹描述可在关节空间中用通过起始点和终止点关节角的一个平滑轨迹函数,(,t,),来表示。,为实现系统的平稳运动，每个关节的轨迹函数,(,t,),至少需要满足四个约束条件，即,两端点位置约束和两端点速度约束,。,端点位置约束是指起始位姿和终止位姿分别所对应的关节角度。,(,t,),在时刻,t,0,=0,时的值是起始关节角度,0,，在终端时刻,t,f,时的值是终止关节角度,f,，即,为满足关节运动速度的连续性要求，起始点和终止点的关节速度可简单地设定为零，即,上面给出的四个约束条件可以惟一地确定一个三次多项式：,运动过程中的关节速度和加速度则为,将其代以给定的约束条件，可得三次多项式的系数,，,，,和,，则对于起始速度及终止速度为零的关节运动，满足连续平稳运动要求的三次多项式插值函数为：,关节角速度和角加速度的表达式为：,三次多项式插值的关节运动轨迹曲线如图,6.8,所示。由图可知，其速度曲线为抛物线，相应的加速度曲线为直线。,图,6.8,三次多项式插值的关节运动轨迹,【,例,6.1】,要求一个六轴机器人的第一关节在,5,秒钟内从初始角,30,0,运动到终端角,75,0,，且起始点和终止点速度均为零。用三次多项式规划该关节的运动，并计算在第,1,、,2,、,3,秒和第,4,秒时关节的角度。,图 关节位移、速度和加速度,解：,位移曲线,二、过路径点的三次多项式插值,若所规划的机器人作业路径在多个点上有位姿要求，如图,6.9,所示，机器人作业除在,A,、,D,点有位姿要求