CN112533738A - 用于估计扭转的方法 - Google Patents
用于估计扭转的方法 Download PDFInfo
- Publication number
- CN112533738A CN112533738A CN201880096495.9A CN201880096495A CN112533738A CN 112533738 A CN112533738 A CN 112533738A CN 201880096495 A CN201880096495 A CN 201880096495A CN 112533738 A CN112533738 A CN 112533738A
- Authority
- CN
- China
- Prior art keywords
- measured
- torsion
- component
- robot
- components
- 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
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000005259 measurement Methods 0.000 claims description 23
- 238000007476 Maximum Likelihood Methods 0.000 claims description 4
- 238000007670 refining Methods 0.000 claims description 2
- 239000011159 matrix material Substances 0.000 description 12
- 239000013598 vector Substances 0.000 description 11
- 239000000126 substance Substances 0.000 description 7
- 239000012636 effector Substances 0.000 description 4
- 230000005484 gravity Effects 0.000 description 2
- 238000003754 machining Methods 0.000 description 2
- 230000003190 augmentative effect Effects 0.000 description 1
- 238000005219 brazing Methods 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 238000005498 polishing Methods 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
- 210000003857 wrist joint Anatomy 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/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39261—Calculate driving torque from dynamic model, computed torque method variant
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39264—Torque control using hardware designed for position control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39319—Force control, force as reference, active compliance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39343—Force based impedance control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
本发明关于一种用于估计作用在机器人的参考点上的扭转的方法,其包括如下步骤:a)测量扭转的至少一个、但是并非所有分量;以及b)基于机器人的动态模型同时考虑测量分量来估计扭转的非测量分量。
Description
技术领域
本发明涉及一种用于估计作用在机器人的参考点(reference point)、例如其工具中心点(TCP)上的扭转(wrench,有时也称为偶单力组)的方法。
背景技术
在机器人学中,扭转是六维的矢量,其中三个分量描述作用在参考点上的力,且另外三个分量定义施加到所述相同点上的力矩。
如果工业机器人要以力控制的方式运行,其通常装备有6自由度(DOF)力/力矩(F/T)传感器,其测量在三个平移方向上的接触力和围绕所有三个轴线的接触力矩。基于该信息,可在一个或几个方向上主动地控制接触力和力矩例如用于装配、磨削或抛光。虽然6DOF F/T测量结果提供了较高质量的F/T信息,需要用于该目的的传感器是较贵的。
作为测量的备选,接触力和力矩也可基于机器人的动态模型来估计。这样的力和力矩的估计不需要力和力矩传感器;需要的唯一的输入是定义机器人的各个关节的角度的数据,以及当前在马达上的数据或从其中可计算马达力矩的任何其它的数据。因为这些数据对于控制机器人的任何运动是必要的,提供其的力控制或非力控制的设备通常存在于机器人***中且可无另外的成本地被用于提供输入到动态模型中。
估计的力和力矩的质量很大程度上取决于机器人的动态模型允许预测在机器人关节中的摩擦的精度。该预测可能是较难的,因为存在机器人的许多系数,其对摩擦具有影响但是其可能并非所有已知,或者其不能够以期望的精度来测量或预测。
发明内容
本发明的目的是提供一种用于估计扭转的方法,其能够以较低的成本实现较高的精度。
该目的通过一种方法来实现,其包括以下步骤:
a) 通常使用机器人的内置的传感器测量扭转的至少一个、但是并非所有分量,以及
b) 基于机器人的动态模型同时考虑测量分量来估计扭转的非测量分量。
实施该方法的成本可保持成较低,不仅因为传感器的总数量与6 DOF F/T测量方法相比可被减少,而且因为扭转的被选择进行测量的一个或多个分量能够是提供最好的成本收益比的那个或那些。
例如,测量力可能比测量力矩更优选,因为精确的力矩测量结果可能需要在力敏元件与相对于其测量力矩的轴线之间的一定的间距,而力测量不需要,使得力传感器可适应更小的空间。
从成本和收益的观点来看,无额外的传感器可将扭转估计的精度提高成多于第一传感器所做的。因此,在优选的实施例中,测量分量的数量是1。
此外,优选的是,测量分量平行于机器人表面的延伸经过参考点的表面法线。以那种方式,可精确地测量在机器人与触碰表面的外部物体之间的接触力,并且不存在由物体沿着表面滑动使测量结果失真的风险。备选地,该分量可平行于如下方向,参考点在加工工件时在该方向上前进,使得在加工期间能够精确地测量作用在工件上的压力。
存在各种通过其能够考虑一个或多个测量分量的方法。
其中之一是通过最大似然估计、即通过找到非测量分量的那些值(对于这些值,测量实际被测量的被测量分量的值的可能性是最高的)来估计非测量分量。
另一方法基于卡尔曼滤波器(Kalman filter)的原理。卡尔曼滤波器可设置成具有坐标和在各种自由度中机器人的速度作为其状态。将至少一个被测量分量作为状态测量结果输入所述卡尔曼滤波器中,使得其在基于卡尔曼滤波器的测量状态预测未来的状态时将被考虑。
又另一方法包括(作为步骤b)的子步骤)仅基于动态模型来计算扭转的第一估计、并且使用最大后验估计来改进第一估计的步骤。
附图说明
本发明的另外的特征和优点将通过参考附图的其实施例的如下描述而显而易见。
图1是本发明适用于其的机器人***的示意图。
具体实施方式
图1的机器人***包括机器人臂1和关联的控制器2。机器人臂1包括基座3、末端执行器4、任意数量的链节5i(i=1,2,…)和关节6j(j=1,2,…),其将链节5i彼此连接、连接到基座3处或连接到末端执行器4处。出于简洁起见,本文将假定每个关节包括一旋转自由度、即可围绕单独的轴线7旋转。给定的链节5i可相对于邻近的链节5(i+1)或5(i-1)围绕两个不同的轴线旋转;在该情况中,尽管该连接在实际中可能由单独的球形关节形成,本文将假定链节由两个分别具有一旋转自由度的关节来连接。
每个这样的关节6j包括用于驱动其旋转的马达和用于将关节6j的旋转角度反馈到控制器2的旋转编码器(rotational encoder)。
末端执行器4是任何期望类型的工具,例如夹具、焊接或钎焊工具、机加工工具、磨削工具等,或在图1的示例中是钻子(drill)。钻子包括钻头8和插槽9,钻头8可拆卸地安装在该插槽9中且可围绕轴线7旋转地来驱动且在钻孔期间沿着轴线7前进。插槽9容纳力传感器10,其设计用于探测沿着轴线7的力分量。
众所周知,在工具中心点(TCP)11、例如钻头8的尖端处的外部的力和力矩根据以下引起关节载荷力矩
其中,是相对于基座框架的操作器TCP的雅克比矩阵(Jacobian)。将扭转分成,其中,包含可通过机器人的可用的低维度传感器、例如通过在图1的情形中的传感器10来直接测量的分量,且包含因机器人臂1缺少适当的传感器而无法测量的分量。假定轴线7的方向是z方向,和可写成
其中,是包含的所有非零分量(是测量的扭转分量的数量)的矢量且是雅克比矩阵转置的简写版,在其中对应于扭转的测量分量的所有的列已经被移除。注意,在是操作器自由度(DoF)的数量的情况下,。因此,具有的行比列多。该冗余允许提高对于扭转的剩余的(非测量的)分量的F/T估计的质量。
即在关节载荷力矩估计中的误差通常以零平均值来分布。假定马达力矩和重力补偿非常精确地已知,可通过确定在摩擦模型中每个关节的误差的标准差(例如通过在不带有外部载荷和限定工具的验证动作(validation motion)期间采集关节载荷力矩估计)得到协方差矩阵(covariance matrix)。
利用在关节空间中的该先验信息,可通过最大似然估计估计扭转的剩余的分量,如
其对应于雅克比矩阵转置的标准伪逆(pseudo-inverse)。
备选地,可使用关于摩擦模型的质量的定性信息(qualitative information)。为了做到这样,对应于主要关节的对角元素可设置成比对应于腕关节的元素更大的值(仅元素的比值关系到估计)。
根据用于组合测量和计算的扭转分量的第二方法,扭转的第一估计无关于测量结果来计算,使用以下表达式
在下一步骤中,计算扭转的第二估计。在该步骤中,所有可直接测量的力和力矩由对应的测量结果来替代。对于非测量方向,保留初始的估计。这形式化为
然后基于等式(11)的第一估计通过最大后验估计得到扭转的改进的估计:
根据第三方法,将关节水平载荷力矩信息和从低维度的F/T传感器、例如传感器10所采集的测量结果组合成增强测量矢量(augmented measurement vector)y。该矢量y包括个分量,是机器人的自由度的数量,且是扭转的测量分量的数量。机器人的运动通过如下来建模
卡尔曼滤波器实施成包括作为其状态矢量(state vector)。如在技术中常见的那样,卡尔曼滤波器基于当前的状态矢量使用等式15预测未来的状态矢量。该预测得出广义的动量以及扭转二者的变化。计算出在广义的动量以及扭转的至少一个测量分量的预测值与测量值之间的差异。如在现有技术中常见的那样,该差异被用于更新状态矢量,但是因为数据的总量比在仅基于机器人的动态模型常规地预测力和力矩的情况下更高而不依赖力或力矩的测量结果,改进了预测。
参考符号
1 机器人臂
2 控制器
3 基座
4 末端执行器
5 链节
6 关节
7 轴线
8 钻头
9 插槽
10 传感器
11 TCP。
Claims (7)
1. 一种用于估计作用在机器人的参考点上的扭转的方法,其包括如下步骤:
a) 测量所述扭转的至少一个、但是并非所有分量,以及
b) 基于所述机器人的动态模型同时考虑测量分量来估计所述扭转的非测量分量。
2.根据权利要求1所述的方法,其中,步骤b)包括所述非测量分量的最大似然估计。
3.根据权利要求1所述的方法,其中,步骤b)包括仅基于所述动态模型计算所述扭转的第一估计,并且使用最大后验估计来改进所述第一估计。
4.根据权利要求1所述的方法,其中,所述扭转通过卡尔曼滤波器来预测且所述至少一个测量分量作为状态测量结果输入所述卡尔曼滤波器中。
5.根据前述权利要求中任一项所述的方法,其中,在所述扭转的所述测量分量之中存在至少一个力分量且/或在所述非测量分量之中存在至少一个力矩分量。
6.根据前述权利要求中任一项所述的方法,在其中所述测量分量的数量是1。
7.根据前述权利要求中任一项所述的方法,其中,所述测量分量平行于机器人表面的表面法线,其延伸经过所述参考点或向如下方向延伸,所述参考点在加工工件时在该方向上前进。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/EP2018/071631 WO2020030272A1 (en) | 2018-08-09 | 2018-08-09 | Method for estimating a wrench |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112533738A true CN112533738A (zh) | 2021-03-19 |
Family
ID=63209394
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201880096495.9A Pending CN112533738A (zh) | 2018-08-09 | 2018-08-09 | 用于估计扭转的方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US11279027B2 (zh) |
EP (1) | EP3833515A1 (zh) |
CN (1) | CN112533738A (zh) |
WO (1) | WO2020030272A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102021108417B3 (de) * | 2021-04-01 | 2022-03-24 | Franka Emika Gmbh | Ermitteln eines externen Kraftwinders an einem Robotermanipulator |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012135825A (ja) * | 2010-12-24 | 2012-07-19 | Mitsubishi Electric Corp | 力制御装置 |
CN104180818A (zh) * | 2014-08-12 | 2014-12-03 | 北京理工大学 | 一种单目视觉里程计算装置 |
CN104416579A (zh) * | 2013-09-03 | 2015-03-18 | 中国科学院沈阳自动化研究所 | 一种中空式智能模块化关节 |
WO2016110320A1 (en) * | 2015-01-07 | 2016-07-14 | Abb Technology Ag | Method for estimation of external forces and torques on a robot arm |
CN106515849A (zh) * | 2015-09-03 | 2017-03-22 | 操纵技术Ip控股公司 | 基于模型的驾驶员转矩估计 |
US20170274530A1 (en) * | 2016-03-24 | 2017-09-28 | Cambridge Medical Robotics Limited | Robot control |
CN107351086A (zh) * | 2017-08-22 | 2017-11-17 | 华南理工大学 | 一种scara机器人关节力矩的卡尔曼估计方法 |
CN108007686A (zh) * | 2017-10-23 | 2018-05-08 | 华南理工大学 | 一种机器人谐波减速机测试平台精度分析测试方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03117582A (ja) * | 1989-09-28 | 1991-05-20 | Toyota Central Res & Dev Lab Inc | マニピュレータのトルク検出装置およびトルク制御装置 |
JP5242342B2 (ja) * | 2008-10-31 | 2013-07-24 | 株式会社東芝 | ロボット制御装置 |
DE102013010290A1 (de) * | 2013-06-19 | 2014-12-24 | Kuka Laboratories Gmbh | Überwachen eines kinematisch redundanten Roboters |
JP6046218B1 (ja) * | 2015-07-09 | 2016-12-14 | ファナック株式会社 | 物体と物体とを合わせ状態にするロボットのロボット制御装置 |
-
2018
- 2018-08-09 WO PCT/EP2018/071631 patent/WO2020030272A1/en unknown
- 2018-08-09 CN CN201880096495.9A patent/CN112533738A/zh active Pending
- 2018-08-09 EP EP18755427.4A patent/EP3833515A1/en active Pending
-
2021
- 2021-02-08 US US17/169,575 patent/US11279027B2/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012135825A (ja) * | 2010-12-24 | 2012-07-19 | Mitsubishi Electric Corp | 力制御装置 |
CN104416579A (zh) * | 2013-09-03 | 2015-03-18 | 中国科学院沈阳自动化研究所 | 一种中空式智能模块化关节 |
CN104180818A (zh) * | 2014-08-12 | 2014-12-03 | 北京理工大学 | 一种单目视觉里程计算装置 |
WO2016110320A1 (en) * | 2015-01-07 | 2016-07-14 | Abb Technology Ag | Method for estimation of external forces and torques on a robot arm |
CN106515849A (zh) * | 2015-09-03 | 2017-03-22 | 操纵技术Ip控股公司 | 基于模型的驾驶员转矩估计 |
US20170274530A1 (en) * | 2016-03-24 | 2017-09-28 | Cambridge Medical Robotics Limited | Robot control |
CN107351086A (zh) * | 2017-08-22 | 2017-11-17 | 华南理工大学 | 一种scara机器人关节力矩的卡尔曼估计方法 |
CN108007686A (zh) * | 2017-10-23 | 2018-05-08 | 华南理工大学 | 一种机器人谐波减速机测试平台精度分析测试方法 |
Non-Patent Citations (2)
Title |
---|
和争春: "飞行器RCS控制力矩辨识方法研究", 空气动力学学报, vol. 29, no. 02, 30 April 2011 (2011-04-30) * |
郭正旺: "用内式六分量应变天平实测导弹挂飞载荷", 航空学报, vol. 31, no. 07, 31 July 2010 (2010-07-31) * |
Also Published As
Publication number | Publication date |
---|---|
EP3833515A1 (en) | 2021-06-16 |
WO2020030272A1 (en) | 2020-02-13 |
US11279027B2 (en) | 2022-03-22 |
US20210162596A1 (en) | 2021-06-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11298828B2 (en) | Calibration device, calibration method, and control device | |
JP7086531B2 (ja) | ロボットハンド、ロボット装置、ロボットハンドの制御方法、物品の製造方法、制御プログラム及び記録媒体 | |
CN101323111B (zh) | 嵌合装置 | |
US7706922B2 (en) | Method for controlling parallel kinematic mechanism machine and control apparatus therefor | |
JP5618066B2 (ja) | 力制御ロボットのキャリブレーション装置と方法 | |
US20080267737A1 (en) | Fitting device | |
US10668620B2 (en) | Method and apparatus for correcting motions of robot | |
JP2007237312A (ja) | 制御装置 | |
JP5531996B2 (ja) | 6軸ロボットの軸間オフセット検出方法 | |
US11331810B2 (en) | Device, method and program for estimating weight and position of gravity center of load by using robot | |
JP6924563B2 (ja) | 位置決め制御装置の制御方法及び位置決め制御装置 | |
JP2020101541A (ja) | トルク推定のための方法および装置 | |
CN111002304B (zh) | 用于获取机械手的末端执行器的位置和定位的装置 | |
CN109571138B (zh) | 加工***以及加工机的控制方法 | |
CN112533738A (zh) | 用于估计扭转的方法 | |
US11141855B2 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
JPH07276273A (ja) | パラレルリンクマニピュレータのたわみ補正制御方法 | |
JP6654926B2 (ja) | 処理時間の予測方法 | |
EP3444079B1 (en) | Method and robotic system for operating a hand-guided robot | |
CN110871456A (zh) | 机器人 | |
EP3444077A1 (en) | Method for determining a current position of a robot end effector and robotic system | |
JPH0433006A (ja) | ロボツトシステムの制御方法 | |
WO2017026045A1 (ja) | ハンド力覚計測装置、ハンド力覚計測方法、及びハンド力覚計測プログラム | |
US11872700B2 (en) | Robot with a torque sensor and a force sensor | |
JP7250940B2 (ja) | 共通システムの複数の可動モジュールの位置及び配向を状態推定するための方法 |
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 |