采用恒频参量激励的微机械陀螺驱动控制方案
MEMS gyroscopes parametric excitation control scheme with constant resonant frequency
通讯作者:
收稿日期: 2018-12-13
Received: 2018-12-13
作者简介 About authors
林一羽(1992—),女,博士生,从事微机械陀螺数字信号处理研究.orcid.org/0000-0002-9827-5955.E-mail:
提出一种基于恒定谐振频率和参量激励的微机械(MEMS)陀螺驱动控制方案. 该方案利用三角形栅极电容实现,使得陀螺驱动谐振频率和品质因子在环境波动下保持恒定,改善陀螺的温度敏感性. 介绍基于三角形栅极电容的频率调谐和参量激励理论,提出并实现新型恒定谐振频率和参量激励驱动方案. 仿真结果表明,对陀螺驱动模态的实时调谐使得谐振频率恒定;参量激励实现了对驱动模态的稳幅控制. 实验结果表明,该方案测得的陀螺的Allan方差偏置不稳定性为1.69°/h,优于传统方案;降温过程中零偏温漂相比传统方案减小了50%.
关键词:
A novel drive-mode control scheme for MEMS gyroscopes was presented, where the gyroscopes were parametrically excited with constant resonant frequency. The proposed control scheme enabled a constant resonant frequency excitation with parametric amplification in the drive mode via triangular parallel capacitors, to keep the resonant frequency and quality factor constant against environmental fluctuations, and to improve the gyroscope temperature performance. First, frequency tuning and parametric excitation by means of triangular capacitors were introduced. Then, a new control scheme based on parametric excitation at constant frequency was proposed and implemented. The simulation results indicate that the resonant frequency is tuned to be constant and the dive-mode vibration amplitude is controlled to be stable. Finally, the experimental results indicate that the bias instability of gyroscope was 1.69°/h, which was better than that of the traditional scheme, and the temperature drift of zero-rate output during temperature cooling down was reduced to half compared to the traditional control scheme.
Keywords:
本文引用格式
林一羽, 郑旭东, 吴海斌, 马志鹏, 金仲和.
LIN Yi-yu, ZHENG Xu-dong, WU Hai-bin, MA Zhi-peng, JIN Zhong-he.
微机械陀螺的驱动模态控制方案通常采用基于锁相环和自动增益控制(PLL-AGC)环路:一方面,通过锁相环(phase-locked loop,PLL)将驱动振动位移和驱动信号的相位差锁定在−π/2,使得陀螺驱动信号跟踪陀螺驱动模态的谐振频率从而保持驱动模态工作在谐振频率处[1-2];另一方面,自动增益控制(automatic gain control,AGC)环路将陀螺驱动模态振动位移幅值锁定到参考幅值[3]. 对于该控制方案,需要获得陀螺驱动振动的幅度信息和相位信息,并分别通过2个控制器实现对陀螺的驱动信号的幅度稳定和频率跟踪. 对于PLL-AGC闭环控制方案,陀螺驱动模态的谐振频率和品质因子仍然随环境温度波动,即陀螺驱动模态的动力学参数随温度缓变,使得陀螺输出不可避免地发生漂移.
为了克服陀螺谐振频率随温度漂移的影响,笔者所在课题组曾报道了一种基于三角形栅极电容的恒谐振频率驱动(constant resonant frequency drive,CRFD)方案,该方案通过实时调整陀螺本身的谐振频率实现恒定谐振频率驱动[4],报道中陀螺的幅度控制环路采用AGC控制方案,无法避免陀螺驱动模态品质因子随温度的漂移.
三角形栅极电容是一种线性静电刚度调谐结构,其引入的静电刚度与振动位移无关. 本文首先介绍三角形栅极电容用于频率调谐和参量激励的工作原理,在此基础上提出基于三角形栅极电容的恒定谐振频率参量激励(constant resonant frequency parametric excitation,CRF-PE)驱动控制方案. 该方案通过三角形电容对陀螺驱动环路实时调谐,维持工作过程中陀螺驱动模态谐振频率恒定,并通过参量激励实时控制陀螺的驱动模态等效品质因子恒定.
1. 工作原理
1.1. 基于三角形栅极电容的频率调谐和参量激励
图 1
式中:a为三角形固定极板在x方向的长度,b为在y方向的交叠宽度,g为与可动极板在z方向形成的间距,ke为静电弹性系数,N为差分上调谐电极数量,ε为真空介电常数,Vt为调谐电极上施加的调谐电压,KT为表示静电弹性系数与调谐电压平方关系的调谐系数
图1(c)中陀螺三角形电极引入的静电弹性系数为正弹性系数,使陀螺驱动模态等效弹性系数增大,进而增大相应模态的谐振频率. 从式(1)可以看出,三角形上调谐电容结构引入的静电弹性系数与可动电极位移无关,而与直角三角形底长与高长的比值(b/a)成正比,与电极间距g成反比,并与调谐电压成平方正比关系. 将引入的静电弹性系数与调谐电压的平方关系系数用调谐系数KT表示. 考虑引入的弹性系数后,微机械陀螺驱动模态为典型的弹簧-质量块-阻尼系统,遵循如下动力学方程:
式中:m为可动质量块的质量,c为阻尼系数,k为弹性系数,F0为驱动力幅度,ω为工作频率.
参量激励是指在齐次系统中,某个参数发生周期性振荡促使系统达到谐振状态的激励方案,当被运用到微机械陀螺中时,发生周期性变化的参数一般是陀螺的弹性系数[13]. 为了构建能满足参量激励条件的陀螺动力学微分方程,令调谐电压具有如下余弦开根号的形式:
式中:Adc为调谐电压中的直流分量幅度,Aac为调谐电压中的交流分量幅度,ωd为驱动信号频率,φt为调谐电压中的交流分量相位. 那么,对应的微分方程改写为
根据文献[14],当驱动模态频率满足式(5)的谐振条件时,参量激励后的幅度如式(6)所示.
式中:
由式(6)可见,陀螺最终的谐振频率跟KT和Adc相关,KT是和三角形栅极电容参数相关的物理量. 因此可以通过调节Adc调节系统的弹性系数,系统弹性系数由未加电压时的k调节到施加电压后的k+KTAdc. 除了直流调谐作用之外,式(3)中的调谐电压同时引入了参量激励,其效果与参数Aac和φt有关. 当调谐相位满足φt=π/2+2nπ,参量激励的效果为最显著的参量放大,固定φt=π/2后参量放大效果只与参数Aac相关,且随着Aac的增加,陀螺驱动模态等效品质因子增加,那么驱动模态振动位移幅度也随之增大,振动位移幅度与参数Aac的关系如下:
若将无调谐(Adc=Aac=0)情况下的初始弹性系数记为k;直流调谐(Adc>Aac=0)情况下,等效弹性系数、等效谐振频率和品质因子记为keff、w0eff和Q;经参量激励(Adc>Aac>0)后,品质因子得到放大,得到的等效品质因子记为Qeff,则有
式中:ω0为调谐前的自然谐振频率.
由式(7)和(8)可知,基于三角形栅极电容可以实现对陀螺驱动模态的直流调谐和参量激励,且由这种调谐结构引入的弹性系数与位移无关. 施加如式(3)所示的调谐电压后,当陀螺驱动模态的弹性系数k和品质因子Q受环境温度波动而发生改变时,可以分别通过Adc和Aac进行直流调谐和参量激励,保持驱动模态等效弹性系数和等效品质因子恒定不变,这是本文所提新型控制方案的基础. 据此设计新型的基于恒定谐振频率和参量激励的微机械陀螺驱动控制方案,通过闭环控制实现Adc和Aac的自动调节,最终使得陀螺驱动模态的谐振频率和等效品质因子在环境温度波动下都能保持恒定.
1.2. 控制方案
1.2.1. 控制方案框图
如图2(a)所示为传统锁相环和自动增益控制(PLL-AGC)方案的框图,通过锁相环(PLL)来使得陀螺始终驱动在其谐振频率上,同时通过自动增益控制(AGC)来保持驱动幅度恒定. 图中,Gx为陀螺器件的传递函数,ω0为初始设定的驱动频率,Fx(t)为交流驱动力,Aref为振动位移幅度参考值,θref为振动位移相位参考值,2个比例-积分(proportional-integral,PI)控制器分别用于控制驱动振动位移相位和振动位移幅度,并反馈到驱动力的频率和幅度上. PLL-AGC环路的控制目标是使得振动位移相位和幅度分别控制在参考值,即陀螺驱动模态工作在谐振频率上且振动幅度保持恒定.
图 2
图 2 传统PLL-AGC控制方案和新型CRF-PE控制方案的框图
Fig.2 Blocks of traditional PLL-AGC control scheme and novel CRF-PE control scheme
当环境变化引起弹性系数和品质因子变化时,新型CRF-PE控制方案通过调节调谐电压的参数Adc和Aac保持驱动模态等效弹性系数和等效品质因子恒定,而传统PLL-AGC控制方案通过调节陀螺驱动力的频率和幅度,从而补偿掉弹性系数和品质因子变化对谐振状态和振动位移幅度的影响.
相比于传统PLL-AGC控制方案,新型CRF-PE控制方案具有以下几个优点:1)恒定谐振频率控制避免了信号处理电路中与陀螺工作频率相关的模块随频率变化引起的相位漂移. 2)参量激励使驱动模态的等效品质因子可以保持对初始品质因子的恒定放大,从而保证相同的驱动位移时降低驱动电压,减少驱动端和其他电极之间的电耦合. 3)当环境温度波动时,等效弹性系数和等效品质因子保持恒定,即陀螺在驱动模态具有恒定动力学参数,因此新型CRF-PE有望显著改善陀螺的温度性能.
1.2.2. 理论分析
平均化方法是一种能够等效分析同时包含快变化和慢变化的控制系统分析工具[19]. 根据周期平均化方法可以分析新型CRF-PE控制方案中的2个参数Adc、Aac如何根据阻尼系数和弹性系数的变化进行调节,以及调节后驱动模态振动位移的幅度和相位的被控效果.
驱动振动位移的稳态解依然为
对式(10)求时间t的一阶导数,得到的驱动振动速度为
假设
对式(12)求时间t的一阶导数,得到的驱动振动加速度为
将驱动振动位移、速度和加速度公式(式(10)、(12)和(13))代入式(9)中的驱动模态运动方程,可得
将式(14)用矩阵形式表示,且左乘如下所示的非奇异矩阵:
所得新矩阵可拆成式(16)和(17):
对式(15)和(16)进行积化和差后,在ωdt变化的一个周期内对等式两边作积分运算,得到
最终得到控制系统的平均化方程组:
由式(20)可得,新型CRF-PE控制方案的闭环系统平衡点为
在新型CRF-PE控制方案中,被控制的2个对象依旧是检测到的振动位移的幅度和相位. 由式(21)可见,当驱动模态阻尼系数和弹性系数发生改变时,PI控制器对Adc、Aac进行调节,使得等效弹性系数和等效阻尼系数始终保持恒定,即陀螺驱动模态谐振频率和等效品质因子保持恒定.
2. 仿真结果
图 3
表 1 CRF-PE控制方案的仿真参数
Tab.1
参数 | 数值 | 单位 | 参数 | 数值 | 单位 | |
f0 | 1 835.91 | Hz | Q0 | 8 000 | — | |
mx | 1.56×10−5 | kg | KVF | 7.828×10−6 | N/V | |
kx | 2 075.800 | N/m | KXV | 1×105 | V/m | |
cx | 2.25×10−5 | — | KT | 0.038 | N/(m∙V2) |
在仿真过程中,为了验证2个环路可以分别调节等效弹性系数和等效阻尼系数,在开环情况下,先改变弹性系数再进行相位路CRFD闭环,先改变阻尼系数再进行幅度路PE闭环. 具体的仿真过程如下.
1)t=0:驱动模态开环. 设定驱动信号频率为谐振频率,位移幅度逐渐起振到1.47×10−2 μm,相位为−90°.
2)t=5 s:模拟环境变化造成的弹性系数波动. 驱动模态弹性系数从2 075.800 N/m变为2 076.026 N/m,对应的谐振频率从1 835.91 Hz变为1 836.01 Hz. 结果为驱动模态不再谐振,驱动位移开环幅度从1.47×10−2 μm降到1.35×10−2 μm,驱动位移开环相位从−90°变为−52.26°.
3)t=7 s:开始相位路的CRFD闭环,设置参考相位为−90°. 闭环后,相位路的PI控制器输出Adc去调节等效弹性系数,最终等效弹性系数回到谐振时的2 076.026 N/m,意味着谐振频率通过调谐变回驱动信号频率,驱动模态回到谐振状态. 对振动位移的控制效果为位移相位被控制回参考相位(−90°),对应的位移幅度变回1.47×10−2 μm,与谐振时的数值一致.
4)t=10 s:模拟环境变化造成的阻尼系数波动. 驱动模态阻尼系数从2.25×10−5变为2.65×10−5,对应的品质因子从8 000变为6 792. 结果驱动位移开环幅度从1.47×10−2 μm降到1.32×10−2 μm.
5)t=12 s:开始幅度路的PE闭环,参考幅度为1.47×10−2 μm. 闭环后,幅度路的PI控制器输出Aac去调节等效品质因子,最终等效品质因子回到阻尼波动前的8 000. 对振动位移的控制效果为驱动位移闭环幅度从1.32×10−2 μm被调节回1.47×10−2 μm.
图 4
对仿真结果总结如下,在恒频控制和参量激励控制环路闭环后,尽管驱动模态弹性系数和阻尼系数发生了改变,但是在闭环作用下直流分量Adc和交流分量幅度Aac分别调节了等效弹性系数keff和等效品质因子Qeff,使其数值与改变前的弹性系数和阻尼系数相等. 仿真结果表明:CRF-PE控制方案能保持陀螺驱动等效弹性系数和等效品质因子恒定.
3. 实验结果
新型CRF-PE控制方案的实验平台如图5所示,包括硬件电路板、电脑、稳压源、示波器、矢量分析仪和转台.
图 5
首先,控制系统的幅度参考值Aref和相位参考值θref可通过扫频测试获得,Aref=7×105 bit,θref=93°,相位参考值与仿真所设的−90°不相等是因为解调电路的滤波网络会引入相移. 在室温下应用CRF-PE控制方案,驱动位移的幅度和相位稳定性的1 h数据如图6所示,计算得到幅度变化的稳定性为2.724 6×10−5,相位变化的稳定性为0.001 74°(1σ).
图 6
图 6 CRF-PE控制方案1 h驱动稳定性测试
Fig.6 Drive-mode one-hour stability test under CRF-PE control
在CRF-PE控制方法中,幅度环路和相位环路2个PI控制器分别输出直流分量Adc和交流分量幅度Aac,以分别调节等效弹性系数和等效品质因子使其保持恒定. 图7给出了降温过程和室温2种情况下的直流分量Adc和交流分量幅度Aac的45 min数据. 降温过程即首先在温箱中设定控温60 °C,控温2 h后关闭温控,使陀螺系统自然降温,降温45 min后对应的温箱温度从60 °C降温到49 °C. 测试结果显示,在降温过程中,直流分量Adc和交流分量幅度Aac一直在自动调节,而在室温下,直流分量Adc和交流分量幅度Aac基本上稳定不变.
图 7
图 7 CRF-PE控制方案中直流分量和交流分量幅度的45 min数据
Fig.7 45-minite data of direct current component and amplitude of alternating current component under CRF-PE control
在室温下以10 Hz的采样频率分别采集传统PLL-AGC方案和CRF-PE控制方案的1 h零偏输出数据,利用Allan方差进行分析,得到分析曲线如图8所示. 图中,SAllan为Allan方差,τ为Allan方差的积分时间. 在实验测试得到传统PLL-AGC控制方案的角度随机游走(angular random walk, ARW)为0.086°/
图 8
图 8 新型CRF-PE控制方案和传统PLL-AGC控制方案的陀螺零偏输出的Allan方差对比曲线
Fig.8 Comparison of Allan variance graphs of gyroscope outputs using novel CRF-PE control scheme and conventional PLL-AGC control scheme
将传统PLL-AGC控制方案和CRF-PE控制方案分别应用到陀螺中,在温箱中设定控温为60 °C,控温2 h后关闭温控,使陀螺系统自然降温,降温1 600 s对应的温箱温度从60 °C降温到53 °C. 降温过程中,2种方案下的陀螺零偏(Bias)数据如图9所示,相比于传统PLL-AGC控制方案在此降温过程中的零偏漂移为2°/s,CRF-PE控制方案在1 600 s内的零偏漂移为1°/s,CRF-PE控制方案下陀螺漂移改善为PLL-AGC方案下的50%.
图 9
图 9 降温过程中新型CRF-PE控制方案和传统PLL-AGC控制方案的零偏数据对比
Fig.9 Comparison of zero-rate outputs using novel CRF-PE control scheme and conventional PLL-AGC control scheme during temperature cooling down
尽管CRF-PE控制方案下陀螺漂移相比PLL-AGC方案有了明显改善,改善幅度比预期较差,主要原因有以下几点:1)尽管驱动模态的谐振频率和等效品质因子控制为恒定值,但陀螺检测模态开环工作,温度引起的检测模态的动力学参数漂移仍然影响陀螺输出,对检测模态进行力平衡闭环可以进一步改善温度引起的零漂. 2)受限于器件加工时存在较大的硅玻璃键合对准误差,该栅陀螺驱动模态最大工作位移仅仅约为1 μm,在传统PLL-AGC方案测试中陀螺工作已达1 μm,因此所提CRF-PE方案参量放大倍数不能超过2倍,无法完全发挥出参量放大的优越性. 3)尽管新方案在谐振频率和品质因子波动的情况下可以进行调节使其恒定,陀螺零偏的温漂还受到其他因素的影响,如:位移/电容转换增益和检测电路增益.
4. 结 语
本文所提的新型恒频参量激励(CRF-PE)控制方案,基于恒定谐振频率驱动和参量激励,与传统的锁相环和自动增益(PLL-AGC)控制方案相比,具有低驱动电压、低电耦合、高稳定性等优点.
通过实验测试得到新型CRF-PE控制方案的角度随机游走为0.076°/
所提新型CRF-PE控制方案有效改善了陀螺零偏的稳定性和温漂,但依然存在残留的温漂. 后续的研究可以从3个方面进行:1)对CRF-PE控制方案进行优化,通过对检测模态实现力平衡闭环,利用参量放大增加驱动模态的可动位移等方法,可以进一步改善CRF-PE控制方案下陀螺零偏的温漂;2)优化陀螺器件结构设计,提高三角形电极的调谐能力,即增大驱动模态的调谐系数KT,可以提高新型CRF-PE控制方案的调节谐振频率和品质因子的能力,能使其适用于更广的工作温度范围;3)由于位移/电容转换增益和检测电路增益等依然会引起陀螺零偏发生温漂,可以将新型CRF-PE控制方案与自校准检测方案或者零偏补偿方案相结合,进一步改善零偏的温漂.
参考文献
Control of a Z-axis MEMS vibrational gyroscope
[J].DOI:10.1109/TMECH.2005.852437 [本文引用: 1]
Transient response and stability of the AGC-PI closed-loop controlled MEMS vibratory gyroscopes
[J].DOI:10.1088/0960-1317/19/12/125015 [本文引用: 1]
Experimental investigation of parametric and externally forced motion in resonant MEMS sensors
[J].
Parametric excitation, amplifica-tion, and tuning of MEMS folded-beam comb drive oscillator
[J].DOI:10.1109/JMEMS.2012.2221156
Self-induced parametric amplification arising from nonlinear elastic coupling in a micromechanical resonating disk gyroscope
[J].DOI:10.1038/srep09036 [本文引用: 1]
A control scheme for a MEMS electrostatic resonant gyroscope excited using combined parametric excitation and harmonic forcing
[J].DOI:10.1088/0960-1317/16/2/017 [本文引用: 1]
A Slot-structure MEMS gyroscope working at atmosphere with tunable electrostatic spring constant
[J].DOI:10.1109/JMEMS.2013.2250485 [本文引用: 1]
基于参数激励的MEMS环式陀螺驱动方法与实现
[J].
Improvement of MEMS gyroscope driving method based on parametric excitation
[J].
Mechanical parametric amplification and thermomechanical noise squeezing
[J].DOI:10.1103/PhysRevLett.67.699 [本文引用: 1]
An improved phase-robust configuration for vibration amplitude-phase extraction for capacitive MEMS gyroscopes
[J].DOI:10.3390/mi9070362 [本文引用: 1]
Temperature-dependence improvement for a MEMS gyroscope using triangular-electrode based capacitive detection method
[J].
Bias contributions in a MEMS tuning fork gyroscope
[J].DOI:10.1109/JMEMS.2012.2221158 [本文引用: 1]
/
〈 |
|
〉 |
