CN111037542A - 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 - Google Patents
一种逆动力学控制机器人直线加工的轨迹误差补偿方法 Download PDFInfo
- Publication number
- CN111037542A CN111037542A CN201911415179.6A CN201911415179A CN111037542A CN 111037542 A CN111037542 A CN 111037542A CN 201911415179 A CN201911415179 A CN 201911415179A CN 111037542 A CN111037542 A CN 111037542A
- Authority
- CN
- China
- Prior art keywords
- robot
- joint
- pose
- tail end
- deviation
- 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.)
- Granted
Links
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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/023—Cartesian coordinate type
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- 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
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明属于机器人铣削加工领域,并公开了一种逆动力学控制机器人直线加工的轨迹误差补偿方法。该方法包括下列步骤:(a)获取机器人末端在笛卡尔空间中的实际位姿和实际速度;(b)实时测量不同时刻机器人末端在笛卡尔空间中实际位姿和期望位姿之间的位姿偏差和速度偏差;(c)构建实际位姿、位姿偏差与机器人末端每个关节的关节角加速度的关系式(一),计算获得机器人末端每个关节的关节角加速度;(d)构建关节角加速度与每个关节的驱动扭矩之间的关系式(二),计算获得每个关节的驱动扭矩,以此补偿所述位姿偏差和速度偏差,进而实现机器人直线加工的轨迹补偿。通过本发明,实现机器人加工误差补偿,加工精度高,补偿效率快。
Description
技术领域
本发明属于机器人铣削加工领域,更具体地,涉及一种逆动力学控制机器人直线加工的轨迹误差补偿方法。
背景技术
大型结构件上的装配面具有较高的直线度要求,由于轨迹精度低和刚性差,现有的工业机器人加工***难以满足加工精度要求,因此需要开发工业机器人高精直线运动的实时补偿技术。
在机器人铣削加工过程中,切削力与工艺***变形的耦合作用不可避免,不同于机床的铣削加工,由于机器人的弱刚度特性及其非线性分布特征,机器人铣削加工的变形量更大且变形方向更加复杂,在机器人铣削加工中,受力变形为正常服役机器人铣削加工误差的重要来源,而误差辨识与补偿则是提高机器人铣削加工精度的有效手段。
目前,德国Hamburg University of Technology的Cordes等人Offlinesimulation of path deviation due to joint compliance and hysteresis for robotmachining(2017),利用传统刚度模型实验辨识机器人ABB IRB 6660的关节刚度,以及关节的迟滞现象并测出反向误差,Klimchik等学者Efficiency evaluation of robots inmachining applications using industrial performance measure(2017),基于机器人刚度模型与偏差预测的思想,也都成功实现了对工业机器人铣削加工***刚度特性研究和偏差的补偿;上海交通大学熊刚等的Stiffness-based pose optimization of anindustrial robot for five-axis milling(2019),基于机器人的刚度模型和变形误差,优化机器人五轴铣削的位置和姿态,以提高加工精度。上述方法虽然根据刚度特性获得了机器人加工中的变形误差,但是,不能实现机器人末端直线轨迹中加工偏差计算和补偿。故急需一种针对机器人直线加工轨迹中偏差的实时补偿方法。
发明内容
针对现有技术的以上缺陷或改进需求,本发明提供了一种逆动力学控制机器人直线加工的轨迹误差补偿方法,通过建立机器人的逆动力学闭环控制,对机器人末端的关节角的驱动扭矩进行补偿,实现机器人加工误差补偿,加工精度高,补偿效率快。
为实现上述目的,按照本发明,提供了一种逆动力学控制机器人直线加工的轨迹误差补偿方法,该方法包括下列步骤:
(a)对于六轴机器人的直线加工过程,获取其在时刻t下机器人末端在笛卡尔空间中的实际位姿xe和实际速度;
(c)构建在时刻t下的机器人末端的实际位姿xe、位姿偏差与机器人末端每个关节的关节角加速度的关系式(一),并利用该关系式计算获得机器人末端每个关节的关节角加速度;
(d)将机械臂***等效为一个在关节空间中有多个广义弹簧单元的机械***,以此构建机器人关节末端每个关节的关节角加速度与每个关节的驱动扭矩之间的关系式(二),利用该关系式计算获得每个关节的驱动扭矩,采用该驱动扭矩对机器人末端的每个关节进行驱动,以此补偿所述位姿偏差和速度偏差进而实现机器人直线加工的轨迹补偿。
进一步优选地,在步骤(a)中,所述机器人末端在笛卡尔空间中的实际位姿xe优选采用DH矩阵k(q)获得,如下:
xe=k(q)
其中,k(q)是在关节角为q时的DH矩阵。
进一步优选地,在步骤(b)中,所述位姿偏差是在笛卡尔坐标系中机器人末端在y和z轴方向的位置偏差,设定x方向的位置和各个方向的角度偏差为0。
进一步优选地,在步骤(b)中,所述位姿偏差优选按照下列步骤获得:
(b1)在空载状态下,机器人末端按照预设的加工轨迹走刀,获得每个时刻机器人末端的位姿P1;
(b2)负载状态下,机器人末端按照预设的加工轨迹走刀,获得每个时刻机器人末端的位置P2;
(b3)建立几何关系,计算笛卡尔坐标系中y和z轴方向上的机器人末端位置误差,即所需的位姿偏差。
进一步优选地,在步骤(b3)中,所述几何关系按照下列表达式进行:
其中,ΔY是y轴方向的位置误差,ΔZ是z轴方向的位置误差,θ是机器人工作台水平面与预设倾斜面的夹角,l22是机器人的末端位置P2到预设倾斜面的垂直距离,l21是机器人的末端位置P1到预设倾斜面的垂直距离,l12是机器人的末端位置P2到水平面的垂直距离,l11是机器人的末端位置P1到水平面的垂直距离。
其中,xd是预设的机器人末端位姿。
进一步优选地,在步骤(c)中,所述关系式(一)按照下列表达式进行:
进一步优选地,在步骤(d)中,所述关系式(二)按照下列表达式进行:
总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:
1、本发明作为一种机器人高精度直线加工的轨迹误差在线测量与补偿方法,是实现机器人铣削加工过程中末端直线轨迹偏差的实时检测,消除机器人几何误差和变形误差对机器人轨迹精度的影响,提高机器人直线轨迹铣削加工精度的有效方法;
2、本发明采用基于逆动力学控制的轨迹误差实时补偿策略,考虑机器人末端与环境之间的控制交互,直接根据笛卡尔空间监测获得的末端位姿偏差进行反馈的大闭环控制策略,对误差的补偿精度高,尤其适用于在直线加工中,对关节角的误差补偿效率和准确度高。
附图说明
图1是按照本发明的优选实施例所构建的逆动力学控制机器人直线加工的轨迹误差补偿方法流程图;
图2是按照本发明的优选实施例所构建的逆动力学控制框图;
图3是按照本发明的优选实施例所构建的测量机器人末端位姿偏差示意图;
图4是按照本发明的优选实施例所构建的测量机器人末端位姿偏差的预设倾斜面结构示意图;
图5是按照本发明的优选实施例所构建的机器人高精度直线加工的轨迹误差在线测量与补偿的总体流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
如图1所示,一种逆动力学控制机器人直线加工的轨迹误差补偿方法,该方法包括下列步骤:
如图4所示,机器人末端直线运动轨迹误差的测量,具体测量方法概述如下:第一步,在机器人水平工作台上放置平尺,该平尺有两个标准平面,其一为水平面,其二为与水平面成一定夹角的倾斜面;第二步,在机器人末端固定激光位移传感器,使用测头1对准平尺的水平面,使用测头2对准平尺的倾斜面,并保证合适的参考距离;第三步,使机器人沿平尺方向走直线轨迹进行铣削实验,测量获得机器人沿平尺方向运动的激光位移传感器数据;第四步,对比激光位移数据与参考值的偏差,获得传感测头的偏离量。
如图3所示,机器人末端激光位移传感器数据与轨迹误差数据的计算原理图,机器人沿理想直线轨迹运动的实时坐标为P1,对应的激光位移传感器参考数据为:测头1为l11,测头2为l21。机器人实际运动轨迹坐标为P2,对应的激光位移传感器测量数据为:测头1为l12,测头2为l22。测头1与测头2的安装夹角θ与平尺两平面的夹角θ′为互补关系。ΔZ为机器人末端在竖直方向的变形误差,ΔY为机器人末端在水平面上垂直于进给方向的变形误差。
使用激光位移传感器数据计算机器人实时位置误差的公式为:
y是关节角加速度,KP是比例增益矩阵,KD是微分增益矩阵,是笛卡尔空间的加速度偏差量,是笛卡尔空间的速度偏差量,是笛卡尔空间的位置偏差量,是雅克比矩阵相对于关节角q的逆矩阵,是雅克比矩阵相对于关节角q的一阶导数。
(4)将机械臂***等效为一个在关节空间中有n个广义弹簧单元的机械***,通过反映常值刚度的反馈增益矩阵计算产生控制输入的广义力u每个关节的驱动扭矩,使得笛卡尔空间偏差减小。
如图5所示,是按照本发明提供的方法对机器人进行逆动力学控制的硬件示意图,图中通过机器人控制器采集机器人末端关节轴运动的位置、速度和加速度数据,通过激光位移传感器测量对机器人末端的位置数据、并计算得到机器人末端速度数据,通过与机器人末端理论位置对比得到位置偏差,综合以上数据,采用逆动力学模型计算关节轴的扭矩,实现机器人的直线加工的高精度误差监测和补偿。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (8)
1.一种逆动力学控制机器人直线加工的轨迹误差补偿方法,其特征在于,该方法包括下列步骤:
(a)对于六轴机器人的直线加工过程,获取其在时刻t下机器人末端在笛卡尔空间中的实际位姿xe和实际速度;
(c)构建在时刻t下的机器人末端的实际位姿xe、位姿偏差与机器人末端每个关节的关节角加速度的关系式(一),并利用该关系式计算获得机器人末端每个关节的关节角加速度;
2.如权利要求1所述的一种逆动力学控制机器人直线加工的轨迹误差补偿方法,其特征在于,在步骤(a)中,所述机器人末端在笛卡尔空间中的实际位姿xe优选采用DH矩阵k(q)获得,如下:
xe=k(q)
其中,k(q)是在关节角为q时的DH矩阵。
3.如权利要求1所述的一种逆动力学控制机器人直线加工的轨迹误差补偿方法,其特征在于,在步骤(b)中,所述位姿偏差是在笛卡尔坐标系中机器人末端在y和z轴方向的位置偏差,设定x方向的位置和各个方向的角度偏差为0。
4.如权利要求3所述的一种逆动力学控制机器人直线加工的轨迹误差补偿方法,其特征在于,在步骤(b)中,所述位姿偏差优选按照下列步骤获得:
(b1)在空载状态下,机器人末端按照预设的加工轨迹走刀,获得每个时刻机器人末端的位姿P1;
(b2)负载状态下,机器人末端按照预设的加工轨迹走刀,获得每个时刻机器人末端的位置P2;
(b3)建立几何关系,计算笛卡尔坐标系中y和z轴方向上的机器人末端位置误差,即所需的位姿偏差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911415179.6A CN111037542B (zh) | 2019-12-31 | 2019-12-31 | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911415179.6A CN111037542B (zh) | 2019-12-31 | 2019-12-31 | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111037542A true CN111037542A (zh) | 2020-04-21 |
CN111037542B CN111037542B (zh) | 2021-04-06 |
Family
ID=70242588
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911415179.6A Active CN111037542B (zh) | 2019-12-31 | 2019-12-31 | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111037542B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112775974A (zh) * | 2021-01-20 | 2021-05-11 | 武汉科技大学 | 工业机器人铣削过程中的关节刚度辨识方法 |
CN112847373A (zh) * | 2021-01-12 | 2021-05-28 | 成都卡诺普自动化控制技术有限公司 | 一种机器人轨迹同步控制方法、计算机可读存储介质 |
CN113197752A (zh) * | 2021-04-30 | 2021-08-03 | 华中科技大学 | 一种上肢康复机器人的肢体重力动态补偿方法 |
CN114393448A (zh) * | 2022-01-21 | 2022-04-26 | 中国科学院长春光学精密机械与物理研究所 | 一种提高磁流变机器人抛光设备轨迹精度的方法 |
CN114505890A (zh) * | 2020-11-16 | 2022-05-17 | 达明机器人股份有限公司 | 机器人安全补偿重量的***及方法 |
CN114700962A (zh) * | 2022-03-22 | 2022-07-05 | 南京航空航天大学 | 一种用于长臂展高空作业复合机器人的末端位姿精度补偿方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10127076A (ja) * | 1996-10-17 | 1998-05-15 | Nippon Reliance Kk | 電動機の状態帰還制御方法および装置 |
CN106338521A (zh) * | 2016-09-22 | 2017-01-18 | 华中科技大学 | 增材制造表面及内部缺陷与形貌复合检测方法及装置 |
CN107704660A (zh) * | 2017-09-12 | 2018-02-16 | 大连理工大学 | 一种用于工业机器人的误差补偿方法 |
US20180067086A1 (en) * | 2016-09-08 | 2018-03-08 | Linestream Technologies | Method for automatically identifying resonance |
CN109454281A (zh) * | 2018-12-21 | 2019-03-12 | 华中科技大学无锡研究院 | 一种机器人铣削加工中的螺旋桨工件坐标系标定方法 |
CN109746915A (zh) * | 2019-01-18 | 2019-05-14 | 埃夫特智能装备股份有限公司 | 一种提升工业机器人绝对定位精度的运动学方法 |
CN209533402U (zh) * | 2019-01-18 | 2019-10-25 | 华中科技大学无锡研究院 | 一种螺旋桨机器人加工工件坐标系标定*** |
-
2019
- 2019-12-31 CN CN201911415179.6A patent/CN111037542B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10127076A (ja) * | 1996-10-17 | 1998-05-15 | Nippon Reliance Kk | 電動機の状態帰還制御方法および装置 |
US20180067086A1 (en) * | 2016-09-08 | 2018-03-08 | Linestream Technologies | Method for automatically identifying resonance |
CN106338521A (zh) * | 2016-09-22 | 2017-01-18 | 华中科技大学 | 增材制造表面及内部缺陷与形貌复合检测方法及装置 |
CN107704660A (zh) * | 2017-09-12 | 2018-02-16 | 大连理工大学 | 一种用于工业机器人的误差补偿方法 |
CN109454281A (zh) * | 2018-12-21 | 2019-03-12 | 华中科技大学无锡研究院 | 一种机器人铣削加工中的螺旋桨工件坐标系标定方法 |
CN109746915A (zh) * | 2019-01-18 | 2019-05-14 | 埃夫特智能装备股份有限公司 | 一种提升工业机器人绝对定位精度的运动学方法 |
CN209533402U (zh) * | 2019-01-18 | 2019-10-25 | 华中科技大学无锡研究院 | 一种螺旋桨机器人加工工件坐标系标定*** |
Non-Patent Citations (1)
Title |
---|
张明豪等: "螺旋桨叶面加工误差在线测量及补偿", 《组合机床与自动化加工技术》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114505890A (zh) * | 2020-11-16 | 2022-05-17 | 达明机器人股份有限公司 | 机器人安全补偿重量的***及方法 |
CN112847373A (zh) * | 2021-01-12 | 2021-05-28 | 成都卡诺普自动化控制技术有限公司 | 一种机器人轨迹同步控制方法、计算机可读存储介质 |
CN112847373B (zh) * | 2021-01-12 | 2022-07-26 | 成都卡诺普机器人技术股份有限公司 | 一种机器人轨迹同步控制方法、计算机可读存储介质 |
CN112775974A (zh) * | 2021-01-20 | 2021-05-11 | 武汉科技大学 | 工业机器人铣削过程中的关节刚度辨识方法 |
CN113197752A (zh) * | 2021-04-30 | 2021-08-03 | 华中科技大学 | 一种上肢康复机器人的肢体重力动态补偿方法 |
CN114393448A (zh) * | 2022-01-21 | 2022-04-26 | 中国科学院长春光学精密机械与物理研究所 | 一种提高磁流变机器人抛光设备轨迹精度的方法 |
CN114393448B (zh) * | 2022-01-21 | 2023-11-28 | 中国科学院长春光学精密机械与物理研究所 | 一种提高磁流变机器人抛光设备轨迹精度的方法 |
CN114700962A (zh) * | 2022-03-22 | 2022-07-05 | 南京航空航天大学 | 一种用于长臂展高空作业复合机器人的末端位姿精度补偿方法 |
CN114700962B (zh) * | 2022-03-22 | 2023-09-29 | 南京航空航天大学 | 一种用于长臂展高空作业复合机器人的末端位姿精度补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111037542B (zh) | 2021-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111037542B (zh) | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 | |
CN109822577B (zh) | 一种基于视觉伺服的移动式机器人高精度加工方法 | |
CN109848983B (zh) | 一种高顺应性人引导机器人协同作业的方法 | |
CN112873199B (zh) | 基于运动学与空间插值的机器人绝对定位精度标定方法 | |
CN108839027B (zh) | 基于激光测距传感器的机器人自动对准控制方法 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN112008492B (zh) | 一种龙门数控机床平动轴垂直度误差辨识方法 | |
US8554502B2 (en) | Method for calculating probe mounting position in on-machine measuring device | |
US20210291310A1 (en) | Direct pose feedback control method and direct pose feedback controlled machine | |
CN113580148B (zh) | 基于等效运动链的并联机器人运动学标定方法 | |
Shen et al. | Asymptotic trajectory tracking of manipulators using uncalibrated visual feedback | |
CN111546334B (zh) | 一种减小轮廓误差的工业机器人在线位姿误差补偿方法 | |
CN113927599B (zh) | 绝对精度补偿方法及***、设备和计算机可读存储介质 | |
CN109591019B (zh) | 一种无确定性定位特征物体的空间精确定位方法 | |
Saund et al. | High accuracy articulated robots with CNC control systems | |
CN111409067B (zh) | 一种机器人用户坐标系自动标定***及其标定方法 | |
CN112198837B (zh) | 一种基于混合控制的飞机结构件定位单位入位方法 | |
CN111515928B (zh) | 机械臂运动控制*** | |
CN110666794A (zh) | 多自由度协作机器人拖动的末端负载力补偿方法 | |
CN108445765B (zh) | 一种飞机自动钻铆并联调姿托架的标定方法 | |
CN107726982A (zh) | 一种激光测距传感器安装位置误差标定方法 | |
CN111716355A (zh) | 机器人绝对定位精度补偿***及方法 | |
EP4037877B1 (en) | A method for determining placement of parallel-kinematic machine joints, and a parallelkinematic machine with high stiffness | |
Sazonnikova et al. | Increasing of the industrial robot movement accuracy at the incremental forming process | |
CN111502863B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |