[发明专利]一种机器人电机端惯量实时计算方法

说明书

本发明涉及机器人伺服控制系统的性能领域，具体是一种机器人电机端惯量实时计算方法，其具体步骤如下：S1、利用软件统计模型参数；S2、计算机器人各个轴惯量；S3、存储离线辨识结果对计算结果的误差补偿量；S4、机器人工作时根据轴角度计算轴惯量和补偿量；本发明提出的在线惯量计算方法，相比离线辨识算法可以实时计算更新参数，操作简单，不需要单独对机器人进行辨识运行，省去了等待辨识结果的时间，对运行条件几乎无要求，相比在线辨识算法对控制参数变化也不敏感，抗干扰性好，经过误差补偿后辨识的精度相比在线辨识算法较高，相比模型计算的方法，可以极大的减小运算开销，同时计算的惯量精度也有明显的提高。

技术领域

本发明涉及机器人伺服控制系统的性能领域，具体是一种机器人电机端惯量实时计算方法。

背景技术

机器人行业的不断发展，对伺服控制系统的性能提出了更高的要求，但是机器人在运行过程中电机端转动惯量的变化容易造成控制器参数的不匹配，从而降低系统的带宽和稳定裕度，在很大程度上制约了系统性能的提高。

目前惯量辨识的方法主要可以分为离线辨识和在线辨识两种。以加减速法为代表的一类离线惯量辨识方法，辨识精度高，同时运算简单，易于产品化，但缺点是对运行条件和运行速度曲线要求高，无法实现惯量的在线辨识；而以最小二乘法和模型参考自适应等方法为代表的在线惯量辨识方法，却存在参数敏感、抗干扰性差以及运算开销大等不足，而根据机器人动力学模型计算惯量的方法存在运算开销极大，且模型参数与实际误差较大的问题。

以前的轴惯量模型计算的方法是根据动力学模型计算的，由于其动力学正向和逆向计算需要巨大的运算开销，因而只在运动控制器中使用，而不适用于电机驱动器。本发明对机器人动力学正向和逆向计算进行了整理简化，得到了上述的惯量在线计算公式，从而极大的减少了惯量计算的执行时间，使得在驱动器上实时计算机器人各个轴的惯量只需要很小的运算开销，这个是本发明的一个关键点和保护点，此外，以前的轴惯量模型计算的方法由于没有对计算结果进行补偿，导致惯量计算值有较大的误差。

发明内容

为了解决上述问题，本发明提出一种机器人电机端惯量实时计算方法。

一种机器人电机端惯量实时计算方法，其具体步骤如下：

S1、利用软件统计模型参数：利用三维建模软件统计机器人各个轴在机器人坐标系下的质量m、质心坐标与质量的乘积向量Pm，坐标系旋转矩阵R和P，惯性张量矩阵I；

S2、计算机器人各个轴惯量：

a、利用下式循环计算各个轴的惯量：

其中，*代表两个向量的内积，×代表两个向量的外积，i是所要计算惯量的机器人轴号，s是机器人的总轴数，A是各个轴的角度，代表当前轴的单位加速度，R^T是R的转置矩阵；

b、得到当前轴的惯量后，经过与减速比计算折算到电机端惯量；

S3、存储离线辨识结果对计算结果的误差补偿量：

a、将机器人轴的运动范围分别等间隔划分为不同的位置；

b、分别在每个位置使用离线惯量辨识算法辨识得到当前位置处的惯量，减去在该位置处由步骤S2所计算的电机端惯量，即可得到电机的补偿惯量大小；

S4、机器人工作时根据轴角度计算轴惯量和补偿量：

a、对机器人每个轴重复步骤S3；

b、对计算所得到的补偿惯量结果进行平均值计算，即可得到电机的补偿惯量平均值，将该补偿量存储在驱动器的表格中。

所述的步骤S1中，当机器人带负载时，需要将负载的各个参数叠加到与其连接的轴的相应参数上。