基于局部POE的机器人运动学标定

导语:定位精度作为影响机器人性能的重要因素,需要对机器人进行标定来提高机器人的定位精度从而满足工业上的需要。

Question: 什么是机器人标定?为什么机器人需要标定?

Answer:机器人标定是指机器人运动学标定,为了使机器人本体达到与理论设计模型一致,提高机器人的点精度和轨迹精度或者能够完全以编程设定的动作运动,机器人在装配后需要进行标定工作。标定的方法主要有激光跟踪仪、拉线法、20点法等方法。

一. 标定过程

基于误差模型的标定方法可以提高机器人在整个空间里的精度。误差模型法通常分为四步:
1.建模:根据机器人的结构建立机器人运动学模型。
2.测量:利用外部设备测量末端执行器在某一坐标系下的实际位姿。
3.参数辨识:将机器人末端执行器的位姿误差代入误差模型得到机器人的几何参数误差。
4.参数补偿:将机器人的参数修改成计算出来的实际运动学参数。

1.1 建模

  建模方法使用指数积建立机器人的运动学模型。基于指数积的机械臂正运动学 。这种建模方法是全局POE运动学建模,之所以使用指数积建模是因为使用DH法建模时不满足完整性和连续性,而POE建模可以满足其标定模型的要求。

1.2 测量

  视觉捕捉Nokov红外测量或者使用激光传感器测量末端执行器在测量原坐标系下的位姿信息。

1.3 参数辨识

   机器人运动学参数辨识,采用的方法使用递归最小二乘法。

1.4 参数补偿

  几何参数补偿:这里采用局部POE方法标定,局部POE标定并不是还原实际的机器人几何参数,而是为了得到一台绝对精度更加准确的机器人,我们可以在标定完成之后更改机器人输入关节角使机器人走到理想的位置。

二. 基于局部POE的机器人正向运动学建模

旋量理论数学基础
全局POE运动学公式:(考虑末端执行器)

三. 基于局部POE的误差建立方法

3.1 采用位姿测量的误差模型

算例:6R型开链机器人

设理论位置为关节角为[0.1;0.1;0.1;0.1;0.1;0.1]的位姿

在这里插入图片描述

参数设置:设置位姿误差 δ y 小于1e-8时停止迭代,循环100次,迭代不出来视为求解失败。
运算结果:
在这里插入图片描述

在迭代26次后,停止了迭代,此时位姿成功迭代到实际位姿,再继续求逆解得到实际的关节角为[0.11;0.11;0.11;0.11;0.11;0.11],再将这组关节角输入给控制器,控制器根据这组关节角算出来的名义位置更加逼近于真实位姿,即使理论靠近实际,此时标定完成,显著地提高了机器人的绝对精度。

注:标定成功的最直接的验证方法是在机器人基坐标系下得到的测量位置与名义位置是否相同。在标定完成后,可以给机器人输入关节角观察机器人的名义位置和实际位置是否足够接近来观察标定是否成功。