[发明专利]一种基于干扰观测器的指令滤波反步控制方法

摘要

一种基于干扰观测器的指令滤波反步控制方法，针对多源干扰非线性系统，设计一种抗干扰非线性控制器。本发明包括以下步骤：首先，建立多源干扰系统的非线性数学模型；其次，设计非线性干扰观测器估计系统中的等价干扰；再次，将由非线性干扰观测器得到的等价干扰估计值代入指令滤波反步控制器中，构造抗干扰指令滤波反步控制器；最后，通过极点配置方法设计保证闭环复合误差系统渐近稳定的指令滤波反步控制器增益和非线性干扰观测器增益。本发明所述的控制方法抗干扰能力强，可用于飞行器、机械臂、生化过程和船舶等系统的抗干扰控制。

主权项

1.一种基于干扰观测器的指令滤波反步控制方法，其特征在于包括以下步骤：步骤1：建立多源干扰系统的非线性数学模型根据指令滤波反步法递归设计和干扰观测器整体设计两种不同的设计需求，将多源干扰系统的非线性数学模型表示为两种不同的数学描述形式；第一种是子系统描述形式，如下式所示：Ξ1:x.1=f1(x)+g1(x)x2+d1...x.n-1=fn-1(x)+gn-1(x)xn+dn-1x.n=fn(x)+gn(x)u+dn]]>上述微分方程组Ξ₁中每一项状态方程各自表示一个子系统，其中，x_i为系统状态变量，i＝1，...，n，x＝(x₁，...，x_n)^T代表系统状态向量，f_i(x)和g_i(x)是系统状态向量x的连续函数，u代表系统控制输入信号，d₁，...，d_n代表每个子系统中参数不确定、未建模动态和外部干扰三类干扰的等价干扰；第二种是状态空间描述形式，如下式所示：Ξ2:x.=H(x)+Z(x)u+d]]>其中，H(x)∈Rⁿ和Z(x)∈Rⁿ是系统状态向量x的连续非线性函数向量，Rⁿ表示n维实数集，d代表系统的等价干扰向量，d＝(d₁，...，d_n)^T；步骤2：设计非线性干扰观测器估计系统中的等价干扰针对步骤1中建立的状态空间描述形式Ξ₂中存在的等价干扰向量d，构造非线性干扰观测器为：w.=-L(x)w-L(x)(p(x)+H(x)+Z(x)u)]]>d^=w+p(x)]]>是等价干扰向量d的估计值，分别是子系统中的等价干扰d₁，...，d_n的估计值，w∈Rⁿ是非线性干扰观测器的状态，p(x)∈Rⁿ是待设计的非线性函数向量，L(x)是非线性干扰观测器的增益矩阵，二者满足如下关系：L(x)=-∂p(x)∂x=diag{l1,...,ln}]]>l_i，i＝1，...，n是非线性干扰观测器的增益，diag{}表示对角块，在干扰有界以及干扰变化率是慢时变的条件下，即时，干扰观测器的估计误差方程可以表示为：e.=L(x)e]]>其中，估计误差向量e＝(e₁，...，e_n)^T，估计误差i＝1，...，n；步骤3：将由非线性干扰观测器得到的等价干扰估计值代入指令滤波反步控制器中，构造抗干扰指令滤波反步控制器针对步骤1中建立的子系统描述形式Ξ₁，为使子系统的状态变量x_i在等价干扰d_i存在的情况下能够渐进跟踪参考信号x_i，c，即跟踪误差z_i＝x_i-x_i，c渐进稳定，构造子系统的虚拟控制量为：ai=1gi(x)(-cizi-fi(x)+x.i,c-gi-1(x)vi-1-d^i)]]>c_i为虚拟控制量的增益，等价干扰d_i的估计值作为补偿项代入了虚拟控制量a_i中，v_i为补偿跟踪误差，x_i，c和为前一级子系统的虚拟控制量a_i-1经过指令滤波器Ξ₃产生的输出，指令滤波器的状态空间和输出分别可以表示为：Ξ3:q.i,1=qi,2q.i,2=2ζωi(Si,v(ωi22ζωi(Si,M(ai-1)-qi,1))-qi,2),xi,1=qi,1x.i=qi,2]]>其中，q_i，1和q_i，2是指令滤波器的状态变量，ω_i和ζ分别是指令滤波器的固有频率和阻尼比，ζ＝0.707，S_i，M()和S_i，V()分别代表幅值和速率限制函数；经过逐步递推形成的虚拟控制量{a₁，...，a_n}的集合即组成抗干扰指令滤波反步控制器，系统的控制输入信号u＝a_n，特别的，x_i，c和为给定的参考输入指令，g₀(x)＝0、v₀＝0、ξ_n＝0；补偿跟踪误差v_i＝z_i-ξ_i，通过引入补偿量ξ_i消除指令信号饱和对于跟踪误差的影响，ξ_i的传递函数为s表示复变量，对补偿跟踪误差求导，得到的补偿跟踪误差方程的向量形式为：v.=C(x)v+Ee]]>其中，C(x)=-c1g1(x)-g1(x)............gn-1(x)-gn-1(x)-cnn×n,]]>矩阵中其他位置均为0元素，补偿跟踪误差向量v＝(v₁，...，v_n)^T，估计误差向量e＝(e₁，...，e_n)^T，E_n×n为n×n维单位阵；步骤4：通过极点配置方法设计保证闭环复合误差系统渐近稳定的指令滤波反步控制器增益c_i和非线性干扰观测器增益l_i将步骤3中指令滤波反步控制器的补偿跟踪误差方程和步骤2中非线性干扰观测器的估计误差方程联立得到闭环复合误差系统为：v.e.=C(x)E0L(x)ve,]]>A(x)=C(x)E0L(x)2n×2n]]>其中，A(x)为闭环复合误差系统的系统矩阵，用极点配置的方法通过将系统矩阵A(x)的特征根配置到复平面左半开平面[-10，-100]之间的区域，得到指令滤波反步控制器增益c_i和非线性干扰观测器增益l_i，此时系统矩阵A(x)对任意状态变量x∈Rⁿ，所有特征根都具有负实部，则可以保证闭环复合误差系统是渐进稳定的，即保证干扰估计误差e和补偿跟踪误差v渐进趋近于零，实现干扰渐进估计和状态渐进跟踪，达到系统的控制目标。