一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法技术

本发明专利技术公开了一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，该方法首先规划机器人工作空间内理论路径，基于激光追踪仪多站位技术测量得到机器人坐标系下规划路径对应测量点的实际三维坐标，基于激光追踪仪多站位测量模型获得机器人末端定位误差；然后，基于机器人的运动学模型，构建描述工业机器人末端定位误差与24项运动学参数误差之间关系的定位误差模型；最后，利用LASSO算法对机器人24项运动学参数进行精确辨识，实现机器人工业机器人末端定位精度的提升。人工业机器人末端定位精度的提升。人工业机器人末端定位精度的提升。

【技术实现步骤摘要】
一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法


[0001]本专利技术涉及一种对工业机器人运动学参数误差辨识方法，特别是基于多站位激光追踪仪测量的技术方法，属于工业机器人运动学参数辨识和误差补偿领域。

技术介绍

[0002]随着工业机器人向精密加工和精密装配等领域的应用拓展，对其绝对定位精度的要求也越来越高，工业机器人现有绝对定位精度水平已很难满足要求，如何进一步提升工业机器人的绝对定位精度已成为当务之急。
[0003]工业机器人的绝对定位误差主要是由运动学参数误差造成的，占工业机器人末端总误差的90％以上。工业机器人的运动学参数误差补偿通常可分为四个方面：建立运动学模型，搭建测量系统获取定位误差，基于机器人运动学误差模型的参数辨识以及定位误差分析和补偿。机器人运动学参数辨识之前首先获得机器人的定位误差，常用的测量设备有：球杆仪、经纬仪、三坐标测量机、多目视觉测量系统，激光跟踪测量系统等。综合考虑测量精度、测量效率、测量范围和便携性，激光跟踪测量技术无疑是检测工业机器人末端定位误差的首选。由于激光跟踪仪测量的精度有限，且随测量范围的增大测量不确定度也会增大。而激光追踪仪采用标准球设计手段，其机械旋转轴的偏差不会显著影响测量精度，使得激光追踪仪空间距离的测量精度得到了大幅度提高。
[0004]本专利技术使用激光追踪仪多站位测量技术测量工业机器人的定位误差。获得工业机器人定位误差之后，建立误差模型，对机器人运动学参数进行辨识。常用最小二乘法进行参数辨识时，最小二乘计算量小且收敛速度较快，但是当复杂的系数矩阵为奇异矩阵时，将在数值计算过程中产生足以影响计算结果的误差，使得参数误差辨识精度降低。因此本专利技术提出一种LASSO算法对工业机器人运动学参数进行辨识，该算法在损失函数中引入正则化项，有效的解决了求解误差矩阵方程过程中，系数矩阵不可逆等问题，能更准确的辨识出运动学参数误差。

技术实现思路

[0005]引用(申请号/专利号：CN201610889315.5“一种基于激光追踪仪多站位测量的四轴机床标定方法”)中激光追踪仪多站位测量技术。本专利技术的目的是提供一种基于该激光追踪仪多站位技术的工业机器人运动学参数辨识方法，首先使用激光追踪仪多站位技术测量得到机器人坐标系下规划路径对应测量点的三维坐标，并基于激光追踪仪多站位测量模型获得机器人定位误差；然后，基于机器人的运动学模型，构建描述工业机器人末端定位误差与24项运动学参数误差之间关系的定位误差模型；最后，利用LASSO算法对机器人24项运动学参数进行精确辨识，实现工业机器人末端定位精度的提升。
[0006]为达到以上目的，本专利技术是采取如下技术方案予以实现的：
[0007]基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，该方法包括以下
步骤：
[0008]步骤一：规划工业机器人绝对定位误差测量的理论路径，获得机器人坐标系下规划路径对应测量点的理论三维坐标。
[0009]步骤二：构建工业机器人坐标系下的激光追踪仪多站位测量模型。
[0010]机器人坐标系下规划路径对应测量点的理论三维坐标P
i
(x
i
,y
i
,z
i
)，i＝1,2,3,
…
,n，n表示理论测量点的个数且为正整数；激光追踪仪的站位坐标为B
j
(X
j
,Y
j
,Z
j
)，其中j＝1,2,3,
…
,m，m表示站位坐标的个数且取正整数；激光追踪仪的站位B
j
到初始测量点P1的距离为d
j
；测量过程中由激光追踪仪测量猫眼反射镜的相对干涉长度为l
ij
。按三维空间两点距离公式建立下列关系式：
[0011][0012]方程个数为m
×
n，未知数个数为4m+3n。为使方程组可解应满足m
×
n≥4m+3n，则有m和n满足m≥4,n≥16。
[0013]步骤三：基于激光追踪仪多站位技术测量得到机器人坐标系下规划路径对应测量点的实际三维坐标。
[0014]步骤四：获得机器人末端定位误差。
[0015][0016]P
ai
(x
ai
,y
ai
,z
ai
)为机器人坐标系下规划路径对应测量点的实际三维坐标，ΔP
i
＝(Δx
i
,Δy
i
,Δz
i
)
T
为测量点i处的工业机器人的末端定位误差。
[0017]步骤五：用改进D
‑
H法对机器人进行运动学建模，构建相邻关节参考坐标系齐次变换矩阵。
[0018]步骤六：根据齐次转换矩阵建立工业机器人位置误差模型。
[0019]步骤七：利用LASSO算法求解工业机器人位置误差模型，准确辨识24项运动学参数误差
△
X。
[0020]为了求解24项运动学参数误差需要对数据进行预处理。
[0021]将系数矩阵J被标准化为均值为0且为单位长度。将由定位误差组成的矩阵ΔP标准化为均值为0，即
[0022][0023]式中u—方程式个数，u＝1,2,3,
…
,3n；
[0024]n—测量点个数；
[0025]p—第p个参数误差个数，p＝24。
[0026]可以得到一组线性回归系数使得则LASSO的优化目标为
[0027][0028]式中t—调和参数(大于等于零)，J为系数矩阵。
[0029]利用LASSO算法求得24项运动学参数误差。
[0030]综上所述，本专利技术与现有技术相比，具有如下优点和有益效果：
[0031](1)激光跟踪仪要得到机器人坐标系下的测量点的三维坐标需要建立激光跟踪仪坐标系与机器人坐标系之间的转换矩阵，该矩阵通常精度较差会引入一定的误差，而本专利技术采用激光追踪仪多站位技术测量工业机器人定位误差能够有效避免此误差的引入。
[0032](2)辨识工业机器人参数误差常用的算法是最小二乘法，通过激光追踪仪测量规划路径下的测量点的定位误差得到超定方程组，求出参数误差的最小二乘解。最小二乘法具有快速收敛且计算量小等优点，但是当复杂的系数矩阵为奇异矩阵，导致不可逆或成为一个病态矩阵时，通过普通最小二乘法求解的运动学参数误差是错误的，因此该方法并不稳定。而本专利技术采用LASSO算法通过在损失函数中引入正则化项，有效的解决了求解工业机器人位置误差模型过程中，系数矩阵不可逆等问题，能更准确的辨识出运动学参数误差，有效提高工业机器人的绝对定位误差。
附图说明
[0033]图1是激光追踪仪多站位技术测量工业机器人定位误差示意图；
[0034]图2是改进D
‑
H法运动学建模示意图。
具体实施方式...

【技术保护点】

【技术特征摘要】
1.一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，其特征在于：规划机器人工作空间内理论路径；构建工业机器人的激光追踪仪多站位测量模型；基于激光追踪仪多站位技术测量得到机器人坐标系下规划路径对应测量点的三维坐标；基于激光追踪仪多站位测量模型获得机器人末端定位误差；用改进D
‑
H法对机器人进行运动学建模，并构建相邻关节参考坐标系齐次变换矩阵；根据齐次转换矩阵建立工业机器人位置误差模型，表现工业机器人末端定位误差与24项运动学参数误差之间的关系；利用LASSO算法求解方程组准确辨识24项运动学参数误差ΔX。2.如权利要求1所述的一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，其特征在于，在工业机器人工作空间内规划球体运动路径，随机生成60个球面点。3.如权利要求1所述的一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，其特征在于，构建工业机器人的激光追踪仪多站位测量模型测量工业机器人的定位误差。4.如权利要求1所述的一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，其特征在于，考虑测量精度和实验所需时间，确定激光追踪仪测量模型为四站位。5.如权利要求1所述的一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，其特征在于，基于激光追踪仪多站位技术测量得到机器人坐标系下规划路径对应测量点的实际三维坐标。6.如权利要求1所述的一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，其特征在于，基于激光追踪仪多站位技术测量模型得到工业机器人末端定位误差。7.如权利要求1所述的一种基于激光追踪仪多站位技术的工业机器人运动学参数辨识方法，其特征在于，用改进D
‑
H法对机器人进行运动学建模：r为工业机器人的自由度个数，r＝1,2,3
…
,6；确定Z
r
轴方向为沿关节轴r的轴向；原点O
r
为关节轴r+1与r轴的交点或其公垂线与关节轴Z
r
的交点；X
r
轴沿公垂线a
r
...

【专利技术属性】
技术研发人员：陈洪芳，郭治博，
申请(专利权)人：北京工业大学，
类型：发明
国别省市：