法律状态公告日
法律状态信息
法律状态
2016-09-14
授权
授权
2015-02-04
实质审查的生效 IPC(主分类):G05B13/04 申请日:20140925
实质审查的生效
2015-01-07
公开
公开
技术领域
本发明涉及一种微陀螺仪自适应神经网络全局滑模控制方法,属于微陀螺仪控制技术领域。
背景技术
微陀螺仪是惯性导航和惯性制导系统的基本测量元件。因其在体积和成本方面的巨大优势,微陀螺仪广泛应用于航空、航天、汽车、生物医学、军事以及消费电子领域。但是,由于设计与制造中的误差存在和温度扰动,会造成原件特性与设计之间的差异,降低了微陀螺仪系统的性能。微陀螺仪本身属于多输入多输出系统并且系统参数存在不确定性以及易受外界环境的影响。补偿制造误差和测量角速度成为微陀螺仪控制的主要问题,有必要对微陀螺仪系统进行动态补偿和调整。
目前有将各种先进控制方法应用到微陀螺仪的控制当中,典型的有自适应控制和滑模控制方法。这些先进方法一方面补偿了制作误差引起的正交误差,另一方面实现了对微陀螺仪的轨迹控制。但自适应控制对外界扰动的鲁棒性很低,易使系统变得不稳定。
由此可见,上述现有的陀螺仪在使用上,显然仍存在有不便与缺陷,而亟待加以进一步改进。为了解决现有的陀螺仪在使用上存在的问题,相关厂商莫不费尽心思来谋求解决之道,但长久以来一直未见适用的设计被发展完成。
发明内容
本发明的目的在于,克服现有的微陀螺仪控制方法存在的缺陷,特别是提高微陀螺仪系统在存在模型不确定、参数摄动以及外界噪声等各种干扰,在消除系统抖振的情况下而不影响理想轨迹的追踪性能和整个系统的鲁棒性,提供一种微陀螺仪的自适应神经网络全局滑模控制方法。
本发明采用的技术方案是:
微陀螺仪的自适应神经网络全局滑模控制方法,包括如下步骤:
1)建立微陀螺仪的理想动力学方程;
2)根据旋转系中的牛顿定律建立微陀螺仪的无量纲动力学方程,并转化为状态空间形式;
3)建立微陀螺仪的神经网络全局滑模控制系统,基于神经网络全局滑模控制设计控制律,将其作为微陀螺仪的控制输入,对微陀螺仪进行控制,包括如下步骤:
3-1)定义跟踪误差e为
e=X-Xm (7)
X为微陀螺仪运动轨迹,Xm为微陀螺仪理想运动轨迹;
3-2)设计全局动态滑模面s为:
>
令>则s=Ce+fe(t)
其中,f(t)是为了达到全局滑模面而设计的函数,f(t)=f(0)e-kt,C为滑模系数,k为常数;
3-3)假设微陀螺仪的状态方程中不确定和外部干扰项fm(t)存在上界
>
其中,
3-4)设计神经网络全局滑模控制律
其中,K为参数矩阵K*的估计值,Am为微陀螺仪理想状态方程的系数矩阵,B为微陀螺仪状态方程的系数矩阵;
4)基于lyapunov函数理论,设计参数矩阵和神经网络权重向量的自适应律,使控制系统进行在线更新,确保自适应神经网络全局滑模控制系统的渐进稳定性。
前述的步骤1)中,微陀螺仪的理想动力学方程为:
xm=A1sin(w1t),ym=A2sin(w2t)
其中,xm、ym分别是微陀螺仪在x轴和y轴方向上的理想运动轨迹,w1、w2分别是微陀螺仪在x轴和y轴方向上的振动频率,w1≠w2,且都不为零,A1、A2分别为微陀螺仪在x轴和y轴方向上的振幅,t是时间;
写成向量形式为:
>
其中,>为理想运动轨迹,>
写成状态空间表达式为:
>
>
前述的步骤2)中,建立微陀螺仪的无量纲动力学方程具体为:
2-1)考虑到制造缺陷和加工误差,实际微陀螺仪的集总参数数学模型为:
>
>
式中,m是质量块的质量,x,y是质量块在微陀螺仪旋转系中的笛卡尔坐标;dxx,dyy分别是x轴和y轴的阻尼系数,kxx,kyy分别是x轴和y轴的弹簧系数,dxy,kxy分别是耦合的阻尼系数和耦合的弹簧系数,ux,uy是两轴的控制输入,Ωz是角速度,
2-2)取无量纲运动轨迹q*为
>
其中,>
>
2-3)为了计算方便,重新用q代替q*,用t代替t*,用D代替D*,用Q代替Q*,用u代替u*,用Ω代替Ω*,得到
>
q为微陀螺仪的运动轨迹,u为微陀螺仪的控制输入;
2-4)将模型(3)写成状态空间表达式为:
>
式中,>
2-5)考虑到系统参数不确定性和外部干扰,状态空间方程式(4)可表示为如下的形式:
>
其中,fm(t)是集总的不确定和外部干扰项。
前述的步骤3-3)中,不确定和外部干扰项的上界
前述的步骤3-4)中,参数矩阵K*满足:A+BK*T=Am。
前述的步骤4)中,
所述lyapunov函数V设计为:
>
其中,M为自适应增益,
所述参数自适应律为:>
所述神经网络权重向量自适应律为:
由上述技术方案可以看出本发明的有益效果在于:全局滑模控制是通过设计一种动态非线性滑模面方程来实现的,消除滑模控制的到达运动阶段,使系统在响应的全过程都具有鲁棒性,克服了传统滑模变结构控制中到达模态不具有鲁棒性的特点;神经网络可以克服非结构化的不确定性,消除滑模控制中存在的抖振;自适应控制可以估计出微陀螺仪的参数。本发明的自适应神经网络全局滑模控制综合利用自适应全局滑模控制和神经网络的优点,以降低各自的缺点,在简化滑模系数的选取,提高系统的瞬态特性和鲁棒性的前提下,消除了控制输入的抖振,使闭环控制系统具有了更好的动态性能;基于李雅普诺夫稳定性理论设计自适应律,实现了参数的在线更新,能够在任意初始值的情况下,保证系统的全局渐进稳定性。
附图说明
图1为本发明微陀螺仪的简化模型示意图;
图2为本发明自适应神经网络全局滑模控制系统的原理图;
图3为神经网络结构图;
图4为本发明实例中微陀螺仪X、Y轴的跟踪曲线;
图5为本发明实例中微陀螺仪X、Y轴的跟踪误差曲线;
图6为本发明实例中全局滑模面的动态曲线;
图7为本发明实例中自适应参数K随时间变化的关系曲线;
图8为本发明实例中角速度Ωz的自适应辨识过程曲线;
图9为本发明实例中采用自适应神经网络方法的全局滑模控制输入曲线;
图10为本发明实例中采用固定增益方法的全局滑模控制输入曲线。
具体实施方式
下面结合附图和具体实施方式,对本发明作进一步说明:
本发明的微陀螺仪自适应神经网络全局滑模控制系统如图2所示,本发明方法包括如下步骤:
1、根据旋转系中的牛顿定律建立微陀螺仪的无量纲动力学方程
微振动陀螺仪一般包含三个组成部分:被弹性材料所支撑的质量块,静电驱动装置和感测装置。静电驱动电路主要功能是驱动和维持微振动陀螺仪振动时幅值的恒定,感测电路用来感知质量块的位置和速度。微陀螺仪可以被简化为一个由质量块和弹簧构成的有阻尼振动系统。图1显示了在笛卡尔坐标系下简化的微振动陀螺仪模型。对z轴微陀螺仪而言,可以认为质量块被限制只能在x-y平面内运动,而不能沿z轴运动。实际上,由于制造缺陷和加工误差的存在,会造成x轴和y轴的附加动态耦合,如耦合的刚度系数和阻尼系数。考虑到制造误差,实际微陀螺仪的集总参数数学模型为:
>
式中,m是质量块的质量,x,y是质量块在旋转系中的坐标,dxx,dyy分别是x轴和y轴的阻尼系数,kxx,kyy分别是x轴和y轴的弹簧系数,dxy,kxy分别是耦合的阻尼系数和耦合的弹簧系数,合称为正交误差,ux,uy是两轴的控制输入,Ωz是角速度,
模型的无量纲化在设计分析时很有价值,在存在大的时间量级区别时,无量纲化也能使数值仿真容易实现。取无量纲运动轨迹q*为
>
其中,>
>
为了计算方便,重新用q代替q*,用t代替t*,用D代替D*,用Q代替Q*,用u代替u*,用Ω代替Ω*,得到
>
q为微陀螺仪的运动轨迹,u为微陀螺仪的控制输入;
将模型式(3)写成状态空间表达式为:
>
式中,>
2、建立微陀螺仪的理想对力学方程;具体为:微陀螺仪的理想动态特性是一种无能量损耗,两轴间无动态耦合的稳定正弦振荡,可以描述如下:
xm=A1sin(w1t),ym=A2sin(w2t)
其中,xm、ym分别是微陀螺仪在x轴和y轴方向上的理想运动轨迹,w1、w2分别是微陀螺仪在x轴和y轴方向上的振动频率,w1≠w2,且都不为零,A1、A2分别为微陀螺仪在x轴和y轴方向上的振幅,t是时间;
写成向量形式为:
>
其中,>为理想运动轨迹,>
状态空间表达式为:
>
>
3、考虑到系统参数不确定性和外部干扰(fm(t)是集总的不确定和外部干扰项),状态方程式(4)可表示为如下的形式:
>
假定1(匹配条件):存在正的常数
>
假定2:存在一个参数矩阵K*,总使得A+BK*T=Am方程满足。
由A+BK*T=Am得K*T=(BTB)-1BT(Am-A)
>
所以>
则微陀螺仪的各参数为:
>
>
>
4、建立微陀螺仪的神经网络全局滑模控制系统,设计控制律,将其作为微陀螺仪的控制输入,对微陀螺仪进行控制。
定义跟踪误差e为
e=X-Xm (7)
X为微陀螺仪运动轨迹,Xm为微陀螺仪理想运动轨迹。
设计全局动态滑模面s,使它所确定的滑动模态渐进稳定且具有良好的动态品质:
>
令>则s=Ce+fe(t)
其中,C为滑模系数。
f(t)是为了达到全局滑模面而设计的函数,f(t)满足以下3个条件:
(1)>
(2)t→∞时,f(t)→0
(3)f(t)具有一阶导数
其中,e0是跟踪误差的初始值。
所以可将f(t)设计为
f(t)=f(0)e-kt (9)
k为常数。
神经网络结构图如图3所示:
其中,RBF神经网络具有一种前向三层网络拓扑结构,输入层仅仅是信号接收层,不做任何信号处理。输入层的维数与具体信号的维数相关,如本发明中神经网络输入信号为x,它是四维向量,所以RBF网络输入层有四个节点。中间层是隐含层,实施信号的非线性映射作用,将信号从输入空间映射到更高维,信号特征线性可分的隐层空间。输出层作加权求和运算,产生RBF网络输出。本发明中x和y分别是神经网络的输入和输出,输出y为:y=ωTφ(x),其中,ω=[ω1,ω2...ωn]T为神经网络权重向量,φ(x)=[φ1(x),φ2(x)...φn(x)]T是高斯函数。
假设存在最优神经网络的权重向量ω*满足:
其中,ξ为神经网络映射误差,ξ1是正常数,
假设干扰上界
用RBF神经网络逼近不确定和外部干扰项的上界
>
设计神经网络全局滑模控制律
其中,K为参数矩阵K*的估计值。
5、基于lyapunov函数理论,设计参数矩阵和神经权重向量的自适应律,使控制系统进行在线更新,确保自适应神经网络全局滑模控制系统的渐进稳定性。
lyapunov函数V设计为:
>
其中,
对全局动态滑模面s求导,得到:
>
将神经网络全局滑模控制律
>
那么,lyapunov函数V的导数为:
>
选择参数自适应律:
>
选择权重向量自适应律:
其中,ω=[ω1,ω2...ωn]T是神经网络中的权重向量,ω*是最优权重向量,
则有:
>
因为η=ξ0-ξ1>0,所以
由此证明了微陀螺仪自适应神经网络全局滑模控制系统的稳定性。
最后,对本发明的自适应神经网络全局滑模控制方法进行仿真分析,选择一组微陀螺仪的参数如下:
m=1.8×10-7kg,kxx=63.955N/m,kyy=95.92N/m,kxy=12.779N/m
dxx=1.8×10-6Ns/m,dyy=1.8×10-6Ns/m,dxy=3.6×10-7Ns/m
假设输入角速度为ΩZ=100rad/s。参考长度选取q0=1μm,参考频率ω0=1000Hz,非量纲化后,各参数如下:
wxy=70.99,dxx=0.01,dyy=0.01,dxy=0.002,ΩZ=0.1
两轴微陀螺仪的理想轨迹为:xm=sin(6.17t),ym=sin(5.11t)
不确定项和外部干扰总量为[10*(sin(6.17*t);10*cos(5.11*t))]
函数f(t)=s(0)e-130t,
初始量X(0)=[0,0,0,0]T
K(0)=0.95K*,
K的真值为:
>
滑模系数取>自适应增益M=diag[100 100],
传统滑模控制律中,取固定增益ρ=diag[100 100]。
实验的结果如图4至图10所示,
图4为微陀螺仪X、Y轴的跟踪曲线,图中,虚线为理想参考轨迹,实现为实际运动轨迹,图5为跟踪误差曲线,从图中可以看出在有外部干扰的情况下微陀螺仪的轨迹能够很好的追踪上理想轨迹,两者之间的跟踪误差随时间变化逐渐收敛于0,说明该方法能很好的实现跟踪性能。全局滑模面的动态曲线如图6所示,可以看出滑模面逐渐收敛于0,表明系统在短时间内到达切换面并保持在滑模面上滑动。图7所示的是自适应参数K随时间变化的关系曲线,显示在一定时间内K收敛于常数,即它的真值K*,从而辨识出对象的未知参数。图8所示的就是角速度Ωz的自适应辨识过程曲线,虚线为非量纲化后的假定值,实线为实际角速度,从图中可以看出,实际值最终收敛到非量纲化后的假定值。图9、10分别为采用自适应神经网络全局滑模和固定增益方法的全局滑模控制输入曲线,比较可见采用固定增益的全局滑模滑模控制,控制量会出现较大的抖振,而采用自适应神经网络方法对控制器中的切换项进行逼近,可将切换项连续化,从而有效的降低了抖振。
机译: 振动的微结构和共振频率的控制方法以及使用该结构的微致动器和微陀螺仪
机译: 滑模控制方法及滑模控制装置
机译: 滑模控制方法及滑模控制装置