CN106595485A - 一种基于协同克里金的机械臂绝对定位误差估计方法 - Google Patents
一种基于协同克里金的机械臂绝对定位误差估计方法 Download PDFInfo
- Publication number
- CN106595485A CN106595485A CN201710032023.4A CN201710032023A CN106595485A CN 106595485 A CN106595485 A CN 106595485A CN 201710032023 A CN201710032023 A CN 201710032023A CN 106595485 A CN106595485 A CN 106595485A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- site error
- point
- laser tracker
- target ball
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种基于协同克里金的机械臂绝对定位误差估计方法,属于机器人技术领域。该方法所使用的装置由工业机械臂、激光跟踪仪以及靶球组成。靶球粘贴在机械臂末端法兰上,靶球作为工具中心点。该方法通过激光跟踪仪测得一些点的实际位置,然后得到这些点的理论位置和实际位置的位置误差,分别对X,Y,Z方向上位置误差及位置误差的模进行协同克里金插值,进而分别估计出机械臂运动空间中的点在X,Y,Z方向上的位置误差估计,即绝对定位误差估计。该发明方法具有不依赖机械臂的运动学模型,可以提高机械臂的绝对定位精度,不需要对机械臂非开源的控制器内部参数进行修改等优点。
Description
技术领域
本发明涉及机器人技术,更具体地说,本发明涉及一种基于协同克里金的机械臂绝对定位误差估计方法。
背景技术
随着现代制造业的和机器人工业水平的不断提高,机械臂已经被越来越多的制造厂商用来进行自动化生产活动中,如汽车制造、食品加工、航空航天制造、娱乐服务等。机械臂具有重复定位精度高,生产效率高等特点,但机械臂的绝对定位精度就不能满足实际自动化制造要求,所以对机械臂的绝对定位误差进行估计具有很大的必要性。现有的机械臂绝对定位误差估计方法主要是重新建立机械臂的精确运动学模型,并与理想的机械臂运动学模型进行对比,进而估计出机械臂的绝对定位误差,这些方法虽然可以求得运动学模型的误差,但是修改机械臂的非开源控制***是很麻烦的,有时间并不具有可行性。机械臂的运动学模型是一个非线性的***,但该运动学模型的绝对定位误差是各个关节角的函数,因此机械臂运动空间中相邻的点之间具有空间相关性,可以通过空间插值的方式对机械臂的绝对定位误差进行估计。协同克里金是一种对多个具有空间相关性的空间变量进行估计的空间插值方法。
发明内容
针对现有技术,本发明的目的在于提供了一种基于协同克里金的机械臂绝对定位误差估计方法,该方法通过激光跟踪仪测得一些点的实际位置,然后得到这些点的理论位置和实际位置的位置误差,分别对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处的位置误差估计
Claims (1)
1.一种基于协同克里金的机械臂绝对定位误差估计方法,其特征在于:
本发明所使用的装置由机械臂、激光跟踪仪以及靶球组成;靶球粘贴;机械臂末端法兰上;
该方法包括如下步骤:
步骤1:将激光跟踪仪架设在地面上且位置不动,并将靶球粘贴在机械臂末端法兰上,使得激光跟踪仪的测量范围能够覆盖到机械臂的运动空间中;
步骤2:将靶球作为TCP,TCP即为工具中心点,对TCP进行标定,获得靶球相对于机械臂末端法兰坐标系的位置关系;并将激光跟踪仪的坐标***一到机械臂的基座标系;
步骤3:编制数控程序控制机械臂依次到达n个点,这n个点均匀分布在机械臂的运动空间中,且它们的坐标值为理论位置,机械臂每到一个点,激光跟踪仪测量一次靶球,获取的坐标值为实际位置,求解实际位置与理论位置的位置误差及位置误差的模;
步骤4:求解X方向上的位置误差与自身的交叉变异函数、位置误差模的与自身的交叉变异函数及X方向上的位置误差与位置误差模之间的交叉变异函数;
步骤5:拟合交叉变异函数,根据变异函数理论从球状模型、指数模型、高斯模型、线性模型中选取合适的模型对步骤4中的交叉变异函数进行拟合;
步骤6:求解机械臂操作空间中某点处的在X方向上的位置误差估计;
步骤7:重复步骤4~6的操作分别求该点处的在Y方向和Z方向上的位置误差估计,进而可以求得在该点处的位置误差估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710032023.4A CN106595485A (zh) | 2017-01-17 | 2017-01-17 | 一种基于协同克里金的机械臂绝对定位误差估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710032023.4A CN106595485A (zh) | 2017-01-17 | 2017-01-17 | 一种基于协同克里金的机械臂绝对定位误差估计方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106595485A true CN106595485A (zh) | 2017-04-26 |
Family
ID=58585808
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710032023.4A Pending CN106595485A (zh) | 2017-01-17 | 2017-01-17 | 一种基于协同克里金的机械臂绝对定位误差估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106595485A (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107270811A (zh) * | 2017-06-22 | 2017-10-20 | 深圳市恒科通机器人有限公司 | 定位测试方法及定位测试装置 |
CN107443388A (zh) * | 2017-10-11 | 2017-12-08 | 北京航空航天大学 | 一种基于泛克里金的机械臂绝对定位误差估计方法 |
CN107717988A (zh) * | 2017-10-11 | 2018-02-23 | 北京航空航天大学 | 一种基于泛克里金的工业机械臂精度标定方法 |
CN108177145A (zh) * | 2017-12-28 | 2018-06-19 | 北京航空航天大学 | 一种无偏最优的工业机械臂绝对定位精度标定方法 |
CN108214476A (zh) * | 2017-12-28 | 2018-06-29 | 北京航空航天大学 | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 |
CN108582076A (zh) * | 2018-05-10 | 2018-09-28 | 武汉库柏特科技有限公司 | 一种基于标准球的机器人手眼标定方法及装置 |
CN108759672A (zh) * | 2018-06-16 | 2018-11-06 | 复旦大学 | 工业机器人末端位置测量及位移误差补偿方法 |
CN108896999A (zh) * | 2018-05-11 | 2018-11-27 | 广州明珞汽车装备有限公司 | 一种全闭环高精度导航***及方法 |
CN109895082A (zh) * | 2017-12-07 | 2019-06-18 | 中国科学院沈阳自动化研究所 | 一种应用于航天装配设备的控制*** |
CN111844807A (zh) * | 2020-06-15 | 2020-10-30 | 西安交通大学 | 一种用于复合材料铺放设备的接触式自动标定装置及方法 |
CN112378332A (zh) * | 2020-10-15 | 2021-02-19 | 河北工业大学 | 一种工业机器人与激光跟踪仪坐标系对齐方法 |
CN113094642A (zh) * | 2021-04-14 | 2021-07-09 | 电子科技大学 | 一种面向区域内机械臂定位误差估算的新增采样的方法 |
CN113325430A (zh) * | 2021-05-10 | 2021-08-31 | 东风柳州汽车有限公司 | 末端执行器安装精度测量方法、装置、设备及存储介质 |
CN114536403A (zh) * | 2022-02-23 | 2022-05-27 | 广东博智林机器人有限公司 | 关节模组的定位精度测量***及方法 |
CN115026843A (zh) * | 2022-08-11 | 2022-09-09 | 佛山智能装备技术研究院 | 一种基于交叉激光传感器的自动tcp标定及纠偏方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104406585A (zh) * | 2014-11-19 | 2015-03-11 | 中国计量学院 | 基于惯性检测的激光跟踪仪靶球定位*** |
CN204329975U (zh) * | 2014-11-19 | 2015-05-13 | 中国计量学院 | 一种基于惯性检测的激光跟踪仪靶球定位装置 |
CN104646799A (zh) * | 2015-02-04 | 2015-05-27 | 北京石油化工学院 | 一种基于激光跟踪仪的电弧跟踪测试***及方法 |
-
2017
- 2017-01-17 CN CN201710032023.4A patent/CN106595485A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104406585A (zh) * | 2014-11-19 | 2015-03-11 | 中国计量学院 | 基于惯性检测的激光跟踪仪靶球定位*** |
CN204329975U (zh) * | 2014-11-19 | 2015-05-13 | 中国计量学院 | 一种基于惯性检测的激光跟踪仪靶球定位装置 |
CN104646799A (zh) * | 2015-02-04 | 2015-05-27 | 北京石油化工学院 | 一种基于激光跟踪仪的电弧跟踪测试***及方法 |
Non-Patent Citations (1)
Title |
---|
Y. ZENG ET AL.: "Positional error similarity analysis for error compensation of industrial robots", 《ROBOTICS AND COMPUTER-INTEGRATED MANUFACTURING》 * |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107270811A (zh) * | 2017-06-22 | 2017-10-20 | 深圳市恒科通机器人有限公司 | 定位测试方法及定位测试装置 |
CN107443388A (zh) * | 2017-10-11 | 2017-12-08 | 北京航空航天大学 | 一种基于泛克里金的机械臂绝对定位误差估计方法 |
CN107717988A (zh) * | 2017-10-11 | 2018-02-23 | 北京航空航天大学 | 一种基于泛克里金的工业机械臂精度标定方法 |
CN109895082A (zh) * | 2017-12-07 | 2019-06-18 | 中国科学院沈阳自动化研究所 | 一种应用于航天装配设备的控制*** |
CN108214476A (zh) * | 2017-12-28 | 2018-06-29 | 北京航空航天大学 | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 |
CN108177145A (zh) * | 2017-12-28 | 2018-06-19 | 北京航空航天大学 | 一种无偏最优的工业机械臂绝对定位精度标定方法 |
CN108582076A (zh) * | 2018-05-10 | 2018-09-28 | 武汉库柏特科技有限公司 | 一种基于标准球的机器人手眼标定方法及装置 |
CN108896999A (zh) * | 2018-05-11 | 2018-11-27 | 广州明珞汽车装备有限公司 | 一种全闭环高精度导航***及方法 |
CN108896999B (zh) * | 2018-05-11 | 2022-02-18 | 广州明珞汽车装备有限公司 | 一种全闭环高精度导航***及方法 |
CN108759672A (zh) * | 2018-06-16 | 2018-11-06 | 复旦大学 | 工业机器人末端位置测量及位移误差补偿方法 |
CN108759672B (zh) * | 2018-06-16 | 2020-04-24 | 复旦大学 | 工业机器人末端位置测量及位移误差补偿方法 |
CN111844807B (zh) * | 2020-06-15 | 2021-10-08 | 西安交通大学 | 一种用于复合材料铺放设备的接触式自动标定装置及方法 |
CN111844807A (zh) * | 2020-06-15 | 2020-10-30 | 西安交通大学 | 一种用于复合材料铺放设备的接触式自动标定装置及方法 |
CN112378332A (zh) * | 2020-10-15 | 2021-02-19 | 河北工业大学 | 一种工业机器人与激光跟踪仪坐标系对齐方法 |
CN113094642A (zh) * | 2021-04-14 | 2021-07-09 | 电子科技大学 | 一种面向区域内机械臂定位误差估算的新增采样的方法 |
CN113325430A (zh) * | 2021-05-10 | 2021-08-31 | 东风柳州汽车有限公司 | 末端执行器安装精度测量方法、装置、设备及存储介质 |
CN114536403A (zh) * | 2022-02-23 | 2022-05-27 | 广东博智林机器人有限公司 | 关节模组的定位精度测量***及方法 |
CN115026843A (zh) * | 2022-08-11 | 2022-09-09 | 佛山智能装备技术研究院 | 一种基于交叉激光传感器的自动tcp标定及纠偏方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106595485A (zh) | 一种基于协同克里金的机械臂绝对定位误差估计方法 | |
CN106799745A (zh) | 一种基于协同克里金的工业机械臂精度标定方法 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN108731591B (zh) | 一种基于平面约束的机器人工具坐标系标定方法 | |
CN108748159B (zh) | 一种机械臂工具坐标系自标定方法 | |
CN109159151A (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和*** | |
CN104729407B (zh) | 机器人基坐标系与世界坐标系之间关系的自动确定方法 | |
CN110148187B (zh) | 一种SCARA机械手Eye-in-Hand的高精度手眼标定方法和*** | |
CN109794963B (zh) | 一种面向曲面构件的机器人快速定位方法 | |
CN112025772B (zh) | 一种基于视觉测量的机械臂自主标定方法 | |
CN108942918A (zh) | 一种基于线结构光的立体定位方法 | |
CN108214476A (zh) | 基于改进型径向基神经网络的机械臂绝对定位精度标定方法 | |
CN110524371B (zh) | 基于实时力控的复杂曲面恒定切除率的机器人打磨方法 | |
CN114161425B (zh) | 一种工业机器人的误差补偿方法 | |
CN113160334B (zh) | 一种基于手眼相机的双机器人***标定方法 | |
CN108195327B (zh) | 一种基于机器人的附加轴标定方法及终端 | |
CN107796276B (zh) | 一种估算工业机器人绝对定位精度的装置及方法 | |
CN108177145A (zh) | 一种无偏最优的工业机械臂绝对定位精度标定方法 | |
CN112659112A (zh) | 一种基于线激光扫描仪的机器人手眼标定方法 | |
CN110962127B (zh) | 一种用于机械臂末端位姿辅助标定装置及其标定方法 | |
CN114310880A (zh) | 一种机械臂标定方法及装置 | |
CN107717988A (zh) | 一种基于泛克里金的工业机械臂精度标定方法 | |
CN114488944A (zh) | 一种基于插值的伺服走位误差补偿方法 | |
Marshall et al. | Kalman filter visual servoing control law | |
CN117204200B (zh) | 基于丝杠运动的名优茶单芽采摘装置及方法 |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170426 |