CN114829080A - 机器人操纵器的虚拟力传感器的校正 - Google Patents
机器人操纵器的虚拟力传感器的校正 Download PDFInfo
- Publication number
- CN114829080A CN114829080A CN202080086702.XA CN202080086702A CN114829080A CN 114829080 A CN114829080 A CN 114829080A CN 202080086702 A CN202080086702 A CN 202080086702A CN 114829080 A CN114829080 A CN 114829080A
- Authority
- CN
- China
- Prior art keywords
- robotic manipulator
- resultant force
- external
- correction matrix
- manipulator
- 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
- 238000012937 correction Methods 0.000 claims abstract description 74
- 239000011159 matrix material Substances 0.000 claims abstract description 59
- 238000000034 method Methods 0.000 claims abstract description 20
- 230000036544 posture Effects 0.000 claims description 13
- 230000006870 function Effects 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000001419 dependent effect Effects 0.000 claims description 5
- 230000017105 transposition Effects 0.000 claims 1
- 239000012636 effector Substances 0.000 description 8
- 230000033001 locomotion Effects 0.000 description 6
- 238000011161 development Methods 0.000 description 2
- 230000018109 developmental process Effects 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000013013 elastic material Substances 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000001151 other effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000000844 transformation 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/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- 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/37—Measurements
- G05B2219/37537—Virtual sensor
-
- 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/39058—Sensor, calibration of sensor, potentiometer
-
- 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/39059—Sensor adaptation for robots by software
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40586—6-DOF force sensor
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40599—Force, torque sensor integrated in joint
Abstract
本发明涉及一种用于校正机器人操纵器(1)的虚拟力传感器的方法,其中,在多个姿态中进行下列步骤:‑施加(S1)外部合成力到所述机器人操纵器(1)上;‑获知(S2)所述外部合成力的估算;‑基于所获知的估算和预先给定的外部合成力来获知(S3)一次校正矩阵;‑通过逆转一次校正矩阵来获知(S4)二次校正矩阵;以及‑在将对应的二次校正矩阵配属给对应姿态的情况下,将对应的二次校正矩阵存储(S5)到所有二次校正矩阵的数据组中,所述对应的二次校正矩阵被获知用于所述对应姿态。
Description
技术领域
本发明涉及一种用于校正机器人操纵器的虚拟力传感器的方法,以及一种机器人系统,该机器人系统具有机器人臂和控制单元,用于应用该校正。
发明内容
本发明的任务是改善机器人操纵器或者说机器人臂上的虚拟力传感器的实施。
本发明从独立权利要求的特征中获得。有利的改进方案和设计方案是从属权利要求的主题。
本发明的第一方面涉及一种用于校正机器人操纵器的虚拟力传感器的方法,其中,所述虚拟力传感器用于基于通过转矩传感器在所述机器人操纵器的关节中所获知的力矩来获知作用到所述机器人操纵器上的外部合成力(Kraftwinders,力混成),其中,所述机器人操纵器被移动或手动引导到多个姿态中并在所述多个姿态的每个姿态中被实施下列步骤:
-施加对应的预先给定的外部合成力到所述机器人操纵器上;
-基于适用于最新姿态的雅可比矩阵的转置的逆(Inversen)或伪逆(Pseudoinversen)和基于外部转矩的矢量来获知所述外部合成力的估算,其中,外部转矩的矢量基于通过所述转矩传感器在所述机器人操纵器的所述关节中所获知的力矩并基于作用到所述机器人操纵器上的预期力矩来获知;
-基于所述外部合成力的所获知的估算并基于所述预先给定的外部合成力来获知对应的一次校正矩阵;
-通过逆转所述一次校正矩阵来获知对应的二次校正矩阵,其中,所述二次校正矩阵用于对在稍后运行中最新获知的外部合成力进行适配;以及
-在将对应的二次校正矩阵配属给对应姿态的情况下,将对应的二次校正矩阵存储到所有二次校正矩阵的数据组中,所述对应的二次校正矩阵被获知用于所述对应姿态。
在此,机器人操纵器的一姿态尤其给出了机器人操纵器的包括端部效应器(如果存在)的所有节肢的位置和定向的总体。如果已知关于一姿态的全部信息,那么可以将机器人操纵器通过尤其在其关节上的所有驱动器移动到明确的“保持”中。
外部合成力给出了如下这样的力和/或力矩,它们从周围环境出发地作用到机器人操纵器上以及反转地起作用,其中,外部合成力一般具有针对力的三个分量和针对力矩的三个分量。优选地,关于机器人操纵器所有姿态的预先给定的外部合成力是相同的合成力,也就是说恒定。优选替换地,针对这些姿态中的至少两个姿态设置不同的合成力,这点也有利地考虑如下这种姿态,这些姿态在恒定合成力的情况下至少部分单独地作出行为,也就是说,在机器人操纵器的将节肢连接的关节的至少一些中,该合成力的一外力在不产生关节中的力矩的情况下线性地通过该关节朝最接近的近侧节肢方向被导引。针对这种单独姿态的示例是,将机器人操纵器的所有节肢取向到一公共直线上,且外部合成力仅具有一相对于机器人操纵器基座的沿完全等同该公共直线方向的力矢量。
该外部合成力被施加到机器人操纵器上,而通过虚拟力传感器获知该外部合成力的估算。这点借助于尤其是、但是不强制性排除地布置在关节上的转矩传感器来进行。关节上的转矩传感器可以从多个现有技术中已知的转矩传感器中选出。尤其地,这些转矩传感器是力学转矩传感器,在这些转矩传感器中检测例如处在对应转矩传感器的辐条中的柔性弹性材料的膨胀,其中,通过了解材料常数可以推断出施布的力矩。此外尤其可行的是,测量存在于电性马达中的电流强度并从中推断出存在于关节中的力矩。关节中如此检测出的对应力矩典型地由多个原因组成。力矩的第一部分在机器人操纵器运动的情况下由运动学力和力矩,尤其是科氏加速度(Coriolisbeschleunigung)以及离心加速度获得。测量到的力矩的另一部分与机器人操纵器运动无关地归因于重力影响。
当在关节上通过转矩传感器尤其是直接或间接通过测量来检测力矩时,那么这些力矩由于重力影响和运动学所引起的力和力矩而造成预期力矩。也就是说,与最新的运动速度、机器人操纵器的最新加速度和机器人操纵器的质量分布和最新姿态(重力影响)相关地,这些力矩可以在机器人操纵器的转矩传感器上按照理论被获知作为预期力矩并从对应的转矩传感器上测量到的力矩减去。这点优选地在冲量观测器中进行,该冲量观测器的结果就是外部力矩。
为了从这样获知的外部力矩推断出预先给定的外部合成力的估算(该外部合成力具有其最新参照点),需要雅可比矩阵的转置的(伪)逆。伪逆(替代逆本身)尤其是需要的,如果机器人操纵器涉及冗余操纵器的话,也就是说将节肢连接的关节中的至少两个关节相对彼此具有冗余自由度。在冗余机器人操纵器中尤其可以使机器人操纵器的节肢运动,而不改变机器人操纵器的端部效应器的定向和/或位置。
雅可比矩阵原则上将关节上的角速度与一任意点上,尤其是机器人操纵器的远侧端部上的平移和旋转速度相结合。但是原理上不重要的是:实际上是否考虑了速度;因此也可以针对关节上的力矩与对应的任意点上的力和力矩之间的关联而使用雅可比矩阵。雅可比矩阵J的转置、即JT在外部合成力Fext与所获知的外部转矩的矢量τext之间如下地获得:
τext=JTFext
在借助于被称作为(JT)#的J转置的(伪)逆来转换该等式之后,基于所获知的外部转矩的矢量τext适用于外部合成力的估算Fext,est的是:
Fext,est=(JT)#τext
预先给定的外部合成力的方向和数值经由限定是已知的,因为外部合成力的预设值的已知数量也被施加。利用上面的计算也在机器人操纵器的每个单个姿态中已知外部合成力的估算,在所述姿态中施加一外部合成力。当不考虑Fext,real和Fext,est的分量之间的耦合时,然后基于外部合成力的所获知的估算Fext,est并基于预先给定的外部合成力Fext,real,尤其是通过Fext,real的以元素方式的逆转借助于利用Fext,real的分量所形成的对角矩阵的逆转来获知对应的一次校正矩阵K1:
K1=Fext,est·(diag(Fext,real))-1
对应的二次校正矩阵的获知尤其是通过一次校正矩阵的逆转类似于上述的逆优选直接通过:
优选替换地,当K1的逆不能被明确确定时,优选通过其伪逆而确定为:
在极端情况下,一次校准矩阵和二次校准矩阵分别是标量(Skalare)。当仅考虑外部合成力的一分量,使得一次校准矩阵的获知基于外部合成力的标量估算和基于标量的预先给定外部合成力来进行时,尤其是该情况。与之相应地,二次校正矩阵也是标量的单个值。
然后,在将对应的二次校正矩阵配属给对应姿态的情况下,将对应的二次校正矩阵存储到所有二次校正矩阵的数据组中,所述对应的二次校正矩阵被获知用于所述对应姿态。
优选地,获知外部合成力的估算、获知对应的一次校正矩阵、获知对应的二次校正矩阵和存储对应的二次校正矩阵的这些步骤分别通过计算单元来进行。该计算单元尤其与机器人操纵器连接。特别优选地,该计算单元被布置在机器人操纵器本身上,尤其是机器人操纵器的台座或基座上。
本发明的一有利作用是,替代校正机器人操纵器的转矩传感器中的每个单个转矩传感器,将所有转矩传感器的总体在其功能上作为虚拟力传感器在考虑施加到机器人操纵器上的预期力矩的情况下与姿态相关地进行校正,并由此将机器人操纵器质量分布、转矩传感器特性方面的所有不确定性和其他效应进行全面考虑。由此,通过所有的二次校正矩阵的该数据组而可行的是,将针对机器人操纵器一特定姿态的个性化校正应用到机器人操纵器的虚拟力传感器上。
根据一有利实施方式,施加预先给定的外部合成力到机器人操纵器上在机器人操纵器的远侧端部上进行。在机器人操纵器的远侧端部上优选布置端部效应器。因为机器人操纵器的接触力除了不希望的碰撞之外典型地在端部效应器和来自机器人操纵器周围环境的对象之间发生,所以该实施方式有利地考虑该情况,使得校正尤其参考处在机器人操纵器远侧端部上的端部效应器和机器人操纵器周围环境之间的合成力来进行。
根据另一有利实施方式,基于所述外部合成力的所获知的估算并基于经逆转或伪逆的预先给定的外部合成力来获知一次校正矩阵。这点相应于上面已经阐释的优选实施方式,使用了外部合成力的所获知估算的矩阵Fext,real的逆或伪逆从中获得:
优选地,机器人操纵器的多个姿态通过位置的等距网格针对机器人操纵器的一参考点相对于与地固定的坐标系来确定,由此有利地至少以近似方式考虑了机器人操纵器的参考点的全部可能位置(在针对冗余机器人操纵器的各网格点多个姿态的情况下),但是也可考虑非常多数量的网格点。
因此,根据另一有利实施方式,针对机器人操纵器预先给定一任务,所述任务被分析,且在实施所述任务时识别待驶离的工作点,其中,所述机器人操纵器的对应姿态被选择为,使得所述工作点之一和所述机器人操纵器的一参考点分别在一对应姿态中相一致。机器人操纵器的参考点尤其是处在机器人操纵器的远侧端部上的参考点,且尤其是假想地布置在端部效应器上。参考点尤其是与机器人操纵器本体固定,尤其是与机器人操纵器表面上的一地点进行假想连接,也就是说,该参考点相对于该选出的地点即使在机器人操纵器运动时也不执行相对运动。有利地,利用该实施方式,校正特别与机器人操纵器待执行的任务相协调并明显减少了网格点的数量。
根据另一有利实施方式,机器人操纵器是冗余机器人操纵器,且在使用针对所述机器人操纵器对应姿态而言最新的雅可比矩阵的转置的伪逆的情况下获知所述外部合成力的估算。冗余机器人操纵器具有相对彼此冗余的自由度。也就是说尤其地,机器人操纵器的节肢可以运动,而在此不改变特定节肢的定向、尤其是机器人操纵器的端部效应器的定向,和/或尤其是处在机器人操纵器远侧端部上的预先给定的参考点的位置。
根据另一有利实施方式,至少对于所述机器人操纵器的多个姿态中的一部分量而言,所述冗余机器人操纵器在其零空间(Nullraum)中移动经过多个姿态,且对于所述多个姿态中的每个姿态而言获知并存储一特有的一次校正矩阵和二次校正矩阵。有利地,通过该实施方式在估算外部合成力时通过机器人操纵器在其零空间中姿态改变也考虑了发生变化的不准确性。
根据另一有利实施方式,在所述机器人操纵器上施加所述预先给定的外部合成力通过将具有预先给定质量的负载附加到所述机器人操纵器上来进行。在重力恒定和已知的情况下,通过附加具有预先给定质量的负载非常可靠地确保:外部合成力关于与地固定的坐标系总是作用到相同方向上并以总是相同的强度起作用。
根据另一有利实施方式,在所述机器人操纵器上施加所述预先给定的外部合成力通过将所述机器人操纵器的机械弹簧与支承件连接来进行,使得所述机械弹簧被预紧且将力给予到所述机器人操纵器上。机械支承件优选被布置在第二操纵器上,优选第二操纵器的端部效应器上。有利地,通过使用弹簧通过弹簧在该弹簧的特定线性区域上的膨胀可以连续地预先给定外部合成力的力分量的任意值。
根据另一有利实施方式,在所述机器人操纵器上施加所述预先给定的外部合成力通过使所述机器人操纵器运动来进行,使得所述机器人操纵器上的预先给定的加速由于所述机器人操纵器的惯性质量而出现。根据该实施方式,在预期力矩的情况下相应地不考虑来自机器人操纵器运动的力矩,因为这些力矩刚好应被检测并从中获知外部合成力的估算。有利地,根据该实施方式,既不需要机器人操纵器上的具有附加质量的负载,也不需要与弹簧的连接,还不需要施加其他外部的力和/或力矩,因为通过机器人操纵器本身可实施的运动单独用于校正该虚拟力传感器。
本发明的另一方面涉及一种机器人系统,具有机器人臂和控制单元,其中,所述控制单元被实施用于,在所述机器人臂上实施虚拟力传感器,其中,所述虚拟力传感器用于获知作用到所述机器人臂上的外部合成力,且所述外部合成力基于通过力矩传感器在所述机器人臂的关节中所获知的力矩和基于作用到所述机器人臂上的预期力矩和基于分别与姿态相关的最新雅可比矩阵的转置的逆或伪逆来获知,其中,所述控制单元被实施用于,将与姿态相关的校正函数应用到最新获知的外部合成力上,且通过选出一特定的、配属给所述机器人臂对应最新姿态的二次校正矩阵或通过产生来自所述二次校正矩阵中的至少两个特定二次校正矩阵的内插,从所有二次校正矩阵的根据方法所产生的数据组中产生所述校正函数,其中,所述二次校正矩阵中的至少两个特定二次校正矩阵的对应姿态最接近所述机器人臂的对应最新姿态。
这种机器人系统可以与其上执行所述校正的机器人操纵器相一致。在此,如上所述的校正又可以用于应用在该特有的机器人操纵器上,或可以使用在另一机器人操纵器上,为了清楚在此情况下被称作具有“机器人臂”的“机器人系统”。
所提出的机器人系统的优点和优选改进方案通过结合已介绍的方法之前所做出的实施方案的类似的和有意义的转用来得出。
其它的优点、特征和细节由以下的说明中得出,在其中(必要时参考附图)详细地描述至少一个实施例。相同的、类似的和/或功能相同的部件设有相同的附图标记。
附图说明
图1示出了一种根据本发明一实施例的用于校正机器人操纵器的虚拟力传感器的方法;
图2示出了一种机器人操纵器,在其上实施根据图1的方法;以及
图3示出了一种根据本发明另一实施例的机器人系统,用于使用根据图1的校正的结果。
附图中的图示是示意性且非按比例尺的。
具体实施方式
图1示出了一种用于校正机器人操纵器1的虚拟力传感器的方法。机器人操纵器1通过相应操控其驱动器被移动到多个姿态中。在此情况下涉及的是一种冗余机器人操纵器1。因此,针对机器人操纵器1的远侧端部5的一共同位置而言假设了机器人操纵器1的多个姿态,其方式是,该冗余机器人操纵器1在其零空间中被移动经过多个姿态。在这些姿态中的每个中,机器人操纵器1针对一定的时间段被无运动地保持,以便重复地,也就是说在这些姿态中的每个上实施下列步骤:首先,将具有预先给定的力和力矩的预先给定的外部合成力施加到机器人操纵器1的远侧端部5上S1。这点通过外部检查单元(未在图1中示出)来进行。接下来,基于适用于最新姿态的雅可比矩阵的转置的伪逆、也就是说(JT)#,并基于外部转矩的矢量来获知S2外部合成力的估算Fext,est,其中,外部转矩的矢量τext基于通过转矩传感器3在机器人操纵器1的关节中所获知的力矩和基于作用到机器人操纵器1上的预期力矩来获知:
Fext,est=(JT)#τext
适用于最新姿态的雅可比矩阵的转置的伪逆(JT)#,也就是说在此被使用,因为涉及了一种冗余机器人操纵器1。
然后,基于外部合成力的所获知的估算Fext,est并基于经伪逆的预先给定的外部合成力Fext,real来获知S3对应的一次校正矩阵K1,也就是说:
通过逆转所述一次校正矩阵来获知S4对应的二次校正矩阵,其中,所述二次校正矩阵用于对在稍后运行中最新获知的外部合成力进行适配,该获知通过下列计算来进行:
最后,在将对应的二次校正矩阵K2配属给对应姿态的情况下,将对应的二次校正矩阵存储S5到所有二次校正矩阵的数据组中,所述对应的二次校正矩阵被获知用于所述对应姿态。在图2中示出了这种机器人操纵器1,在其上实施该方法。图2的附图标记在此也适用于图1的上述阐释。
图2示出了这种机器人操纵器1,具有其组件、转矩传感器3和机器人操纵器1的其远侧端部5。在此,机器人操纵器1的冗余自由度以符号方式通过具有彼此平行的关节轴的多个关节来表征。在该机器人操纵器1上实施如下面图1所述的方法。在此参照相对于图1的阐释。
图3示出了具有机器人臂12和控制单元14的机器人系统10。在此,该机器人系统10以符号方式在图3中用不同于图1的机器人操纵器1的机器人臂12来示出。其明示了,根据相对于图1以及图2阐释的校正可以被传递到另一机器人系统10上,而不必在该机器人系统本身上发生校正。在此,机器人系统10的控制单元14布置在机器人臂12的基座上并在机器人臂12上实施虚拟力传感器,其中,该虚拟力传感器用于获知最新作用到机器人臂12上的外部合成力,且该外部合成力基于通过力矩传感器13在机器人臂12的关节中所获知的力矩和基于作用到机器人臂12上的预期力矩和基于分别与姿态相关的最新雅可比矩阵的转置的逆或伪逆来获知。此外,控制单元14将与姿态相关的校正函数应用到最新获知的外部合成力上,其中,校正函数从所有二次校正矩阵的根据图1阐释所产生的数据组中通过选出特定的、配属给机器人臂12的对应最新姿态的、也就是说最接近的二次校正矩阵来确定。
虽然本发明在细节上通过优选的实施例被较详细地图解和阐释,但是本发明不被这些公开的示例所限制并且本领域技术人员可以从中推导出另外的变型方案,而不离开本发明的保护范围。因此清楚的是,存在多个变型方案可能性。同样清楚的是,示例性所提到的实施方式实际仅表示示例,这些示例不以任何方式被概括为例如保护范围、应用可能性或本发明配置的限制。确切的说,之前的说明和附图描述使本领域技术人员能够具体地转换示例性实施方式,其中,本领域技术人员在了解所公开的发明构思的情况下可以进行例如在示例性实施方式中提到的各个元件的功能或布置方面的各种改变,而不会脱离权利要求及其合法等同物、例如说明书中的广泛说明所限定的保护范围。
附图标记列表
1 机器人操纵器
3 转矩传感器
5 机器人操纵器的远侧端部
10 机器人系统
12 机器人臂
13 力矩传感器
14 控制单元
S1 施加
S2 获知
S3 获知
S4 获知
S5 存储
Claims (10)
1.用于校正机器人操纵器(1)的虚拟力传感器的方法,其中,所述虚拟力传感器用于基于通过转矩传感器(3)在所述机器人操纵器(1)的关节中所获知的力矩来获知作用到所述机器人操纵器(1)上的外部合成力,其中,所述机器人操纵器(1)被移动或手动引导到多个姿态中并在所述多个姿态的每个姿态中被实施下列步骤:
-施加(S1)对应的预先给定的外部合成力到所述机器人操纵器(1)上;
-基于适用于最新姿态的雅可比矩阵的转置的逆或伪逆和基于外部转矩的矢量来获知(S2)所述外部合成力的估算,其中,外部转矩的所述矢量基于通过所述转矩传感器(3)在所述机器人操纵器(1)的所述关节中所获知的力矩并基于作用到所述机器人操纵器(1)上的预期力矩来获知;
-基于所述外部合成力的所获知的估算并基于所述预先给定的外部合成力来获知(S3)对应的一次校正矩阵;
-通过逆转所述一次校正矩阵来获知(S4)对应的二次校正矩阵,其中,所述二次校正矩阵用于对在稍后运行中最新获知的外部合成力进行适配;以及
-在将对应的二次校正矩阵配属给对应姿态的情况下,将对应的二次校正矩阵存储(S5)到所有二次校正矩阵的数据组中,所述对应的二次校正矩阵被获知用于所述对应姿态。
2.根据权利要求1所述的方法,
其中,施加所述预先给定的外部合成力到所述机器人操纵器(1)上在所述机器人操纵器(1)的远侧端部(5)上进行。
3.根据前述权利要求中任一项所述的方法,
其中,基于所述外部合成力的所获知的估算并基于经逆转或伪逆的预先给定的外部合成力来获知所述一次校正矩阵。
4.根据前述权利要求中任一项所述的方法,
其中,针对所述机器人操纵器(1)预先给定一任务,所述任务被分析,且在实施所述任务时识别待驶离的工作点,其中,所述机器人操纵器(1)的对应姿态被选择为,使得所述工作点之一和所述机器人操纵器(1)的一参考点分别在一对应姿态中相一致。
5.根据前述权利要求中任一项所述的方法,
其中,所述机器人操纵器(1)是冗余机器人操纵器,且在使用针对所述机器人操纵器(1)的对应姿态而言最新的雅可比矩阵的转置的伪逆的情况下获知所述外部合成力的估算。
6.根据权利要求5所述的方法,
其中,至少对于所述机器人操纵器(1)的多个姿态中的一部分量而言,所述冗余机器人操纵器(1)在其零空间中移动经过多个姿态,且对于所述多个姿态中的每个姿态而言获知并存储一特有的一次校正矩阵和二次校正矩阵。
7.根据权利要求1至6中任一项所述的方法,
其中,在所述机器人操纵器(1)上施加所述预先给定的外部合成力通过将具有预先给定质量的负载附加到所述机器人操纵器(1)上来进行。
8.根据权利要求1至6中任一项所述的方法,
其中,在所述机器人操纵器(1)上施加所述预先给定的外部合成力通过将所述机器人操纵器(1)的机械弹簧与支承件连接来进行,使得所述机械弹簧被预紧且将力给予到所述机器人操纵器(1)上。
9.根据权利要求1至6中任一项所述的方法,
其中,在所述机器人操纵器(1)上施加所述预先给定的外部合成力通过使所述机器人操纵器(1)运动来进行,使得所述机器人操纵器(1)上的预先给定的加速由于所述机器人操纵器(1)的惯性质量而出现。
10.机器人系统(10),具有机器人臂(12)和控制单元(14),其中,所述控制单元(14)被实施用于,在所述机器人臂(12)上实施虚拟力传感器,其中,所述虚拟力传感器用于获知作用到所述机器人臂(12)上的外部合成力,且所述外部合成力基于通过力矩传感器(13)在所述机器人臂(12)的关节中所获知的力矩和基于作用到所述机器人臂(12)上的预期力矩和基于分别与姿态相关的最新雅可比矩阵的转置的逆或伪逆来获知,其中,所述控制单元(14)被实施用于,将与姿态相关的校正函数应用到最新获知的外部合成力上,且通过选出一特定的、配属给所述机器人臂(12)对应最新姿态的二次校正矩阵或通过产生来自所述二次校正矩阵中的至少两个特定二次校正矩阵的内插,从所有二次校正矩阵的根据权利要求1至9中任一项所述的方法所产生的数据组中产生所述校正函数,其中,所述二次校正矩阵中的所述至少两个特定二次校正矩阵的对应姿态最接近所述机器人臂(12)的对应最新姿态。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102019134666.5A DE102019134666B4 (de) | 2019-12-17 | 2019-12-17 | Kalibrieren eines virtuellen Kraftsensors eines Robotermanipulators |
DE102019134666.5 | 2019-12-17 | ||
PCT/EP2020/086422 WO2021122748A1 (de) | 2019-12-17 | 2020-12-16 | Kalibrieren eines virtuellen kraftsensors eines robotermanipulators |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114829080A true CN114829080A (zh) | 2022-07-29 |
Family
ID=74130167
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202080086702.XA Pending CN114829080A (zh) | 2019-12-17 | 2020-12-16 | 机器人操纵器的虚拟力传感器的校正 |
Country Status (7)
Country | Link |
---|---|
US (1) | US20230090384A1 (zh) |
EP (1) | EP4076866A1 (zh) |
JP (1) | JP2023508911A (zh) |
KR (1) | KR20220113795A (zh) |
CN (1) | CN114829080A (zh) |
DE (1) | DE102019134666B4 (zh) |
WO (1) | WO2021122748A1 (zh) |
Families Citing this family (2)
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 |
DE102022130316B3 (de) | 2022-11-16 | 2024-01-11 | Schaeffler Technologies AG & Co. KG | Verfahren zum Kalibrieren eines Drehmomentsensors in einem Robotergelenk |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020011092A1 (en) * | 1998-02-23 | 2002-01-31 | Ryuichi Hara | Method for calibrating force sensor mounted on robot, and robot |
CN101528151A (zh) * | 2006-10-25 | 2009-09-09 | 欧洲原子能共同体由欧洲委员会代表 | 用于微创机器人外科处理系统的力评估 |
WO2016110320A1 (en) * | 2015-01-07 | 2016-07-14 | Abb Technology Ag | Method for estimation of external forces and torques on a robot arm |
CN105783809A (zh) * | 2016-04-14 | 2016-07-20 | 昆山工研院工业机器人研究所有限公司 | 一种机器人标定测试组合装置 |
CN107186460A (zh) * | 2017-07-10 | 2017-09-22 | 上海新时达电气股份有限公司 | 工业机器人进行轴孔装配的方法及其系统 |
CN107735229A (zh) * | 2015-12-31 | 2018-02-23 | 深圳配天智能技术研究院有限公司 | 一种机器人性能测试负载装置 |
US20190054619A1 (en) * | 2017-08-17 | 2019-02-21 | Siemens Healthcare Gmbh | Operating a hand-guided robot |
WO2019048279A1 (de) * | 2017-09-06 | 2019-03-14 | Kuka Systems Gmbh | Verfahren zum steuern eines roboters |
CN109822574A (zh) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | 一种工业机器人末端六维力传感器标定的方法 |
DE202019102430U1 (de) * | 2019-04-30 | 2019-06-05 | Franka Emika Gmbh | Ermittlung eines externen Kraftwinders durch Drehmomentsensoren eines Robotermanipulators |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5109573B2 (ja) * | 2007-10-19 | 2012-12-26 | ソニー株式会社 | 制御システム及び制御方法、並びにロボット装置 |
DE102013010290A1 (de) | 2013-06-19 | 2014-12-24 | Kuka Laboratories Gmbh | Überwachen eines kinematisch redundanten Roboters |
DE102013019450A1 (de) | 2013-11-21 | 2015-05-21 | Daimler Ag | Verfahren zum Vermeiden einer Kollision eines Roboters mit einem Objekt |
DE102015205176B3 (de) | 2015-03-23 | 2016-05-12 | Kuka Roboter Gmbh | Robustes intuitives Bedienverfahren durch Berührung eines Manipulators |
DE102015009151A1 (de) | 2015-07-14 | 2017-01-19 | Kuka Roboter Gmbh | Ermitteln eines Eingabebefehls für einen Roboter, der durch manuelles Ausüben einer Kraft auf den Roboter eingegeben wird |
DE102015012959B4 (de) | 2015-10-08 | 2019-01-17 | Franka Emika Gmbh | Robotersystem und Verfahren zur Steuerung eines Robotersystems |
-
2019
- 2019-12-17 DE DE102019134666.5A patent/DE102019134666B4/de active Active
-
2020
- 2020-12-16 CN CN202080086702.XA patent/CN114829080A/zh active Pending
- 2020-12-16 WO PCT/EP2020/086422 patent/WO2021122748A1/de unknown
- 2020-12-16 EP EP20837948.7A patent/EP4076866A1/de active Pending
- 2020-12-16 KR KR1020227024191A patent/KR20220113795A/ko unknown
- 2020-12-16 US US17/784,366 patent/US20230090384A1/en active Pending
- 2020-12-16 JP JP2022537893A patent/JP2023508911A/ja active Pending
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020011092A1 (en) * | 1998-02-23 | 2002-01-31 | Ryuichi Hara | Method for calibrating force sensor mounted on robot, and robot |
CN101528151A (zh) * | 2006-10-25 | 2009-09-09 | 欧洲原子能共同体由欧洲委员会代表 | 用于微创机器人外科处理系统的力评估 |
WO2016110320A1 (en) * | 2015-01-07 | 2016-07-14 | Abb Technology Ag | Method for estimation of external forces and torques on a robot arm |
CN107735229A (zh) * | 2015-12-31 | 2018-02-23 | 深圳配天智能技术研究院有限公司 | 一种机器人性能测试负载装置 |
CN105783809A (zh) * | 2016-04-14 | 2016-07-20 | 昆山工研院工业机器人研究所有限公司 | 一种机器人标定测试组合装置 |
CN107186460A (zh) * | 2017-07-10 | 2017-09-22 | 上海新时达电气股份有限公司 | 工业机器人进行轴孔装配的方法及其系统 |
US20190054619A1 (en) * | 2017-08-17 | 2019-02-21 | Siemens Healthcare Gmbh | Operating a hand-guided robot |
WO2019048279A1 (de) * | 2017-09-06 | 2019-03-14 | Kuka Systems Gmbh | Verfahren zum steuern eines roboters |
CN109822574A (zh) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | 一种工业机器人末端六维力传感器标定的方法 |
DE202019102430U1 (de) * | 2019-04-30 | 2019-06-05 | Franka Emika Gmbh | Ermittlung eines externen Kraftwinders durch Drehmomentsensoren eines Robotermanipulators |
Also Published As
Publication number | Publication date |
---|---|
DE102019134666A1 (de) | 2021-06-17 |
DE102019134666B4 (de) | 2022-03-31 |
WO2021122748A1 (de) | 2021-06-24 |
JP2023508911A (ja) | 2023-03-06 |
US20230090384A1 (en) | 2023-03-23 |
KR20220113795A (ko) | 2022-08-16 |
EP4076866A1 (de) | 2022-10-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114829081A (zh) | 机器人操纵器的虚拟力传感器的校正 | |
JP7003463B2 (ja) | ロボットの制御装置、ロボットシステム、並びに、カメラの校正方法 | |
EP2915635B1 (en) | Robot, robot system, control device, and control method | |
JP5457161B2 (ja) | 多優先作動空間インピーダンス制御 | |
JP6700669B2 (ja) | 制御方法、ロボット装置、プログラム、記録媒体、及び物品の製造方法 | |
US9969088B2 (en) | Force sensor correcting method | |
US11370117B2 (en) | Collision handling by a robot | |
CN114829080A (zh) | 机器人操纵器的虚拟力传感器的校正 | |
WO2017163071A1 (en) | Robot control | |
Sadeghian et al. | Null-space impedance control with disturbance observer | |
JP6044511B2 (ja) | ロボットの制御方法及びロボットシステム | |
JP2017056544A (ja) | ロボット制御装置、ロボット制御方法 | |
Sandoval et al. | Improved dynamic formulation for decoupled cartesian admittance control and RCM constraint | |
Yamano et al. | Cooperative control of a 3D dual-flexible-arm robot | |
Ortenzi et al. | An experimental study of robot control during environmental contacts based on projected operational space dynamics | |
US20230063392A1 (en) | Robotic device | |
KR20100105143A (ko) | 칼만 필터를 이용한 로봇 기구학 변수 추정 방법 및 시스템 | |
Lippiello et al. | Robot interaction control using force and vision | |
US20220388161A1 (en) | Force measurement and force generation in redundant robot manipulators | |
KR101789758B1 (ko) | 모듈화 로봇의 모듈 간 연결 순서 추정 방법 | |
CN111844017B (zh) | 显示方法 | |
Tavakoli et al. | Self calibration of step-by-step based climbing robots | |
JP3243500B2 (ja) | 無重力模擬装置および任意重力模擬装置 | |
Lippiello et al. | Robot force/position control with force and visual feedback | |
JP2569412B2 (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 |