[发明专利]一种基于均值耦合的多机械臂系统自适应参数辨识与位置同步控制方法

摘要

一种基于均值耦合的多机械臂系统自适应参数辨识与位置同步控制方法，包括以下步骤：步骤1，建立多机械臂系统模型；步骤2，定义多机械臂跟踪误差、同步误差及均值耦合误差；步骤3，设计自适应参数估计律和控制器。本发明所设计的参数辨识和同步控制方案对多机械臂系统具有良好的辨识和控制效果，使多机械臂系统能够实现高精度参数辨识并且具有良好的跟踪性能和同步性能。

主权项

1.一种基于均值耦合的多机械臂系统自适应参数辨识与位置同步控制方法，其特征在于，所述控制方法包括以下步骤：步骤1,建立多机械臂动力学模型；一个由n个m关节的多机械臂动力学系统模型表示成如下形式：其中n为机械臂的数量，m为每个机械臂的关节数量，分别为机械臂的关节角位置矢量，速度矢量和加速度矢量，M(q)＝diag([M₁(q) … M_n(q)])为机械臂的正定惯性矩阵，表示离心力和哥氏力矩阵，为作用在关节上的重力矢量，为关节控制输入力矩矢量；步骤2,定义多机械臂跟踪误差、同步误差及均值耦合误差，过程如下：2.1,定义多机械臂跟踪误差e为：e＝qd‑q  (2)其中，为关节角位置误差，为期望的关节角位置矢量；2.2,定义多机械臂同步误差ε为：ε＝Te  (3)其中I为单位对角阵；2.3,定义多机械臂均值耦合误差E为：E＝e+βε＝Ae  (4)其中A＝I+βT是耦合系数矩阵，β＝diag([β₁ … β_n])代表同步系数，且为正定矩阵；步骤3,设计自适应参数估计律和控制器，过程如下：3.1,设计滑模面为：其中λ₁＞0为控制参数，辅助矩阵和其微分形式的表示形式为：3.2,定义辅助矩阵回归矩阵如下：其中是已知的回归矩阵，θ是未知的参数；由式(1)，式(5)，式(6)和式(7)得：其中由式(7)和式(8)得：3.3,将回归矩阵进行如下滤波操作：其中和τ_f分别是和τ滤波后的变量，k是调节参数；由式(9)和式(10)得：其中为滤波后的变量；3.4,定义两个动态方程P和Q如下：其中，l是调节参数；P(0)、Q(0)分别是P和Q的初值；由式(12)得：3.5,由式(11)和式(13)得到关于参数误差的信息：Q＝Pθ  (14)其中为θ的估计值，为估计误差；3.6,设计自适应参数估计律为：其中Γ＞0，κ＞0为自适应增益矩阵；3.7,设计自适应控制器为：其中K＞0为控制器参数；3.8,设计李雅普诺夫函数为：对V求导得：将式(8)和式(16)‑(17)代入式(19)，得到其中μ＝min{2λ_min(K)/λ_max(M(I+βT)^‑1),2κλ_min(P)/λ_max(Γ^‑1)}，λ_max(·)和λ_min(·)为对应矩阵的最大和最小特征值，由此判定系统是稳定的，并且状态量收敛。