CN113286683B - 用于确定机器人机械手的负载的重力和重心的方法 - Google Patents
用于确定机器人机械手的负载的重力和重心的方法 Download PDFInfo
- Publication number
- CN113286683B CN113286683B CN202080008323.9A CN202080008323A CN113286683B CN 113286683 B CN113286683 B CN 113286683B CN 202080008323 A CN202080008323 A CN 202080008323A CN 113286683 B CN113286683 B CN 113286683B
- Authority
- CN
- China
- Prior art keywords
- load
- gravity
- determining
- external force
- ext
- 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
- 230000005484 gravity Effects 0.000 title claims abstract description 91
- 238000000034 method Methods 0.000 title claims abstract description 29
- 230000003068 static effect Effects 0.000 claims abstract description 60
- 239000012636 effector Substances 0.000 claims abstract description 52
- 238000012935 Averaging Methods 0.000 claims abstract description 22
- 230000009466 transformation Effects 0.000 claims description 6
- 230000033001 locomotion Effects 0.000 description 8
- 230000000694 effects Effects 0.000 description 5
- 239000003550 marker Substances 0.000 description 5
- 230000036544 posture Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- 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/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
-
- 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
- G01—MEASURING; TESTING
- G01G—WEIGHING
- G01G19/00—Weighing apparatus or methods adapted for special purposes not provided for in the preceding groups
- G01G19/52—Weighing apparatus combined with other objects, e.g. furniture
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01M—TESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
- G01M1/00—Testing static or dynamic balance of machines or structures
- G01M1/12—Static balancing; Determining position of centre of gravity
- G01M1/122—Determining position of centre of gravity
-
- 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/39194—Compensation gravity
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种用于确定机器人机械手(1)的负载(11)的重力和重心的方法,所述方法具有以下步骤:‑使用末端执行器(9)抓取(S1)负载(11);‑将负载(11)移动(S2)到数量n个成对不同的静态姿势;‑针对n个静态姿势中的每一个确定(S3)相应外力旋量Fext;‑在基座坐标系中至少确定(S4)相应外力旋量Fext的指示外力的分量;‑根据相应外力旋量Fext的在基座坐标系中指示外力的分量中的朝重力向量的方向指向的相应分量以及根据重力向量的大小确定(S5)负载(11)的重力的相应估计;‑通过对负载(11)的重力的相应估计求平均来确定(S6)负载(11)的重力;‑基于负载(11)的重力或针对相应静态姿势所确定的负载(11)的重力的相应估计以及基于外力旋量Fext的指示外部作用的力矩的分量,针对n个静态姿势中的每一个确定(S7)负载(11)的重心的坐标的估计;以及‑通过对重心的坐标的相应估计求平均来确定(S8)负载(11)的重心。
Description
技术领域
本发明涉及一种用于确定机器人机械手的负载的重力和重心的方法以及一种用于确定机器人机械手的负载的重力和重心的系统。
发明内容
本发明的目的是确定机器人机械手的负载的重力和重心。
本发明产生于独立权利要求的特征。有利的改进方案和设计方案是从属权利要求的主题。
本发明的第一方面涉及一种用于确定机器人机械手的负载的重力和重心的方法。所述机器人机械手布置在基座处并具有多个连杆。所述连杆通过关节彼此连接。在所述关节处布置有致动器,以使布置在其中一个关节处的相应连杆相对于彼此旋转或倾斜。所述机器人机械手还具有用于抓取所述负载的末端执行器。根据本发明的第一方面的方法具有以下步骤:
-使用所述末端执行器抓取所述负载;
-将所述负载移动到数量n个成对不同的静态姿势;
-针对所述n个静态姿势中的每一个确定相应外力旋量Fext,其中,所述相应外力旋量Fext指示外部作用在所述机器人机械手上的力和力矩;
-在基座坐标系中至少确定所述相应外力旋量Fext的指示外力的分量,其中,所述基座坐标系是笛卡尔坐标系并设想主体固定地布置在所述机器人机械手的所述基座处,并且其中,所述基座坐标系的轴线平行于重力向量;
-根据所述相应外力旋量Fext的在所述基座坐标系中指示外力的分量中的朝重力向量的方向指向的相应分量,针对所述n个静态姿势中的每一个确定所述负载的重力的相应估计;
-通过对所述负载的重力的相应估计求平均来确定所述负载的重力;
-基于所述负载的重力或针对所述相应静态姿势所确定的所述负载的重力的相应估计以及基于所述外力旋量Fext的指示外部作用的力矩的分量,针对所述n个静态姿势中的每一个确定所述负载的重心的坐标的估计;以及
-通过对重心的坐标的相应估计求平均来确定所述负载的重心。
基座坐标系的取向至少如此对准,使得基座坐标系的轴线朝局部重力向量的方向指向。基座坐标系优选地在设置机器人机械手时相应地予以校准。
在基座坐标系中至少确定相应外力旋量Fext的指示外力的分量尤其等效于通过相应的坐标系变换来如此变换外力旋量Fext,使得在局部重力向量的方向上精确限定了外力旋量Fext的指示力的分量,因为在这种情况下,还隐式限定了沿重力向量取向的基座坐标系。局部重力向量是尤其指示作用在地球上给定位置的重力的方向的向量。
静态姿势保持一定的时间段。这允许静态测量力和力矩,而无需检测动态力和力矩,例如科里奥利力、切向加速度或离心力。因此,在静态姿势的相应外力旋量Fext中也不包含任何动态力或力矩。外力旋量Fext针对静态姿态具有所有外力和力矩的影响,负载的重力也属于这些影响。而在外力旋量Fext中不包含包括末端执行器在内的机器人机械手的重力。由此产生的结果是,在机器人机械手的静态姿态中,在末端执行器中没有承受负载的情况下,外力旋量Fext对应于零向量。
重心是点状位置,即在确定重心时,在该点状位置即重心确定位置向量。在这里,该位置向量的起点尤其是位于指定该位置向量所在的相应坐标系的原点。
当确定负载的重力时,机器人机械手本身有利地充当秤以确定负载的质量的重力。在这里,重力的确定与质量的确定完全相同,因为负载的重力和质量通过位置系数彼此关联。
本发明的有益效果是可以有效地确定机器人机械手的负载的重力和重心。
根据本发明的一个有利实施方式,将负载移动到数量n个成对不同的静态姿势是仅通过控制k个致动器进行,k≤n,其中,数量k是一个预限定的数量,并且k个致动器被安排或分配给最靠近末端执行器的k个关节。根据另一有利实施方式,k=3,并且将负载移动到数量n个成对不同的静态姿势是仅通过控制最靠近末端执行器的三个关节的三个致动器来进行。根据另一有利实施方式,k=2,并且将负载移动到数量n个成对不同的静态姿势是仅通过控制最靠近末端执行器的两个关节的两个致动器来进行。由此,有利地分别仅在非常小的空间部段上执行移动负载的步骤。
根据另一有利实施方式,将负载移动到数量n个成对不同的静态姿势是仅通过控制k个致动器来进行,其中k≤n,其中,k是预限定的数量。
有利地,k=2,并且将负载移动到数量n个成对不同的静态姿势是仅通过控制最靠近末端执行器的三个关节的第一致动器和第三致动器来进行。
根据另一有利实施方式,根据用户的输入信号自动执行用于确定机器人机械手的负载的重力和重心的步骤。
根据另一有利实施方式,n个静态姿势由机器人机械手自动跟随并叠加在另一运动上,其中,所述另一运动优选地是机器人机械手的手动引导。
根据另一有利实施方式,用于确定机器人机械手的负载的重力和重心的步骤是在机器人机械手的手动引导期间执行。在这里,静态姿势在可用时相应地自动选择。
根据另一有利实施方式,所述外力旋量Fext由所述关节中的扭矩传感器来确定。
扭矩传感器有利地集成在可致动旋转的关节的电致动器中。尤其地,通过测量电致动器中的电流可检测那里的扭矩。
根据另一有利实施方式,所述外力旋量Fext借助所述关节处或所述连杆处的应变计来确定。
根据另一有利实施方式,将所述负载从成对不同的方向多次移动到所述n个静态姿势中的数量m个,其中m≤n。
由此,有利地,滞后效应可以从相应的力传感器或力矩传感器求平均并因此从外力旋量Fext的测量中消除。滞后效应尤其源于“机器人机械手”系统的摩擦和惯性。根据接近这种姿势的方向,从相应的力传感器或力矩传感器测量不同的值。如果相应地从不同方向对称地移动到所需姿势,则这允许当检测外力旋量Fext时消除由相应滞后效应引起的测量误差。
根据另一有利实施方式,n=8。
根据另一有利实施方式,针对所述n个静态姿势中的每一个确定相应外力旋量Fext是在相对于所述末端执行器主体固定的末端执行器坐标系中进行,并且为了在所述基座坐标系中至少确定所述相应外力旋量Fext的指示力的分量,在所述末端执行器坐标系和所述基座坐标系之间进行系变换。
根据另一有利实施方式,针对所述n个静态姿势中的每一个确定所述负载的重心的坐标的估计是在相对于所述末端执行器主体固定的末端执行器坐标系中进行。
末端执行器坐标系设想主体固定地布置在末端执行器处。因此,当末端执行器移动时,末端执行器坐标系随末端执行器一起旋转。因此,末端执行器坐标系相对于末端执行器没有相对运动。
根据另一有利实施方式,确定所述负载的重心是通过对所述负载的重心的坐标的相应估计求算术平均来进行。
根据另一有利实施方式,确定所述负载的重力是通过对所述负载的重力的相应估计求算术平均来进行。
根据一个有利实施方式,所述方法还具有以下步骤:
-基于所述负载的重力和/或所述负载的重心适配所述机器人机械手的调节系统。
根据另一有利实施方式,所述调节系统的适配是通过适配至少一个调节参数来进行。
调节参数尤其是反馈增益、前向分支增益或建模死区时间。
根据另一有利实施方式,所述方法还具有以下步骤:
-考虑到所述负载的重心,规划和执行所述负载的移动路径以及在跟随所述移动路径期间所述负载的相应姿势,从而减少至少作用在末端执行器关节上的力矩。
根据另一有利实施方式,所述方法还具有以下步骤:
-基于质量确定所述负载的最大路径速度,从而不超过所述负载的预定最大平移脉冲。
根据另一有利实施方式,所述方法具有以下步骤:
-基于所述负载的重心和/或所述负载的质量确定所述负载的最大旋转速度,从而不超过所述负载的预定最大角动量。
本发明的另一方面涉及一种用于确定机器人机械手的负载的重力和重心的系统,其中,所述机器人机械手布置在基座处并具有多个连杆,并且所述连杆通过关节彼此连接并可通过布置在所述关节处的致动器相对于彼此旋转,并且其中,所述机器人机械手具有:
-末端执行器,所述末端执行器实施用于抓取所述负载;
-控制单元,所述控制单元实施成控制布置在所述关节处的所述致动器以将所述负载移动到数量n个成对不同的静态姿势;
-估计单元,所述估计单元实施成针对所述n个静态姿势中的每一个确定相应外力旋量Fext,其中,所述相应外力旋量Fext指示外部作用在所述机器人机械手上的力和力矩;
-计算单元,所述计算单元实施成:
a)在基座坐标系中至少指示所述相应外力旋量Fext的指示力的分量,其中,所述基座坐标系是笛卡尔坐标系并主体固定地布置在所述机器人机械手的所述基座处,并且所述基座坐标系的轴线平行于重力向量;
b)根据所述相应外力旋量Fext的在所述基座坐标系中指示外力的分量中的朝重力向量的方向指向的相应分量以及根据重力向量的大小确定所述负载的重力的相应估计;
c)通过对所述负载的重力的相应估计求平均来确定所述负载的重力;
d)基于所述负载的重力或针对所述相应静态姿势所确定的所述负载的重力的相应估计以及基于所述相应外力旋量Fext的指示外部作用的力矩的分量,针对所述n个静态姿势中的每一个确定所述负载的重心的坐标的估计;以及
e)通过对重心的坐标的相应估计求平均来确定所述负载的重心。
根据另一有利实施方式,所述机器人机械手具有扭矩传感器,所述扭矩传感器实施成确定所述关节中的力矩,其中,所述计算单元实施成根据所述关节中的力矩确定外力旋量Fext。
扭矩传感器有利地集成在关节的电致动器中。尤其是通过测量电致动器中的电流可以检测那里的扭矩。
根据另一有利实施方式,所述机器人机械手在所述关节处或所述连杆处具有应变计,其中,所述应变计均实施成检测所述机器人机械手的支承材料中的应力并将其传输到所述计算单元,其中,所述计算单元实施成根据所检测的应力确定外力旋量Fext。
根据另一有利实施方式,所述控制单元实施成控制布置在所述关节处的所述致动器以将所述负载从成对不同的方向移动到n个静态姿势中的数量m个,其中m≤n。
根据另一有利实施方式,所述计算单元实施成,在相对于所述末端执行器主体固定的末端执行器坐标系中针对所述n个静态姿势中的每一个确定相应外力旋量Fext,并且为了在所述基座坐标系中至少确定所述相应外力旋量Fext的指示力的分量,在所述末端执行器坐标系和所述基座坐标系之间进行系变换。
根据另一有利实施方式,所述计算单元实施成,在相对于所述末端执行器主体固定的末端执行器坐标系中针对所述n个静态姿势中的每一个确定所述负载的重心的坐标的估计。
根据另一有利实施方式,所述计算单元实施成,通过对所述负载的重心的坐标的相应估计求算术平均来确定所述负载的重心。
根据另一有利实施方式,所述计算单元实施成,通过对所述负载的重力的相应估计求算术平均来确定所述负载的重力。
所提出的系统的优点和优选的改进方案产生于对与所提出的方法相关联做出的上述实施方案的类似和符合意义的转移。
进一步的优点、特征和细节产生于以下描述,其中,在必要时参照附图,详细描述了至少一个实施例。相同、相似和/或功能相同的部分设有相同的附图标记。
附图说明
图1示出了根据本发明的一个实施例的用于确定机器人机械手的负载的重力和重心的方法;
图2示出了根据本发明的另一实施例的用于确定机器人机械手的负载的重力和重心的系统;以及
图3除了图1中说明的方法之外还示出了象征性表示的静态姿势。
附图中的图示是示意性的而不是按比例绘制的。
具体实施方式
图1示出了用于确定机器人机械手1的负载11的重力和重心的方法,其中,机器人机械手1布置在基座3处并具有多个连杆5,并且连杆5通过关节7彼此连接并可通过关节5处的致动器6相对于彼此旋转,并且其中,机器人机械手1具有用于抓取负载11的末端执行器9。该方法具有以下步骤:
-使用末端执行器9抓取S1负载11;
-将负载11移动S2到数量n个成对不同的静态姿势;
-针对n个静态姿势中的每一个确定S3相应外力旋量Fext,其中,该相应外力旋量Fext指示外部作用在机器人机械手1上的力和力矩;
-在基座坐标系中至少确定S4相应外力旋量Fext的指示外力的分量,其中,基座坐标系是笛卡尔坐标系并主体固定地布置在机器人机械手1的基座3处,并且基座坐标系的轴线平行于重力向量;
-根据相应外力旋量Fext的在基座坐标系中指示外力的分量中的朝重力向量的方向指向的相应分量确定S5负载11的重力的相应估计;
-通过对负载11的重力的相应估计求平均来确定S6负载11的重力;
-基于负载11的重力或针对相应静态姿势所确定的负载11的重力的相应估计以及基于外力旋量Fext的指示外部作用的力矩的分量,针对n个静态姿势中的每一个确定S7负载11的重心的坐标的估计;以及
-通过对重心的坐标的相应估计求平均来确定S8负载11的重心。
图2示出了用于确定机器人机械手1的负载11的重力和重心的系统100,其中,机器人机械手1布置在基座3处并具有多个连杆5,并且连杆5通过关节7彼此连接并可通过布置在关节5处的致动器6相对于彼此旋转。机器人机械手1具有以下:
-末端执行器9,该末端执行器9实施用于抓取负载11;
-控制单元101,该控制单元101实施成控制布置在关节7处的致动器6以将负载11移动到数量n个成对不同的静态姿势;
-估计单元103,该估计单元103实施成针对n个静态姿势中的每一个确定相应外力旋量Fext,其中,相应外力旋量Fext指示外部作用在机器人机械手1上的力和力矩并且由关节7中的扭矩传感器13以及由连杆5处的应变计15来确定;
-计算单元105,该计算单元105实施成:
a)在基座坐标系中至少指示相应外力旋量Fext的指示力的分量,其中,基座坐标系是笛卡尔坐标系并主体固定地布置在机器人机械手1的基座3处,并且基座坐标系的轴线平行于重力向量;
b)根据相应外力旋量Fext的在基座坐标系中指示外力的分量中的朝重力向量的方向指向的相应分量以及根据重力向量的大小确定负载11的重力的相应估计;
c)通过对负载11的重力的相应估计求平均来确定负载11的重力;
d)基于负载11的重力或针对相应静态姿势所确定的负载11的重力的相应估计以及基于相应外力旋量Fext的指示外部作用的力矩的分量,针对n个静态姿势中的每一个确定负载11的重心的坐标的估计;以及
e)通过对重心的坐标的相应估计求平均来确定负载11的重心。
图3除了图1的方法之外还更详细地但象征性地示出了负载11的各种静态姿势。该方法用于确定机器人机械手1的负载11的重力和重心,其中,机器人机械手1布置在基座3处并具有多个连杆5,并且连杆5通过关节7彼此连接并可通过关节5处的致动器6相对于彼此旋转,并且其中,机器人机械手1具有用于抓取负载11的末端执行器9。在使用末端执行器9抓取S1负载11之后,将负载11移动S2到数量n个成对不同的静态姿势。这些不同的静态姿势在图3中示出。将负载11从成对不同的方向多次移动到n个静态姿势中的数量m个,其中m≤n,其中,这里:m=n=4。静态姿势用q1、q2、q3和q4表示。针对这些静态姿势中的每一个确定S3相应外力旋量Fext,其中,相应外力旋量Fext在末端执行器坐标系中指示外部作用在机器人机械手1上的力和力矩。在这种情况下,外力旋量Fext具有六个分量。外力旋量Fext的前三个分量在此描述力,并且外力旋量Fext的随后的三个分量描述所检测的力矩。针对n个静态姿势中的每一个确定相应外力旋量Fext是在相对于末端执行器9主体固定的末端执行器坐标系K中进行,并且为了在基座坐标系B中至少确定相应外力旋量Fext的指示力的分量,在末端执行器坐标系K和基座坐标系B之间进行系变换。基座坐标系B是笛卡尔坐标系并设想主体固定地布置在机器人机械手1的基座3处,并且基座坐标系B的轴线平行于现场给出的重力向量。然后,根据相应外力旋量Fext的在基座坐标系B中指示外力的分量中的朝重力向量的方向指向的相应分量确定S5负载11的重力的相应估计:
在此,下标'K'表示索引前面的相应变量对末端执行器坐标系K的引用,并且相应变量前面的上标'B'表示基座坐标系B中的标记。此外,g表示局部主导的重力向量的大小。此外,借助指示'(3)'的表达式指示向量标记的外力旋量Fext的第三分量,适用于相应姿势q1、或q2、或q3或q4。因此,术语/>针对姿势q1至q4中的每一个描述了负载的质量的重力的相应估计。
确定负载11的重力是通过对负载11的重力的坐标的相应估计求算术平均来进行。
此外,基于针对相应静态姿势所确定的负载11的重力的相应估计以及基于相应外力旋量Fext的指示外部作用的力矩的分量,针对n个静态姿势中的每一个确定S7负载11的重心的坐标的估计。
坐标的估计针对相应估计使用由x、y、z构成的索引来指示,其中,指示'(4)'指示向量标记的外力旋量Fext的第四分量,指示'(5)'指示向量标记的外力旋量Fext的第五分量,以此类推。
在此,下标'K'表示索引前面的相应变量对末端执行器坐标系K的引用,并且相应变量前面的上标'K'表示末端执行器坐标系K中的标记。使用坐标x、y、z确定S8负载11的重心是通过对负载11的重心的坐标的相应估计求算术平均来进行:
在此,x、y、z表示负载的重心的相应坐标。
尽管已经通过优选的实施例更详细地图示和说明了本发明,但本发明不受公开的实施例的限制,并且本领域技术人员可以在不脱离本发明的保护范围的情况下从中推导出其他变型例。因此,显而易见的是,存在多种可能的变型例。还显而易见的是,以示例方式引用的实施方式实际上仅代表示例,不应以任何方式将其理解为例如对本发明的保护范围、可能的应用或构造的限制。相反,前面的描述和附图的描述使得本领域技术人员能够具体地实施示例性实施方式,其中,本领域技术人员在了解所公开的发明构思的情况下,可以在不脱离由权利要求及其合法等效物例如说明书中的进一步解释所限定的保护范围的情况下,例如针对在示例性实施方式中提到的各个元件的功能或布置进行各种变更。
附图标记说明:
1 机器人机械手
3 基座
5 连杆
6 致动器
7 关节
9 末端执行器
11 负载
13 扭矩传感器
15 应变计
100 系统
101 控制单元
103 估计单元
105 计算单元
S1 抓取
S2 移动
S3 确定
S4 确定
S5 确定
S6 确定
S7 确定
S8 确定
Claims (10)
1.一种用于确定机器人机械手(1)的负载(11)的重力和重心的方法,其中,所述机器人机械手(1)布置在基座(3)处并具有多个连杆(5),并且所述连杆(5)通过关节(7)彼此连接并可通过所述关节(5)处的致动器(6)相对于彼此位移或旋转,并且其中,所述机器人机械手(1)具有用于抓取所述负载(11)的末端执行器(9),所述方法具有以下步骤:
-使用所述末端执行器(9)抓取(S1)所述负载(11);
-将所述负载(11)移动(S2)到数量n个不同的静态姿势;
-针对所述n个静态姿势中的每一个确定(S3)相应外力旋量Fext,其中,所述相应外力旋量Fext指示外部作用在所述机器人机械手(1)上的力和力矩;
-在基座坐标系中至少确定(S4)所述相应外力旋量Fext的指示外力的分量,其中,所述基座坐标系是笛卡尔坐标系并主体固定地布置在所述机器人机械手(1)的所述基座(3)处,并且所述基座坐标系的轴线平行于重力向量;
-根据所述相应外力旋量Fext的在所述基座坐标系中指示外力的分量中的朝重力向量的方向指向的相应分量确定(S5)所述负载(11)的重力的相应估计;
-通过对所述负载(11)的重力的相应估计求平均来确定(S6)所述负载(11)的重力;
-基于所述负载(11)的重力或针对所述相应静态姿势所确定的所述负载(11)的重力的相应估计以及基于所述外力旋量Fext的指示外部作用的力矩的分量,针对所述n个静态姿势中的每一个确定(S7)所述负载(11)的重心的坐标的估计;以及
-通过对重心的坐标的相应估计求平均来确定(S8)所述负载(11)的重心。
2.根据权利要求1的方法,其中,所述外力旋量Fext由所述关节(7)中的扭矩传感器(13)来确定。
3.根据权利要求1的方法,其中,所述外力旋量Fext借助所述关节(7)处或所述连杆(5)处的应变计(15)来确定。
4.根据前述权利要求中任一项所述的方法,其中,将所述负载(11)从成对不同的方向多次移动到所述n个静态姿势中的数量m个,其中m≤n。
5.根据前述权利要求中任一项所述的方法,其中,n=8。
6.根据前述权利要求中任一项所述的方法,其中,针对所述n个静态姿势中的每一个确定相应外力旋量Fext是在相对于所述末端执行器(9)主体固定的末端执行器坐标系中进行,并且为了在所述基座坐标系中至少确定所述相应外力旋量Fext的指示力的分量,在所述末端执行器坐标系和所述基座坐标系之间进行系变换。
7.根据前述权利要求中任一项所述的方法,其中,针对所述n个静态姿势中的每一个确定所述负载(11)的重心的坐标的估计是在相对于所述末端执行器(9)主体固定的末端执行器坐标系中进行。
8.根据前述权利要求中任一项所述的方法,其中,确定所述负载(11)的重心是通过对所述负载(11)的重心的坐标的相应估计求算术平均来进行。
9.根据前述权利要求中任一项所述的方法,其中,确定所述负载(11)的重力是通过对所述负载(11)的重力的相应估计求算术平均来进行。
10.一种用于确定机器人机械手(1)的负载(11)的重力和重心的系统(100),其中,所述机器人机械手(1)布置在基座(3)处并具有多个连杆(5),并且所述连杆(5)通过关节(7)彼此连接并可通过布置在所述关节(5)处的致动器(6)相对于彼此旋转,并且其中,所述机器人机械手(1)具有:
-末端执行器(9),所述末端执行器(9)实施用于抓取所述负载(11);
-控制单元(101),所述控制单元(101)实施成控制布置在所述关节(7)处的所述致动器(6)以将所述负载(11)移动到数量n个不同的静态姿势;
-估计单元(103),所述估计单元(103)实施成针对所述n个静态姿势中的每一个确定相应外力旋量Fext,其中,所述相应外力旋量Fext指示外部作用在所述机器人机械手(1)上的力和力矩;
-计算单元(105),所述计算单元(105)实施成:
a)在基座坐标系中至少指示所述相应外力旋量Fext的指示力的分量,其中,所述基座坐标系是笛卡尔坐标系并主体固定地布置在所述机器人机械手(1)的所述基座(3)处,并且所述基座坐标系的轴线平行于重力向量;
b)根据所述相应外力旋量Fext的在所述基座坐标系中指示外力的分量中的朝重力向量的方向指向的相应分量以及根据重力向量的大小确定所述负载(11)的重力的相应估计;
c)通过对所述负载(11)的重力的相应估计求平均来确定所述负载(11)的重力;
d)基于所述负载(11)的重力或针对所述相应静态姿势所确定的所述负载(11)的重力的相应估计以及基于所述相应外力旋量Fext的指示外部作用的力矩的分量,针对所述n个静态姿势中的每一个确定所述负载(11)的重心的坐标的估计;以及
e)通过对重心的坐标的相应估计求平均来确定(S8)所述负载(11)的重心。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102019101595.2 | 2019-01-23 | ||
DE102019101595.2A DE102019101595B3 (de) | 2019-01-23 | 2019-01-23 | Verfahren zum Ermitteln einer Gewichtskraft und eines Schwerpunktes einer Robotermanipulatorlast |
PCT/EP2020/051453 WO2020152191A1 (de) | 2019-01-23 | 2020-01-22 | Verfahren zum ermitteln einer gewichtskraft und eines schwerpunktes einer robotermanipulatorlast |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113286683A CN113286683A (zh) | 2021-08-20 |
CN113286683B true CN113286683B (zh) | 2024-06-11 |
Family
ID=69570617
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202080008323.9A Active CN113286683B (zh) | 2019-01-23 | 2020-01-22 | 用于确定机器人机械手的负载的重力和重心的方法 |
Country Status (8)
Country | Link |
---|---|
US (1) | US20220088804A1 (zh) |
EP (1) | EP3914423A1 (zh) |
JP (1) | JP7319722B2 (zh) |
KR (1) | KR20220020242A (zh) |
CN (1) | CN113286683B (zh) |
DE (1) | DE102019101595B3 (zh) |
SG (1) | SG11202108018YA (zh) |
WO (1) | WO2020152191A1 (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6795540B2 (ja) * | 2018-04-24 | 2020-12-02 | ファナック株式会社 | ロボットを用いた負荷の重量及び重心位置を推定するための装置、方法及びプログラム |
DE102019120157B3 (de) * | 2019-07-25 | 2020-08-20 | Franka Emika Gmbh | Verifikation eines Massemodells eines Robotermanipulators |
KR102279329B1 (ko) * | 2020-01-30 | 2021-07-21 | 한국과학기술연구원 | 로봇 교시 시스템 |
EP3862835B1 (en) * | 2020-02-10 | 2023-10-25 | Volocopter GmbH | Method and system for monitoring a condition of a vtol-aircraft |
DE102020135010B4 (de) | 2020-12-29 | 2024-05-08 | Franka Emika Gmbh | Massedaten-Schätzung einer externen Last für einen Robotermanipulator |
DE102020135011B3 (de) | 2020-12-29 | 2022-03-03 | Franka Emika Gmbh | Bilderkennung zum angepassten Ausführen eines Steuerprogramms eines Robotermanipulators |
CN114427932B (zh) * | 2022-04-07 | 2022-06-17 | 中国汽车技术研究中心有限公司 | 一种用于碰撞假人的质心测量方法及质心测量仪 |
CN116834022A (zh) * | 2023-08-23 | 2023-10-03 | 长广溪智能制造(无锡)有限公司 | 机器臂末端负载的质量和质心位置辨识方法及装置 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08252787A (ja) * | 1995-03-17 | 1996-10-01 | Yaskawa Electric Corp | ロボットの制御パラメータ推定方法 |
JP2004025387A (ja) * | 2002-06-27 | 2004-01-29 | Nachi Fujikoshi Corp | 多関節ロボットの負荷重量及び負荷重心位置の自動算出方法 |
JP2010076074A (ja) * | 2008-09-29 | 2010-04-08 | Panasonic Corp | ロボットの制御方法 |
JP2011235374A (ja) * | 2010-05-07 | 2011-11-24 | Yaskawa Electric Corp | ロボットの負荷推定装置及び負荷推定方法 |
CN103302667A (zh) * | 2012-03-15 | 2013-09-18 | 株式会社捷太格特 | 机器人控制方法、机器人控制装置和机器人控制系统 |
CN103495977A (zh) * | 2013-09-29 | 2014-01-08 | 北京航空航天大学 | 一种6r型工业机器人负载识别方法 |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN104108103A (zh) * | 2013-04-18 | 2014-10-22 | 发那科株式会社 | 具备搬运工件的机器人的机器人系统 |
CN108463314A (zh) * | 2016-01-11 | 2018-08-28 | 库卡德国有限公司 | 机器人相对于重力方向的定向的确定 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3766484B2 (ja) * | 1996-11-01 | 2006-04-12 | 株式会社不二越 | 多関節ロボットの負荷重量及び負荷重心位置の自動算出方法 |
JP4054984B2 (ja) | 2001-12-20 | 2008-03-05 | 株式会社安川電機 | ロボットの制御装置および制御方法 |
JP4289619B2 (ja) | 2004-09-15 | 2009-07-01 | 富士フイルム株式会社 | 多関節ロボットのツール位置補正方法 |
DE102007026114A1 (de) * | 2007-06-05 | 2008-12-11 | Siemens Ag | Positioniervorrichtung und Verfahren zum Positionieren einer Last sowie medizinische Diagnostik- und/oder Therapieanlage |
JP5720876B2 (ja) * | 2010-11-29 | 2015-05-20 | 株式会社Ihi | 加工ロボット及びその重力補償方法 |
JP6007636B2 (ja) * | 2012-07-20 | 2016-10-12 | セイコーエプソン株式会社 | ロボット制御システム及びロボット制御装置 |
KR101575487B1 (ko) * | 2014-06-11 | 2015-12-08 | 현대자동차주식회사 | 로봇의 대상물 무게 및 무게중심 산출시스템 및 그 제어방법 |
JP6223640B2 (ja) * | 2015-06-22 | 2017-11-01 | 三菱電機株式会社 | キャリブレーション装置およびこれを用いたロボットシステム |
JP2017024142A (ja) * | 2015-07-27 | 2017-02-02 | ファナック株式会社 | 支持体の弾性変形を補償するロボット制御装置 |
JP6487385B2 (ja) * | 2016-07-20 | 2019-03-20 | ファナック株式会社 | ロボットの原点位置較正装置および方法 |
JP6464205B2 (ja) * | 2017-01-17 | 2019-02-06 | ファナック株式会社 | ロボット制御装置 |
JP6834655B2 (ja) * | 2017-03-23 | 2021-02-24 | 株式会社デンソーウェーブ | ロボットの負荷重心位置推定装置及びロボットの負荷重心位置推定方法 |
JP6795540B2 (ja) * | 2018-04-24 | 2020-12-02 | ファナック株式会社 | ロボットを用いた負荷の重量及び重心位置を推定するための装置、方法及びプログラム |
US11027435B2 (en) * | 2018-12-04 | 2021-06-08 | Raytheon Company | Automated work piece testing system and method for same |
-
2019
- 2019-01-23 DE DE102019101595.2A patent/DE102019101595B3/de not_active Expired - Fee Related
-
2020
- 2020-01-22 US US17/420,017 patent/US20220088804A1/en active Pending
- 2020-01-22 WO PCT/EP2020/051453 patent/WO2020152191A1/de unknown
- 2020-01-22 KR KR1020217026418A patent/KR20220020242A/ko active IP Right Grant
- 2020-01-22 SG SG11202108018YA patent/SG11202108018YA/en unknown
- 2020-01-22 EP EP20704177.3A patent/EP3914423A1/de not_active Withdrawn
- 2020-01-22 CN CN202080008323.9A patent/CN113286683B/zh active Active
- 2020-01-22 JP JP2021543128A patent/JP7319722B2/ja active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08252787A (ja) * | 1995-03-17 | 1996-10-01 | Yaskawa Electric Corp | ロボットの制御パラメータ推定方法 |
JP2004025387A (ja) * | 2002-06-27 | 2004-01-29 | Nachi Fujikoshi Corp | 多関節ロボットの負荷重量及び負荷重心位置の自動算出方法 |
JP2010076074A (ja) * | 2008-09-29 | 2010-04-08 | Panasonic Corp | ロボットの制御方法 |
JP2011235374A (ja) * | 2010-05-07 | 2011-11-24 | Yaskawa Electric Corp | ロボットの負荷推定装置及び負荷推定方法 |
CN103302667A (zh) * | 2012-03-15 | 2013-09-18 | 株式会社捷太格特 | 机器人控制方法、机器人控制装置和机器人控制系统 |
CN104108103A (zh) * | 2013-04-18 | 2014-10-22 | 发那科株式会社 | 具备搬运工件的机器人的机器人系统 |
CN103495977A (zh) * | 2013-09-29 | 2014-01-08 | 北京航空航天大学 | 一种6r型工业机器人负载识别方法 |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN108463314A (zh) * | 2016-01-11 | 2018-08-28 | 库卡德国有限公司 | 机器人相对于重力方向的定向的确定 |
Also Published As
Publication number | Publication date |
---|---|
JP2022518277A (ja) | 2022-03-14 |
KR20220020242A (ko) | 2022-02-18 |
JP7319722B2 (ja) | 2023-08-02 |
EP3914423A1 (de) | 2021-12-01 |
WO2020152191A1 (de) | 2020-07-30 |
SG11202108018YA (en) | 2021-09-29 |
US20220088804A1 (en) | 2022-03-24 |
CN113286683A (zh) | 2021-08-20 |
DE102019101595B3 (de) | 2020-03-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113286683B (zh) | 用于确定机器人机械手的负载的重力和重心的方法 | |
US11597095B2 (en) | Systems and methods for providing contact detection in an articulated arm | |
CA1330363C (en) | Robot system | |
US9555548B2 (en) | Robot control device for controlling robot moved according to applied force | |
JP5849451B2 (ja) | ロボットの故障検出方法、制御装置およびロボット | |
JP6044511B2 (ja) | ロボットの制御方法及びロボットシステム | |
JP6831530B2 (ja) | 外乱オブザーバ及びロボット制御装置 | |
US10300602B2 (en) | Method and means for handling an object | |
WO2020239181A1 (en) | Detection of change in contact between robot arm and an object | |
Namiki et al. | Ball catching in kendama game by estimating grasp conditions based on a high-speed vision system and tactile sensors | |
US11999049B2 (en) | Tactile feedback of an end effector of a robot manipulator over different orientation ranges | |
SE516720C2 (sv) | Utrustning för styrning av en industrirobot och förfarande för programmering och/eller justering av robotens rörelse | |
JP2023508912A (ja) | ロボットマニピュレータの仮想力センサの較正 | |
CN110871456B (zh) | 机器人 | |
US20220388161A1 (en) | Force measurement and force generation in redundant robot manipulators | |
JP2016179523A (ja) | ロボット制御装置およびロボットシステム | |
CN118076467A (zh) | 把持控制装置和把持控制方法 | |
KR101292550B1 (ko) | 볼-온-플레이트 시스템 균형 제어 장치 및 방법 |
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 |