CN209840976U - 一种用于工业机器人热形变误差补偿的测量装置 - Google Patents

一种用于工业机器人热形变误差补偿的测量装置 Download PDF

Info

Publication number
CN209840976U
CN209840976U CN201920983144.1U CN201920983144U CN209840976U CN 209840976 U CN209840976 U CN 209840976U CN 201920983144 U CN201920983144 U CN 201920983144U CN 209840976 U CN209840976 U CN 209840976U
Authority
CN
China
Prior art keywords
industrial robot
robot
thermal deformation
sensor
laser ranging
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.)
Active
Application number
CN201920983144.1U
Other languages
English (en)
Inventor
蔡阳
乔贵方
张颖
温秀兰
万其
宋光明
孙大林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Institute of Technology
Original Assignee
Nanjing Institute of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing Institute of Technology filed Critical Nanjing Institute of Technology
Priority to CN201920983144.1U priority Critical patent/CN209840976U/zh
Application granted granted Critical
Publication of CN209840976U publication Critical patent/CN209840976U/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)

Abstract

本实用新型公开了一种用于工业机器人热形变误差补偿的测量装置,所述测量装置包括机器人末端检测球装置与机器人末端定位检测装置,所述机器人末端检测球装置由连接件和检测球构成,安装在工业机器人的末端;所述机器人末端定位检测装置包括安装支架、传感器安装底盘和四个以上的激光测距传感器,所有激光测距传感器围成一圈,均匀地分布在传感器安装底盘上,且倾斜角均为45°,各激光测距传感器分别与机器人控制器连接,进行数据通信。本实用新型测量装置能够辅助实现对工业机器人运动学参数误差的准确辨识,提升工业机器人的末端定位精度,减少工业机器人停机维护时间,进一步提升生产线的自动化程度。

Description

一种用于工业机器人热形变误差补偿的测量装置
技术领域
本实用新型涉及工业机器人标定技术领域,具体为一种用于工业机器人热形变误差补偿的测量装置。
背景技术
随着机器人技术的发展,工业机器人逐渐在焊接、切削、装配等领域得到越来越广泛的应用。通过安装不同的末端工具,工业机器人能够完成多种作业任务。但随着工业机器人的持续运行,因环境温度变化、伺服电机散热、关节摩擦等都会导致工业机器人定位精度的下降,无法满足当前的作业任务需求,其主要原因是温度引起连杆与关节的热形变,从而导致机器人几何参数的变化,这也是影响工业机器人精度的主要因素。
目前针对工业机器人的热形变误差补偿的方法主要分为两类:(1)基于前期的实验测试数据,利用人工神经网络等技术建立工业机器人的热形变误差修正模型,根据该模型实现热形变误差的补偿;(2)利用人工周期性地完成机器人参数标定,重新修正工业机器人的几何参数,以此提高工业机器人的作业精度。但第一类方法会较大程度地受前期修正模型的建模精度影响,同时未能充分考虑其他未知影响因素。第二类方法离线地周期性标定会耗费大量的人力资源,较大程度地降低生产线的产能。目前也存在一些如基于视觉的机器人几何参数周期性标定方法,但该方法受环境光的影响较大。因此,亟待提出一种用于工业机器人热形变误差的快速在线检测装置,既能够保证工业机器人的误差补偿精度,又可以提高工业机器人生产线的自动化程度。
实用新型内容
本实用新型的技术目的是提供一种不受环境光影响,且具有较好测量精度、稳定性和较低价格的,可用于工业机器人热形变误差补偿的测量装置。
为实现上述技术目的,本实用新型提供的技术方案为:
一种用于工业机器人热形变误差补偿的测量装置,其特征在于,机器人末端检测球装置与机器人末端定位检测装置;
所述机器人末端检测球装置由连接件和检测球构成,所述连接件包括一法兰盘和一连接杆,连接杆的一端与检测球固定连接,另一端与法兰盘固定连接,连接件通过其法兰盘与工业机器人的末端法兰盘固定连接;
所述机器人末端定位检测装置包括安装支架、传感器安装底盘和由四个以上的激光测距传感器组成的激光测距传感器组,所述激光测距传感器组安装在传感器安装底盘上,且各激光测距传感器均位于同一测量平面上,激光发射方向均朝向传感器安装底盘的内侧,且相对于所述测量平面保持相同的倾斜夹角;所述测量平面与工业机器人基坐标系的XOY平面平行,各个激光测距传感器分别与机器人控制器连接,进行数据通信;所述传感器安装底盘则固定安装在安装支架顶部。
在上述方案的基础上,进一步改进或优选的方案还包括:
所述激光测距传感器在传感器安装底盘上围成一圈。
所述激光测距传感器均匀分布在传感器安装底盘上。
作为优选,所述激光测距传感器的激光发射方向与所述测量平面的夹角均为45°。
所述传感器安装底盘设有圆形的盘体,盘体周侧设有向上凸起的外沿,所述外沿设有均匀分布的若干固定槽,所述固定槽的数量不少于激光测距传感器的数量,由开设在外沿上的斜切口构成,用于安装所述激光测距传感器。
所述盘体的上表面与机器人末端定位检测装置的测量平面平行,所述斜切口的底面与盘体上表面的夹角为45°。
所述检测球的加工精度应满足球面上任一点到球心的距离误差不大于0.01mm。
所述激光测距传感器的数量为6个,以60°的圆心夹角均匀分布在传感器安装底盘上。
有益效果:
本实用新型用于工业机器人热形变误差补偿的测量装置,相比于视觉测量系统,此装置不受环境光的影响,具有较好的测量精度、稳定性和较低价格;相比于激光跟踪仪等测量设备,可以降低系统的造价较低;与专利申请号为201610351194.9的标定装置相比,降低了对机器人运动的依赖性,两个装置具有相同的价格,但是本申请测量装置的测量精度相对较高。
附图说明
图1是本实用新型热形变误差补偿测量装置的安装示意图;
图2是本实用新型的机器人末端检测球装置的示意图;
图3是本实用新型的机器人末端定位检测装置结构图;
图4是本实用新型的传感器安装底盘的结构图;
图5是本实用新型的传感器安装支架示意图;
图6是本实用新型的机器人末端定位检测示意图;
图7是本实用新型的机器人末端定位计算示意图。
具体实施方式
为了进一步阐明本实用新型的技术方案和工作原理,下面结合附图与具体实施例对本实用新型做详细的介绍。
如图1至图6所示的一种用于工业机器人热形变误差补偿的测量装置,包括机器人末端检测球装置3与机器人末端定位检测装置4等组成部分。本实施例中,所述机器人末端定位检测装置4与工业机器人2均设置在水平面上,使机器人末端定位检测装置4的测量平面与工业机器人2基坐标系的XOY平面平行
所述机器人末端检测球装置3由连接件301和检测球302构成,所述连接件301包括一法兰盘和一连接杆,连接杆的一端与检测球302固定连接,另一端与法兰盘固定连接,连接件301通过其法兰盘与工业机器人的末端法兰盘固定连接。检测球302球面的加工精度应优于0.01mm,即球面上任一点到球心的距离误差不大于0.01mm。
所述机器人末端定位检测装置4包括安装支架401、传感器安装底盘402和六个激光测距传感器403、404、405、406、407、408(激光测距传感器少于四个时,在计算过程中,多少会存在误差)。所述传感器安装底盘402设有圆形的盘体,盘体周侧设有向上凸起的外沿,所述外沿设有均匀分布的六个固定槽,所述固定槽由开设在外沿上的斜切口构成,用于安装激光测距传感器。六个激光测距传感器围成一圈,均匀地分布在传感器安装底盘402上,且倾斜角均为45°(斜切口的底面与所述基盘平面的夹角为45°),六个激光测距传感器分别通过RS-485总线与机器人控制器1连接,进行数据通信。而传感器安装底盘402通过位于其盘体中心的四个安装孔配合锁紧装置固定在安装支架401的顶部。
采用上述测量装置对工业机器人进行热形变误差补偿的工作原理为,首先,将经过精度校准后(即尚未产生热形变,精度满足作业要求)的工业机器人2,通过人工示教方法,将安装在工业机器人2末端的机器人末端检测球装置3移动至机器人末端定位检测装置4的检测范围内,使得六个激光测距传感器403、404、405、406、407、408均能够测量到检测球302,并且各个激光测距传感器403、404、405、406、407、408的数值大致相等;当工业机器人2工作连续工作一段时间后,即可能产生热形变时,可以根据初始人工示教的位姿周期性地进入机器人末端定位检测装置4的检测范围,判断工业机器人2的定位精度是否能够满足生产要求,若不满足,则进入具体的误差标定程序。
本实施例以六关节工业机器人为例,介绍本实用新型测量装置的一种使用方式,具体过程如下:
步骤1:将机器人末端检测球装置3安装在经过精度校准后的工业机器人2的末端,将机器人末端定位检测装置4设置在工业机器人2的一侧,将工业机器人2固定安装在生产线上;
通过人工示教的方法,将机器人末端检测球装置3移动至机器人末端定位检测装置4的检测范围内,使激光测距传感器组内的各个激光测距传感器均能够测量到所述检测球302,并获取工业机器人2的基坐标系ΦB与机器人末端定位检测装置4的测量坐标系ΦM之间的转换矩阵MRB,以及检测球302球心坐标到工业机器人2末端法兰盘坐标的转换矩阵RT,并将此时末端法兰盘在工业机器人基坐标系下的位置记为默认工具坐标点的名义位置PNj
步骤2:经过一段时间的运行后,控制工业机器人2按照人工示教的位姿进入到机器人末端定位检测装置4的检测范围内,判断工业机器人2的定位精度能否满足生产要求,若不满足,则进入以下步骤;
步骤3:变换工业机器人的末端位姿,通过控制工业机器人2,使机器人末端检测球装置3处于末端定位检测装置4的检测范围内,即各个激光测距传感器均能够检测到所述检测球302;
步骤4:将各个激光测距传感器的测量数据分别记为Li(i=1,2,…,6),建立每个激光测距传感器的局部坐标系Φi(i=1,2,…,6),根据传感器安装底盘402的结构参数,获得该局部坐标系Φi与机器人末端定位检测装置4的测量坐标系ΦM的转换矩阵为MRi
步骤5:将各个激光测距传感器射在检测球302表面上的各测量点,在局部坐标系Φi下的坐标记为根据坐标系转换关系,将测量点的坐标转换至机器人末端定位检测装置4的测量坐标系ΦM下,并记为PMi=(xi,yi,zi)(i=1,2,…,6);
步骤6:设Pr=(xr,yr,zr)为检测球302球心在机器人末端定位检测装置4的测量坐标系ΦM下的坐标,利用PMi=(xi,yi,zi)(i=1,2,…,6),可以得到6个球心距离公式,(xi-xr)2+(yi-yr)2+(zi-zr)2=r2(i=1,2,…,6);
步骤7:步骤6中的六个球心距离公式仅有三个未知参数,构成了超定方程组,利用最小二乘法可以计算出检测球302的球心在机器人末端定位检测装置4测量坐标系ΦM下的坐标Pr
根据步骤1中的两个转换矩阵MRB和RT,利用Pr计算得到此时末端法兰盘在工业机器人基坐标系下的坐标,记为默认工具坐标点的位置Pj,已知工业机器人2基坐标系下默认工具坐标点的名义位置为PNj,可得工业机器人2的定位误差ΔP=Pj-PNj,记录ΔP和工业机器人2各关节的空间坐标;
步骤8:重复执行步骤3至步骤7,且执行次数不少30次,一般可取50次;
步骤9:基于MDH模型参数法建立位置误差模型如下:
D=JθΔθ+JaΔa+JαΔα+JdΔd+JβΔβ
上式中:
D表示工业机器人末端的定位误差,即ΔP;
Δθ=[Δθ1 Δθ2...Δθ6]
Δα=[Δα1 Δα2...Δα6]
Δα=[Δa1 Δa2...Δα6]
Δd=[Δd1 Δα2...Δα6]
Δβ=[Δβ1 Δβ2...Δβ6]
所述MDH模型中(MDH模型为现有技术,此处不做展开介绍),工业机器人相邻两关节间的坐标系关系用四个参数描述,分别为关节转角θk、连杆扭角αk、连杆长度ak和关节距离dk,参数βk是相邻两关节轴Zk-1和Zk在平行于轴Xk和Zk的平面上的夹角;
k为关节的标号,k=1,2…6;
上述方括号中的Δθk、Δαk、Δak、Δdk、Δβk分别为第k个关节的上述五个参数的几何参量误差;
Δθ、Δα、Δa、Δd、Δβ分别为各关节上述参数几何参量误差的集合;
Jθ、Ja、Jα、Jd、Jβ为对应的雅克比矩阵;
将通过步骤7获得所有ΔP和与之对应的各关节空间坐标,带入工业机器人的位置误差模型中,利用最小二乘法计算得到相对准确的工业机器人2的运动学参数,将该运动学参数更新至机器人控制器1的控制模块中,实现对工业机器人2热形变误差的补偿。
在工业机器人的工作过程中,可周期性的执行步骤2,即每隔一段时间对工业机器人进行误差标定一次,以维持工业机器人的作业精度。
以上显示和描述了本实用新型的基本原理、主要特征和本实用新型的优点,本实用新型测量装置可实施但不限于实施上述方法。本行业的技术人员应该了解,本实用新型不受上述实施例的限制,上述实施例和说明书中描述的只是说明本实用新型的原理,在不脱离本实用新型精神和范围的前提下,本实用新型还会有各种变化和改进,本实用新型要求保护范围由所附的权利要求书、说明书及其等效物界定。

Claims (8)

1.一种用于工业机器人热形变误差补偿的测量装置,其特征在于,机器人末端检测球装置(3)与机器人末端定位检测装置(4);
所述机器人末端检测球装置由连接件(301)和检测球(302)构成,所述连接件(301)包括一法兰盘和一连接杆,连接杆的一端与检测球(302)固定连接,另一端与法兰盘固定连接,连接件(301)通过其法兰盘与工业机器人的末端法兰盘固定连接;
所述机器人末端定位检测装置(4)包括安装支架(401)、传感器安装底盘(402)和由四个以上的激光测距传感器组成的激光测距传感器组,所述激光测距传感器组安装在传感器安装底盘(402)上,且各激光测距传感器均位于同一测量平面上,激光发射方向均朝向传感器安装底盘(402)的内侧,且相对于所述测量平面保持相同的倾斜夹角;所述测量平面与工业机器人基坐标系的XOY平面平行,各个激光测距传感器分别与机器人控制器(1)连接,进行数据通信;所述传感器安装底盘(402)则固定安装在安装支架(401)顶部。
2.根据权利要求1所述的一种用于工业机器人热形变误差补偿的测量装置,其特征在于,所述激光测距传感器在传感器安装底盘(402)上围成一圈。
3.根据权利要求1或2所述的一种用于工业机器人热形变误差补偿的测量装置,其特征在于,所述激光测距传感器均匀分布在传感器安装底盘(402)上。
4.根据权利要求1所述的一种用于工业机器人热形变误差补偿的测量装置,其特征在于,所述激光测距传感器的激光发射方向与所述测量平面的夹角均为45°。
5.根据权利要求1所述的一种用于工业机器人热形变误差补偿的测量装置,其特征在于,所述传感器安装底盘(402)设有圆形的盘体,盘体周侧设有向上凸起的外沿,所述外沿设有均匀分布的若干固定槽,所述固定槽的数量不少于激光测距传感器的数量,由开设在外沿上的斜切口构成,用于安装所述激光测距传感器。
6.根据权利要求5所述的一种用于工业机器人热形变误差补偿的测量装置,其特征在于,所述盘体的上表面与机器人末端定位检测装置(4)的测量平面平行,所述斜切口的底面与盘体上表面的夹角为45°。
7.根据权利要求1所述的一种用于工业机器人热形变误差补偿的测量装置,其特征在于,所述检测球(302)的加工精度应满足球面上任一点到球心的距离误差不大于0.01mm。
8.根据权利要求1所述的一种用于工业机器人热形变误差补偿的测量装置,其特征在于,所述激光测距传感器的数量为6个,以60°的圆心夹角均匀分布在传感器安装底盘(402)上。
CN201920983144.1U 2019-06-27 2019-06-27 一种用于工业机器人热形变误差补偿的测量装置 Active CN209840976U (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201920983144.1U CN209840976U (zh) 2019-06-27 2019-06-27 一种用于工业机器人热形变误差补偿的测量装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201920983144.1U CN209840976U (zh) 2019-06-27 2019-06-27 一种用于工业机器人热形变误差补偿的测量装置

Publications (1)

Publication Number Publication Date
CN209840976U true CN209840976U (zh) 2019-12-24

Family

ID=68899219

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201920983144.1U Active CN209840976U (zh) 2019-06-27 2019-06-27 一种用于工业机器人热形变误差补偿的测量装置

Country Status (1)

Country Link
CN (1) CN209840976U (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111086023A (zh) * 2019-12-18 2020-05-01 南京熊猫电子股份有限公司 基于工业机器人内部温度的定位精度补偿方法及其使用方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111086023A (zh) * 2019-12-18 2020-05-01 南京熊猫电子股份有限公司 基于工业机器人内部温度的定位精度补偿方法及其使用方法

Similar Documents

Publication Publication Date Title
CN110174074B (zh) 一种用于工业机器人热形变误差补偿的测量装置及方法
CN109794938B (zh) 一种适用于曲面结构的机器人制孔误差补偿装置及其方法
CN108748159B (zh) 一种机械臂工具坐标系自标定方法
CN112873199B (zh) 基于运动学与空间插值的机器人绝对定位精度标定方法
CN107972071B (zh) 一种基于末端点平面约束的工业机器人连杆参数标定方法
CN102825602B (zh) 一种基于psd的工业机器人自标定方法及装置
CN109822574A (zh) 一种工业机器人末端六维力传感器标定的方法
CN109176517B (zh) 基于末端名义点约束的串联工业机器人连杆参数标定方法
US20080201015A1 (en) System for Calibration of an Industrial Robot and a Method Thereof
CN102601684B (zh) 基于间接测量法的高精度制孔机器人的工具参数标定方法
CN107741224A (zh) 一种基于视觉测量及标定的agv自动调姿定位方法
CN111037542B (zh) 一种逆动力学控制机器人直线加工的轨迹误差补偿方法
CN107457785B (zh) 一种基于关节反馈的机器人位置补偿方法
CN113146613B (zh) 一种工业机器人d-h参数三维自标定校准装置及方法
CN103659806A (zh) 一种工业机器人零位标定方法
CN110977963A (zh) 一种工业机器人标定系统的自适应对准控制方法
CN113618738B (zh) 一种机械臂运动学参数标定方法及系统
CN110370271A (zh) 工业串联机器人的关节传动比误差校准方法
CN111390914B (zh) 一种机器人零位和工具坐标标定方法
JPH06131032A (ja) ロボット装置およびロボット装置のティ−チング方法。
CN117506918A (zh) 一种工业机器人末端位姿校准方法
CN114505865B (zh) 一种基于位姿跟踪的机械臂路径生成方法及系统
CN209840976U (zh) 一种用于工业机器人热形变误差补偿的测量装置
CN113733155B (zh) 六轴工业机器人标定装置和标定方法
CN113211436B (zh) 基于遗传算法的六自由度串联机器人误差标定方法

Legal Events

Date Code Title Description
GR01 Patent grant
GR01 Patent grant
EE01 Entry into force of recordation of patent licensing contract
EE01 Entry into force of recordation of patent licensing contract

Assignee: Jiangsu source hi tech Service Co.,Ltd.

Assignor: NANJING INSTITUTE OF TECHNOLOGY

Contract record no.: X2024980001827

Denomination of utility model: A measurement device for compensating thermal deformation errors in industrial robots

Granted publication date: 20191224

License type: Common License

Record date: 20240204

EE01 Entry into force of recordation of patent licensing contract
EE01 Entry into force of recordation of patent licensing contract

Assignee: NANJING QIANWEI INTELLIGENT TECHNOLOGY CO.,LTD.

Assignor: NANJING INSTITUTE OF TECHNOLOGY

Contract record no.: X2024980003131

Denomination of utility model: A measurement device for compensating thermal deformation errors in industrial robots

Granted publication date: 20191224

License type: Common License

Record date: 20240322