法律状态公告日
法律状态信息
法律状态
2019-06-04
未缴年费专利权终止 IPC(主分类):G05B13/04 授权公告日:20151028 终止日期:20180619 申请日:20130619
专利权的终止
2015-10-28
授权
授权
2013-11-06
实质审查的生效 IPC(主分类):G05B13/04 申请日:20130619
实质审查的生效
2013-10-02
公开
公开
技术领域
本发明涉及一种微陀螺仪的控制方法,特别涉及一种基于角速度估计的自适应模糊滑模 控制方法。
背景技术
微陀螺仪是测量角速度的传感器,因其在结构、体积、成本方面的优势而广泛应用在航 空、航海生物医药、汽车、军事和消费电子产品等领域中。但是,由于生产制造过程中的误 差存在和环境温度的影响,造成原件特性与设计之间的差异,导致存在耦合的刚度系数和阻 尼系数,降低了微陀螺仪的灵敏度和精度。此外,陀螺仪本身属于多输入多输出系统,存在 参数的不确定性和外界干扰对系统参数的造成的波动。所以补偿制造误差和外界干扰成为微 陀螺仪控制的主要问题。
传统的模糊控制器设计不依靠被控对象的模型,但它却非常依靠控制专家或操作者的经 验知识,不便于控制参数的学习和调整,且难以保证控制系统的稳定性。自适应模糊控制则 是具有自适应学习算法的模糊逻辑系统,其学习算法是依靠数据信息来调整模糊逻辑系统的 参数,且可以保证控制系统的稳定性,但这些控制方案都是用误差和误差变化率作为模糊输 入变量,所以在实际中需要较多的模糊规则。而模糊滑模控制是用滑模面作为模糊输入变量, 可以大大的减少模糊规则。
发明内容
本发明是为避免参数不确定性和外界干扰对三轴微陀螺仪控制系统的影响,提供了一种 基于角速度估计的自适应模糊滑模控制方法,该自适应模糊滑模控制方法可以补偿参数不确 定性和环境干扰,并且正确估计出角速度和有效的降低传统滑模控制方法中的抖振现象。 为达到上述技术目的,本发明采用的技术方案为:
微陀螺仪基于角速度估计的自适应模糊滑模控制方法,包括以下步骤
1)建立微陀螺仪无量纲动态方程;
2)建立微陀螺仪的参考模型;
3)设计基于角速度估计的自适应模糊滑模控制器,具体为
3-1)设计等效控制器,对滑模切换面S求导,令不考虑不确定性和外加干扰, 得到等效控制力ueq,ueq=K*TX-(CB)-1CAme
其中,
X为微陀螺仪的轨迹状态,Xm为参考模型的轨迹状态
e为跟踪误差,满足e=X-Xm
S为滑模切换面函数,满足S=Ce,C为滑模系数
A和B为微陀螺仪状态方程的状态参量,Am为参考模型状态方程的状态参量;
3-2)考虑到所述等效控制力ueq中,K*未知,用K*的估计值K代替K*,自适应调节K 的参数,并增加切换控制器,
得到自适应滑模控制律φ,φ=ueq+usw=KTX-(CB)-1CAme-fsgn(S)
其中,ueq=KTX-(CB)-1CAme为等效控制器的输出;usw=-fsgn(S)为切换控制 器的输出,实现对不确定性和外加干扰的鲁棒控制,f为固定增益,是系统本身的不确定性 和外加干扰总量fm的上界值;
3-3)基于Lyapunov函数,设计等效控制器中的自适应参数K的自适应律,实现系统 参数和角速度的自适应辨识,保证整个闭环系统的全局渐进稳定性,
Lyapunov函数V1为,
自适应律为,
其中,估计误差满足M为对称正定矩阵;
3-4)由于fm未知,利用自适应模糊控制,设计切换控制器,使其输出usw满足, 用自适应模糊系统的输出逼近切换控制器的固定增益值f,这样,切换 控制器的输出变为则得到自适应模糊滑模控制律为:
其中,
3-5)基于Lyapunov函数,设计切换控制器中的可变参数的自适应律实现对外 部扰动的鲁棒性,保证整个闭环系统的全局渐进稳定性,
Lyapunov函数V2为,
自适应律为,
其中,η,λi2为正常数,可变参数的估计误差满足为最优可变参 数。
前述步骤1),具体为,
1-1)假设三轴微陀螺仪在x轴、y轴和z轴三个方向上分别以匀速的角速度旋转,离 心力忽略不计,则三轴微陀螺仪的动态方程的微分形式为
其中,m是质量块的质量,
1-2)将上述方程进行非量纲化处理,得到三轴微陀螺仪的无量纲动力学方程的微分形 式
其中,
忽略符号表示的不同,重新用q代替q*,用D代替D*,用Ω代替Ω*,用u代替u*, 得到
将所述方程(3)作为三轴微陀螺仪的无量纲动力学方程
1-3)将所述步骤1-2)中的微分方程(3)写成状态方程的形式
其中:
1-4)考虑到系统存在外来的干扰和系统本身的不确定性,引入不确定性因子和外来的 干扰项,系统的状态方程可表示为如下的形式
其中fm=EX+G,fm为系统本身的不确定性和外加干扰总量,
函数E(t)和G(t)满足
d(t)=BG(t),ΔA(t)=BE(t)
d(t)为外来的干扰,ΔA为系统的不确定性因子。
前述步骤2),微陀螺仪的参考模型选择三轴间无动态耦合的稳定正弦振荡,描述为:
其中,xm、ym、zm分别为参考模型在x轴、y轴和z轴方向上的位置向量,A1、A2、A3分别为参考模型在x轴、y轴和z轴方向上给定的振幅,ω1、ω2、ω3分别为参考模型在x轴、 y轴和z轴方向上给定的振动频率,t是时间变量,
写成状态方程形式:
其中:
通过采用上述技术手段,本发明的有益效果是,本发明利用自适应模糊控制方法和模糊 滑模控制方法各自的优点,可以与自适应模糊控制一样自动调整模糊规则,通过动态自适应 律来产生令人满意的系统响应,并且可以如模糊滑模控制一样显著地减少模糊规则的数量; 系统达到稳态后,该方法具有良好的跟踪性能;设计的自适应辨识方法可以辨识出微陀螺仪 的角速度和其它系统参数;基于Lyapunov方法设计的自适应算法能够保证整个闭环系统的 全局渐进稳定性;由于对固定增益进行模糊逼近,明显的减少了抖振。
附图说明
图1为本发明的微陀螺仪基于角速度估计的自适应模糊滑模控制系统结构框图;
图2为本发明的具体实施例中微陀螺仪X、Y、Z轴方向上的跟踪曲线图;
图3为本发明的具体实施例中滑模面的动态曲线图;
图4为本发明的具体实施例中自适应参数K中的子变量K1随时间变化的曲线图;
图5为本发明的具体实施例中自适应参数K中的子变量K2随时间变化的曲线图;
图6为本发明的具体实施例中自适应参数K中的子变量K3随时间变化的曲线图;
图7为本发明的具体实施例中微陀螺仪X、Y、Z轴三个方向上角速度Ωx,Ωy,Ωz的 自适应辨识过程曲线图;
图8为本发明的具体实施例中采用固定增益的传统滑模控制方法的控制输入曲线图;
图9为本发明的具体实施例中采用自适应模糊滑模控制方法的控制输入曲线图;
具体实施方式
下面结合附图和具体实施方式详细说明本发明。
微陀螺仪基于角速度估计的自适应模糊滑模控制方法,包括以下几个部分
一、建立三轴微陀螺仪的无量纲动态方程
对三轴微陀螺仪而言,可以认为质量块可在空间内运动。假设三轴微陀螺仪可在x轴、 y轴和z轴三个方向上分别以匀速的角速度旋转,离心力可忽略不计,则三轴微陀螺仪的动 态方程如下所示为:
其中:m是质量块的质量,dxy、dxz、dyz是非对称的阻尼项,dxx、dyy、dzz分别是 x,y,z轴方向上的阻尼项,kxx、kxy、kxz、kyy、kyz、kzz是系统的弹簧系数, Ωx、Ωy、Ωz分别是x,y,z轴方向上的角速度,ux、uy、uz分别是x,y,z轴方 向上的控制输入。
方程两边同除以质量m,等效变换为微分方程形式如下:
其中:
式(2)表示的微陀螺仪的微分方程是一种有量纲形式,即式中的各个物理量不仅要考 虑数值大小,还要顾及各物理量单位的一致性,因此增加了控制器设计的复杂度。所以有必 要对三轴微陀螺仪的数学模型进行非量纲化处理。因为时间t*=ω0t是无量纲的,方程两边 同除以参考频率ω02和参考长度q0,得到三轴微陀螺仪的无量纲运动方程的微分形式:
式中,各无量纲变量的表达式为:.
忽略符号表示的不同,重新用q代替q*,用D代替D*,用Ω代替Ω*,用u代替u*, 得到
将方程(3)作为三轴微陀螺仪的无量纲动力学方程
式(3)写成状态方程形式为
其中:
假设系统存在外来的干扰和系统本身的不确定性,其状态方程可表示为如下的形式
式中:ΔA为系统的不确定性因子,d(t)为外来的干扰。
假定存在匹配条件:存在函数E(t)和G(t)使得下列条件满足:
d(t)=BG(t),ΔA(t)=BE(t) (6)
由上式假定,式(5)可写为:
其中:fm=ΕX+G,fm为系统本身的不确定性和外加干扰总量。
假定存在有界条件:存在正定矩阵f=diag[f1 f2 f3],使得系统本身的不确定性和 外来干扰总量fm满足上界条件|fmi|<fi,i=1,2,3。
假定存在一个常数矩阵K*,总使得A+BK*T=Am方程满足。
其中
通过上式的等式变换,矩阵K*T中包含了被控对象的所有系统参数、三个轴的输入的 角速度和参考模型的三个振动频率。通过对K*T进行估计,设计其自适应律,就可以从中 计算出各个微陀螺仪参数和角速度。
二、建立微陀螺仪的参考模型
系统的参考模型选择三轴间无动态耦合的稳定正弦振荡,可以描述如下为:
xm=A1sin(ω1t),ym=A2sin(ω2t),zm=A3sin(ω3t)
其中,xm、ym、zm分别为参考模型在x轴、y轴和z轴方向上的位置向量,A1、A2、 A3分别为参考模型在x轴、y轴和z轴方向上给定的振幅,ω1、ω2、ω3分别为参考模型 在x轴、y轴和z轴方向上给定的振动频率,t是时间变量,
也可以写成状态空间方程形式:
其中:
三、设计基于角速度估计的自适应模糊滑模控制器
三轴微陀螺仪自适应模糊滑模控制系统的结构框图如图1所示。
定义状态变量的跟踪误差e为:
e=X-Xm (9)
对其求导得:
定义滑模切换面函数S为:
S=Ce (11)
其中:S=[s1 s2 s3]T,C为滑模系数,
对S求导得:
令不考虑不确定性和外加干扰fm,可推导出等效控制力ueq
ueq=K*TX-(CB)-1CAme (13)
将微陀螺仪的所有参数以及角速率都看作未知的变量时,A的参数就未知,即K*未知, 则控制力ueq就难于用于实际的应用中。所以,我们有必要设计新的控制律,以适应实际的 工程应用。
用K*的估计值K代替K*,自适应调节K的参数,考虑不确定性和外加干扰,增加切换 控制器,设计新的自适应滑模控制律φ为:
φ=ueq+usw=KTX-(CB)-1CAme-fsgn(S) (14)
其中,固定增益f是系统本身的不确定性和外加干扰总量fm的上界值, ueq=KTX-(CB)-1CAme为等效控制器的输出,usw=-fsgn(S)为切换控制器的输出,实 现对不确定性和外加干扰的鲁棒控制。
将自适应滑模控制律φ作为微陀螺仪的控制输入代入式(12)可以得到:
其中:估计误差
基于Lyapunov函数,设计等效控制器中的自适应参数K的自适应律,
定义Lyapunov函数V1为
其中:M=MT>0为对称正定矩阵,tr(A)表示矩阵A的迹。
对Lyapunov函数V1求导得
因为是标量,所以
再结合矩阵迹的几个性质:
tr(A+B)=tr(A)+tr(B)
tr(AB)=tr(BA)
tr(A)=tr(AT)
tr(αA)=αtr(A)
于是将式(15)代入式(17)得到:
为使得则令前两项之和等于0,所以采用以下的自适应律
对于K(t)的初始值K(0),可以任意设定。
定义自适应律后,式(18)变为:
λi2为正常数
因为所以Lyapunov函数中的所有参数都是有界的。根据Barbalat定理及其推 论,我们可以得到limt→∞si=0,i=1,2,3,limt→∞K=K*,收敛到真值,从而实现参数 和角速度的自适应辨识。
当K收敛到真值K*时,根据假定3中K*的表达式:
则可以计算出微陀螺仪的各参数值和角速度的值为:
dxx=k12,dyy=k24,dzz=k36,ωxy=k13=k21,ωyz=k25=k33,ωxz=k15=k31, ωx2=ω12+k11,ωy2=ω22+k23,ωz2=ω32+k35,
考虑到fm未知时,固定增益f的值很难确定,如果选择过小的话,可能不足以消除不 确定项fm的影响,从而不能保证系统运动到达滑模面,而造成系统不稳定;如果选择过大 的话,会造成比较大的抖振。所以在参数辨识的基础上增加自适应模糊控制,通过将滑模控 制项中的固定增益进行连续的有效的估计,从而有效的降低抖振。
重新设计切换控制器,采用自适应模糊系统的输出来逼近固定增益f,将代替f代 入到式(14)中,则得到自适应模糊滑模控制律为:
其中:为f的估计值,
采用乘积推理机、单值模糊器和中心平均解模糊器对模糊控制进行反模糊化,则自适应 模糊系统的输出为:
其中:为的子变量,可变参数为模糊向量ξi为 ξi=[ξi1,ξi2,...,ξim]T,μA(si)为滑模切换面函数的隶属函数,i=1,2,3,sgn(·)为符号函 数。
根据万能逼近定理,会存在一个最优的模糊控制系统输出f*来逼近固定增益f,使得逼 近误差最小,表达式为:
f*=f+ε=αi*Tξi (25)
其中:ε为逼近误差,α*i为最优可变参数。
最优可变参数定义为:
其中:Ωα为的集合。
基于Lyapunov函数,设计切换控制器中的可变参数的自适应律
Lyapunov函数V2为:
其中:M=MT>0为对称正定矩阵,tr(A)表示矩阵A的迹,为各个可变参 数子变量的估计误差,i=1,2,3,η为正常数。
对两边求导得:
λi2为正常数
为了使令后面两项之和等于0,则得到自适应律为
其中i=1,2,3
则
因为根据Barbalat定理及其推论,我们可以得到limt→∞si=0,i=1,2,3,
最后,进行数值仿真计算
根据上述自适应模糊滑模控制算法,在MATLAB/Simulink中对微陀螺仪控制系统进行数 值仿真。三轴微陀螺仪参数如下:
m=0.57×10-8kg,q0=1μm,ω0=3kHz,dxx=0.429×10-6N·s/m,
dyy=0.687×10-6N·s/m,dzz=0.895×10-6N·s/m,
dxy=0.0429×10-6N·s/m,dxz=0.0687×10-6N·s/m,
dyz=0.0895×10-6N·s/m,kxx=80.98N/m,kyy=71.62N/m,
kzz=60.97N/m,kxy=5N/m,kxz=6N/m,kyz=7N/m。
假定未知的输入角速度为:
Ωx=3rad/s,Ωy=2rad/s,Ωz=5rad/s。
非量纲化后,各轴角速度参数如下:
Ωx=0.001,Ωy=0.000667,Ωz=0.00167
参考轨迹选择如下:
xm=sin(6.71t),ym=1.2sin(5.11t),zm=1.5sin(4.17t)
定义滑模切换面函数S的3种隶属函数为:
μNM(s)=1/(1+exp(5(s+3))),
μZO(s)=exp(-s2),μPM(s)=1/(1+exp(5(s-3)))
假定不确定性和外加干扰总量为:
fm(t)=[10sin(6.71t) 10cos(5.11t) 10cos(4.17t)]T
被控对象的初始状态取X0=[0 0 0 0 0 0],K的真值计算为
仿真结果如图2-9所示。
图2为微陀螺仪X、Y、Z轴方向上的跟踪曲线,结果表明有外部干扰的情况下微陀螺仪 的X、Y、Z轴轨迹能够很好的追踪上参考轨迹,说明该方法能很好的实现跟踪性能。
图3为滑模面的动态曲线图,结果表明系统在短时间内到达切换面并保持在滑模面上滑 动,滑模面逐渐收敛于0。
图4至图6为自适应参数K中的子变量随时间变化的关系曲线,结果表明在一定时间 内K的各个变量逐渐收敛于常数值,可以辨识出它的真值K*中的各个变量值,通过计算就 可以计算出微陀螺仪系统的未知参数。
图7为微陀螺仪X、Y、Z轴三个方向上角速度Ωx,Ωy,Ωz的自适应辨识过程曲线图, 结果表明它们都能够收敛到各自的非量纲化后的假定值。
图8为采用固定增益的传统滑模控制方法的控制输入曲线图,结果表明其控制量会出现 比较大的抖振。
图9为采用自适应模糊滑模控制方法的控制输入曲线图,结果表明采用自适应模糊方法 对控制器中的切换项增益进行逼近,可有效的降低抖振。
具体实施例的结果显示,本发明设计的自适应模糊滑模控制方法,能够使跟踪误差和滑 模函数很快地收敛到零,具有良好的跟踪性能,能够正确地辨识出角速度,而且对参数变化 和外部扰动具有鲁棒性,同时能够明显的改善传统滑模控制方法中的抖振现象。
以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上的限制,虽然本 发明已以较佳实施例揭露如上,然而并非用以限定本发明,任何熟悉本专业的技术人员,在 不脱离本发明技术方案范围内,当可利用上述揭示的技术内容作出些许更动或修饰为等同变 化的等效实施例,但凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施 例所作的任何简单修改、等同变化与修饰,均仍属于本发明技术方案的范围内。
机译: u0434 u0432 u0443 u0445 u043a u043e u043e u0440 u0434 u0438 u043d u0430 u0442 u043d u044b u0439基于 u0442 u0440 u0435 u0445 u0441 u0442 u0435 u043f u0435 u043d u043d u043e u0433 u043e陀螺仪和配置方法 u0434 u0432 u0443 u0445 u043a u043e u043e u0440 u0434 u0438 u043d u0430 u0442 u043e u043e u0433 u043e基于 u0442 u0440 u0435 u0445 u0441 u0442 u0435 u043f u0435 u043d u043d u043d u043e u0433 u043e陀螺仪的传感器角速度
机译: 基于三轴陀螺仪传感器输出值导出角速度的角速推导装置和角速度推导方法
机译: 基于使用陀螺仪传感器和/或MEMS角速度传感器(MEMS陀螺仪)的系统的应用来确定车轮对准的方法和系统