CN206967526U - 一种基于三维力传感器的工业机器人标定装置 - Google Patents
一种基于三维力传感器的工业机器人标定装置 Download PDFInfo
- Publication number
- CN206967526U CN206967526U CN201720566859.8U CN201720566859U CN206967526U CN 206967526 U CN206967526 U CN 206967526U CN 201720566859 U CN201720566859 U CN 201720566859U CN 206967526 U CN206967526 U CN 206967526U
- Authority
- CN
- China
- Prior art keywords
- force sensor
- demarcation
- robot
- dimensional force
- measurement
- 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.)
- Expired - Fee Related
Links
- 238000005259 measurement Methods 0.000 claims abstract description 46
- 238000009434 installation Methods 0.000 claims abstract description 9
- 230000015572 biosynthetic process Effects 0.000 claims description 3
- 230000035945 sensitivity Effects 0.000 claims description 3
- 238000000034 method Methods 0.000 abstract description 11
- 238000010276 construction Methods 0.000 abstract description 4
- 238000011017 operating method Methods 0.000 abstract description 2
- 239000011159 matrix material Substances 0.000 description 8
- 238000010586 diagram Methods 0.000 description 4
- 230000003252 repetitive effect Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000001228 spectrum Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Landscapes
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
一种基于三维力传感器的工业机器人标定装置，包括标定测量组件和标定球组件，所述的标定测量组件安装在机器人末端法兰上，所述的标定球组件固定在机器人工作空间内，其中，所述的标定测量组件包括有连接底板，固定安装在所述连接底板一端的三维力传感器，以及通过螺栓固定安装在所述三维力传感器上端的测量球结构，所述连接底板的另一端形成有用于与所述机器人末端法兰相连接的法兰安装结构；所述的标定球组件包括有固定底座，固定安装在所述固定底座上端的连接件，以及通过螺栓固定安装在所述连接件上端且与所述的测量球结构相对应的标定球结构。本实用新型结构简单、标定方法操作步骤简单、标定精度高。
Description
技术领域
本实用新型涉及一种工业机器人标定装置。特别是涉及一种基于三维力传感器的工业机器人标定装置。
背景技术
随着机器人技术在各行各业中的广泛应用，业界对工业机器人的重复定位精度和绝对定位精度要求也越来越高。特别是离线编程技术的发展要求机器人必须具备很高的绝对定位精度。目前的工业机器人重复定位精度都比较高，一般在0.1mm以下，然而，绝对定位精度却很低，并且每台机器人的差别较大，严重制约了工业机器人的应用范围。研究表明，对于具有较高重复定位精度的机器人，可以通过运动学参数标定有效提高机器人的绝对定位精度，因此运动学参数标定已经成为机器人领域的研究热点。
运动学参数标定是指应用先进的测量设备和基于模型的参数辨识方法辨识出机器人模型的准确参数，从而提高机器人定位精度的过程，它包括：建模、测量、参数辨识和补偿四个步骤。传统的标定方法所建立的标定模型复杂，数据测量一般要借助激光跟踪仪、三坐标测量机、球杆仪等昂贵的精密测量仪器，并且涉及机器人基础坐标系与测量系统坐标系间的变换，容易引入外来误差，标定精度不高。
发明内容
本实用新型所要解决的技术问题是，提供一种结构简单、制造成本低、标定精度高的基于三维力传感器的工业机器人标定装置。
本实用新型所采用的技术方案是：一种基于三维力传感器的工业机器人标定装置，包括标定测量组件和标定球组件，所述的标定测量组件安装在机器人末端法兰上，所述的标定球组件固定在机器人工作空间内，其中，所述的标定测量组件包括有连接底板，固定安装在所述连接底板一端的三维力传感器，以及通过螺栓固定安装在所述三维力传感器上端的测量球结构，所述连接底板的另一端形成有用于与所述机器人末端法兰相连接的法兰安装结构；所述的标定球组件包括有固定底座，固定安装在所述固定底座上端的连接件，以及通过螺栓固定安装在所述连接件上端且与所述的测量球结构相对应的标定球结构。
所述的法兰安装结构包括有一体连接在所述连接底板的与所述机器人末端法兰相对应处的凸起，所述的凸起处向内凹进的形成有用于嵌入所述机器人末端法兰的凹槽，所述凹槽的底面上形成有用于与所述末端法兰固定连接的且贯穿连接底板的连接孔。
所述的测量球结构和标定球结构结构相同，包括有构成测量球结构中的测量球或构成标定球结构中的标定球的球体，固定连接在所述球体下端的连接杆，以及固定连接在所述连接杆下端的用于通过螺栓与所述的三维力传感器或所述的连接件固定连接的连接板，所述连接板上形成有用于插入螺栓的贯通孔。
所述的三维力传感器的量程为0-5Kg，输出灵敏度为1.0±10％mV/V。
本实用新型的一种基于三维力传感器的工业机器人标定装置，结构简单、制造成本低、安装方便，标定方法操作步骤简单、标定精度高。具有的优点和积极效果是：
1、相比于激光跟踪仪、三坐标测量机、球杆仪等昂贵的精密测量仪器，本实用新型成本低，安装方便，操作简单；
2、标定球组件可以固定在工业机器人工作空间内任意位置，可以对工业机器人整个工作空间进行标定；
3、标定算法不需要测量绝对位置，不涉及机器人基础坐标系与测量系统坐标系间的变换，标定精度高。
附图说明
图1是本实用新型基于三维力传感器的工业机器人标定装置中机器人和标定测量组件示意图；
图2是本实用新型基于三维力传感器的工业机器人标定装置中标定测量组件结构示意图；
图3是本实用新型基于三维力传感器的工业机器人标定装置中标定球组件结构示意图；
图4是本实用新型标定测量组件和标定球组件中的测量球结构或标定球结构的结构示意图；
图5是本实用新型中标定球球心到测量球球心的位置向量示意图。
图中
1：机器人 2：标定测量组件
21：连接底板 22：三维力传感器
23：测量球结构 24：法兰安装结构
241：凸起 242：底面
243：连接孔 3：标定球组件
31：固定底座 32：连接件
33：标定球结构 101：球体
102：连接杆 103：贯通孔
104：连接板
具体实施方式
下面结合实施例和附图对本实用新型的一种基于三维力传感器的工业机器人标定装置做出详细说明。
如图1、图2、图3所示，本实用新型的一种基于三维力传感器的工业机器人标定装置，包括标定测量组件2和标定球组件3，所述的标定测量组件2安装在机器人1末端法兰上，所述的标定球组件3固定在机器人1工作空间内，其中，所述的标定测量组件2包括有连接底板21，固定安装在所述连接底板21一端的三维力传感器22，以及通过螺栓固定安装在所述三维力传感器22上端的测量球结构23，所述的三维力传感器22的量程为0-5Kg，输出灵敏度为1.0±10％mV/V。所述连接底板21的另一端形成有用于与所述机器人1末端法兰相连接的法兰安装结构24；所述的标定球组件3包括有固定底座31，固定安装在所述固定底座31上端的连接件32，以及通过螺栓固定安装在所述连接件32上端且与所述的测量球结构23相对应的标定球结构33。
如图2所示，所述的法兰安装结构24包括有一体连接在所述连接底板21的与所述机器人1末端法兰相对应处的凸起241，所述的凸起241处向内凹进的形成有用于嵌入所述机器人1末端法兰的凹槽，所述凹槽的底面242上形成有用于与所述末端法兰固定连接的且贯穿连接底板21的连接孔243。
如图1、图2、图3、图4所示，所述的测量球结构23和标定球结构33结构相同，包括有构成测量球结构23中的测量球或构成标定球结构33中的标定球的球体101，固定连接在所述球体101下端的连接杆102，以及固定连接在所述连接杆102下端的用于通过螺栓与所述的三维力传感器22或所述的连接件32固定连接的连接板104，所述连接板104上形成有用于插入螺栓的贯通孔103。所述球体101最好具有一定的球面度、粗糙度，以保证标定精度。
下面结合图1～图5说明本实用新型的基于三维力传感器的工业机器人标定装置的标定方法，包括以下步骤：
1)将所述标定测量组件安装在工业机器人末端法兰上；
2)将所述标定球组件固定在工业机器人的工作空间内；
3)操作所述工业机器人，通过所述连接底板和三维力传感器将标定测量组件中所述的测量球结构中的测量球从两个以上的方向与标定球组件中所述的标定球结构中的标定球接触，所述三维力传感器记录每次测量球和标定球接触的接触力fi＝(fxi,fyi,fzi)，对应记录每次接触时所述工业机器人的关节转角数据θi；
4)多次改变所述标定球组件在所述工业机器人工作空间的位置，重复步骤3)m次，其中3m大于要标定的工业机器人运动学参数的个数；
5)根据步骤3)中所述三维力传感器记录的接触力fi＝(fxi,fyi,fzi)和对应记录的工业机器人关节转角数据θi，计算所述标定球球心位置pi＝pni+Jidω，根据所述标定球球心位置在所述工业机器人工作空间是固定的，建立m个标定约束方程，并得到矩阵形式的标定方程B＝Adω；当系数矩阵A列满秩时，根据最小二乘法求得所述工业机器人运动学参数误差向量dω＝(ATA)-1ATB。具体包括：
采用D-H法建立所述工业机器人的运动学模型，将连杆坐标系i-1到连杆坐标系i的齐次变换矩阵记作Ai，则机器人末端的法兰坐标系N相对机器人基础坐标系0的齐次变换矩阵为：
对测量球球心建立测量球坐标系E，所述测量球相对机器人末端法兰固定安装，法兰坐标系N到测量球坐标系E的齐次变换矩阵记作则测量球坐标系E相对机器人基础坐标系0的齐次变换矩阵为：
当操作所述工业机器人使所述测量球和标定球接触时，对所述标定球球心建立标定球坐标系B，通过所述三维力传感器记录的接触力fi＝(fxi,fyi,fzi)求得所述标定球球心到测量球球心的位置向量：其中为所述标定球球心到测量球球心的单位方向向量；r1,r2，分别为测量球和标定球的半径，则标定球坐标系B相对机器人基础坐标系0的齐次变换矩阵为：
提取标定球球心在所述机器人基础坐标系的位置分量为：pni＝f(θi,fi)，考虑所述机器人运动学参数误差，所述标定球球心在机器人基础坐标系的实际位置向量为：pi＝pni+Jidω，其中Ji为标定雅克比矩阵，dω为机器人运动学参数误差向量，当操作机器人使所述测量球以两个不同方向接触标定球时，可以得到两个位置方程为：
p1＝pn1+J1dω
p2＝pn2+J2dω
两式相减得：p2-p1＝pn2-pn1+(J2-J1)dω，根据两次接触时标定球球心在机器人基础坐标系的位置相同，建立标定约束方程：pn2-pn1＝(J1-J2)dω，多次改变所述标定球组件在所述工业机器人工作空间的位置，根据所建立的m个标定约束方程，得到矩阵形式的标定方程：
B＝Adω
其中B＝[(pn2-pn1)1；(pn2-pn1)2；…(pn2-pn1)m]，A＝[(J1-J2)1；(J1-J2)2；…(J1-J2)m]，m为改变所述标定球组件位置的次数；
当系数矩阵A列满秩时，根据最小二乘法求得所述工业机器人运动学参数误差向量：
dω＝(ATA)-1ATB。
Claims (4)
1.一种基于三维力传感器的工业机器人标定装置，包括标定测量组件(2)和标定球组件(3)，其特征在于，所述的标定测量组件(2)安装在机器人(1)末端法兰上，所述的标定球组件(3)固定在机器人(1)工作空间内，其中，所述的标定测量组件(2)包括有连接底板(21)，固定安装在所述连接底板(21)一端的三维力传感器(22)，以及通过螺栓固定安装在所述三维力传感器(22)上端的测量球结构(23)，所述连接底板(21)的另一端形成有用于与所述机器人(1)末端法兰相连接的法兰安装结构(24)；所述的标定球组件(3)包括有固定底座(31)，固定安装在所述固定底座(31)上端的连接件(32)，以及通过螺栓固定安装在所述连接件(32)上端且与所述的测量球结构(23)相对应的标定球结构(33)。
2.根据权利要求1所述的基于三维力传感器的工业机器人标定装置，其特征在于，所述的法兰安装结构(24)包括有一体连接在所述连接底板(21)的与所述机器人(1)末端法兰相对应处的凸起(241)，所述的凸起(241)处向内凹进的形成有用于嵌入所述机器人(1)末端法兰的凹槽，所述凹槽的底面(242)上形成有用于与所述末端法兰固定连接的且贯穿连接底板(21)的连接孔(243)。
3.根据权利要求1所述的基于三维力传感器的工业机器人标定装置，其特征在于，所述的测量球结构(23)和标定球结构(33)结构相同，包括有构成测量球结构(23)中的测量球或构成标定球结构(33)中的标定球的球体(101)，固定连接在所述球体(101)下端的连接杆(102)，以及固定连接在所述连接杆(102)下端的用于通过螺栓与所述的三维力传感器(22)或所述的连接件(32)固定连接的连接板(104)，所述连接板(104)上形成有用于插入螺栓的贯通孔(103)。
4.根据权利要求1所述的基于三维力传感器的工业机器人标定装置，其特征在于，所述的三维力传感器(22)的量程为0-5Kg，输出灵敏度为1.0±10％mV/V。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201720566859.8U CN206967526U (zh) | 2017-05-20 | 2017-05-20 | 一种基于三维力传感器的工业机器人标定装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201720566859.8U CN206967526U (zh) | 2017-05-20 | 2017-05-20 | 一种基于三维力传感器的工业机器人标定装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN206967526U true CN206967526U (zh) | 2018-02-06 |
Family
ID=61410224
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201720566859.8U Expired - Fee Related CN206967526U (zh) | 2017-05-20 | 2017-05-20 | 一种基于三维力传感器的工业机器人标定装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN206967526U (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107042527A (zh) * | 2017-05-20 | 2017-08-15 | 天津大学 | 一种基于三维力传感器的工业机器人标定装置及标定方法 |
-
2017
- 2017-05-20 CN CN201720566859.8U patent/CN206967526U/zh not_active Expired - Fee Related
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107042527A (zh) * | 2017-05-20 | 2017-08-15 | 天津大学 | 一种基于三维力传感器的工业机器人标定装置及标定方法 |
| CN107042527B (zh) * | 2017-05-20 | 2023-04-28 | 天津大学 | 一种基于三维力传感器的工业机器人标定装置及标定方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107042527A (zh) | 一种基于三维力传感器的工业机器人标定装置及标定方法 | |
| CN107042528B (zh) | 一种工业机器人的运动学标定系统及方法 | |
| CN109732596B (zh) | 基于六维虚拟关节模型的工业机器人刚度辨识系统及其辨识方法 | |
| CN106247932B (zh) | 一种基于摄影系统的机器人在线误差补偿装置及方法 | |
| CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
| CN109304730B (zh) | 一种基于激光测距仪的机器人运动学参数标定方法 | |
| CN106813638B (zh) | 一种3rps并联机器人几何参数辨识方法 | |
| CN105180962B (zh) | 一种基于空间两点投影的协同机器人基坐标系标定方法 | |
| JP2008522836A (ja) | 運動学的ロボット・モデル・パラメータ決定によって多関節ロボットにおいて改善された精度を提供する方法及びシステム | |
| CN103076131A (zh) | 用于测量大型机械臂大力与小力矩的六维力与力矩传感器 | |
| CN105066808B (zh) | 一种工业机器人运动学参数简易标定装置及其标定方法 | |
| CN112847341A (zh) | 工业机器人分步式标定系统及方法 | |
| CN106363605B (zh) | 带连杆变形误差检测的三自由度并联机构 | |
| CN104833324A (zh) | 一种基于测量头的机器人标定方法 | |
| CN109798855B (zh) | 机床的标定方法和系统 | |
| CN110103229A (zh) | 设于机器人末端的工具的重力补偿方法和系统 | |
| CN106584509B (zh) | 并联机器人的原点标定方法 | |
| TWI708667B (zh) | 運動裝置之位置與姿態校正裝置及系統與方法 | |
| CN113618738A (zh) | 一种机械臂运动学参数标定方法及系统 | |
| CN206967526U (zh) | 一种基于三维力传感器的工业机器人标定装置 | |
| CN111536877A (zh) | 一种三坐标测量机上的线激光传感器姿态标定方法 | |
| CN108088370A (zh) | 一种基于光栅尺及编码器的位置测量系统和测量方法 | |
| CN102506647B (zh) | 一种用于合拢管测量的球面坐标测量机 | |
| CN105806217B (zh) | 用于物体空间位置测量的单拉线式测量系统和方法 | |
| CN208043029U (zh) | 一种数控装置末端位置实时测量系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180206 |