一种基于协同克里金的机械臂绝对定位误差估计方法技术

本发明专利技术公开了一种基于协同克里金的机械臂绝对定位误差估计方法，属于机器人技术领域。该方法所使用的装置由工业机械臂、激光跟踪仪以及靶球组成。靶球粘贴在机械臂末端法兰上，靶球作为工具中心点。该方法通过激光跟踪仪测得一些点的实际位置，然后得到这些点的理论位置和实际位置的位置误差，分别对X,Y,Z方向上位置误差及位置误差的模进行协同克里金插值，进而分别估计出机械臂运动空间中的点在X,Y,Z方向上的位置误差估计，即绝对定位误差估计。该发明专利技术方法具有不依赖机械臂的运动学模型，可以提高机械臂的绝对定位精度，不需要对机械臂非开源的控制器内部参数进行修改等优点。

A method of absolute positioning error estimation based on cooperative Krikin

The invention discloses a method for estimating the absolute positioning error of a robot arm based on cooperative Krikin, which belongs to the technical field of the robot. Device used in this method by the industrial manipulator, the laser tracker and the target ball. The target ball is pasted on the end flange of the mechanical arm. This method by laser tracker to measure the actual position of some points, and then get the position error of theoretical position and actual position of these points, respectively to X, Y, Z direction position error and position error of collaborative Krikin interpolation, and then estimate the mechanical arm movement points in space in X, Y and the estimated position error in the Z direction, the absolute positioning error estimation. The invention has the advantages that the kinematics model of the robot arm can not be relied on, and the absolute positioning accuracy of the robot arm can be improved.

【技术实现步骤摘要】

本专利技术涉及机器人技术，更具体地说，本专利技术涉及一种基于协同克里金的机械臂绝对定位误差估计方法。
技术介绍
随着现代制造业的和机器人工业水平的不断提高，机械臂已经被越来越多的制造厂商用来进行自动化生产活动中，如汽车制造、食品加工、航空航天制造、娱乐服务等。机械臂具有重复定位精度高，生产效率高等特点，但机械臂的绝对定位精度就不能满足实际自动化制造要求，所以对机械臂的绝对定位误差进行估计具有很大的必要性。现有的机械臂绝对定位误差估计方法主要是重新建立机械臂的精确运动学模型，并与理想的机械臂运动学模型进行对比，进而估计出机械臂的绝对定位误差，这些方法虽然可以求得运动学模型的误差，但是修改机械臂的非开源控制系统是很麻烦的，有时间并不具有可行性。机械臂的运动学模型是一个非线性的系统，但该运动学模型的绝对定位误差是各个关节角的函数，因此机械臂运动空间中相邻的点之间具有空间相关性，可以通过空间插值的方式对机械臂的绝对定位误差进行估计。协同克里金是一种对多个具有空间相关性的空间变量进行估计的空间插值方法。
技术实现思路
针对现有技术，本专利技术的目的在于提供了一种基于协同克里金的机械臂绝对定位误差估计方法，该方法通过激光跟踪仪测得一些点的实际位置，然后得到这些点的理论位置和实际位置的位置误差，分别对X,Y,Z方向上位置误差及位置误差的模进行协同克里金插值，进而分别估计出机械臂运动空间中的点在X,Y,Z方向上的位置误差估计，即绝对定位误差估计。本专利技术所使用的装置由机械臂、激光跟踪仪以及靶球组成。靶球粘贴在机械臂末端法兰上。本专利技术通过以下技术方案实现。该方法包括如下步骤：步骤1：将激光跟踪仪架设在地面上且位置不动，并将靶球粘贴在机械臂末端法兰上，使得激光跟踪仪的测量范围能够覆盖到机械臂的运动空间中；步骤2：将靶球作为TCP，TCP即为工具中心点，对TCP进行标定，获得靶球相对于机械臂末端法兰坐标系的位置关系；并将激光跟踪仪的坐标系统一到机械臂的基座标系；步骤3：编制数控程序控制机械臂依次到达n个点，这n个点均匀分布在机械臂的运动空间中，且它们的坐标值为理论位置，机械臂每到一个点，激光跟踪仪测量一次靶球，获取的坐标值为实际位置，求解实际位置与理论位置的位置误差及位置误差的模；步骤4：求解X方向上的位置误差与自身的交叉变异函数、位置误差模的与自身的交叉变异函数及X方向上的位置误差与位置误差模之间的交叉变异函数；步骤5：拟合交叉变异函数，根据变异函数理论从球状模型、指数模型、高斯模型、线性模型中选取合适的模型对步骤4中的交叉变异函数进行拟合；步骤6：求解机械臂操作空间中某点处的在X方向上的位置误差估计；步骤7：重复步骤4～6的操作分别求该点处的在Y方向和Z方向上的位置误差估计，进而可以求得在该点处的位置误差估计。与已有技术相比，本专利技术的有益效果在于：本专利技术所述的基于协同克里金的机械臂绝对定位精度估计方法，不依赖机械臂的运动学模型，可以提高机械臂的绝对定位精度，不需要对机械臂非开源的控制器内部参数进行修改等优点。附图说明图1为本专利技术中测量机械臂位置误差的布局轴侧图。图中：1.机械臂；2.靶球；3.激光跟踪仪；具体实施方式：下面通过结合附图对本专利技术作进一步说明。本专利技术的实施方式：参见图1，本专利技术所使用的装置由机械臂、激光跟踪仪以及靶球组成。靶球粘贴在机械臂末端法兰上。下面为本专利技术方法的步骤做详细的说明。本专利技术方法的具体实施步骤如下：步骤1：将激光跟踪仪架设在地面上且位置不动，并将靶球粘贴在机械臂末端法兰上，使得激光跟踪仪的测量范围能够覆盖到机械臂的运动空间中；步骤2：将靶球作为TCP，TCP即为工具中心点，对TCP进行标定，获得靶球相对于机械臂末端法兰坐标系的位置关系；并将激光跟踪仪的坐标系统一到机械臂的基座标系；步骤3：编制数控程序控制机械臂依次到达n个点Pk(xk,yk,zk),k＝1,2,…,n，这n个点均匀分布在机械臂的运动空间中，且它们的坐标值为理论位置，机械臂每到一个点，激光跟踪仪测量一次靶球，获取的坐标值P′k(x′k,y′k,z′k),k＝1,2,…,n为实际位置，实际位置与理论位置的位置误差为：e(Pk)＝[e1(Pk)e2(Pk)e3(Pk)]＝P′k-Pk,(k＝1,2,…,n)其中，e1(Pk)，e2(Pk)，e3(Pk)分别表示理论位置Pk在X、Y、Z方向的位置误差；位置误差的模为：步骤4：求解交叉变异函数，通过下式求取ei(P)和ej(P)(i,j＝1,4)的交叉变异函数；其中：γij(h)为交叉变异函数，N(h)为分隔距离为h的点对总数；步骤5：拟合交叉变异函数，根据变异函数理论从球状模型、指数模型、高斯模型、线性模型中选取合适的模型对交叉变异函数γij(h)(i,j＝1,4)进行拟合；拟合模型的公式见下式：球状模型：指数模型高斯模型线性模型其中：c0为块金值，a为编程，c0+c为基台值；步骤6：求解工业机械臂操作空间中某点P0处的在X方向上的位置误差估计位置误差估计通过下式求得：其中：为点P0处位置误差模的估计，Γk为2×2的矩阵，其元素为常数；Γk可通过下式求得：用矩阵可表示为如下形式：其中：为拉格朗日系数，I2为2×2的单位矩阵，O2为2×2的零矩阵，步骤7：重复步骤4～6的操作分别求点P0处的在Y方向和Z方向上的位置误差估计和进而可以求得在点P0处的位置误差估计本文档来自技高网...

【技术保护点】
一种基于协同克里金的机械臂绝对定位误差估计方法，其特征在于：本专利技术所使用的装置由机械臂、激光跟踪仪以及靶球组成；靶球粘贴；机械臂末端法兰上；该方法包括如下步骤：步骤1：将激光跟踪仪架设在地面上且位置不动，并将靶球粘贴在机械臂末端法兰上，使得激光跟踪仪的测量范围能够覆盖到机械臂的运动空间中；步骤2：将靶球作为TCP，TCP即为工具中心点，对TCP进行标定，获得靶球相对于机械臂末端法兰坐标系的位置关系；并将激光跟踪仪的坐标系统一到机械臂的基座标系；步骤3：编制数控程序控制机械臂依次到达n个点，这n个点均匀分布在机械臂的运动空间中，且它们的坐标值为理论位置，机械臂每到一个点，激光跟踪仪测量一次靶球，获取的坐标值为实际位置，求解实际位置与理论位置的位置误差及位置误差的模；步骤4：求解X方向上的位置误差与自身的交叉变异函数、位置误差模的与自身的交叉变异函数及X方向上的位置误差与位置误差模之间的交叉变异函数；步骤5：拟合交叉变异函数，根据变异函数理论从球状模型、指数模型、高斯模型、线性模型中选取合适的模型对步骤4中的交叉变异函数进行拟合；步骤6：求解机械臂操作空间中某点处的在X方向上的位置误差估计；步骤7：重复步骤4～6的操作分别求该点处的在Y方向和Z方向上的位置误差估计，进而可以求得在该点处的位置误差估计。...

【技术特征摘要】
1.一种基于协同克里金的机械臂绝对定位误差估计方法，其特征在于：本发明所使用的装置由机械臂、激光跟踪仪以及靶球组成；靶球粘贴；机械臂末端法兰上；该方法包括如下步骤：步骤1：将激光跟踪仪架设在地面上且位置不动，并将靶球粘贴在机械臂末端法兰上，使得激光跟踪仪的测量范围能够覆盖到机械臂的运动空间中；步骤2：将靶球作为TCP，TCP即为工具中心点，对TCP进行标定，获得靶球相对于机械臂末端法兰坐标系的位置关系；并将激光跟踪仪的坐标系统一到机械臂的基座标系；步骤3：编制数控程序控制机械臂依次到达n个点，这n个点均匀分布在机械臂的运动空间中，且它们的坐标值为理论位...

【专利技术属性】
技术研发人员：袁培江，陈冬冬，林敏青，曹双倩，刘元伟，蔡鹦，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京;11