[发明专利]基于龙伯格状态观测器的柔性机械臂系统饱和补偿控制方法

摘要

一种基于龙伯格状态观测器的柔性机械臂系统饱和补偿控制方法，包括建立柔性机械臂伺服系统的动态模型，初始化系统状态、采样时间以及控制参数；采用龙伯格状态观测器，获得渐近收敛于系统真实状态的观测值；根据微分中值定理，将系统中的非线性饱和输入线性化处理，推导出带有未知饱和的柔性机械臂系统模型；进行通过动态面技术，在每一步设计中引入虚拟控制量，并依次通过一阶低通滤波器，避免传统反演控制法所带来的复杂度爆炸问题；同时，利用神经网络的自学习能力，能有效逼近非线性系统中复杂的非线性项。本发明提供一种能够有效改善柔性机械臂伺服系统控制性能的基于龙伯格状态观测器的神经网络自适应控制方法，实现系统的精确快速跟踪。

主权项

一种基于龙伯格状态观测器的柔性机械臂系统饱和补偿控制方法，其特征在于：所述方法包括以下步骤：步骤1：建立柔性机械臂伺服系统动态模型，初始化系统状态、采样时间以及控制参数，过程如下：1.1柔性机械臂伺服系统动态模型的运动方程表达式为Iq··+K(q-θ)+MgLsin(q)=0Jθ··-K(q-θ)=u(v)---(1)]]>其中，q与θ分别为机械臂连杆和电机的转动角度；g为重力加速度；I为连杆的惯量；J为电机的惯量；K为弹簧的刚度系数；M与L分别为连杆的质量与长度；v为控制信号；u(v)为饱和环节，表示式为u(v)=sat(v)=sign(v)uM|v|≥uMv|v|≥uM---(2)]]>其中，sign(v)为未知非线性函数；uM为未知饱和输入上界，且uM＞0；1.2定义：x1＝q，x3＝θ，式(1)改写为x·1=x2+f1(x‾1,x2)x·2=x3+f2(x‾2,x3)x·3=x4+f3(x‾3,x4)x·4=1Ju(v)+f4(x)y=x1---(3)]]>其中，x＝[x1，x2，x3，x4]Tf1(x‾1,x2)=0,f2(x‾2,x3)=-MgLIsinx1-KI(x1-x3+IKx3),]]>f3(x‾3,x4)=0,f4(x)=KJ(x1-x3),]]>y为系统位置输出轨迹；步骤2：根据微分中值定理，将系统中的非线性输入饱和进行线性化处理，推导出带有未知饱和的机械臂伺服系统模型，过程如下：2.1对饱和模型进行光滑处理g(v)=uM*tanh(vuM)=ev/uM-e-v/uMev/uM+e-v/uM---(4)]]>则sat(v)＝g(v)+d(v)  (5)其中，d(v)表示光滑函数与饱和模型之间存在的误差；2.2根据微分中值定理，存在μ∈(0，1)使g(v)=g(v0)+gvμ(v-v0)---(6)]]>其中，vμ＝μv+(1‑μ)v0，v0∈(0，v)；选择v0＝0，式(6)被改写为g(v)=gvμv---(7)]]>2.3由式(5)和式(7)，将式(3)改写为以下等效形式x·1=x2+f1(x‾1,x2)x·2=x3+f2(x‾2,x3)x·3=x4+f3(x‾3,x4)x·4=1J[gvμv+d(v)]+f4(x)y=x1---(8)]]>步骤3：设计柔性机械臂伺服系统的龙伯格观测器模型，并定义相关变量，过程如下：3.1龙伯格观测器表达式为x^·1=x^2+l1(x1-x^1)+f^1(x‾^1,x^2)x^·2=x^3+l2(x1-x^1)+f^2(x‾^2,x^3)x^·3=x^4+l3(x1-x^1)+f^3(x‾^3,x^4)x^·4=1Ju(v)+l4(x1-x^1)+f^4(x^)y^=x^1---(9)]]>其中，分别为观测器状态空间模型状态；l1，l2，l3，l4分别为观测器增益参数；为观测器输出；3.2定义状态观测器观测误差及误差矩阵E＝(e1，e2，e3，e4)T  (11)步骤4：计算控制系统位置跟踪误差，选择神经网络逼近复杂非线性项，设计虚拟控制量，并通过一阶低通滤波器输出，更新神经网络权值与误差估计权值过程如下：4.1定义系统的跟踪误差为s1＝y1‑yr  (12)其中，yr为二阶可导期望轨迹；4.2设计虚拟控制量α1α1=-(c1+12)s1+y·r---(13)]]>其中,c1为常数，且c1＞0；4.3定义一个新的变量z2，让虚拟控制量α1通过时间常数为τ2的一阶低通滤波器τ2z·2+z2=α1z2(0)=α1(0)---(14)]]>4.4定义滤波误差χ2＝z2‑α1，则z·2=α1-z2τ2=-χ2τ2---(15)]]>4.5定义误差变量s2=x^2-z2---(16)]]>4.6为了逼近复杂的非线性不确定项定义以下神经网络其中，为理想权重；为神经网络误差值理想值，εN2为神经网络误差值上界，满足的表达式为其中，exp( )为指数函数，cj＝[cj1，cj2]为隐含层第j个神经元的中心向量；bj为神经元节点的基宽参数；4.7设计虚拟控制量α2其中,c2，δ为常数，且c1＞0，δ＞0；4.8定义一个新的变量z3，让虚拟控制量α2通过时间常数为τ3的一阶低通滤波器τ3z·3+z3=α2z3(0)=α2(0)---(20)]]>4.9定义滤波误差χ3＝z3‑α2，则z·3=α2-z3τ3=-χ3τ3---(21)]]>4.10设计神经网络权重估计值和自适应参数的调节规律为其中，r2，σ2，η2，δ2为常数，且r2＞0，σ2＞0,η2＞0,δ2＞0；4.11定义误差变量s3=x^3-z3---(23)]]>4.12设计虚拟控制量α3α3=-l2e1+z·3-c3s3---(24)]]>其中,c3为常数，且c3＞0；4.13定义一个新的变量z4，让虚拟控制量α3通过时间常数为τ4的一阶低通滤波器τ4z·4+z4=α3z4(0)=α3(0)---(25)]]>4.14定义滤波误差χ4＝z4‑α3，则z·4=α3-z4τ4=-χ4τ4---(26)]]>步骤5:设计控制器输入，过程如下：5.1定义误差变量s4=x^4-z4---(27)]]>5.2为了逼近不能直接得到的复杂非线性不确定项定义以下神经网络其中，为理想权重；为神经网络误差理想值，εN4为神经网络误差上界，满足的表达式为5.3设计控制器输入为v其中，∈、c4与a4为常数，且∈，a4，c4＞0；5.4神经网络权重估计值的调节规律为其中，r4与σ4为常数，且r4，σ4＞0；步骤6：设计李雅普诺夫函数V=ETPE+Σi=1412si2+Σi=2412χi2+12γ2θ~2Tθ~2+12γ4θ~4Tθ~4+12η2ϵ~N22---(32)]]>对式(32)进行求导得：V·=E·TPE+ETPE·+Σi=14sis·i+Σi=24χ2χ·2-1γ2θ~2Tθ^·2-1γ4θ~4Tθ^·4-1η2ϵ~N2ϵ·N2ϵ^·N2---(33)]]>如果则判定系统是稳定的。