一种基于ADRC的微机械陀螺幅值控制系统技术方案

一种基于ADRC的微机械陀螺幅值控制系统，包括微机械陀螺，微机械陀螺分别通过频率控制回路和幅值控制回路控制，所述频率控制回路中使用锁相环为微机械陀螺提供正弦驱动信号，使陀螺做简谐振动；所述幅值控制回路中使用自抗扰控制来稳定微机械陀螺输出信号的幅值；两个回路皆采用闭环控制。本发明专利技术提高微机械陀螺输出信号的幅值稳定性以及稳定性。出信号的幅值稳定性以及稳定性。出信号的幅值稳定性以及稳定性。

【技术实现步骤摘要】
一种基于ADRC的微机械陀螺幅值控制系统


[0001]本专利技术涉及微机械陀螺
，特别涉及一种基于ADRC的微机械陀螺幅值控制系统。

技术介绍

[0002]微机械陀螺是惯性导航系统与惯性仪表的核心部件，在战略武器中占有及其重要的地位，且在战术武器中的应用也日益广泛，以陀螺为核心组成的各种系统和设备已被广泛用于航海，航空航天，陆地和兵器等导航领域。
[0003]现阶段微机械陀螺幅值控制系统中主要使用自动增益控制，该控制算法是基于PID控制方法的一种控制方法，该方法在控制幅值时由于比例系数的关系，会产生超调，超调与快速性不可兼得，若系统响应快则系统超调就会变大，若想要系统超调变小，那么系统的快速性将会降低。

技术实现思路

[0004]为了克服上述现有技术的不足，本专利技术的目的在于提供一种基于ADRC的微机械陀螺幅值控制系统，旨在提高微机械陀螺输出信号的幅值稳定性。
[0005]为了实现上述目的，本专利技术采用的技术方案是：
[0006]一种基于ADRC的微机械陀螺幅值控制系统，包括微机械陀螺，微机械陀螺分别通过频率控制回路和幅值控制回路控制，所述频率控制回路中使用锁相环为微机械陀螺提供正弦驱动信号，使陀螺做简谐振动；
[0007]所述幅值控制回路中使用自抗扰控制来稳定微机械陀螺输出信号的幅值；
[0008]两个回路皆采用闭环控制。
[0009]所述频率控制回路通过锁相环为微机械陀螺提供正弦驱动信号，所述锁相环回路包含鉴相器、环路滤波器和压控振荡器；<br/>[0010]所述鉴相器用于判断微机械陀螺输出信号与输入信号的相位差；
[0011]环路滤波器根据鉴相器输出误差，输出控制电压，控制压控振荡器的输出频率；
[0012]压控振荡器为电压控制器件，根据输入电压的大小调整输出信号的频率。
[0013]所述微机械陀螺频率控制回路工作方式为：
[0014]第一步，压控振荡器产生一定范围内的驱动信号，使微机械陀螺进入谐振工作范围；
[0015]第二步，微机械陀螺的输出信号与压控振荡器的输出信号通过鉴相器，鉴相器输出两个信号的相位差信号，并将该信号输入至环路滤波器；
[0016]第三步，环路滤波器根据输入的误差信号，输出一个控制信号，调整压控振荡器的输出信号频率，以此往复，最终频率控制回路输出频率达到微机械陀螺的工作频率，使微机械陀螺工作在谐振频率。
[0017]所述幅值控制回路使用自抗扰控制来稳定微机械陀螺输出信号幅值，所述幅值控
制回路中包含跟踪微分器、误差反馈控制模块和扩张状态观测器模块；
[0018]所述跟踪微分器事先安排过渡过程，提取含有随机噪声的输入信号及其微分信号，解决PID超调性、快速性之间的矛盾；
[0019]所述误差反馈控制模块根据反馈的误差信号输出控制信号使控制对象(微机械陀螺)工作在期望的状态；
[0020]所述扩张状态观测器模块用于估计系统内外扰动的实时作用值，并在反馈中给予补偿，用补偿的方法消除扰动的影响。
[0021]所述自抗扰控制具体算法如下：
[0022]跟踪微分器；
[0023]fh＝fhan(x1(k)
‑
v(k),x2(k),r0,h0)
[0024]x1(k+1)＝x1(k)+h*x2(k)
[0025]x2(k+1)＝x2(k)+h*fh
[0026]其中：x1跟踪输入信号，x2为x1的导数，h为采样时间，r0，h0为函数控制参量，v(k)为输入信号；
[0027]其中fhan为最速综合函数，其表达式为：
[0028][0029]式中参数计算方法为：
[0030][0031]a0＝h0x2[0032]y＝x1+a0[0033][0034][0035][0036]a＝(a0+y
‑
a2)s
y
+a2[0037][0038]本例中取h0＝0.01，r0＝1，v(k)＝1，h＝0，01。
[0039]式中：r0，h0为函数控制参量，x1，x2为系统状态，sign函数为符号函数当x&gt;0,sign(x)＝1；当x＝0,sign(x)＝0；当x&lt;0,sign(x)＝
‑
1。
[0040]所述扩张状态观测器模块具体算法为：
[0041]ε1＝z1(k)
‑
y(k)
[0042]z1(k+1)＝z1(k)+h[z2(k)
‑
β
01
ε1][0043][0044][0045]其中：fal(x,a,δ)为非线性函数：
[0046][0047]误差反馈控制：
[0048]e1＝v1‑
z1[0049]e2＝v2‑
z2[0050]u0＝fhan(e1,e2,r,h1)
[0051]u＝(u0‑
z3)/b0[0052]本例中取b0＝2，h1＝0.01，r＝1。
[0053]式中：z1，z2，z3分别为观测到的原系统的三个状态，ε1为观测值与输出的误差值，β
01
，β
02
，β
03
为可扩张状态观测器针对不同系统的可调参数，e1，e2为系统观测误差，u0为误差反馈控制输出，u为系统控制输入。
[0054]本专利技术的有益效果：
[0055]本专利技术使用ADRC控制算法对微机械陀螺的输出幅值进行控制，所述跟踪微分器事先安排过渡过程，提取含有随机噪声的输入信号及其微分信号，解决PID超调性、快速性之间的矛盾；所述误差反馈控制模块根据反馈的误差信号输出控制信号使控制对象(微机械陀螺)工作在期望的状态；所述扩张状态观测器模块用于估计系统内外扰动的实时作用值，并在反馈中给予补偿，用补偿的方法消除扰动的影响。
附图说明
[0056]图1为基于ADRC的微机械陀螺驱动装置结构示意图。
[0057]图2为频率控制回路结构示意图。
[0058]图3为幅值控制回路结构示意图。
[0059]图4为跟踪微分器输入输出结果图。
[0060]图5为基于自动增益控制与自抗扰控制的幅值稳定系统仿真结果对比图。
具体实施方式
[0061]下面结合实施例对本专利技术作进一步详细说明。
[0062]在本实施例中，如图1所示中微机械陀螺是控制对象，频率控制回路中使用锁相环为微机械陀螺提供正弦驱动信号，使陀螺做简谐振动。幅值控制回路中使用自抗扰控制来稳定微机械陀螺输出信号的幅值。两个环路皆采用闭环控制。
[0063]在本实施例中，如图2所示中频率控制回路使用的是锁相环为微机械陀螺提供正弦驱动信号，其中锁相环回路包含：1、鉴相器，用于判断微机械陀螺输出信号与输入信号的相位差。2、环路滤波器，根据鉴相器输出误差，输出控制电压，控制压控振荡器的输出频率。3、压控振荡器，压控振荡器为电压控制器件，可根据本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于ADRC的微机械陀螺幅值控制系统，其特征在于，包括微机械陀螺，微机械陀螺分别通过频率控制回路和幅值控制回路控制，所述频率控制回路中使用锁相环为微机械陀螺提供正弦驱动信号，使陀螺做简谐振动；所述幅值控制回路中使用自抗扰控制来稳定微机械陀螺输出信号的幅值；两个回路皆采用闭环控制。2.根据权利要求1所述的一种基于ADRC的微机械陀螺幅值控制系统，其特征在于，所述频率控制回路通过锁相环为微机械陀螺提供正弦驱动信号，所述锁相环回路包含鉴相器、环路滤波器和压控振荡器；所述鉴相器用于判断微机械陀螺输出信号与输入信号的相位差；环路滤波器根据鉴相器输出误差，输出控制电压，控制压控振荡器的输出频率；压控振荡器为电压控制器件，根据输入电压的大小调整输出信号的频率。3.根据权利要求1所述的一种基于ADRC的微机械陀螺幅值控制系统，其特征在于，所述微机械陀螺频率控制回路工作方式为：第一步，压控振荡器产生一定范围内的驱动信号，使微机械陀螺进入谐振工作范围；第二步，微机械陀螺的输出信号与压控振荡器的输出信号通过鉴相器，鉴相器输出两个信号的相位差信号，并将该信号输入至环路滤波器；第三步，环路滤波器根据输入的误差信号，输出一个控制信号，调整压控振荡器的输出信号频率，以此往复，最终频率控制回路输出频率达到微机械陀螺的工作频率，使微机械陀螺工作在谐振频率。4.根据权利要求1所述的一种基于ADRC的微机械陀螺幅值控制系统，其特征在于，所述幅值控制回路使用自抗扰控制来稳定微机械陀螺输出信号幅值，所述幅值控制回路中包含跟踪微分器、误差反馈控制模块和扩张状态观测器模块；所述跟踪微分器事先安排过渡过程，提取含有随机噪声的输入信号及其微分信号，解决PID超调性、快速性之间的矛盾；所述误差反馈控制模块根据反馈的误差信号输出控制信号使控制对象工作在期望的状态；所述扩张状态观测器模块用于估计系统内外扰动的实时作用值，并在反馈中给予补偿...

【专利技术属性】
技术研发人员：贠卫国，张梦豪，
申请(专利权)人：西安建筑科技大学，
类型：发明
国别省市：