一种机械臂系统的鲁棒滑模自适应控制方法技术方案

本发明专利技术公开了一种具有渐进跟踪性能的机械臂系统鲁棒滑模自适应控制方法，属于机械臂控制领域。该控制方法考虑了机械臂系统的参数等结构不确定性以及外干扰等非结构不确定性，并且针对参数等结构不确定性设计参数估计器；针对外干扰等非结构不确定性的上界设计出连续的鲁棒控制器；本发明专利技术所设计的鲁棒自适应控制器对同时存在参数等结构不确定性以及外干扰等非结构不确定性的机械臂系统有良好的作用，并能保证机械臂系统位置跟踪性能；本发明专利技术所设计的鲁棒滑模自适应控制器简单并且其控制输出连续，利于在工程实际中应用。

【技术实现步骤摘要】
一种机械臂系统的鲁棒滑模自适应控制方法
本专利技术涉及机械臂控制领域，尤其涉及一种机械臂系统的鲁棒滑模自适应控制方法。
技术介绍
机械臂系统是一个多输入多输出、高度非线性、强耦合的复杂系统。因其独特的操作灵活性，已经在工业装配、安全防爆等领域得到广泛的应用，如喷漆机器人、点焊机器人、拆弹机器人等。由于机械臂系统的复杂性，在控制器设计的过程中会面临着许多建模不确定性包括结构不确定性和非结构不确定性，这些因素会严重影响控制器性能，导致控制器控制精度降低，甚至使所设计的控制器不稳定，从而增加了控制器的设计难度。随着工业领域技术水平的不断进步，对机械臂的控制精度也在不断提高。但是传统的控制方法显然已经不能满足系统的高性能要求，成为限制机械臂控制性能的因素。近年来，随着控制技术的不断发展，各种基于现代控制理论的控制方法相继提出。其中滑模控制在机械臂中用的比较广泛，但是其不能对系统中存在参数等结构不确定性进行估计，当系统中存在大的参数等结构不确定性时将会使设计的控制器显得保守，从而使系统的性能恶化。针对机械臂系统中不确定非线性的特点，建立系统数学模型，并在此基础上设计了机械臂系统滑模自适应鲁棒控制克服系统参数不确定性和未建模不确定性。
技术实现思路
本专利技术为解决机械臂系统控制中的不确定非线性问题，进而提出一种机械臂鲁棒滑模自适应控制方法。本专利技术为解决上述问题采取具体步骤如下：一种机械臂鲁棒滑模自适应控制方法，包括以下步骤：步骤1、建立机械臂系统的动力学模型，根据欧拉—拉格朗日方法，一个n自由度的机械臂系统动力学模型如下：公式(1)中q∈Rn，分别为机械臂关节的速度、角速度和角加速度；H(q)∈Rn×n为机械臂系统的惯性矩阵；G(q)∈Rn，τ∈Rn分别表示向心科里奥利力、重力以及输入力矩：Fv为粘性摩擦系数，d∈Rn为外部干扰向量，包括系统的时变干扰和常值干扰，所述机械臂系统具有以下性质：性质1：H(q)是一个正定对称矩阵，满足：其中，m1和m2∈R是已知的有界正实数；性质2：机械臂惯性矩阵的微分矩阵和科里奥利矩阵的满足以下斜对称矩阵关系：性质3：机械臂动态模型相对于一组物理参数是线性的：其中，是机械臂关节回归矩阵，α＝[κ,ρ,ε,μ]T是机械臂模型中的固有参数；所述机械臂系统还满足以下条件和引理：条件1：机械臂系统期望位置指令qd，它的一阶微分和二阶微分均是连续有界信号；条件2：机械臂不确定项干扰d有界，即||d||≤d0(5)其中，d0是一个已知有界正常数；引理1.考虑一阶系统如下控制律在上述系统中达到有限时间稳定：θ＝-θ-λθ-μθq/p(7)其中，θ为系统状态变量，λ和μ为正常数，q＞0和p＞0且q和p都为奇整数，满足q/p＜1；因此，收敛时间ts为：引理2.有0≤xtanh(x/a)≤|x|(8)引理3.或x＞,y≥0有x/x+y≤1(9)；步骤2、设计机械臂滑模自适应鲁棒控制步骤如下：步骤2.1、定义所以qd是系统期望跟踪的位置指令且该指令二阶可微，设计一个滑模面，限制跟踪误差，保证误差收敛至0，其中Λ是一个常值矩阵，并且它的特征值严格位于右复半平面，设计虚拟参考轨迹qr代替期望轨迹qd，因此，和就被替换为定义其中s＝[s1,s2,…sn]T，为了避免滑模控制的抖动，设计控制律：其中λ1和μ1是正常数，q1＞0和p1＞0且同为整数奇数，并且满足q1/p1＜1，根据公式(1)、(14)和(15)得到：根据式(16)可得：步骤2.2、设计控制律，结合公式(17)和性质1，基于机械臂系统动力学模型的控制律设计为：τ＝τa+τs(18)τs＝τs1+τs2(20)τs1＝-KDs(21)其中，τa为模型前馈补偿项；τs1为线性反馈项，保证系统的稳定性；τs2为连续鲁棒项，用来克服系统中的外部有界干扰，具体设计形式在后续设计中给出；KD是一个对称正定矩阵，为对角矩阵；和是H(q),G(q)和Fv的估计值；步骤2.3、设计参数回归器及参数估计器，采用参数回归器的参数自适应律为：其中Γ为对角自适应律矩阵且Γ＞0，γ为正常数，Γ和γ影响参数的自适应率；步骤2.4、根据条件2设计连续鲁棒项，克服系统干扰τs2＝[τs21,τs22,…τs2n]T(24)其中τs2i形式如下式(25)中，ki为已知正常数，ξ(t)满足以下条件|ξi(t)|≤δi*其中和δi都是正常数；步骤3、分析机械臂系统的稳定性，根据步骤2中设计的滑模自适应鲁棒控制方法，利用李雅普诺夫稳定性理论对系统进行稳定性证明，得到系统渐进稳定的结果，定义李雅普诺夫函数如下：其中并且Fv＞0，对(27)式求导，得到将公式(16)、(18)-(21)带入(28)根据机械臂性质2、3得到将自适应律(22)、(23)带入式(29)得将式(24)、(25)带入(30)根据引理2可得根据引理3可得其中，W是一个正函数，同时对公式(33)两侧积分，得到根据式(34)可得V(t)∈L∞，W∈L2，所以s，和都是有界，根据条件1，可知系统状态q有界，根据式(26)，系统输出τ有界，所以，系统的闭环信号均有界，并且可以得到W有界，因此W一致连续，根据Barbalat引理可知系统渐进稳定，根据引理1可得si∈s分别在有限时刻ti收敛至0，ti时刻如下证明：设计李雅普诺夫函数对(36)求导得到将公式(15)带入(37)得其中λ1和μ1为正常数，q1＞0，q1＞0且同为奇整数，所以在有限时刻ti时，si收敛至0。本专利技术的有益效果是：本专利技术以机械臂系统作为研究对象，建立了机械臂系统的动力学模型，以其关节位置输出能准确跟踪期望位置指令为控制目标，同时考虑了系统的参数等结构不确定性以及外干扰等非结构不确定性，并且针对参数的结构不确定性设计参数估计器，针对外部烦扰不确定性设计连续的鲁棒控制项，同时结合有限时间控制，保证机械臂系统的位置输出能准确地跟踪期望的位置指令；本专利技术所设计的机械臂系统鲁棒滑模自适应控制方法的控制输出光滑连续，更利于在工程实际中应用。仿真结果验证了其有效性。除了上面所描述的目的、特征和优点之外，本专利技术还有其它的目的、特征和优点。下面将参照附图，对本专利技术作进一步详细的说明。附图说明图1是本专利技术仿真二自由度机械臂结构图。图2是机械臂系统鲁棒滑模自适应控制原理示意及流程图。图3是本专利技术所设计的控制器作用下系统参数自适应图。图4是本专利技术所设计的控制器机械臂关节跟踪曲线图。图5是本专利技术所设计的控制器机械臂关节跟踪误差图。图6是PID控制器机械臂关节跟踪误差图。图7是本专利技术所设计的控制器关节控制输出图。具体实施方式下面结合说明书附图，对本专利技术作进一步的说明。本实施例具体结合二自由度机械臂(如图1)实施，机械臂连杆1、2的长度分别为l1和l2，质量分别为m1和m2，且质心位于连杆二分之一处，q1和q2为机械臂关节空间关节角度。结合图1至图2说明本实施方式，本实施方式所述一种机械臂系统的鲁棒滑模自适应控制方法的具体步骤如下：步骤1、建立机械臂系统的动力学模型，根据欧拉—拉格朗日方法，机械臂系统的动力学模型如下：公式(1)中q∈Rn，分别为机械臂关节的速度、角速度和角加速度；H(q)∈Rn×n为机械臂系统的惯性矩阵；G(q)∈Rn，τ∈Rn表示向心科里奥利力、重力以及输入力矩：Fv本文档来自技高网...

【技术保护点】
1.一种机械臂鲁棒滑模自适应控制方法，其特征在于包括以下步骤：步骤1、建立机械臂系统的动力学模型，根据欧拉—拉格朗日方法，一个n自由度的机械臂系统动力学模型如下：

【技术特征摘要】
1.一种机械臂鲁棒滑模自适应控制方法，其特征在于包括以下步骤：步骤1、建立机械臂系统的动力学模型，根据欧拉—拉格朗日方法，一个n自由度的机械臂系统动力学模型如下：公式(1)中q∈Rn，分别为机械臂关节的速度、角速度和角加速度；H(q)∈Rn×n为机械臂系统的惯性矩阵；G(q)∈Rn，τ∈Rn分别表示向心科里奥利力、重力以及输入力矩：Fv为粘性摩擦系数，d∈Rn为外部干扰向量，包括系统的时变干扰和常值干扰，所述机械臂系统具有以下性质：性质1：H(q)是一个正定对称矩阵，满足：其中，m1和m2∈R是已知的有界正实数；性质2：机械臂惯性矩阵的微分矩阵和科里奥利矩阵的满足以下斜对称矩阵关系：性质3：机械臂动态模型相对于一组物理参数是线性的：其中，是机械臂关节回归矩阵，α＝[κ,ρ,ε,μ]T是机械臂模型中的固有参数；所述机械臂系统还满足以下条件和引理：条件1：机械臂系统期望位置指令qd，它的一阶微分和二阶微分均是连续有界信号；条件2：机械臂不确定项干扰d有界，即||d||≤d0(5)其中，d0是一个已知有界正常数；引理1.考虑一阶系统如下控制律在上述系统中达到有限时间稳定：θ＝-θ-λθ-μθq/p(7)其中，θ为系统状态变量，λ和μ为正常数，q＞0和p＞0且q和p都为奇整数，满足q/p＜1；因此，收敛时间ts为：引理2.有0≤xtanh(x/a)≤|x|(8)引理3.或x＞,y≥0有x/x+y≤1(9)；步骤2、设计机械臂滑模自适应鲁棒控制步骤如下：步骤2.1、定义所以qd是系统期望跟踪的位置指令且该指令二阶可微，设计一个滑模面，限制跟踪误差，保证误差收敛至0，其中Λ是一个常值矩阵，并且它的特征值严格位于右复半平面，设计虚拟参考轨迹qr代替期望轨迹qd，因此，和就被替换为定义其中s＝[s1,s2,…sn]T，为了避免滑模控制的抖动，设计控制律：其中λ1和μ1是正常数，q1＞0和p1＞0且同为...

【专利技术属性】
技术研发人员：胡健，李向辉，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32