[go: up one dir, main page]

CN108908327B - 一种机器人定位误差分级补偿方法 - Google Patents

一种机器人定位误差分级补偿方法 Download PDF

Info

Publication number
CN108908327B
CN108908327B CN201810376116.3A CN201810376116A CN108908327B CN 108908327 B CN108908327 B CN 108908327B CN 201810376116 A CN201810376116 A CN 201810376116A CN 108908327 B CN108908327 B CN 108908327B
Authority
CN
China
Prior art keywords
robot
error
model
pose
kinematic
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
Application number
CN201810376116.3A
Other languages
English (en)
Other versions
CN108908327A (zh
Inventor
石章虎
田威
孟华林
郑法颖
曾德标
张霖
何晓煦
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Chengdu Aircraft Industrial Group Co Ltd
Original Assignee
Chengdu Aircraft Industrial Group Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Chengdu Aircraft Industrial Group Co Ltd filed Critical Chengdu Aircraft Industrial Group Co Ltd
Priority to CN201810376116.3A priority Critical patent/CN108908327B/zh
Publication of CN108908327A publication Critical patent/CN108908327A/zh
Application granted granted Critical
Publication of CN108908327B publication Critical patent/CN108908327B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1692Calibration of manipulator

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开一种机器人定位误差分级补偿方法,包括以下步骤:计算补偿前末端位姿误差;建立运动学模型和运动学误差模型;计算各运动学参数误差最优解和修正后的运动学模型和修正的运动学模型下末端位姿;计算定位误差补偿后输入给的补偿量;计算实际到达位姿,得到经过参数标定之后的残余误差;建立残余误差估计模型,进行期望目标点的补偿;预测定位误差;预测的期望目标点残余误差;计算输入给的补偿量;计算末端实际到达位姿,补偿完成。本发明能够有效的提高工业的绝对定位精度;采用基于空间相似性的残余误差模型,能够体现定位误差在空间中表现出的各向异性。

Description

一种机器人定位误差分级补偿方法
技术领域
本发明涉及自动钻铆技术领域,具体的说,是一种机器人定位误差分级补偿方法。
背景技术
新兴的机器人技术的发展使得机器人可作为一种高质量高效率的平台,配以末端执行器、柔性工装、检测感知等子系统,构成各种不同的机器人柔性自动化系统。在新兴技术支持下,工业机器人逐渐向高精度领域方向拓展,作业任务向高效精密作业发展。因此为实现航空工业的更高质量、更高效率、更高柔性的制造装配技术要求,工业机器人的绝对定位精度的提高成为了亟待解决的技术难题。实际上,对于重复定位精度在0.1mm左右的没有任何精度补偿措施的重载机器人系统,其绝对定位精度一般在1~2mm左右,显然不能满足航空制造领域大型部件自动钻铆的精度要求,因此使用机器人精度补偿技术,提高工业机器人的绝对定位精度对于工业机器人在航空制造领域的应用是十分必要的。
当前为了实现机器人高精度控制,主要存在两种方法:离线标定前馈控制方法和在线检测反馈控制方法。其中反馈控制技术又包括关节反馈控制技术和末端反馈控制技术。曲巍葳等提出的末端反馈控制技术其实质是在机器人末端增加空间6D传感器并利用激光跟踪仪全闭环反馈控制,实时检测机器人的末端位姿实现机器人的高精度控制,显著提高机器人的点位运动的绝对定位精度。但由于其方法对于加工开敞性较差的场合,激光跟踪仪容易断光,在工业现场不易实施。美国Electroimpact公司为了提高机器人的定位精度,在各关节处增加光栅尺,整体利用西门子840D数控系统重新开发机器人控制系统。但是这种方法整体改造机器人控制系统任务量大较为繁琐,并且该方法主要依赖光栅尺的标定精度。日本FANUC为了实现高精度制孔铆接,通过将机器视觉iRVision技术集成到机器人控制器中,利用iRVision相机检测空间位姿并调整机器人的运动。上述的在线检测反馈控制方法都存在设备成本昂贵,并且高度依赖外部的检测设备,增加了末端执行器或者机器人关节的复杂程度,对于工业现场环境有更高的要求。因此大部分机器人精度补偿技术研究都集中在机器人运动学标定方面离线标定前馈控制方法,主要分为基于运动学模型的标定方法和无运动学模型的标定方法;具体包括以下方法:
1、将机器人的工作空间划分为一个个网格,在每个网格中进行机器人运动学参数标定,得到该网格下的一组参数误差,然后根据期望目标位姿选取其所在网格的参数误差进行前馈补偿。这种方法虽然能够达到较好的补偿效果,但是存在前期的机器人运动学参数标定任务量大的弊端。
2、使用激光跟踪仪测量拟合出机器人各关节转轴及所需各几何特征,并据此建立更贴合实际的机器人运动学模型。这种方法受到外界环境的影响因素大,从而拟合出的关节转轴存在一定的误差。
3、采用径向基函数神经网络(Radial Basis Function Network)对DR06工业机器人的几何误差和非几何误差进行了识别,将机器人的最大定位误差由5.8mm减小至1.8mm。采用神经网络进行机器人运动学参数的缺点在于其求得的最优解往往是局部极值,导致识别精度较低。
4、对于工作空间内划分的网格中的一待补偿点,采用网格的顶点所对应的定位误差进行反距离加权插值,估计待补偿点的定位误差。该方法计算过程简单,不需要建立复杂的误差模型,但是当待补偿点的姿态变化较大时,使用该方法的估计误差可能会较大。
发明内容
本发明的目的在于提供一种机器人定位误差分级补偿方法,有效地补偿机器人的残余误差,经过分级补偿后将机器人误差减小到0.3mm,显著提高机器人的绝对定位精度。
本发明通过下述技术方案实现:一种机器人定位误差分级补偿方法,具体包括以下步骤:
步骤S1:在待补偿区域内随机选取m个采样点的理论位姿Ps,采用激光跟踪仪测量机器人实际到达位姿Pm,得到补偿前机器人的末端位姿误差ΔPm=Pm-Ps
步骤S2:建立机器人各连杆之间的运动关系,得到机器人运动学模型;建立机器人运动学误差模型;
步骤S3:求解步骤S2中的运动学误差模型,得到各运动学参数误差最优解和修正后的运动学模型,并计算修正的运动学模型下机器人的末端位姿Pk
步骤S4:将修正后的运动学模型下机器人的末端位姿Pk进行后置处理,得到定位误差补偿后输入给机器人的补偿量Pl=2Ps-Pk
步骤S5:将补偿量Pl输入机器人,用激光跟踪仪测量得到机器人实际到达位姿Pln,得到机器人经过参数标定之后的残余误差为ΔPr=Pln-Ps
步骤S6:将采样点理论位姿Ps和经过运动学标定后的残余误差ΔPr代入基于空间相似性的残余误差建模方法中,建立残余误差估计模型,开始进行期望目标点的补偿;
步骤S7:将目标点理论位姿Pt带入步骤S3中的修正后的运动学模型中求得预测的位姿Pf,得到预测的机器人定位误差ΔPf=Pf-Pt
步骤S8:将Pt、Ps和ΔPr代入步骤S6残余误差估计模型中,计算得到预测的期望目标点残余误差ΔPrm
步骤S9:计算期望目标点经过定位误差和残余误差补偿后,输入给机器人的补偿量Pw=Pt-ΔPf-ΔPrm
步骤S10:将步骤S9中的补偿量Pw输入机器人,由激光跟踪仪测量得到的机器人末端实际到达位姿Pwa,则期望目标点定位误差和残余误差补偿完成。
进一步地,为了更好的实现本发明,所述步骤S2具体是指:根据步骤S1给定的随机采样点理论位姿和激光跟踪仪测量得到的实际位姿,使用D-H模型建立机器人各连杆之间的运动关系,建立机器人运动学误差模型。
进一步地,为了更好的实现本发明,所述步骤S2中的机器人运动学模型为通过对机器人连杆之间的几何关系进行参数化描述,以根据机器人的关节输入获得机器人的末端位姿和姿态。
进一步地,为了更好的实现本发明,所述步骤S2中的运动学误差模型为在机器人运动学模型的基础上,考虑机器人的误差因素,建立机器人各关节输入与机器人末端定位误差之间关系的数学描述。
进一步地,为了更好的实现本发明,所述步骤S3中求解步骤S2中的运动学误差模型;具体是指:通过Levenberg–Marquardt阻尼迭代最小二乘法求解步骤S2中的运动学误差模型。
进一步地,为了更好的实现本发明,所述步骤S3中的Levenberg–Marquardt阻尼迭代最小二乘法为一种收敛速度快的参数辨识算法,在最小二乘算法的基础上引入自适应阻尼系数避免矩阵出现奇异性。
进一步地,为了更好的实现本发明,所述步骤S6中的残余误差估计模型为根据采样点的理论位姿和残余误差,建立基于空间相似性的残余误差映射,用于估计出期望目标点的残余误差。
本发明与现有技术相比,具有以下优点及有益效果:
(1)本发明能够有效的提高工业机器人的绝对定位精度;
(2)本发明通过研究分级补偿控制机制,实现基于耦合参数辨识和空间相似性的机器人分级误差补偿,使用后能有效地补偿机器人的残余误差,经过分级补偿后将机器人误差减小到0.3mm,显著提高机器人的绝对定位精度;
(3)本发明采用了改进型Levenberg–Marquardt阻尼迭代最小二乘法,能够求得目标函数的全局收敛解,参数误差估计较为正确,从而提高机器人运动学参数标定的精度;
(4)本发明采用了基于空间相似性的残余误差模型,最优权值的计算在笛卡尔坐标系的不同方向上具有不同的计算结果,能够体现机器人定位误差在空间中表现出的各向异性,并且最优权值取决于待补偿点与采样点的位姿与姿态。
附图说明
图1为本发明机器人完成定位误差分级补偿控制策略图。
具体实施方式
下面结合实施例对本发明作进一步地详细说明,但本发明的实施方式不限于此。
实施例1:
本发明通过下述技术方案实现,如图1所示,一种机器人定位误差分级补偿方法,具体包括以下步骤:
步骤S1:在待补偿区域内随机选取m个采样点的理论位姿Ps,采用激光跟踪仪测量机器人实际到达位姿Pm,得到补偿前机器人的末端位姿误差ΔPm=Pm-Ps
步骤S2:建立机器人各连杆之间的运动关系,得到机器人运动学模型;建立机器人运动学误差模型;
步骤S3:求解步骤S2中的运动学误差模型,得到各运动学参数误差最优解和修正后的运动学模型,并计算修正的运动学模型下机器人的末端位姿Pk
步骤S4:将修正后的运动学模型下机器人的末端位姿Pk进行后置处理,得到定位误差补偿后输入给机器人的补偿量Pl=2Ps-Pk
步骤S5:将补偿量Pl输入机器人,用激光跟踪仪测量得到机器人实际到达位姿Pln,得到机器人经过参数标定之后的残余误差为ΔPr=Pln-Ps
步骤S6:将采样点理论位姿Ps和经过运动学标定后的残余误差ΔPr代入基于空间相似性的残余误差建模方法中,建立残余误差估计模型,开始进行期望目标点的补偿;
步骤S7:将目标点理论位姿Pt带入步骤S3中的修正后的运动学模型中求得预测的位姿Pf,得到预测的机器人定位误差ΔPf=Pf-Pt
步骤S8:将Pt、Ps和ΔPr代入步骤S6残余误差估计模型中,计算得到预测的期望目标点残余误差ΔPrm
步骤S9:计算期望目标点经过定位误差和残余误差后,输入给机器人的补偿量Pw=Pt-ΔPf-ΔPrm
步骤S10:将步骤S9中的补偿量Pw输入机器人,由激光跟踪仪测量得到的机器人末端实际到达位姿Pwa,则期望目标点定位误差和残余误差补偿完成。
需要说明的是,通过上述改进,使用后能有效地补偿机器人的残余误差,经过分级补偿后将机器人误差减小到0.3mm,显著提高机器人的绝对定位精度。
采用Levenberg–Marquardt阻尼迭代最小二乘法,能够求得目标函数的全局收敛解,参数误差估计较为正确,从而提高机器人运动学参数标定的精度。
采用基于空间相似性的残余误差模型,最优权值的计算在笛卡尔坐标系的不同方向上具有不同的计算结果,能够体现机器人定位误差在空间中表现出的各向异性。并且最优权值取决于待补偿点与采样点的位置与姿态。
本实施例的其他部分与上述实施例相同,故不再赘述。
实施例2:
一种机器人定位误差分级补偿方法,分析机器人定位误差分布规律以及误差源作用机理,将定位误差的主要影响因素分为几何参数误差和非几何参数误差两类。针对几何参数误差因素,提出一种综合考虑机器人机座坐标系建立误差和几何参数误差的耦合参数误差模型。针对非几何参数误差因素,提出一种基于空间相似性的残余误差模型。通过研究分级补偿控制机制,实现基于耦合参数辨识和空间相似性的机器人分级误差补偿,进一步提高机器人的绝对定位精度。
具体包括以下步骤:
步骤S1:在待补偿区域内随机选取m个采样点的理论位姿Ps,采用激光跟踪仪测量机器人实际到达位姿Pm,得到补偿前机器人的末端位姿误差ΔPm=Pm-Ps
步骤S2:使用D-H模型建立机器人各连杆之间的运动关系,得到机器人运动学模型;具体是指:根据步骤S1给定的随机采样点理论位姿Ps和激光跟踪仪测量得到的实际位姿Pm,建立机器人运动学误差模型;
机器人运动学模型为通过对机器人连杆之间的几何关系进行参数化描述,以根据机器人的关节输入获得机器人的末端位姿和姿态;
运动学误差模型为在机器人运动学模型的基础上,考虑机器人的误差因素,建立机器人各关节输入与机器人末端定位误差之间关系的数学描述;
步骤S3:通过Levenberg–Marquardt阻尼迭代最小二乘法求解步骤S2中的运动学误差模型,得到各运动学参数误差最优解和修正后的运动学模型,并计算修正的运动学模型下机器人的末端位姿Pk;Levenberg–Marquardt阻尼迭代最小二乘法为一种收敛速度快的参数辨识算法,在最小二乘算法的基础上引入自适应阻尼系数避免矩阵出现奇异性;
步骤S4:将修正后的运动学模型下机器人的末端位姿Pk进行后置处理,得到定位误差补偿后输入给机器人的补偿量Pl=2Ps-Pk
步骤S5:将补偿量Pl输入机器人,用激光跟踪仪测量得到机器人实际到达位姿Pln,得到机器人经过参数标定之后的残余误差为ΔPr=Pln-Ps
步骤S6:将采样点理论位姿Ps和经过运动学标定后的残余误差ΔPr代入基于空间相似性的残余误差建模方法中,建立残余误差估计模型,开始进行期望目标点的补偿;
残余误差估计模型为根据采样点的理论位姿和残余误差,建立基于空间相似性的残余误差映射,用于估计出期望目标点的残余误差;
步骤S7:将目标点理论位姿Pt带入步骤S3中的修正后的运动学模型中求得预测的位姿Pf,得到预测的机器人定位误差ΔPf=Pf-Pt
步骤S8:将Pt、Ps和ΔPγ代入步骤S6残余误差估计模型中,计算得到预测的期望目标点残余误差ΔPrm
步骤S9:计算期望目标点经过定位误差和残余误差后,输入给机器人的补偿量Pw=Pt-ΔPf-ΔPrm
步骤S10:将步骤S9中的补偿量Pw输入机器人,由激光跟踪仪测量得到的机器人末端实际到达位姿Pwa,则期望目标点定位误差和残余误差补偿完成。
实施例3:
如图1所示,一种机器人定位误差分级补偿方法,具体包括以下步骤:
步骤S1:在待补偿区域内随机选取m个采样点的理论位姿Ps,用激光跟踪仪测量机器人实际到达位姿Pm,得到补偿前机器人的末端位姿误差ΔPm=Pm-Ps
步骤S2:使用D-H模型建立机器人各连杆之间的运动关系,得到机器人运动学模型;根据步骤S1给定的随机采样点理论位姿Ps和激光跟踪仪测量得到的实际位姿Pm,建立机器人运动学误差模型,模型建立如下:
使用D-H模型建立机器人各连杆之间的运动关系,为了避免相邻两轴之间相互平行或接近平行时产生的奇异问题,在理论D-H模型的基础上,相邻连杆之间的运动关系增加一个绕坐标系y轴的转角β,使机器人的连杆变换公式变为:
Figure GDA0003048092130000071
式中:sθi=sinθi;cθi=cosθi;sαi=sinαi;cαi=cosαi;sβi=sinβi;cβi=cosβi
对于N个关节串联的机器人,由相邻连杆的变换可以得到机器人运动学方程,机器人末端位姿变换矩阵0Tn为:
0Tn0A1 1A2n-1An
根据步骤S1给定的随机采样点理论位姿Ps和补偿前机器人的末端位姿误差ΔPm,由于以上建立的运动学模型中各参数存在误差,因此机器人末端位姿误差和各连杆参数误差之间的线性变换关系为:
Figure GDA0003048092130000072
若测量了m组机器人的定位误差,可得:
Figure GDA0003048092130000073
则对于m个采样点,机器人运动学误差模型为:ΔPm=Jm·ΔX
步骤S3:通过Levenberg–Marquardt阻尼迭代最小二乘法求解步骤S2中的运动学误差模型,得到各运动学参数误差最优解和修正后的运动学模型,并计算修正的运动学模型下机器人的末端位姿Pk。Levenberg–Marquardt阻尼迭代最小二乘法迭代过程如下:
(1)计算第k次迭代的机器人雅克比矩阵J(Xk)。
(2)求解第k次迭代的运动学参数误差改变值ΔXk,即:
ΔXk=-[JT(Xk)J(Xk)+μkI]-1JT(Xk)ΔP(Xk)
式中:I为单位矩阵;Xk为第k次迭代时的运动学参数误差;μk为第k次迭代的阻尼因子;ΔP(Xk)为第k次迭代的位姿误差。
(3)更新第k+1次迭代时的运动学参数误差Xk+1和迭代次数k为:
Xk+1=Xk+ΔXk
k=k+1
(4)更新第k+1次迭代时的阻尼系数μk+1为:
Figure GDA0003048092130000081
(5)当||ΔP(Xk+1)||-||ΔP(Xk)||≤ε时,一般取ε=0.0001,此时相邻两次迭代的位姿误差二范数之差趋近于零,证明已经收敛。
步骤S4:将修正后的运动学模型下机器人的末端位姿Pk进行后置处理,得到定位误差补偿后输入给机器人的补偿量Pl=2Ps-Pk
步骤S5:将补偿量Pl输入机器人,用激光跟踪仪测量得到机器人实际到达位姿Pln,得到机器人经过参数标定之后的残余误差为ΔPr=Pln-Ps
步骤S6:将采样点理论位姿Ps和经过运动学标定后的残余误差ΔPr代入基于空间相似性的残余误差建模方法中,建立残余误差估计模型。模型建立过程如下:
构建一个误差映射函数,来描述末端残余误差与关节转角的关系,并且建立采样点与采样点之间的相关性矩阵。根据目标点与采样点相关性矩阵定量描述,利用克里金差值的方法,估计出目标点的残余误差。
空间任意一点的误差分为确定性误差和随机误差,误差映射函数描述为:
el(θ)=ρ(βl,θ)+gl(θ) l=x,y,z
其中,θ=[θ1,θ2…θn]T为n自由度机器人空间任意一点的关节转角值;l为工作空间坐标方向,以在x方向的残余误差建模为例进行讨论。
ρ(β,θ)为误差映射函数的线性部分,其形式如下:
ρ(β,θ)=β12θ1+…+βn+1θn
=[1 θ1 … θn
=f(θ)Tβ
g(θ)表示误差映射函数的随机部分,满足期望为0,且任意两组关节转角输入g(θ)(i)和g(θ)(j)对应的协方差为:
Cov(g(θ)(i),g(θ)(j))=σ2S(ξ,θ(i),θ(j))
式中σ2为采样点在x方向的方差,S(ξ,θi,θj)是以ξ为参数的相关性模型:
Figure GDA0003048092130000091
式中ξk∈ξ,为第k个关节转角的辨识因子,由极大似然估计求得:
Figure GDA0003048092130000092
式中
Figure GDA0003048092130000093
为相关性矩阵,Ri,j=S(ξ,θ(i),θ(j))。
步骤S7:开始进行期望目标点的补偿,将目标点理论位姿Pt带入步骤S3中的修正后的运动学模型中求得预测的位姿Pf,得到预测的机器人定位误差ΔPf=Pf-Pt
步骤S8:将Pt、Ps和ΔPr代入步骤S6残余误差估计模型中,计算得到预测的期望目标点残余误差ΔPrm,残余误差估计方法如下:
由克里金差值可知,空间内任意一目标点在x,y,z方向的估计误差可以表示为:
Figure GDA0003048092130000094
式中:w∈Rm为目标点与采样点的权值矢量;e∈Rm为采样点某方向的误差矢量。
构建矩阵F描述采样点关节输入F=[f(θ(l))…f(θ(m))]T,构建相关性矢量r∈Rm描述目标点与采样点的相关性,r(θ)=[S(ξ,θ(l),θ)…S(ξ,θ(m),θ)]T
利用的方法求出权值w应该保证目标点的估计值与实际值的差值是无偏的,即:
Figure GDA0003048092130000095
式中:G=[g(θ(l))…g(θ(m))]T
要保证上式是无偏的,则需使FTw=f(θ),为了保证求得权值最优,需使下式的方差最小,则:
Figure GDA0003048092130000101
求解上述问题可以转化为条件极值的问题,可由拉格朗日乘数法解决,即:
L(w,λ)=δ2(1+wTRw-2wTr)-λT(FTw-f(θ))
其中λ为拉格朗日乘子;
令L′w=0得:L′w(w,λ)=2δ2(Rw-r)-Fλ=0;
求解上述公式即可解出最优w,带入式
Figure GDA0003048092130000102
可求出目标点的估计误差。
步骤S9:计算期望目标点经过定位误差和残余误差后,输入给机器人的补偿量Pw=Pt-ΔPf-ΔPrm
步骤S10:将步骤S9中的补偿量Pw输入机器人,由激光跟踪仪测量得到的机器人末端实际到达位姿Pwa,则期望目标点定位误差和残余误差补偿完成。
需要说明的是,通过上述改进,
本实施例的其他部分与上述实施例相同,故不再赘述。
以上所述,仅是本发明的较佳实施例,并非对本发明做任何形式上的限制,凡是依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化,均落入本发明的保护范围之内。

Claims (7)

1.一种机器人定位误差分级补偿方法,其特征在于:具体包括以下步骤:
步骤S1:在待补偿区域内随机选取m个采样点的理论位姿Ps,采用激光跟踪仪测量机器人实际到达位姿Pm,得到补偿前机器人的末端位姿误差ΔPm=Pm-Ps
步骤S2:建立机器人各连杆之间的运动关系,得到机器人运动学模型;建立机器人运动学误差模型;
步骤S3:求解步骤S2中的运动学误差模型,得到各运动学参数误差最优解和修正后的运动学模型,并计算修正的运动学模型下机器人的末端位姿Pk
步骤S4:将修正后的运动学模型下机器人的末端位姿Pk进行后置处理,得到定位误差补偿后输入给机器人的补偿量Pl=2Ps-Pk
步骤S5:将补偿量Pl输入机器人,用激光跟踪仪测量得到机器人实际到达位姿Pln ,得到机器人经过参数标定之后的残余误差为ΔPr=Pln-Ps
步骤S6:将采样点理论位姿Ps和经过运动学标定后的残余误差ΔPr代入基于空间相似性的残余误差建模方法中,建立残余误差估计模型,开始进行期望目标点的补偿;
步骤S7:将目标点理论位姿Pt带入步骤S3中的修正后的运动学模型中求得预测的位姿Pf,得到预测的机器人定位误差ΔPf=Pf-Pt
步骤S8:将Pt、Ps和ΔPr代入步骤S6残余误差估计模型中,计算得到预测的期望目标点残余误差ΔPrm
步骤S9:计算期望目标点经过定位误差和残余误差补偿后,输入给机器人的补偿量Pw=Pt-ΔPf-ΔPrm
步骤S10:将步骤S9中的补偿量Pw输入机器人,由激光跟踪仪测量得到的机器人末端实际到达位姿Pwa,则期望目标点定位误差和残余误差补偿完成。
2.根据权利要求1所述的一种机器人定位误差分级补偿方法,其特征在于:所述步骤S2具体是指:根据步骤S1给定的随机采样点理论位姿和激光跟踪仪测量得到的实际位姿,使用D-H模型建立机器人各连杆之间的运动关系,建立机器人运动学误差模型。
3.根据权利要求2所述的一种机器人定位误差分级补偿方法,其特征在于:所述步骤S2中的机器人运动学模型为通过对机器人连杆之间的几何关系进行参数化描述,以根据机器人的关节输入获得机器人的末端位姿和姿态。
4.根据权利要求2所述的一种机器人定位误差分级补偿方法,其特征在于:所述步骤S2中的运动学误差模型为在机器人运动学模型的基础上,考虑机器人的误差因素,建立机器人各关节输入与机器人末端定位误差之间关系的数学描述。
5.根据权利要求1-4任一项所述的一种机器人定位误差分级补偿方法,其特征在于:所述步骤S3中求解步骤S2中的运动学误差模型,具体是指:通过Levenberg–Marquardt阻尼迭代最小二乘法求解步骤S2中的运动学误差模型。
6.根据权利要求5所述的一种机器人定位误差分级补偿方法,其特征在于:所述步骤S3中的Levenberg–Marquardt阻尼迭代最小二乘法为一种收敛速度快的参数辨识算法,在最小二乘算法的基础上引入自适应阻尼系数避免矩阵出现奇异性。
7.根据权利要求6所述的一种机器人定位误差分级补偿方法,其特征在于:所述步骤S6中的残余误差估计模型为根据采样点的理论位姿和残余误差,建立基于空间相似性的残余误差映射,用于估计出期望目标点的残余误差。
CN201810376116.3A 2018-04-25 2018-04-25 一种机器人定位误差分级补偿方法 Active CN108908327B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810376116.3A CN108908327B (zh) 2018-04-25 2018-04-25 一种机器人定位误差分级补偿方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810376116.3A CN108908327B (zh) 2018-04-25 2018-04-25 一种机器人定位误差分级补偿方法

Publications (2)

Publication Number Publication Date
CN108908327A CN108908327A (zh) 2018-11-30
CN108908327B true CN108908327B (zh) 2021-09-07

Family

ID=64403204

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810376116.3A Active CN108908327B (zh) 2018-04-25 2018-04-25 一种机器人定位误差分级补偿方法

Country Status (1)

Country Link
CN (1) CN108908327B (zh)

Families Citing this family (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109924984B (zh) * 2019-03-22 2022-01-21 上海电气集团股份有限公司 基于人体运动意图检测的机器人运动控制方法及系统
CN110161850B (zh) * 2019-04-24 2020-04-07 南京航空航天大学 一种工业机器人变参数刚度辨识与建模方法
CN110193829B (zh) * 2019-04-24 2020-04-07 南京航空航天大学 一种耦合运动学与刚度参数辨识的机器人精度控制方法
CN110181509A (zh) * 2019-05-14 2019-08-30 浙江树人学院(浙江树人大学) 一种基于误差补偿的工业机器人运动控制方法
CN111055273B (zh) * 2019-05-16 2022-10-11 广西大学 一种用于机器人的两步误差补偿方法
CN110385720B (zh) * 2019-07-26 2020-08-04 南京航空航天大学 一种基于深度神经网络的机器人定位误差补偿方法
CN110646212B (zh) * 2019-10-23 2022-01-25 成都飞机工业(集团)有限责任公司 一种飞机发动机标定的新方法
CN110967042A (zh) * 2019-12-23 2020-04-07 襄阳华中科技大学先进制造工程研究院 一种工业机器人定位精度标定方法、装置及系统
CN111300422B (zh) * 2020-03-17 2021-04-23 浙江大学 基于视觉图像的机器人工件抓取位姿误差补偿方法
CN111650881B (zh) * 2020-05-12 2021-09-10 武汉理工大学 数控机床定位误差预测与补偿方法、系统及存储介质
CN112231888B (zh) * 2020-08-31 2024-04-05 北京工业大学 一种基于激光追踪测量系统机械结构的理想动力学模型建立方法
CN113051810B (zh) * 2021-03-12 2022-05-06 浙江大学 基于约束网格层次聚类的空分过程pwa模型辨识方法
CN114131607B (zh) * 2021-12-08 2022-07-12 北京工业大学 工业机器人广义运动学误差的运动学校准方法及系统
CN114161425B (zh) * 2021-12-28 2024-03-12 中国人民解放军战略支援部队信息工程大学 一种工业机器人的误差补偿方法
CN114474004B (zh) * 2022-03-18 2023-10-03 河北工业大学 一种多因素耦合车载建筑机器人误差补偿规划控制策略
CN114734440B (zh) * 2022-04-15 2023-09-05 同济大学 一种混联双臂搬运机器人运动学参数精准标定方法
CN115556114A (zh) * 2022-11-07 2023-01-03 浙江大学 一种基于闭环矢量链摄动与抗差估计主元回归算法的几何误差参数辨识方法
CN115648228B (zh) * 2022-12-28 2023-05-26 广东隆崎机器人有限公司 工业机器人多源误差补偿方法、装置、设备及存储介质
CN116945195B (zh) * 2023-09-19 2024-01-12 成都飞机工业(集团)有限责任公司 全向测量设备系统装置、配准方法、电子设备和存储介质
CN118596147A (zh) * 2024-06-25 2024-09-06 珞石(山东)机器人集团有限公司 一种全生命周期工业机器人位置误差预测及补偿方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101049697A (zh) * 2006-04-05 2007-10-10 中国科学院自动化研究所 一种移动机器人的位姿传感系统及其方法
CN101231749A (zh) * 2007-12-20 2008-07-30 昆山华恒工程技术中心有限公司 一种工业机器人的标定方法
KR20090113746A (ko) * 2008-04-28 2009-11-02 한양대학교 산학협력단 물체의 공간적 의미정보를 이용한 로봇의 자기위치 추정 방법
CN105022394A (zh) * 2014-04-29 2015-11-04 东北大学 动态环境下的移动机器人可靠定位方法
DE102015211407A1 (de) * 2015-06-22 2016-12-22 Kuka Roboter Gmbh Verbesserung der Temperaturdriftkompensation durch geregelte Überkompensation
CN107443388A (zh) * 2017-10-11 2017-12-08 北京航空航天大学 一种基于泛克里金的机械臂绝对定位误差估计方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8180714B2 (en) * 2007-05-29 2012-05-15 The Board Of Trustees Of The Leland Stanford Junior University Automatic generation of human models for motion capture, biomechanics and animation

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101049697A (zh) * 2006-04-05 2007-10-10 中国科学院自动化研究所 一种移动机器人的位姿传感系统及其方法
CN101231749A (zh) * 2007-12-20 2008-07-30 昆山华恒工程技术中心有限公司 一种工业机器人的标定方法
KR20090113746A (ko) * 2008-04-28 2009-11-02 한양대학교 산학협력단 물체의 공간적 의미정보를 이용한 로봇의 자기위치 추정 방법
CN105022394A (zh) * 2014-04-29 2015-11-04 东北大学 动态环境下的移动机器人可靠定位方法
DE102015211407A1 (de) * 2015-06-22 2016-12-22 Kuka Roboter Gmbh Verbesserung der Temperaturdriftkompensation durch geregelte Überkompensation
CN107443388A (zh) * 2017-10-11 2017-12-08 北京航空航天大学 一种基于泛克里金的机械臂绝对定位误差估计方法

Also Published As

Publication number Publication date
CN108908327A (zh) 2018-11-30

Similar Documents

Publication Publication Date Title
CN108908327B (zh) 一种机器人定位误差分级补偿方法
CN111590581B (zh) 机器人的定位补偿方法及装置
Ochoa et al. Impedance control architecture for robotic-assisted mold polishing based on human demonstration
Zhu et al. Positioning error compensation on two-dimensional manifold for robotic machining
Peng et al. Total differential methods based universal post processing algorithm considering geometric error for multi-axis NC machine tool
Wang et al. Calibration method of robot base frame using unit quaternion form
Wang et al. Nonparametric statistical learning control of robot manipulators for trajectory or contour tracking
CN106777656B (zh) 一种基于pmpsd的工业机器人绝对精度校准方法
CN110253574B (zh) 一种多任务机械臂位姿检测和误差补偿方法
CN107457785B (zh) 一种基于关节反馈的机器人位置补偿方法
Klimchik et al. Optimal pose selection for calibration of planar anthropomorphic manipulators
CN115648228B (zh) 工业机器人多源误差补偿方法、装置、设备及存储介质
Jiang et al. A novel dual-robot accurate calibration method using convex optimization and lie derivative
Landgraf et al. A hybrid neural network approach for increasing the absolute accuracy of industrial robots
Xiao et al. A new fixed axis-invariant based calibration approach to improve absolute positioning accuracy of manipulators
Posada et al. Automatic programming and control for robotic deburring
Maghami et al. Calibration of multi-robot cooperative systems using deep neural networks
Qiao et al. Industrial robot accuracy degradation monitoring and quick health assessment
Lin et al. Accuracy Compensation Technology of Closed-Loop Feedback of Industrial Robot Joints.
Liao et al. Error Compensation for Industrial Robots
Chaluš et al. Finding Optimal Sensor Positions for Hand-Eye Calibration
Gubankov et al. Identification method of kinematic parameters of multilink industrial manipulator
Sumenkov et al. Kinematic Calibration of an Industrial Manipulator without External Measurement Devices
Schillreff et al. Learning-based Kinematic Calibration using Adjoint Error Model.
Jing et al. A learning-based approach for error compensation of industrial manipulator with hybrid model

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