硅微机械陀螺快速热启动实现方法
【专利摘要】本发明公开了一种实现硅微机械陀螺快速热启动的方法，属于微机电系统设计领域。通过利用敏感模态电路各信号之间的相位关系，采用四则混合运算抑制系统相位误差分量引入的零位温度漂移，并根据驱动模态电路控制原理，利用驱动模态直流激励电压与谐振频率的关系，通过线性拟合方法抑制系统正交误差分量引入的零位温度漂移，从而实现陀螺系统快速热启动。本发明通过处理敏感模态检测电路的相位关系抑制系统相位误差分量引入的零位温度漂移，进一步通过驱动模态直流激励电压、谐振频率的线性关系，利用线性拟合抑制系统正交误差分量引入的零位温度漂移，从而实现陀螺系统快速热启动。
【专利说明】
硅微机械陀螺快速热启动实现方法
技术领域
[0001] 本发明涉及一种实现硅微机械陀螺快速热启动的方法，属于微机电系统设计领 域。
【背景技术】
[0002] 陀螺是一种用来测量物体旋转角速率的惯性器件，在导航制导、深空探测、平台稳 定控制、汽车工业、消费电子等领域具有重要的应用。
[0003] 热启动时间是评价硅微机械陀螺性能的重要指标，因此，实现硅微机械陀螺的快 速热启动具有重要意义。热启动过程是硅微机械陀螺零位漂移随陀螺温度达到稳态而逐渐 稳定的过程，根据文献"Bias Contribution Modeling for a Symmetrical Micromachined Coriolis Vibratory Gyroscope"，陀螺零位主要由系统的正交分量以及 相位误差分量决定。系统的正交误差主要由驱动模态与敏感模态的不等刚度引入，在热启 动过程中，刚度随着温度变化而变化导致正交误差引入的零位分量随温度变化;相位误差 主要由陀螺驱动模态与敏感模态频率差以及敏感模态检测电路的相位延迟共同决定，在热 启动过程中，两模态频差以及相位延迟随温度变化而变化导致相位误差引入的零位分量随 温度变化。因此，若要实现硅微机械陀螺零位的快速热启动，就必须实现对正交误差分量以 及相位误差分量的联合补偿。
【发明内容】
[0004] 本发明提出一种面向硅微机械陀螺零位漂移的快速热启动方法。通过利用敏感模 态电路各信号之间的相位关系，采用四则混合运算抑制系统相位误差分量引入的零位温度 漂移，并根据驱动模态电路控制原理，利用驱动模态直流激励电压与谐振频率的关系，通过 线性拟合方法抑制系统正交误差分量引入的零位温度漂移，从而实现陀螺系统快速热启 动。
[0005] 本发明提出的硅微机械陀螺快速热启动方法原理是:参考图1。
[0006] 本发明提出的硅微机械陀螺快速热启动方法过程为：
[0007] 首先，陀螺系统由陀螺表头、驱动模态电路、敏感模态电路以及热启动控制电路组 成;陀螺表头驱动模态的检测信号进入驱动电路模块，经过C/V转换1、增益1、移相器、自动 增益控制等模块后，生成驱动激励电压，施加到陀螺表头驱动激励电极控制驱动模态稳幅 振动;其中C/V转换1将电容信号转化成电压信号并通过增益1模块后产生电压信号，再将该 电压信号通过移相器进行90°相移，接着通过自动增益控制模块产生直流电压V dc，并将该直 流电压与移相器的输出电压相加后加载到陀螺表头驱动模态实现驱动模态稳幅振动。
[0008] 接着，由于陀螺驱动模态与敏感模态的刚度不相等，当驱动模态振动时，敏感模态 产生正交误差力，此时，由于哥氏效应，陀螺敏感模态也将产生哥氏力；当哥氏力与正交误 差力共同作用陀螺敏感模态时，通过敏感模态电路的C/V转换2模块分别得到哥氏力和正交 误差力对应的电压信号，再通过增益2模块得到放大后的电压信号；该电压信号分为两路： 一路与驱动模态电路的移相器输出信号相乘，再通过低通滤波器1模块得到直流电压，再将 该直流电压引入增益3模块进行信号放大得到直流电压信号，其中增益3模块的放大倍数由 增益2输出电压信号与移相器输出电压信号通过鉴相器控制获得;另一路与驱动模态电路 增益1模块的输出信号相乘，再将该直流电压引入增益4模块进行信号放大得到直流电压信 号，同理，增益4模块的放大倍数由增益2输出电压信号与移相器输出电压信号通过鉴相器 控制获得;接着将两路直流电压信号进行相加后再与自动增益控制模块输出的直流电压进 行放大后相减，最终得到零温漂的角速度输出信号，实现陀螺快速热启动。
[0009]本发明的有益效果是:通过处理敏感模态检测电路的相位关系抑制系统相位误差 分量引入的零位温度漂移，进一步通过驱动模态直流激励电压、谐振频率的线性关系，利用 线性拟合抑制系统正交误差分量引入的零位温度漂移，从而实现陀螺系统快速热启动。 [0010]下面结合图和实施例对本发明进一步说明。
【附图说明】
[0011] 图1是实施例中硅微机械陀螺快速热启动实现方法的原理图。
【具体实施方式】
[0012] 本实施例中给出了一种实现硅微机械陀螺快速热启动的方法，该实施例中的原理 为：
[0013] 首先，陀螺表头驱动模态的检测信号进入驱动电路模块，C/V转换1将电容信号转 化成电压信号并通过增益1后的电压信号为k QXsin(cod(T)t)，其中ko为移相器输出到增益1 输出的增益，X为驱动位移，ω d(T)为驱动模态谐振频率，且是温度T的函数;增益ko为0.2ν/μ m，驱动位移X设为5μπι，移相器产生90°相移后变为lcos(co d(T)t)、通过自动增益控制单元 后，驱动激励直流电压Vd。为2V，再与lcos(cod(T)t)相加后施加到陀螺表头驱动激励电极控 制驱动t旲态稳幅振汤在5 Mi。
[0014] 接着，当驱动模态振动时，敏感模态产生正交误差分量kdsXsin(c〇d(T)t)，当有角 速度输入时，由哥氏效应产生的哥氏力为2Q mWdXC0S( (〇(1(!')〇，111 = 2\10_71^，代入后为 2.5Χ10-13Ω cod(T)c〇S(cod(T)t)，当哥氏力与正交误差分量共同作用陀螺敏感模态时，通 过敏感模态电路的C/V转换2，增益2等模块后，得到电压信号为：
[0015] Vde = 2kiQm〇d(T)Xcos(〇d(T)t+n(T))+kikdsXsin(〇d(T)t+n(T))
[0016] =7X10-7Ω cod(T)cos( cod(T)t+n(T))+31kdssin( cod(T)t+n(T))
[0017]其中，增益kA3X107，ri(T)通过鉴相器模块获得;上式右边第一项为哥氏力对应 的输出电压，第二项为正交误差力对应的输出电压，Iu为敏感模态单元输入信号到增益2单 元输出信号的增益，η(τ)为哥氏力与正交误差力通过陀螺敏感模态、C/V转换2以及增益2等 单元后产生的相位误差且是温度的函数，正交分量kikdsXsir^coXlOt+rKT))的相位误差Tl (T)与ω d (T)受温度变化影响陀螺零位热启动时间。
[0018]在热启动控制电路中，Vde与驱动模态电路中的移相器输入、输出信号相乘，再分别 通过低通滤波器1、低通滤波器2得到V1、Vq，低通滤波器的截止频率均设置为40Hz，
[0019]
[0020]
[0021] 进一步，分别通过增益3、增益4,得到ViG，Vqc，其中增益3为cos(n(T))，增益4为sin (n(T))，ri(T)通过鉴相器比较增益2输出信号与移相器输出信号的相位差获得，通过推导可 知：
[0022]
[0023]
[0024]
[0025]
[0026] 输出电压Vciut没有相位误差Il(T)以及正交误差的耦合刚度kds，且当Ω=〇时，零位 输出电压为+ 恒定不变，因此陀螺零位的温度漂移以及热启动过程不受相位误差和 2 正交误差分量影响；当Ω矣0时，此时角速度输出电压热漂移受增益k^lu，驱动位移X以及谐 振频率Cod(T)影响，根据电路控制原理，采用零温漂的阻容器件实现增益ko，!^控制，因此 khh在热启动过程中保持恒定不变；由驱动模态电路控制原理可知，当谐振频率c〇d(T)在 热启动过程中受温度影响变化时，自动增益控制模块根据谐振频率变化能够自动调整它的 输出直流电压Vd。，再将调整后的直流电压加载到驱动模态上，从而保持驱动位移)(恒定不 变。因此，输出电压热漂移仅受谐振频率ω d(T)影响，在100 °C的温度变化范围内，温度T与 谐振频率ω d(T)呈线性关系ω d(T) =kwT+ ω <!()，1^是一次项系数，ω dQ是谐振频率初始值，又 由于驱动模态电路为线性系统，因此，谐振频率ω d与直流电压Vd。呈线性关系，Vtk(T) =kd J +b，b是初始值，kdc是直流电压与谐振频率的斜率，通过测量直流电压Vdc (T)以及线性拟合， 当koluX2 Ω mku = ktkdc时，初始谐振频率ω dQ = 231X 4000，得到最终角速率输出电压：
[0027:
[0028:
[0029:
[0030]由上式可以看出，当Ω=〇时，零位输出电压恒定不变，即零位漂移以及热启动过
【主权项】
1.硅微机械陀螺快速热启动方法，其特征在于，过程如下： 首先，陀螺系统由陀螺表头、驱动模态电路、敏感模态电路以及热启动控制电路组成； 陀螺表头驱动模态的检测信号进入驱动电路模块，经过C/V转换1、增益1、移相器、自动增益 控制等模块后，生成驱动激励电压，施加到陀螺表头驱动激励电极控制驱动模态稳幅振动； 其中C/ν转换1将电容信号转化成电压信号并通过增益1模块后产生电压信号，再将该电压 信号通过移相器进行90°相移，接着通过自动增益控制模块产生直流电压Vdc，并将该直流电 压与移相器的输出电压相加后加载到陀螺表头驱动模态实现驱动模态稳幅振动； 接着，由于陀螺驱动模态与敏感模态的刚度不相等，当驱动模态振动时，敏感模态产生 正交误差力，此时，由于哥氏效应，陀螺敏感模态也将产生哥氏力；当哥氏力与正交误差力 共同作用陀螺敏感模态时，通过敏感模态电路的C/ν转换2模块分别得到哥氏力和正交误差 力对应的电压信号，再通过增益2模块得到放大后的电压信号；该电压信号分为两路:一路 与驱动模态电路的移相器输出信号相乘，再通过低通滤波器1模块得到直流电压，再将该直 流电压引入增益3模块进行信号放大得到直流电压信号，其中增益3模块的放大倍数由增益 2输出电压信号与移相器输出电压信号通过鉴相器控制获得;另一路与驱动模态电路增益1 模块的输出信号相乘，再将该直流电压引入增益4模块进行信号放大得到直流电压信号，同 理，增益4模块的放大倍数由增益2输出电压信号与移相器输出电压信号通过鉴相器控制获 得;接着将两路直流电压信号进行相加后再与自动增益控制模块输出的直流电压进行放大 后相减，最终得到零温漂的角速度输出信号，实现陀螺快速热启动。
【文档编号】G01C19/5776GK105841685SQ201610300725
【公开日】2016年8月10日
【申请日】2016年5月9日
【发明人】苑伟政, 申强, 谢建兵, 常洪龙
【申请人】西北工业大学