[发明专利]一种串联机器人逆动力学快速计算方法

说明书

技术领域

本发明涉及串联机器人逆动力学计算方法，特别涉及一种串联机器人逆动力学快速计算方法。

背景技术

串联机器人在制造业、农业、娱乐业等行业得到越来越广泛的应用，许多应用场景需要串联机器人拥有高速、高精度的运动性能。基于串联机器人动力学模型的运动控制能赋予机器人高速、高精度的运动性能，这种方法需要不断实时进行串联机器人逆动力学计算。

目前串联机器人逆动力学模型多以拉格朗日方程法进行建模，这种方法得到的串联机器人逆动力学模型十分复杂，以6自由度的串联机器人为例，使用拉格朗日方程法得到的逆动力学模型，总共需要计算66271次乘法和51548次加法。而串联机器人控制器的伺服控制周期一般为1ms，显然如此复杂的模型无法在1ms之内完成计算。因此，需要更简洁的模型和更快速的计算方法才能实现串联机器人逆动力学实时计算。

发明内容

本发明的目的是提供一种串联机器人逆动力学快速计算方法，旨在解决串联机器人逆动力学实时计算问题。

本发明的目的通过下述技术方案来实现：

一种串联机器人逆动力学快速计算方法，包括如下步骤：

S1、使用牛顿-欧拉方程建立相对简洁的串联机器人逆动力学模型；

S2、解耦得到标准动力学参数和对应的回归矩阵；

S3、使用基于数值的简化方法对解耦后模型进行简化，得到基本动力学参数和对应的基本回归矩阵；

S4、借助符号运算工具对基本回归矩阵进行合并和简化，并提取反复出现的项作为中间项，优先计算以减少计算量。

进一步地，所述步骤S2包含如下步骤：

S2.1、使用迭代牛顿-欧拉动力学算法得到串联机器人的逆动力学表达式

式中，Γ为各关节力矩；分别为各关节的转角、角速度和角加速度；δ为各连杆的标准动力学参数，且δ＝[δ₁ δ₂ … δ_n]^T，δ_k为连杆k的标准动力学参数且δ_k＝[L_xxk L_xykL_xzk L_yyk L_yzk L_zzk l_xk l_yk l_zk m_k f_vk f_ck I_ak]^T；InvDYN(·)为机器人逆动力学模型函数；

为了便于进行串联机器人动力学参数辨识，需要将式(1)改写成如式(2)所示的线性形式

式中，被称作回归矩阵，是关于关节的转角、角速度和角加速度的函数；

S2.2、依次令矢量δ的第i个动力学参数等于1，其余动力学参数等于0，然后代入式(1)所示的InvDYN(·)函数中，则除去零项后，剩余项均为第i个动力学参数的相关项，将其赋值给回归矩阵H的相关列，最终得到完整的回归矩阵H。

进一步地，所述步骤S3包含如下步骤：

S3.1、可以将矩阵和机器人标准动力学参数δ分成两部分，则动力学方程可以写成如下的形式

式中，H_b为矩阵所有n_b个线性无关列组成的子矩阵；H_d为剩下的n_d个全零列向量和线性相关列组成的子矩阵；δ_b为基本动力学参数；δ_d为对动力学不起作用的动力学参数；

H_d可以用H_b线性表示，写作

H_d＝H_bK_d；(4)

S3.2、设置换矩阵P＝[P_b P_d]满足如下式

HP＝[H_b H_d]，(5)

则有

联立式(3)到(6)可以得到

H_b(δ_b+K_dδ_d)＝Γ，(7)

写成含基本动力学参数项的动力学方程，则为