CN103336430A - 微陀螺仪的自适应模糊h无穷控制方法 - Google Patents

微陀螺仪的自适应模糊h无穷控制方法 Download PDF

Info

Publication number
CN103336430A
CN103336430A CN2013102541464A CN201310254146A CN103336430A CN 103336430 A CN103336430 A CN 103336430A CN 2013102541464 A CN2013102541464 A CN 2013102541464A CN 201310254146 A CN201310254146 A CN 201310254146A CN 103336430 A CN103336430 A CN 103336430A
Authority
CN
China
Prior art keywords
centerdot
gyroscope
omega
fuzzy
parameter
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN2013102541464A
Other languages
English (en)
Inventor
隽婉茹
费峻涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Changzhou Campus of Hohai University
Original Assignee
Changzhou Campus of Hohai University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Changzhou Campus of Hohai University filed Critical Changzhou Campus of Hohai University
Priority to CN2013102541464A priority Critical patent/CN103336430A/zh
Publication of CN103336430A publication Critical patent/CN103336430A/zh
Pending legal-status Critical Current

Links

Images

Landscapes

  • Gyroscopes (AREA)

Abstract

本发明公开了一种微陀螺仪的自适应模糊H无穷控制方法,采用基于线性矩阵不等式方法设计控制器,控制器包含两个部分:一个是应用模糊逻辑系统构造的基本模糊控制器,它用来逼近微陀螺仪的理想控制器;一个是鲁棒控制项,用来克服外界干扰对微陀螺仪系统的输出跟踪误差的影响,保证微陀螺仪系统闭环稳定。本发明采用基于Lyapunov的方法自适应调整模糊系统中的参数,从而保证模糊控制系统的稳定性。本发明设计的控制器用于逼近非线性方程,来补偿系统中的非线性现象,达到精确控制的目的,提高了系统的稳定性和可靠性,极具产业上的利用价值。

Description

微陀螺仪的自适应模糊H无穷控制方法
技术领域
本发明涉及微陀螺仪的控制系统,具体为一种微陀螺仪的自适应模糊H无穷控制方法。
背景技术
微陀螺仪是很多应用领域中最常用的测量角速度的传感器,比如导航、制导和控制稳定性。微陀螺仪是利用科里奥利力(即:地球自转偏向力)将一个轴上的能量转移到另一个轴上的装置,传统的操作模式缺少驱动陀螺仪从一个模式到一个已知的摆动运动,而检测到的科里奥利加速度耦合到振动的感知模式,振动是和驱动模式是垂直的,振动感知模式的响应提供关于实用角速度的信息。由于生产制造过程中的误差存在和环境温度的影响,造成原件特性与设计之间的差异,导致存在耦合的刚度系数和阻尼系数,降低了微陀螺仪的灵敏度和精度。此外,陀螺仪本身属于多输入多输出系统,存在参数的不确定性和外界干扰对系统参数的造成的波动,补偿制造误差和测量角速度成为微陀螺仪控制的主要问题。而传统控制方法集中在对驱动轴振荡幅值和频率稳定以及两轴频率匹配的控制上,存在未考虑参数变动,环境变化影响恶劣,不能解决零角速率输出等问题。因此,先进的控制技术被要求应用于微微陀螺仪的控制中
模糊控制系统不需要被控对象的数学模型,它以人对被控对象的控制经验为依据而设计控制器,因此适用于结构确定,参数未知或不确定的系统。模糊控制的突出优点是能够比较容易地将人的控制经验融入控制器中,但若是缺乏这样的控制经验,很难设计出高水平的模糊控制器。而且,由于模糊控制器采用了IF-THEN控制规则,不便于控制参数的学习和调整,且难以保证控制系统的稳定性。
自适应模糊控制是指具有自适应学习算法的模糊逻辑系统,其学习算法是依靠数据信息来调整模糊逻辑系统的参数,且可以保证控制系统的稳定性。与传统的自适应控制系统相比,自适应模糊控制的优越性在于它可以利用操作人员提供的语言性模糊信息,而传统的自适应控制则不能。这一点对具有高度不确定因素的微陀螺仪系统尤其重要。
在线性矩阵不等式(LMI)在控制系统中得到广泛的重视之前,绝大多数的控制问题是通过Riccati方程或其不等式求解来解决的。但是Riccati方程或不等式求解过程中有大量的参数和正定对称矩阵需要预先调整。并且Riccati方程的解是满足某一方面性能指标最优的唯一解。这给实际应用问题的解决带来了极大的不便。但是LMI方法是通过求解凸优化问题,不需要预先调整任何参数和正定对称矩阵,给问题求解带来了方便。同时求解LMI得到了一个解集,这一特性在求解系统的多目标控制问题中非常有用。
目前,自适应模糊H无穷控制在微陀螺仪的控制系统中尚未得到应用。
发明内容
本发明为克服现有的微陀螺仪的控制系统存在的缺陷,而提供一种微陀螺仪的自适应模糊H无穷控制方法,能够自适应调整模糊控制系统的参数,保证了闭环系统具有全局稳定性,并取得给定的跟踪误差性能指标。
本发明解决其技术问题是采用以下技术方案来实现的。
微陀螺仪的自适应模糊H无穷控制方法,包括以下步骤:
1)建立微陀螺仪的非量纲化动力学方程;
2)定义参考模型为其中qm为参考轨迹,km为参考模型系统矩阵;
3)建立控制任务,具体为,设计自适应模糊控制器和调整参数向量θ的自适应律,使得闭环系统具有全局稳定性,并取得控制误差性能指标;
所述设计自适应模糊控制器,具体为:若参数D,Ω,kb已知,则控制器设计为
φ * = ( D + 2 Ω ) q · + k b q + q · · m + k T e - - - ( 6 )
此为理想控制器,其中,e为跟踪误差,e=qm-q,k=(k2,k1)T,k2,k1为系统参数,qm为参考轨迹,q为运动轨迹;
若参数D,Ω,kb未知,则设计基于线性矩阵不等式的自适应模糊控制器,
其中,参数D,Ω,kb为微陀螺仪的非量纲化动力学方程中的参数;
4)采用基于Lyapunov的方法验证闭环控制系统的稳定性,完成控制任务。
前述的步骤1),建立微陀螺仪的非量纲化动力学方程,具体为
1-1)考虑到制造误差,实际微陀螺仪的集总参数数学模型为:
m x · · + d xx x · + d xy y · + k xx x + k xy y = u x + 2 m Ω z y · (1)
m y · · + d xy x · + d yy y · + k xy x + k yy y = u y - 2 m Ω z x ·
其中,m是质量块的质量,x,y是质量块在旋转系中的坐标,dxx,dyy分别是x轴和y轴的阻尼系数,kxx,kyy分别是x轴和y轴的弹簧系数,dxy,kxy分别是耦合的阻尼系数和耦合的弹簧系数,合称为正交误差,ux,uy是两轴的控制输入,Ωz为微陀螺仪的角速度,
Figure BDA000033944155000318
Figure BDA000033944155000319
是科里奥利力;
1-2)取非量纲时间t*=w0t,将所述方程(1)的两边同除以质量块质量m、参考长度q0以及两轴的共振频率w0的平方
Figure BDA000033944155000320
得到微陀螺仪的非量纲化动力学方程
q · · * + D * q · * + k b q * = u * - 2 Ω * q · * - - - ( 3 - 1 )
其中,q*为微陀螺仪轨迹,
q * = q q 0 , D * = D mw 0 , Ω * = Ω w 0 , u x * = u x mw 0 2 q 0 , u y * = u y mw 0 2 q 0
q = x y , Ω = 0 - Ω z Ω z 0 , D = d xx d xy d xy d yy , k b = w x 2 w xy w xy w y 2 , u * = u x * u y * ,
w x 2 = k xx mw 0 2 , w y 2 = k yy mw 0 2 , w xy = k xy mw 0 2
1-3)忽略符号表示的不同,重新用q代替q*,用D代替D*,用u代替u*,用Ω代替Ω*,则式(3-1)转化为
q · · + D q · + k b q = u - 2 Ω q · - - - ( 3 )
以此作为微陀螺仪的非量纲化动力学方程。
前述的步骤3)中,基于线性矩阵不等式设计自适应模糊控制器包括两部分:第一部分为模糊控制器uc(q|θ),用于逼近理想控制器φ*;另一部分为H鲁棒控制项v2,用以克服外界干扰对系统输出跟踪误差的影响,保证系统闭环稳定;
所述模糊控制器的输出uc(q|θ)为, u c ( q | θ ) = Σ i = 1 N θ i ξ i ( q ) = θ T ξ ( q ) ,
其中基本模糊控制器uc(x|θ)为,
Figure BDA00003394415500042
ξ(x)为模糊基函数,N为模糊控制规则条数,θ为调整参数向量;
所述H鲁棒控制项v2为,v2=Ke,其中,矩阵K和矩阵P是下列线性矩阵不等式的解:
A T P + PA - PBK - K T B T P + 1 &rho; 2 PB B T P + 2 Q < 0 - - - ( 28 )
其中,P=PT>0,A为系统参数矩阵, A = 0 1 - k 2 - k 1 , B = 0 1 , Q为一个正定矩阵,ρ是抑制水平,为给定参数,
则基于线性矩阵不等式设计的自适应模糊控制器的输出φ2为,φ2=uc(q|θ)+v2
前述的步骤3)中,调整参数向量θ的自适应律
Figure BDA00003394415500047
为,
Figure BDA000033944155000410
其中,η为学习律。
前述的步骤3)中,控制性能指标为
&Integral; 0 T e T Qedt &le; e T ( 0 ) Pe ( 0 ) + 1 &eta; &theta; ~ T ( 0 ) &theta; ~ ( 0 ) + &rho; 2 &Integral; 0 T &omega; T &omega;dt - - - ( 5 )
式中,e为跟踪误差,T∈[0,∞)为系统时间,ω是模糊逼近误差,ω∈L2[0,T],Q和P是两个正定矩阵,
Figure BDA00003394415500049
是参数的估计误差,θ*为参数向量的最优参数,η为学习律,ρ为抑制水平。
前述的步骤4)中Lyapunov函数V取为:
V = 1 2 e T Pe + 1 2 &eta; &theta; ~ T &theta; ~ .
借由上述技术方案,本发明具有以下优点:
1.采用自适应模糊H无穷控制器对陀螺仪系统进行控制,是利用模糊控制器的优点和自适应控制优点以及H无穷控制的结合进行设计的,该控制器可以直接利用模糊控制规则,自适应调整模糊控制器的参数,减少跟踪误差和外界干扰对系统误差的影响,并且对外界干扰具有很强的鲁棒性。
2.与传统的H无穷控制器相比,自适应模糊H无穷控制器可以自适应调整模糊控制系统的参数,保证了闭环系统具有全局稳定性,并取得给定的跟踪误差性能指标。
3.采用基于Lyapunov的方法进行稳定性分析,从而保证陀螺仪系统的稳定性和精确性,这种模糊控制器可以广泛应用于微陀螺仪控制,以提高系统的稳定性和可靠性,其极具产业上的利用价值。
附图说明
图1为传统的基于Riccati方程的自适应模糊H无穷控制方法的总体框图;
图2为本发明基于线性矩阵不等式的自适应模糊H无穷控制方法的总体框图;
图3为基于Riccati法的控制系统的跟踪曲线图;
图4为基于Riccati法的控制系统的跟踪误差曲线图;
图5为基于Riccati法的控制系统加入一倍扰动后的跟踪曲线图;
图6为基于Riccati法的控制系统加入一倍扰动后的跟踪误差曲线图;
图7为基于线性矩阵不等式法的控制系统的跟踪曲线图;
图8为基于线性矩阵不等式法的控制系统的跟踪误差曲线图;
图9为基于线性矩阵不等式法的控制系统加入10倍扰动后的跟踪曲线图;
图10为基于线性矩阵不等式法的控制系统加入10倍扰动后的跟踪误差曲线图;
具体实施方式
下面对结合附图和具体实施方式对本发明作进一步描述。
微陀螺仪的自适应模糊H无穷控制方法,包括以下步骤:
1.建立微陀螺仪的非量纲化动力学方程
微振动陀螺仪一般包含三个组成部分:被弹性材料所支撑的质量块,静电驱动装置和感测装置,静电驱动电路主要功能是驱动和维持微振动陀螺仪振动时幅值的恒定;感测电路用来感知质量块的位置和速度。微陀螺仪可以被简化为一个由质量块和弹簧构成的有阻尼振动系统,对微微陀螺仪而言,可以认为质量块被限制只能在x-y平面内运动,而不能沿Z轴运动。实际上,由于制造缺陷和加工误差的存在,会造成x轴和y轴的附加动态耦合,如耦合的刚度系数和阻尼系数。考虑到制造误差,实际微陀螺仪的集总参数数学模型为:
m x &CenterDot; &CenterDot; + d xx x &CenterDot; + d xy y &CenterDot; + k xx x + k xy y = u x + 2 m &Omega; z y &CenterDot; (1)
m y &CenterDot; &CenterDot; + d xy x &CenterDot; + d yy y &CenterDot; + k xy x + k yy y = u y - 2 m &Omega; z x &CenterDot;
m是质量块的质量,x,y是质量块在旋转系中的坐标,dxx,dyy分别是x轴和y轴的阻尼系数,kxx,kyy分别是x轴和y轴的弹簧系数,dxy,kxy分别是耦合的阻尼系数和耦合的弹簧系数,合称为正交误差,ux,uy是两轴的控制输入,Ωz为微陀螺仪的角速度,
Figure BDA000033944155000618
Figure BDA000033944155000619
是科里奥利力。
模型的非量纲化在设计分析时很有价值,在存在大的时间量级区别时,非量纲化也能使数值仿真容易实现。因此设非量纲时间t*=w0t,将式(1)的两边同除以参考质量m、参考长度q0,以及两轴的共振频率的平方
Figure BDA000033944155000620
微陀螺仪模型可改写为:
q &CenterDot; &CenterDot; q 0 + D mw 0 q &CenterDot; q 0 + K a mw 0 2 q q 0 = u mw 0 2 q 0 - 2 &Omega; w 0 q &CenterDot; q 0 - - - ( 2 )
其中, q = x y , u = u x u y , &Omega; = 0 - &Omega; z &Omega; z 0 , D = d xx d xy d xy d yy , K a = k xx k xy k xy k yy
定义新的参数如下:
q * = q q 0 , D * = D mw 0 , &Omega; * = &Omega; w 0 , u x * = u x mw 0 2 q 0 , u y * = u y mw 0 2 q 0
w x 2 = k xx mw 0 2 , w y 2 = k yy mw 0 2 , w xy = k xy mw 0 2
则微陀螺仪的非量纲化动力学方程可写为
q &CenterDot; &CenterDot; * + D * q &CenterDot; * + K b q * = u * - 2 &Omega; * q &CenterDot; * - - - ( 3 - 1 )
q*为微陀螺仪的运动轨迹轨迹
忽略符号表示的不同,重新用q代替q*,用D代替D*,用u代替u*,用Ω代替Ω*,则式(3-1)式转化为
q &CenterDot; &CenterDot; + D q &CenterDot; + k b q = u - 2 &Omega; q &CenterDot; - - - ( 3 )
以此作为微陀螺仪的非量纲化动力学方程。
2.定义参考模型为
q &CenterDot; &CenterDot; m = - k m q m - - - ( 4 )
其中,qm为参考轨迹,km为参考模型的系统矩阵。
3.建立控制任务,具体为,设计自适应模糊控制器和调整参数向量θ的自适应律,使得闭环系统具有全局稳定性,并取得如下的控制性能指标
&Integral; 0 T e T Qedt &le; e T ( 0 ) Pe ( 0 ) + 1 &eta; &theta; ~ T ( 0 ) &theta; ~ ( 0 ) + &rho; 2 &Integral; 0 T &omega; T &omega;dt - - - ( 5 )
式中,e为跟踪误差,e=qm-q,T∈[0,∞)为系统时间,ω∈L2[0,T]是模糊逼近误差,Q和P是两个正定矩阵,
Figure BDA00003394415500075
是参数的误差向量,θ*为参数向量的最优参数,η为学习律,ρ为抑制水平,是两个给定的参数,并且η>0,ρ>0。
其中,设计自适应模糊控制器,具体过程为
若参数D,Ω,kb已知,则控制器可设计为
&phi; * = ( D + 2 &Omega; ) q &CenterDot; + k b q + q &CenterDot; &CenterDot; m k T e - - - ( 6 )
此为理想控制器,可使得
Figure BDA00003394415500076
其中跟踪误差e满足,
Figure BDA00003394415500077
如果选择合适的系统参数k=(k2,k1)T值,即可使得多项式h(s)=s2+k1s+k2的根在左半开平面,则得
Figure BDA00003394415500078
即控制任务完成。
若参数D,Ω,kb未知,控制器式(6)无法应用,因此需要应用模糊逻辑系统构造自适应模糊H无穷控制器。有两种方式,分别为传统的基于Riccati方程方法和本发明的基于线性矩阵不等式方法设计自适应模糊控制器,下面将这两种方式进行详细说明并对比分析。
(一)基于Riccati方程设计自适应模糊控制器
如图1所示,基于Riccati方程设计的自适应模糊控制器由两部分组成:第一部分为模糊控制器uc(q|θ),用它来逼近理想控制器φ*;第二部分是一个H鲁棒控制项v1,它用于克服模糊逼近误差和外界干扰对跟踪误差的影响,并保证系统的稳定性。
模糊控制器uc(q|θ)表示为
u c ( q | &theta; ) = &Sigma; i = 1 N &theta; i &xi; i ( q ) = &theta; T &xi; ( q ) - - - ( 7 )
其中基本模糊控制器uc(x|θ)为,
Figure BDA00003394415500082
ξ(x)为模糊基函数,N为模糊控制规则条数,θ为调整参数向量;
H鲁棒控制项v1为,
v 1 = 1 &lambda; e T PB - - - ( 8 )
其中,λ>0是一个设计参数,矩阵P是满足下面Riccati方程解的一个正定矩阵。
PA + A T P + Q - 2 &lambda; PBB T P + 1 &rho; 2 PB B T P = 0 - - - ( 9 )
A为系统参数矩阵, A = 0 1 - k 2 - k 1 , B = 0 1 , Q为一个正定矩阵,ρ是抑制水平,为给定参数,
Riccati方程(9)存在解的条件是2ρ2≥λ。
则基于Riccati方程设计的自适应模糊控制器的输出φ1
φ1=uc(q|θ)+v1                 (10)
将自适应模糊控制器式(10)作为微陀螺仪的控制输入u代入非量纲化动力学方程式(3)中,可得
q &CenterDot; &CenterDot; = - ( D + 2 &Omega; ) q &CenterDot; - k b q + u c ( q | &theta; ) + v 1 - - - ( 11 )
对理想控制器式(6)式进行变形有
q &CenterDot; &CenterDot; m = &phi; * - ( D + 2 &Omega; ) q &CenterDot; - k b q - k T e - - - ( 12 )
(12)式减去(11)式可得
e &CenterDot; &CenterDot; = q &CenterDot; &CenterDot; m - q &CenterDot; &CenterDot; = - k T e + &phi; * - u c ( q | &theta; ) - v 1 - - - ( 13 )
我们将上式可改写成矩阵方程的形式,即
e &CenterDot; = Ae + B [ &phi; * - u c ( q | &theta; ) - v 1 ] - - - ( 14 )
式中
A = 0 1 - k 2 - k 1 , B = 0 1
定义参数向量θ的最优参数为θ*
&theta; * = arg min &theta; &Element; &Omega; [ sup x &Element; u c | u c ( q | &theta; ) - &phi; * ( q ) | ] - - - ( 15 )
式中Ω是适当的包含θ的有界集。
定义模糊逼近误差ω为
ω=φ*(q)-uc(q|θ*)                (16)
将式(16),式(7)带入式(14),则(14)式改写为
e &CenterDot; = Ae - B &theta; ~ T &xi; ( q ) + B&omega; - Bv 1 - - - ( 17 )
式中
Figure BDA00003394415500097
是参数的估计误差。
选取参数向量θ的自适应律
Figure BDA00003394415500098
&theta; &CenterDot; = &eta;e T PB&xi; ( q ) - - - ( 18 )
式中,η>0是参数的学习律。
将微陀螺仪的非量纲化动力学方程式(3)作为控制对象,将自适应模糊控制器式(10)作为微陀螺仪的控制输入,参数向量θ的自适应律取(18)式,则控制方案满足如下的性能:
(1)θ∈Ω,q,e,u∈L
(2)对于给定的抑制水平ρ,跟踪误差达到H控制性能指标(5)。
下面采用Lyapunov第二法来验证该控制方案是否可以保证系统闭环稳定。
取Lyapunov函数V为
V = 1 2 e T Pe + 1 2 &eta; &theta; ~ T &theta; ~ - - - ( 19 )
对Lyapunov函数V求导得
V &CenterDot; = 1 2 e &CenterDot; T Pe + 1 2 e T P e &CenterDot; + 1 2 &eta; &theta; ~ &CenterDot; T &theta; ~ + 1 2 &eta; &theta; ~ T &theta; ~ &CenterDot; - - - ( 20 )
由于根据(17)式有
V &CenterDot; = 1 2 e &CenterDot; T Pe + 1 2 e T P e &CenterDot; + 1 2 &eta; &theta; &CenterDot; T &theta; ~ + 1 2 &eta; &theta; ~ T &theta; &CenterDot;
= 1 2 [ e T A T Pe + e T APe - &xi; T &theta; ~ B T Pe - e T PB &theta; ~ T &xi; + &omega; B T Pe + e T PB&omega; - v 1 B T Pe - e T PBv 1 ]
+ 1 2 &eta; &theta; &CenterDot; T &theta; ~ + 1 2 &eta; &theta; ~ T &theta; &CenterDot;
然后,将式(8)和式(18)带入,可得
V &CenterDot; = 1 2 e T ( A T P + PA - 2 &lambda; PBB T P ) e + 1 2 &omega; B T Pe + 1 2 e T PB&omega;
- 1 2 &theta; ~ T [ e T PB&xi; ( q ) - 1 &eta; &theta; &CenterDot; ] - 1 2 [ &xi; ( q ) T B T Pe - 1 &eta; &theta; &CenterDot; T ] &theta; ~ - - - ( 21 )
又因为 e T PB&xi; ( q ) - 1 &eta; &theta; &CenterDot; = 0 , &xi; ( q ) T B T Pe - 1 &eta; &theta; &CenterDot; T = 0
所以上式可以写为
V &CenterDot; = 1 2 e T ( A T P + PA - 2 &lambda; PBB T P ) e + 1 2 &omega;B T Pe + 1 2 e T PB&omega; - - - ( 22 )
根据Riccati方程(9)得
V &CenterDot; = - 1 2 e T Qe - 1 2 &rho; 2 e T PBB T Pe + 1 2 &omega;B T Pe + 1 2 e T PB&omega;
= - 1 2 e T Qe - 1 2 ( 1 &rho; ( B T Pe - &rho;&omega; ) T ( 1 &rho; B T Pe - &rho;&omega; ) + 1 2 &rho; 2 &omega; 2
&le; - 1 2 e T Qe + 1 2 &rho; 2 &omega; 2 - - - ( 23 )
对(23)式从0到T积分得
V ( 0 ) - V ( T ) &le; - 1 2 &Integral; 0 T e T Qedt + 1 2 &rho; 2 &Integral; 0 T &omega; 2 dt - - - ( 24 )
由于V(T)≥0,所以(24)式化为
1 2 &Integral; 0 T e T Qedt &le; V ( 0 ) + 1 2 &rho; 2 &Integral; 0 T &omega; 2 dt
= e T ( 0 ) Pe ( 0 ) + 1 &eta; &theta; ~ T ( 0 ) &theta; ~ ( 0 ) + &rho; 2 &Integral; 0 T &omega; T &omega;dt - - - ( 25 )
即跟踪误差取得H控制性能指标,控制任务完成。
(二)基于线性矩阵不等式设计自适应模糊控制器
如图2所示,基于线性矩阵不等式设计的自适应模糊控制器由两部分组成,一部分为模糊控制器uc(q|θ),用于逼近理想控制器φ*;另一部分为H鲁棒控制项v2,用于克服外界干扰对系统输出跟踪误差的影响,保证系统闭环稳定。它表示如下
φ2=uc(q|θ)+v2         (26)
其中,H鲁棒控制项v2
v2=Ke        (27)
矩阵K和矩阵P是下列线性矩阵不等式的解:
A T P + PA - PBK - K T B T P + 1 &rho; 2 PBB T P + 2 Q < 0 - - - ( 28 )
其中,P=PT>0,A为系统参数矩阵, A = 0 1 - k 2 - k 1 , B = 0 1 , Q为一个正定矩阵,ρ是抑制水平,为给定参数,
此时系统的误差方程变为
e &CenterDot; = Ae - B &theta; ~ T &xi; ( q ) + B&omega; - Bv 2 - - - ( 29 )
将微陀螺仪的非量纲化动力学方程式(3)作为控制对象,将自适应模糊控制器式(26)作为微陀螺仪的控制输入,参数向量θ的自适应律取(18)式,则控制方案满足如下的性能:
(1)对
Figure BDA00003394415500117
有θ∈Ω,q,e,u∈L
(2)对于给定的抑制水平ρ,跟踪误差达到H控制性能指标式(5)。
下面采用Lyapunov第二法来验证该控制方案是否可以保证系统闭环稳定。取Lyapunov函数V为
V = 1 2 e T Pe + 1 2 &eta; &theta; ~ T &theta; ~ - - - ( 19 )
求V对时间的导数得
V &CenterDot; = 1 2 e &CenterDot; T Pe + 1 2 e T P e &CenterDot; + 1 &eta; &theta; ~ T &theta; ~ &CenterDot; - - - ( 30 )
由于
Figure BDA000033944155001211
将式(29)和式(18)带入上述方程
V &CenterDot; = 1 2 ( e T A T - &xi; T &theta; ~ B T + &omega; T B T - e T K T B T ) Pe
+ 1 2 e T P ( Ae - B &theta; ~ T &xi; + B&omega; - BKe ) + &theta; ~ T e T PB&xi;
= 1 2 e T ( A T P + PA - K T B T P - PBK ) e + 1 2 ( &omega; T B T Pe + e T PB&omega; ) - - - ( 31 )
由矩阵性质
&omega; T B T Pe + e T PB&omega; &le; &rho; 2 &omega; T &omega; + 1 &rho; 2 e T PBB T Pe - - - ( 32 )
可得
V &CenterDot; = 1 2 e T ( A T P + PA - K T B T P - PBK + 1 &rho; 2 PBB T P + 2 Q ) e - e T Qe + 1 2 &rho; 2 &omega; T &omega; - - - ( 33 )
根据线性矩阵不等式可得
V &CenterDot; < - e T Qe + 1 2 &rho; 2 &omega; T &omega; < - 1 2 e T Qe + 1 2 &rho; 2 &omega; T &omega; - - - ( 34 )
对上式从0到T积分得
V ( T ) - V ( 0 ) &le; - 1 2 &Integral; 0 T e T Qedt + 1 2 &rho; 2 &Integral; 0 T &omega; 2 dt - - - ( 35 )
由于V(T)≥0,所以(35)式化为
1 2 &Integral; 0 T e T Qedt &le; V ( 0 ) + 1 2 &rho; 2 &Integral; 0 T &omega; 2 dt
= e T ( 0 ) Pe ( 0 ) + 1 &eta; &theta; ~ T ( 0 ) &theta; ~ ( 0 ) + &rho; 2 &Integral; 0 T &omega; T &omega;dt - - - ( 36 )
从而跟踪误差取得H控制性能指标。
补充说明:
令X=P-1,
Figure BDA000033944155001212
根据Schur补性质,线性矩阵不等式式(28)可写为
XA T + AX - B K ^ - K ^ T B T B X B T - &rho; 2 I 0 X 0 - ( 2 Q ) - 1 < 0 - - - ( 37 )
不等式(37)是关于矩阵X,K的线性矩阵不等式,可以通过Matlab中LMI工具箱求解。
最后可求出P=X-1,
Figure BDA00003394415500134
最后,对设计的自适应模糊控制器进行仿真分析
微陀螺仪模型为
Figure BDA00003394415500135
非量纲化后的微陀螺仪参数选取如下:
Figure BDA00003394415500132
Figure BDA00003394415500133
wxy=70.99,dxx=0.01,dyy=0.01,dxy=0.002,Ω=0.1
在区间[-3,3]上定义6个模糊集合,分别为:
μN3(x)=1/(1+exp(5(x+2)))    μN2(x)=exp(-(x+1.5)2)
μN1(x)=exp(-(x+0.5)2)    μP1(x)=exp(-(x-0.5)2)
μP2(x)=exp(-(x-1.5)2)    μP3(x)=1/(1+exp(-5(x-2)))
系统初始状态为[1,0,0,0],θ中各元素的初始值均为0。给定参考信号为x轴sin(6.17t),y轴为1.2sin(5.11t),两种方法设计的自适应模糊控制器的系统仿真参数选择分别如下:
(1)基于Riccati方程的系统参数:k1=2,k2=1,ρ=0.02,λ=0.0007,η=50,Q=[100;010];x轴扰动量为
Figure BDA00003394415500136
y轴扰动量为
Figure BDA00003394415500137
(2)基于线性矩阵不等式法的系统参数:k1=2,k2=1,ρ=8,η=150,Q=[102;210];x轴扰动量为
Figure BDA00003394415500138
y轴扰动量为
Figure BDA00003394415500139
仿真的结果如图3至图10所示,各图中,上面为X轴输出,下面为Y轴输出。
图3和图4分别是系统无干扰状态下,基于Riccati方法的系统跟踪曲线和跟踪误差曲线图。图5和图6是在微陀螺仪系统中加入了一倍的干扰后,系统的跟踪曲线和跟踪误差曲线。其中,实线为参考轨迹,虚线为实际运动轨迹。我们可以看出,在无干扰时,基于Riccati法系统的输出跟踪曲线从第8步开始收敛,X轴的跟踪误差约为0.3,Y轴的跟踪误差为0.5,陀螺仪系统不能很精确的跟踪参考模型轨迹,尤其是y轴,存在较大误差。在系统加入了1倍的扰动量后,系统的跟踪性能更差。
图7和图8分别是系统无干扰状态下,基于线性矩阵不等式方法的系统跟踪曲线和跟踪误差曲线图。图9至图10是微陀螺仪系统中加入了十倍的干扰后,系统的跟踪曲线和跟踪误差曲线。其中,实线为参考轨迹,虚线为实际运动轨迹。从图7至图10来看,基于线性矩阵不等式法系统的输出跟踪曲线从1步就开始收敛,X轴的跟踪误差趋近于0,Y轴的跟踪误差限定在0.05以内。在系统加入10倍的扰动后,系统跟踪误差没有变化,系统鲁棒性良好。
由以上具体实施例的结果显示,在丰富的输入信号情况下,本发明设计的基于线性矩阵不等式法的控制器控制效果明显优于基于Riccati法的控制器,该控制器能够使跟踪误差向量很快地收敛到零,同时在外界扰动情况下,系统仍然可以很好的跟踪模型,具有良好的鲁棒性。
以上实施例仅为本发明其中的一种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (6)

1.微陀螺仪的自适应模糊H无穷控制方法,其特征在于,包括以下步骤:
1)建立微陀螺仪的非量纲化动力学方程;
2)定义参考模型为
Figure FDA00003394415400012
其中qm为参考轨迹,km为参考模型系统矩阵;
3)建立控制任务,具体为,设计自适应模糊控制器和调整参数向量θ的自适应律,使得闭环系统具有全局稳定性,并取得控制误差性能指标;
所述设计自适应模糊控制器,具体为:若参数D,Ω,kb已知,则控制器设计为
&phi; * = ( D + 2 &Omega; ) q &CenterDot; + k b q + q m &CenterDot; &CenterDot; + k T e - - - ( 6 )
此为理想控制器,其中,e为跟踪误差,e=qm-q,k=(k2,k1)T,k2,k1为系统参数,qm为参考轨迹,q为运动轨迹;
若参数D,Ω,kb未知,则设计基于线性矩阵不等式的自适应模糊控制器,
其中,参数D,Ω,kb为微陀螺仪的非量纲化动力学方程中的参数;
4)采用基于Lyapunov的方法验证闭环控制系统的稳定性,完成控制任务。
2.根据权利要求1所述的微陀螺仪的自适应模糊H无穷控制方法,其特征在于,所述步骤1),建立微陀螺仪的非量纲化动力学方程,具体为
1-1)考虑到制造误差,实际微陀螺仪的集总参数数学模型为: m x &CenterDot; &CenterDot; + d xx x &CenterDot; + d xy y &CenterDot; + k xx x + k xy = u x + 2 m &Omega; z y &CenterDot; (1) m y &CenterDot; &CenterDot; + d xy x &CenterDot; + d yy y &CenterDot; + k xy x + k yy y = u y - 2 m &Omega; z x &CenterDot;
其中,m是质量块的质量,x,y是质量块在旋转系中的坐标,dxx,dyy分别是x轴和y轴的阻尼系数,kxx,kyy分别是x轴和y轴的弹簧系数,dxy,kxy分别是耦合的阻尼系数和耦合的弹簧系数,合称为正交误差,ux,uy是两轴的控制输入,Ωz为微陀螺仪的角速度,
Figure FDA00003394415400015
Figure FDA00003394415400016
是科里奥利力;
1-2)取非量纲时间t*=w0t,将所述方程(1)的两边同除以质量块质量m、参考长度q0以及两轴的共振频率w0的平方
Figure FDA00003394415400017
得到微陀螺仪的非量纲化动力学方程 q &CenterDot; &CenterDot; * + D * q &CenterDot; * + k b q * = u * - 2 &Omega; * q &CenterDot; * - - - ( 3 - 1 )
其中,q*为微陀螺仪轨迹, q * = q q 0 , D * = D mw 0 , &Omega; * = &Omega; w 0 , u x * = u x mw 0 2 q 0 , u y * = u y mw 0 2 q 0 q = x y , &Omega; = 0 - &Omega; z &Omega; z 0 , D = d xx d xy d xy d yy , k b = w x 2 w xy w xy w y 2 , u * = u x * u y * , w x 2 = k xx mw 0 2 , w y 2 = k yy mw 0 2 , w xy = k xy mw 0 2
1-3)忽略符号表示的不同,重新用q代替q*,用D代替D*,用u代替u*,用Ω代替Ω*,则式(3-1)转化为
q &CenterDot; &CenterDot; + D q &CenterDot; + k b q = u - 2 &Omega; q &CenterDot; - - - ( 3 )
以此作为微陀螺仪的非量纲化动力学方程。
3.根据权利要求1所述的微陀螺仪的自适应模糊H无穷控制方法,其特征在于,所述步骤3)中,基于线性矩阵不等式设计自适应模糊控制器包括两部分:第一部分为模糊控制器uc(q|θ),用于逼近理想控制器φ*;另一部分为H鲁棒控制项v2,用以克服外界干扰对系统输出跟踪误差的影响,保证系统闭环稳定;
所述模糊控制器的输出uc(q|θ)为,
Figure FDA000033944154000215
其中基本模糊控制器uc(x|θ)为,
Figure FDA000033944154000216
ξ(x)为模糊基函数,N为模糊控制规则条数,θ为调整参数向量;
所述H鲁棒控制项v2为,v2=Ke,其中,矩阵K和矩阵P是下列线性矩阵不等式的解: A T P + PA - PBK - K T B T P + 1 &rho; 2 PBB T P + 2 Q < 0 - - - ( 28 )
其中,P=PT>0,A为系统参数矩阵,
Figure FDA00003394415400031
Q为一个正定矩阵,ρ是抑制水平,为给定参数,
则基于线性矩阵不等式设计的自适应模糊控制器的输出φ2为,φ2=uc(q|θ)+v2
4.根据权利要求1所述的微陀螺仪的自适应模糊H无穷控制方法,其特征在于,所述步骤3)中,调整参数向量θ的自适应律
Figure FDA00003394415400034
为,
其中,η为学习律。
5.根据权利要求1所述的微陀螺仪的自适应模糊H无穷控制方法,其特征在于,所述步骤3)中,控制性能指标为 &Integral; 0 T e T Qedt &le; e T ( 0 ) Pe ( 0 ) + 1 &eta; &theta; ~ T ( 0 ) &theta; ~ ( 0 ) + &rho; 2 &Integral; 0 T &omega; T &omega;dt - - - ( 5 )
式中,e为跟踪误差,T∈[0,∞)为系统时间,ω是模糊逼近误差,ω∈L2[0,T],Q和P是两个正定矩阵,是参数的估计误差,θ*为参数向量的最优参数,η为学习律,ρ为抑制水平。
6.根据权利要求1所述的微陀螺仪的自适应模糊H无穷控制方法,其特征在于,所述步骤4)中Lyapunov函数V取为: V = 1 2 e T Pe + 1 2 &eta; &theta; ~ T &theta; ~ .
CN2013102541464A 2013-06-24 2013-06-24 微陀螺仪的自适应模糊h无穷控制方法 Pending CN103336430A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2013102541464A CN103336430A (zh) 2013-06-24 2013-06-24 微陀螺仪的自适应模糊h无穷控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN2013102541464A CN103336430A (zh) 2013-06-24 2013-06-24 微陀螺仪的自适应模糊h无穷控制方法

Publications (1)

Publication Number Publication Date
CN103336430A true CN103336430A (zh) 2013-10-02

Family

ID=49244622

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2013102541464A Pending CN103336430A (zh) 2013-06-24 2013-06-24 微陀螺仪的自适应模糊h无穷控制方法

Country Status (1)

Country Link
CN (1) CN103336430A (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105278331A (zh) * 2015-05-26 2016-01-27 河海大学常州校区 一种微陀螺的鲁棒自适应神经网络h无穷控制方法
CN105301962A (zh) * 2015-11-04 2016-02-03 河海大学常州校区 一种基于自适应模糊控制的悬臂梁振动控制方法
CN105388762A (zh) * 2015-12-11 2016-03-09 河海大学常州校区 基于lmi线性不等式的微陀螺仪h无穷控制方法
CN105717791A (zh) * 2015-09-25 2016-06-29 河海大学常州校区 一种自适应h无穷控制的悬臂梁振动控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102393639A (zh) * 2011-10-18 2012-03-28 河海大学常州校区 基于自适应模糊滑模的微陀螺仪追踪控制方法
CN102411302A (zh) * 2011-11-07 2012-04-11 河海大学常州校区 基于直接自适应模糊控制的mems微陀螺仪控制方法
CN102508434A (zh) * 2011-11-07 2012-06-20 河海大学常州校区 用于微陀螺仪的自适应模糊滑模控制器
CN102681443A (zh) * 2012-06-05 2012-09-19 河海大学常州校区 一种基于模糊补偿的微机电陀螺仪模糊自适应控制系统

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102393639A (zh) * 2011-10-18 2012-03-28 河海大学常州校区 基于自适应模糊滑模的微陀螺仪追踪控制方法
CN102411302A (zh) * 2011-11-07 2012-04-11 河海大学常州校区 基于直接自适应模糊控制的mems微陀螺仪控制方法
CN102508434A (zh) * 2011-11-07 2012-06-20 河海大学常州校区 用于微陀螺仪的自适应模糊滑模控制器
CN102681443A (zh) * 2012-06-05 2012-09-19 河海大学常州校区 一种基于模糊补偿的微机电陀螺仪模糊自适应控制系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
王岩等: "不确定广义模糊系统的鲁棒模糊H∞控制器设计", 《计算技术与自动化》, vol. 22, no. 1, 31 March 2003 (2003-03-31), pages 3 - 7 *
邓玮: "基于模糊基函数的一类非线性系统自适应H∞控制", 《沈阳工程学院学报(自然科学版)》, vol. 5, no. 2, 30 April 2009 (2009-04-30) *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105278331A (zh) * 2015-05-26 2016-01-27 河海大学常州校区 一种微陀螺的鲁棒自适应神经网络h无穷控制方法
CN105717791A (zh) * 2015-09-25 2016-06-29 河海大学常州校区 一种自适应h无穷控制的悬臂梁振动控制方法
CN105717791B (zh) * 2015-09-25 2018-06-22 河海大学常州校区 一种自适应h无穷控制的悬臂梁振动控制方法
CN105301962A (zh) * 2015-11-04 2016-02-03 河海大学常州校区 一种基于自适应模糊控制的悬臂梁振动控制方法
CN105388762A (zh) * 2015-12-11 2016-03-09 河海大学常州校区 基于lmi线性不等式的微陀螺仪h无穷控制方法

Similar Documents

Publication Publication Date Title
CN102298322B (zh) 基于模型参考自适应控制微陀螺仪的方法
CN104281056B (zh) 基于神经网络上界学习的微陀螺仪鲁棒自适应控制方法
CN102508434B (zh) 用于微陀螺仪的自适应模糊滑模控制器
CN102393639B (zh) 基于自适应模糊滑模的微陀螺仪追踪控制方法
CN102298315B (zh) 基于rbf神经网络滑模控制的mems陀螺仪的自适应控制系统
CN103616818B (zh) 微陀螺仪的自适应模糊神经全局快速终端滑模控制方法
CN105045097B (zh) 一种基于神经网络的微陀螺仪反演全局滑模模糊控制方法
CN102636995B (zh) 基于rbf神经网络滑模控制微陀螺仪的方法
CN103439884B (zh) 一种基于模糊滑模的智能汽车横向控制方法
CN103116275B (zh) 基于滑模补偿的微陀螺仪鲁棒神经网络控制系统及方法
CN104122794B (zh) 微陀螺仪的自适应模糊神经补偿非奇异终端滑模控制方法
CN103279038B (zh) 基于t-s模糊模型的微陀螺仪滑模自适应控制方法
CN102411302A (zh) 基于直接自适应模糊控制的mems微陀螺仪控制方法
CN102914972A (zh) 基于模型整体逼近的微陀螺仪rbf网络自适应控制方法
CN103529701A (zh) 微陀螺仪的神经网络全局滑模控制方法
CN105278331A (zh) 一种微陀螺的鲁棒自适应神经网络h无穷控制方法
CN103336430A (zh) 微陀螺仪的自适应模糊h无穷控制方法
CN103345154B (zh) 微陀螺仪系统的间接自适应模糊滑模控制方法
CN103345148A (zh) 微陀螺仪的鲁棒自适应控制方法
CN103885339A (zh) 微陀螺仪的反演自适应模糊滑模控制方法
CN103389648A (zh) 微陀螺仪的全局滑模控制方法
CN104155874B (zh) 微陀螺仪的反演自适应模糊动态滑模控制方法
CN104503246A (zh) 微陀螺仪系统的间接自适应神经网络滑模控制方法
CN104267604B (zh) 微陀螺仪自适应神经网络全局滑模控制方法
CN105487382B (zh) 基于动态面的微陀螺自适应模糊滑模控制方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C12 Rejection of a patent application after its publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20131002