CN114147726A - 一种几何误差与非几何误差相结合的机器人标定方法 - Google Patents
一种几何误差与非几何误差相结合的机器人标定方法 Download PDFInfo
- Publication number
- CN114147726A CN114147726A CN202111608435.0A CN202111608435A CN114147726A CN 114147726 A CN114147726 A CN 114147726A CN 202111608435 A CN202111608435 A CN 202111608435A CN 114147726 A CN114147726 A CN 114147726A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- parameters
- error
- robot
- matrix
- 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
- 238000000034 method Methods 0.000 title claims abstract description 54
- 239000011159 matrix material Substances 0.000 claims abstract description 56
- 239000002245 particle Substances 0.000 claims abstract description 38
- 238000012843 least square support vector machine Methods 0.000 claims abstract description 28
- 230000008878 coupling Effects 0.000 claims abstract description 16
- 238000010168 coupling process Methods 0.000 claims abstract description 16
- 238000005859 coupling reaction Methods 0.000 claims abstract description 16
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 9
- 238000000354 decomposition reaction Methods 0.000 claims abstract description 7
- 239000013598 vector Substances 0.000 claims description 26
- 230000009466 transformation Effects 0.000 claims description 20
- 238000005457 optimization Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 11
- 238000005259 measurement Methods 0.000 claims description 10
- 230000007246 mechanism Effects 0.000 claims description 10
- 238000012706 support-vector machine Methods 0.000 claims description 10
- 239000000126 substance Substances 0.000 claims description 6
- 238000012549 training Methods 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000008030 elimination Effects 0.000 claims description 3
- 238000003379 elimination reaction Methods 0.000 claims description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 2
- 238000012804 iterative process Methods 0.000 claims description 2
- 238000004088 simulation Methods 0.000 claims description 2
- 230000001360 synchronised effect Effects 0.000 claims description 2
- 238000012360 testing method Methods 0.000 claims description 2
- 239000000203 mixture Substances 0.000 description 4
- 238000009795 derivation Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000003754 machining Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
-
- 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)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
一种几何误差与非几何误差相结合的机器人标定方法，它涉及一种机器人标定方法。本发明为了解决现有机器人中的平行四边形机械臂在标定时同时存在几何误差和非几何误差，导致机器人标定误差大的问题。本发明的步骤一：根据机械臂构型基于MDH模型和机械臂的构型参数建立坐标系及运动学矩阵坐标系及运动学矩阵；步骤二：建立平行四边形的误差模型及平行四边形末端位置的运动矩阵；步骤三：根据奇异值分解的方法剔除耦合参数，辨识几何参数；步骤四：使用粒子群算法计算出最小二乘支持向量机的最优参数后，补偿由于非几何误差引起的剩余位置误差。本发明用于机器人标定。
Description
技术领域
本发明涉及一种机器人标定方法，具体涉及一种几何误差与非几何误差相结合的机器人标定方法，是针对有限样本下的机器人运动学精度的标定方法，属于工业机器人技术领域。
背景技术
机器人作为典型的机电设备，在加工、装配、医疗等领域具有广泛的应用。在机器人的实际应用中，定位精度是一个重要的指标。随自动化智能化技术的发展，对机器人的定位精度提出更高的要求，尤其在管道，钻孔，焊接等领域。
但由于加工公差、装配误差、柔性变形等影响，机器人的实际模型与名义模型不一致，导致机器人的绝对定位精度较低。
目前，机器人在标定过程中，一般都采用带有平行四边形的机械臂来完成标定，但是由于平行四边形的机械臂在生产、加工和装配过程中会存在大量的几何误差，而且在标定过程中，还存在非几何误差，导致机器人标定绝对定位精度低的问题，也给运动的求解带来困难。
发明内容
本发明的目的是为了解决现有机器人中的平行四边形机械臂在标定时同时存在几何误差和非几何误差，导致机器人标定误差大的问题。进而提供一种几何误差与非几何误差相结合的机器人标定方法。
本发明的技术方案是：一种几何误差与非几何误差相结合的机器人标定方法，包括以下步骤：
步骤一：根据机械臂构型基于MDH模型和机械臂的构型参数建立坐标系及运动学矩阵坐标系及运动学矩阵；
步骤二：建立平行四边形的误差模型及平行四边形末端位置的运动矩阵；
步骤三：根据奇异值分解的方法剔除耦合参数，辨识几何参数；
步骤四：使用粒子群算法计算出最小二乘支持向量机的最优参数后，补偿由于非几何误差引起的剩余位置误差。
本发明与现有技术相比具有以下效果：
本发明首先采用MDH模型建立了几何误差模型；然后使用奇异值分解的方法对耦合参数进行处理，以提高辨识的精度和效率；最后使用粒子群寻算法优化参数后的LSSVR，补偿由于非几何误差引起的剩余位置误差，提高有限样本估计时的准确性。
也就是说本发明同时减少了机器人机械臂的平行四边形机构在标定过程中存在的几何误差和运动过程中存在的非几何误差，通过采用粒子群寻优最小二乘支持向量机的算法，在有限样本数量的情况下提高了机器人运动学的精度。
附图说明
图1为本发明带平行四边形的冗余机械臂的结构与坐标示意图；
图2为本发明带平行四边形的冗余机械臂的四边形机构示意图；
图3为本发明带平行四边形的冗余机械臂标定和补偿工作流程图；本图中的几何参数辨识部分展示的是实际应用时控制器的流程，省略了本发明理论公式推导以及剔除耦合参数部分。
图4为本发明带平行四边形的冗余机械臂逆运动学工作流程图；其中，本发明的标定方法部分省略了逆运动学推导部分，因为逆运动学推导部分为现有技术。但作为本发明完整的技术方案，在实际标定时，可以采用逆运动学的计算，该过程与本发明的标定方法共同组成完整的方案，故补充了逆运动学工作流程图。
图5为具体实施例实验结果对比图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
具体实施方式一：结合图1至图4说明本实施方式，本实施方式的一种几何误差与非几何误差相结合的机器人标定方法，它包括以下步骤：
步骤一：根据机械臂构型基于MDH模型和机械臂的构型参数建立坐标系及运动学矩阵坐标系及运动学矩阵；
步骤二：建立平行四边形的误差模型及平行四边形末端位置的运动矩阵；
步骤三：根据奇异值分解的方法各个关节之间的耦合参数，辨识几何参数；
步骤四：使用粒子群算法计算出最小二乘支持向量机的最优参数后，补偿由于非几何误差引起的剩余位置误差。
本发明解决了现有技术中对机器人的几何误差与非几何误差建模分别建模补偿，以减小机器人的末端定位误差。本发明具体使用了基于粒子群寻优与最小二乘支持向量机相结合的标定方法分别减小机器人的几何误差与非几何误差提高机器人的绝对定位精度，提高有限样本估计时的准确性和稳健性。
具体实施方式二：结合图1和图2说明本实施方式，本实施方式的步骤一中的构型参数坐标系为：
第1关节坐标系x1z1y1由基坐标系x0z0y0绕x0轴旋转90°；
第2关节坐标系x2z2y2由第1关节坐标系绕z1轴旋转90°，并沿y1轴移动a1；
第3关节坐标系x3z3y3由第2关节坐标系绕x2轴旋转90°，并沿x2轴移动a2；
第4关节坐标系x4z4y4由第3关节坐标系绕x3轴旋转90°，并沿z3轴移动a3；
第5关节坐标系x5z5y5由第4关节坐标系绕x4轴旋转90°，并沿y4轴移动a4；
第6关节坐标系由第5关节坐标系沿y5移动a5；
所有关节都以各自的z轴为旋转中心转动。
如此设置，可以减少平行四边形机构的几何误差对末端定位误差的影响。其它组成和连接关系与具体实施方式一相同。
具体实施方式三：结合图1至图4说明本实施方式，本实施方式的步骤一的运动学矩阵坐标系及运动学矩阵包括以下步骤：
步骤一一：齐次坐标变换矩阵的构建；
根据机械臂相邻关节之间的其次变换方程得出机械臂末端坐标系相对于基坐标系的齐次坐标变换矩阵
公式(1)：
其中，
表示相邻两连杆坐标系的其次坐标变换矩阵，所述连杆为相邻两个关节之间的连接件；关节角度，关节偏置，连杆长度，连杆扭转和Hayati参数分别为θi，di，ai，αi和βi；
表示法兰坐标系与工具坐标系之间的齐次转换矩阵；
如果相邻两关节平行或者近似平行，那么di＝0,βi≠0，否则βi＝0,di≠0；
步骤一二：法兰坐标系的构建；
在实际中，法兰坐标系难以准确测量，因此
通过以下方程确定：
从测量坐标系到SMR的变换矩阵为：
在这里，
表示SMR在测量坐标系下的位置；
在标定前，
应该被初步测量，
通过CAD模型初步确定，在标定中，对
和
进行同步辨识。如此设置，只需一次辨识即可，可以减少累计多次辨识以及测量误差所带来的影响。其它组成和连接关系与具体实施方式一或二相同。
具体实施方式四：结合图1至图4说明本实施方式，本实施方式的步骤二中包括以下步骤：
步骤二一：建立平行四边形的误差模型；
平行四边形机构在平面O1x1y1上投影，并构建闭环约束方程如下所示：
在这里cθi和sθi分别是cos(θi)和sin(θi)的简写；θi,j是θi+θj的简写；lA2,lp3,lp4是平行四边形机构的杆长
步骤二二：平行四边形末端位置的运动矩阵；
根据平行四边形的定义，得到θ3＝θA2+θP3+θP4-θ2-π，通过对公式(6)进行微分得到被动关节的角度θP3，θP4与θ2θA2,a2,lA2,lP3,lP4之间的线性化关系：
得到：
Δθ3＝g1Δθ2+g2ΔθA2+g3Δa2+g4ΔlA2+g5ΔlP3+g6ΔlP4 (8)
其中，考虑到平行四边形的约束条件lA2＝lP4与θ3＝-θ2+θA2，对方程(8)简化得到：
g1＝-g2＝-1,
带平行四边形机构的机器人的运动学模型如方程(5)所示，末端位置误差与几何参数之间的关系可以表示为：
ΔX＝JB*ΔB+JR*Δq+JT*ΔT (10)
ΔX3×1＝J3×36*Δg36×1 (11)
在这里ΔX是末端位置误差为3*1向量，
ΔB是基座标系误差向量，
Δq是机器人参数误差向量，
ΔT是工具座标系误差向量，ΔB＝[Δx0,Δy0,Δz0,Δα0,Δβ0,Δθ0]T，ΔT＝[Δxt,Δyt,Δzt]T。Δq＝[ΔθT,ΔdT,ΔaT,ΔαT,ΔβT]T，在这里Δθ＝[Δθ1,L,Δθ6]T,Δd＝[Δd1,Δd3,L,Δd6]T,Δa＝[Δa1,L,Δa6]T,Δα＝[Δα1,L,Δα6]T，Δβ＝[Δβ2]T；
Ji是对应的辨识雅克比矩阵；
基座标系的误差参数所对应的雅克比矩阵为：
Jx0＝[xM]，Jy0＝[yM]，Ja0＝[xM×PSMR]，Jβ0＝[y'M×PSMR]
Jz0＝[z0]，Jθ0＝[z”M×Pb,SMR] (12)
其中xi,yi,zi表示测量坐标系{i}的方向向量，坐标系{M'}是坐标系{M}绕xM轴旋转α0后所形成的坐标系，y'M是坐标系{M'}沿y轴的方向向量；
{M”}表示坐标系{M'}绕y'M轴旋转β0后形成坐标系，向量Pb,SMR将基座标系的原点连接到末端工具坐标系的原点；
机器人的误差参数对应的雅克比矩阵为：
Jθi＝[zi-1×Pi-1,n]，Jdi＝[zi-1]，Jai＝[xi']，Jαi＝[xi'×Pi,n]，Jβi＝[yi×Pi,n](13)
在这里，zi和yi表示连杆坐标系{i}沿z和y轴的方向向量。坐标系{i'}是连杆坐标系{i-1}绕zi-1轴旋转θi之后形成的坐标系，xi'是坐标系{i'}沿x轴的方向向量。向量Pi,n将连杆{i}坐标系的原点连接到末端工作坐标的原点；
其中，将方程(8)集成到方程(11)中得到平行四边形误差参数所对应的雅克比矩阵：
其中，
平行四边形误差参数所对应的雅克比矩阵；
法兰坐标系的误差参数所对应的雅克比矩阵计为：
JxSMR＝[xFL]，JySMR＝[yFL]，JzSMR＝[zFL] (15)
xFL,yFL,，zFL表示沿法兰坐标系x,y,z轴的方向向量。
其它组成和连接关系与具体实施方式一、二或三相同。
具体实施方式五：结合图1至图4说明本实施方式，本实施方式的步骤三中包括以下步骤：
步骤三一：剔除耦合参数；
将公式(10)简写为ΔX＝J·Δg，并使H＝[JT·J]，通过对H进行奇异值分解得到：
(16)
其中，U和V都是酉矩阵，并且满足UTU＝I,VTV＝I；
Σ＝diag(σ1,σ2,K,σr)代表主对角线上不为零的对角阵，σ1,σ2,K,σr是H矩阵的特征值，r是H矩阵的秩(r≤36)，因此，有36-r个参数是线性相关的；
由于H是对称矩阵且VT＝U-1，V是旋转矩阵，那么VT·Δg等于Δg，通过行初等变换得到线性相关的系数；
在此基础上使用模型分析的方法，确定非线性耦合参数之间的表达式，并且通过仿真验证了耦合参数关系方程式的正确性，根据以上的分析，得到耦合参数：
其中，X＝a6+xt，之后将耦合参数Δθ1,Δd1,ΔlP4,Δa5,Δα5,Δθ6,Δxt,Δzt从标定模型中去除；
步骤三二：辨识几何参数；
通过对n个机器人关节配置下的末端位置进行测量，建立3×n个方程辨识机器人的几何参数,为使系统的线性化误差最小，采用迭代最小二乘法(ILS)辨识模型的参数：
gk＝gk-1+Δgk (19)
其中，gk是在第kth次迭代时更新的参数，Δgk是第kth次迭代时的参数误差，使用如下的方程表示：
Δgk＝[Jk TJk]-1Jk TΔPk (20)
其中，
是在第k次迭代时末端的位置误差矩阵，
是其对应的辨识雅克比矩阵,直到Δgk的值小于ε，迭代过程终止。
如此设置，循环迭代(最小二乘法)可以最小化线性误差。其它组成和连接关系与具体实施方式一、二、三或四相同。
具体实施方式六：结合图1至图4说明本实施方式，本实施方式的步骤四中的使用粒子群算法计算出最小二乘支持向量机的最优参数的过程如下：
步骤四一：设定最小二乘支持向量机的最优目标；
训练样本为(xi,yi)分别是最小二乘支持向量机的输入输出向量，最小二乘支持向量机模型描述为:
y(x)＝ωTφ(x)+b (21)
其中ω是权重向量，φ(x)是非线性函数，b是曲线的偏差，最小二乘支持向量机的优化目标为：
ei是第ith样本的逼近误差，γ是正则化参数，用于避免过拟合问题；
步骤四二：确定最小二乘支持向量机函数；
将拉格朗日乘子αi引入方程式(21)，优化问题变为：
其中，αi是每个xi的拉格朗日乘子，对公式(23)中变量ω,b,ei分别求偏导数，并令偏导数等于零得到如下的方程：
在消去ei和ω得到：
在这里I＝[1,1,K,1]T,α＝[α1,α2,K,αn]T，
其中，K(xi,xj)代表核函数，在高维空间中进行内积运算；其中，y＝(y1,y2,K,yn)T，因此，对于新的样本x，最小二乘支持向量机的输出为：
选择径向基核函数作为最小二乘支持向量机的核函数，回归函数如下所示：
其中，σ为核函数的参数；
训练好的最小二乘支持向量机回归函数简写为：Lssvr(θi)，θi＝[θ1,L,θ6]。
如此设置，将机器人的各关节角度作为影响机器人位置精度的要素，并作为最小二乘支持向量机的输入，对剩余定位误差进行预测，可以减少非几何误差。其它组成和连接关系与具体实施方式一至五中任意一项相同。
具体实施方式七：结合图1至图4说明本实施方式，本实施方式的步骤四中的补偿由于非几何误差引起的剩余位置误差的过程如下：
步骤1：完成之前标定步骤后，在机器人工作空间内随机取200组点，并让机器人按照取点位置运动，记录此时机器人仍具有的剩余位置误差作为样本数据，将样本数据的80％作为训练样本，20％的样本数据作为测试样本；
步骤2：利用训练好的最小二乘支持向量机对非几何误差进行预测；
设置最小二乘支持向量机中因子C和核参数σ的范围，并根据该范围随机初始化粒子群；
步骤3:设置优化迭代次数为200次，加速度因子c1和c2，最大惯性权值wmax为0.8，最小惯性权值wmin为0.5，随机权值方差平均为0.2，根据公式(29)自适应更新权值；
其中，f为粒子的当前值；favg和fmin分别为粒子群中的均值和最小值，wmin和wmax分别为最大和最小权重系数；
步骤4:根据公式(30)计算每个粒子的适应度值，然后根据适应度值确定当前粒子的个体最优值和种群最优值；
其中，N为粒子数量，f(xi)为每次粒子群寻优后输出结果，yi为样本期望结果；
步骤5:根据公式(31)和公式(32)迭代更新粒子的位置和速度，生成新一代的种群；
其中，Vi表示第i个粒子的速度；Pi表示本次计算后第i个粒子的最佳位置；Xi表示第i个粒子的位置；w(s)是惯性权系数；d是解空间的维数，c1和c2是加速度因子，它们是非负常数；r1和r2是两个介于(0,1)之间的随机数，增加了搜索的随机性，k表示当前迭代次数；
步骤6:重新计算新种群中每个粒子的适应度值，然后与历史个体的最优位置和种群的最优位置进行比较；如果适应度函数的值大于当前的最优值，那么将当前的参数(支持向量机的C和σ参数)替换最优的参数，否则保持原参数不变；
步骤7:预设最大迭代次数和适应度值的下限，验证每次迭代后的结果是否满足预设最大迭代次数和适应度值的下限要求，如果条件没有满足则终止计算，回到步骤4重新计算每个粒子的适应度值；如果条件得到满足，程序结束，获得全局最优,即最优C和σ；
步骤8:将得到的粒子群最优位置(C，σ)分配到最小二乘支持向量机的预测模型中，得到最优预测模型；
步骤9：采用三个最小二乘支持向量机分别对剩余位置误差ΔPX，ΔPY，ΔPZ进行预测，最小二乘支持向量机的输入数据为机器人的关节角度集合θi＝[θ1,L,θ6]，输出数据为几何误差补偿后的剩余位置误差。
如此设置，以粒子群寻优算法可以获得比人工设定的参数更优的参数，使最小二乘支持向量机对非几何误差的补偿达到最优效果。其它组成和连接关系与具体实施方式一至六中任意一项相同。
具体实施例：
标定系统的设备包含ABB带平行四边形机构的IRB1410机器人，Leica AT960激光跟踪仪(位置精度±15um+6um/m)和球形安装靶球。
IRB1410的重复定位精度为±50um。
使用轴线拟合对
进行初步确定。
通过CAD模型对
进行初步确定。
在机器人最大可测量的空间生成400组的关节配置并测量对应的末端位置。
为了进行几何参数的辨识、LSSVR的训练和补偿效果评估，分别选取100，200和100组涵盖整个测量空间的样本称为S1，S2，S3，对应的末端位置分别为PS1，PS2，PS3。
其中，S1用于几何参数的辨识，S2用于LSSVR的训练，S3用于标定后精度的评估与验证。通过计算100组实验结果数据的平均值、最大值和均方差，标定各步骤后机器人的末端定位精度如下表格所示。
| 平均值 | 最大值 | 均方差 | |
| 名义模型 | 1.0967 | 2.1455 | 0.354 |
| 辨识 | 0.1331 | 0.3514 | 0.076 |
| LSSVR | 0.0819 | 0.1811 | 0.0322 |
| PSO_LSSVR | 0.0723 | 0.1602 | 0.0317 |
通过对以上数据内容的分析可知，本申请相比于现有技术在机器人标定方面具有更高的精度提升以及迭代计算时间短的优点。
以上实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (7)
1.一种几何误差与非几何误差相结合的机器人标定方法，其特征在于：它包括以下步骤：
步骤一：根据机械臂构型基于MDH模型和机械臂的构型参数建立坐标系及运动学矩阵坐标系及运动学矩阵；
步骤二：建立平行四边形的误差模型及平行四边形末端位置的运动矩阵；
步骤三：根据奇异值分解的方法各个关节之间的耦合参数，辨识几何参数；
步骤四：使用粒子群算法计算出最小二乘支持向量机的最优参数后，补偿由于非几何误差引起的剩余位置误差。
2.根据权利要求1所述的一种几何误差与非几何误差相结合的机器人标定方法，其特征在于：步骤一中的构型参数坐标系为：
第1关节坐标系x1z1y1由基坐标系x0z0y0绕x0轴旋转90°；
第2关节坐标系x2z2y2由第1关节坐标系绕z1轴旋转90°，并沿y1轴移动a1；
第3关节坐标系x3z3y3由第2关节坐标系绕x2轴旋转90°，并沿x2轴移动a2；
第4关节坐标系x4z4y4由第3关节坐标系绕x3轴旋转90°，并沿z3轴移动a3；
第5关节坐标系x5z5y5由第4关节坐标系绕x4轴旋转90°，并沿y4轴移动a4；
第6关节坐标系由第5关节坐标系沿y5移动a5；
所有关节都以各自的z轴为旋转中心转动。
3.根据权利要求2所述的一种几何误差与非几何误差相结合的机器人标定方法，其特征在于：步骤一的运动学矩阵坐标系及运动学矩阵包括以下步骤：
步骤一一：齐次坐标变换矩阵的构建；
根据机械臂相邻关节之间的其次变换方程得出机械臂末端坐标系相对于基坐标系的齐次坐标变换矩阵
公式(1)：
其中，
表示相邻两连杆坐标系的其次坐标变换矩阵，所述连杆为相邻两个关节之间的连接件；关节角度，关节偏置，连杆长度，连杆扭转和Hayati参数分别为θi，di，ai，αi和βi；
表示法兰坐标系与工具坐标系之间的齐次转换矩阵；
如果相邻两关节平行或者近似平行，那么di＝0,βi≠0，否则βi＝0,di≠0；
步骤一二：法兰坐标系的构建；
在实际中，法兰坐标系难以准确测量，因此
通过以下方程确定：
从测量坐标系到SMR的变换矩阵为：
在这里，
表示SMR在测量坐标系下的位置；
在标定前，
应该被初步测量，
通过CAD模型初步确定，在标定中，对
和
进行同步辨识。
4.根据权利要求3所述的一种几何误差与非几何误差相结合的机器人标定方法，其特征在于：步骤二中包括以下步骤：
步骤二一：建立平行四边形的误差模型；
平行四边形机构在平面O1x1y1上投影，并构建闭环约束方程如下所示：
在这里cθi和sθi分别是cos(θi)和sin(θi)的简写；θi，j是θi+θj的简写；lA2，lp3，lp4是平行四边形机构的杆长；
步骤二二：平行四边形末端位置的运动矩阵；
根据平行四边形的定义，得到θ3＝θA2+θP3+θP4-θ2-π，通过对公式(6)进行微分得到被动关节的角度θP3，θP4与θ2θA2，a2，lA2，lP3，lP4之间的线性化关系：
得到：
Δθ3＝g1Δθ2+g2ΔθA2+g3Δa2+g4ΔlA2+g5ΔlP3+g6ΔlP4 (8)
其中，考虑到平行四边形的约束条件lA2＝lP4与θ3＝-θ2+θA2，对方程(8)简化得到：
带平行四边形机构的机器人的运动学模型如方程(5)所示，末端位置误差与几何参数之间的关系可以表示为：
ΔX＝JB*ΔB+JR*Δq+JT*ΔT (10)
ΔX3×1＝J3×36*Δg36×1 (11)
在这里ΔX是末端位置误差为3*1向量，
ΔB是基座标系误差向量，
ΔP是机器人参数误差向量，
ΔT是工具座标系误差向量，ΔB＝[Δx0,Δy0,Δz0,Δα0,Δβ0,Δθ0]T，ΔT＝[Δxt,Δyt,Δzt]T。Δq＝[ΔθT,ΔdT,ΔaT,ΔαT,ΔβT]T，在这里Δθ＝[Δθ1,L,Δθ6]T，Δd＝[Δd1,Δd3,L,Δd6]T，Δa＝[Δa1,L,Δa6]T，Δα＝[Δα1,L,Δα6]T，Δβ＝[Δβ2]T；
Ji是对应的辨识雅克比矩阵；
基座标系的误差参数所对应的雅克比矩阵为：
Jx0＝[xM]，Jy0＝[yM]，Ja0＝[xM×PSMR]，Jβ0＝[y'M×PSMR]
Jz0＝[z0]，Jθ0＝[z”M×Pb,SMR] (12)
其中xi，yi，zi表示测量坐标系{i}的方向向量，坐标系{M'}是坐标系{M}绕xM轴旋转α0后所形成的坐标系，y'M是坐标系{M'}沿y轴的方向向量；
{M”}表示坐标系{M'}绕y'M轴旋转β0后形成坐标系，向量Pb,SMR将基座标系的原点连接到末端工具坐标系的原点；
机器人的误差参数对应的雅克比矩阵为：
Jθi＝[zi-1×Pi-1,n]，Jdi＝[zi-1]，Jai＝[xi']，Jαi＝[xi'×Pi,n]，Jβi＝[yi×Pi,n] (13)
在这里，zi和yi表示连杆坐标系{i}沿z和y轴的方向向量。坐标系{i'}是连杆坐标系{i-1}绕zi-1轴旋转θi之后形成的坐标系，xi'是坐标系{i'}沿x轴的方向向量。向量Pi,n将连杆{i}坐标系的原点连接到末端工作坐标的原点；
其中，将方程(8)集成到方程(11)中得到平行四边形误差参数所对应的雅克比矩阵：
其中，
平行四边形误差参数所对应的雅克比矩阵；
法兰坐标系的误差参数所对应的雅克比矩阵计为：
JxSMR[xFL]，JySMR＝[yFL]，JzSMR＝[zFL] (15)
xFL，yFL，zFL表示沿法兰坐标系x，y，z轴的方向向量。
5.根据权利要求4所述的一种几何误差与非几何误差相结合的机器人标定方法，其特征在于：步骤三中包括以下步骤：
步骤三一：剔除耦合参数；
将公式(10)简写为ΔX＝J·Δg，并使H＝[JT·J]，通过对H进行奇异值分解得到：
其中，A·B表示矩阵的点乘，U和V都是酉矩阵，并且满足UTU＝I，VTV＝I；
∑代表主对角线上不为零的对角阵，σ1，σ2，K，σr是H矩阵的特征值，r是H矩阵的秩(r≤36)，因此，有36-r个参数是线性相关的；
由于H是对称矩阵且VT＝U-1，V是旋转矩阵，那么VT·Δg等于Δg，通过行初等变换得到线性相关的系数；
在此基础上使用模型分析的方法，确定非线性耦合参数之间的表达式，并且通过仿真验证了耦合参数关系方程式的正确性，根据以上的分析，得到耦合参数：
其中，X＝a6+xt，之后将耦合参数Δθ1，Δd1，ΔlP4，Δa5，Δα5，Δθ6，Δxt，Δxt从标定模型中去除；
步骤三二：辨识几何参数；
通过对n个机器人关节配置下的末端位置进行测量，建立3×n个方程辨识机器人的几何参数，为使系统的线性化误差最小，采用迭代最小二乘法(ILS)辨识模型的参数：
gk＝gk-1+Δgk (19)
其中，gk是在第kth次迭代时更新的参数，Δgk是第kth次迭代时的参数误差，使用如下的方程表示：
其中，
是在第kth迭代时末端的位置误差矩阵，
是其对应的辨识雅克比矩阵,直到Δgk的值小于ε，迭代过程终止。
6.根据权利要求1或5所述的一种几何误差与非几何误差相结合的机器人标定方法，其特征在于：步骤四中的使用粒子群算法计算出最小二乘支持向量机的最优参数的过程如下：
步骤四一：设定最小二乘支持向量机的最优目标；
训练样本为(xi,yi)分别是最小二乘支持向量机的输入输出向量，最小二乘支持向量机模型描述为:
y(x)＝ωTφ(x)+b (21)
其中ω是权重向量，φ(x)是非线性函数，b是曲线的偏差，最小二乘支持向量机的优化目标为：
ei是第ith个样本的逼近误差，γ是正则化参数，用于避免过拟合问题；
步骤四二：确定最小二乘支持向量机函数；
将拉格朗日乘子αi引入方程式(21)，优化问题变为：
其中，αi是每个xi的拉格朗日乘子，对公式(23)中变量ω,b,ei分别求偏导数，并令偏导数等于零得到如下的方程：
在消去ei和ω得到：
在这里I＝[1,1,K,1]T,α＝[α1,α2,K,αn]T，
其中，K(xi,xj)代表核函数，在高维空间中进行内积运算；其中，y＝(y1,y2,K,yn)T，因此，对于新的样本x，最小二乘支持向量机的输出为：
选择径向基核函数作为最小二乘支持向量机的核函数，回归函数如下所示：
其中，σ为核函数的参数；
训练好的最小二乘支持向量机回归函数简写为：Lssvr(θi)，θi＝[θ1,L,θ6]。
7.根据权利要求6所述的一种几何误差与非几何误差相结合的机器人标定方法，其特征在于：步骤四中的补偿由于非几何误差引起的剩余位置误差的过程如下：
步骤1：完成之前标定步骤后，在机器人工作空间内随机取200组点，并让机器人按照取点位置运动，记录此时机器人仍具有的剩余位置误差作为样本数据，将样本数据的80％作为训练样本，20％的样本数据作为测试样本；
步骤2：利用训练好的最小二乘支持向量机对非几何误差进行预测；
设置最小二乘支持向量机中因子C和核参数σ的范围，并根据该范围随机初始化粒子群；
步骤3:设置优化迭代次数为200次，加速度因子c1和c2，最大惯性权值wmax为0.8，最小惯性权值wmin为0.5，随机权值方差平均为0.2，根据公式(29)自适应更新权值；
其中，f为粒子的当前值；favg和fmin分别为粒子群中的均值和最小值，wmin和wmax分别为最大和最小权重系数；
步骤4：根据公式(30)计算每个粒子的适应度值，然后根据适应度值确定当前粒子的个体最优值和种群最优值；
其中，N为粒子数量，f(xi)为每次粒子群寻优后输出结果，yi为样本期望结果；
步骤5：根据公式(31)和公式(32)迭代更新粒子的位置和速度，生成新一代的种群；
其中，Vi表示第i个粒子的速度；Pi表示本次计算后第i个粒子的最佳位置；Xi表示第i个粒子的位置；w(s)是惯性权系数；d是解空间的维数，c1和c2是加速度因子，它们是非负常数；r1和r2是两个介于(0，1)之间的随机数，增加了搜索的随机性，k表示当前迭代次数；
步骤6：重新计算新种群中每个粒子的适应度值，然后与历史个体的最优位置和种群的最优位置进行比较；如果适应度函数的值大于当前的最优值，那么将当前的参数(支持向量机的C和σ参数)替换最优的参数，否则保持原参数不变；
步骤7：预设最大迭代次数和适应度值的下限，验证每次迭代后的结果是否满足预设最大迭代次数和适应度值的下限要求，-如果条件没有满足则终止计算，回到步骤4重新计算每个粒子的适应度值；如果条件得到满足，程序结束，获得全局最优，即最优C和σ；
步骤8：将得到的粒子群最优位置(C，σ)分配到最小二乘支持向量机的预测模型中，得到最优预测模型；
步骤9：采用三个最小二乘支持向量机分别对剩余位置误差ΔPX，ΔPY，ΔPZ进行预测，最小二乘支持向量机的输入数据为机器人的关节角度集合θi＝[θ1，L，θ6]，输出数据为几何误差补偿后的剩余位置误差。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111608435.0A CN114147726B (zh) | 2021-12-27 | 2021-12-27 | 一种几何误差与非几何误差相结合的机器人标定方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111608435.0A CN114147726B (zh) | 2021-12-27 | 2021-12-27 | 一种几何误差与非几何误差相结合的机器人标定方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114147726A true CN114147726A (zh) | 2022-03-08 |
| CN114147726B CN114147726B (zh) | 2024-05-03 |
Family
ID=80452369
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111608435.0A Active CN114147726B (zh) | 2021-12-27 | 2021-12-27 | 一种几何误差与非几何误差相结合的机器人标定方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114147726B (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114474004A (zh) * | 2022-03-18 | 2022-05-13 | 河北工业大学 | 一种多因素耦合车载建筑机器人误差补偿规划控制策略 |
| CN117067221A (zh) * | 2023-10-16 | 2023-11-17 | 北京科技大学 | 基于六自由度工业机器人误差模型和交叉辨识方法及装置 |
| WO2024037174A1 (zh) * | 2022-08-15 | 2024-02-22 | 中国科学院宁波材料技术与工程研究所 | 基于位姿约束和力感知的机器人标定方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2917322A1 (fr) * | 2007-06-15 | 2008-12-19 | Commissariat Energie Atomique | Procede de calibration de la position d'un systeme poly-articule, notamment d'un robot |
| JP2014075031A (ja) * | 2012-10-04 | 2014-04-24 | Osaka Kiko Co Ltd | 幾何誤差同定方法と当該幾何誤差同定方法を使用した数値制御方法、数値制御装置及びマシニングセンタ |
| CN105773622A (zh) * | 2016-04-29 | 2016-07-20 | 江南大学 | 一种基于iekf的工业机器人绝对精度校准方法 |
| CN111771099A (zh) * | 2018-02-26 | 2020-10-13 | 瑞尼斯豪公司 | 坐标定位机 |
| CN112959354A (zh) * | 2019-12-13 | 2021-06-15 | 中国科学院沈阳自动化研究所 | 一种引入弹性变形的机械臂标定方法 |
-
2021
- 2021-12-27 CN CN202111608435.0A patent/CN114147726B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2917322A1 (fr) * | 2007-06-15 | 2008-12-19 | Commissariat Energie Atomique | Procede de calibration de la position d'un systeme poly-articule, notamment d'un robot |
| JP2014075031A (ja) * | 2012-10-04 | 2014-04-24 | Osaka Kiko Co Ltd | 幾何誤差同定方法と当該幾何誤差同定方法を使用した数値制御方法、数値制御装置及びマシニングセンタ |
| CN105773622A (zh) * | 2016-04-29 | 2016-07-20 | 江南大学 | 一种基于iekf的工业机器人绝对精度校准方法 |
| CN111771099A (zh) * | 2018-02-26 | 2020-10-13 | 瑞尼斯豪公司 | 坐标定位机 |
| CN112959354A (zh) * | 2019-12-13 | 2021-06-15 | 中国科学院沈阳自动化研究所 | 一种引入弹性变形的机械臂标定方法 |
Non-Patent Citations (1)
| Title |
|---|
| 戴智斌 等: "Delta 并联机器人机构参数误差分析及标定方法研究", 《机电一体化》, no. 03 * |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114474004A (zh) * | 2022-03-18 | 2022-05-13 | 河北工业大学 | 一种多因素耦合车载建筑机器人误差补偿规划控制策略 |
| CN114474004B (zh) * | 2022-03-18 | 2023-10-03 | 河北工业大学 | 一种多因素耦合车载建筑机器人误差补偿规划控制策略 |
| WO2024037174A1 (zh) * | 2022-08-15 | 2024-02-22 | 中国科学院宁波材料技术与工程研究所 | 基于位姿约束和力感知的机器人标定方法 |
| CN117067221A (zh) * | 2023-10-16 | 2023-11-17 | 北京科技大学 | 基于六自由度工业机器人误差模型和交叉辨识方法及装置 |
| CN117067221B (zh) * | 2023-10-16 | 2024-02-09 | 北京科技大学 | 基于六自由度工业机器人误差模型和交叉辨识方法及装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114147726B (zh) | 2024-05-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108908327B (zh) | 一种机器人定位误差分级补偿方法 | |
| CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
| CN114147726B (zh) | 一种几何误差与非几何误差相结合的机器人标定方法 | |
| CN110202582B (zh) | 一种基于三坐标平台的机器人标定方法 | |
| CN112873199B (zh) | 基于运动学与空间插值的机器人绝对定位精度标定方法 | |
| CN106777656B (zh) | 一种基于pmpsd的工业机器人绝对精度校准方法 | |
| CN110202575B (zh) | 一种用于工业测量的机器人目标轨迹精度补偿方法 | |
| CN109176505B (zh) | 一种基于球杆仪的六轴关节工业机器人空间误差标定方法 | |
| Jiang et al. | A new calibration method for joint-dependent geometric errors of industrial robot based on multiple identification spaces | |
| CN112318498B (zh) | 一种考虑参数耦合的工业机器人标定方法 | |
| CN111216164A (zh) | 一种机器人在线校准方法、系统、存储介质及校准设备 | |
| CN114131595B (zh) | 一种机器人6d位姿估计系统及方法 | |
| Cao et al. | Pose error compensation based on joint space division for 6-DOF robot manipulators | |
| CN113459094B (zh) | 一种工业机器人工具坐标系及零点自标定方法 | |
| Xiao et al. | A new fixed axis-invariant based calibration approach to improve absolute positioning accuracy of manipulators | |
| CN113211445A (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
| Deng et al. | Elasto-geometrical error and gravity model calibration of an industrial robot using the same optimized configuration set | |
| Santolaria et al. | Self-alignment of on-board measurement sensors for robot kinematic calibration | |
| Gao et al. | Kinematic calibration of industrial robots based on distance information using a hybrid identification method | |
| Bai et al. | Calibration method based on models and least-squares support vector regression enhancing robot position accuracy | |
| Li et al. | Efficient industrial robot calibration via a novel unscented Kalman filter-incorporated variable step-size Levenberg–Marquardt algorithm | |
| CN112720480B (zh) | 一种基于分级误差的机器人轨迹修正方法及系统 | |
| Shen et al. | A novel robot kinematic calibration method based on common perpendicular line model | |
| CN114131607B (zh) | 工业机器人广义运动学误差的运动学校准方法及系统 | |
| Zhao et al. | A new calibration method and experimental study for kinematic parameters of industrial robot |
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 | ||
| CB03 | Change of inventor or designer information | ||
| CB03 | Change of inventor or designer information |
Inventor after: Zhang He Inventor after: Pang Linjun Inventor after: Zhao Jie Inventor after: Chen Zhigang Inventor before: Zhang He Inventor before: Pang Linjun Inventor before: Zhao Jie |
|
| GR01 | Patent grant | ||
| GR01 | Patent grant |