CN107831655B - 微陀螺仪的分数阶自适应反演模糊滑模控制方法 - Google Patents

微陀螺仪的分数阶自适应反演模糊滑模控制方法 Download PDF

Info

Publication number
CN107831655B
CN107831655B CN201710992674.8A CN201710992674A CN107831655B CN 107831655 B CN107831655 B CN 107831655B CN 201710992674 A CN201710992674 A CN 201710992674A CN 107831655 B CN107831655 B CN 107831655B
Authority
CN
China
Prior art keywords
gyroscope
micro
fuzzy
sliding mode
fractional order
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.)
Active
Application number
CN201710992674.8A
Other languages
English (en)
Other versions
CN107831655A (zh
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 CN201710992674.8A priority Critical patent/CN107831655B/zh
Publication of CN107831655A publication Critical patent/CN107831655A/zh
Application granted granted Critical
Publication of CN107831655B publication Critical patent/CN107831655B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0265Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
    • G05B13/0275Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using fuzzy logic only

Abstract

本发明公开了一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,包括:建立微陀螺仪系统的无量纲动力学方程数学模型和参考轨迹模型;构建基于分数阶的反演自适应模糊滑模控制器。本发明能够实现微陀螺实时跟踪的目标,并且增强了系统的鲁棒性,在有外界干扰的情况下仍然保持很好的性能;根据分数阶滑模面设计分数阶自适应律,基于Lyapunov稳定性判据设计一种自适应辨识方法,在线实时估计微陀螺的各项未知系统参数,与整数阶相比,多了可调项,提高了控制效果和参数估计效果;模糊系统逼近参数不确定性及外部干扰总量的上界值,通过对上界值进行模糊逼近,可将滑模控制器中的切换项连续化,大大的降低抖振。

Description

微陀螺仪的分数阶自适应反演模糊滑模控制方法
技术领域
本发明涉及微陀螺仪控制技术领域,具体是一种微陀螺仪的分数阶自适应反演模糊滑模控制方法。
背景技术
微陀螺仪是测量惯性导航和惯性制导系统角速度的传感器,因为它在任何环境下都能够自主导航,所以自出现以来就受到人们的广泛关注,在航天、航海、航空和军事等领域得到了普遍的应用。但是生产和制造过程中存在误差且易受温度影响,造成元件特性与设计之间的差异,从而导致微陀螺仪的性能降低。另外,微陀螺仪属于多输入多输出系统并且系统参数存在不确定性及易受外界环境的影响,使得陀螺仪追踪效果并不理想。传统的滑模控制方法中滑模面的设计都是采用误差的比例、微分或积分的组合,其中微分或积分的阶数都是整数,微陀螺仪的跟踪效果比较差,系统参数和角速度估计效果也比较差,容易引起抖振。
本发明的分数阶自适应反演模糊滑模控制方法中,反演设计方法是将复杂的非线性系统分解成不超过系统阶数的子系统,然后为每个子系统分别设计李雅普诺夫函数,一直“后退”到整个子系统,直到完成整个控制律的设计。在设计过程中,采用分数阶滑模面,根据李雅普诺夫函数设计带有分数阶的反演滑模控制律,通过调节分数阶阶数,来提高系统的性能。在反演分数阶滑模控制律中用切换项函数代替干扰项,采用自适应模糊控制方法将不连续的切换项连续化,有效降低系统抖振。
Lyapunov(李雅普诺夫)函数V(x,t)是可以根据需要自由选取的,但是要符合李雅普诺夫函数的要求(即李雅普诺夫稳定性判据),即V(x,t)是正定的,当x≠0时,V(x,t)>0;当x=0时,V(0,t)=0,具有连续的偏导数;V(x,t)的一阶导
Figure BDA0001441844940000011
是负半定的。
发明内容
本发明为了避免上述不足之处,提出一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,在线实时估计陀螺仪参数矩阵,有效提高控制效果和参数估计效果,并且有效降低抖振。
本发明采用的技术方案是:一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特
征在于:包括如下步骤:
一、建立微陀螺仪系统的无量纲动力学方程数学模型;
二、构建微陀螺仪系统的参考轨迹模型;
三、构建基于分数阶的自适应反演模糊滑模控制器,首先,为微陀螺仪的一个子系统,设计Lyapunov函数,保证微陀螺仪系统的稳定性;然后,设计分数阶反演滑模控制律;最后,设计基于分数阶的自适应反演模糊滑模控制律,实现在线调节微陀螺仪系统,在线实时估计微陀螺的系统参数,确保全局渐进稳定性。
前述的一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:所述步骤一中:所述微陀螺仪的无量纲数学模型为:
Figure BDA0001441844940000021
其中,q为微陀螺仪数学模型无量纲化后的位置向量,
Figure BDA0001441844940000022
表示对位置向量q求一阶导数,
Figure BDA0001441844940000023
表示对位置向量q求二阶导数;Db为无量纲化后阻尼矩阵,K为无量纲化后弹簧系数矩阵,Ω为无量纲化后角速度矩阵,u为微陀螺仪的控制输入,d(t)为系统不确定性和外界干扰总和,满足||d(t)||≤ρ,ρ为系统的不确定性和外界干扰总和的上界。
前述的一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:所述步骤二中:所述微陀螺仪系统的参考轨迹模型为:
xr=A1sin(ω1t),yr=A2sin(ω2t) (3)
其中xr、yr是指x轴、y轴两轴的参考轨迹模型;A1、A2分别是微陀螺仪在x轴、y轴方向上的振幅;ω1、ω2分别是微陀螺仪在x轴、y轴方向上给定的振动频率;t是时间变量。
前述的一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:所述步骤三中,为微陀螺仪的一个子系统,设计Lyapunov函数,设计步骤包括:
定义矢量x1,x2分别为:
Figure BDA0001441844940000024
基于反演设计技术,将微陀螺仪的数学模型(1)转换为如下形式:
Figure BDA0001441844940000025
定义微陀螺仪实际位置和参考轨迹之间的跟踪误差e1为:
e1=x1-qr (7)
其中,qr为微陀螺仪系统两轴的参考轨迹,
则跟踪误差导数的一阶导数
Figure BDA0001441844940000031
为:
Figure BDA0001441844940000032
取虚拟控制量α1为:
Figure BDA0001441844940000033
其中,c1为误差系数,为非零的正常数;
定义跟踪误差函数e2为:
e2=x21 (10)
对具有跟踪误差e1的微陀螺仪子系统选取一个Lyapunov函数V1为:
Figure BDA0001441844940000034
对V1沿时间t求导得:
Figure BDA0001441844940000035
当e2=0,
Figure BDA0001441844940000036
满足负定性,保证系统是稳定的。
前述的一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:所述步骤三中,分数阶反演滑模控制律u1设计步骤包括:
针对微陀螺仪设计分数阶滑模面s为:
s=λ1e12Dα-1e13e2 (15)
其中,λ123为滑模系数,为正实数,Dα-1e1表示对e1求α-1阶导;
对具有跟踪误差e2的微陀螺仪子系统选取Lyapunov函数V2为:
Figure BDA0001441844940000037
根据Lyapunov函数V2设计分数阶反演滑模控制律u1为:
Figure BDA0001441844940000041
其中,
Figure BDA0001441844940000042
Figure BDA0001441844940000043
表示滑模切换项,用来代替系统不确定性和外界干扰总和d(t);
Figure BDA0001441844940000044
微陀螺仪系统是稳定的。
前述的一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:所述步骤三中,基于分数阶的自适应反演模糊滑模控制律u'设计步骤包括:
定义微陀螺仪无量纲化模型中估计误差分别为:
Figure BDA0001441844940000045
定义模糊系统自适应参数估计误差为:
Figure BDA0001441844940000046
Figure BDA0001441844940000047
是用来逼近滑模切换项
Figure BDA00014418449400000412
的模糊系统输出,θ*是模糊系统的最优参数,θ是模糊系统参数,
基于分数阶的自适应反演模糊滑模控制律u'为:
Figure BDA0001441844940000048
其中模糊系统输出
Figure BDA0001441844940000049
存在如下形式:
Figure BDA00014418449400000410
其中,
Figure BDA00014418449400000411
分别为微陀螺仪两轴的模糊系统输出,θ为模糊系统参数,Φ(s)T是与隶属度相关的函数;
将分数阶的自适应反演模糊滑模控制律u'作为微陀螺仪系统控制输入u,带入微陀螺仪系统的数学模型中,实现对微陀螺仪系统的跟踪控制;
定义第三个Lyapunov函数V为:
Figure BDA0001441844940000051
其中,r1是正常数,
Figure BDA0001441844940000052
表示微陀螺仪坐标轴模糊系统参数的估计误差,
Figure BDA0001441844940000053
代表x轴模糊系统参数估计误差,
Figure BDA0001441844940000054
代表y轴模糊系统参数估计误差,M=MT>0,N=NT>0,P=PT>0为对称正定矩阵,tr{·}表示矩阵的求迹运算,
Figure BDA0001441844940000055
分别为参数矩阵Db,K,Ω的参数估计误差;
为了保证Lyapunov函数的导数
Figure BDA0001441844940000056
在线实时估计微陀螺的系统参数,设计微陀螺仪参数矩阵Db,K,Ω的估计值
Figure BDA0001441844940000057
和模糊系统参数θi的自适应律分别为:
Figure BDA0001441844940000058
Figure BDA0001441844940000059
为陀螺仪系统阻尼矩阵Db的估计值的自适应律,
Figure BDA00014418449400000510
为陀螺仪系统的弹簧系数矩阵K的估计值的自适应律,
Figure BDA00014418449400000511
为陀螺仪角速度矩阵的估计值的自适应律,
Figure BDA00014418449400000512
是模糊系统参数自适应律;当选取上述参数自适应律时,
Figure BDA00014418449400000513
满足李雅普诺夫稳定性定理,保证微陀螺仪系统全局渐进稳定性。
本发明的有益效果在于:本发明通过反演技术,将微陀螺仪系统分解成简单的子系统,再为每个子系统设计Lyapunov函数,使得整个控制过程清晰明了;在反演控制方法基础上,设计分数阶滑模面,即带有偏差的分数阶导数的滑模面,则多了可以调节的微分阶数项,增加了调节自由度,使得控制效果有所改善;当微陀螺仪系统参数和角速度看作未知变量时,基于Lyapunov稳定性理论,设计参数的自适应律,实时更新微陀螺仪的角速度和其他系统参数的估计值;本发明具有提高陀螺仪系统控制性能和鲁棒性的特点,能够实现微陀螺仪较好的跟踪效果,降低系统误差,并且降低系统抖振,以及辨识出系统参数和角速度,辨识系统参数可以了解系统的物理参数,如果某个参数距离给定的值很远,说明系统内部出现问题,需要更换原件等。
附图说明
图1为本发明分数阶自适应反演模糊滑模控制系统的原理图;
图2为本发明采用分数阶自适应反演模糊滑模控制方法的微陀螺X,Y轴跟踪效果图;
图3为本发明采用分数阶自适应反演模糊滑模控制方法的跟踪误差图;
图4为本发明采用分数阶自适应反演模糊滑模控制方法的两轴控制输入响应曲线图。
具体实施方式
下面结合附图对本发明作进一步描述。以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
如图1所示,一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,包括以下步骤:
一、建立微陀螺仪系统的无量纲动力学方程数学模型
一般的微机械振动陀螺仪由三个部分组成:弹性材料所支撑悬挂的质量块、静电驱动装置、感测装置,将其简化为一个由质量块和弹簧构成的有阻尼振荡系统。对z轴微陀螺仪而言,可以认为质量块被限制只能在x-y平面内运动,而不能沿z轴运动,只围绕z轴旋转。
根据旋转系中的牛顿定律,考虑加工制造误差,再对数学模型进行无量纲化处理及等效变换后,得到的微陀螺仪的数学模型如下:
Figure BDA0001441844940000061
其中:
Figure BDA0001441844940000062
q为微陀螺仪数学模型无量纲化后的位置向量,q1,q2分别为陀螺仪数学模型无量纲化后x轴、y轴的位置向量;
Figure BDA0001441844940000063
为参考位移,Q1,Q2分别为微陀螺仪x轴、y轴的位置;
Figure BDA0001441844940000068
表示对位置向量q求一阶导数,
Figure BDA0001441844940000064
表示对位置向量q求二阶导数;
Figure BDA0001441844940000065
为微陀螺仪的控制输入,ux,uy分别表示x轴和y轴的控制输入;
Figure BDA0001441844940000066
为无量钢化后阻尼矩阵,其中,
Figure BDA0001441844940000067
箭头→表示后者由前者计算得到是等于关系,Dxx,Dyy分别为微陀螺仪x轴、y轴的阻尼系数,Dxy为两轴的耦合阻尼系数,m为陀螺仪的质量,ω0为两轴的共振频率;
Figure BDA0001441844940000071
为无量纲化后弹簧系数矩阵,其中,
Figure BDA0001441844940000072
kxx,kyy分别为微陀螺仪x轴、y轴的弹簧系数,kxy为两轴耦合的弹簧系数;
Figure BDA0001441844940000073
为无量纲化后角速度矩阵,其中
Figure BDA0001441844940000074
Ω* z为z轴方向上的输入角速度,陀螺仪是沿着x-y平面运动,但是同时它也在围绕z轴旋转,所以有z轴角速度;d(t)为系统不确定性和外界干扰总和,满足||d(t)||≤ρ,|| ||表示求向量的模,ρ为系统的不确定性和外界干扰总和的上界。
式(1)可以写成通用形式的数学模型:
Figure BDA0001441844940000075
其中,
Figure BDA0001441844940000076
T表示向量的转置,f1,f2分别表示
Figure BDA0001441844940000077
计算后得到的二维向量中的每个分量。
二、构建微陀螺仪系统的参考轨迹模型;
微陀螺仪的理想动态特性是一种无能量损耗,x轴、y轴两轴间无动态耦合的稳定正弦振荡,参考轨迹模型描述如下:
xr=A1sin(ω1t),yr=A2sin(ω2t) (3)
其中xr、yr是指x轴、y轴两轴的参考轨迹模型;A1、A2分别是微陀螺仪在x轴、y轴方向上的振幅;ω1、ω2分别是微陀螺仪在x轴、y轴方向上给定的振动频率;t是时间变量。
将(3)式转化成微分方程形式为:
Figure BDA0001441844940000078
其中,qr=[xr yr]T为微陀螺仪系统两轴的参考轨迹,
Figure BDA0001441844940000079
表示对x轴、y轴的参考轨迹qr求二阶导,Kr=diag{ω1 22 2},diag{}表示对角矩阵,矩阵Kr表示微陀螺仪在x轴、y轴方向上给定的振动频率的对角矩阵。
三、构建基于分数阶的反演自适应模糊滑模控制器;
为了应用反演技术理论,首先对微陀螺仪的通用形式数学模型即公式(2)进行变换,定义矢量x1和x2
Figure BDA0001441844940000081
则式(2)可以改写为:
Figure BDA0001441844940000082
分数阶反演滑模控制器设计步骤如下:
基于分数阶的反演自适应模糊滑模控制器设计步骤如下:
为微陀螺仪的两个子系统,分别设计合适的Lyapunov函数,保证微陀螺仪系统的稳定性:
3.1):为微陀螺仪的一个子系统,设计Lyapunov函数,保证微陀螺仪系统的稳定性;
定义微陀螺仪实际位置和参考轨迹之间的跟踪误差e1为:
e1=x1-qr (7)
则跟踪误差导数的一阶导数
Figure BDA0001441844940000083
为:
Figure BDA0001441844940000084
取虚拟控制量α1为:
Figure BDA0001441844940000085
其中c1为误差系数,为非零的正常数。
定义跟踪误差函数e2为:
e2=x21 (10)
对具有跟踪误差e1的微陀螺仪子系统选取一个Lyapunov函数V1为:
Figure BDA0001441844940000086
对V1沿时间t求导得:
Figure BDA0001441844940000087
当e2=0,则可得
Figure BDA0001441844940000091
Figure BDA0001441844940000092
满足负定性,符合李雅普诺夫稳定性判据,故跟踪误差e1满足全局渐进稳定,渐进收敛到零,可以保证系统是稳定的。因此,进一步设计分数阶反演滑模控制律u1,使滑模面趋于零。在系统稳定的时候,滑模面函数s趋于零。
3.2)针对微陀螺仪设计分数阶反演滑模控制器的控制律u1
对第二个跟踪误差e2沿时间求导得:
Figure BDA0001441844940000093
针对微陀螺仪设计分数阶滑模面s为:
s=λ1e12Dα-1e13e2 (15)
其中,λ123为滑模系数,为正实数,Dα-1e1是指对e1求α-1阶导,这是分数阶专用的写法,D表示求导,α是指分数阶的阶数,则微陀螺仪分数阶滑模面s的导数
Figure BDA0001441844940000099
为:
Figure BDA0001441844940000094
其中,Dαe1是对Dα-1e1求导的结果。
结合滑模面,对具有跟踪误差e2的微陀螺仪子系统设计第二个Lyapunov函数V2为:
Figure BDA0001441844940000095
对公式(17)Lyapunov函数V2两边求导可得:
Figure BDA0001441844940000096
根据分数阶滑模面s公式(15)可得到:
Figure BDA0001441844940000097
将公式(19)代入公式(18)进一步转换
Figure BDA0001441844940000098
为:
Figure BDA0001441844940000101
其中
Figure BDA0001441844940000102
由李雅普诺夫稳定性判据可知,只有
Figure BDA0001441844940000103
才能保证微陀螺仪系统是稳定的;为了保证
Figure BDA0001441844940000104
针对微陀螺仪系统,设计基于分数阶的反演滑模控制律u1为:
Figure BDA0001441844940000105
其中,
Figure BDA0001441844940000106
表示滑模切换项,用来代替系统不确定性和外界干扰总和d(t)。
由于sTe1=e1 Ts,将基于分数阶的反演控制律u1代入公式(20)
Figure BDA0001441844940000107
得:
Figure BDA0001441844940000108
Figure BDA00014418449400001010
根据Lyapunov稳定性判据可以证明微陀螺仪系统是稳定的;
3.3)设计基于分数阶的自适应反演模糊滑模控制器的控制律u':
由于微陀螺仪无量纲化模型中Db,K,Ω三个参数是未知的,并且在实际应用过程中,系统存在不确定性和外界干扰,因此反演控制律u1公式(21)不能直接应用。基于自适应理论知识,用估计值
Figure BDA0001441844940000109
代替(21)中的三个陀螺仪参数矩阵,设计三个参数估计值的自适应算法,在线实时更新估计;同时用模糊系统
Figure BDA0001441844940000111
来逼近滑模切换项。
定义微陀螺仪无量纲化模型中估计误差分别为:
Figure BDA0001441844940000112
定义模糊系统自适应参数估计误差为:
Figure BDA0001441844940000113
Figure BDA0001441844940000114
是用来逼近滑模切换项
Figure BDA0001441844940000115
的模糊系统输出,θ*是模糊系统的最优参数,θ是模糊系统参数,
基于分数阶的反演控制律公式(21)可以转换为基于分数阶的自适应反演模糊滑模控制律u':
Figure BDA0001441844940000116
将分数阶的自适应反演模糊滑模控制律u'作为微陀螺仪系统控制输入u,带入微陀螺仪系统的数学模型中,实现对微陀螺仪系统的跟踪控制。
以单轴系统为例,假设模糊系统由N条模糊规则构成,第k条模糊规则表达形式为:
Figure BDA0001441844940000117
其中xj为模糊系统输入变量,j=1,2,,,n,n为输入变量的个数,
Figure BDA0001441844940000118
为模糊系统输出,μj k为xj的隶属度函数,Bk
Figure BDA0001441844940000119
的模糊集。
则模糊系统的输出
Figure BDA00014418449400001110
为:
Figure BDA00014418449400001111
其中,∏表示连乘符号,
Figure BDA00014418449400001112
是与隶属度有关的函数,θX=[θ1θ2...θN]T表示模糊系统参数,θk即为模糊系统参数θX中的一个分量。
在本文中由于陀螺仪是两轴系统,仅需把上面的x分别用滑模面s在两个轴上分量s1,s2代替即可,s1表示x轴滑模面,s2表示y轴滑模面。由于模糊系统每轴输入变量只有一个,所以n取1,输入变量上标j忽略即可,即每轴的输入变量分别为s1,s2,则本文模糊系统设计为:
Figure BDA0001441844940000121
其中
Figure BDA0001441844940000122
表示x轴模糊系统参数,Φ(s1)=[Φ1(s12(s1)...ΦN(s1)]T
Figure BDA0001441844940000123
表示y轴模糊系统参数,Φ(s2)=[Φ1(s22(s2)...ΦN(s2)]T
定义微陀螺仪系统中,模糊系统的输出
Figure BDA0001441844940000124
存在如下形式:
Figure BDA0001441844940000125
其中,
Figure BDA0001441844940000126
模糊系统参数
Figure BDA0001441844940000127
Figure BDA0001441844940000128
定义模糊系统最优参数θ*为:
Figure BDA0001441844940000129
其中Ωh为模糊系统参数θ的集合,Rn表示实数域,si表示单轴的滑模面,i=1,2,分别代表两个轴的滑模面。sup表示最小上界,arg min是[]中取最小值时模糊系统参数θ的取值。
将基于分数阶的自适应反演模糊滑模控制律u'公式(24)代入微陀螺设计分数阶滑模面s的导数
Figure BDA00014418449400001210
公式(16)
Figure BDA00014418449400001211
定义第三个Lyapunov函数V为:
Figure BDA0001441844940000131
其中,r1是正常数,
Figure BDA0001441844940000132
表示微陀螺仪坐标轴模糊系统参数的估计误差,
Figure BDA0001441844940000133
代表x轴模糊系统参数估计误差,
Figure BDA0001441844940000134
代表y轴模糊系统参数估计误差,M=MT>0,N=NT>0,P=PT>0为对称正定矩阵,称作自适应固定增益矩阵,它们是可调整的参数,是可人为选取的;tr{·}表示矩阵的求迹运算。
对第三个Lyapunov函数V等式两边求导得:
Figure BDA0001441844940000135
由于Db=Db T,K=KT,Ω=-ΩT,并且
Figure BDA0001441844940000136
为标量,因此:
Figure BDA0001441844940000137
同理可得:
Figure BDA0001441844940000141
Figure BDA0001441844940000142
所以
Figure BDA0001441844940000143
为保证
Figure BDA0001441844940000144
设计自适应律为:
Figure BDA0001441844940000145
Figure BDA0001441844940000146
为陀螺仪系统阻尼矩阵Db的估计值的自适应律,
Figure BDA0001441844940000147
为陀螺仪系统的弹簧系数矩阵K的估计值的自适应律,
Figure BDA0001441844940000148
为陀螺仪角速度矩阵的估计值的自适应律,
Figure BDA0001441844940000149
是模糊系统参数自适应律。
那么V对时间t的微分为:
Figure BDA0001441844940000151
由于
Figure BDA0001441844940000152
满足李雅普诺夫稳定性定理,由此可以得到具有跟踪误差e1的子系统、具有跟踪误差e2的子系统、滑模面函数s将会渐进地收敛到零,从而验证本发明所提出的控制方法能够实现对微陀螺仪的分数阶自适应反演模糊滑模控制,具有鲁棒作用,提高系统控制性能,使得跟踪效果更好,降低系统误差,并且降低抖振,同时在线辨识微陀螺仪系统参数,从而了解微陀螺仪系统的物理参数,如果参数辨识
Figure BDA0001441844940000153
中某个估计值距离给定的值Db,K,Ω很远,说明系统内部出现问题,需要更换原件等。
为了更加直观地显示本发明提出的分数阶自适应反演模糊滑模控制方法的优越性,在MATLAB/SIMULINK对本发明控制方法进行计算机仿真实验。
参考现有文献,选取微陀螺仪的参数为:
m=1.8×10-7kg,Dxx=1.8×10-6N s/m,Dyy=1.8×10-6N s/m,
Dxy=3.6×10-7N s/m,kxx=63.955N/m,kyy=95.92N/m,kxy=12.779N/m。
假定未知的输入角速度为Ωz *=100rad/s。首先微陀螺参数进行无量纲化处理,对于振动式微陀螺仪,基础质量块沿x轴,y轴振动幅值在亚微米级别,参考位移选取为q0=1μm较为合理。因为微陀螺的操作频率在kHz范围,所以选取固有频率为ω0=1kHz。得到微陀螺仪的无量纲化参数为:
ωx 2=355.3,ωy 2=532.9,ωxy=70.99,dxx=0.01
dyy=0.01,dxy=0.002,Ωz=0.1
Figure BDA0001441844940000154
Figure BDA0001441844940000155
对于两轴微陀螺仪系统,分别选取滑模面s的3个隶属度函数,在微陀螺仪系统中,每轴只有一个输入变量si因此j取1,k=1-N,在本文中取三个隶属度函数,所以N=3。3个隶属度函数分别为:μ1(si)=1/(1+exp(5(si+3))),μ2(si)=exp(-si 2),μ3(si)=1/(1+exp(5(si-3)))。
仿真实验中,设系统的初始条件为:
Figure BDA0001441844940000161
q1(0),q2(0)是指微陀螺仪在x轴、y轴的初始位置,此刻t=0,微陀螺的两轴期望运行轨迹(参考轨迹)为:xr=sin(4.17t),yr=1.2sin(5.11t),三个参数矩阵的估计初值分别为:
Figure BDA0001441844940000162
Figure BDA0001441844940000163
在滑模控制律中,滑模面参数取λ1=55,λ2=10,λ3=1,误差系数取c1=200,取M=N=diag(150,150),P=diag(20,20),取分数阶阶数α=0.9。
当外界干扰取白噪声信号d=[0.5*randn(1,1);0.5*randn(1,1)]时,randn(1,1)表示产生随机数,仿真结果如图2至图4所示。
图2为微陀螺仪X、Y轴的跟踪曲线,从图中可以看出采用分数阶自适应反演模糊滑模控制方法后微陀螺仪的X、Y轴轨迹能够很好的追踪上参考轨迹。
图3为跟踪误差曲线图,从图中可以看出,X、Y轴上的跟踪误差e1能在较短时间内收敛到零。
图4为两轴控制输入响应曲线。用模糊方法对控制器中的滑模切换项
Figure BDA0001441844940000164
进行逼近,可将滑模切换项连续化,有效降低了抖振。
本发明通过反演控制,简化了系统,使得整个控制器设计过程清晰明了;同时为微陀螺仪的每个子系统设计李雅普诺夫函数,基于自适应机制,设计自适应律,实时估计陀螺仪系统的参数和角速度;选取分数阶滑模面,在保留滑模控制优势的基础上,又多了可以调节的微分阶数项,增加了调节自由度,改善了控制性能;另外,采用模糊控制系统对外界干扰项进行逼近,有效降低了抖振。本文应用分数阶滑模面,相比于动态面方法,在滑模面面中多了可以调节的分数阶阶数项,增加了调节自由度,提高了陀螺仪跟踪效果,有效降低了系统误差,并且本文可以实现陀螺仪系统参数和角速度的辨识,了解微陀螺仪系统的物理参数。
以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上大的限制,虽然本发明以较佳实例揭露如上,然而并非用以限制本发明,任何熟悉本专业的技术人员,在不脱离本发明技术方案范围内,当可利用上述揭示的技术内容作出些许更动或修饰为等同变化的等效实例,但凡是为脱离本发明的技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化与装饰,均仍属于本发明技术方案的范围内。

Claims (3)

1.一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:包括如下步骤:
一、建立微陀螺仪系统的无量纲动力学方程数学模型;
二、构建微陀螺仪系统的参考轨迹模型;
三、构建基于分数阶的自适应反演模糊滑模控制器,首先,为微陀螺仪的一个子系统,设计Lyapunov函数,保证微陀螺仪系统的稳定性;然后,设计分数阶反演滑模控制律;最后,设计基于分数阶的自适应反演模糊滑模控制律,实现在线调节微陀螺仪系统,在线实时估计微陀螺的系统参数,确保全局渐进稳定性;
所述步骤一中:所述微陀螺仪的无量纲数学模型为:
Figure FDA0002705484270000011
其中,q为微陀螺仪数学模型无量纲化后的位置向量,
Figure FDA0002705484270000012
表示对位置向量q求一阶导数,
Figure FDA0002705484270000013
表示对位置向量q求二阶导数;Db为无量纲化后阻尼矩阵,K为无量纲化后弹簧系数矩阵,Ω为无量纲化后角速度矩阵,u为微陀螺仪的控制输入,d(t)为系统不确定性和外界干扰总和,满足||d(t)||≤ρ,ρ为系统的不确定性和外界干扰总和的上界;
所述步骤三中,为微陀螺仪的一个子系统,设计Lyapunov函数,设计步骤包括:
定义矢量x1,x2分别为:
Figure FDA0002705484270000014
基于反演设计技术,将微陀螺仪的数学模型(1)转换为如下形式:
Figure FDA0002705484270000015
定义微陀螺仪实际位置和参考轨迹之间的跟踪误差e1为:
e1=x1-qr (7)
其中,qr为微陀螺仪系统两轴的参考轨迹,
则跟踪误差导数的一阶导数
Figure FDA0002705484270000016
为:
Figure FDA0002705484270000017
取虚拟控制量α1为:
Figure FDA0002705484270000021
其中,c1为误差系数,为非零的正常数;
定义跟踪误差函数e2为:
e2=x21 (10)
对具有跟踪误差e1的微陀螺仪子系统选取一个Lyapunov函数V1为:
Figure FDA0002705484270000022
对V1沿时间t求导得:
Figure FDA0002705484270000023
当e2=0,
Figure FDA0002705484270000024
满足负定性,保证系统是稳定的;
所述步骤三中,分数阶反演滑模控制律u1设计步骤包括:
针对微陀螺仪设计分数阶滑模面s为:
s=λ1e12Dα-1e13e2 (15)
其中,λ123为滑模系数,为正实数,Dα-1e1表示对e1求α-1阶导;
对具有跟踪误差e2的微陀螺仪子系统选取Lyapunov函数V2为:
Figure FDA0002705484270000025
根据Lyapunov函数V2设计分数阶反演滑模控制律u1为:
Figure FDA0002705484270000026
其中,
Figure FDA0002705484270000031
Figure FDA0002705484270000032
表示滑模切换项,用来代替系统不确定性和外界干扰总和d(t);
Figure FDA0002705484270000033
微陀螺仪系统是稳定的。
2.根据权利要求1中所述的一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:所述步骤二中:所述微陀螺仪系统的参考轨迹模型为:
xr=A1 sin(ω1t),yr=A2 sin(ω2t) (3)
其中xr、yr是指x轴、y轴两轴的参考轨迹模型;A1、A2分别是微陀螺仪在x轴、y轴方向上的振幅;ω1、ω2分别是微陀螺仪在x轴、y轴方向上给定的振动频率;t是时间变量。
3.根据权利要求1中所述的一种微陀螺仪的分数阶自适应反演模糊滑模控制方法,其特征在于:所述步骤三中,基于分数阶的自适应反演模糊滑模控制律u'设计步骤包括:
定义微陀螺仪无量纲化模型中估计误差分别为:
Figure FDA0002705484270000034
定义模糊系统自适应参数估计误差为:
Figure FDA0002705484270000035
Figure FDA0002705484270000036
是用来逼近滑模切换项
Figure FDA0002705484270000037
的模糊系统输出,θ*是模糊系统的最优参数,θ是模糊系统参数,
基于分数阶的自适应反演模糊滑模控制律u'为:
Figure FDA0002705484270000038
其中模糊系统输出
Figure FDA0002705484270000039
存在如下形式:
Figure FDA00027054842700000310
其中,
Figure FDA00027054842700000311
分别为微陀螺仪两轴的模糊系统输出,θ为模糊系统参数,Φ(s)T是与隶属度相关的函数;
将分数阶的自适应反演模糊滑模控制律u'作为微陀螺仪系统控制输入u,带入微陀螺仪系统的数学模型中,实现对微陀螺仪系统的跟踪控制;
定义第三个Lyapunov函数V为:
Figure FDA0002705484270000041
其中,r1是正常数,
Figure FDA0002705484270000042
表示微陀螺仪坐标轴模糊系统参数的估计误差,
Figure FDA0002705484270000043
代表x轴模糊系统参数估计误差,
Figure FDA0002705484270000044
代表y轴模糊系统参数估计误差,M=MT>0,N=NT>0,P=PT>0为对称正定矩阵,tr{·}表示矩阵的求迹运算,
Figure FDA0002705484270000045
分别为参数矩阵Db,K,Ω的参数估计误差;
为了保证Lyapunov函数的导数
Figure FDA0002705484270000046
在线实时估计微陀螺的系统参数,设计微陀螺仪参数矩阵Db,K,Ω的估计值
Figure FDA0002705484270000047
和模糊系统参数θi的自适应律分别为:
Figure FDA0002705484270000048
Figure FDA0002705484270000049
为陀螺仪系统阻尼矩阵Db的估计值的自适应律,
Figure FDA00027054842700000410
为陀螺仪系统的弹簧系数矩阵K的估计值的自适应律,
Figure FDA00027054842700000411
为陀螺仪角速度矩阵的估计值的自适应律,
Figure FDA00027054842700000412
是模糊系统参数自适应律;当选取上述参数自适应律时,
Figure FDA00027054842700000413
满足李雅普诺夫稳定性定理,保证微陀螺仪系统全局渐进稳定性。
CN201710992674.8A 2017-10-23 2017-10-23 微陀螺仪的分数阶自适应反演模糊滑模控制方法 Active CN107831655B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710992674.8A CN107831655B (zh) 2017-10-23 2017-10-23 微陀螺仪的分数阶自适应反演模糊滑模控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710992674.8A CN107831655B (zh) 2017-10-23 2017-10-23 微陀螺仪的分数阶自适应反演模糊滑模控制方法

Publications (2)

Publication Number Publication Date
CN107831655A CN107831655A (zh) 2018-03-23
CN107831655B true CN107831655B (zh) 2020-11-24

Family

ID=61648903

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710992674.8A Active CN107831655B (zh) 2017-10-23 2017-10-23 微陀螺仪的分数阶自适应反演模糊滑模控制方法

Country Status (1)

Country Link
CN (1) CN107831655B (zh)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108710296B (zh) * 2018-04-26 2021-06-01 河海大学常州校区 微陀螺仪的分数阶自适应快速终端滑模控制方法
CN109240083B (zh) * 2018-09-28 2021-10-01 河海大学常州校区 微陀螺仪系统的自适应模糊超扭曲滑模控制方法
CN109579873A (zh) * 2018-12-11 2019-04-05 中国航空工业集团公司北京长城计量测试技术研究所 一种基于模糊逻辑系统的环形激光器温度建模及补偿方法
CN110109353B (zh) * 2019-04-17 2022-01-11 杭州电子科技大学 一种反作用轮平衡自行车机器人模糊自适应滑模控制系统
CN110262242B (zh) * 2019-07-01 2022-03-15 河海大学常州校区 一种微陀螺仪自适应分数阶滑模控制方法
CN110389529B (zh) * 2019-07-18 2022-04-01 西北工业大学 基于平行估计的mems陀螺仪参数辨识驱动控制方法
CN110647036B (zh) * 2019-09-23 2022-04-22 河海大学常州校区 微陀螺仪自适应双反馈模糊神经网络分数阶滑模控制方法
CN111857172B (zh) * 2020-08-11 2023-03-28 东北电力大学 基于预设跟踪误差的四旋翼动态面积分滑模控制器
CN112181002B (zh) * 2020-09-15 2023-03-14 河海大学常州校区 微陀螺仪双递归扰动模糊神经网络分数阶滑模控制方法
CN112286055B (zh) * 2020-10-26 2022-08-26 贵州大学 无精确参考轨迹的分数阶mems陀螺仪加速自适应反演控制方法
CN113183710B (zh) * 2021-05-26 2022-07-01 华东理工大学 一种提升乘坐舒适性的主动悬架系统模糊控制方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016189285A1 (en) * 2015-05-22 2016-12-01 Cirrus Logic International Semiconductor Limited Adaptive receiver

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI334066B (en) * 2007-03-05 2010-12-01 Univ Nat Taiwan Science Tech Method of fuzzy logic control with combined sliding mode concept for ideal dynamic responses
CN102393639B (zh) * 2011-10-18 2015-04-22 河海大学常州校区 基于自适应模糊滑模的微陀螺仪追踪控制方法
WO2013182901A1 (en) * 2012-06-07 2013-12-12 Actiwave Ab Non-linear control of loudspeakers
CN103151781B (zh) * 2013-03-19 2014-12-10 河海大学常州校区 基于反馈线性化的有源电力滤波器自适应模糊控制方法
CN103324087B (zh) * 2013-06-19 2015-10-07 河海大学常州校区 基于神经网络的微陀螺仪的自适应反演控制系统及方法
CN103345155B (zh) * 2013-06-19 2015-12-09 河海大学常州校区 微陀螺仪的自适应反演控制系统及方法
TWM487575U (zh) * 2013-10-28 2014-10-01 Univ Nat Taipei Technology 切換式磁阻馬達之適應性模糊補償監督式滑動模式控制裝置
CN103728882B (zh) * 2014-01-07 2016-04-06 河海大学常州校区 微陀螺仪的自适应反演非奇异终端滑模控制方法
CN105045097B (zh) * 2015-05-26 2017-10-27 河海大学常州校区 一种基于神经网络的微陀螺仪反演全局滑模模糊控制方法
CN105204345A (zh) * 2015-10-22 2015-12-30 河海大学常州校区 一种自适应分数阶滑模控制方法
CN105610163B (zh) * 2016-01-20 2018-05-22 河海大学常州校区 基于分数阶的有源电力滤波器自适应模糊滑模控制方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016189285A1 (en) * 2015-05-22 2016-12-01 Cirrus Logic International Semiconductor Limited Adaptive receiver

Also Published As

Publication number Publication date
CN107831655A (zh) 2018-03-23

Similar Documents

Publication Publication Date Title
CN107831655B (zh) 微陀螺仪的分数阶自适应反演模糊滑模控制方法
CN108227504B (zh) 微陀螺分数阶自适应模糊神经反演终端滑模控制方法
CN108710296B (zh) 微陀螺仪的分数阶自适应快速终端滑模控制方法
Rahmani MEMS gyroscope control using a novel compound robust control
Fei et al. Adaptive fuzzy super-twisting sliding mode control for microgyroscope
Fei Robust adaptive vibration tracking control for a micro-electro-mechanical systems vibratory gyroscope with bound estimation
CN109240083B (zh) 微陀螺仪系统的自适应模糊超扭曲滑模控制方法
Wang et al. Trajectory tracking control of a 2-DOF manipulator using computed torque control combined with an implicit lyapunov function method
CN110703610B (zh) 微陀螺仪的递归模糊神经网络非奇异终端滑模控制方法
CN103345155B (zh) 微陀螺仪的自适应反演控制系统及方法
CN111258216A (zh) 一种适用于四旋翼飞行器的滑模重复控制器
Yu H∞ Tracking-based adaptive fuzzy-neural control for MIMO uncertain robotic systems with time delays
CN110262237B (zh) 基于双反馈模糊神经网络的微陀螺仪超扭曲滑模控制方法
CN115981162A (zh) 一种基于新型扰动观测器的机器人系统滑模控制轨迹跟踪方法
Zlotnik et al. Higher order nonlinear complementary filtering on lie groups
Izadi et al. Discrete-time rigid body attitude state estimation based on the discrete Lagrange-d'Alembert principle
CN110471293B (zh) 一种估计时变角速度的z轴陀螺仪滑模控制方法
CN109917645B (zh) 微陀螺双反馈模糊神经网络超扭曲滑模控制系统设计方法
Yan et al. Adaptive control of MEMS gyroscope based on global terminal sliding mode controller
Fei et al. Robust adaptive control for a MEMS vibratory gyroscope
Wu et al. Adaptive neural LMI-based H-infinity control for MEMS gyroscope
Fei et al. Robust neural network control of MEMS gyroscope using adaptive sliding mode compensator
CN110579966B (zh) 一种基于神经网络辨识参数的z轴陀螺仪控制方法
CN110426952B (zh) 考虑外界干扰的区间数据学习mems陀螺仪高精度驱动控制方法
CN114229039A (zh) 一种充液柔性航天器自适应无角速度复合控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant