CN108908335A - 基于改进差分进化算法的机器人标定方法 - Google Patents
基于改进差分进化算法的机器人标定方法 Download PDFInfo
- Publication number
- CN108908335A CN108908335A CN201810803346.3A CN201810803346A CN108908335A CN 108908335 A CN108908335 A CN 108908335A CN 201810803346 A CN201810803346 A CN 201810803346A CN 108908335 A CN108908335 A CN 108908335A
- Authority
- CN
- China
- Prior art keywords
- robot
- differential evolution
- evolution algorithm
- improved differential
- algorithm
- 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.)
- Granted
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/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种基于改进差分进化算法的机器人标定方法,用于六自由度工业机器人几何参数标定,建立机器人运动学模型;机器人在工作空间运动,读取并记录机器人在各路点位置时的关节转角,同时利用激光跟踪仪测量并记录各路点位置机器人末端执行器的实际位置坐标;计算机器人理论位置坐标;计算各路点间理论距离与实际距离,并建立目标函数确定待辨识结构参数;以改进的差分进化算法辨识结构参数;将辨识出的结构参数误差代入验证。本发明集合模拟退火算法和种群多样性评价函数,改进了传统差分进化算法全局收敛性差的缺陷,提高了机器人结构参数误差的辨识精度和效率,同时又吸收了差分进化算法收敛速率快的特点。
Description
技术领域
本发明涉及工业机器人领域,尤其涉及一种基于改进差分进化算法的机 器人标定方法。
背景技术
工业机器人是现代制造业的一种重要自动化设备,是推动优势和战略产 业快速发展的重要领域之一。但工业机器人重复定位精度较高,而绝对定位 精度较低,制约了机器人在高精度场合的应用,限制了机器人的发展。影响 机器人绝对定位精度的因素包括参数因素、负载因素、环境因素等。其中由 于零件加工及装配过程中产生的机器人连杆实际参数与理论参数间的偏差是 导致机器人定位误差的最主要因素,大概占所有误差源的90%以上。机器人 的参数识别可分为以下4个步骤:建模、标定数据采集、辨识、验证与补偿。
机器人参数辨识算法是机器人参数辨识的关键之一。机器人最常用的标 定算法是最小二乘算法,例如高斯-牛顿算法与Levenberg-Marquardt(LM) 算法。但这些算法对初始值要求过高,限制了这些算法的使用。采用基于遗 传算法的标定方法,遗传算法有较高的收敛速率且对初始参数没有要求,但 全局收敛能力较弱,不易找到全局最优解。采用基于卡尔曼和粒子滤波器的 标定方法,但存在着辨识算法过于复杂,收敛速率较低的特点。北京航空航 天大学等采用粒子群优化算法标定机器人,该算法能有效提高辨识效率,但辨识精度有待提高。上述辨识算法无法同时满足机器人参数辨识所需的辨识 精度、辨识效率、收敛性。
发明内容
本发明的目的是提出一种基于改进差分进化算法的机器人标定方法,提 高机器人参数辨识的辨识精度、辨识效率、收敛性。
为实现上述发明目的,本发明的技术方案是:一种基于改进差分进化算 法的机器人标定方法,用于六自由度工业机器人几何参数标定,具体包括如 下步骤:
步骤一,建立机器人运动学模型;
步骤二,机器人在工作空间运动,读取并记录机器人在各路点位置时的 关节转角,同时利用激光跟踪仪测量并记录各路点位置机器人末端执行器的 实际位置坐标;
步骤三,计算机器人理论位置坐标;
步骤四,计算各路点间理论距离与实际距离,得到距离误差,并建立目 标函数确定待辨识结构参数;
步骤五,以改进的差分进化算法辨识结构参数;所述改进的差分进化算 法具体步骤如下:
初始化种群;
计算初始最优解与最优结构参数,判断是否达到标定要求;
计算种群多样性评价函数,判断是否需要二次变异;
变异操作和交叉操作;
选择操作;
终止迭代;
步骤六,将辨识出的结构参数误差代入机器人运动学模型中,以验证辨 识结果的准确性。
作为本发明优选,所述步骤五中计算种群多样性评价函数,若种群多样 性函数小于预设阙值,则表示种群多样性较低,需要二次变异;否则,不需 要二次变异。
作为本发明优选,步骤五中二次变异通过下式实现
式中,Xm为变异个体,为最优结构参数,η为符合高斯分布的随机 变量。
作为本发明优选,所述步骤五中种群多样性评价函数δ如下式
式中式中δ为种群多样性评价函数,NP为种群规模,bestcoord为随机 采样点在最优结构参数下的坐标值,icoord为该采样点在其余结构参数下的 坐标值。
作为本发明优选,所述步骤五交叉操作中交叉概率因子CR=1,保证算 法有较快的收敛速率。
本发明的有益效果是:
本发明基于改进差分进化算法的机器人标定方法,集合模拟退火算法和 种群多样性评价函数,改进了传统差分进化算法全局收敛性差的缺陷,通过 改进后的差分进化算法,提高了机器人结构参数误差的辨识精度和效率,同 时又吸收了差分进化算法收敛速率快的特点。
具体实施方式
下面将对本发明实施例中的技术方案进行清楚、完整地描述。
一种基于改进差分进化算法的机器人标定方法,用于六自由度工业机器 人几何参数标定,具体包括如下步骤:
步骤一,建立机器人运动学模型;
根据旋量理论与机器人理论结构参数建立运动学模型,具体公式如下:
其中gst(0)为机器人在零位时的位姿矩阵,对于旋转关节、运动旋量的矩 阵指数形式可表示为式中 q=[qx,qy,qz]表示机器人各旋转轴原点的位置坐标,w= [wx,wy,wz]表示各旋转轴的方向向量。因此可得到计算机器人末端 执行器理论位置坐标的函数,如下:
[rx,ry,rz]=f(θ1…θ6,w1…w6,q1…q6)
由于机械加工误差,装配误差以及机械变形的存在,会使机器人的几何 参数实际值偏离其设计的值。此时每个关节处的机器人结构参数误差可表示 为:
Δq=(Δqx,Δqy,Δqz)
Δw=(Δwx,Δwy,Δwz)
Δθ
机器人实际位置坐标r(θ)可表示为
r(θ)=f(θ1…θ6,Δw1…Δw6,Δq1…Δq6,Δθ1…Δθ6)
步骤二,机器人在工作空间运动,读取并记录机器人在各路点位置时的 关节转角θ=θ1…θ6,同时利用激光跟踪仪测量并记录各路点位置机器人末 端执行器的实际位置坐标,记为其中ak=(xk,yk,zk);
步骤三,根据机器人理论运动学模型与关节转角计算机器人理论位置坐 标,记为其中bk=(xk,yk,zk);
步骤四,计算各路点间理论距离与实际距离得到距离误差EK(ε)=Lk-lk;建立目标函数
其中x=[θ,q,w]为待辨识机器人结构参数。
步骤五,以改进的差分进化算法辨识结构参数。差分进化算法是一种高 效的全局优化算法。差分进化算法具有收敛速率快,辨识精度高的特点,但 容易陷入局部最优解而无法找到全局最优解。差分进化算法陷入局部最优是 由于种群多样性下降导致的。而模拟退火算法由于采用Metropolis接受准则, 具有较高的全局收敛能力。为解决传统差分进化算法全局收敛性差的缺陷, 本文结合模拟退火算法和种群多样性评价函数,提出了一种改进差分进化算 法,算法具体步骤如下:
(1)初始化种群
按下式初始化种群,种群规模为NP,其中i=1,2,…NP,j=1,2,…42为 待辨识参数个数,xj为机器人的理论结构参数。
xi,j=xj+rand(-1,1)
(2)计算出每个个体所对应的目标函数,作为适应度函数Fitnessi,挑 选出最适应度值BestFitness与最优结构参数目标函数计算公式如下
(3)判断最优适应度值BestFitness是否达到精度要求,若符合则退出, 不符合则进行下一步。
(4)计算种群多样性评价函数,判断是否需要二次变异
种群多样性评价函数δ如下式
式中式中δ为种群多样性评价函数,NP为种群规模,bestcoord为随机 采样点在最优结构参数下的坐标值,icoord为该采样点在其余结构参数下的 坐标值。若δ<deta,deta为预设的阈值,则表示此时种群多样性较低,算法 的搜索结果易陷入局部最优点,为保证算法的全局搜索能力则按下式对部分 随机选择的个体进行变异操作;否则不变异,直接进行下步操作。
式中,Xm为变异个体,为最优结构参数,η为符合高斯分布的随机 变量。
(5)对进行步骤(6)、(7)产生第g+1代种群。
(6)在种群中随机选择两个个体,按照下式进行变异,生成变异个体 xm;
其中为与不同的两个随机的互不相同的个体。
(7)按下式进行交叉操作,生成试验个体xT。
其中CR为交叉概率因子,CR越大有利于局部搜索与和加速收敛速度, CR越小有利于保持种群的多样性和全局搜素能力,因此差分进化算法的收敛 速率和全局搜索能力是矛盾的。本文选择CR=1,保证算法有较快的收敛速率, 缺失的全局搜索能力由二次变异和模拟退火算法来保证,以此解决收敛速率 与全局搜索能力的矛盾。
(8)按下式进行选择,生成
步骤六,将辨识出的结构参数代入机器人运动学模型中,以验证辨识结 果的准确性。
所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基 于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所 获得的所有其他实施例,都属于本发明保护的范围。
Claims (5)
1.一种基于改进差分进化算法的机器人标定方法,用于六自由度工业机器人几何参数标定,其特征在于,具体包括如下步骤:
步骤一,建立机器人运动学模型;
步骤二,机器人在工作空间运动,读取并记录机器人在各路点位置时的关节转角,同时利用激光跟踪仪测量并记录各路点位置机器人末端执行器的实际位置坐标;
步骤三,计算机器人理论位置坐标;
步骤四,计算各路点间理论距离与实际距离,得到距离误差,并建立目标函数确定待辨识结构参数;
步骤五,以改进的差分进化算法辨识结构参数;所述改进的差分进化算法具体步骤如下:
初始化种群;
计算初始最优解与最优结构参数,判断是否达到标定要求;
计算种群多样性评价函数,判断是否需要二次变异;
变异操作和交叉操作;
选择操作;
终止迭代;
步骤六,将辨识出的结构参数误差代入机器人运动学模型中,以验证辨识结果的准确性。
2.根据权利要求1所述的基于改进差分进化算法的机器人标定方法,其特征在于,所述步骤五中计算种群多样性评价函数,若种群多样性函数小于预设阙值,则表示种群多样性较低,需要二次变异;否则,不需要二次变异。
3.根据权利要求1所述的基于改进差分进化算法的机器人标定方法,其特征在于,步骤五中二次变异通过下式实现
式中,Xm为变异个体,为最优结构参数,η为符合高斯分布的随机变量。
4.根据权利要求1所述的基于改进差分进化算法的机器人标定方法,其特征在于,所述步骤五中种群多样性评价函数如下式
式中δ为种群多样性评价函数,NP为种群规模,bestcoord为随机采样点在最优结构参数下的坐标值,icoord为该采样点在其余结构参数下的坐标值。
5.根据权利要求1所述的基于改进差分进化算法的机器人标定方法,其特征在于,所述步骤五交叉操作中交叉概率因子CR=1,保证算法有较快的收敛速率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810803346.3A CN108908335B (zh) | 2018-07-20 | 2018-07-20 | 基于改进差分进化算法的机器人标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810803346.3A CN108908335B (zh) | 2018-07-20 | 2018-07-20 | 基于改进差分进化算法的机器人标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108908335A true CN108908335A (zh) | 2018-11-30 |
CN108908335B CN108908335B (zh) | 2023-03-14 |
Family
ID=64416781
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810803346.3A Active CN108908335B (zh) | 2018-07-20 | 2018-07-20 | 基于改进差分进化算法的机器人标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108908335B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110146839A (zh) * | 2019-05-30 | 2019-08-20 | 中国海洋大学 | 一种移动平台磁梯度张量***校正方法 |
CN110276101A (zh) * | 2019-05-17 | 2019-09-24 | 杭州电子科技大学 | 基于差分进化单纯形算法的关节式坐标测量机标定方法 |
CN110842914A (zh) * | 2019-10-15 | 2020-02-28 | 上海交通大学 | 基于差分进化算法的手眼标定参数辨识方法、***及介质 |
CN112277002A (zh) * | 2020-10-19 | 2021-01-29 | 南京工程学院 | 基于非完整位姿信息的机器人运动学标定装置及标定方法 |
CN112507480A (zh) * | 2020-11-25 | 2021-03-16 | 浙江同善人工智能技术有限公司 | 一种惯性参数辨识方法 |
CN114184150A (zh) * | 2021-12-10 | 2022-03-15 | 凌云科技集团有限责任公司 | 一种关节臂式坐标测量机的结构参数优化方法和装置 |
CN114521960A (zh) * | 2022-02-25 | 2022-05-24 | 苏州康多机器人有限公司 | 一种腹腔手术机器人的全自动实时标定方法、装置及*** |
CN115356986A (zh) * | 2022-08-22 | 2022-11-18 | 电子科技大学 | 一种基于Be-SA算法的工业机器人绝对定位精度提高方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102297687A (zh) * | 2011-05-13 | 2011-12-28 | 北京理工大学 | 一种电子罗盘的标定方法 |
US20150314450A1 (en) * | 2014-04-30 | 2015-11-05 | Hong Fu Jin Precision Industry (Shenzhen)Co., Ltd. | Calibration method for coordinate system of robot manipulator |
CN106881718A (zh) * | 2017-03-13 | 2017-06-23 | 哈尔滨工业大学 | 基于遗传算法的六自由度串联机器人误差标定方法 |
CN107175660A (zh) * | 2017-05-08 | 2017-09-19 | 同济大学 | 一种基于单目视觉的六自由度机器人运动学标定方法 |
CN107443375A (zh) * | 2017-07-20 | 2017-12-08 | 深圳市同川科技有限公司 | 机器人原点标定方法、装置、存储介质和计算机设备 |
CN107553493A (zh) * | 2017-09-22 | 2018-01-09 | 东南大学 | 一种基于拉绳位移传感器的机器人运动学参数标定方法 |
CN108121206A (zh) * | 2017-12-21 | 2018-06-05 | 扬州大学 | 基于高效改进型差分进化算法的复合自适应内模控制优化方法 |
CN108177145A (zh) * | 2017-12-28 | 2018-06-19 | 北京航空航天大学 | 一种无偏最优的工业机械臂绝对定位精度标定方法 |
CN108214476A (zh) * | 2017-12-28 | 2018-06-29 | 北京航空航天大学 | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 |
-
2018
- 2018-07-20 CN CN201810803346.3A patent/CN108908335B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102297687A (zh) * | 2011-05-13 | 2011-12-28 | 北京理工大学 | 一种电子罗盘的标定方法 |
US20150314450A1 (en) * | 2014-04-30 | 2015-11-05 | Hong Fu Jin Precision Industry (Shenzhen)Co., Ltd. | Calibration method for coordinate system of robot manipulator |
CN106881718A (zh) * | 2017-03-13 | 2017-06-23 | 哈尔滨工业大学 | 基于遗传算法的六自由度串联机器人误差标定方法 |
CN107175660A (zh) * | 2017-05-08 | 2017-09-19 | 同济大学 | 一种基于单目视觉的六自由度机器人运动学标定方法 |
CN107443375A (zh) * | 2017-07-20 | 2017-12-08 | 深圳市同川科技有限公司 | 机器人原点标定方法、装置、存储介质和计算机设备 |
CN107553493A (zh) * | 2017-09-22 | 2018-01-09 | 东南大学 | 一种基于拉绳位移传感器的机器人运动学参数标定方法 |
CN108121206A (zh) * | 2017-12-21 | 2018-06-05 | 扬州大学 | 基于高效改进型差分进化算法的复合自适应内模控制优化方法 |
CN108177145A (zh) * | 2017-12-28 | 2018-06-19 | 北京航空航天大学 | 一种无偏最优的工业机械臂绝对定位精度标定方法 |
CN108214476A (zh) * | 2017-12-28 | 2018-06-29 | 北京航空航天大学 | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110276101A (zh) * | 2019-05-17 | 2019-09-24 | 杭州电子科技大学 | 基于差分进化单纯形算法的关节式坐标测量机标定方法 |
CN110276101B (zh) * | 2019-05-17 | 2022-11-15 | 杭州电子科技大学 | 基于差分进化单纯形算法的关节式坐标测量机标定方法 |
CN110146839A (zh) * | 2019-05-30 | 2019-08-20 | 中国海洋大学 | 一种移动平台磁梯度张量***校正方法 |
CN110842914A (zh) * | 2019-10-15 | 2020-02-28 | 上海交通大学 | 基于差分进化算法的手眼标定参数辨识方法、***及介质 |
CN110842914B (zh) * | 2019-10-15 | 2022-09-23 | 上海交通大学 | 基于差分进化算法的手眼标定参数辨识方法、***及介质 |
CN112277002A (zh) * | 2020-10-19 | 2021-01-29 | 南京工程学院 | 基于非完整位姿信息的机器人运动学标定装置及标定方法 |
CN112277002B (zh) * | 2020-10-19 | 2021-11-02 | 南京工程学院 | 基于非完整位姿信息的机器人运动学标定装置及标定方法 |
CN112507480A (zh) * | 2020-11-25 | 2021-03-16 | 浙江同善人工智能技术有限公司 | 一种惯性参数辨识方法 |
CN112507480B (zh) * | 2020-11-25 | 2024-06-07 | 浙江同善人工智能技术有限公司 | 一种惯性参数辨识方法 |
CN114184150A (zh) * | 2021-12-10 | 2022-03-15 | 凌云科技集团有限责任公司 | 一种关节臂式坐标测量机的结构参数优化方法和装置 |
CN114521960A (zh) * | 2022-02-25 | 2022-05-24 | 苏州康多机器人有限公司 | 一种腹腔手术机器人的全自动实时标定方法、装置及*** |
CN115356986A (zh) * | 2022-08-22 | 2022-11-18 | 电子科技大学 | 一种基于Be-SA算法的工业机器人绝对定位精度提高方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108908335B (zh) | 2023-03-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108908335A (zh) | 基于改进差分进化算法的机器人标定方法 | |
CN111531547B (zh) | 一种基于视觉测量的机器人标定及检测方法 | |
CN102706277B (zh) | 一种基于全方位点约束的工业机器人在线零位标定装置及方法 | |
CN106881718B (zh) | 基于遗传算法的六自由度串联机器人误差标定方法 | |
CN109242912A (zh) | 采集装置外参标定方法、电子设备、存储介质 | |
TWI517101B (zh) | 三維掃描器校正系統及其校正方法 | |
CN106052556A (zh) | 一种基于激光追踪仪多站位测量的三坐标测量机空域坐标修正方法 | |
CN108177145A (zh) | 一种无偏最优的工业机械臂绝对定位精度标定方法 | |
CN102607552A (zh) | 基于神经网络的工业机器人空间网格精度补偿方法 | |
CN109493389B (zh) | 一种基于深度学习的相机标定方法及*** | |
CN111595238B (zh) | 一种基于多站法的激光跟踪仪精度现场评价*** | |
CN109458994B (zh) | 一种空间非合作目标激光点云icp位姿匹配正确性判别方法及*** | |
CN110375649B (zh) | 一种柔性臂坐标测量机的圆光栅偏心参数标定方法 | |
CN108876862B (zh) | 一种非合作目标点云位置姿态计算方法 | |
CN108458710B (zh) | 位姿测量方法 | |
CN111687845B (zh) | 一种基于惯性测量单元的机械臂运动学参数标定方法 | |
CN111609847B (zh) | 一种面向薄板件的机器人拍照测量***自动规划方法 | |
CN112361958A (zh) | 一种线激光与机械臂标定方法 | |
CN115311371A (zh) | 一种双机器人自动测量划线***标定方法 | |
CN110345867A (zh) | 一种基于反距离权重法修正cmm空间任意点坐标误差的方法 | |
CN113510748B (zh) | 基于双目视觉的机器人空间位置重复性和准确度测量方法 | |
Nieves et al. | Laser beam multi-position alignment approach for an automated industrial robot calibration | |
CN115307547A (zh) | 一种激光跟踪仪结合视觉***的组网测试方法 | |
CN103310106B (zh) | 一种零件孔系作用尺寸的计算方法 | |
CN108592838B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |