CN110053051B - 工业串联机器人关节刚度系数辨识方法 - Google Patents
工业串联机器人关节刚度系数辨识方法 Download PDFInfo
- Publication number
- CN110053051B CN110053051B CN201910366001.0A CN201910366001A CN110053051B CN 110053051 B CN110053051 B CN 110053051B CN 201910366001 A CN201910366001 A CN 201910366001A CN 110053051 B CN110053051 B CN 110053051B
- Authority
- CN
- China
- Prior art keywords
- robot
- joint
- setting
- matrix
- tail end
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 206010023230 Joint stiffness Diseases 0.000 title claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims abstract description 29
- 239000003638 chemical reducing agent Substances 0.000 claims description 16
- 238000005259 measurement Methods 0.000 claims description 12
- 239000000126 substance Substances 0.000 claims description 12
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 3
- 230000004907 flux Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 238000005457 optimization Methods 0.000 description 3
- 238000012360 testing method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005498 polishing Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种工业串联机器人关节刚度系数辨识方法,包括工业串联机器人、机器人控制器、计算机、激光跟踪仪和安装激光靶标的工装;计算机分别与机器人控制器和激光跟踪仪数据连接,工业串联机器人与机器人控制器数据连接;安装激光靶标的工装与机器人末端固连接。本发明具有校准精度高、速度快,可实现刚度系数矩阵辨识和角度偏差校准的特点。
Description
技术领域
本发明涉及串联工业机器人技术领域,尤其是涉及一种基于激光跟踪仪进行高精度测量、对工业机器人刚度系数矩阵进行全局笛卡尔空间误差优化的辨识校准方法。
背景技术
随着机器人技术的发展,要求机器人能够完成更加复杂的任务,如工业机器人的打磨抛光、精密装配、钻孔焊接等。这些应用都要在机器人末端加载一个大质量的工装,而这个大质量的工装或者机器人本身的自重都会导致机器人杆件与关节的变形,从而导致机器人末端绝对定位精度下降。由于杆件与关节变形的影响,会导致机器人不能高质量地完成任务。
机器人在重载工况下,应力主要集中在机器人关节的减速器处。将减速器近似为线性扭簧模型,机器人关节的角度变形量与输出力矩成正比,比例关系即为关节刚度系数。通过辨识关节减速器的刚度系数,可以在任意点位估算各个关节角的角度变形量补偿回机器人控制器,提升机器人的绝对定位精度。
目前,常用的刚度系数辨识方法,如李骁的“一种工业机器人减速机扭转刚度试验台”,在试验台架上辨识单关节的刚度系数,操作繁琐。而通过模型法辨识得到的刚度系数可以同时辨识各个关节轴的刚度系数,修正关节角度提升机器人绝对定位精度。
发明内容
本发明的发明目的是为了克服现有技术中的刚度系数辨识操作繁琐、准确度差的不足,提供了一种基于激光跟踪仪进行高精度测量、对工业机器人刚度系数矩阵进行全局笛卡尔空间误差优化的辨识校准方法。
为了实现上述目的,本发明采用以下技术方案:
一种工业串联机器人关节刚度系数辨识方法,包括工业串联机器人、机器人控制器、计算机、激光跟踪仪和安装激光靶标的工装;计算机分别与机器人控制器和激光跟踪仪数据连接,工业串联机器人与机器人控制器数据连接;安装激光靶标的工装与机器人末端固连接;包括如下步骤:
(1-1)根据GB/T12642选择工业机器人灵活工作空间中立方体中的任意m个位置点,机器人控制器控制机器人末端到达选定的m个位置点,且固连于机器人末端的安装激光靶标的工装在每个位置点处姿态均朝向激光跟踪仪;
(1-4)计算机将辨识的刚度系数更新到机器人控制器中,完成对机器人的关节变形补偿。
本发明能够基于激光跟踪仪进行高精度测量、对工业机器人刚度系数辨识补偿关节角变形,进行全局笛卡尔空间误差优化。
机器人的末端负载及自重会导致机器人的关节角变形,进而影响机器人末端位置。机器人关节角度值偏差与机器人末端位置偏差关系可以通过雅克比矩阵表示。
作为优选,步骤(1-3)包括如下步骤:
(2-2)设定机器人末端位置偏差为
(2-3)设定机器人的雅克比矩阵为
(2-4)设定机器人各轴关节由电机-减速器-连杆组成,其中,直流伺服电机近似为线性模型,直流伺服电机的电磁特性公式为
(2-5)设定减速器为线性扭簧模型,杆件近似为刚体,则减速器的角度变形量与输入力矩成正比,减速器的输入力矩与变形量存在以下关系:
(2-6)设定机器人关节刚度矩阵为
(2-7)设定关节角度变形量与电机控制电流之间的关系为
(2-8)设定机器人关节柔度矩阵为
(2-9)设定关节角的偏差为
(2-11)每一次迭代过程中,将柔度系数向量加上上一次迭代值更新的柔度系数向量,柔度系数向量的初始值将所有元素均设置为0;
当本次迭代计算得到的柔度系数向量>R时,转入步骤(2-1),其中,R为修正阈值;
当本次迭代计算得到的柔度系数向量≤R时,得到修正后的刚度系数参数。
因此,本发明具有如下有益效果:校准精度高、速度快,可实现刚度系数矩阵辨识和角度偏差校准。
附图说明
图1是本发明的工业机器人和激光跟踪仪的一种结构示意图;
图2为本发明的一种流程图;
图3为本发明的一种校准前后绝对定位精度对比图。
图中:工业串联机器人1、激光靶标2、激光跟踪仪3。
具体实施方式
下面结合附图和具体实施方式对本发明做进一步的描述。
如图1、图2所示的实施例是一种工业串联机器人关节刚度系数辨识方法,包括工业串联机器人1、机器人控制器、计算机、激光跟踪仪3和安装激光靶标2的工装;计算机分别与机器人控制器和激光跟踪仪数据连接,工业串联机器人与机器人控制器数据连接;安装激光靶标的工装与机器人末端固连接;包括如下步骤:
步骤100,根据GB/T12642选择工业机器人灵活工作空间中立方体中的任意m个位置点,机器人控制器控制机器人末端到达选定的m个位置点,且固连于机器人末端的安装激光靶标的工装在每个位置点处姿态均朝向激光跟踪仪;
步骤302,设定机器人末端位置偏差为
步骤303,设定机器人的雅克比矩阵为
步骤304,设定机器人各轴关节由电机-减速器-连杆组成,其中,直流伺服电机近似为线性模型,直流伺服电机的电磁特性公式为
步骤305,设定减速器为线性扭簧模型,杆件近似为刚体,则减速器的角度变形量与输入力矩成正比,减速器的输入力矩与变形量存在以下关系:
步骤306,设定机器人关节刚度矩阵为
步骤307,设定关节角度变形量与电机控制电流之间的关系为
步骤308,设定机器人关节柔度矩阵为
步骤309,设定关节角的偏差为
步骤311,每一次迭代过程中,将柔度系数向量加上上一次迭代值更新柔度系数向量,柔度系数向量的初始值将所有元素均设置为0;
当本次迭代计算得到的柔度系数向量>R时,转入步骤300,其中,R为修正阈值;
当本次迭代计算得到的柔度系数向量≤R时,得到修正后的刚度系数参数。
步骤400,计算机将辨识的刚度系数更新到机器人控制器中,完成对机器人的关节变形补偿。
图3为本发明的一种校准前后绝对定位精度对比图。
应理解,本实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解,在阅读了本发明讲授的内容之后,本领域技术人员可以对本发明作各种改动或修改,这些等价形式同样落于本申请所附权利要求书所限定的范围。
Claims (2)
1.一种工业串联机器人关节刚度系数辨识方法,其特征是,包括工业串联机器人、机器人控制器、计算机、激光跟踪仪和安装激光靶标的工装;计算机分别与机器人控制器和激光跟踪仪数据连接,工业串联机器人与机器人控制器数据连接;安装激光靶标的工装与机器人末端固连接;包括如下步骤:
(1-1)根据GB/T12642选择工业机器人灵活工作空间中立方体中的任意m个位置点,机器人控制器控制机器人末端到达选定的m个位置点,且固连于机器人末端的安装激光靶标的工装在每个位置点处姿态均朝向激光跟踪仪;
(1-3-2)设定机器人末端位置偏差为
(1-3-3)设定机器人的雅克比矩阵为
(1-3-4)设定机器人各轴关节由电机-减速器-连杆组成,其中,直流伺服电机近似为线性模型,直流伺服电机的电磁特性公式为
(1-3-5)设定减速器为线性扭簧模型,杆件近似为刚体,则减速器的角度变形量与输入力矩成正比,减速器的输入力矩与变形量存在以下关系:
(1-3-6)设定机器人关节刚度矩阵为
(1-3-7)设定关节角度变形量与电机控制电流之间的关系为
(1-3-8)设定机器人关节柔度矩阵为
(1-3-9)设定关节角的偏差为
(1-3-11)每一次迭代过程中,将柔度系数向量加上上一次迭代值更新的柔度系数向量,柔度系数向量的初始值将所有元素均设置为0;
当本次迭代计算得到的柔度系数向量>R时,转入步骤(1-3-1),其中,R为修正阈值;
当本次迭代计算得到的柔度系数向量≤R时,得到修正后的刚度系数参数;
(1-4)计算机将辨识的刚度系数更新到机器人控制器中,完成对机器人的关节变形补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910366001.0A CN110053051B (zh) | 2019-04-30 | 2019-04-30 | 工业串联机器人关节刚度系数辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910366001.0A CN110053051B (zh) | 2019-04-30 | 2019-04-30 | 工业串联机器人关节刚度系数辨识方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110053051A CN110053051A (zh) | 2019-07-26 |
CN110053051B true CN110053051B (zh) | 2020-08-21 |
Family
ID=67322015
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910366001.0A Active CN110053051B (zh) | 2019-04-30 | 2019-04-30 | 工业串联机器人关节刚度系数辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110053051B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110480609B (zh) * | 2019-08-20 | 2021-07-30 | 南京涵铭置智能科技有限公司 | 一种位姿误差自补偿的码垛机器人及其码垛方法 |
CN112959354B (zh) * | 2019-12-13 | 2022-03-15 | 中国科学院沈阳自动化研究所 | 一种引入弹性变形的机械臂标定方法 |
CN111168717B (zh) * | 2019-12-20 | 2021-11-16 | 北京卫星制造厂有限公司 | 基于工业机器人刚度测量加载装置和关节刚度辨识方法 |
CN111267143A (zh) * | 2020-02-18 | 2020-06-12 | 清华大学 | 六自由度工业串联机器人关节刚度辨识方法及系统 |
CN112775974B (zh) * | 2021-01-20 | 2022-11-11 | 武汉科技大学 | 工业机器人铣削过程中的关节刚度辨识方法 |
CN113654747B (zh) * | 2021-09-26 | 2024-04-16 | 珠海格力智能装备有限公司 | 机器人的关节刚度的检测方法、装置和机器人 |
CN114918920B (zh) * | 2022-06-01 | 2023-11-21 | 浙江大学 | 一种基于神经网络和距离误差模型的工业机器人标定方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4756662A (en) * | 1986-03-31 | 1988-07-12 | Agency Of Industrial Science & Technology | Varible compliance manipulator |
CN105773622B (zh) * | 2016-04-29 | 2019-04-16 | 江南大学 | 一种基于iekf的工业机器人绝对精度校准方法 |
CN106737855B (zh) * | 2016-08-22 | 2019-07-02 | 南京理工大学 | 一种综合位姿误差模型与刚度补偿的机器人精度补偿方法 |
CN107704660B (zh) * | 2017-09-12 | 2021-01-19 | 大连理工大学 | 一种用于工业机器人的误差补偿方法 |
CN108406768B (zh) * | 2018-03-09 | 2021-11-19 | 汇川技术(东莞)有限公司 | 一种基于自重和负载变形补偿的机器人标定方法以及系统 |
CN109176531A (zh) * | 2018-10-26 | 2019-01-11 | 北京无线电测量研究所 | 一种串联型机器人运动学标定方法和系统 |
CN109434829B (zh) * | 2018-11-07 | 2022-07-29 | 华侨大学 | 一种立体石雕机器人加工系统的变形预测及补偿方法 |
-
2019
- 2019-04-30 CN CN201910366001.0A patent/CN110053051B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110053051A (zh) | 2019-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110053051B (zh) | 工业串联机器人关节刚度系数辨识方法 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN111730599B (zh) | 阻抗控制方法、装置、阻抗控制器和机器人 | |
CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
CN110370271B (zh) | 工业串联机器人的关节传动比误差校准方法 | |
CN106994686B (zh) | 关节外力力矩的计算方法及装置、机器人 | |
de Wit et al. | Theory of robot control | |
CN111531547B (zh) | 一种基于视觉测量的机器人标定及检测方法 | |
CN106777656B (zh) | 一种基于pmpsd的工业机器人绝对精度校准方法 | |
Xu et al. | Adaptive visual servoing for an underwater soft robot considering refraction effects | |
KR20160149649A (ko) | 비선형 관절 강성을 포함하는 로봇 캘리브레이션 방법 | |
CN107414827B (zh) | 基于线性反馈控制器的六自由度机械臂自适应检测方法 | |
CN108089441B (zh) | 空间拍机次镜六自由度精密调整机构标定算法和存储介质 | |
CN1974325A (zh) | 一种精确补偿摩擦的磁悬浮控制力矩陀螺框架伺服控制系统 | |
CN110715769A (zh) | 多点法质心测量设备的称重传感器受力点位置标定方法 | |
CN113211445B (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
CN113459094B (zh) | 一种工业机器人工具坐标系及零点自标定方法 | |
Klimchik et al. | Geometric and elastostatic calibration of robotic manipulator using partial pose measurements | |
CN110044385B (zh) | 一种大失准角情况下的快速传递对准方法 | |
CN115008476B (zh) | 基于等效运动学模型的机器人标定方法及设备 | |
Asada et al. | Joint torque measurement of a direct-drive arm | |
CN110815207B (zh) | 一种Stewart型并联柔索机器人运动学标定方法 | |
CN114161411A (zh) | 一种基于视觉的多足机器人运动学参数标定方法 | |
Titov et al. | Force-torque control implementation for 2 DoF manipulator | |
CN109909999B (zh) | 一种获取机器人tcp坐标的方法和装置 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240109 Address after: Building 033, Building 2, No. 15, Lane 587, Juxian Road, Ningbo High tech Zone, Ningbo City, Zhejiang Province, 315000, China, 7-1-1 Patentee after: ZHEJIANG PREMAX TECHNOLOGY CO.,LTD. Address before: 2-4 / F, building 4, standard workshop, 1418 Moganshan Road, Shangcheng District, Hangzhou City, Zhejiang Province, 310013 Patentee before: HANGZHOU VICON TECHNOLOGY Co.,Ltd. |