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