CN109434873B - 机器人关节伺服电机转矩常数的测量方法 - Google Patents
机器人关节伺服电机转矩常数的测量方法 Download PDFInfo
- Publication number
- CN109434873B CN109434873B CN201811315487.7A CN201811315487A CN109434873B CN 109434873 B CN109434873 B CN 109434873B CN 201811315487 A CN201811315487 A CN 201811315487A CN 109434873 B CN109434873 B CN 109434873B
- Authority
- CN
- China
- Prior art keywords
- joint
- robot
- servo motor
- mass
- moment
- 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
Images
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
-
- 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/0095—Means or methods for testing manipulators
Abstract
本发明公开了机器人关节伺服电机转矩常数的测量方法,包括以下步骤:在机器人末端安装已知质心位置和质量的负载;将待测的伺服电机相对应的机器人关节来回进行运动,其余关节不动;采样该关节匀速段的关节角度序列[θ1,θ2,…,θN]及该关节角度序列对应的伺服电机的电流值;将对应关节角度下的正反转的电流值进行处理后得到电流序列[Im1,Im2,…,ImN],通过计算得到不同关节角度下的关节力矩[τm1,τm2,…,τmN];最后将上述数据线性拟合得到伺服电机的转矩常数。本发明在不需要力矩传感器等额外设备、也无需对伺服电机进行拆卸的情况下,能够测量安装于机器人上的伺服电机的转矩常数。
Description
技术领域
本发明涉及伺服电机转矩常数的测量方法。
背景技术
伺服电机是机器人的重要组成部分之一,伺服电机产生的力矩和力,直接或间接地驱动机器人本体来获得机器人的各种运动。为了满足更高速高精度的机器人运动需求,对机器人关节伺服电机的控制技术提出了更高的要求,一些新的控制方法例如基于机器人动力学模型的力矩前馈补偿控制等被广泛研究。因此,伺服电机参数在机器人测试和应用中显得尤为重要。
伺服电机的转矩常数是其中非常重要的一个参数,它直接反映了电机电流与力矩之间的关系。由于大部分机器人没有安装关节力矩传感器,关节力矩只能通过电机电流来表征,再通过转矩常数将电机电流转化为关节力矩,并与机器人动力学模型等相关联。大部分电机在出厂时附带的参数表中一般会标有转矩常数参数,但该值是一个范围值,且伺服电机安装于机器人后,关节输出端还需要经过减速机、同步带等设备,因此有必要重新测量其转矩常数参数。
发明内容
本发明所要解决的技术问题在于提供一种在不需要力矩传感器等额外设备、也无需对伺服电机进行拆卸的情况下,能够测量安装于机器人上的伺服电机的转矩常数的测量方法。
为解决上述技术问题,本发明实施例提供了一种机器人关节伺服电机转矩常数的测量方法,包括以下步骤:
在机器人末端安装已知质心位置和质量的负载;
控制与待测的伺服电机相对应的机器人关节来回运动,而机器人的其余关节不动,并使机器人关节来回运动的范围不超过规定的机器人关节运动范围,且机器人在运动过程中存在匀速运动阶段;
在机器人关节来回运动时的匀速运动阶段以预定的时间间隔采样与待测的伺服电机相对应的机器人关节的关节角度和待测伺服电机的电流值;
将每一关节角度下在伺服电机正转时所对应的电流值Im+和在伺服电机反转时对应的电流值Im-相加后除以2,得到该关节角度下伺服电机的电流值Im为Im=(Im++Im-)/2;对于采样得到的一系列关节角度[θ1,θ2,…,θN],得到相对应的电流序列[Im1,Im2,…,ImN],其中,N为大于等于10的整数;
通过计算得到与所述的一系列关节角度[θ1,θ2,…,θN]相对应的关节力矩序列[τm1,τm2,…,τmN];
基于关节力矩序列[τm1,τm2,…,τmN]和电流序列[Im1,Im2,…,ImN],通过线性拟合得到机器人关节伺服电机的转矩常数KT。
根据本发明又一实施例的一种机器人关节伺服电机转矩常数的测量方法,包括以下步骤:
在机器人末端安装已知质心位置和质量的负载;
控制与待测的伺服电机相对应的机器人关节来回运动,而机器人的其余关节不动,并使机器人关节来回运动的范围不超过规定的机器人关节运动范围,且机器人在运动过程中存在匀速运动阶段;
在机器人关节来回运动时的匀速运动阶段以预定的时间间隔采样与待测的伺服电机相对应的机器人关节的关节角度和待测伺服电机的电流值;
将每一关节角度下在伺服电机正转时所对应的电流值Im+和在伺服电机反转时对应的电流值Im-相加后除以2,得到该关节角度下伺服电机的电流值Im为Im=(Im++Im-)/2;对于采样得到的一系列关节角度[θ1,θ2,…,θN],得到相对应的电流序列[Im1,Im2,…,ImN],其中,N为大于等于10的整数;
通过计算得到与一系列关节角度[θ1,θ2,…,θN]相对应的关节力矩序列[τm1,τm2,…,τmN];
通过更换不同的末端负载或改变机器人的其余关节中一个或多个关节的关节位置,重新控制与待测的伺服电机相对应的机器人关节来回运动,得到多个关节力矩序列和多个电流序列;
基于多个关节力矩序列和多个电流序列,通过线性拟合得到机器人关节伺服电机的转矩常数KT。
本发明至少具有以下优点:
采用根据本发明实施例的伺服电机转矩常数的测量方法不需要力矩传感器等额外设备,也不需要对伺服电机进行拆卸,测量过程简单,实施成本低。通过该测量方法得到的转矩常数可以直接地反应出伺服电机电流与关节力矩之间的关系,在基于机器人动力学模型的伺服控制的应用中尤为重要。
附图说明
图1示出了根据本发明一实施例的机器人关节伺服电机转矩常数的测量方法的示意图。
图2示出了某型号机器人第1关节的伺服电机的转矩常数模拟结果示意图。
具体实施方式
下面结合附图对本发明做出进一步说明。
请参阅图1。根据本发明一实施例的一种机器人关节伺服电机转矩常数的测量方法,包括以下步骤:
在机器人末端安装已知质心位置和质量的负载;
控制与待测的伺服电机相对应的机器人关节来回运动,而机器人的其余关节不动,并使机器人关节来回运动的范围不超过规定的机器人关节运动范围,且机器人在运动过程中存在匀速运动阶段;
在机器人关节来回运动时的匀速运动阶段以预定的时间间隔采样与待测的伺服电机相对应的机器人关节的关节角度和待测伺服电机的电流值;其中,机器人关节在做“来侧”运动时,伺服电机的转动方向为正转或反转中的一者,机器人关节在做“回侧”运动时,伺服电机的转动方向为正转或反转中的另一者;
将每一关节角度下在伺服电机正转时所对应的电流值Im+和在伺服电机反转时对应的电流值Im-相加后除以2,得到该关节角度下伺服电机的电流值Im为Im=(Im++Im-)/2;对于采样得到的一系列关节角度[θ1,θ2,…,θN],得到相对应的电流序列[Im1,Im2,…,ImN],其中,N为大于等于10的整数;
通过计算得到与一系列关节角度[θ1,θ2,…,θN]相对应的关节力矩序列[τm1,τm2,…,τmN];
基于关节力矩序列[τm1,τm2,…,τmN]和电流序列[Im1,Im2,…,ImN],通过线性拟合得到机器人关节伺服电机的转矩常数KT。
以下以测量六轴机器人的第四关节的伺服电机转矩常数为例,说明具体的测量的过程如下。
步骤A、在机器人末端安装已知质心位置和质量的负载,同时分别将机器人的第一关节、第二关节、第三关节、第五关节和第六关节固定为某一角度。
步骤B、使用示教器控制机器人第四关节做来回运动,运动角度不超过规定的机器人关节运动范围(即机器人关节角度限制),且保证机器人在运动过程中存在匀速运动阶段。
步骤C、机器人控制器在机器人的匀速运动阶段以预定的时间间隔采样(该预定的时间间隔例如为机器人控制器的采样周期,如4ms或8ms)第四关节的关节角度和第四关节的伺服电机的电流值,得到一系列关节角度[θ1,θ2,…,θN]以及相应的伺服电机的电流数据。
步骤D、机器人控制器处理电流数据,将相同关节角度下电机正转和反转的电流数据处理得到该关节角度下伺服电机的电流值Im为:Im=(Im++Im-)/2;对于采样得到的一系列关节角度[θ1,θ2,…,θN],得到相对应的电流序列[Im1,Im2,…,ImN],其中,N=50。
步骤E、通过将负载的质量和质心位置、机器人各个关节的质量、质心位置和关节角度代入机器人的动力学模型中,通过计算得到机器人在第四关节处于每一采样得到的关节角度时的重力矩G(θ),关节力矩τm等于重力矩G(θ)。对于一系列的第四关节的关节角度[θ1,θ2,…,θN],可以计算得到第四关节的关节力矩序列[τm1,τm2,…,τmN]。
负载的质量和质心位置为已知,机器人各关节的质量和质心位置可以通过三维模型(例如CAD三维模型)或测量得到。
已知在关节空间中,机器人的动力学方程为:
其中,τm为关节力矩;
G(θ)为重力矩;
τf为关节摩擦力矩。
将关节位置、速度、加速度信息以及机器人惯性参数代入到上述动力学方程中即可以得到机器人运动过程中各关节所需的关节力矩。
当机器人第i个关节(本应用实例中是第四个关节)进行匀速运动,而其他关节不动的条件下有:
于是对于第i个关节,上述方程可以简化为:
即,关节力矩等于所添加的负载重力矩和关节的摩擦力矩。因为摩擦力矩与速度的方向相反,在正转条件下,有:
在反转条件下,有:
将两者相加有:
通过上述方程可以排除该关节摩擦力矩的影响,同时得到该关节在不同角度处的关节力矩。
对于机器人各关节,关节的负载为六关节末端添加的负载和其余关节。在本应用例中,机器人第四关节的负载为六关节末端添加的负载和机器人四五六关节,它们所产生的重力矩可以通过负载的惯性参数和机器人各关节的惯性参数计算得到。
步骤F、根据伺服电机的转矩常数KT的定义公式KT=τm/Im,基于关节力矩序列[τm1,τm2,…,τmN]和电流序列[Im1,Im2,…,ImN],通过线性拟合得到机器人第四关节的伺服电机的转矩常数KT。
重复上述步骤,还可以得到机器人其余各关节的伺服电机的转矩常数。即,将机器人第i个关节(i等于1、2、3、5或6)来回进行运动,其余关节不动,通过机器人控制器采样记录下该关节匀速段的关节角度序列[θ1,θ2,…,θN]及该关节角度序列对应的伺服电机的电流值,将对应关节角度下的正反转的电流值进行处理后得到电流序列[Im1,Im2,…,ImN],同时通过模型计算得到不同关节角度下的关节力矩[τm1,τm2,…,τmN],最后将上述数据线性拟合得到伺服电机的转矩常数。
为了使测量结果更加精确,在其它的应用实例中,在步骤E之后,进一步通过更换不同的末端负载或改变机器人的其余关节中一个或多个关节的关节位置,重新控制与待测的伺服电机相对应的机器人关节来回运动(对于第四关节而言,是除了第四关节以外的其余一个或多个关节,重新控制第四关节来回运动),得到多个关节力矩序列和多个电流序列,重复多次,获得的数据能够覆盖量程;最后基于多个关节力矩序列和多个电流序列,通过线性拟合得到机器人关节伺服电机的转矩常数KT。
图2示出了某型号机器人第一关节的伺服电机电流、关节力矩数据及拟合结果。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
Claims (3)
1.一种机器人关节伺服电机转矩常数的测量方法,其特征在于,包括以下步骤:
在机器人末端安装已知质心位置和质量的负载;
控制与待测的伺服电机相对应的机器人关节来回运动,而机器人的其余关节不动,并使机器人关节来回运动的范围不超过规定的机器人关节运动范围,且机器人在运动过程中存在匀速运动阶段;
在机器人关节来回运动时的匀速运动阶段以预定的时间间隔采样与待测的伺服电机相对应的机器人关节的关节角度和待测伺服电机的电流值;
将每一关节角度下在伺服电机正转时所对应的电流值Im+和在伺服电机反转时对应的电流值Im-相加后除以2,得到该关节角度下伺服电机的电流值Im为Im=(Im++Im-)/2;对于采样得到的一系列关节角度[θ1,θ2,…,θN],得到相对应的电流序列[Im1,Im2,…,ImN],其中,N为大于等于10的整数;
通过计算得到与所述的一系列关节角度[θ1,θ2,…,θN]相对应的关节力矩序列[τm1,τm2,…,τmN];所述关节力矩序列[τm1,τm2,…,τmN]中的每一个关节力矩值是通过以下方式得到:将所述负载的质量和质心位置、机器人各个关节的质量、质心位置和关节角度代入机器人的动力学模型中,通过计算得到重力矩,使关节力矩等于重力矩;
基于所述关节力矩序列[τm1,τm2,…,τmN]和所述电流序列[Im1,Im2,…,ImN],通过线性拟合得到机器人关节伺服电机的转矩常数KT。
2.如权利要求1所述的机器人关节伺服电机转矩常数的测量方法,其特征在于,机器人各个关节的质量和质心位置是通过机器人三维模型或测量得到。
3.一种机器人关节伺服电机转矩常数的测量方法,其特征在于,包括以下步骤:
在机器人末端安装已知质心位置和质量的负载;
控制与待测的伺服电机相对应的机器人关节来回运动,而机器人的其余关节不动,并使机器人关节来回运动的范围不超过规定的机器人关节运动范围,且机器人在运动过程中存在匀速运动阶段;
在机器人关节来回运动时的匀速运动阶段以预定的时间间隔采样与待测的伺服电机相对应的机器人关节的关节角度和待测伺服电机的电流值;
将每一关节角度下在伺服电机正转时所对应的电流值Im+和在伺服电机反转时对应的电流值Im-相加后除以2,得到该关节角度下伺服电机的电流值Im为Im=(Im++Im-)/2;对于采样得到的一系列关节角度[θ1,θ2,…,θN],得到相对应的电流序列[Im1,Im2,…,ImN],其中,N为大于等于10的整数;
通过计算得到与所述的一系列关节角度[θ1,θ2,…,θN]相对应的关节力矩序列[τm1,τm2,…,τmN];所述关节力矩序列[τm1,τm2,…,τmN]中的每一个关节力矩值是通过以下方式得到:将所述负载的质量和质心位置、机器人各个关节的质量、质心位置和关节角度代入机器人的动力学模型中,通过计算得到重力矩,使关节力矩等于重力矩;
通过更换不同的末端负载或改变机器人的其余关节中一个或多个关节的关节位置,重新控制与待测的伺服电机相对应的机器人关节来回运动,得到多个关节力矩序列和多个电流序列;
基于所述多个关节力矩序列和所述多个电流序列,通过线性拟合得到机器人关节伺服电机的转矩常数KT。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811315487.7A CN109434873B (zh) | 2018-11-06 | 2018-11-06 | 机器人关节伺服电机转矩常数的测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811315487.7A CN109434873B (zh) | 2018-11-06 | 2018-11-06 | 机器人关节伺服电机转矩常数的测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109434873A CN109434873A (zh) | 2019-03-08 |
CN109434873B true CN109434873B (zh) | 2023-01-06 |
Family
ID=65551793
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811315487.7A Active CN109434873B (zh) | 2018-11-06 | 2018-11-06 | 机器人关节伺服电机转矩常数的测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109434873B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110181505B (zh) * | 2019-04-22 | 2021-09-07 | 珠海格力智能装备有限公司 | 机器人的减速机确定的方法及机器人 |
CN110524577B (zh) * | 2019-08-12 | 2021-03-02 | 珠海格力智能装备有限公司 | 一种用于机器人关节力矩刚性的测量方法和装置 |
CN112140111B (zh) * | 2020-09-24 | 2022-08-19 | 珠海格力智能装备有限公司 | 机器人的末端负载质心的确定方法 |
CN112405615B (zh) * | 2020-10-30 | 2021-11-30 | 珠海格力电器股份有限公司 | 机器人末端负载质量检测方法、装置及工业机器人 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4925312A (en) * | 1988-03-21 | 1990-05-15 | Staubli International Ag | Robot control system having adaptive feedforward torque control for improved accuracy |
CN103425100B (zh) * | 2013-07-23 | 2015-10-21 | 南京航空航天大学 | 基于力矩平衡的机器人直接示教控制方法 |
CN108227492B (zh) * | 2018-01-03 | 2020-07-14 | 华中科技大学 | 一种六自由度串联机器人末端负载动力学参数的辨识方法 |
-
2018
- 2018-11-06 CN CN201811315487.7A patent/CN109434873B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109434873A (zh) | 2019-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109434873B (zh) | 机器人关节伺服电机转矩常数的测量方法 | |
Duchaine et al. | Computationally efficient predictive robot control | |
CN106994686B (zh) | 关节外力力矩的计算方法及装置、机器人 | |
Akhtaruzzaman et al. | Modeling and control of a rotary inverted pendulum using various methods, comparative assessment and result analysis | |
US9434073B2 (en) | Robot apparatus and control method therefor | |
CN109927032A (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
JP2020526403A (ja) | 構成依存力学系を有するシステムの振動制御 | |
CN113561217A (zh) | 驱动机构、机器人设备测量和控制方法及部件制造方法 | |
Moberg et al. | Modeling and parameter estimation of robot manipulators using extended flexible joint models | |
CN107414827B (zh) | 基于线性反馈控制器的六自由度机械臂自适应检测方法 | |
CN109940609B (zh) | 一种基于中心对称静摩擦模型的机器人动力学建模方法 | |
CN112179551B (zh) | 机器人的关节电机转矩系数与摩擦力同步测试方法和装置 | |
CN109968402B (zh) | 回程间隙测量方法及控制方法、装置、系统和存储介质 | |
CN106233214A (zh) | 补偿机器人运动偏差 | |
WO2014091840A1 (ja) | サーボ制御装置 | |
CN110259879A (zh) | 用于电动Stewart结构的无力反馈隔振控制方法和系统 | |
Bayrak et al. | Design of an experimental twin‐rotor multi‐input multi‐output system | |
CN107351086B (zh) | 一种scara机器人关节力矩的卡尔曼估计方法 | |
CN113664869A (zh) | 机械臂、机械臂控制方法及系统 | |
Wu et al. | A study on tracking error based on mechatronics model of a 5-DOF hybrid spray-painting robot | |
Tjahjowidodo et al. | Nonlinear modelling and identification of torsional behaviour in harmonic drives | |
CN215825344U (zh) | 机械臂 | |
Kennedy et al. | Estimation and modeling of the harmonic drive transmission in the Mitsubishi PA-10 robot arm | |
CN114454150A (zh) | 一种基于复合学习的臂式机器人控制方法及机器人系统 | |
Yu et al. | Dynamical model and experimental identification of a cable-driven finger joint for surgical robot |
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 |