CN109304711A - 串联机器人轨迹规划方法 - Google Patents
串联机器人轨迹规划方法 Download PDFInfo
- Publication number
- CN109304711A CN109304711A CN201811271246.7A CN201811271246A CN109304711A CN 109304711 A CN109304711 A CN 109304711A CN 201811271246 A CN201811271246 A CN 201811271246A CN 109304711 A CN109304711 A CN 109304711A
- Authority
- CN
- China
- Prior art keywords
- robot
- formula
- motion
- node
- planning
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明实施例公开了一种串联机器人轨迹规划方法,包括:得到机器人运动任务空间中机器人的姿态控制节点Ti的序列,和与之对应的时间节点ti的序列;计算各个姿态控制节点的角序列在机器人运动任务空间中构造连续的曲线插值姿态控制节点角的序列;规划在相邻两个姿态控制节点之间机器人运动的轨迹;根据机器人运动的轨迹计算在相邻两个姿态控制节点之间机器人运动的速度及加速度。本发明通过对机械臂算法进行规划,实现了机械臂的准确控制。
Description
技术领域
本发明涉及机器人行走轨迹规划技术领域,尤其是一种串联机器人轨迹规划方法。
背景技术
机器人是一个复杂动态体系,能够用在不同领域。其中,六自由度机器人在工业生产中被广泛使用,机器人的串联机构是机器人的重要组成部分,机器人串联结构典型组成为底座、腰部、大臂(上臂)、小臂(前臂)、腕部和手部。由于串联机器人采用的是开环结构,即从底座到末端执行器间各关节依次串接,只有一条运动链,这使得它具有以下优点:(1)负载能力强,能够实现负重较大的工作;(2)运动空间大,操作广度好,能够对大规模目标进行操作;(3)控制对象明确,各关节之间关联性好,控制简便;(4)灵活性强,延展性高;(5)技术成熟,成本低,便于维护,但是机器人串联机构的轨迹规划使机器人运行的效率还比较低,如果路径规划不科学可能导致机器人经过奇异位姿,或发生碰撞损坏机器人;如果机器人的速度规划不合理会使机构震动,运动不平稳,也可能损坏电机。
因此,现有技术需要改进。
发明内容
本发明实施例所要解决的一个技术问题是:提供一种串联机器人轨迹规划方法,以解决现有技术存在的问题,所述串联机器人轨迹规划方法包括:
得到机器人运动任务空间中机器人的姿态控制节点Ti的序列,和与之对应的时间节点ti的序列;
计算各个姿态控制节点的角序列在机器人运动任务空间中构造连续的曲线插值姿态控制节点角的序列,所述角序列与时间节点ti的序列对应,j为节点序列号,j=1,2,3,……n;
规划在相邻两个姿态控制节点之间机器人运动的轨迹;
根据机器人运动的轨迹计算在相邻两个姿态控制节点之间机器人运动的速度及加速度。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述根据机器人运动的轨迹计算在相邻两个姿态控制节点之间机器人运动的速度及加速度包括:
机器人控制单元接收到机器人移动的命令,设定机器人的运行时间和运行速度,计算机器人运动的加速度,将加速度指令赋给机器人运动控制电机;
机器人运动控制电机按照机器人控制单元的指令进行加速度运行;
设定时间参数t1,t2,t3,在0-t1时间内机器人加速度上升,在t1-t2时间内机器人做匀加速运动,在t2-t3时间内加速度减少。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述设定时间参数t1,t2,t3,在0-t1时间内机器人加速度上升,在t1-t2时间内机器人做匀加速运动,在t2-t3时间内加速度减少的速度、加速度计算模型包括梯形模型和正弦模型。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述梯形模型的数学表达式包括:
机器人运动加速度的数学表达式:
对公式(1)进行时间积分得到机器人运动速度的函数,设置机器人运动的初始速度和结束速度为零,则机器人运动速度的数学表达式为:
对公式(2)进行时间积分得到机器人位移的函数,设置机器人的初始时位移为零,则机器人位移的数学表达式为:
令T1=t1,T2=t2-t1,T3=t3-t2,则公式(3)中
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述正弦模型的数学表达式包括:
机器人运动加速度的数学表达式:
为保证最大加速度和最大速度的约束,以及加速度边界条件,式中
将式(4)进行时间积分得到机器人运动的速度函数,设置机器人运动的初始速度和末速度为零,则机器人运动的速度函数表达式为:
对公式(5)进行时间积分,得到机器人运动的位移函数表达式:
式中:S02=S01+vmaxT2,T2=t2-t1。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述规划在相邻两个姿态控制节点之间机器人运动的轨迹包括:
对机器人运动的控制节点进行规划;
对相邻两个姿态控制节点之间机器人运动的直线运动轨迹规划;
对相邻两个姿态控制节点之间机器人运动的运动姿态规划。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述对机器人运动的控制节点进行规划采用采用三次样条规划。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述三次样条规划包括:
令Pi(ti,si(ti))和Pi+1(ti+1,si(ti+1))为机器人运动曲线上的相邻的两个控制节点,在这两个控制节点之间的第i个三次多项式为:
si(t)=ai(t-ti)3+bi(t-ti)2+ci(t-ti)+di;(ti≤t≤ti+1) (7)
si(t)的一阶导数为:
si′(t)=3ai(t-ti)2+2bi(t-ti)+ci (8)
si(t)的二阶导数为:
令pi=si(ti),pi'=si'(ti),pi”=si”(ti),Δti=ti+1-ti,Δpi=pi+1-pi,得:
三次样条曲线在各节点处连续且一阶导数、二阶导数均连续,则:
si(ti+1)=si+1(ti+1) (11)
si′(ti+1)=si+1′(ti+1) (12)
si″(ti+1)=si+1″(ti+1) (13)
由式(11)和(13)得:
联立公式(8)、(12)、(13)、(14)得:
联立公式(9)和(13),得:
3ai(Δti)2+2bi(Δti)+ci=ci+1 (16)
将式(11)、(15)、(16)代入公式(7)得
Δti+1pi+2″+2(Δti+Δti+1)pi+1″+Δtipi″=6(Δpi+1/Δti+1-Δpi/Δti) (17)
式中i=1,2,3...n-2,因此将式(17)写成矩阵的模式:
Ap”=6Bp
式中:p=[p1,p2,...,pn]T,p”=[p1”,p2”,...,pn”]T;
A和B为(n-2)×n阶矩阵:
其中:αi=Δti,αij=αi+αj,βi=1/Δti,βij=βi+βj;
设置两个约束条件,p1″=pn″=0;
将p”,p均变为n-2维,矩阵A和B也相应的变为(n-2)×(n-2)矩阵:
从而求出各控制节点的加速度矢量:p″=6A-1Bp;
将节点加速度矢量p”和节点位移矢量p带入式(11)(14)(15)求出所有的三次多项式系数,已知系数利用式(8)即求出三次样条轨迹。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述对相邻两个姿态控制节点之间机器人运动的直线运动轨迹规划包括:
机器人控制单元接收到机器人从某一控制节点移动到下一个控制节点的命令;
机器人控制单元将机器人的直线运动分解为X、Y、Z三个轴的运动;
应用加速度控制方法,根据在进行运动规划时规定的加速度amax和速度vmax,得到位移时间函数S(t);
将位移时间函数S(t)在X、Y、Z三个轴上投影,控制X、Y、Z三个轴的运动,实现机器人末端沿直线运动。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述机器人控制单元将机器人的直线运动分解为X、Y、Z三个轴的运动包括:
设某一控制节点P的坐标为[x1,y1,z1],与其相邻的下一个控制节点Q的坐标为[x2,y2,z2],则有:
式中: X(t)、Y(t)、Z(t)分别为机器人在X、Y、Z轴方向上的位移。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述对相邻两个姿态控制节点之间机器人运动的运动姿态规划包括:
设置机器人在一个控制节点的初始运动姿态为R1,在其下一个相邻的控制节点的末端运动姿态为R2,获得旋转矩阵R,所述初始运动姿态为R1为机器人机械臂开始的位置,末端运动姿态为R2为机器人机械臂完成任务后用户需要的姿态;
使用罗德里格斯变换公式,计算出机器人运动的等效旋转轴和旋转角度;
进行机器人运动的加减速控制运算。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述使用罗德里格斯变换公式,计算出机器人运动的等效旋转轴和旋转角度包括:
设置机器人在一个控制节点的初始运动姿态为R1,在其下一个相邻的控制节点的末端运动姿态为R2,获得旋转矩阵R,R1通过旋转矩阵R变换得到R2,即R2=RR1,R=R2R1 -1;
使用罗德里格斯变换公式推导可得:
由式(20)求出旋转轴,观察通用旋转矩阵得到:
通过式(21)确定旋转轴的方向,求出cosθ、sinθ,在此基础上求出等效旋转角:
θ=atan(cosθ,sinθ) (22)
其中θ为相邻姿态之间的等效旋转总角度。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述规划在相邻两个姿态控制节点之间机器人运动的轨迹还包括姿态的四元数规划,所述姿态的四元数规划包括:
所述四元数由实数加上三个虚数单位i,j,k构造,四元数的表达式为q=[s,(x,y,z)]=s+xi+yj+zk,其中s、x、y、z为实数,虚数单位k表示绕Z轴旋转,虚数单位j代表绕Y轴旋转,虚数单位i旋转代表绕X轴旋转,-i,-j,-k分别代表虚数单位i,j,k旋转的反向旋转。
与现有技术相比,本发明具有以下优点:
本发明提出了一种串联机器人轨迹规划方法,保证了机器人在各关节位置的速度、加速度连续;采用三次样条插值的方法,得到机器人运动关节角度的平滑函数,使机器人规划运行轨迹更加平滑;采用梯形模式和正弦模式进行机器人加速度规划,保证了机器人加速度的连续;采用四元数规划方法,对机器人运动任务空间的位置进行直线规划和姿态规划;采用三次样条规划,对机器人空间关节进行规划,实现机械臂的加速减速,空间运动的效果,本发明通过对机械臂算法进行规划,实现了机械臂的准确控制。
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
附图说明
构成说明书的一部分的附图描述了本发明的实施例,并且连同描述一起用于解释本发明的原理。
参照附图,根据下面的详细描述,可以更加清楚地理解本发明,其中:
图1为本发明的串联机器人轨迹规划方法的一个实施例的流程图;
图2为本发明的串联机器人轨迹规划方法的另一个实施例的流程图;
图3为本发明的串联机器人轨迹规划方法的又一个实施例的流程图。
具体实施方式
现在将参照附图来详细描述本发明的各种示例性实施例。应注意到:除非另外具体说明,否则在这些实施例中阐述的部件和步骤的相对布置、数字表达式和数值不限制本发明的范围。
对于相关领域普通技术人员已知的技术、方法和设备可能不作详细讨论,但在适当情况下,所述技术、方法和设备应当被视为说明书的一部分。
如图1所示,所述串联机器人轨迹规划方法包括:
10,得到机器人运动任务空间中机器人的姿态控制节点Ti的序列,和与之对应的时间节点ti的序列;
20,计算各个姿态控制节点的角序列在机器人运动任务空间中构造连续的曲线插值姿态控制节点角的序列,所述角序列与时间节点ti的序列对应,j为节点序列号,j=1,2,3,……n;
30,规划在相邻两个姿态控制节点之间机器人运动的轨迹;
40,根据机器人运动的轨迹计算在相邻两个姿态控制节点之间机器人运动的速度及加速度。
所述根据机器人运动的轨迹计算在相邻两个姿态控制节点之间机器人运动的速度及加速度包括:
机器人控制单元接收到机器人移动的命令,设定机器人的运行时间和运行速度,计算机器人运动的加速度,将加速度指令赋给机器人运动控制电机;
机器人运动控制电机按照机器人控制单元的指令进行加速度运行;
设定时间参数t1,t2,t3,在0-t1时间内机器人加速度上升,在t1-t2时间内机器人做匀加速运动,在t2-t3时间内加速度减少。
所述设定时间参数t1,t2,t3,在0-t1时间内机器人加速度上升,在t1-t2时间内机器人做匀加速运动,在t2-t3时间内加速度减少的速度、加速度计算模型包括梯形模型和正弦模型。
在基于本发明上述串联机器人轨迹规划方法的另一个实施例中,所述梯形模型的数学表达式包括:
梯形运动控制是加减速控制方法中简单的模式。加减速过程分为加速、匀速、减速三个阶段,机器人运动加速度的数学表达式:
对公式(1)进行时间积分得到机器人运动速度的函数,设置机器人运动的初始速度和结束速度为零,则机器人运动速度的数学表达式为:
对公式(2)进行时间积分得到机器人位移的函数,设置机器人的初始时位移为零,则机器人位移的数学表达式为:
令T1=t1,T2=t2-t1,T3=t3-t2,则公式(3)中
梯形模式的优点是算法容易,有助于提高机器人算法实时性,但是在轨迹的始末端其加速度不连续,容易使运动***振动,会对机器人产生冲击。
所述正弦模型的数学表达式包括:
机器人运动加速度的数学表达式:
为保证最大加速度和最大速度的约束,以及加速度边界条件,式中
将式(4)进行时间积分得到机器人运动的速度函数,设置机器人运动的初始速度和末速度为零,则机器人运动的速度函数表达式为:
对公式(5)进行时间积分,得到机器人运动的位移函数表达式:
式中:S02=S01+vmaxT2,T2=t2-t1。
正弦模式的优点是速度、加速度函数连续,机器人运动平稳。但是在相同的最大加速度和最大速度约束下,其运动时间较长,响应不够快。
如图2所示,所述规划在相邻两个姿态控制节点之间机器人运动的轨迹包括:
101,对机器人运动的控制节点进行规划;
102,对相邻两个姿态控制节点之间机器人运动的直线运动轨迹规划;
103,对相邻两个姿态控制节点之间机器人运动的运动姿态规划。
所述对机器人运动的控制节点进行规划采用采用三次样条规划。
所述三次样条规划包括:
令Pi(ti,si(ti))和Pi+1(ti+1,si(ti+1))为机器人运动曲线上的相邻的两个控制节点,在这两个控制节点之间的第i个三次多项式为:
si(t)=ai(t-ti)3+bi(t-ti)2+ci(t-ti)+di;(ti≤t≤ti+1) (7)
si(t)的一阶导数为:
si′(t)=3ai(t-ti)2+2bi(t-ti)+ci (8)
si(t)的二阶导数为:
令pi=si(ti),pi'=si'(ti),pi”=si”(ti),Δti=ti+1-ti,Δpi=pi+1-pi,得:
三次样条曲线在各节点处连续且一阶导数、二阶导数均连续,则:
si(ti+1)=si+1(ti+1) (11)
si′(ti+1)=si+1′(ti+1) (12)
si″(ti+1)=si+1″(ti+1) (13)
由式(11)和(13)得:
联立公式(8)、(12)、(13)、(14)得:
联立公式(9)和(13),得:
3ai(Δti)2+2bi(Δti)+ci=ci+1 (16)
将式(11)、(15)、(16)代入公式(7)得
Δti+1pi+2″+2(Δti+Δti+1)pi+1″+Δtipi″=6(Δpi+1/Δti+1-Δpi/Δti) (17)
式中i=1,2,3...n-2,因此将式(17)写成矩阵的模式:
Ap”=6Bp
式中:p=[p1,p2,...,pn]T,p”=[p1”,p2”,...,pn”]T;
A和B为(n-2)×n阶矩阵:
其中:αi=Δti,αij=αi+αj,βi=1/Δti,βij=βi+βj;
设置两个约束条件,p1″=pn″=0;
将p”,p均变为n-2维,矩阵A和B也相应的变为(n-2)×(n-2)矩阵:
从而求出各控制节点的加速度矢量:p″=6A-1Bp;
将节点加速度矢量p”和节点位移矢量p带入式(11)(14)(15)求出所有的三次多项式系数,已知系数利用式(8)即求出三次样条轨迹。
如图3所示,所述对相邻两个姿态控制节点之间机器人运动的直线运动轨迹规划包括:
201,机器人控制单元接收到机器人从某一控制节点移动到下一个控制节点的命令;
202,机器人控制单元将机器人的直线运动分解为X、Y、Z三个轴的运动;
203,应用加速度控制方法,根据在进行运动规划时规定的加速度amax和速度vmax,得到位移时间函数S(t);
204,将位移时间函数S(t)在X、Y、Z三个轴上投影,控制X、Y、Z三个轴的运动,实现机器人末端沿直线运动。
所述机器人控制单元将机器人的直线运动分解为X、Y、Z三个轴的运动包括:
设某一控制节点P的坐标为[x1,y1,z1],与其相邻的下一个控制节点Q的坐标为[x2,y2,z2],则有:
式中: X(t)、Y(t)、Z(t)分别为机器人在X、Y、Z轴方向上的位移。
分别将和代入式(18)可得到机器人在x、y、z方向上的位移变化方程,机器人的主控制器根据 控制机器人在X、Y、Z这三个方向的运动,实现机器人末端沿直线运动。
所述对相邻两个姿态控制节点之间机器人运动的运动姿态规划包括:
设置机器人在一个控制节点的初始运动姿态为R1,在其下一个相邻的控制节点的末端运动姿态为R2,获得旋转矩阵R,所述初始运动姿态为R1为机器人机械臂开始的位置,末端运动姿态为R2为机器人机械臂完成任务后用户需要的姿态;
使用罗德里格斯变换公式,计算出机器人运动的等效旋转轴和旋转角度;
进行机器人运动的加减速控制运算。
所述使用罗德里格斯变换公式,计算出机器人运动的等效旋转轴和旋转角度包括:
设置机器人在一个控制节点的初始运动姿态为R1,在其下一个相邻的控制节点的末端运动姿态为R2,获得旋转矩阵R,R1通过旋转矩阵R变换得到R2,即R2=RR1,R=R2R1 -1;
使用罗德里格斯变换公式推导可得:
由式(20)求出旋转轴,观察通用旋转矩阵得到:
通过式(21)确定旋转轴的方向,求出cosθ、sinθ,在此基础上求出等效旋转角:
θ=atan(cosθ,sinθ) (22)
其中θ为相邻姿态之间的等效旋转总角度,然后对等效旋转角进行加减速控制,可得到机器人姿态的插补点序列。
所述规划在相邻两个姿态控制节点之间机器人运动的轨迹还包括姿态的四元数规划,所述姿态的四元数规划包括:
所述四元数由实数加上三个虚数单位i,j,k构造,四元数的表达式为q=[s,(x,y,z)]=s+xi+yj+zk,其中s、x、y、z为实数,虚数单位k表示绕Z轴旋转,虚数单位j代表绕Y轴旋转,虚数单位i旋转代表绕X轴旋转,-i,-j,-k分别代表虚数单位i,j,k旋转的反向旋转。
四元数有如下性质:
(1)设则
当||q||=1时,称q为单位四元数,一定存在单位矢量和角度θ使
因此四元数可以更直观的描述三维空间刚体的姿态以及其旋转,在三维空间中绕轴旋转θ角可以用四元数来描述。设为三维空间中的矢量,其对应的四元数为p绕旋转θ角后的可得四元数为p',p′=qpq-1;
(2)四元数的叉乘:设四元数则
为了求出四元数和齐次变换矩阵的关系,可以把四元数的左乘和右乘等效为矩阵的左乘。即p×q=TLq,p×q=TRp;
其中:
若用齐次变换矩阵和四元数同时操作一个三维矢量,假设其变化是等价的,即
由四元数性质可推导得:
T=TLTR
根据机器人的位姿求出与之对应的两个互补的四元数:
q=[w,(x,y,z)]
x=(ay-oz)/4w
y=(nz-ax)/4w
z=(ny-ox)/4w
这样对w,x,y,z进行插补便可得到平滑的姿态变化。
本说明书中各个实施例均采用递进的方式描述,每个实施例重点说明的都是与其它实施例的不同之处,各个实施例之间相同或相似的部分相互参见即可。对于***实施例而言,由于其与方法实施例基本对应,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
本发明的描述是为了示例和描述起见而给出的,而并不是无遗漏的或者将本发明限于所公开的形式。很多修改和变化对于本领域的普通技术人员而言是显然的。选择和描述实施例是为了更好说明本发明的原理和实际应用,并且使本领域的普通技术人员能够理解本发明从而设计适于特定用途的带有各种修改的各种实施例。
Claims (13)
1.一种串联机器人轨迹规划方法,其特征在于,包括:
得到机器人运动任务空间中机器人的姿态控制节点Ti的序列,和与之对应的时间节点ti的序列;
计算各个姿态控制节点的角序列在机器人运动任务空间中构造连续的曲线插值姿态控制节点角的序列,所述角序列与时间节点ti的序列对应,j为节点序列号,j=1,2,3,……n;
规划在相邻两个姿态控制节点之间机器人运动的轨迹;
根据机器人运动的轨迹计算在相邻两个姿态控制节点之间机器人运动的速度及加速度。
2.根据权利要求1所述的串联机器人轨迹规划方法,其特征在于,所述根据机器人运动的轨迹计算在相邻两个姿态控制节点之间机器人运动的速度及加速度包括:
机器人控制单元接收到机器人移动的命令,设定机器人的运行时间和运行速度,计算机器人运动的加速度,将加速度指令赋给机器人运动控制电机;
机器人运动控制电机按照机器人控制单元的指令进行加速度运行;
设定时间参数t1,t2,t3,在0-t1时间内机器人加速度上升,在t1-t2时间内机器人做匀加速运动,在t2-t3时间内加速度减少。
3.根据权利要求2所述的串联机器人轨迹规划方法,其特征在于,所述设定时间参数t1,t2,t3,在0-t1时间内机器人加速度上升,在t1-t2时间内机器人做匀加速运动,在t2-t3时间内加速度减少的速度、加速度计算模型包括梯形模型和正弦模型。
4.根据权利要求3所述的串联机器人轨迹规划方法,其特征在于,所述梯形模型的数学表达式包括:
机器人运动加速度的数学表达式:
对公式(1)进行时间积分得到机器人运动速度的函数,设置机器人运动的初始速度和结束速度为零,则机器人运动速度的数学表达式为:
对公式(2)进行时间积分得到机器人位移的函数,设置机器人的初始时位移为零,则机器人位移的数学表达式为:
令T1=t1,T2=t2-t1,T3=t3-t2,则公式(3)中
5.根据权利要求3所述的串联机器人轨迹规划方法,其特征在于,所述正弦模型的数学表达式包括:
机器人运动加速度的数学表达式:
为保证最大加速度和最大速度的约束,以及加速度边界条件,式中
将式(4)进行时间积分得到机器人运动的速度函数,设置机器人运动的初始速度和末速度为零,则机器人运动的速度函数表达式为:
对公式(5)进行时间积分,得到机器人运动的位移函数表达式:
式中:S02=S01+vmaxT2,T2=t2-t1。
6.根据权利要求1所述的串联机器人轨迹规划方法,其特征在于,所述规划在相邻两个姿态控制节点之间机器人运动的轨迹包括:
对机器人运动的控制节点进行规划;
对相邻两个姿态控制节点之间机器人运动的直线运动轨迹规划;
对相邻两个姿态控制节点之间机器人运动的运动姿态规划。
7.根据权利要求6所述的串联机器人轨迹规划方法,其特征在于,所述对机器人运动的控制节点进行规划采用采用三次样条规划。
8.根据权利要求7所述的串联机器人轨迹规划方法,其特征在于,所述三次样条规划包括:
令Pi(ti,si(ti))和Pi+1(ti+1,si(ti+1))为机器人运动曲线上的相邻的两个控制节点,在这两个控制节点之间的第i个三次多项式为:
si(t)=ai(t-ti)3+bi(t-ti)2+ci(t-ti)+di;(ti≤t≤ti+1) (7)
si(t)的一阶导数为:
si′(t)=3ai(t-ti)2+2bi(t-ti)+ci (8)
si(t)的二阶导数为:
令pi=si(ti),pi'=si'(ti),pi”=si”(ti),Δti=ti+1-ti,Δpi=pi+1-pi,得:
三次样条曲线在各节点处连续且一阶导数、二阶导数均连续,则:
si(ti+1)=si+1(ti+1) (11)
si′(ti+1)=si+1′(ti+1) (12)
si″(ti+1)=si+1″(ti+1) (13)
由式(11)和(13)得:
联立公式(8)、(12)、(13)、(14)得:
联立公式(9)和(13),得:
3ai(Δti)2+2bi(Δti)+ci=ci+1 (16)
将式(11)、(15)、(16)代入公式(7)得
Δti+1pi+2″+2(Δti+Δti+1)pi+1″+Δtipi″=6(Δpi+1/Δti+1-Δpi/Δti) (17)
式中i=1,2,3...n-2,因此将式(17)写成矩阵的模式:
Ap”=6Bp
式中:p=[p1,p2,...,pn]T,p”=[p1”,p2”,...,pn”]T;
A和B为(n-2)×n阶矩阵:
其中:αi=Δti,αij=αi+αj,βi=1/Δti,βij=βi+βj;
设置两个约束条件,p1″=pn″=0;
将p”,p均变为n-2维,矩阵A和B也相应的变为(n-2)×(n-2)矩阵:
从而求出各控制节点的加速度矢量:p″=6A-1Bp;
将节点加速度矢量p”和节点位移矢量p带入式(11)(14)(15)求出所有的三次多项式系数,已知系数利用式(8)即求出三次样条轨迹。
9.根据权利要求6所述的串联机器人轨迹规划方法,其特征在于,所述对相邻两个姿态控制节点之间机器人运动的直线运动轨迹规划包括:
机器人控制单元接收到机器人从某一控制节点移动到下一个控制节点的命令;
机器人控制单元将机器人的直线运动分解为X、Y、Z三个轴的运动;
应用加速度控制方法,根据在进行运动规划时规定的加速度amax和速度vmax,得到位移时间函数S(t);
将位移时间函数S(t)在X、Y、Z三个轴上投影,控制X、Y、Z三个轴的运动,实现机器人末端沿直线运动。
10.根据权利要求6所述的串联机器人轨迹规划方法,其特征在于,所述机器人控制单元将机器人的直线运动分解为X、Y、Z三个轴的运动包括:
设某一控制节点P的坐标为[x1,y1,z1],与其相邻的下一个控制节点Q的坐标为[x2,y2,z2],则有:
式中: X(t)、Y(t)、Z(t)分别为机器人在X、Y、Z轴方向上的位移。
11.根据权利要求6所述的串联机器人轨迹规划方法,其特征在于,所述对相邻两个姿态控制节点之间机器人运动的运动姿态规划包括:
设置机器人在一个控制节点的初始运动姿态为R1,在其下一个相邻的控制节点的末端运动姿态为R2,获得旋转矩阵R,所述初始运动姿态为R1为机器人机械臂开始的位置,末端运动姿态为R2为机器人机械臂完成任务后用户需要的姿态;
使用罗德里格斯变换公式,计算出机器人运动的等效旋转轴和旋转角度;
进行机器人运动的加减速控制运算。
12.根据权利要求11所述的串联机器人轨迹规划方法,其特征在于,所述使用罗德里格斯变换公式,计算出机器人运动的等效旋转轴和旋转角度包括:
设置机器人在一个控制节点的初始运动姿态为R1,在其下一个相邻的控制节点的末端运动姿态为R2,获得旋转矩阵R,R1通过旋转矩阵R变换得到R2,即R2=RR1,R=R2R1 -1;
使用罗德里格斯变换公式推导可得:
由式(20)求出旋转轴,观察通用旋转矩阵得到:
通过式(21)确定旋转轴的方向,求出cosθ、sinθ,在此基础上求出等效旋转角:
θ=atan(cosθ,sinθ) (22)
其中θ为相邻姿态之间的等效旋转总角度。
13.根据权利要求1所述的串联机器人轨迹规划方法,其特征在于,所述规划在相邻两个姿态控制节点之间机器人运动的轨迹还包括姿态的四元数规划,所述姿态的四元数规划包括:
所述四元数由实数加上三个虚数单位i,j,k构造,四元数的表达式为q=[s,(x,y,z)]=s+xi+yj+zk,其中s、x、y、z为实数,虚数单位k表示绕Z轴旋转,虚数单位j代表绕Y轴旋转,虚数单位i旋转代表绕X轴旋转,-i,-j,-k分别代表虚数单位i,j,k旋转的反向旋转。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811271246.7A CN109304711A (zh) | 2018-10-29 | 2018-10-29 | 串联机器人轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811271246.7A CN109304711A (zh) | 2018-10-29 | 2018-10-29 | 串联机器人轨迹规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109304711A true CN109304711A (zh) | 2019-02-05 |
Family
ID=65222208
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811271246.7A Pending CN109304711A (zh) | 2018-10-29 | 2018-10-29 | 串联机器人轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109304711A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110000794A (zh) * | 2019-05-06 | 2019-07-12 | 江苏集萃智能制造技术研究所有限公司 | 一种基于协作机器人的截断式非对称速度规划方法 |
CN110162070A (zh) * | 2019-05-15 | 2019-08-23 | 北京控制工程研究所 | 末端自由边界约束下的三轴姿态运动轨迹规划***及方法 |
CN113172627A (zh) * | 2021-04-30 | 2021-07-27 | 同济大学 | 多移动机械手协同搬运***运动学建模与分布式控制方法 |
CN116277038A (zh) * | 2023-05-23 | 2023-06-23 | 极限人工智能(北京)有限公司 | 一种给定时间和初末速度的机械臂轨迹规划方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102794767A (zh) * | 2012-08-31 | 2012-11-28 | 江南大学 | 视觉引导的机器人关节空间b样条轨迹规划方法 |
CN103970139A (zh) * | 2014-05-09 | 2014-08-06 | 上海交通大学 | 一种机器人连续点位运动规划方法及其运动控制器 |
CN106826829A (zh) * | 2017-02-22 | 2017-06-13 | 武汉工程大学 | 一种可控误差的工业机器人光顺运动轨迹生成方法 |
CN107662205A (zh) * | 2016-07-29 | 2018-02-06 | 深圳光启合众科技有限公司 | 机器人及其关节运动控制方法和装置 |
US20180085919A1 (en) * | 2016-09-27 | 2018-03-29 | Denso Wave Incorporated | Control device for robot |
-
2018
- 2018-10-29 CN CN201811271246.7A patent/CN109304711A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102794767A (zh) * | 2012-08-31 | 2012-11-28 | 江南大学 | 视觉引导的机器人关节空间b样条轨迹规划方法 |
CN103970139A (zh) * | 2014-05-09 | 2014-08-06 | 上海交通大学 | 一种机器人连续点位运动规划方法及其运动控制器 |
CN107662205A (zh) * | 2016-07-29 | 2018-02-06 | 深圳光启合众科技有限公司 | 机器人及其关节运动控制方法和装置 |
US20180085919A1 (en) * | 2016-09-27 | 2018-03-29 | Denso Wave Incorporated | Control device for robot |
CN106826829A (zh) * | 2017-02-22 | 2017-06-13 | 武汉工程大学 | 一种可控误差的工业机器人光顺运动轨迹生成方法 |
Non-Patent Citations (3)
Title |
---|
孙斌等: "基于四元数的机械臂平滑姿态规划与仿真", 《机械科学与技术》 * |
王允航: "连续轨迹的S型速度规划的研究", 《中国优秀硕士学位论文全文数据库(电子期刊)工程科技Ⅰ辑》 * |
雷爱民: "机器人运动控制***的软件设计", 《万方学位论文全文》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110000794A (zh) * | 2019-05-06 | 2019-07-12 | 江苏集萃智能制造技术研究所有限公司 | 一种基于协作机器人的截断式非对称速度规划方法 |
CN110162070A (zh) * | 2019-05-15 | 2019-08-23 | 北京控制工程研究所 | 末端自由边界约束下的三轴姿态运动轨迹规划***及方法 |
CN110162070B (zh) * | 2019-05-15 | 2022-04-12 | 北京控制工程研究所 | 末端自由边界约束下的三轴姿态运动轨迹规划***及方法 |
CN113172627A (zh) * | 2021-04-30 | 2021-07-27 | 同济大学 | 多移动机械手协同搬运***运动学建模与分布式控制方法 |
CN113172627B (zh) * | 2021-04-30 | 2022-07-29 | 同济大学 | 多移动机械手协同搬运***运动学建模与分布式控制方法 |
CN116277038A (zh) * | 2023-05-23 | 2023-06-23 | 极限人工智能(北京)有限公司 | 一种给定时间和初末速度的机械臂轨迹规划方法及*** |
CN116277038B (zh) * | 2023-05-23 | 2023-10-20 | 极限人工智能(北京)有限公司 | 一种给定时间和初末速度的机械臂轨迹规划方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109304711A (zh) | 串联机器人轨迹规划方法 | |
JP6766186B2 (ja) | ロボット関節空間におけるポイントツーポイント移動の軌跡計画方法 | |
JP6268819B2 (ja) | 多軸型ロボットの軌道生成方法 | |
Williams Ii et al. | Translational planar cable-direct-driven robots | |
CN108241339A (zh) | 仿人机械臂的运动求解和构型控制方法 | |
JP2014193519A (ja) | 多軸型ロボットの軌道生成方法及び多軸型ロボットの制御装置 | |
Jahanpour et al. | A novel trajectory planning scheme for parallel machining robots enhanced with NURBS curves | |
Kabir et al. | Generation of synchronized configuration space trajectories of multi-robot systems | |
CN107263466B (zh) | 空间机器人基于二次规划问题的基座无扰控制方法 | |
Jiang et al. | Dynamic point-to-point trajectory planning beyond the static workspace for six-DOF cable-suspended parallel robots | |
CN107584474A (zh) | 一种基于几何投影的球面关节双臂机器人协调运动方法 | |
CN109623825A (zh) | 一种移动轨迹规划方法、装置、设备和存储介质 | |
Staicu | Recursive modelling in dynamics of Delta parallel robot | |
Gauthier et al. | Optimization of a test trajectory for SCARA systems | |
Liping et al. | Kinematics and inverse dynamics analysis for a novel 3-PUU parallel mechanism | |
CN109991847A (zh) | 一种柔性多体机器人近似时间最优轨迹规划方法 | |
Aneesh | Tracking Controller of mobile robot | |
Tamir et al. | Passivity based control of stewart platform for trajectory tracking | |
CN109434838A (zh) | 线驱动连续机器人内窥操作的协同运动规划方法及*** | |
JP6123595B2 (ja) | 2軸ロボットの速度制御方法 | |
Murakami et al. | Motion planning for catching a light-weight ball with high-speed visual feedback | |
Ying-Shi et al. | Online minimum-acceleration trajectory planning with the kinematic constraints | |
Cui et al. | A novel inverse kinematics solution for a 7-DOF humanoid manipulator | |
Kong et al. | Application of orientation interpolation of robot using unit quaternion | |
Dehghani et al. | Dynamics modeling of planar continuum robots by finite circular elements for motion control |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190205 |
|
RJ01 | Rejection of invention patent application after publication |