CN108858198A - 一种基于模拟退火遗传算法的机械臂路径规划方法 - Google Patents
一种基于模拟退火遗传算法的机械臂路径规划方法 Download PDFInfo
- Publication number
- CN108858198A CN108858198A CN201810837871.7A CN201810837871A CN108858198A CN 108858198 A CN108858198 A CN 108858198A CN 201810837871 A CN201810837871 A CN 201810837871A CN 108858198 A CN108858198 A CN 108858198A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- simulated annealing
- pedestal
- genetic
- joint
- 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)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Numerical Control (AREA)
Abstract
一种基于模拟退火遗传算法的机械臂路径规划方法,包括以下步骤:步骤1:采用拉格朗日方法对空间六自由度机械臂进行位置级、速度级运动学和动力学建模;步骤2:针对机械臂末端极短时间内的碰撞对基座产生的扰动以及机械臂各关节角的约束,建立机械臂轨迹的优化适应度函数;步骤3:采用五阶多项式对机械臂路径进行拟合,利用模拟退火遗传算法求解最佳的轨迹,以满足较好的适应度函数。本发明针对机械臂抓捕任务中,保证基座扰动最小化以及各关节角约束情况下,通过模拟退火遗传算法求取最优解,提高了收敛速度以及求解精度。
Description
技术领域
本发明涉及空间机械臂领域,特别涉及一种基于模拟退火遗传算法的机械臂路径规划方法。
背景技术
轨迹规划是空间机器人研究的重要方向。为了完成给定的任务,机械臂各关节及末端需要按照一定的轨迹运行。由于维数较大,在采取轨迹优化算法方面较为困难,经常会过早收敛,或者在接近最优时搜索效率极低。针对这些问题,本发明提出一种模拟退火遗传算法,对空间六自由度机械臂进行轨迹规划。
发明内容
本发明的目的在于提供一种基于模拟退火遗传算法的机械臂路径规划方法,以解决上述问题。
为实现上述目的,本发明采用以下技术方案:
一种基于模拟退火遗传算法的机械臂路径规划方法,包括以下步骤:
步骤1:采用拉格朗日方法对空间六自由度机械臂进行位置级、速度级运动学和动力学建模;
步骤2:针对机械臂末端极短时间碰撞模型为瞬时内的碰撞对基座产生的扰动以及机械臂各关节角的约束,建立机械臂轨迹的优化适应度函数;
步骤3:采用五阶多项式对机械臂路径进行拟合,利用模拟退火遗传算法求解最佳的轨迹,以满足较好的适应度函数。
进一步的,步骤1中,拉格朗日法建立空间六自由度机械臂模型;
位置级运动学方程:
为第i个连杆相对于基坐标系位姿的齐次变换矩阵,为第i个连杆相对于第i-1个连杆位姿的齐次变换矩阵,固定在末端连杆上的坐标系为n;
速度级运动学方程:
表示空间机械臂末端在惯性系下的线速度和角速度,Jb表示基座速度与机械臂末端速度之间的雅可比矩阵,表示基座在惯性系下的线速度和角速度,Jm表示关节角速度与机械臂末端速度之间的雅可比矩阵,表示关节角速度;
动力学方程:
H为表示基座惯量和基座与机械臂耦合惯量的矩阵,cb、cm分别为基座和机械臂运动有关的非线性力项,Fb、Fe分别为基座和机械臂末端执行器上的外作用力和力矩,τm为机械臂各关节外力矩。
进一步的,步骤2中,适应度函数建立;
碰撞冲量方程:
e为材料复原系数,v1、v2分别为机械臂末端和目标物在碰撞点的速度,N为碰撞点的法向向量,D1、D2分别为机械臂和目标的雅可比惯性矩阵;由上可得基座姿态扰动表达式:
δwb=f(θ,N,vr)
为使关节角限定在给定的范围内,设计如下:
αi为每个关节角的权重,θi max、θi min为第i个关节角期望的上下限;
综合上述条件,可得适应度函数:
k1、k2分别为两项的权重。
进一步的,步骤3中,机械臂轨迹规划;
采用五阶多项式差值算法对机械臂轨迹进行描述:假设某一关节在开始时刻t0=0的关节角度为θ0,在终止时刻tf的关节角度为θf,满足此条件的光滑轨迹用θ(t)表示,a0...a5为多项式差值系数。
θ(t)=a0+a1t+a2t2+...+a5t5
五次多项式的一阶导函数、二阶导函数分别作为关节速度、加速度的时间函数在起始点和终止点的约束条件分别为:
可以解出:
进一步的,步骤3中,模拟退火遗传算法求解;
根据上述条件针对上述机械臂末端轨迹表达式,对机械臂末端,设计如下算法:
选取群体大小为500,选取编码方式为实数编码,交叉概率pc取0.7,变异概率pm取0.02。
a.随机生成初始种群p0,包含M个个体;
b.计算每个个体的适应度值;
c.将上一代优良个体进行遗传到下一代个体中;
d.将上一代个体随机交配成对,并进行交叉交换染色体;
e.将上一代个体进行变异改变一个或几个基因;
f.在上一代染色体体α的邻域中随机产生新染色体β,α和β竞争进入下一代种群的方法采取Metropolis准则函数进行判别,令Δf=fit(α)-fit(β),如果Δf≤0,则把β直接复制进下一代种群:否则产生[0,1]的随机数r,如果把β直接复制进下一代种群:否则将α复制进下一代种群;
g.反复上述操作,选取适应度最高的个体最为最优解。
与现有技术相比,本发明有以下技术效果:
本发明针对机械臂抓捕任务中,保证基座扰动最小化以及各关节角约束情况下,通过模拟退火遗传算法求取最优解,提高了收敛速度以及求解精度。本发明针对机械臂抓捕任务中,由于维数较大,在采取轨迹优化算法方面较为困难,经常会过早收敛,或者在接近最优时搜索效率极低等问题,考虑到传统的简单遗传算法在搜索全局最优问题中容易出现的早熟现象,对遗传算法加以改进,引入模拟退火算法,在遗传算法每次迭代后对新一代种群进行模拟退火操作,采用Metropolis准则进行判别选取最优个体,有利于算法跳出局部最优。
附图说明
图1为关节角优化轨迹。
具体实施方式
以下结合附图对本发明进一步说明:
请参阅图1,一种基于模拟退火遗传算法的机械臂路径规划方法,包括以下步骤:
步骤1:采用拉格朗日方法对空间六自由度机械臂进行位置级、速度级运动学和动力学建模;
步骤2:针对机械臂末端极短时间碰撞模型为瞬时内的碰撞对基座产生的扰动以及机械臂各关节角的约束,建立机械臂轨迹的优化适应度函数;
步骤3:采用五阶多项式对机械臂路径进行拟合,利用模拟退火遗传算法求解最佳的轨迹,以满足较好的适应度函数。
步骤1中,拉格朗日法建立空间六自由度机械臂模型;
位置级运动学方程:
为第i个连杆相对于基坐标系位姿的齐次变换矩阵,为第i个连杆相对于第i-1个连杆位姿的齐次变换矩阵,固定在末端连杆上的坐标系为n;
速度级运动学方程:
表示空间机械臂末端在惯性系下的线速度和角速度,Jb表示基座速度与机械臂末端速度之间的雅可比矩阵,表示基座在惯性系下的线速度和角速度,Jm表示关节角速度与机械臂末端速度之间的雅可比矩阵,表示关节角速度;
动力学方程:
H为表示基座惯量和基座与机械臂耦合惯量的矩阵,cb、cm分别为基座和机械臂运动有关的非线性力项,Fb、Fe分别为基座和机械臂末端执行器上的外作用力和力矩,τm为机械臂各关节外力矩。
步骤2中,适应度函数建立;
碰撞冲量方程:
e为材料复原系数,v1、v2分别为机械臂末端和目标物在碰撞点的速度,N为碰撞点的法向向量,D1、D2分别为机械臂和目标的雅可比惯性矩阵;由上可得基座姿态扰动表达式:
δwb=f(θ,N,vr)
为使关节角限定在给定的范围内,设计如下:
αi为每个关节角的权重,θi max、θi min为第i个关节角期望的上下限;
综合上述条件,可得适应度函数:
k1、k2分别为两项的权重。
步骤3中,机械臂轨迹规划;
采用五阶多项式差值算法对机械臂轨迹进行描述:假设某一关节在开始时刻t0=0的关节角度为θ0,在终止时刻tf的关节角度为θf,满足此条件的光滑轨迹用θ(t)表示,a0...a5为多项式差值系数。
θ(t)=a0+a1t+a2t2+...+a5t5
五次多项式的一阶导函数、二阶导函数分别作为关节速度、加速度的时间函数在起始点和终止点的约束条件分别为:
可以解出:
步骤3中,模拟退火遗传算法求解;
根据上述条件针对上述机械臂末端轨迹表达式,对机械臂末端,设计如下算法:
选取群体大小为500,选取编码方式为实数编码,交叉概率pc取0.7,变异概率pm取0.02。
a.随机生成初始种群p0,包含M个个体;
b.计算每个个体的适应度值;
c.将上一代优良个体进行遗传到下一代个体中;
d.将上一代个体随机交配成对,并进行交叉交换染色体;
e.将上一代个体进行变异改变一个或几个基因;
f.在上一代染色体体α的邻域中随机产生新染色体β,α和β竞争进入下一代种群的方法采取Metropolis准则函数进行判别,令Δf=fit(α)-fit(β),如果Δf≤0,则把β直接复制进下一代种群:否则产生[0,1]的随机数r,如果把β直接复制进下一代种群:否则将α复制进下一代种群;
g.反复上述操作,选取适应度最高的个体最为最优解。
表1:六自由度机械臂DH参数
Claims (5)
1.一种基于模拟退火遗传算法的机械臂路径规划方法,其特征在于,包括以下步骤:
步骤1:采用拉格朗日方法对空间六自由度机械臂进行位置级、速度级运动学和动力学建模;
步骤2:针对机械臂末端极短时间碰撞模型为瞬时内的碰撞对基座产生的扰动以及机械臂各关节角的约束,建立机械臂轨迹的优化适应度函数;
步骤3:采用五阶多项式对机械臂路径进行拟合,利用模拟退火遗传算法求解最佳的轨迹,以满足适应度函数。
2.根据权利要求1所述的一种基于模拟退火遗传算法的机械臂路径规划方法,其特征在于,步骤1中,拉格朗日法建立空间六自由度机械臂模型;
位置级运动学方程:
为第i个连杆相对于基坐标系位姿的齐次变换矩阵,为第i个连杆相对于第i-1个连杆位姿的齐次变换矩阵,固定在末端连杆上的坐标系为n;
速度级运动学方程:
表示空间机械臂末端在惯性系下的线速度和角速度,Jb表示基座速度与机械臂末端速度之间的雅可比矩阵,表示基座在惯性系下的线速度和角速度,Jm表示关节角速度与机械臂末端速度之间的雅可比矩阵,表示关节角速度;
动力学方程:
H为表示基座惯量和基座与机械臂耦合惯量的矩阵,cb、cm分别为基座和机械臂运动有关的非线性力项,Fb、Fe分别为基座和机械臂末端执行器上的外作用力和力矩,τm为机械臂各关节外力矩。
3.根据权利要求1所述的一种基于模拟退火遗传算法的机械臂路径规划方法,其特征在于,步骤2中,适应度函数建立;
碰撞冲量方程:
e为材料复原系数,v1、v2分别为机械臂末端和目标物在碰撞点的速度,N为碰撞点的法向向量,D1、D2分别为机械臂和目标的雅可比惯性矩阵;由上得基座姿态扰动表达式:
δwb=f(θ,N,vr)
为使关节角限定在给定的范围内,设计如下:
αi为每个关节角的权重,θimax、θimin为第i个关节角期望的上下限;
综合上述条件,可得适应度函数:
k1、k2分别为两项的权重。
4.根据权利要求1所述的一种基于模拟退火遗传算法的机械臂路径规划方法,其特征在于,步骤3中,机械臂轨迹规划;
采用五阶多项式差值算法对机械臂轨迹进行描述:假设某一关节在开始时刻t0=0的关节角度为θ0,在终止时刻tf的关节角度为θf,满足此条件的光滑轨迹用θ(t)表示,a0...a5为多项式差值系数;
θ(t)=a0+a1t+a2t2+...+a5t5
五次多项式的一阶导函数、二阶导函数分别作为关节速度、加速度的时间函数在起始点和终止点的约束条件分别为:
解出:
5.根据权利要求4所述的一种基于模拟退火遗传算法的机械臂路径规划方法,其特征在于,步骤3中,模拟退火遗传算法求解;
根据针对上述机械臂末端轨迹表达式,对机械臂末端,设计如下算法:
选取群体大小为500,选取编码方式为实数编码,交叉概率pc取0.7,变异概率pm取0.02;
a.随机生成初始种群p0,包含M个个体;
b.计算每个个体的适应度值;
c.将上一代优良个体进行遗传到下一代个体中;
d.将上一代个体随机交配成对,并进行交叉交换染色体;
e.将上一代个体进行变异改变一个或几个基因;
f.在上一代染色体体α的邻域中随机产生新染色体β,α和β竞争进入下一代种群的方法采取Metropolis准则函数进行判别,令Δf=fit(α)-fit(β),如果Δf≤0,则把β直接复制进下一代种群:否则产生[0,1]的随机数r,如果把β直接复制进下一代种群:否则将α复制进下一代种群;
g.反复上述操作,选取适应度最高的个体最为最优解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810837871.7A CN108858198A (zh) | 2018-07-26 | 2018-07-26 | 一种基于模拟退火遗传算法的机械臂路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810837871.7A CN108858198A (zh) | 2018-07-26 | 2018-07-26 | 一种基于模拟退火遗传算法的机械臂路径规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108858198A true CN108858198A (zh) | 2018-11-23 |
Family
ID=64305952
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810837871.7A Pending CN108858198A (zh) | 2018-07-26 | 2018-07-26 | 一种基于模拟退火遗传算法的机械臂路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108858198A (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109857110A (zh) * | 2019-02-13 | 2019-06-07 | 广州视源电子科技股份有限公司 | 运动规划方法、装置、设备及计算机可读存储介质 |
CN110147566A (zh) * | 2019-04-02 | 2019-08-20 | 阜阳师范学院 | 基于遗传算法与非线性规划对高温防护服的研究方法 |
CN110385718A (zh) * | 2019-06-24 | 2019-10-29 | 中国科学院合肥物质科学研究院 | 一种六自由度治疗床的运动控制方法 |
CN111152212A (zh) * | 2019-12-05 | 2020-05-15 | 北京蒂斯科技有限公司 | 一种基于功率最优的机械臂移动轨迹规划方法及装置 |
CN112847351A (zh) * | 2020-12-31 | 2021-05-28 | 重庆电子工程职业学院 | 一种基于指数趋近率的并联机器人轨迹跟踪控制方法 |
CN113407895A (zh) * | 2021-06-29 | 2021-09-17 | 广东电网有限责任公司 | 基于模拟退火算法的闪光驱鸟最优频率选择方法及*** |
CN114237238A (zh) * | 2021-12-08 | 2022-03-25 | 扬州大学 | 一种自主导航的智能投料饲喂机器人及其投料饲喂方法 |
CN114265364A (zh) * | 2021-12-21 | 2022-04-01 | 江苏师范大学 | 一种工业物联网的监测数据处理***及方法 |
CN115741688A (zh) * | 2022-11-15 | 2023-03-07 | 福州大学 | 基于改进遗传算法的六自由度机械臂轨迹优化方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2009028187A1 (ja) * | 2007-08-30 | 2009-03-05 | Ntn Corporation | 転がり軸受の設計システムおよび設計方法 |
CN101408979A (zh) * | 2008-11-18 | 2009-04-15 | 上海理工大学 | 基于遗传算法的人体颌面骨ct图像数字化处理方法 |
CN104526695A (zh) * | 2014-12-01 | 2015-04-22 | 北京邮电大学 | 一种最小化基座碰撞扰动的空间机械臂轨迹规划方法 |
CN105138000A (zh) * | 2015-08-06 | 2015-12-09 | 大连大学 | 最优化基座位姿扰动的七自由度空间机械臂轨迹规划方法 |
CN106527132A (zh) * | 2016-11-10 | 2017-03-22 | 华南理工大学 | 基于遗传模拟退火算法的蛇形机器人运动控制方法 |
-
2018
- 2018-07-26 CN CN201810837871.7A patent/CN108858198A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2009028187A1 (ja) * | 2007-08-30 | 2009-03-05 | Ntn Corporation | 転がり軸受の設計システムおよび設計方法 |
CN101408979A (zh) * | 2008-11-18 | 2009-04-15 | 上海理工大学 | 基于遗传算法的人体颌面骨ct图像数字化处理方法 |
CN104526695A (zh) * | 2014-12-01 | 2015-04-22 | 北京邮电大学 | 一种最小化基座碰撞扰动的空间机械臂轨迹规划方法 |
CN105138000A (zh) * | 2015-08-06 | 2015-12-09 | 大连大学 | 最优化基座位姿扰动的七自由度空间机械臂轨迹规划方法 |
CN106527132A (zh) * | 2016-11-10 | 2017-03-22 | 华南理工大学 | 基于遗传模拟退火算法的蛇形机器人运动控制方法 |
Non-Patent Citations (3)
Title |
---|
宗玉杰 等: "模拟退火遗传算法在机械臂路径规划中的应用", 《测控技术》 * |
张龙: "空间机械臂在轨捕获碰撞动力学及控制研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
闫磊: "拟人机器人参数化逆运动学及在轨装配协调规划研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109857110A (zh) * | 2019-02-13 | 2019-06-07 | 广州视源电子科技股份有限公司 | 运动规划方法、装置、设备及计算机可读存储介质 |
CN110147566A (zh) * | 2019-04-02 | 2019-08-20 | 阜阳师范学院 | 基于遗传算法与非线性规划对高温防护服的研究方法 |
CN110147566B (zh) * | 2019-04-02 | 2022-12-20 | 阜阳师范学院 | 基于遗传算法与非线性规划对高温防护服的研究方法 |
CN110385718B (zh) * | 2019-06-24 | 2022-05-17 | 中国科学院合肥物质科学研究院 | 一种六自由度治疗床的运动控制方法 |
CN110385718A (zh) * | 2019-06-24 | 2019-10-29 | 中国科学院合肥物质科学研究院 | 一种六自由度治疗床的运动控制方法 |
CN111152212A (zh) * | 2019-12-05 | 2020-05-15 | 北京蒂斯科技有限公司 | 一种基于功率最优的机械臂移动轨迹规划方法及装置 |
CN111152212B (zh) * | 2019-12-05 | 2021-01-22 | 北京蒂斯科技有限公司 | 一种基于功率最优的机械臂移动轨迹规划方法及装置 |
CN112847351A (zh) * | 2020-12-31 | 2021-05-28 | 重庆电子工程职业学院 | 一种基于指数趋近率的并联机器人轨迹跟踪控制方法 |
CN113407895A (zh) * | 2021-06-29 | 2021-09-17 | 广东电网有限责任公司 | 基于模拟退火算法的闪光驱鸟最优频率选择方法及*** |
CN114237238A (zh) * | 2021-12-08 | 2022-03-25 | 扬州大学 | 一种自主导航的智能投料饲喂机器人及其投料饲喂方法 |
CN114237238B (zh) * | 2021-12-08 | 2023-11-28 | 扬州大学 | 一种自主导航的智能投料饲喂机器人及其投料饲喂方法 |
CN114265364A (zh) * | 2021-12-21 | 2022-04-01 | 江苏师范大学 | 一种工业物联网的监测数据处理***及方法 |
CN114265364B (zh) * | 2021-12-21 | 2023-10-03 | 江苏师范大学 | 一种工业物联网的监测数据处理***及方法 |
CN115741688A (zh) * | 2022-11-15 | 2023-03-07 | 福州大学 | 基于改进遗传算法的六自由度机械臂轨迹优化方法 |
CN115741688B (zh) * | 2022-11-15 | 2024-06-14 | 福州大学 | 基于改进遗传算法的六自由度机械臂轨迹优化方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108858198A (zh) | 一种基于模拟退火遗传算法的机械臂路径规划方法 | |
CN111168675B (zh) | 一种家用服务机器人的机械臂动态避障运动规划方法 | |
JP6807949B2 (ja) | 干渉回避装置 | |
CN106444738B (zh) | 基于动态运动基元学习模型的移动机器人路径规划方法 | |
CN105676642B (zh) | 一种六自由度机器人工位布局与运动时间协同优化方法 | |
CN104526695B (zh) | 一种最小化基座碰撞扰动的空间机械臂轨迹规划方法 | |
CN107199569A (zh) | 一种基于关节能量均衡分配的关节机器人轨迹规划方法 | |
CN109048892A (zh) | 一种基于q学习的机械臂末端避障方法 | |
CN108555911A (zh) | 基于虚拟推力的遥操作机械臂三维避障方法 | |
CN108748160B (zh) | 基于多种群粒子群算法的机械臂运动规划方法 | |
CN113084811A (zh) | 一种机械臂路径规划方法 | |
CN108582073A (zh) | 一种基于改进的随机路标地图法的机械臂快速避障方法 | |
CN112809665B (zh) | 一种基于改进rrt算法的机械臂运动规划方法 | |
CN112549016A (zh) | 一种机械臂运动规划方法 | |
CN115091469B (zh) | 一种基于最大熵框架的深度强化学习机械臂运动规划方法 | |
CN117103282A (zh) | 一种基于matd3算法的双臂机器人协同运动控制方法 | |
CN106842959A (zh) | 一种Nao机器人步态规划遗传算法 | |
Ji et al. | Model-based trajectory prediction and hitting velocity control for a new table tennis robot | |
CN113043278B (zh) | 一种基于改进型鲸鱼搜索方法的机械臂轨迹规划方法 | |
Raheem et al. | Heuristic D* algorithm based on particle swarm optimization for path planning of two-link robot arm in dynamic environment | |
Huang et al. | Optimal path planning for minimizing disturbance of space robot | |
Yılmaz et al. | Optimal trajectory planning by big bang-big crunch algorithm | |
Sohn et al. | Applying human motion capture to design energy-efficient trajectories for miniature humanoids | |
Huang et al. | Configuration control of space robots for impact minimization | |
CN111077887A (zh) | 一种采用领航跟随法的多机器人综合避障方法 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20181123 |