机器人关节伺服电机转矩常数的测量方法技术

本发明专利技术公开了机器人关节伺服电机转矩常数的测量方法，包括以下步骤：在机器人末端安装已知质心位置和质量的负载；将待测的伺服电机相对应的机器人关节来回进行运动，其余关节不动；采样该关节匀速段的关节角度序列[θ1,θ2,…,θN]及该关节角度序列对应的伺服电机的电流值；将对应关节角度下的正反转的电流值进行处理后得到电流序列[Im1,Im2,…,ImN]，通过计算得到不同关节角度下的关节力矩[τm1,τm2,…,τmN]；最后将上述数据线性拟合得到伺服电机的转矩常数。本发明专利技术在不需要力矩传感器等额外设备、也无需对伺服电机进行拆卸的情况下，能够测量安装于机器人上的伺服电机的转矩常数。

Measurement Method of Torque Constant of Robot Joint Servomotor

The invention discloses a method for measuring the torque constant of a robot joint servo motor, which includes the following steps: installing a load with known centroid position and mass at the end of the robot; moving the corresponding robot joints of the servo motor to be measured back and forth, while the rest joints remain immobile; sampling the joint angle sequence of the joint uniform speed section [theta 1, theta 2,... The current value of the servo motor corresponding to the joint angle sequence and the forward and reverse current values corresponding to the joint angle sequence are processed to obtain the current sequence [Im1, Im2,...] ImN, the joint torques at different joint angles [m1, m2,... MN]. Finally, the torque constant of the servo motor is obtained by linear fitting of the above data. The invention can measure the torque constant of the servo motor mounted on the robot without additional equipment such as a moment sensor and disassembly of the servo motor.

【技术实现步骤摘要】
机器人关节伺服电机转矩常数的测量方法
本专利技术涉及伺服电机转矩常数的测量方法。
技术介绍
伺服电机是机器人的重要组成部分之一，伺服电机产生的力矩和力，直接或间接地驱动机器人本体来获得机器人的各种运动。为了满足更高速高精度的机器人运动需求，对机器人关节伺服电机的控制技术提出了更高的要求，一些新的控制方法例如基于机器人动力学模型的力矩前馈补偿控制等被广泛研究。因此，伺服电机参数在机器人测试和应用中显得尤为重要。伺服电机的转矩常数是其中非常重要的一个参数，它直接反映了电机电流与力矩之间的关系。由于大部分机器人没有安装关节力矩传感器，关节力矩只能通过电机电流来表征，再通过转矩常数将电机电流转化为关节力矩，并与机器人动力学模型等相关联。大部分电机在出厂时附带的参数表中一般会标有转矩常数参数，但该值是一个范围值，且伺服电机安装于机器人后，关节输出端还需要经过减速机、同步带等设备，因此有必要重新测量其转矩常数参数。
技术实现思路
本专利技术所要解决的技术问题在于提供一种在不需要力矩传感器等额外设备、也无需对伺服电机进行拆卸的情况下，能够测量安装于机器人上的伺服电机的转矩常数的测量方法。为解决上述技术问题，本专利技术实施例提供了一种机器人关节伺服电机转矩常数的测量方法，包括以下步骤：在机器人末端安装已知质心位置和质量的负载；控制与待测的伺服电机相对应的机器人关节来回运动，而机器人的其余关节不动，并使机器人关节来回运动的范围不超过规定的机器人关节运动范围，且机器人在运动过程中存在匀速运动阶段；在机器人关节来回运动时的匀速运动阶段以预定的时间间隔采样与待测的伺服电机相对应的机器人关节的关节角度和待测伺服电机的电流值；将每一关节角度下在伺服电机正转时所对应的电流值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本文档来自技高网...

【技术保护点】
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。

【技术特征摘要】
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。2.如权利要求1所述的机器人关节伺服电机转矩常数的测量方法，其特征在于，所述关节力矩序列[τm1,τm2,…,τmN]中的每一个关节力矩值是通过以下方式得到：将所述负载的质量和质心位置、机器人各个关节的质量、质心位置和关节角度代入机器人的动力学模型中，通过计算得到重力...

【专利技术属性】
技术研发人员：林俐，袁建军，韩哲东，李生，熊圆圆，
申请(专利权)人：上海新时达机器人有限公司，
类型：发明
国别省市：上海,31