CN105159096B - 一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 - Google Patents
一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 Download PDFInfo
- Publication number
- CN105159096B CN105159096B CN201510653873.7A CN201510653873A CN105159096B CN 105159096 B CN105159096 B CN 105159096B CN 201510653873 A CN201510653873 A CN 201510653873A CN 105159096 B CN105159096 B CN 105159096B
- Authority
- CN
- China
- Prior art keywords
- joint
- space
- space manipulator
- particle
- optimal
- 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.)
- Active
Links
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明实施例提出了一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法,包括:将空间机械臂操作空间点到点的转移任务从笛卡尔空间转换至关节空间,利用七次多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数;将空间机械臂各关节力矩均值和最小作为该算法求解的目标函数;依据所述优化控制参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,得出空间机械臂的运行路径;该路径即可使得空间机械臂关节力矩均值和最小。根据本发明实施例提供的技术方案,在满足任务约束条件下执行操作空间中点到点转移任务时,依照上述规划路径运行可以使得空间机械臂各关节力矩得以优化。
Description
【技术领域】
本发明涉及自动化控制技术,尤其涉及一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法。
【背景技术】
当冗余度空间机械臂末端执行器运动时,其任务空间维数小于其关节空间维数。所以,当冗余度空间机械臂末端执行器按一定轨迹运动时,其关节驱动力矩满足任务要求的解并不是唯一的。正是由于其冗余度的存在,使得我们能够优化其在满足主运动任务下的辅助性能指标。
对空间机械臂的关节驱动力矩进行优化是非常重要的,一方面是从工作过程的安全性来考虑,如果空间机械臂在运动过程中要求的关节驱动力矩过大或超限,会使空间机械臂动力学性能下降,算法失效,并加快空间机械臂因关节应力过大导致的机械结构性能衰减速率,严重时甚至损坏空间机械臂本身;另一方面是希望空间机械臂能以较小的关节驱动力矩完成规定的操作程序,以进一步降低能耗,改变空间机械臂时刻面临燃料有限、补给困难的局面,同时可以减轻空间机械臂的机构磨损,延缓因关节应力过大导致的机械结构性能衰减速率,以降低空间机械臂的使用代价进而延长其使用寿命。
【发明内容】
有鉴于此,本发明实施例提出了一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法,以降低空间机械臂任务执行所需的能耗,同时可以减轻空间机械臂的机构磨损,延缓因关节应力过大导致的机械结构性能衰减速率。
本发明实施例提出了一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法,包括:
利用七次多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数;
将空间机械臂各关节力矩均值的和值最小作为粒子群算法求解过程中的目标函数;
依据所述优化控制参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,规划得出空间机械臂的运行路径;所述运行路径即可使得所述空间机械臂关节力矩得以优化。
上述方法中,获得粒子群算法的优化控制参数的方法为:利用七次多项式插值方法对各个关节进行插值遍历,根据空间机械臂轨迹连续、速度连续等要求,基于多项式插值法得出空间机械臂关节角表达式,再利用空间机械臂执行点到点的转移任务时初始、终止状态的关节角度、角速度、角加速度约束条件将多项式系数用某几个参数表示,所获得的参数即为粒子群算法的优化控制参数。
使用上述方法中七次多项式插值法获得的空间机械臂关节角的表达式为:
θ(t)=ai7t7+ai6t6+ai5t5+ai4t4+ai3t3+ai2t2+ai1t+ai0
其中,θ表示关节角序列,为n维列向量,ai0,ai1,...ai7为七次多项式系数,i=1,2,...,7表示第i个关节;
利用空间机械臂执行点到点的转移任务时的初始、终止关节角度、角速度、角加速度约束条件建立关节角约束方程为:
qint=θint
qdes=θdes
其中qint,分别为空间机械臂关节角表达式所描述的所述空间机械臂执行点到点的转移任务时的初始关节角度,角速度以及角加速度;qdes,分别为空间机械臂关节角表达式所描述的所述空间机械臂执行点到点的转移任务时的终止关节角度,角速度以及角加速度;θint,θdes是任务给定的初始及终止的关节角度;
将ai6和ai7选为粒子群算法的优化控制参数,对空间机械臂关节角进行七次多项式插值,所得到的8个多项式系数均可以通过ai6和ai7两个未知参数表示,具体表示如下:
ai0=θint
ai1=ai2=0
上述方法中,将空间机械臂关节力矩均值和最小作为粒子群算法求解过程中的目标函数。当冗余度空间机械臂的末端执行器运动时,其任务空间维数小于其关节空间维数。所以,冗余度空间机械臂末端执行器按一定轨迹运动时,其关节驱动力矩的解将不唯一。因此由于冗余度的存在使得我们能够对空间机械臂的关节驱动力矩进行优化。
所述粒子群算法求解过程中的目标函数为:
其中,i=1,2,...,7表示空间机械臂的第i个关节,Z为空间机械臂在任务执行过程中所有关节力矩的均值和,为空间机械臂的第i个关节在任务执行过程中力矩的均值;
所述空间机械臂第i个关节力矩的均值为:
其中,τi为空间机械臂的关节力矩矢量τ=(τ1,τ2,…,τn)T中的第i个分量,tf为规划时间;
所述关节力矩矢量τ可由空间机械臂在关节空间的动力学基本方程求得,所述空间机械臂在关节空间的动力学基本方程如下:
式中,θ表示关节角序列,为n维列向量,;D(θ)∈Rn×n为其关节空间中惯性矩阵;为其哥氏力和离心力矢量矩阵;G(θ)∈Rn×1为其重力项;τ=(τ1,τ2,…,τn)T为其关节力矩矢量。
上述方法中,依据所述优化计算参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,规划得出空间机械臂的运行路径,使空间机械臂的关节力矩得到优化,包括:根据空间机械臂轨迹的任务要求,利用粒子群优化算法,以空间机械臂各关节力矩均值和最小为优化性能指标,以空间机械臂关节插值多项式的未知系数ai6和ai7为控制参数展开优化计算;
利用所述粒子群算法求解空间机械臂最小关节力矩均值和的具体步骤如下:
1)利用七次多项式插值法得到的控制参数a=[ai6,ai7],i=1,2,...,7,将关节空间的关节角数据描述为插值多项式函数值的离散序列;
2)设定微粒群算法中的初始变量,包括微粒数popsize、认知系数c1、社会系数c2、迭代次数max_length、微粒子速度上限Vmax、微粒子速度下限Vmin以及问题域中的问题值的上下限等;
3)微粒参数初始化。结合所设定的初始参数和微粒速度优化方程,利用随机函数得到微粒群中各粒子的初始位置、初始速度,并将其记录到当前位置表中;
粒子k的当前位置表示为:
Xk(T)=(a16(T),a17(T),a26(T),a27(T),a36(T)…a76(T),a77(T))
其中,k表示第k个粒子,k=1,2,...,popsize;Xk(T)为14维行向量,表示粒子k在14维空间中的当前位置;T为迭代次数,T=1,2,...,max_length;第k个粒子初始位置表示为Xk(1);ai6(T)与ai7(T)为第T次迭代后的控制参数,i=1,2,...,7;
粒子k的当前速度表示为:
Vk(T)=(v16(T),v17(T),v26(T),v27(T),v36(T)…v76(T),v77(T))
Vk(T)为14维行向量,表示粒子k在14维空间中的当前速度;其中v16(T)表示与a16(T)相对应维度的速度分量,其余维度类似,第k个粒子初始速度表示为Vk(1);
4)根据粒子当前位置计算出当前的七次多项式插值曲线,从而得到目标函数相对应的适应度值,记为f(X),f(X)是关于粒子在空间中位置的函数,用于反映粒子在空间中的位置与目标函数间的关系,记录当前个体最优位置和历史最优位置到当前个体最优表和历史最优表中;
5)计算当前迭代次数下的惯性因子ω的值,通过微粒子速度变异方程迭代计算微粒子新的当前速度,所述微粒子速度变异方程为:
Vk(T+1)=ω·Vk(T)+c1·r1·(pBestk(T)-Xk(T))+c2·r2·(gBest(T)-Xk(T))
其中,Vk(T+1)为微粒子k第T+1次迭代时速度,Vk(T)为微粒子k第T次迭代时速度,ω为当前迭代次数下的惯性因子,r1和r2为[0,1]的随机数,pbestk(T)为微粒子k迭代T次后的个体最优位置,gBestk(T)为迭代T次后整个粒子群的全局最优位置;
惯性因子ω的值由下式确定:
式中,ω1和ω2分别是惯性权重的初始值和终端值;max_length和T分别为最大迭代次数和当前迭代次数;
6)通过更新微粒子当前的速度值,进而更新微粒子的当前位置,并修改当前位置表中的位置参数;
微粒子位置更新方程为:
Xk(T+1)=Xk(T)+Vk(T+1)
其中,Xk(T+1)为微粒子k更新后的当前位置;
7)利用粒子的当前位置Xk(T),通过多项式方程计算得到基于当前多项式参数的关节角度、角速度和角加速度,然后利用SOA逆动力学方程计算出空间机械臂当前各关节力矩均值和,并以此作为目标函数的当前适应度值;
8)通过当前个体适应度值修改粒子个体历史最优值表和最优位置表中的最优值和最优位置参数;
粒子k的当前最优位置由下式确定:
9)修改群体最优值表和最优位置表中的最优值和最优位置,并转到步骤(5),进行循环优化计算,直至迭代次数max_length达到设定值;
所述全局最优位置gBest(T)由下式确定:
gBest(T)=min{f(pbest1(T)),f(pbest2(T)),…,f(pbestpopsize(T))}
10)统计最优值数据,并计算整个群体的最优值及相应的最优位置,得到最优微粒子对应的位置坐标,从而计算得到最优位置对应的多项式插值曲线,得到空间机械臂目标函数的当前最优路径。
所述运行路径使得所述空间机械臂关节力矩得到优化。
由以上技术方案可以看出,本发明实施例具有以下有益效果:
本发明实施例的技术方案中,利用七次多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数,将空间机械臂各关节力矩均值的和值最小作为粒子群算法求解过程中的目标函数,依据所述优化控制参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,从而获得使空间机械臂各关节力矩均值的和值得以优化的运行路径,因此能够使空间机械臂在完成任务的前提下使得各关节力矩均值的和值得以降低,从而降低空间机械臂任务执行所需的能耗,同时可以减轻空间机械臂的机构磨损,延缓因关节应力过大导致的机械结构性能衰减速率。
【附图说明】
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其它的附图。
图1是本发明实施例所提出的基于粒子群算法的冗余度空间机械臂关节力矩优化方法的流程示意图;
图2是基于空间算子描述的多自由度空间机械臂模型示意图;
图3是基于空间算子代数的逆动力学计算流程图;
图4是利用本发明实施例所提出的基于粒子群算法的空间机械臂关节力矩优化算法的流程图;
图5是本发明实施例中七自由度空间机械臂DH坐标系示意图;
图6是本发明实施例迭代寻优过程中种群目标均值的变化曲线示意图;
图7是本发明实施例迭代寻优过程中空间机械臂关节力矩均值和的变化曲线示意图。
【具体实施方式】
为了更好的理解本发明的技术方案,下面结合附图对本发明实施例进行详细描述。
应当明确,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
基于粒子群算法的冗余度空间机械臂关节力矩优化方法主要包括三个部分:首先将笛卡尔空间的规划路径向关节空间转换,针对空间机械臂关节空间展开数值仿真研究,利用多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数;再将空间机械臂各关节力矩均值的和值最小作为粒子群算法求解过程中的目标函数;最终以多项式系数作为优化控制参数,以空间机械臂各关节力矩均值的和值最小目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,所求运行路径即可使得所述空间机械臂关节力矩得以优化。
本发明实施例给出一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法,请参考图1,其为本发明实施例所提出的基于粒子群算法的冗余度空间机械臂关节力矩优化方法的流程示意图,如图1所示,该方法包括以下步骤:
步骤101,将空间机械臂操作空间中点到点的转移任务从笛卡尔空间转换至关节空间,利用七次多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数。
具体的,首先利用七次多项式插值方法对各个关节进行插值遍历,根据空间机械臂轨迹连续、速度连续等要求,基于多项式插值法建立空间机械臂关节角表达式如下:
根据空间机械臂关节角的多项式表达式,求导可以得到空间机械臂各关节的速度、加速度多项式表达式为:
利用空间机械臂初始和终止的关节角度、角速度、角加速度约束条件qint=θin,tqdes=θdes,可以建立6个关节角约束方程,而在空间机械臂关节角表达式中,多项式的未知系数为8个,因此选择其中的两个参数ai6和ai7作为粒子群算法的控制参数,即a=[ai6,ai7],i=1,2,...,7作为待定参数,其中n为空间机械臂的自由度数目。将空间机械臂关节角于其速度、加速度表达式代入空间机械臂约束方程可以将其余六个多项式系数用ai6和ai7两个参数表示,具体表示如下:
ai0=θint
ai1=ai2=0
其中,θint与θdes是任务给定的空间机械臂初始及终止的关节角度;至此空间空间机械臂关节角的表达式可以由ai6和ai7两个参数确定,本实施例中同样选取这两个参数作为优化控制参数。
步骤102,将空间机械臂各关节力矩均值的和值最小作为粒子群算法优化求解过程中的目标函数。
具体的,将空间机械臂各关节力矩均值和最小认为是空间机械臂各关节力矩最优,从而将空间机械臂各关节力矩均值的和值最小作为粒子群算法求解过程中的目标函数,对冗余度空间机械臂关节力矩进行优化求解。
所述粒子群算法求解过程中的目标函数为:
其中,i=1,2,...,7表示空间机械臂的第i个关节,Z为空间机械臂在任务执行过程中所有关节力矩均值和,为空间机械臂的第i个关节在任务执行过程中力矩的均值;
在给定任务的约束条件下,空间机械臂的力矩均值和最小的优化问题可以表示为:
所述关节力矩矢量τ可由空间机械臂在关节空间的动力学基本方程求得,所述空间机械臂在关节空间的动力学基本方程如下:
式中,θ表示关节角序列,为n维列向量;D(θ)∈Rn×n为其关节空间中惯性矩阵;为其哥氏力和离心力矢量矩阵;G(θ)∈Rn×1为其重力项;τ=(τ1,τ2,…,τn)T为其关节力矩矢量。
图2是基于空间算子描述的多自由度空间机械臂模型示意图,本实施例采用的动力学基本方程就是基于该模型建立的。如图2可以得到本实施例所依据的空间机械臂系统的各符号表示如下:ΣI为惯性坐标系,空间机械臂所有递推运算均是相对于惯性坐标系进行的;Σk为第k杆坐标系,定义在关节处;Jk为关节k,Jn为空间机械臂底座,J0为空间机械臂末端与外界相连处;Ck为第k杆质心位置;ak为关节Jk到k杆质心Ck的向量;bk为k杆质心Ck到关节Jk+1的向量;pk为关节k在惯性系下的向量;m(k)为第k杆质量;Pc(k)为点Jk到Ck的向量。
图3是基于空间算子代数的逆动力学计算流程图,由图3可以得出空间机械臂在关节空间的动力学基本方程,具体步骤如下:
首先利用旋量描述方法来表示空间机械臂的速度、加速度以及力和力矩:
其中,ωk,vk,Nk,Fk分别代表第k个关节的角速度、速度、角加速度、加速度、力矩以及力。
定义空间第k杆的惯性质量矩阵为:
其中Ik为连杆k相对于第k关节坐标系的惯性张量矩阵,mk为连杆k的质量,为连杆k的质心向量的反对称矩阵,E是三维单位矩阵。定义关节k的状态转换矩阵为H(k)=[hT(k) 0 0 0],其中h(k)为关节的转动轴向量,是三维列向量,当第k个自由度为移动副时,H(k)=[0 0 0 hT(k)],当有固连基座时,由于基座与惯性系为虚铰链接,因此有H(n+1)=diag[1,1,1,1,1,1]。
关节速度、加速度递推式如下,其中k=n,n-1,…,1
关节力、力矩递推式如下,其中k=1,2,…,n
f(k)=φ(k,k-1)f(k-1)+M(k)α(k)+b(k)
T(k)=H(k)f(k)
其中,a(k),b(k)分别表示空间机械臂的科氏力和离心力,φ(k+1,k)为力和力矩递推算子,φT(k+1,k)为速度和加速度递推算子如以下表达式表示:
是相邻关节k+1到关节k的向量,其中定义H(k)为关节k的状态转换矩阵。
a(k),b(k)分别表示空间机械臂的科氏力和离心力,当关节为旋转铰时:
当关节为移动铰时,a(k)表示如下:
定义多自由度空间机械臂的系统速度算子为V=[V(1),...V(n-1),V(n)]T,并以同样的形式表示空间机械臂的加速度算子、科氏力算子、离心力算子、力算子、力矩算子分别为α,a,b,f,T,则可以得到:
f=φ(Mα+b)
T=Hf
其中M是空间机械臂质量矩阵算子,H是状态投影矩阵算子,φ是空间转移算子。
最终可推导得到空间机械臂力矩计算公式为:
其中:
MG=HφMφTHT
C=Hφ(MφTa+b)
MG表示空间机械臂的广义质量矩阵,C表示空间机械臂的非线性力矩阵。空间机械臂在关节空间的动力学基本方程中,D(θ)即为此处的MG,即等同于此计算公式中的C,由于在空间中重力极小,故重力项G(θ)可忽略不计。
步骤103,依据所述优化控制参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,规划得出空间机械臂的运行路径;所述运行路径即可使得所述空间机械臂关节力矩得以优化。
具体的,图4是利用本发明实施例所提出的基于粒子群算法的空间机械臂关节力矩优化算法的流程图。如图4所示,粒子群算法求解空间机械臂最小关节力矩均值和的具体步骤如下:
利用所述粒子群算法求解空间机械臂最小关节力矩均值和的具体步骤如下:
1)利用七次多项式插值法得到的控制参数a=[ai6,ai7],i=1,2,...,7,将关节空间的关节角数据描述为插值多项式函数值的离散序列;
2)设定微粒群算法中的初始变量,包括微粒数popsize、认知系数c1、社会系数c2、迭代次数max_length、微粒子速度上限Vmax、下限Vmin以及问题域中的问题值的上下限等;
3)微粒参数初始化。结合所设定的初始参数和微粒速度优化方程,利用随机函数得到微粒群中各粒子的初始位置、初始速度,并将其记录到当前位置表中;
粒子k的当前位置表示为:
Xk(T)=(a16(T),a17(T),a26(T),a27(T),a36(T)…a76(T),a77(T))
其中,k表示第k个粒子,k=1,2,...,popsize;Xk(T)为14维行向量,表示粒子k在14维空间中的当前位置;T为迭代次数,T=1,2,...,max_length;第k个粒子初始位置表示为Xk(1);ai6(T)与ai7(T)为第T次迭代后的控制参数,i=1,2,...,7;
粒子k的当前速度表示为:
Vk(T)=(v16(T),v17(T),v26(T),v27(T),v36(T)…v76(T),v77(T))
Vk(T)为14维行向量,表示粒子k在14维空间中的当前速度;其中v16(T)表示与a16(T)相对应维度的速度分量,其余维度类似,第k个粒子初始速度表示为Vk(1);
4)根据粒子当前位置计算出当前的七次多项式插值曲线,从而得到目标函数相对应的适应度值,记为f(X),f(X)是关于粒子在空间中位置的函数,用于反映粒子在空间中的位置与目标函数间的关系,记录当前个体最优位置和历史最优位置到当前个体最优表和历史最优表中;
5)计算当前迭代次数下的惯性因子ω的值,通过微粒子速度变异方程迭代计算微粒子新的当前速度,所述微粒子速度变异方程为:
Vk(T+1)=ω·Vk(T)+c1·r1·(pBestk(T)-Xk(T))+c2·r2·(gBest(T)-Xk(T))
其中,Vk(T+1)为微粒子k第T+1次迭代时速度,Vk(T)为微粒子k第T次迭代时速度,ω为当前迭代次数下的惯性因子,r1和r2为[0,1]的随机数,pbestk(T)为微粒子k迭代T次后的个体最优位置,gBestk(T)为迭代T次后整个粒子群的全局最优位置;
惯性因子ω的值由下式确定:
式中,ω1和ω2分别是惯性权重的初始值和终端值;max_length和T分别为最大迭代次数和当前迭代次数;
6)通过更新微粒子当前的速度值,进而更新微粒子的当前位置,并修改当前位置表中的位置参数;
微粒子位置更新方程为:
Xk(T+1)=Xk(T)+Vk(T+1)
其中,Xk(T+1)为微粒子k更新后的当前位置;
7)通过当前得到的控制参数(即粒子的当前位置Xk(T)),通过七次多项式方程计算得到基于当前多项式参数的关节角度、角速度和角加速度,然后利用SOA逆动力学方程计算出空间机械臂当前各关节力矩的均值和,并以此作为目标函数的当前适应度值;
8)通过当前个体适应度值修改粒子个体历史最优值表和最优位置表中的最优值和最优位置参数;
粒子k的当前最优位置由下式确定:
9)修改群体最优值表和最优位置表中的最优值和最优位置,并转到步骤(5),进行循环优化计算,直至迭代次数max_length达到设定值;
所述全局最优位置gBest(T)由下式确定:
gBest(T)=min{f(pbest1(T)),f(pbest2(T)),…,f(pbestpopsize(T))}
10)统计最优值数据,并计算整个群体的最优值及相应的最优位置,得到最优微粒子对应的位置坐标,从而计算得到最优位置对应的七次多项式插值曲线,得到空间机械臂目标函数的当前最优路径。
所述运行路径使得所述空间机械臂的关节力矩得以优化。
用于具体实施例中,以一个七自由度的空间机械臂为具体研究对象进行了数值仿真研究,该空间机械臂由七个旋转关节和两根长直臂杆连接组成,空间机械臂的结构具有对称性,其中本发明实施例中七自由度空间机械臂DH坐标系示意图如图5所示。图5中空间机械臂各杆件的长度为d1=1.2m;d2=0.53m;d3=0.53m;d4=0.52m;d5=0.53m;d6=0.53m;d7=1.2m;a3=5.8m;a4=5.8m;表一为空间机械臂D-H参数表,如下所示:
表一
连杆i | θi(°) | di(m) | ai-1(m) | αi-1(°) |
1 | θ1(0) | d1 | 0 | 90 |
2 | θ2(90) | d2 | 0 | -90 |
3 | θ3(0) | 0 | a3 | 0 |
4 | θ4(0) | d3+d4+d5 | a4 | 0 |
5 | θ5(0) | 0 | 0 | 90 |
6 | θ6(-90) | d6 | 0 | -90 |
7 | θ7(0) | d7 | 0 | 0 |
由表一可以得到空间机械臂的DH参数。此外,空间机械臂第一个关节坐标系位置相对于基座坐标系中心的坐标为rca0={0.2,0,2},姿态偏差为{0,0,0}。
表二为空间机械臂质量特性参数表,由表二可得到空间机械臂系统的惯性质量参数以及质心坐标向量参数,如下所示:
表二
所述空间机械臂在关节空间中点到点的转移任务设定如下:设定空间机械臂在运行过程中的一组初始关节角度为θint=[-20°,0,-10°,-100°,120°,180°,70°],一组期望的终止关节角度为θdes=[0,15°,-30°,-110°,140°,165°,90°],规划时间为tf=20s。
利用本发明的方法,以空间机械臂处在固定基座模式为例,以多项式系数为控制参数,结合动力学模型中计算方程,以任务中空间机械臂各关节力矩均值的和值最小为优化目标,利用粒子群算法对给定空间机械臂关节空间轨迹进行优化计算,并通过Matlab软件进行了仿真实验。给定空间机械臂负载参数以及粒子群算法中相关参数为:质量mload=400kg;惯性张量:Iload={[16,0,0],[0,137,0],[0,0,146]};粒子的速度约束Vmax=100,Vmin=0,最大迭代次数max_length=100,粒子个数popsize=30,惯性因子ω从0.8到0.2逐渐衰减,认知系数c1=0.2,社会系数c2=0.2。任务执行过程中的约束条件为:关节角度q的范围为[-180°,180°],关节角速度关节角加速度
图6是本发明实施例迭代寻优过程中种群目标均值的变化曲线示意图,如图6所示,在种群迭代更新100次以后,获得种群目标均值的变化曲线,其中横坐标轴是种群更新迭代次数,纵坐标轴是对应种群当前迭代次数的种群目标均值,由该图可以看出在种群迭代寻优过程中,种群目标均值以较快速度下降,并在迭代到30次时已经从开始时的6.9×10^4收敛到2.6×10^3,且收敛过程迅速没有波动。
图7是本发明实施例迭代寻优过程中空间机械臂关节力矩均值和的变化曲线示意图,如图7所示,在种群迭代更新100次以后,获得迭代寻优过程中空间机械臂关节力矩均值和值的变化曲线,其中横坐标轴是种群更新迭代次数,纵坐标轴是对应种群当前迭代次数的空间机械臂关节力矩均值和,由该图可以看出在种群迭代寻优过程中,空间机械臂各关节力矩均值的和值以较快速度下降,并在迭代到30次时已经从开始时的1.1×10^3收敛到4.4×10^2,且收敛过程迅速没有波动,由该图可以说明利用本方法使得所述空间机械臂的关节力矩达到了比较好的优化效果。
综上所述,本发明实施例具有以下有益效果:
本发明实施例的技术方案中,利用七次多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数,将空间机械臂各关节力矩均值的和值最小作为粒子群算法求解过程中的目标函数,依据所述优化控制参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,从而获得使空间机械臂各关节力矩均值的和值最小的运行路径,因此能够使空间机械臂在完成任务的前提下使得各关节力矩均值的和值得以降低,从而降低空间机械臂任务执行所需的能耗,同时可以减轻空间机械臂的机构磨损,延缓因关节应力过大导致的机械结构性能衰减速率。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明保护的范围之内。
Claims (4)
1.一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法,其特征在于,所述方法步骤包括:
(1)将空间机械臂操作空间中点到点的转移任务从笛卡尔空间转换至关节空间,利用七次多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数;
(2)将空间机械臂各关节力矩均值和最小作为粒子群算法优化求解过程中的目标函数;
(3)依据所述优化控制参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,规划得出空间机械臂当前所能达到的关节力矩均值和最小的运行路径;所述运行路径即可使得所述空间机械臂关节力矩的均值和得以减小。
2.根据权利要求1所述的方法,其特征在于,利用七次多项式插值法对空间机械臂关节变量进行参数化处理,获得粒子群算法的优化控制参数,包括:利用七次多项式插值方法对各个关节进行插值遍历,基于七次多项式插值法得出空间机械臂关节角表达式,再利用空间机械臂执行点到点的转移任务时初始、终止状态的关节角度、角速度、角加速度约束条件将七次多项式系数用某几个参数表示,所获得的参数即为粒子群算法的优化控制参数;
基于七次多项式插值法获得的空间机械臂关节角的表达式为:
θ(t)=ai7t7+ai6t6+ai5t5+ai4t4+ai3t3+ai2t2+ai1t+ai0
其中,θ表示关节角序列,为n维列向量,ai0,ai1,...ai7为七次多项式系数,i=1,2,...,7表示第i个关节,t表示时间;
利用空间机械臂执行点到点的转移任务时的初始、终止关节角度、角速度、角加速度约束条件建立关节角约束方程为:
qint=θint
qdes=θdes
其中qint,分别为空间机械臂关节角表达式所描述的所述空间机械臂执行点到点的转移任务时的初始关节角度,角速度以及角加速度;qdes, 分别为空间机械臂关节角表达式所描述的所述空间机械臂执行点到点的转移任务时的终止关节角度、角速度以及角加速度;θint,θdes是任务给定的初始及终止的关节角度;
将ai6和ai7选为粒子群算法的优化控制参数,对空间机械臂关节角进行七次多项式插值,所得到的8个多项式系数均可以通过ai6和ai7两个未知参数表示,具体表示如下:
ai0=θint
ai1=ai2=0
。
3.根据权利要求1所述的方法,其特征在于,将空间机械臂各关节力矩均值和最小作为粒子群算法求解过程中的目标函数,具体说明如下:空间机械臂各关节力矩的数值能够间接反映其在主运动任务执行过程中的辅助性能,以空间机械臂各关节力矩均值和作为其操作空间中点到点转移任务下的辅助性能指标,即为利用粒子群算法求解过程中的目标函数;
所述粒子群算法求解过程中的目标函数为:
其中,i=1,2,...,7表示空间机械臂的第i个关节,Z为空间机械臂在任务执行 过程中所有关节力矩的均值和,为空间机械臂的第i个关节在任务执行过程中力矩的均值;
所述空间机械臂第i个关节力矩的均值为:
其中,τi为空间机械臂的关节力矩矢量τ=(τ1,τ2,…,τn)T中的第i个分量,tf为规划时间;
所述关节力矩矢量τ可由空间机械臂在关节空间的动力学基本方程求得,所述空间机械臂在关节空间的动力学基本方程如下:
式中,θ表示关节角序列,为n维列向量;D(θ)∈Rn×n为其关节空间中惯性矩阵;为其哥氏力和离心力矢量矩阵;G(θ)∈Rn×1为其重力项;τ=(τ1,τ2,…,τn)T为其关节力矩矢量。
4.根据权利要求2所述的方法,其特征在于,依据所述优化控制参数以及所述目标函数,利用粒子群算法的寻优原理对空间机械臂运行轨迹进行优化求解,获得使空间机械臂各关节力矩得以优化的运行路径,包括:根据空间机械臂轨迹的任务要求,利用粒子群优化算法,以空间机械臂各关节力矩均值和最小为优化性能指标,以空间机械臂关节插值多项式的未知系数ai6和ai7为控制参数展开优化计算;
利用所述粒子群算法求解空间机械臂各关节力矩最小的均值和的具体步骤如下:
1)利用七次多项式插值法得到的控制参数a=[ai6,ai7],i=1,2,...,7,将关节空间的关节角数据描述为插值多项式函数值的离散序列;
2)设定微粒群算法中的初始变量,包括微粒数popsize、认知系数c1、社会 系数c2、迭代次数max_length、微粒子速度上限Vmax、微粒子速度下限Vmin以及问题域中的问题值的上下限;
3)微粒参数初始化;结合所设定的初始参数和微粒速度优化方程,利用随机函数得到微粒群中各粒子的初始位置、初始速度,并将其记录到当前位置表中;
粒子k的当前位置表示为:
Xk(T)=(a16(T),a17(T),a26(T),a27(T),a36(T)…a76(T),a77(T))
其中,k表示第k个粒子,k=1,2,...,popsize;Xk(T)为14维行向量,表示粒子k在14维空间中的当前位置;T为迭代次数,T=1,2,...,max_length;第k个粒子初始位置表示为Xk(1);ai6(T)与ai7(T)为第T次迭代后的控制参数,i=1,2,...,7;
粒子k的当前速度表示为:
Vk(T)=(v16(T),v17(T),v26(T),v27(T),v36(T)…v76(T),v77(T))
Vk(T)为14维行向量,表示粒子k在14维空间中的当前速度;其中v16(T)表示与a16(T)相对应维度的速度分量,其余维度类似,第k个粒子初始速度表示为Vk(1);
4)根据粒子当前位置计算出当前的七次多项式插值曲线,从而得到目标函数相对应的适应度值,记为f(X),f(X)是关于粒子在空间中位置的函数,用于反映粒子在空间中的位置与目标函数间的关系,记录当前个体最优位置和历史最优位置到当前个体最优表和历史最优表中;
5)计算当前迭代次数下的惯性因子ω的值,通过微粒子速度变异方程迭代计算微粒子新的当前速度,所述微粒子速度变异方程为:
Vk(T+1)=ω·Vk(T)+c1·r1·(pBestk(T)-Xk(T))+c2·r2·(gBest(T)-Xk(T))
其中,Vk(T+1)为微粒子k第T+1次迭代时速度,Vk(T)为微粒子k第T次迭代时速度,ω为当前迭代次数下的惯性因子,r1和r2为[0,1]的随机数,pbestk(T)为微粒子k迭代T次后的个体最优位置,gBestk(T)为迭代T次后整个粒子群的全局最优位置;
惯性因子ω的值由下式确定:
式中,ω1和ω2分别是惯性权重的初始值和终端值;max_length和T分别为最大迭代次数和当前迭代次数;
6)通过更新微粒子当前的速度值,进而更新微粒子的当前位置,并修改当前位置表中的位置参数;
微粒子位置更新方程为:
Xk(T+1)=Xk(T)+Vk(T+1)
其中,Xk(T+1)为微粒子k更新后的当前位置;
7)利用粒子的当前位置Xk(T),通过七次多项式方程计算得到基于当前多项式参数的关节角度、角速度和角加速度,然后利用SOA逆动力学方程计算出空间机械臂当前各关节力矩的均值和,并以此作为目标函数的当前适应度值;
8)通过当前个体适应度值修改粒子个体历史最优值表和最优位置表中的最优值和最优位置参数;
粒子k的当前最优位置由下式确定:
9)修改群体最优值表和最优位置表中的最优值和最优位置,并转到步骤(5),进行循环优化计算,直至迭代次数max_length达到设定值;
所述全局最优位置gBest(T)由下式确定:
gBest(T)=min{f(pbest1(T)),f(pbest2(T)),…,f(pbestpopsize(T))}
10)统计最优值数据,并计算整个群体的最优值及相应的最优位置,得到最优微粒子对应的位置坐标,从而计算得到最优位置对应的七次多项式插值曲线,得到空间机械臂目标函数的当前最优路径;
所述运行路径即为所述空间机械臂关节力矩经优化后的路径,这能够使空间机械臂在完成任务的前提下使得各关节力矩均值和得到降低。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510653873.7A CN105159096B (zh) | 2015-10-10 | 2015-10-10 | 一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510653873.7A CN105159096B (zh) | 2015-10-10 | 2015-10-10 | 一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105159096A CN105159096A (zh) | 2015-12-16 |
CN105159096B true CN105159096B (zh) | 2017-08-29 |
Family
ID=54799984
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510653873.7A Active CN105159096B (zh) | 2015-10-10 | 2015-10-10 | 一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105159096B (zh) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105676636B (zh) * | 2016-01-11 | 2018-12-07 | 北京邮电大学 | 一种基于nsga-ii算法的冗余度空间机械臂多目标优化方法 |
CN105717869B (zh) * | 2016-03-15 | 2018-05-29 | 珞石(北京)科技有限公司 | 工业机器人操作空间路径复合限制求解方法 |
CN105676898B (zh) * | 2016-03-21 | 2018-10-09 | 北京控制工程研究所 | 一种基于关节位置控制器的机器人末端力控制方法 |
CN106682682A (zh) * | 2016-10-20 | 2017-05-17 | 北京工业大学 | 一种基于粒子群优化算法对支持向量机的优化方法 |
CN106363633A (zh) * | 2016-11-11 | 2017-02-01 | 航天科工智能机器人有限责任公司 | 基于改良粒子群算法的机器人稳定步态规划方法和装置 |
CN106647282B (zh) * | 2017-01-19 | 2020-01-03 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
CN108068113B (zh) * | 2017-11-13 | 2020-06-12 | 苏州大学 | 7-dof仿人臂飞行物体作业最小加速度轨迹优化 |
CN108742840B (zh) * | 2018-04-10 | 2020-07-17 | 北京理工大学 | 机器人的标定方法和装置 |
CN108656117B (zh) * | 2018-05-21 | 2021-04-16 | 武汉理工大学 | 一种多约束条件下最优时间的机械臂空间轨迹优化方法 |
CN109108963B (zh) * | 2018-07-24 | 2020-10-16 | 西北工业大学 | 基于差分演化粒子群算法空间多关节机器人路径规划方法 |
CN109343345B (zh) * | 2018-09-28 | 2021-12-03 | 江南大学 | 基于qpso算法的机械臂多项式插值轨迹规划方法 |
CN110464470B (zh) * | 2019-09-10 | 2021-07-09 | 深圳市精锋医疗科技有限公司 | 手术机器人及其臂体的控制方法、控制装置 |
CN111053613B (zh) * | 2019-12-10 | 2020-10-13 | 联博智能科技有限公司 | 一种运动追踪方法、装置、机械臂及计算机可读存储介质 |
CN112068586B (zh) * | 2020-08-04 | 2021-08-13 | 西安交通大学 | 一种空间时间联合优化的四旋翼无人飞行器轨迹规划方法 |
CN111985144B (zh) * | 2020-09-27 | 2023-07-18 | 江西师范大学 | 一种地学数据多参数协同优化的idw插值方法 |
CN113033065B (zh) * | 2021-04-02 | 2023-06-09 | 南京理工大学 | 一种两关节绳驱连续型机械臂逆运动学求解方法 |
CN114670190B (zh) * | 2022-03-08 | 2023-10-24 | 西北工业大学 | 一种基于解析数值混合法的冗余机械臂逆运动学方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104020665A (zh) * | 2014-06-25 | 2014-09-03 | 北京邮电大学 | 基于多目标粒子群算法的机械臂最小跃度轨迹优化方法 |
CN104076685A (zh) * | 2014-05-20 | 2014-10-01 | 大连大学 | 一种减少基座姿态扰动的空间机械臂路径规划方法 |
CN104526695A (zh) * | 2014-12-01 | 2015-04-22 | 北京邮电大学 | 一种最小化基座碰撞扰动的空间机械臂轨迹规划方法 |
CN104965517A (zh) * | 2015-07-07 | 2015-10-07 | 张耀伦 | 一种机器人笛卡尔空间轨迹的规划方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7974737B2 (en) * | 2006-10-31 | 2011-07-05 | GM Global Technology Operations LLC | Apparatus and method of automated manufacturing |
US20110153080A1 (en) * | 2009-12-22 | 2011-06-23 | Siemens Product Lifecycle Management Software Inc. | Method and apparatus for industrial robotic pathscycle time optimization using fly by |
US9731419B2 (en) * | 2010-08-03 | 2017-08-15 | Praxair S.T. Technology, Inc. | System and method for programming robots |
-
2015
- 2015-10-10 CN CN201510653873.7A patent/CN105159096B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104076685A (zh) * | 2014-05-20 | 2014-10-01 | 大连大学 | 一种减少基座姿态扰动的空间机械臂路径规划方法 |
CN104020665A (zh) * | 2014-06-25 | 2014-09-03 | 北京邮电大学 | 基于多目标粒子群算法的机械臂最小跃度轨迹优化方法 |
CN104526695A (zh) * | 2014-12-01 | 2015-04-22 | 北京邮电大学 | 一种最小化基座碰撞扰动的空间机械臂轨迹规划方法 |
CN104965517A (zh) * | 2015-07-07 | 2015-10-07 | 张耀伦 | 一种机器人笛卡尔空间轨迹的规划方法 |
Non-Patent Citations (3)
Title |
---|
9-DOF 超冗余机器人轨迹规划优化算法;贾庆轩等;《北京邮电大学学报》;20080430;第31卷(第2期);第20-25页 * |
基于多项式插值的自由漂浮空间机器人轨迹规划粒子群优化算法;石忠等;《宇航学报》;20110731;第32卷(第7期);第1516-1521页 * |
基于量子粒子群优化算法的空间机器人非完整笛卡尔路径规划;史也等;《机械工程学报》;20111231;第47卷(第23期);第65-73页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105159096A (zh) | 2015-12-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105159096B (zh) | 一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 | |
CN111538949B (zh) | 冗余机器人逆运动学求解方法、装置和冗余机器人 | |
CN105676636B (zh) | 一种基于nsga-ii算法的冗余度空间机械臂多目标优化方法 | |
Li et al. | Path planning of mobile robot based on improved genetic algorithm | |
CN106393116B (zh) | 具有初态学习的机械臂分数阶迭代学习控制方法及系统 | |
Wen et al. | Elman fuzzy adaptive control for obstacle avoidance of mobile robots using hybrid force/position incorporation | |
CN109676610B (zh) | 一种断路器装配机器人及其实现工作轨迹优化的方法 | |
Li et al. | A hybrid assembly sequence planning approach based on discrete particle swarm optimization and evolutionary direction operation | |
CN110877333A (zh) | 一种柔性关节机械臂控制方法 | |
Suh et al. | Tangent space RRT: A randomized planning algorithm on constraint manifolds | |
CN108068113A (zh) | 7-dof仿人臂飞行物体作业最小加速度轨迹优化 | |
CN107263483B (zh) | 二自由度关节机器人轨迹的协调控制方法 | |
CN107633105B (zh) | 一种基于改进混合蛙跳算法的四旋翼无人机参数辨识方法 | |
Mohammed et al. | Design optimal PID controller for quad rotor system | |
CN113319857A (zh) | 机械臂力位混合控制方法、装置、电子设备及存储介质 | |
CN109582030A (zh) | 一种调整无人机姿态控制中待整定参数方法及相关装置 | |
CN107529498A (zh) | 一种空间机器人抓捕非合作目标的方法 | |
CN111482969A (zh) | 一种基于bas算法的六自由度偏置机器人逆解方法 | |
CN111123943A (zh) | 一种基于伪逆约束的超冗余机器人轨迹规划方法及系统 | |
CN107511830B (zh) | 一种五自由度混联机器人控制器参数自适应调整实现方法 | |
CN113219825A (zh) | 一种四足机器人单腿轨迹跟踪控制方法及系统 | |
Panda et al. | Model reduction of linear systems by conventional and evolutionary techniques | |
Zhang et al. | Time-optimal trajectory planning of dulcimer music robot based on PSO algorithm | |
CN113434982B (zh) | 一种电力智能仿生攀爬机器人的运动学逆解方法 | |
Han et al. | Integral backstepping based computed torque control for a 6 DOF arm robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |