第 28 卷第 9 期
2011 年 9 月
计 算 机 应 用 研 究
Application Research of Computers
基 于 AGA 的 时 间 最 优 机 械 臂 轨 迹 规 划 算 法
付 荣, 居鹤华
(北京工业大学 电子信息与控制工程学院, 北京 100124)
Vol.28 No.9
Sep.2011
倡
FU Rong, JU He唱hua
虑关节速度和加速度等约束条件下运用遗传算法对各分段轨
摘 要: 根据机械臂运动学约束,提出了关节空间基于自适应遗传算法(AGA)的 3唱5唱3 多项式插值轨迹规划算
法。 利用运动学约束,以最优时间为目标,针对关节型机器人在静态环境下点到点的轨迹规划问题,利用 AGA
算法解算多项式插值的时间。 通过与基于 GA 的3唱5唱3 多项式机械臂轨迹规划进化曲线和运动位置、速度、加速
度曲线对比,证明该方法在算法收敛、运行平稳度上都有突出优点。
关键词: 机械臂; 轨迹规划; 时间最优; 自适应遗传算法; 多项式插值
中图分类号: TP242畅2 文献标志码: A 文章编号: 1001唱3695(2011)09唱3275唱04
doi:10.3969/j.issn.1001唱3695.2011.09.019
Time唱optimal trajectory planning algorithm based on AGA for manipulator
(College of Electronic Information & Control Engineering, Beijing University of Technology, Beijing 100124, China)
Abstract: According to the velocity limitation of manipulator, proposed a time唱optimal 3唱5唱3 polynomial interpolation trajec唱
tory planning algorithm based on adaptive genetic algorithm (AGA).To plan the point唱to唱point trajectories for manipulator
working in a static environment for time唱optimal, used AGA to get the time of polynomial interpolation.The simulation results
show that the algorithm has good performance on time唱optimal and stability compared with 3唱5唱3 polynomial interpolation traj唱
ectory planning algorithm based on simple genetic algorithm.
Key words: manipulator; trajectory planning; time唱optimal; adaptive genetic algorithm(AGA); polynomial interpolation
遗传算法是模拟生物在自然环境中的遗传和进化过程而
形成的一种全局优化概率搜索算法。 其搜索不依赖于梯度信
息,尤其适用于处理传统搜索方法难于解决的复杂和非线性问
题,所需的领域知识少,具有很强的鲁棒性。 传统的遗传算法
由于使用固定的交叉概率 Pc 和变异概率 Pm,存在无法兼顾算
法的收敛速度和全局最优的问题。 对自适应遗传算法,国内外
已有很多学者进行了研究。 Srinivas 等人
算法能够在优化过程中自适应地改变 Pc 和 Pm 值,在种群趋向
于最优时,增大 Pc 和 Pm 值,而在种群离散于解空间时,减小
Pc 和 Pm 值,便能达到全局最优和快速收敛的效果。 刘智明等
[2]
了余弦改进形式的自适应遗传算子。 喻寿益等人
式模糊自适应遗传算法,在一定程度上改善了自适应遗传算法
的不足。
多项式插值函数计算简单,唱常用于机械臂轨迹规划。 分
段多项式插值函数中,满足轨迹位置、速度、加速度连续且多项
式次数最低的分段多项式组合为三次样条插值为 3唱3唱3唱3唱3
插值、3 段3唱5唱3 多项式插值和 4唱3唱4 多项式插值。 恽为民等
将遗传算法优化引入动力学模型,提出了最小时间的机
[5]
(1)
器人轨迹优化方法。 将甘亚辉等人
(2)
优轨迹规划,利用遗传算法方法优化4唱4唱…唱4唱5 多项式规划
(3)
运行轨迹实现机械臂避障功能。 其对象为简单的平面关节机
未知系数 aj1i、aj2i、aj3i为第 j 个关节轨迹第一段、第二段、第
械臂,且多项式插值系数高,计算量大。 张勇等人
三段插值函数的第 i 个系数,hj1(t)、hj2(t)、hj3(t)分别代表第 j
自适应遗传算法优化三次样条插值的并联机械臂轨迹规划,考
收稿日期: 2011唱03唱03; 修 回 日 期: 2011唱04唱23 基 金 项 目: 国 家“863” 计 划 资 助 项 目(2008AA0085); 国 家 自 然 科 学 基 金 资 助 项 目
(60975065)
作者简介:付荣(1986唱),女,北京怀柔人,硕士,主要研究方向为机械 臂轨迹规划(gigglefurong@yahoo.com.cn);居鹤华(1969唱),男,教授,博
士,主要研究方向为机器人自主运动控制.
迹时间间隔进行了优化。 但三次样条插值不能使加速度连续。
提出了基于 IAGA 的机械手时间最优轨迹规划,
但该方法没有与多项式插值结合,虽然改进的自适应方法可以
改善遗传算法的收敛效果,但是机械臂的运行效果并不理想。
综合考虑计算量和高次多项式带来的不稳定性,本文根据
三自由度机械臂运动学约束,提出了关节空间基于自适应遗传
算法(AGA)的3唱5唱3 多项式插值轨迹规划算法。 针对B2 型月
实验,基于 GA 的 3唱5唱3 多项式机械臂轨迹规划收敛速度、运
动位置、速度、加速度曲线对比,证明该方法在以上性能方面有
突出优点。
1 3唱5唱3 样条插值函数的构造
一般来说,样条曲线是在插值点具有 k -1 阶导数连续性
的 k 次多项式。 对于多项式样条函数,一阶导数代表速度的连
续性,二阶导数代表加速度的连续性,三阶导数代表脉动。
hj2(t) =aj25 t5 +aj24 t4 +aj23 t3 +aj22 t2 +aj21t1 +aj20
hj3(t) =aj33 t3 +aj32t2 +aj31 t1 +aj30 j =1,2,3,4,n
提出基于排序的改进自适应遗传算法。 石山等人
[4]
[3]
球车上驱动相机盒运动的六自由度正交解耦机械臂进行仿真
3唱5唱3 样条多项式的通式为
hj1(t) =aj13 t3 +aj12 t2 +aj11 t1 +aj10
[1]
提出的自适应遗传
人
人
周小燕等人
[8]
研究
提出嵌套
[6]
提出多机器人系统的最
[7]
提出利用
计 算 机 应 用 研 究
置是笛卡尔系下机械臂运动的空间坐标通过逆运动学解算得
·6723·
段关节的第一段三次多项式轨迹、第二段五次多项式轨迹和第
三段三次多项式轨迹,n 表示关节个数。 Tj、Jj、Aj、Vj、Xj 表示第
j 段关节插值的时间、脉动、加速度、速度和位置。 Xj 表示的位
出的关节角度。 已知条件为第 j 个关节各段的初始点 Xj0、路径
点 Xj1和 Xj2、末端点 Xj3 以及初始点和终点的加速度、速度 Aj0、
Aj3、Vj0、Vj3(一般取为0)。 路径点之间的速度与加速度连续。 根
据以上条件,推导出求解未知系数 aji 与插值点的关系式(4)唱
(7)。 式(4)中的 t1、t2、t3 表示第 j 段关节的3 段多项式插值的
时间。 式(6)即是系数 aji的解。
0
0
0 -2
t22
t32
3t22
2t2
2
6t2
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0 -2
t23
t33
3t23
2t3
6t3
2
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0 -1
0
t3
1
0
0
0
0
0
0
0
0
0
0
0
0
0 -1
0
0
1
0
0
0
0
0
1
0
0 -1
0
0
1
0
0
0
0
0
0
0
0
0
1
0
0
0
0 -1
0
0
t42
t2
4t32
1
12t22
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
a =ivn(A) ×b
b =[0 0 0 0 0 0 Xj3 0 0 Xj0 0 0 Xj2 Xj1]T (5)
(6)
0
0
0
t52
5t42
20t32
0
0
0
0
0
0
0
0
t31
3t21
6t1
0
0
0
0
0
0
0
0
0
0
0
t21
2t1
2
0
0
0
0
0
0
0
0
1
0
0
a =[aj13 aj12 aj11 aj10 aj25 aj24 aj23 aj22
t1
1
0
0
0
0
0
0
0
0
1
0
0
0
1
0
0
0
0
0
0
0
0
1
0
0
0
0
A =
(4)
aj21 aj20 aj33 aj32 aj31 aj30] T
(7)
t,k) =uk +vk -uk
t
fit(t) =-f(t)
第 28 卷
(11)
具体步骤如下:
a)初始化种群。 对第 j 个关节的三段插值函数时间的搜
索空间中分别随机产生 M 个 l 位二进制串基因码组成的种群,
构成种群 POPt1、POPt2、POTt3。 假设 xi
t 是 ml 维的行向量,表
示第 t 代的第 i 个个体。 其中,i∈{1,2,…,M}。 每个个体用 l
位二进制表示。 个体 xi
t 的第 k 个长度为 l 的二进制编码串转
换为实数的解码函数 Γ为
Γ(xi
×2 n -1)
n =1xl(kl +n)
(12)
2 l -1 ( ∑l
其中:vk、uk 分别表示为第 k 个实数范围的上限和下限。 随机
产生基因码的值,并计算相应的实数。
b)根据产生的 M 组 3唱5唱3 多项式插值时间组合,代入式
(4)(7),求解出 aji的系数矩阵 a。
c)将系数矩阵 a 代入式(1)(3)求解出三段多项式。 多项
式对时间求导,得到三段多项式的速度函数。 判断多项式的最
大速度是否符合式(9)。
d)适应度函数的构建有两个任务:首先使机械臂运动速
度收敛到运动学约束内;然后使各段插值时间尽量减小。 对
c)的计算结果采用两个适应度函数切换的开关控制,即如果
三段中的任一速度函数不符合式(9),该段的目标函数为|v(j,
i)|。 如果三段的速度全部满足式(9) 的约束,则目标函数切
换为 min (tji),以减小每段关节运行时间为优化目标进行迭
代。 其中 j 为 M 组种群的第 j 组,i 为多项式插值的段数,取值
范围是1、2、3。 如果有的个体不满足其运动学约束,在下一步
中,该个体被淘汰的几率会增加。
e)自适应遗传操作:
(a)选择。 一般遗传算法中采用的选择方式为轮盘赌选
择机制,其最大的缺点是容易导致进化过程中出现过早收敛和
停滞。 为了解决这个问题,AGA 采用优胜劣汰选择策略。 将
适应度函数按升序排列,每次随机地从种群中挑选一定数目的
个体,并将其中最好的选做父个体。
(b)交叉和变异。 通过计算种群的平均适应度 favg 与种群
最优适应度 fmax之间的关系来判别遗传算法是否收敛于最优:
当最优解的适应度与平均适应度接近,即|fmax -favg|变小时,种
群收敛于最优解的可能性大于种群发散在解空间的可能性;反
之亦然。 Pc 和 Pm 值依赖于|fmax -favg |的变化,当整个种群趋
于收敛时,增大 Pc 和 Pm 值,反之减小。 为了得到好的效果,
既要避免算法收敛于局部最优,也要防止优良基因受到破坏,
因此适应度较优的个体应有较小的 Pc 和 Pm 值,而适应度较劣
[8]。 这样提高了群体中表现优
的个体应有较大的 Pc 和 Pm 值
良的个体的交叉率和变异率,使它们不会处于一种近似停滞不
前的状态。 自适应交叉率和变异率为
[9]:
Pc = Pc1 -(Pc1 -Pc2)(f ′-favg)
fmax -favg
Pm = Pm1 -(Pm1 -Pm2)(fmax -f)
f ′≥favg
Pc1 f ′≥favg
f≥favg
Pm1 f≥favg
(14)
其中:f′
是要交叉的两个个体中较大的适应度值,f 为要变异个
体的适应度值。 为了保证每一代的优良个体不被破坏,采用精
英选择策略,选择适应度最优的个体,直接复制到下一代中。
上式中 Pc1 =0.9,Pc2 =0.4,Pm1 =0.1,Pm2 =0.01。
f)构成新的 M ×3 种群 POPt1、POPt2、POPt3。
fmax -favg
(13)
2 时间最优问题求解
式(4)(7)对3唱5唱3 多项式未知系数的解算是以每段多项
式插值时间已知为基础的。 如何选择最优的时间,使机械臂在
最短的时间内完成运动且满足速度约束,是本文研究的主要内
容。 优化目标是满足运动学约束的所有关节的运动时间最短。
其函数为
(8)
函数为
j =0tj1 +tj2 +tj3
f(t) =min∑n
max{ |Vj3 |}≤Vmax
j =1,2,3,4,n
s.t.max{ |Vj1 |}≤Vmax,max{ |Vj2 |}≤Vmax
f(t) =min(tj1 +tj2 +tj3)
(9)
式(8)中:Vj1、Vj2、Vj3 是第 j 个关节每段多项式随时间变化的速
度。 对机械臂每个关节单独进行优化。 第 j 个关节优化目标
(10)
3唱5唱3 多项式插值函数应用粒子群算法,如何选择自变量
id是关键问题。 式(4)(7) 中
以确定因变量 xk
时间 t1、t2、t3 是待优化的未知量,系数 aji 也是待求解的未知
数。 如果把未知系数 aji当做自变量,t1、t2、t3 当做因变量,待优
化的变量维数为14,计算量大且复杂。 本文直接在待优化时
间 t1、t2、t3 的搜索空间里优化,搜索维数降低为3 维,避免了推
导复杂的映射关系。 t1、t2、t3 是未知量,其搜索空间需要根据
经验设定在尽可能大的范围。 为了使关节运动速度尽快收敛
到约束内,采用两种适应度函数的开关控制。 在满足运动学约
束后,进行时间最优的自适应遗传算法优化迭代。
id,并选择出最佳 xk
适应度函数取目标函数的负数为
付 荣,等:基于 AGA 的时间最优机械臂轨迹规划算法
间的最大值,以确保满足运动学约束。
第 9 期
g)满足终止条件则算法结束,否则转 b)。
h)完成所有关节的时间优化。 每段时间取各关节该段时
t1 =max{tj1};t2 =max{tj2};t3 =max{tj3} j =1,2,3,4,n
遗传算法需要循环迭代。 本文研究的遗传算法是在优化
目标的搜索空间内搜索,在计算式(4)时,如果迭代步数很大,
易造成矩阵不满秩,这影响了该方法在复杂目标优化的应用,
所以在每一步迭代过程中,都要检验新产生种群是否有实数值
为0 的个体。 如果有,则要重新随机产生该个体的值。
3 仿真与实验结果
本文研究 B2 型月球车上驱动相机盒运动的六自由度正
交解耦机械臂,整体结构如图1 所示。 机械臂腕心位置即相机
盒位置。 关节1 ~3 旋转方向两两正交,解耦于控制相机盒定
向的关节4 ~6,如图2 所示。
·7723·
个体。 二进制解码为实数的上下限02.55 s。 遗传算法迭代时
间为50 步。 关节允许的最大运动速度是 Vmax =3 m/s。 初始
和终点的速度与加速度都是0。
采用基于 GA 的3唱5唱3 多项式插值算法,确定每段插值的
最优时间。 交叉率和变异率分别为0.8 和0.01。 图46 是遗传
算法迭代中某个个体的进化过程。 三个关节每段插值都收敛
到一个实数。 为了确保收敛迅速,在交叉和变异过程中保留一
组适应度函数最小值的个体作为下一代父类中的一个个体。
可以看出由于变异的存在,在收敛过程中结果会有突变。 根据
步骤 h),得到关节插值时间为 t1 =0.61,t2 =1.60,t3 =0.69。
根据该插值时间,得到关节的运动位置、速度和加速度的变化
曲线如图79 所示。
运动学建模采用标准 D唱H 坐标系法,如图2 所示。 为了
研究其位置控制,实验仿真只针对前三个关节。 驱动位置控制
的前三个关节 D唱H 参数如表1 所示。
关节
1
2
3
θ
θ1
θ2
θ3
表 1 D唱H 参数表
cos α sin α
α
0
0
1
0
0
90闭
90闭
0
1
a
L1
0
0
d
0
L2
L3
[10]。
期工作中完成
采用欧几里德范数可以求解出机械臂位置控制和方向控
制的各关节角度的逆运动学解析解。 其逆运动学推导已在前
如图3 所示,在笛卡尔系下给定机械臂末端的轨迹插值
点。 由逆运动学将各空间位置插值点转换为关节空间的角度
插值点。
第一关节至第三关节的初始位置、路径点和终点所对应的
角度如表2 所示。
表 2 各关节的角度插值点
类别
X0
X1
X2
X3
节点 1
.569
1
.532
1
1
.351
.131
1
关节位置 x
节点 2
.761
-0
.978
-0
-1
.511
.140
-2
节点 3
.731
0
.525
0
0
.713
.896
0
每个关节三段插值都有100 个二进制字符串长度为 8 的
根据步骤 a)h),图1012 是自适应遗传算法迭代中某个个
体的进化过程。 根据步骤 h),得到关节插值时间为 t1 =0.39,
t2 =1.25,t3 =1.25。 根据该插值时间,得到关节的运动位置、
速度和加速度的变化曲线如图1315 所示。
从个体进化图的对比看出,自适应遗传算法比基本遗传算
法收敛速度快。 针对第二关节插值时间的进化图6 和图12 的
对比,证明其收敛效果好。 虽然得到的每段插值的结果比遗传
算法进化结果相差无几(0.01 s) 可以忽略,但是图 15 显示的
速度曲线没有达到速度约束极值,比普通遗传算法节省能耗,
增加了运行的稳定性。
4 结束语
本文以六自由度解耦机械手臂位置控制(三关节机械臂)
为例,根据机械臂运动学的速度约束,提出了在关节空间中基
于自适应遗传算法的时间最优的3唱5唱3 多项式插值轨迹规划
方法。
·8723·
计 算 机 应 用 研 究
第 28 卷
Pc 和 Pm 参数的选择对遗传算法的寻优性能影响很大。
普通遗传算法在进化过程中采用固定的 Pc、Pm 值使收敛速度
慢,容易陷入早熟收敛;自适应遗传算法根据适应度的分散程
度自适应改变 Pc、Pm,明显改善了遗传算法的搜索性能。 本文
核心是利用自适应遗传算法优化多项式插值时间,通过与普通
遗传算法进化过程作对比,可以看出自适应遗传算法比普通遗
传算法提高了收敛速度,并使后者减少趋于局域最优解的情
况。 实验证明,两个算法虽然在优化上都使在满足运动学约束
的条件下性能达到优化,但自适应遗传算法的优化不仅避免了
遗传算法存在的收敛速度慢和早熟收敛等问题,还减小了机械
臂运动能耗,增加了运行平稳性。
参考文献:
[1]
SRINIVAS M, PATNA IK L M.Adaptive probabilities of crossover
and mutation in genetic algorithm[J].IEEE Trans on Systems,
Man and Cybernetics,1994,24(4):656唱667.
[2] 刘智明,贺新.基于排序的改进自适应遗传算法[J].信息与控制,
2004,33(1):6唱8.
[3] 石山,励庆孚,王兴华.基于自适应遗传算法的无刷直流电机的优
化设计[J].西安交通大学学报,2002,36(12):1215唱1218.
[4] 喻寿益, 邝 溯 琼.嵌 套 式 模 糊 自 适 应 遗 传 算 法[J].控 制 工 程,
2010,17(1):75唱79.
[5] 恽为民,戴先中,席裕庚.基于遗传算法的多机器人关节空间最优
运动规划[J].机器人,1997,17(4):206唱217.
[6] 甘亚辉,戴先中.基于遗传算法的多机器人系统的最优轨迹规划
[J].控制理论与应用,2010,27(9):1245唱1251.
[7] 张勇,张宪民,胡峻峰,等.高速并联机械手最优时间轨迹规划及
实现[J].机电工程技术,2010,39(10):42唱45.
[8] 周小燕,高峰,鲍官军,等.基 于 IAGA 的 机 械 手 时 间 最 优 轨 迹 规
划[J].机电工程,2009,26(8):1唱3.
[9] 王小平,曹立明.遗传算法理论应用与软件实现[M].西安:西安
交通大学出版社,2002:1唱101.
[10] 付荣,居鹤华.高精度解耦六自由度机械臂逆运动学解法[J].计
算机测量与控制,2010,18(7):1637唱1640.
[11] 刘超,欧杰,曹祺.基 于 自 适 应 遗 传 算 法 的 航 迹 规 划 研 究[J].飞
行力学,2010,28(1):36唱39.
本文根据多起重机共直流母线节能系统的结构及组成特
( 上接第 3274 页)
5 结束语
点,构建了系统形式化模型及等效电路;利用混杂系统理论,逐
一建立等效电路中各单元电路模型,进而得到系统整体模型。
仿真研究了系统直流母线的功率和电压,验证了所建模型的合
理性,提出了通过协调调度起重机状态提高节能效果,保证系
统可靠运行的新方法,为更好地开展多起重机协调调度节能控
制算法的研究提供了仿真模型。
参考文献:
[1] 王万新.公共直流母线在交流传动中的应用[J].电气传动,2002,
32(5):57唱58.
[2] 王云飞,杨耕.通用变频器—感应起重机系统的起重机耗能型制
动控制方法[J].电工技术学报, 2006,21(1):87唱92.
[3] 刘永峰,谢 吉 华.变 频 器 回 馈 制 动 研 究[J].变 频 器 世 界,2008
(8):52唱54.
[4] GOEBEL R, SANFELICE R G, TEEL A R.Hybrid dynamical sys唱
tems[J].IEEE Control Systems Magazine,2009(4): 28唱93.
[5] 侯媛彬, 李倩.基于 Petri 网分解技术的自动化物流系统建模分
析[J].计算机应用研究, 2010,27(11):4133唱4135.
2004,16(3):375唱380.
真[J].系统仿真学报,2008,20(10):2740唱2745.
策略[J].计算机应用研究, 2010,27(9):3290唱3293.
[J].系统仿真学报,2010,22(4):833唱836.
制[J].动力工程,2009,29(4):369唱375.
真[J].系统仿真学报,2007,19(15):3546唱3549.
计算机应用研究, 2010,27(1):196唱199.
21(3):76唱81.
[6] 薛乐,廖 沫, 魏 晨,等.混 合 系 统 及 其 建 模[J].系 统 仿 真 学 报,
[7] 田晓丹,罗飞,许玉格.基于细胞自动机的电梯混合系统建模及仿
[8] 赵小翠, 罗飞, 许玉格.混合电梯群控系统建模及新型优化调度
[9] 秦琳琳, 石 春, 吴 刚.基 于 混 杂 系 统 的 温 室 天 窗 温 度 系 统 建 模
[10] 徐大平, 高峰, 吕跃刚.基于混杂系统的风力发电机组建模与控
[11] 张悦,王东风,韩璞,等.一类混杂系统的推广自动机模型及其仿
[12] 张萌, 高德远, 樊 晓 桠.基 于 混 合 自 动 机 的 PSL 模 型 研 究[J].
[13] 林健.三阶段法与活动周期图[J].北京航空航天大学学报,1995,
[14] 王维平.离散事件系统建模与仿真[M].北京:科学出版社,2007.
[15] PAUL R J.Activity cycle diagrams and the three phase method[C] //
Proc of the 25th Conference on Winter Simulation.1993:123唱131.
[16] MARTINEZ J C.EZStrobe唱general唱purpose simulation system based
on activity cycle diagrams[C] //Proc of Winter Simulation Conference
Proceedings.2001: 1556唱1564.
[17] De LARA A F W, HIRATA C M.Translating activity cycle diagrams
to Java simulation programs[C] //Proc of the 37th IEEE Annual Sym唱
posium on Simulation.2004:157唱164.