浙江大学学报(工学版), 2019, 53(9): 1795-1804 doi: 10.3785/j.issn.1008-973X.2019.09.019

通信技术、电气工程

采用恒频参量激励的微机械陀螺驱动控制方案

林一羽,, 郑旭东,, 吴海斌, 马志鹏, 金仲和

MEMS gyroscopes parametric excitation control scheme with constant resonant frequency

LIN Yi-yu,, ZHENG Xu-dong,, WU Hai-bin, MA Zhi-peng, JIN Zhong-he

通讯作者: 郑旭东,男,副教授. orcid.org/0000-0003-2685-9844. E-mail: zhengxudong@zju.edu.cn

收稿日期: 2018-12-13  

Received: 2018-12-13  

作者简介 About authors

林一羽(1992—),女,博士生,从事微机械陀螺数字信号处理研究.orcid.org/0000-0002-9827-5955.E-mail:linyy@zju.edu.cn , E-mail:linyy@zju.edu.cn

摘要

提出一种基于恒定谐振频率和参量激励的微机械(MEMS)陀螺驱动控制方案. 该方案利用三角形栅极电容实现,使得陀螺驱动谐振频率和品质因子在环境波动下保持恒定,改善陀螺的温度敏感性. 介绍基于三角形栅极电容的频率调谐和参量激励理论,提出并实现新型恒定谐振频率和参量激励驱动方案. 仿真结果表明,对陀螺驱动模态的实时调谐使得谐振频率恒定;参量激励实现了对驱动模态的稳幅控制. 实验结果表明,该方案测得的陀螺的Allan方差偏置不稳定性为1.69°/h,优于传统方案;降温过程中零偏温漂相比传统方案减小了50%.

关键词: 微机械(MEMS)陀螺 ; 驱动控制方案 ; 参量激励 ; 恒谐振频率驱动 ; 三角形栅极电容

Abstract

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: MEMS gyroscope ; drive-mode control ; parametric excitation ; constant resonance frequency drive ; triangular parallel capacitors

PDF (1467KB) 元数据 多维度评价 相关文章 导出 EndNote| Ris| Bibtex  收藏本文

本文引用格式

林一羽, 郑旭东, 吴海斌, 马志鹏, 金仲和. 采用恒频参量激励的微机械陀螺驱动控制方案. 浙江大学学报(工学版)[J], 2019, 53(9): 1795-1804 doi:10.3785/j.issn.1008-973X.2019.09.019

LIN Yi-yu, ZHENG Xu-dong, WU Hai-bin, MA Zhi-peng, JIN Zhong-he. MEMS gyroscopes parametric excitation control scheme with constant resonant frequency. Journal of Zhejiang University(Engineering Science)[J], 2019, 53(9): 1795-1804 doi:10.3785/j.issn.1008-973X.2019.09.019

微机械陀螺的驱动模态控制方案通常采用基于锁相环和自动增益控制(PLL-AGC)环路:一方面,通过锁相环(phase-locked loop,PLL)将驱动振动位移和驱动信号的相位差锁定在−π/2,使得陀螺驱动信号跟踪陀螺驱动模态的谐振频率从而保持驱动模态工作在谐振频率处[1-2];另一方面,自动增益控制(automatic gain control,AGC)环路将陀螺驱动模态振动位移幅值锁定到参考幅值[3]. 对于该控制方案,需要获得陀螺驱动振动的幅度信息和相位信息,并分别通过2个控制器实现对陀螺的驱动信号的幅度稳定和频率跟踪. 对于PLL-AGC闭环控制方案,陀螺驱动模态的谐振频率和品质因子仍然随环境温度波动,即陀螺驱动模态的动力学参数随温度缓变,使得陀螺输出不可避免地发生漂移.

为了克服陀螺谐振频率随温度漂移的影响,笔者所在课题组曾报道了一种基于三角形栅极电容的恒谐振频率驱动(constant resonant frequency drive,CRFD)方案,该方案通过实时调整陀螺本身的谐振频率实现恒定谐振频率驱动[4],报道中陀螺的幅度控制环路采用AGC控制方案,无法避免陀螺驱动模态品质因子随温度的漂移.

参量激励(parametric excitation,PE)是一种利用陀螺动力学方程中参数发生周期性振荡促使系统达到谐振状态的激励方案,微机械陀螺中可利用弹性系数周期变化实现参量激励[5-8]. 参量激励可用来调整陀螺驱动品质因子从而调节振动幅度. 但目前微机械陀螺的参量激励主要基于变间距梳齿结构,其引入的静电刚度具有非线性项,参量激励时会加剧振动位移的非线性.

Gallacher等[9-11]利用参量激励对品质因子的调节作用,实现驱动控制方案的幅度控制,但相位控制仍采用PLL,陀螺驱动模态谐振频率随温度的漂移依然无法避免.

三角形栅极电容是一种线性静电刚度调谐结构,其引入的静电刚度与振动位移无关. 本文首先介绍三角形栅极电容用于频率调谐和参量激励的工作原理,在此基础上提出基于三角形栅极电容的恒定谐振频率参量激励(constant resonant frequency parametric excitation,CRF-PE)驱动控制方案. 该方案通过三角形电容对陀螺驱动环路实时调谐,维持工作过程中陀螺驱动模态谐振频率恒定,并通过参量激励实时控制陀螺的驱动模态等效品质因子恒定.

1. 工作原理

1.1. 基于三角形栅极电容的频率调谐和参量激励

图1(a)所示为所用的栅结构微机械陀螺的示意图,外框质量块被限制沿着x轴振动,内框有xy两个方向的自由度,内框沿y轴的振动能反映陀螺所敏感的角速度信号. 图1(b)给出了微机械陀螺可动质量块下方的固定电极图,包括矩形电极和三角形电极.

图 1

图 1   栅结构微机械结构示意图

Fig.1   Schematic diagram of slot-structure gyrosocpe


陀螺器件的加工过程可概括如下:在可动质量块背面刻蚀栅槽,如图1(b)所示,在玻璃上加工固定金属电极,包含矩形电极和三角形电极. 质量块背面栅条与玻璃衬底上的固定矩形电极形成差分电容检测结构,可动质量块的位移导致电容的交叠面积发生变化,一侧交叠面积变大,另一侧交叠面积变小,从而使得差分电容的电容量相应地发生改变,此电容变化量与可动质量块的位移成正比. 质量块的可动电极与玻璃衬底上的固定三角形电极形成如图1(c)所示的三角形栅极电容,即图1(b)中的陀螺调谐端,用来进行频率调谐和参量激励. 该变面积差分电容结构可以引入正弹性系数,称为三角形电容上调谐结构. 图1(d)显示的是微机械陀螺的照片.

对于如图1(c)中所示的三角形上调谐电容结构,其直角三角形固定电极与矩形可动电极的交叠部分为直角三角形. 根据文献[12],差分调谐电压调谐效果是单边调谐电极的2倍,N对差分上调谐电极引入的弹性系数如下:

${k_{\rm{e}}} = 2N\frac{{\partial {F_{\rm{e}}}}}{{\partial x}} = N\frac{{\varepsilon b}}{{ag}}V_{\rm{t}}^{\rm{2}}{\rm{ = }}{K_{\rm{T}}}V_{\rm{t}}^{\rm{2}}.$

式中:a为三角形固定极板在x方向的长度,b为在y方向的交叠宽度,g为与可动极板在z方向形成的间距,ke为静电弹性系数,N为差分上调谐电极数量,ε为真空介电常数,Vt为调谐电极上施加的调谐电压,KT为表示静电弹性系数与调谐电压平方关系的调谐系数

图1(c)中陀螺三角形电极引入的静电弹性系数为正弹性系数,使陀螺驱动模态等效弹性系数增大,进而增大相应模态的谐振频率. 从式(1)可以看出,三角形上调谐电容结构引入的静电弹性系数与可动电极位移无关,而与直角三角形底长与高长的比值(b/a)成正比,与电极间距g成反比,并与调谐电压成平方正比关系. 将引入的静电弹性系数与调谐电压的平方关系系数用调谐系数KT表示. 考虑引入的弹性系数后,微机械陀螺驱动模态为典型的弹簧-质量块-阻尼系统,遵循如下动力学方程:

$m\ddot x + c\dot x + \left( {k + {k_{\rm{e}}}} \right)x = {F_0}\cos\; \omega t.$

式中:m为可动质量块的质量,c为阻尼系数,k为弹性系数,F0为驱动力幅度,ω为工作频率.

参量激励是指在齐次系统中,某个参数发生周期性振荡促使系统达到谐振状态的激励方案,当被运用到微机械陀螺中时,发生周期性变化的参数一般是陀螺的弹性系数[13]. 为了构建能满足参量激励条件的陀螺动力学微分方程,令调谐电压具有如下余弦开根号的形式:

${U_{\rm{t}}} = \sqrt {{A_{{\rm{dc}}}} + {A_{{\rm{ac}}}}\cos \;(2{\omega _{\rm{d}}}t + {\varphi _{\rm{t}}})} .$

式中:Adc为调谐电压中的直流分量幅度,Aac为调谐电压中的交流分量幅度,ωd为驱动信号频率,φt为调谐电压中的交流分量相位. 那么,对应的微分方程改写为

$m\ddot x + c\dot x + kx{\rm{ + }}{K_{\rm{T}}}\left( {{A_{{\rm{dc}}}} + {A_{{\rm{ac}}}}\cos \;(2{\omega _{\rm{d}}}t + {\varphi _{\rm{t}}})} \right)x = {F_{\rm{d}}}\cos {\omega _{\rm{d}}}t.$

根据文献[14],当驱动模态频率满足式(5)的谐振条件时,参量激励后的幅度如式(6)所示.

${\omega _{\rm{d}}} = {\omega _{0{\rm{eff}}}} = \left[ {\frac{{\rm{1}}}{m}\left( {k + {K_{\rm{T}}}{A_{{\rm{dc}}}}} \right)}\right]^{1/2},$

$ \begin{split} & \left| x \right|({A_{{\rm{ac}}}},{\varphi _{\rm{t}}}) = \\ & \frac{{{F_0}}}{{c{\omega _{0{\rm{eff}}}}}}\!\left[ {{{\left( {\frac{{\cos \;\!\left( {{\varphi _{\rm{t}}}{\rm{/}}2{\rm{ + }}{\text{π}} {\rm{/}}4} \right)}}{{1{\rm{ + }}E}}} \right)}^2}{\rm{ + }}{{\left( {\frac{{\sin\;\! \left( {{\varphi _{\rm{t}}}{\rm{/}}2{\rm{ + }}{\text{π}} {\rm{/4}}} \right)}}{{1 \!-\! E}}} \right)}^2}}\right]^{1/2} . \end{split} $

式中: $E = {{{K_{\rm{T}}}{A_{{\rm{ac}}}}}/{\left( {2c{\omega _{{\rm{0eff}}}}} \right)}}$. 其中,ω0eff为调谐后的等效谐振频率.

由式(6)可见,陀螺最终的谐振频率跟KTAdc相关,KT是和三角形栅极电容参数相关的物理量. 因此可以通过调节Adc调节系统的弹性系数,系统弹性系数由未加电压时的k调节到施加电压后的k+KTAdc. 除了直流调谐作用之外,式(3)中的调谐电压同时引入了参量激励,其效果与参数Aacφt有关. 当调谐相位满足φt=π/2+2nπ,参量激励的效果为最显著的参量放大,固定φt=π/2后参量放大效果只与参数Aac相关,且随着Aac的增加,陀螺驱动模态等效品质因子增加,那么驱动模态振动位移幅度也随之增大,振动位移幅度与参数Aac的关系如下:

$\left| x \right|({A_{{\rm{ac}}}},{\text{π}}/{2} + {\rm{2}}n{\text{π}}){\rm{ = }}\frac{{{F_0}}}{{c{\omega _{0{\rm{eff}}}} - {{{K_{\rm{T}}}{A_{{\rm{ac}}}}}/{\rm{2}}}}} = \frac{{{F_0}}}{{{k_{{\rm{eff}}}}}}{Q_{{\rm{eff}}}}.$

若将无调谐(Adc=Aac=0)情况下的初始弹性系数记为k;直流调谐(Adc>Aac=0)情况下,等效弹性系数、等效谐振频率和品质因子记为keffw0effQ;经参量激励(Adc>Aac>0)后,品质因子得到放大,得到的等效品质因子记为Qeff,则有

$\left. \begin{gathered} k = m{\omega _0}^2,Q = \frac{{\rm{1}}}{c}m{\omega _{0{\rm{eff}}}}, \\ {k_{{\rm{eff}}}} = k + {K_{\rm{T}}}{A_{{\rm{dc}}}} = m{\omega _{0{\rm{eff}}}}^2, \\ {Q_{{\rm{eff}}}} = Q{\left[ {1 - \frac{{{K_{\rm{T}}}{A_{{\rm{ac}}}}Q}}{{2{k_{{\rm{eff}}}}}}} \right]^{ - 1}}. \\ \end{gathered} \right\}$

式中:ω0为调谐前的自然谐振频率.

由式(7)和(8)可知,基于三角形栅极电容可以实现对陀螺驱动模态的直流调谐和参量激励,且由这种调谐结构引入的弹性系数与位移无关. 施加如式(3)所示的调谐电压后,当陀螺驱动模态的弹性系数k和品质因子Q受环境温度波动而发生改变时,可以分别通过AdcAac进行直流调谐和参量激励,保持驱动模态等效弹性系数和等效品质因子恒定不变,这是本文所提新型控制方案的基础. 据此设计新型的基于恒定谐振频率和参量激励的微机械陀螺驱动控制方案,通过闭环控制实现AdcAac的自动调节,最终使得陀螺驱动模态的谐振频率和等效品质因子在环境温度波动下都能保持恒定.

1.2. 控制方案

1.2.1. 控制方案框图

图2(a)所示为传统锁相环和自动增益控制(PLL-AGC)方案的框图,通过锁相环(PLL)来使得陀螺始终驱动在其谐振频率上,同时通过自动增益控制(AGC)来保持驱动幅度恒定. 图中,Gx为陀螺器件的传递函数,ω0为初始设定的驱动频率,Fxt)为交流驱动力,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


图2(b)所示为恒谐振频率参量激励(CRF-PE)方案的框图,通过恒定谐振频率控制环路,使得陀螺的驱动谐振频率始终为固定频率,同时通过参量激励来保持驱动幅度恒定. 与传统PLL-AGC控制方案相比,新型CRF-PE控制方案也须对驱动振动位移进行相位和幅度的提取和控制. 不同的是,在新型CRF-PE控制方案中,驱动力的频率和幅度是不变的,发生改变的是调谐电压中的参数AdcAac,受到PI控制器的反馈调节,驱动力和调谐电压分别作用于如图1(b)所示的驱动电极和调谐电极上.

在传统PLL-AGC控制方案中,一方面,由于陀螺零偏输出的标度因子与工作频率成正比,工作频率的波动会造成标度因子的波动;另一方面,信号处理电路中存在相位对工作频率敏感的模块(如:滤波器),当相位漂移时会在驱动模态的PLL环路造成相位锁定误差[15-16],当检测模态的解调相位设为恒定值时,PLL环路的相位锁定误差会引起正交误差到零偏的耦合,同时会影响标度因数[17]. 正交误差一方面来源于微机械加工工艺误差造成的弹性梁失配,另一方面由驱动力耦合中的正交成分引起,该耦合与驱动模态品质因子负相关[18],即驱动模态品质因子的波动会导致陀螺的零偏漂移.

当环境变化引起弹性系数和品质因子变化时,新型CRF-PE控制方案通过调节调谐电压的参数AdcAac保持驱动模态等效弹性系数和等效品质因子恒定,而传统PLL-AGC控制方案通过调节陀螺驱动力的频率和幅度,从而补偿掉弹性系数和品质因子变化对谐振状态和振动位移幅度的影响.

相比于传统PLL-AGC控制方案,新型CRF-PE控制方案具有以下几个优点:1)恒定谐振频率控制避免了信号处理电路中与陀螺工作频率相关的模块随频率变化引起的相位漂移. 2)参量激励使驱动模态的等效品质因子可以保持对初始品质因子的恒定放大,从而保证相同的驱动位移时降低驱动电压,减少驱动端和其他电极之间的电耦合. 3)当环境温度波动时,等效弹性系数和等效品质因子保持恒定,即陀螺在驱动模态具有恒定动力学参数,因此新型CRF-PE有望显著改善陀螺的温度性能.

1.2.2. 理论分析

平均化方法是一种能够等效分析同时包含快变化和慢变化的控制系统分析工具[19]. 根据周期平均化方法可以分析新型CRF-PE控制方案中的2个参数AdcAac如何根据阻尼系数和弹性系数的变化进行调节,以及调节后驱动模态振动位移的幅度和相位的被控效果.

ωdt变化的一个周期内,图2(b)中的环路变量{aθAdcAacVt}都可以近似地理解为常量,因此采用周期平均化方案来推导模态匹配算法的稳态解是合理的. 将图2(b)中低通滤波器(LPF)的作用用函数LPF{}表示,选取参量放大效应最明显的相位条件φt=π/2,系统控制方程为

$\left. \begin{aligned} & m\ddot x \!+\! c\dot x \!+\! kx{\rm{ \!+\! }}{K_{\rm{T}}}\left( {{A_{{\rm{dc}}}} \!+\! {A_{{\rm{ac}}}}\cos\;\! (2{\omega _{\rm{d}}}t \!+\! 90^\circ )} \right)x \!=\! {F_{\rm{d}}}\cos {\omega _{\rm{d}}}t, \\ & i\left( t \right) = {\rm{LPF}}\left\{ {x\left( t \right)\cos\; \left( {{\omega _{\rm{d}}}t} \right)} \right\} = {{\left| x \right|}}\cos\; \left( {{\varphi _x}} \right)/2, \\ & q\left( t \right) = {\rm{LPF}}\left\{ {x\left( t \right)\sin\; \left( {{\omega _{\rm{d}}}t} \right)} \right\} = - {{\left| x \right|}}\sin\; \left( {{\varphi _x}} \right)/2, \\ & a =({{i^2} + {q^2}})^{1/2} ,\;\theta = {\rm{ar}}\tan\; \left( {{q}/{i}} \right), \\ & {{\dot A}_{{\rm{dc}}}} = {K_{\rm{p}}}\dot \theta - {K_{\rm{i}}}\left( {\theta - {\theta _{{\rm{ref}}}}} \right),{{\dot A}_{{\rm{ac}}}} = {K_{\rm{p}}}\dot a - {K_{\rm{i}}}\left( {a - {A_{{\rm{ref}}}}} \right).{\rm{ }} \end{aligned} \right\}$

驱动振动位移的稳态解依然为

$x = \left| x \right|\cos\; ({\omega _{\rm{d}}}t + {\varphi _x}).$

对式(10)求时间t的一阶导数,得到的驱动振动速度为

$\dot x = \left| {\dot x} \right|\cos\; ({\omega _{\rm{d}}}t + {\varphi _x}) - \left| x \right|\left( {{\omega _{\rm{d}}} + {{\dot \varphi }_x}} \right)\sin\; ({\omega _{\rm{d}}}t + {\varphi _x}).$

假设 $\left| {\dot x} \right|\cos\; ({\omega _{\rm{d}}}t + {\varphi _x}) - \left| x \right|{\dot \varphi _x}\sin\; ({\omega _{\rm{d}}}t + {\varphi _x}) = 0$,则驱动振动速度可以重新写成:

$\dot x = - \left| x \right|{\omega _{\rm{d}}}\sin ({\omega _{\rm{d}}}t + {\varphi _x}).$

对式(12)求时间t的一阶导数,得到的驱动振动加速度为

$\begin{split} \ddot x = & - {\omega _{\rm{d}}}\left| {\dot x} \right|\sin \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right) - \\ & {\omega _{\rm{d}}}\left| x \right|\left( {{\omega _{\rm{d}}} + {{\dot \varphi }_x}} \right)\cos \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right). \end{split}$

将驱动振动位移、速度和加速度公式(式(10)、(12)和(13))代入式(9)中的驱动模态运动方程,可得

$\begin{split} & - m{\omega _{\rm{d}}}\left| {\dot x} \right|\sin \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right) - m{\omega _{\rm{d}}}\left| x \right|\left( {{\omega _{\rm{d}}} + {{\dot \varphi }_x}} \right)\cos \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right) - \\ & c\left| x \right|{\omega _{\rm{d}}}\sin ({\omega _{\rm{d}}}t + {\varphi _x}) + \left( {k{\rm{ + }}{K_{\rm{T}}}{A_{{\rm{dc}}}}} \right)\left| x \right|\cos ({\omega _{\rm{d}}}t + {\varphi _x}) - \\ & {{{K_{\rm{T}}}{A_{{\rm{ac}}}}}}\left| x \right|\sin ({\omega _{\rm{d}}}t + {\varphi _x})\cos \left( {2{\varphi _x}} \right)/2 + \\ & {{{K_{\rm{T}}}{A_{{\rm{ac}}}}}}\left| x \right|\cos ({\omega _{\rm{d}}}t + {\varphi _x})\sin \left( {2{\varphi _x}} \right)/2 = {F_{\rm{d}}}\cos {\omega _{\rm{d}}}t. \end{split} $

将式(14)用矩阵形式表示,且左乘如下所示的非奇异矩阵:

$\left[ {\begin{array}{*{20}{c}} {m{\omega _{\rm{d}}}\sin \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right)}&{\cos \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right)} \\ {m{\omega _{\rm{d}}}\cos \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right)}&{ - \sin \left( {{\omega _{\rm{d}}}t + {\varphi _x}} \right)} \end{array}} \right]$

所得新矩阵可拆成式(16)和(17):

$ \begin{split} & \left[ {\left| {\dot x} \right|\cos \left( {{\omega _{\rm{d}}}t + \varphi } \right) - \left| x \right|\dot \varphi \sin \left( {{\omega _{\rm{d}}}t + \varphi } \right)} \right]m{\omega _{\rm{d}}}\sin \left( {{\omega _{\rm{d}}}t + \varphi } \right) + \\ & \left[ {\left( {\left( {k{\rm{ + }}{K_{\rm{T}}}{A_{{\rm{dc}}}}} \right)\left| x \right| - m{\omega _{\rm{d}}}\left| x \right|\left( {{\omega _{\rm{d}}} + {{\dot \varphi }_x}} \right)} \right.} \right. - \\ & \left. {{K_{\rm{T}}}{A_{{\rm{ac}}}}\left| x \right|\sin \left( {2{\varphi _x}} \right)/2} \right)\cos \left( {{\omega _{\rm{d}}}t + \varphi } \right) + \left( {m{\omega _{\rm{d}}}\left| {\dot x} \right| + c\left| x \right|{\omega _{\rm{d}}} + } \right.\\ & \left. {\left. {{K_{\rm{T}}}{A_{{\rm{ac}}}}\left| x \right|\cos \left( {2{\varphi _x}} \right)/2} \right)\sin \left( {{\omega _{\rm{d}}}t + \varphi } \right)} \right]\left[ {\cos \left( {{\omega _{\rm{d}}}t + \varphi } \right)} \right]{\rm{ = }}\\ & {F_{\rm{d}}}\cos {\omega _{\rm{d}}}t\cos \left( {{\omega _{\rm{d}}}t + \varphi } \right). \end{split} $

$ \begin{split} & \left[ {\left| {\dot x} \right|\cos \left( {{\omega _{\rm{d}}}t + \varphi } \right) - \left| x \right|\dot \varphi \sin \left( {{\omega _{\rm{d}}}t + \varphi } \right)} \right]m{\omega _{\rm{d}}}\cos \left( {{\omega _{\rm{d}}}t + \varphi } \right) + \\ & \left[ {\left( {\left( {k{\rm{ + }}{K_{\rm{T}}}{A_{{\rm{dc}}}}} \right)\left| x \right| - m{\omega _{\rm{d}}}\left| x \right|\left( {{\omega _{\rm{d}}} + {{\dot \varphi }_x}} \right) - } \right.} \right.\\ & \left. {{K_{\rm{T}}}{A_{{\rm{ac}}}}\left| x \right|\sin \left( {2{\varphi _x}} \right)/2} \right)\cos \left( {{\omega _{\rm{d}}}t + \varphi } \right) + \left( {m{\omega _{\rm{d}}}\left| {\dot x} \right| + c\left| x \right|{\omega _{\rm{d}}} + } \right.\\ & \left. {\left. {{K_{\rm{T}}}{A_{{\rm{ac}}}}\left| x \right|\cos \left( {2{\varphi _x}} \right)/2} \right)\sin \left( {{\omega _{\rm{d}}}t + \varphi } \right)} \right]\left[ { - \sin \left( {{\omega _{\rm{d}}}t + \varphi } \right)} \right] = \\ & - {F_{\rm{d}}}\cos {\omega _{\rm{d}}}t\sin \left( {{\omega _{\rm{d}}}t + \varphi } \right). \end{split} $

对式(15)和(16)进行积化和差后,在ωdt变化的一个周期内对等式两边作积分运算,得到

$\begin{split}& \frac{1}{2}\left( {\left( {k{\rm{ + }}{K_{\rm{T}}}{A_{{\rm{dc}}}}} \right)\left| x \right| - m\left| x \right|{\omega _{\rm{d}}}^2 - \frac{{{K_{\rm{T}}}{A_{{\rm{ac}}}}}}{2}\left| x \right|\sin \left( {2{\varphi _x}} \right)} \right) - \\ & \begin{array}{*{20}{c}} {}&{}&{} \end{array}\qquad\left| x \right|\dot \varphi m{\omega _{\rm{d}}} = \frac{1}{2}{F_{\rm{d}}}\cos \varphi, \end{split} $

$ - \frac{1}{2}\left( {c\left| x \right|{\omega _{\rm{d}}} + \frac{{{K_{\rm{T}}}{A_{{\rm{ac}}}}}}{2}\left| x \right|\cos \left( {2{\varphi _x}} \right)} \right) = - \frac{1}{2}{F_{\rm{d}}}\sin \varphi .$

最终得到控制系统的平均化方程组:

$\left. \begin{aligned} & i = \frac{{\left| x \right|}}{2}\cos \left( {{\varphi _x}} \right),q = - \frac{{\left| x \right|}}{2}\sin \left( {{\varphi _x}} \right) \Rightarrow {\varphi _x} = - \frac{{\text{π}} }{2},\\ & a = \sqrt {{i^2} + {q^2}} \Rightarrow \left| x \right| = 2a,\theta = ar\tan \left( {\frac{q}{i}} \right) \Rightarrow \theta = - {\varphi _x},\\ & {{\dot A}_{{\rm{ac}}}} = - {K_{\rm{p}}}\dot a - {K_{\rm{i}}}\left( {a - {A_{{\rm{ref}}}}} \right) \Rightarrow a = {A_{{\rm{ref}}}},\\ & {{\dot A}_{{\rm{dc}}}} = - {K_{\rm{p}}}\dot \theta + {K_{\rm{i}}}\left( {\theta - {\theta _{{\rm{ref}}}}} \right) \Rightarrow \theta = {\theta _{{\rm{ref}}}},\\ & - \frac{1}{2}\left( {c\left| x \right|{\omega _{\rm{d}}} + \frac{{{K_{\rm{T}}}{A_{{\rm{ac}}}}}}{2}\left| x \right|\cos \left( {2{\varphi _x}} \right)} \right) = \\ & \begin{array}{*{20}{c}} {}&{} \end{array} - \frac{1}{2}{F_{\rm{d}}}\sin \left( {{\varphi _x}} \right) \Rightarrow \left| x \right| = \frac{{{F_{\rm{d}}}}}{{c{\omega _{\rm{d}}} - \left( {{K_{\rm{T}}}{A_{{\rm{ac}}}}} \right){\rm{/2}}}} = 2{A_{{\rm{ref}}}},\\ & \frac{1}{2}\left( {\left( {k{\rm{ + }}{K_{\rm{T}}}{A_{{\rm{dc}}}}} \right)\left| x \right| - m\left| x \right|{\omega _{\rm{d}}}^2 - \frac{{{K_{\rm{T}}}{A_{{\rm{ac}}}}}}{2}\sin \left( {2{\varphi _x}} \right)} \right) - \\ & \begin{array}{*{20}{c}} {}&{} \end{array}\left| x \right|{{\dot \varphi }_x}m{\omega _{\rm{d}}} ={F_{\rm{d}}}\cos \left( {{\varphi _x}} \right)/2 \Rightarrow k{\rm{ + }}{K_{\rm{T}}}{A_{{\rm{dc}}}} = m{\omega _{\rm{d}}}^2. \end{aligned} \right\}$

由式(20)可得,新型CRF-PE控制方案的闭环系统平衡点为

$\left. \begin{gathered} a = {A_{{\rm{ref}}}},\;\theta = {\theta _{{\rm{ref}}}} = {\text{π}}/{2},\;\left| x \right| = 2{A_{{\rm{ref}}}},\qquad \\ {A_{{\rm{ac}}}} = \frac{{2c{\omega _{\rm{d}}}}}{{{K_{\rm{T}}}}} - \frac{{{F_{\rm{d}}}}}{{{K_{\rm{T}}}{A_{{\rm{ref}}}}}},\;{A_{{\rm{dc}}}} = \frac{{k - m{\omega _{\rm{d}}}^2}}{{{K_{\rm{T}}}}}. \end{gathered} \right\}$

在新型CRF-PE控制方案中,被控制的2个对象依旧是检测到的振动位移的幅度和相位. 由式(21)可见,当驱动模态阻尼系数和弹性系数发生改变时,PI控制器对AdcAac进行调节,使得等效弹性系数和等效阻尼系数始终保持恒定,即陀螺驱动模态谐振频率和等效品质因子保持恒定.

2. 仿真结果

图3(a)所示,利用Matlab/Simulink仿真搭建新型CRF-PE控制方案的仿真模型,目的是进一步验证该方案可以在驱动模态的弹性系数和阻尼系数发生改变时调节参数AdcAac,从而保持等效弹性系数和等效品质因子不变. 仿真模型中包括驱动力产生、陀螺驱动模态、解调滤波、求幅度相位、PI控制器、调谐电压合成这5个模块,与图2(b)中的框图一一对应.

图 3

图 3   CRF-PE控制方案仿真模型

Fig.3   Simulation of CRF-PE control model


在仿真过程中需要模拟环境变化造成的驱动模态的弹性系数和阻尼系数的改变,因此陀螺的动力学微分方程采用带反馈环节的仿真模型,如图3(b)所示. 采用的仿真参数如表1所示. 表中,f0为驱动模态本征谐振频率,Q0为驱动模态本征品质因数,KVF为驱动电压/驱动力转换系数,KXV为振动位移/检测电压转换系数.

表 1   CRF-PE控制方案的仿真参数

Tab.1  Simulation parameters of CRF-PE control scheme

参数 数值 单位 参数 数值 单位
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/(mV2

新窗口打开| 下载CSV


在仿真过程中,为了验证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所示,其中,弹性系数kx和阻尼系数cx的变化在仿真模型图3(b)中设定,位移相位θt)、位移幅度at)、直流分量Adc、交流分量幅度Aac在仿真模型图3(a)中进行观察. 等效弹性系数keff和等效品质因子Qeff根据式(8)进行计算.

图 4

图 4   CRF-PE控制方案仿真结果

Fig.4   Simulation results of CRF-PE control scheme


对仿真结果总结如下,在恒频控制和参量激励控制环路闭环后,尽管驱动模态弹性系数和阻尼系数发生了改变,但是在闭环作用下直流分量Adc和交流分量幅度Aac分别调节了等效弹性系数keff和等效品质因子Qeff,使其数值与改变前的弹性系数和阻尼系数相等. 仿真结果表明:CRF-PE控制方案能保持陀螺驱动等效弹性系数和等效品质因子恒定.

3. 实验结果

新型CRF-PE控制方案的实验平台如图5所示,包括硬件电路板、电脑、稳压源、示波器、矢量分析仪和转台.

图 5

图 5   CRF-PE控制方案的实验平台照片

Fig.5   Photo of experimental platform for CRF-PE control


首先,控制系统的幅度参考值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°/ $\sqrt {\rm{h}} $,偏置不稳定性(bias instability, BI)为1.86°/h,而新型CRF-PE控制方案的角度随机游走为0.076°/ $ \sqrt {\rm{h}} $,偏置不稳定性为1.69°/h,可见新方案优于传统PLL-AGC方案.

图 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°/ $\sqrt {\rm{h}} $,偏置不稳定性为1.69°/h,优于传统PLL-AGC方案. 在降温过程中CRF-PE控制方案下的陀螺零偏漂移降到传统PLL-AGC方案下的50%.

所提新型CRF-PE控制方案有效改善了陀螺零偏的稳定性和温漂,但依然存在残留的温漂. 后续的研究可以从3个方面进行:1)对CRF-PE控制方案进行优化,通过对检测模态实现力平衡闭环,利用参量放大增加驱动模态的可动位移等方法,可以进一步改善CRF-PE控制方案下陀螺零偏的温漂;2)优化陀螺器件结构设计,提高三角形电极的调谐能力,即增大驱动模态的调谐系数KT,可以提高新型CRF-PE控制方案的调节谐振频率和品质因子的能力,能使其适用于更广的工作温度范围;3)由于位移/电容转换增益和检测电路增益等依然会引起陀螺零偏发生温漂,可以将新型CRF-PE控制方案与自校准检测方案或者零偏补偿方案相结合,进一步改善零偏的温漂.

参考文献

NORTHEMANN T, MAURER M, ROMBACH S, et al. Phase-locked drive loop with amplitude regulation based on phase-shifting for gyroscope [C] // IEEE International Conference Solid-State Sensors, Actuatrors, and Microsystems (Transducers). Beijing: IEEE, 2011: 16-19.

[本文引用: 1]

OBOE R, ANTONELLO R, LASALANDRA E, et al

Control of a Z-axis MEMS vibrational gyroscope

[J]. IEEE/ASME Transactions on Mechatronics, 2005, 10 (4): 364- 370

DOI:10.1109/TMECH.2005.852437      [本文引用: 1]

CUI J, CHI X Z, DING H T, et al

Transient response and stability of the AGC-PI closed-loop controlled MEMS vibratory gyroscopes

[J]. Journal of Micromechanics and Microengineering, 2009, 19 (12): 125015

DOI:10.1088/0960-1317/19/12/125015      [本文引用: 1]

ZHU H J, JIN Z H, HU S C, et al. Drive mode control for MEMS gyroscopes with electrostatically tunable structure [C] // IEEE International Conference on Manipulation, Manufacturing and Measurement on the Nanoscale (3M-Nano). Suzhou: IEEE, 2014: 273-276.

[本文引用: 1]

OROPEZA-RAMOS L A, TURNER K L. Parametric resonance amplification in a MEMGyroscope [C] // IEEE Sensors. Irvine: IEEE, 2005: 660-663.

[本文引用: 1]

HARISH K M, GALLACHER B J, BURDESS J S, et al

Experimental investigation of parametric and externally forced motion in resonant MEMS sensors

[J]. Journal of Micromechanics and Microengineering, 2008, 19 (1): 015021

KHIRALLAH K

Parametric excitation, amplifica-tion, and tuning of MEMS folded-beam comb drive oscillator

[J]. Journal of Microelectromechanical Systems, 2013, 22 (2): 318- 330

DOI:10.1109/JMEMS.2012.2221156     

NITZAN S H, ZEGA V, LI M, et al

Self-induced parametric amplification arising from nonlinear elastic coupling in a micromechanical resonating disk gyroscope

[J]. Scientific Reports, 2015, 5: 9036

DOI:10.1038/srep09036      [本文引用: 1]

GALLACHER B J, BURDESS J S, HARISH K M

A control scheme for a MEMS electrostatic resonant gyroscope excited using combined parametric excitation and harmonic forcing

[J]. Journal of Micromechanics and Microengineering, 2006, 16 (2): 320- 331

DOI:10.1088/0960-1317/16/2/017      [本文引用: 1]

SENKAL D, NG E J, HONG V, et al. Parametric drive of a toroidal MEMS rate integrating gyroscope demonstrating <20 PPM scale factor stability [C] // 28th IEEE International Conference on Micro Electro Mechanical Systems (MEMS). Estoril: IEEE, 2015: 29-32.

ZHANG X F, ZHAO H M, XU D C, et al. Research of suppressing electrical feed-through for resonant ring MEMS gyroscope based on parametric excitation [C] // 2018 2nd IEEE Advanced Information Management, Communicates, Electronic and Automation Control Conference (IMCEC). Xi' an: IEEE, 2018: 133-136.

[本文引用: 1]

HU S C, JIN Z H, ZHU H J, et al

A Slot-structure MEMS gyroscope working at atmosphere with tunable electrostatic spring constant

[J]. Journal of Microelectromechanical Systems, 2013, 22 (4): 909- 918

DOI:10.1109/JMEMS.2013.2250485      [本文引用: 1]

钱磊, 赵鹤鸣, 张晓峰, 等

基于参数激励的MEMS环式陀螺驱动方法与实现

[J]. 智能与传感技术, 2018, 26 (11): 293- 302

[本文引用: 1]

QIAN Lei, ZHAO He-ming, ZHANG Xiao-feng, et al

Improvement of MEMS gyroscope driving method based on parametric excitation

[J]. Computer Measurement and Control, 2018, 26 (11): 293- 302

[本文引用: 1]

RUGAR D, GRUTTER P

Mechanical parametric amplification and thermomechanical noise squeezing

[J]. Physical Review Letters, 1991, 67 (6): 699- 702

DOI:10.1103/PhysRevLett.67.699      [本文引用: 1]

WU H B, ZHENG X D, LIN Y Y, et al. A novel amplitude-phase information extraction architecture for MEMS vibratory gyroscopes using a modified double side-band demodulation configuration [C] // 2018 IEEE Sensors. New Delhi: IEEE, 2018: 1134-1137.

[本文引用: 1]

ZHENG X, D LIU S Q, LIN Y Y, et al

An improved phase-robust configuration for vibration amplitude-phase extraction for capacitive MEMS gyroscopes

[J]. Micromachines, 2018, 9 (7): 362

DOI:10.3390/mi9070362      [本文引用: 1]

LIN Y Y, ZHENG X D, LIU S Q, et al

Temperature-dependence improvement for a MEMS gyroscope using triangular-electrode based capacitive detection method

[J]. IET Micro & Nano Letters, 2017, 12 (11): 828- 833

[本文引用: 1]

WALTHER A, BLANC C L, DELORME N, et al

Bias contributions in a MEMS tuning fork gyroscope

[J]. Journal of Microelectromechanical Systems, 2013, 22 (2): 303- 308

DOI:10.1109/JMEMS.2012.2221158      [本文引用: 1]

SANDERS J A, VERHULST F, MURDOCK J. Averaging methods in nonlinear dynamical systems [M]. 2th ed. New York: Spring, 2007.

[本文引用: 1]

/