[发明专利]一种基于自适应摩擦补偿的机械臂内模控制方法

说明书

本发明公开了一种基于自适应摩擦补偿的机械臂内模控制方法，涉及机械臂系统控制领域；该方法包括：步骤1，建立n自由度机械臂系统的动力学模型；步骤2，设计内模，将机械臂系统的位置跟踪和干扰抑制问题转化为由该系统和内模组成的增广系统的镇定问题；步骤3，设计最终控制器，对摩擦力进行补偿并解决增广系统的镇定问题。本发明针对机械臂系统在实际运行中存在外部力矩扰动和摩擦力的情况，设计了基于自适应摩擦补偿的内模控制器，在允许系统参数未知的情况下，可以对机械臂系统进行干扰抑制和摩擦补偿，从而实现对机械臂关节的高精度位置跟踪控制和速度跟踪控制。

技术领域

本发明涉及机械臂系统控制领域，具体为一种基于自适应摩擦补偿的机械臂内模控制方法。

背景技术

机械臂经过几十年的发展，不仅能精准高效地完成各种任务，而且还可以在一些恶劣环境中代替人类进行高风险重复性的工作，目前被广泛应用于焊接、装配、喷涂等工业场景中。同时，机械臂也是一个复杂的非线性系统，在实际应用中经常会受到参数不确定性、外部干扰和摩擦力的影响，这无疑会降低系统的控制精度，甚至会影响系统的稳定，因此在设计控制器时综合考虑参数不确定性、外部干扰和摩擦力的影响，从而实现对机械臂的高精度控制具有重要意义。

一方面，非线性输出调节理论在过去的几十年取得了很大进展，而其内模控制方法能够方便地解决系统的轨迹跟踪与干扰抑制问题，且具有良好的鲁棒性。另一方面，相比于其它摩擦力模型，Stribeck摩擦力模型能较准确反应摩擦非线性特性，因此在本发明中被用来描述机械臂的关节摩擦力矩。将内模控制方法和自适应摩擦补偿方法结合应用到机械臂系统中，可以在系统参数未知的情况下补偿摩擦，抑制干扰，最终实现高精度的位置跟踪性能和速度跟踪性能。

发明内容

基于背景技术存在的技术问题，本发明提出了一种基于自适应摩擦补偿的机械臂内模控制方法。针对机械臂系统在实际运行中存在外部力矩扰动和摩擦力的情况，设计了基于自适应摩擦补偿的内模控制器，在允许系统参数未知的情况下实现了机械臂系统的干扰抑制和摩擦补偿，具有良好的位置跟踪性能和速度跟踪性能。

本发明采用的技术方案是：

一种基于自适应摩擦补偿的机械臂内模控制方法，其特征在于，包括以下步骤：

步骤1：建立n自由度机械臂系统的动力学模型；

步骤2：设计内模，将机械臂系统的位置跟踪和干扰抑制问题转化为由该系统和内模组成的增广系统的镇定问题；

步骤3：设计最终控制器，对摩擦力进行补偿并解决增广系统的镇定问题。

步骤1中，建立n自由度机械臂系统的动力学模型，其过程如下：

1.1，根据欧拉—拉格朗日方法建立n自由度机械臂系统的动力学模型如下：

其中分别为机械臂的关节位置和速度向量，为正定对称的惯性矩阵，为向心力和科里奥利力矩，为重力矩，为输入力矩，为摩擦力矩，为外界扰动。上述机械臂系统具有以下性质：

性质1：矩阵和满足以下条件：

性质2：机械臂模型可进行下列参数线性化变换：

其中E(q,x),均为已知矩阵，满足为机械臂中不确定参数。

1.2，假设机械臂关节位置期望值为q_d，且q_d,均为连续有界信号，外部力矩干扰τ_d(t)＝[τ_d1(t),…,τ_dn(t)]^T为有限个阶跃信号和正弦信号的组合，形式如下：