专利摘要

专利摘要

本发明公开了一种基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，首先利用三次样条插值函数生成各关节从任务起点到终点经过各路径节点的轨迹；根据生成的轨迹，确定优化目标函数中与之对应的各关节最小跃度均值；根据优化目标函数和任务的约束条件确定各关节的适应度函数；最后，根据各关节的适应度函数，利用多目标粒子群优化算法，得到优化目标函数对应的Pareto最优解集，然后按照一定的原则从最优解集中选择最优的轨迹规划方案。本发明综合考虑各个关节的跃度值，在降低路径中所有关节跃度的最大值以及各关节跃度值平均性和均衡分布方面都有明显改善，利用该方法，可有效减小机械臂的执行误差，减少运动过程对关节机构的磨损。

权利要求

1.基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，其特征在于，包括如下步骤：

1)在任务约束条件下，利用三次样条插值函数生成三次样条插值曲线，该三次样条插值函数为：

$\left\{\begin{array}{c}{Q}_{\mathrm{ji}}\left(t\right)=\frac{{\stackrel{..}{Q}}_{\mathrm{ji}}\left(t_i\right)}{6h_i}{(t_{i+1}-t)}^3+\frac{{\stackrel{..}{Q}}_{\mathrm{ji}}\left(t_{i+1}\right)}{6h_i}{(t-t_i)}^3\\ +[\frac{q_{j,i+1}}{h_i}-\frac{h_i{\stackrel{..}{Q}}_{\mathrm{ji}}\left(t_{i+1}\right)}{6}](t-t_i)\\ +[\frac{q_{j,i}}{h_i}-\frac{h_i{\stackrel{..}{Q}}_{\mathrm{ji}}\left(t_i\right)}{6}](t_{i+1}-t)\\ i=1,...,n-1\end{array}\right.$

其中，Q_ji(t)为时间区间[t_i，t_i+1]上的三次样条轨迹， 为第i个路径节点处的加速度，q_ji为在起点及终点速度、加速度均为零的约束条件下第j个关节在第i个路径节点处的位置，h_i为相邻路径节点间的时间间隔，t_i为第i个路径节点处的时刻值，t_i+1为第i+1个路径节点处的时刻值，n为包括起点、终点的路径节点个数；

2)根据生成的三次样条插值曲线，确定优化目标函数中与之对应的各关节最小跃度：

$\begin{array}{c}{F}_{\mathrm{obj}}{\left(h\right)}_j=\underset{i-1}{\overset{n-1}{\Sigma }}|{\stackrel{...}{Q}}_{\mathrm{ji}}(h,t)·h_i|\\ =\underset{i-1}{\overset{n-1}{\Sigma }}|\frac{({\alpha }_{j,i+1}-{\alpha }_{j,i})}{h_i}·h_i|\\ =\underset{i-1}{\overset{n-1}{\Sigma }}|{\alpha }_{j,i+1}-{\alpha }_{j,i}|(j=1,...,m)\end{array}$

式中，F_obj(h)_j为第j个关节在给定时间向量h下的优化目标函数值， 是三次样条插值曲线的跃度，m为机械臂的关节个数，α_j，i为第j个关节在第i个路径节点处的加速度，n为包括起点、终点的路径节点个数，h_i为相邻路径节点间的时间间隔；

3)根据优化目标函数和任务约束条件，确定各关节的适应度函数：

fitness(X)_j＝F_obj(h)_j+r₁G_v(h)_j+r₂G_a(h)_j+r₃G_j(h)_j+r₄G_t(h)_j

式中，fitness(X)_j为第j个关节在给定决策向量X下的适应度函数值，r₁，…，r₄为惩罚系数，G_v，G_a，G_j，G_t分别为速度、加速度、跃度、时间约束条件下的惩罚项；

4)根据各关节的适应度函数，利用多目标粒子群优化算法，得到优化目标函数对应的Pareto最优解集。

2.如权利要求1所述的基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，其特征在于，所述步骤4)包括如下步骤：

S1：设置算法初始化的相关参数，给定种群规模，在任务约束条件的范围内随机生成初始粒子的速度与位置，产生初始群体，计算得到初始群体中各粒子适应度函数值，并依据Pareto主导准则将初始种群中所有粒子相互比较完成后得到初始群体中Pareto最优解，并将最优解存入外部存储器I中；

S2：将每个粒子的个体最优极值设置为对应粒子的当前位置；

S3：每个粒子的全局最优极值，从外部存储器I中随机选取；

S4：对于每个粒子，根据选取出的个体最优极值和全局最优极值，按照以下公式计算新的粒子速度并更新粒子位置，得到新群体；

$\left\{\begin{array}{c}{v}_{\mathrm{ij}}(t+1)=\omega \left(t\right)v_{\mathrm{ij}}\left(t\right)+c_1{r}_1({\mathrm{pbest}}_{\mathrm{ij}}\left(t\right)-x_{\mathrm{ij}}\left(t\right))\\ +c_2{r}_2({\mathrm{gbest}}_j\left(t\right)-x_{\mathrm{ij}}\left(t\right))\\ x_{\mathrm{ij}}(t+1)=x_{\mathrm{ij}}\left(t\right)+v_{\mathrm{ij}}(t+1)\end{array}\right.$

其中，j为粒子的第j维，j＝1，2，…，n，i表示第i个粒子，i＝1，2，…，M，c₁和c₂为学习因子，pbest_ij(t)为第t代种群中第i个粒子个体最优极值的第j维分量，gbest_j(t)为第t代种群中所有粒子全局最优极值的第j维分量；r₁和r₂为两个相互独立并服从正态分布的随机函数，ω为惯性权重；

x_ij(t)为第t代种群中第i个粒子位置的第j维分量，v_ij(t)为第t代种群中第i个粒子速度的第j维分量；

S5：依据任务的约束条件，将新群体中所有粒子的速度、位置都限定在约束条件范围内；

S6：利用新群体更新外部存储器I，若I中的粒子个数超过一定规模，计算每个粒子相应的拥挤度，保留拥挤度较大的粒子；

S7：对新群体中的所有粒子，按照基于约束主导的Pareto排序法更新每个粒子的个体最优极值；粒子的全局最优极值仍然从外部存储器I中随机选取；

S8：判断算法是否满足结束条件，若满足，则执行步骤S9，否则跳转至步骤S4；

S9：输出外部存储器I中的所有粒子作为所述优化目标函数对应的Pareto最优解集。

3.如权利要求2所述的基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，其特征在于：

从初始群体或更新后的新群体中确定Pareto最优解的方法是：

根据当前群体中每个粒子的位置信息确定当前各路径节点之间的时间间隔向量，根据该时间间隔向量以及任务的约束条件计算各个关节的适应度函数值，并将得到的适应度函数值依据Pareto主导准则与外部存储器I中所有粒子相互比较完成后确定是否为所述优化目标函数对应的Pareto最优解，若是则将该粒子存入外部存储器I中，否则对当前群体中其他粒子继续比较。

4.如权利要求1或3所述的基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，其特征在于，该方法还包括：

得到优化目标函数对应的Pareto最优解集后，按照各关节跃度均值方差最小且最大关节跃度值较小的原则，从所述Pareto最优解集中选择最优的轨迹规划方案。

说明书

技术领域

本发明涉及一种基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，属于机器人控制技术领域。

背景技术

随着自动控制和机器人领域的深入研究和技术发展，机械臂已广泛应用于半导体制造、工业、医疗、军事以及太空探索等领域，机械臂的研究热点和难点主要集中于运动轨迹规划及在此基础上的精确控制方面，其中，轨迹规划作为轨迹控制的基础，对机械臂的运行效率、平稳性、作业精度和能量消耗具有重要的意义。

轨迹规划是指给定起点和终点，根据任务要求寻求一条连接起点和终点的最优有效路径，然后将路径转换成机械臂各个关节的空间坐标，确定机械臂在运动过程中各关节的位移、速度、加速度和跃度，形成轨迹。有效的轨迹规划能够减少机械臂的磨损、节省作业时间、提高工作效率。

最小跃度作为轨迹优化的一个重要研究方向，是以一种间接的方式限制关节力矩的变化率，使机械臂的运动更加平稳，且可提高跟踪精度，减少机械臂的共振和机构磨损。

现有的关于最小跃度的轨迹优化方法主要分为两类：一类是根据单一目标函数(如机械臂的某个重要关节)进行单目标优化，如由Piazzi等提出的基于区间分析的算法，通过三次样条函数对轨迹插值，基于最大最小法使执行时间预设的路径的跃度最大绝对值全局最小，这类方法的缺点是，单目标函数只关注跃度最大时刻，不能反映整个任务过程中跃度的全局水平，即，只考虑某个关节的跃度，无法综合考虑到每个关节的跃度，导致机械臂中某个或某几个关节性能较好，而其余关节性能略逊，各关节的跃度不均衡会增加机械臂的执行误差，造成关节机构的磨损；另一类是，基于遗传算法的方法规划全局跃度最小的路径，由于遗传算法原理复杂，计算成本过大，不利于推广应用。

发明内容

鉴于上述原因，本发明的目的在于提供一种基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，该方法以降低机械臂各个关节的跃度为目标函数进行多目标优化，轨迹规划综合考虑到各关节的跃度，可使机械臂各关节在运动过程中性能均衡，减小机械臂的执行误差，避免某些关节在运动过程中受到严重磨损。

为实现上述目的，本发明采用以下技术方案：

基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，其特征在于，包括如下步骤：

1)在任务约束条件下，利用三次样条插值函数生成三次样条插值曲线，该三次样条插值函数为：

Qji(t)=Q..ji(ti)6hi(ti+1-t)3+Q..ji(ti+1)6hi(t-ti)3+[qj,i+1hi-hiQ..ji(ti+1)6](t-ti)+[qj,ihi-hiQ..ji(ti)6](ti+1-t)i=1,...,n-1]]>

其中，Q_ji(t)为时间区间[t_i，t_i+1]上的三次样条轨迹， 为第i个路径节点处的加速度，q_ji为在起点及终点速度、加速度均为零的约束条件下第j个关节在第i个路径节点处的位置，h_i为相邻路径节点间的时间间隔，t_i为第i个路径节点处的时刻值，t_i+1为第i+1个路径节点处的时刻值，n为包括起点、终点的路径节点个数；

2)根据生成的三次样条插值曲线，确定优化目标函数中与之对应的各关节最小跃度：

Fobj(h)j=Σi-1n-1|Q...ji(h,t)·hi|=Σi-1n-1|(αj,i+1-αj,i)hi·hi|=Σi-1n-1|αj,i+1-αj,i|(j=1,...,m)]]>

式中，F_obj(h)_j为第j个关节在给定时间向量h下的优化目标函数值， 是三次样条插值曲线的跃度，m为机械臂的关节个数，α_j，i为第j个关节在第i个路径节点处的加速度，n为包括起点、终点的路径节点个数，h_i为相邻路径节点间的时间间隔；

3)根据优化目标函数和任务约束条件，确定各关节的适应度函数：

fitness(X)_j＝F_obj(h)_j+r₁G_v(h)_j+r₂G_a(h)_j+r₃G_j(h)_j+r₄G_t(h)_j

式中，fitnsess(X)_j为第j个关节在给定决策向量X下的适应度函数值，r₁，…，r₄为惩罚系数，G_v，G_a，G_j，G_t分别为速度、加速度、跃度、时间约束条件下的惩罚项；

4)根据各关节的适应度函数，利用多目标粒子群优化算法，得到优化目标函数对应的Pareto最优解集。

进一步的，

所述步骤4)包括如下步骤：

S1：设置算法初始化的相关参数，给定种群规模，在任务约束条件的范围内随机生成初始粒子的速度与位置，产生初始群体，计算得到初始群体中各粒子适应度函数值，并依据Pareto主导准则将初始种群中所有粒子相互比较完成后得到初始群体中Pareto最优解，并将最优解存入外部存储器I中；

S2：将每个粒子的个体最优极值设置为对应粒子的当前位置；

S3：每个粒子的全局最优极值，从外部存储器I中随机选取；

S4：对于每个粒子，根据选取出的个体最优极值和全局最优极值，按照以下公式计算新的粒子速度并更新粒子位置，得到新群体；

vij(t+1)=ω(t)vij(t)+c1r1(pbestij(t)-xij(t))+c2r2(gbestj(t)-xij(t))xij(t+1)=xij(t)+vij(t+1)]]>

其中，j为粒子的第j维，j＝1，2，…，n，i表示第i个粒子，i＝1，2，…，M，c₁和c₂为学习因子，pbest_ij(t)为第t代种群中第i个粒子个体最优极值的第j维分量，gbest_j(t)为第t代种群中所有粒子全局最优极值的第j维分量；r₁和r₂为两个相互独立并服从正态分布的随机函数，ω为惯性权重；

x_ij(t)为第t代种群中第i个粒子位置的第j维分量，v_ij(t)为第t代种群中第i个粒子速度的第j维分量；

S5：依据任务的约束条件，将新群体中所有粒子的速度、位置都限定在约束条件范围内；

S6：利用新群体更新外部存储器I，若I中的粒子个数超过一定规模，计算每个粒子相应的拥挤度，保留拥挤度较大的粒子；

S7：对新群体中的所有粒子，按照基于约束主导的Pareto排序法更新每个粒子的个体最优极值；粒子的全局最优极值仍然从外部存储器I中随机选取；

S8：判断算法是否满足结束条件，若满足，则执行步骤S9，否则跳转至步骤S4；

S9：输出外部存储器I中的所有粒子作为所述优化目标函数对应的Pareto最优解集。

其中，从初始群体或更新后的新群体中确定Pareto最优解的方法是：

根据当前群体中每个粒子的位置信息确定当前各路径节点之间的时间间隔向量，根据该时间间隔向量以及任务的约束条件计算各个关节的适应度函数值，并将得到的适应度函数值依据Pareto主导准则与外部存储器I中所有粒子相互比较完成后确定是否为所述优化目标函数对应的Pareto最优解，若是则将该粒子存入外部存储器I中，否则对当前群体中其他粒子继续比较。

该方法还包括：

得到优化目标函数对应的Pareto最优解集后，按照各关节跃度均值方差最小且最大关节跃度值较小的原则，从所述Pareto最优解集中选择最优的轨迹规划方案。

本发明的优点在于：

本发明综合考虑了各个关节的跃度值，在降低路径中所有关节跃度的最大值以及各关节跃度值平均性和均衡分布方面都有明显改善，利用该方法，可有效减小机械臂的执行误差，减少运动过程对关节机构的磨损。

附图说明

图1是机械臂的运动规划系统。

图2是本发明的方法流程示意图。

图3是于一具体实施例中利用本发明的方法得到的Pareto前沿部分分量的散点示意图。

图4至图9是一具体实施例中机械臂最终选取规划方案中与六个关节对应的位置、速度、加速度及跃度曲线的示意图。

具体实施方式

以下结合附图和实施例对本发明作进一步详细的描述。

研究表明，降低机械臂各关节在运动过程中的跃度可以有效减小机械臂的执行误差，并可减少运动过程对关节机构的磨损，本发明即是提出了一种基于多目标粒子群算法的机械臂最小跃度轨迹优化方法，具体说明如下：

一、最小跃度的轨迹优化问题

图1是机械臂的运动规划系统，如图所示，机械臂在执行任务前，需利用该系统针对任务需求对机械臂进行轨迹规划，其中，上层规划器用于根据任务需求生成路径节点，机械臂上的各个关节必须在规定的任务总时间之内，在速度、加速度、跃度等运动学约束的条件下，依次经过各路径节点以完成任务。

设定机械臂完成任务必须要经过的路径节点D为：

D＝{d_ij|i＝1，…，s；j＝1，…，m}   (1)

其中，d_ij为机械臂上第j个关节在第i个路径节点处的位置，s为路径节点个数，m为机械臂的关节个数。

以机械臂上各关节的跃度均值最小为优化目标，构造如下优化目标函数：

min1T∫0T|q...j(t)|dtj=1,...,m---(2)]]>

其中，T为任务总时间， 为第j个关节在t时刻的跃度，m为机械臂的关节个数。与采用跃度平方积分作为优化目标相比，各个关节跃度均值的优化目标函数值与路径中各个关节跃度数值大小呈线性正比，可以避免关节跃度数值较大时，相应的目标函数值过大，导致优化算法不易达到运动学约束上限，不能充分发挥关节运动性能，从而难以获得各个关节跃度最小的Pareto最优解的问题。

在给定任务总时间的约束条件下，各关节的跃度均值最小的优化问题为：

find:min1T∫0T|q...j(t)|dt(j=1,...,m)subject to:|q.j(t)|≤VCj,j=1,...,m|q..j(t)|≤WCj,j=1,...,m|q...j(t)|≤JCj,j=1,...,mh=[h1,...,hs-1]TΣi=1s-1hi=T---(3)]]>

其中， 为第j个关节在t时刻的速度， 为第j个关节在t时刻的加速度，VC_j为第j个关节的速度最大值，WC_j为第j个关节的加速度最大值，JC_j为第j个关节的跃度最大值，h_i为两个相邻路径节点之间的时间间隔，T为任务总时间。

二、根据优化问题，实现最小跃度的轨迹优化方法

图2是本发明的方法流程图，结合图2所示：

1、利用三次样条插值函数生成各关节从任务起点到终点途径各路径节点的轨迹

在给定的路径节点之间插入额外的节点，可使机械臂的运动轨迹在速度、加速度、跃度上保持连续，进而使机械臂的整个运动过程更加平稳。

假设运动路径上的起点、终点的速度和加速度均为零，则，在该约束条件下，路径节点更新为：

Q＝{q_ji|j＝1，…，m；i＝1，…，n}   (4)

其中，q_ji为在起点及终点速度、加速度均为零的约束条件下第j个关节在第i个节点处的位置，q_j，1为根据任务设定好的起点位置，q_j，n为根据任务设定好的终点位置，m为机械臂的关节个数，n＝s+2，s为路径节点个数。

令每个路径节点处的时刻值为t1，…，t_n，其中：t₁＝0、t_n＝T，则，相邻路径节点间的时间间隔为：

hi=ti+1-tii=1,...,n-1---(5)]]>

令Q_ji(t)为时间区间[t_i，t_i+1]上的三次样条轨迹，对于一个关节，需要计算n-1次三次样条插值函数实现整个任务路径的插值，为避免求解4(n-1)个未知系数，对Q_ji(t)的二阶导数进行线性插值：

Q..ji(t)=ti+1-thiQ..ji(ti)+t-tihiQ..ji(ti+1)i=1,...,n-1---(6)]]>

对公式(6)进行两次积分，并根据Q_ji(t_i)＝q_j，i和Q_ji(t_i+1)＝q_j，i+1两个边界条件确定积分常数，得到以下有关关节位置的三次样条插值函数：

Qji(t)=Q..ji(ti)6hi(ti+1-t)3+Q..ji(ti+1)6hi(t-ti)3+[qj,i+1hi-hiQ..ji(ti+1)6](t-ti)+[qj,ihi-hiQ..ji(ti)6](ti+1-t)i=1,...,n-1---(7)]]>

若给定时间向量 该三次样条插值函数只与各路径节点处的加速度 有关，由于起点和终点的加速度均设定为零，则需要求解起点与终点之间的n-2个路径节点处的加速度，为此，对公式(7)进行求导运算，同时利用各节点间速度连续的约束条件Q_i(t_i)＝Q_i-1(t_i)，建立如下线性方程：

AZj=Bjj=1,...,m---(8)]]>

令 向量Z_j＝[α_j，2，，α_j，n-1]^T为n-2个路径节点处的加速度，为求解向量Z_j＝[α_j，2，，α_j，n-1]^T，其系数矩阵A只与h^*有关，

A=a11a12a21a22a23Oa32a33a34...Oan-2,n-3an-2,n-2=3h1+2h2+h12/h2h2Oh2-h12/h22(h2+h3)h3h32(h3+h4)h4...hn-32(hn-3+hn-2)hn-2-hn-12hn-2Ohn-23hn-1+2hn-2+hn-12hn-2---(9)]]>

常向量B与q_ji和h_i具体关系如下：

B=[B2,...,Bn-1]T=6h2*[(q3h2+q1h1)-(1h1+1h2)·(q1+h1v1+h123α1)]-h1h2α16h2h3(q1+h1v1+h123α1)+6q4h32-6q3h3

基于多目标粒子群算法的机械臂最小跃度轨迹优化方法专利购买费用说明

Q：办理专利转让的流程及所需资料

A：专利权人变更需要办理著录项目变更手续，有代理机构的，变更手续应当由代理机构办理。

1：专利变更应当使用专利局统一制作的“著录项目变更申报书”提出。

2：按规定缴纳著录项目变更手续费。

3：同时提交相关证明文件原件。

4：专利权转移的，变更后的专利权人委托新专利代理机构的，应当提交变更后的全体专利申请人签字或者盖章的委托书。

Q:专利著录项目变更费用如何缴交

A：（1）直接到国家知识产权局受理大厅收费窗口缴纳,（2）通过代办处缴纳，（3）通过邮局或者银行汇款,更多缴纳方式

Q：专利转让变更，多久能出结果

A：著录项目变更请求书递交后，一般1-2个月左右就会收到通知，国家知识产权局会下达《转让手续合格通知书》。