基于动态面的微陀螺自适应模糊滑模控制方法
【技术领域】
[0001] 本发明涉及一种基于动态面的微陀螺自适应模糊滑模控制方法。
【背景技术】
[0002] 微陀螺仪是测量惯性导航和惯性制导系统角速度的传感器，广泛应用于航空、航 天、航海和陆地车辆的导航与定位及油田勘探开发等军事、民用领域中。与传统陀螺仪相 比，微陀螺仪在体积和成本上有着巨大的优势，因此有着更加广阔的应用市场。但是，由于 生产制造过程中误差的存在和外界环境温度的影响，造成原件特性与设计之间的差异，导 致存在耦合的刚度系数和阻尼系数，降低了微陀螺仪的灵敏度和精度。另外，陀螺仪自身属 于多输入多输出系统，存在参数的不确定性且在外界干扰下系统参数容易波动，因此，降低 系统抖振成为微陀螺仪控制的主要问题之一。
【发明内容】
[0003] 针对上述问题，本发明提供一种基于动态面的微陀螺自适应模糊滑模控制方法， 具有抖振低、可靠性高、对参数变化鲁棒性高的优点。
[0004] 为实现上述技术目的，达到上述技术效果，本发明通过以下技术方案实现：
[0005] 基于动态面的微陀螺自适应模糊滑模控制方法，其特征在于，包括如下步骤：
[0006] 步骤一、建立微陀螺仪的数学模型：
[0007] 步骤二、利用模糊控制方法逼近微陀螺仪的动态特性和外界干扰之和；
[0008] 步骤三、基于动态面设计自适应模糊滑模控制器；
[0009] 步骤四、基于自适应模糊滑模控制器控制微陀螺仪。
[0010] 优选，步骤一中建立的微陀螺仪的数学模型为：
[0011]
[001 2]其中，X、y分别代表微陀螺仪在X、γ轴方向上的位移，dxx、'分别为X、Y轴方向弹簧 的弹性系数，kxx、kyy分别为X、Y轴方向的阻尼系数，dxy、k xy是由于加工误差等引起的耦合参 数，m为陀螺仪质量块的质量，Ωζ为质量块自转的角速度，u x、uy分别是X、Y轴的输入控制力， 形如f的参数表示Γ的一阶导数，形如f的参数表示Γ的二阶导数。
[0013] 对模型进行无量纲化处理得到无量纲化模型：
[0014] 等式两边同时除以m，并且使得
，
^则无量纲化模型为：
[0015]
[0016] 将模型改写成向量形式：
[0017]
[0018] 其中，u为动态面控制律，
，
* ，
[0019] 考虑系统参数不确定和外界干扰，模型可以写成：
[0020]
[00211其中AD，ΔΚ是参数扰动，d是外界干扰；
[0022] 将其写成状态方程形式为：
[0023]
[0024] 其中，qi = q，^=4;
[0025] 为了便于计算将定义q = xi，夺=%，xi、X2为输入变量；
[0026] 则状态方程变为如下式子：
[0027]
[0028]其中f为陀螺仪的动态特性与外界干扰之和，且：
[0029] f = -(D+ Δ D+2 Ω )χ2-(Κ+ Δ K)xi+d〇
[0030] 优选，步骤二中引入模糊原理，用/来逼近f，采用单值模糊化，乘机推理机中心平 均反模糊化，步骤二具体包括如下步骤：
[0031] 假设模糊系统由N条模糊规则构成，第i条模糊规则R1的表达形式为：
[0032] R1: If X, is /4 and ··*. xk is /4.， then m. is ff :(i = 1,2,...,.,,,M)
[0033] 其中，Xj(j = l，2,.......，n)为输入变量，/4为Xj(j = l，2,.......，n)的隶属度 函数，即为/<(\);
[0034] 则模糊系统的输出?为：
[0035] n J-'-
η
[0036] 其中ξΑ为模糊基向量，
/=1 J-Y
为自适应向量为么的转置；
[0037] 针对f的模糊逼近，采用分别逼近fx和fy的形式，fx，fy分别为陀螺仪x、y轴的动态 特性和外界干扰的和，相应的模糊系统设计为：
[0038]
[0039] 定义模糊函数为如下形式：
[0040]
[0041]其中
分别为
?勺转置；
[0042]定义最优逼近常量：
[0043]
[0044] 式中，〇￡是|的集合，arg为复数的辐角运算函数，sup为上确界运算函数；
[0045] 定义：为模糊输出误差，
[0046] 贝1J:
[0047] …
[0048]
[0049] ε是模糊系统的逼近误差，对于给定的任意常量ε(ε>0)，如下不等式成立：
，并且使得
，其中η为大于零的常数。
[0050] 优选，步骤三具体包括如下步骤：
[0051] 定义位置误差
[0052] zi = xi-xid
[0053] 其中xld为指令信号，则
[0054] ζ{=χχ-χια
[0055] 定义Lyapunov函数为
，其中？f为ζι的转置，贝lj
[0056]
[0057] 为保证
，引入％为义2的虚拟控制量，定义
[0058] x2： = ~^ι^ι +
[0059] C1为大于0的常数；
[0060] 为了克服微分爆炸的现象，引入了低通滤波器：
[0061] 取<^为低通滤波器
关于输入为S时的输出，
[0062] 并满足：
[0063] 其中τ为滤波器的时间常数，为大于0的常数，Ql为低通滤波器的输出，α?(0)、5(〇) 分别为α 1与f2:的初始值：
[0064]
[0065]所产生的滤波误差为 [0066]
[0067] 虚拟控制误差:Ζ2 = Χ2_αι，则
[0068] 为了补偿由于模糊逻辑控制器引入所带来的误差，引入滑模项对此误差进行补 偿，其中滑模面定义为:S = Ζ2 ;
[0069] 定义第二个Lyapunov函数
，其中
的转置，
[0070] 为了保证
，控制器的动态面控制律设计 为：
，n与C2为大于零的常数；
[0071] 此时我们用模糊函数输出/去逼近陀螺仪的动态特性f，则更新的控制律为：
[0072]
[0073] 基于上述设计，本发明的原理是：将基于动态面的自适应模糊滑模控制方法应用 到微陀螺仪当中，设计一个带噪声的近似理想的微陀螺仪动态模型，作为系统参考轨迹，整 个基于动态面的自适应模糊滑模控制保证实际微陀螺仪轨迹追踪上参考轨迹，达到一种理 想的动态特性，补偿了制造误差和环境干扰，降低系统的抖振。根据微陀螺仪本身参数以及 输入角速率，设计一个参数可调的动态面控制器和自适应模糊控制器，以系统的追踪误差 信号作为控制器的输入信号，任意设定控制器参数的初值，保证追踪误差收敛于零，同时所 有参数估计值收敛于真值。
[0074] 本发明的有益效果是：
[0075]系统能以很快的速度达到稳态，微陀螺仪的动态特性是一种理想模式，补偿了制 造误差和环境干扰。基于动态面方法设计的算法减少了引入的参数、简化了计算程度、降低 了抖振。自适应模糊滑模控制能够补偿系统设计参数的误差与外界的干扰，提高系统的有 效性。
【附图说明】
[0076]图1是本发明微陀螺仪的简化模型示意图；
[0077]图2是本发明原理图；
[0078]图3是本发明具体实施例中误差的时域响应曲线图；
[0079]图4是本发明的具体实施例中X轴控制力的时域响应曲线图；
[0080] 图5是本发明的具体实施例中y轴控制力的时域响应曲线图。
【具体实施方式】
[0081] 下面结合附图和具体的实施例对本发明技术方案作进一步的详细描述，以使本领 域的技术人员可以更好的理解本发明并能予以实施，但所举实施例不作为对本发明的限 定。
[0082] 基于动态面的微陀螺自适应模糊滑模控制方法，包括如下步骤：
[0083] 步骤一、建立微陀螺仪的数学模型：
[0084]步骤二、利用模糊控制方法逼近微陀螺仪的动态特性和外界干扰之和