CN104897150B - 一种提升硅微机械陀螺仪带宽全温性能的方法 - Google Patents
一种提升硅微机械陀螺仪带宽全温性能的方法 Download PDFInfo
- Publication number
- CN104897150B CN104897150B CN201510334584.0A CN201510334584A CN104897150B CN 104897150 B CN104897150 B CN 104897150B CN 201510334584 A CN201510334584 A CN 201510334584A CN 104897150 B CN104897150 B CN 104897150B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- resistance
- mfrac
- micro
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
- G01C19/5776—Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Signal Processing (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及微机械陀螺仪,具体是一种提升硅微机械陀螺仪带宽全温性能的方法。本发明解决了微机械陀螺仪无法兼顾机械灵敏度和带宽、带宽全温性能差的问题。一种提升硅微机械陀螺仪带宽全温性能的方法,该方法是采用如下步骤实现的:1)以扫频的方式确定微机械陀螺仪驱动模态和检测模态的谐振角频率;2)根据微机械陀螺仪驱动模态和检测模态扫频测试的结果,计算得出微机械陀螺仪驱动模态和检测模态的品质因数;3)在微机械陀螺仪的检测回路中增设偶极子全温跟踪补偿控制器;所述偶极子全温跟踪补偿控制器包括温度补偿环节、零极点发生环节、比例环节。本发明适用于微机械陀螺仪。
Description
技术领域
本发明涉及微机械陀螺仪,具体是一种提升硅微机械陀螺仪带宽全温性能的方法。
背景技术
微机械陀螺仪是一种采用哥氏效应原理敏感载体输入角速率信息的传感器,其具有体积小、功耗低、重量轻、成本低、抗过载特性强、易于集成化和批量生产等优点,并广泛应用于诸多领域(比如惯性导航、汽车安全、工业控制、消费电子等)。如图1-图2所示,微机械陀螺仪包括陀螺结构、陀螺测控电路。所述陀螺结构包括驱动轴向结构、检测轴向结构。所述检测轴向结构包括哥氏质量、检测位移提取结构(若检测回路为闭环回路,则检测轴向结构还包括检测力反馈结构)。所述陀螺测控电路包括驱动闭环回路、检测回路。所述检测回路包括前级放大接口、次级放大器、解调器、第一低通滤波器、第二低通滤波器(若检测回路为闭环回路,则检测回路还包括调制器和直流信号叠加装置)。微机械陀螺仪的工作模态包含驱动模态和检测模态。工作时,沿微机械陀螺仪输入轴施加输入角速率信号,则微机械陀螺仪的检测回路产生输出信号。
微机械陀螺仪的动力方程为:
式(A1)中:x为驱动轴向结构的位移;ωx为微机械陀螺仪驱动模态的谐振角频率;Qx为微机械陀螺仪驱动模态的品质因数;Fdx为驱动轴向结构所受的驱动力;mx为驱动轴向结构的等效质量;kx为驱动模态等效刚度;cx为驱动模态等效阻尼;Fd为驱动模态驱动力幅度;ωd为驱动模态驱动力的角频率(通常有ωd=ωx);y为检测轴向结构的位移;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Ωz为微机械陀螺仪的输入角速率;ky为检测模态等效刚度;my为检测轴向结构的等效质量;cy为检测模态等效阻尼。
由于微机械陀螺仪通常采用真空封装,致使微机械陀螺仪检测模态的品质因数很大(在2000以上),因此对式(A1)进一步求解可得:
式(A3)-(A4)中:x为驱动轴向结构的位移;Fd为驱动模态驱动力幅度;mx为驱动轴向结构的等效质量;ωx为微机械陀螺仪驱动模态的谐振角频率;ωd为驱动模态驱动力的角频率;Qx为微机械陀螺仪驱动模态的品质因数;y为检测轴向结构的位移;Fc为哥氏力;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Ωz为微机械陀螺仪的输入角速率。
根据式(A2)-(A4),可以得到微机械陀螺仪的机械灵敏度为:
式(A5)中:Smachenical为微机械陀螺仪的机械灵敏度;Fd为驱动模态驱动力幅度;Qx为微机械陀螺仪驱动模态的品质因数;mx为驱动轴向结构的等效质量;ωd为驱动模态驱动力的角频率;ωy为微机械陀螺仪检测模态的谐振角频率;Ax为驱动轴向结构的运动幅度;Δf为微机械陀螺仪的模态频差(微机械陀螺仪驱动模态和检测模态的谐振角频率之差)。
根据式(A5)可知,微机械陀螺仪的机械灵敏度与微机械陀螺仪的模态频差成反比。
微机械陀螺仪的标度因数为:
式(A6)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Ax为驱动轴向结构的运动幅度;ωd为驱动模态驱动力的角频率;Vdac为驱动模态激励信号的幅度;Kyc为检测位移提取结构的转换系数;Kpre为前级放大接口的增益倍数;Ksec为次级放大器的增益倍数;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数。
由于微机械陀螺仪检测模态在真空封装状态下的品质因数很大(在2000以上),因此根据式(A6)可知,微机械陀螺仪存在四个共轭极点:
式(A7)中:p1、p2、p3、p4为微机械陀螺仪存在的四个共轭极点;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;ωd为驱动模态驱动力的角频率。
由于微机械陀螺仪检测模态在真空封装状态下的品质因数很大(在2000以上),通过对式(A7)进行化简可以发现,微机械陀螺仪在其模态频差处和模态频和(微机械陀螺仪驱动模态和检测模态的谐振角频率之和)处各存在两个共轭极点:
式(A8)中:p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;ωd为驱动模态驱动力的角频率;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点。
如图5所示,微机械陀螺仪在其模态频差处存在的两个共轭极点会使得微机械陀螺仪的标度因数在微机械陀螺仪的模态频差处达到峰值,并使得微机械陀螺仪的相位剧烈变化180°。微机械陀螺仪在其模态频和处存在的两个共轭极点对微机械陀螺仪带宽的影响则可以忽略。
通过对式(A6)进行化简可得:
式(A9)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Ax为驱动轴向结构的运动幅度;Vdac为驱动模态激励信号的幅度;Kyc为检测位移提取结构的转换系数;Kpre为前级放大接口的增益倍数;Ksec为次级放大器的增益倍数;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;Δf为微机械陀螺仪的模态频差。
根据式(A9)可知,微机械陀螺仪的带宽为:
fb=0.54Δf (A11);
式(A10)-(A11)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;fb为微机械陀螺仪的带宽;Δf为微机械陀螺仪的模态频差。
根据式(A11)可知,微机械陀螺仪的带宽与微机械陀螺仪的模态频差成正比。
然而在实际应用中,一方面为了提高微机械陀螺仪的机械灵敏度(以此提高微机械陀螺仪的分辨率、阈值、信噪比、零偏稳定性、噪声特性),需要减小微机械陀螺仪的模态频差,另一方面为了增大微机械陀螺仪的带宽,需要增大微机械陀螺仪的模态频差,由此使得提高微机械陀螺仪的机械灵敏度和增大微机械陀螺仪的带宽成为一对矛盾,从而导致微机械陀螺仪无法兼顾机械灵敏度和带宽。此外,如图7所示,由于制造微机械陀螺仪的材料为硅,使得微机械陀螺仪驱动模态和检测模态的谐振角频率、微机械陀螺仪驱动模态和检测模态的品质因数均会随着外界温度变化而发生变化,由此使得微机械陀螺仪的模态频差随着外界温度变化而发生变化,从而使得微机械陀螺仪在其模态频差处存在的两个共轭极点随着外界温度变化而发生漂移,进而导致微机械陀螺仪的带宽全温性能差(一方面导致微机械陀螺仪的带宽在全温范围内变化大,另一方面导致微机械陀螺仪的带内平整度差)。基于此,有必要发明一种全新的方法,以解决微机械陀螺仪无法兼顾机械灵敏度和带宽、带宽全温性能差的问题。
发明内容
本发明为了解决微机械陀螺仪无法兼顾机械灵敏度和带宽、带宽全温性能差的问题,提供了一种提升硅微机械陀螺仪带宽全温性能的方法。
本发明是采用如下技术方案实现的:一种提升硅微机械陀螺仪带宽全温性能的方法,该方法是采用如下步骤实现的:
1)以扫频的方式确定微机械陀螺仪驱动模态和检测模态的谐振角频率;
2)根据微机械陀螺仪驱动模态和检测模态扫频测试的结果,计算得出微机械陀螺仪驱动模态和检测模态的品质因数,具体计算公式如下:
式(A12)中:Qx为微机械陀螺仪驱动模态的品质因数;ωx为微机械陀螺仪驱动模态的谐振角频率;ωx-3、ωx+3为比微机械陀螺仪驱动模态固有频率状态下的信号幅值小3分贝信号幅值对应的两个输入角速率信号频率点,且ωx-3<ωx<ωx+3;Qy为微机械陀螺仪检测模态的品质因数;ωy为微机械陀螺仪检测模态的谐振角频率;ωy-3、ωy+3为比微机械陀螺仪检测模态固有频率状态下的信号幅值小3分贝信号幅值对应的两个输入角速率信号频率点,且ωy-3<ωy<ωy+3;
根据微机械陀螺仪驱动模态和检测模态的品质因数,计算得出微机械陀螺仪的标度因数,具体计算公式如下:
式(A13)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Ax为驱动轴向结构的运动幅度;ωd为驱动模态驱动力的角频率;Vdac为驱动模态激励信号的幅度;Kyc为检测位移提取结构的转换系数;Kpre为前级放大接口的增益倍数;Ksec为次级放大器的增益倍数;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
通过对式(A13)进行化简可得:
式(A14)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
3)在微机械陀螺仪的检测回路中增设偶极子全温跟踪补偿控制器;所述偶极子全温跟踪补偿控制器包括温度补偿环节、零极点发生环节、比例环节;
所述温度补偿环节包括第一运算放大器、第一温度补偿电阻、具有正温度系数的热敏电阻、第二温度补偿电阻;
所述零极点发生环节包括第二运算放大器、第三运算放大器、第四运算放大器、第五运算放大器、第一电容、第二电容、第二电阻、第三电阻、第四电阻、第五电阻、第六电阻、第七电阻、第八电阻、第九电阻、第十电阻;
所述比例环节包括第六运算放大器、第十一电阻、第十二电阻;
第一运算放大器的正输入端与第一低通滤波器的输出端连接;第二运算放大器的正输入端、第三运算放大器的正输入端、第四运算放大器的正输入端、第五运算放大器的正输入端、第六运算放大器的正输入端均接地;第六运算放大器的输出端与第二低通滤波器的输入端连接;
第一电容的两端分别与第二运算放大器的负输入端和输出端连接;第二电容的两端分别与第三运算放大器的负输入端和输出端连接;
第一温度补偿电阻的一端接地,另一端与第一运算放大器的负输入端连接;具有正温度系数的热敏电阻的两端分别与第一运算放大器的负输入端和输出端连接;第二温度补偿电阻的两端分别与第一运算放大器的输出端和第二运算放大器的负输入端连接;第二电阻的两端分别与第二运算放大器的输出端和第三运算放大器的负输入端连接;第三电阻的两端分别与第二运算放大器的负输入端和第四运算放大器的输出端连接;第四电阻的两端分别与第五运算放大器的负输入端和输出端连接;第五电阻的两端分别与第一低通滤波器的输出端和第五运算放大器的负输入端连接;第六电阻的两端分别与第四运算放大器的输出端和第五运算放大器的负输入端连接;第七电阻的两端分别与第四运算放大器的负输入端和输出端连接;第八电阻的两端分别与第一低通滤波器的输出端和第四运算放大器的负输入端连接;第九电阻的两端分别与第三运算放大器的输出端和第四运算放大器的负输入端连接;第十电阻的两端分别与第五运算放大器的输出端和第三运算放大器的负输入端连接;第十一电阻的两端分别与第四运算放大器的输出端和第六运算放大器的负输入端连接;第十二电阻的两端分别与第六运算放大器的负输入端和输出端连接;
设偶极子全温跟踪补偿控制器的传递函数为:
式(A15)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Kdcc为偶极子全温跟踪补偿控制器的增益;偶极子全温跟踪补偿控制器的增益由比例环节产生;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点(应设置在拟拓展的带宽以外);偶极子全温跟踪补偿控制器的两个共轭零点和极点由零极点发生环节产生;
增设偶极子全温跟踪补偿控制器后,微机械陀螺仪的标度因数变为式(A14)和式(A15)的乘积:
式(A16)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;Kdcc为偶极子全温跟踪补偿控制器的增益;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
设计偶极子全温跟踪补偿控制器的两个共轭零点,使得偶极子全温跟踪补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子:
式(A17)中:p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;
通过对式(A16)进行化简可得:
式(A18)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;Kdcc为偶极子全温跟踪补偿控制器的增益;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
根据式(A18)可知,微机械陀螺仪的标度因数不再受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约,而仅受偶极子全温跟踪补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约,由此使得微机械陀螺仪的带宽不再受微机械陀螺仪的模态频差的制约;
根据偶极子全温跟踪补偿控制器的结构可知,偶极子全温跟踪补偿控制器的传递函数为:
式(A19)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Vfo为控制器输出;Vfi为控制器输入;Rf1为等效电阻,且令Rf1b>>Rf1a,则Rf1a为第一温度补偿电阻的阻值;Rf1b为具有正温度系数的热敏电阻的阻值;Rf1c为第二温度补偿电阻的阻值;Rf2为第二电阻的阻值;Rf3为第三电阻的阻值;Rf4为第四电阻的阻值;Rf5为第五电阻的阻值;Rf6为第六电阻的阻值;Rf7为第七电阻的阻值;Rf8为第八电阻的阻值;Rf9为第九电阻的阻值;Rf10为第十电阻的阻值;Rf11为第十一电阻的阻值;Rf12为第十二电阻的阻值;
将式(A8)和式(A17)代入式(A15),可得:
式(A20)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Kdcc为偶极子全温跟踪补偿控制器的增益;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Δω2为偶极子全温跟踪补偿控制器的两个共轭零点的乘积,同时也为微机械陀螺仪在其模态频差处存在的两个共轭极点的乘积;ωFn 2为偶极子全温跟踪补偿控制器的两个极点的乘积;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
将式(A19)和式(A20)进行结合,可得:
式(A21)中:ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Δω2为偶极子全温跟踪补偿控制器的两个共轭零点的乘积,同时也为微机械陀螺仪在其模态频差处存在的两个共轭极点的乘积;ωFn 2为偶极子全温跟踪补偿控制器的两个极点的乘积;Kdcc为偶极子全温跟踪补偿控制器的增益;Rf1为等效电阻,且令Rf1b>>Rf1a,则Rf1a为第一温度补偿电阻的阻值;Rf1b为具有正温度系数的热敏电阻的阻值;Rf1c为第二温度补偿电阻的阻值;Rf2为第二电阻的阻值;Rf3为第三电阻的阻值;Rf4为第四电阻的阻值;Rf5为第五电阻的阻值;Rf6为第六电阻的阻值;Rf7为第七电阻的阻值;Rf8为第八电阻的阻值;Rf9为第九电阻的阻值;Rf10为第十电阻的阻值;Rf11为第十一电阻的阻值;Rf12为第十二电阻的阻值;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
根据式(A21)可知,当外界温度变化时,具有正温度系数的热敏电阻的阻值发生变化,使得等效电阻发生变化,由此使得偶极子全温跟踪补偿控制器的两个共轭零点发生漂移,从而使得偶极子全温跟踪补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点在外界温度变化时始终组成偶极子;
因此,根据式(A18)可知,微机械陀螺仪的标度因数在外界温度变化时始终不受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约,而仅受偶极子全温跟踪补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约,由此使得微机械陀螺仪的带宽在外界温度变化时始终不受微机械陀螺仪的模态频差的制约。
本发明所述的一种提升硅微机械陀螺仪带宽全温性能的方法基于偶极子补偿原理,通过将偶极子全温跟踪补偿控制器产生的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子,消除了微机械陀螺仪的模态频差对带宽的制约,由此使得增大微机械陀螺仪的带宽不再需要增大微机械陀螺仪的模态频差,从而使得提高微机械陀螺仪的机械灵敏度和增大微机械陀螺仪的带宽不再矛盾,进而使得微机械陀螺仪能够完全兼顾机械灵敏度和带宽。此外,本发明所述的一种提升硅微机械陀螺仪带宽全温性能的方法基于温度补偿原理,通过采用温度补偿环节,实现了对微机械陀螺仪在其模态频差处存在的两个共轭极点进行全温跟踪补偿(当微机械陀螺仪在其模态频差处存在的两个共轭极点发生漂移时,偶极子全温跟踪补偿控制器产生的两个共轭零点同样发生漂移,由此使得在外界温度变化时偶极子全温跟踪补偿控制器产生的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点始终组成偶极子),由此有效提升了微机械陀螺仪的带宽全温性能(一方面使得微机械陀螺仪的带宽在全温范围内变化很小,另一方面使得微机械陀螺仪的带内平整度很好),如图8-图9所示。
本发明有效解决了微机械陀螺仪无法兼顾机械灵敏度和带宽、带宽全温性能差的问题,适用于微机械陀螺仪。
附图说明
图1是本发明的微机械陀螺仪的结构示意图。
图2是本发明的微机械陀螺仪的检测回路的结构示意图。
图3是本发明的偶极子全温跟踪补偿控制器的结构示意图。
图4是本发明的偶极子全温跟踪补偿控制器的电路原理图。
图5是微机械陀螺仪在其模态频差处存在的两个共轭极点对微机械陀螺仪的标度因数和相位的影响示意图。
图6是本发明的偶极子的形成原理示意图。
图7是微机械陀螺仪驱动模态和检测模态的谐振角频率、微机械陀螺仪驱动模态和检测模态的品质因数的全温变化曲线图。
图8是未增设温度补偿环节时微机械陀螺仪的输入输出波特图。
图9是增设温度补偿环节后微机械陀螺仪的输入输出波特图。
图中:XS为驱动模态激励信号;YS为检测模态激励信号;XV为驱动位移信号;YV为检测位移信号。
具体实施方式
一种提升硅微机械陀螺仪带宽全温性能的方法,该方法是采用如下步骤实现的:
1)以扫频的方式确定微机械陀螺仪驱动模态和检测模态的谐振角频率;
2)根据微机械陀螺仪驱动模态和检测模态扫频测试的结果,计算得出微机械陀螺仪驱动模态和检测模态的品质因数,具体计算公式如下:
式(A12)中:Qx为微机械陀螺仪驱动模态的品质因数;ωx为微机械陀螺仪驱动模态的谐振角频率;ωx-3、ωx+3为比微机械陀螺仪驱动模态固有频率状态下的信号幅值小3分贝信号幅值对应的两个输入角速率信号频率点,且ωx-3<ωx<ωx+3;Qy为微机械陀螺仪检测模态的品质因数;ωy为微机械陀螺仪检测模态的谐振角频率;ωy-3、ωy+3为比微机械陀螺仪检测模态固有频率状态下的信号幅值小3分贝信号幅值对应的两个输入角速率信号频率点,且ωy-3<ωy<ωy+3;
根据微机械陀螺仪驱动模态和检测模态的品质因数,计算得出微机械陀螺仪的标度因数,具体计算公式如下:
式(A13)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Ax为驱动轴向结构的运动幅度;ωd为驱动模态驱动力的角频率;Vdac为驱动模态激励信号的幅度;Kyc为检测位移提取结构的转换系数;Kpre为前级放大接口的增益倍数;Ksec为次级放大器的增益倍数;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
通过对式(A13)进行化简可得:
式(A14)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
3)在微机械陀螺仪的检测回路中增设偶极子全温跟踪补偿控制器;所述偶极子全温跟踪补偿控制器包括温度补偿环节、零极点发生环节、比例环节;
所述温度补偿环节包括第一运算放大器T1、第一温度补偿电阻Rf1a、具有正温度系数的热敏电阻Rf1b、第二温度补偿电阻Rf1c;
所述零极点发生环节包括第二运算放大器T2、第三运算放大器T3、第四运算放大器T4、第五运算放大器T5、第一电容Cf1、第二电容Cf2、第二电阻Rf2、第三电阻Rf3、第四电阻Rf4、第五电阻Rf5、第六电阻Rf6、第七电阻Rf7、第八电阻Rf8、第九电阻Rf9、第十电阻Rf10;
所述比例环节包括第六运算放大器T6、第十一电阻Rf11、第十二电阻Rf12;
第一运算放大器T1的正输入端与第一低通滤波器的输出端连接;第二运算放大器T2的正输入端、第三运算放大器T3的正输入端、第四运算放大器T4的正输入端、第五运算放大器T5的正输入端、第六运算放大器T6的正输入端均接地;第六运算放大器T6的输出端与第二低通滤波器的输入端连接;
第一电容Cf1的两端分别与第二运算放大器T2的负输入端和输出端连接;第二电容Cf2的两端分别与第三运算放大器T3的负输入端和输出端连接;
第一温度补偿电阻Rf1a的一端接地,另一端与第一运算放大器T1的负输入端连接;具有正温度系数的热敏电阻Rf1b的两端分别与第一运算放大器T1的负输入端和输出端连接;第二温度补偿电阻Rf1c的两端分别与第一运算放大器T1的输出端和第二运算放大器T2的负输入端连接;第二电阻Rf2的两端分别与第二运算放大器T2的输出端和第三运算放大器T3的负输入端连接;第三电阻Rf3的两端分别与第二运算放大器T2的负输入端和第四运算放大器T4的输出端连接;第四电阻Rf4的两端分别与第五运算放大器T5的负输入端和输出端连接;第五电阻Rf5的两端分别与第一低通滤波器的输出端和第五运算放大器T5的负输入端连接;第六电阻Rf6的两端分别与第四运算放大器T4的输出端和第五运算放大器T5的负输入端连接;第七电阻Rf7的两端分别与第四运算放大器T4的负输入端和输出端连接;第八电阻Rf8的两端分别与第一低通滤波器的输出端和第四运算放大器T4的负输入端连接;第九电阻Rf9的两端分别与第三运算放大器T3的输出端和第四运算放大器T4的负输入端连接;第十电阻Rf10的两端分别与第五运算放大器T5的输出端和第三运算放大器T3的负输入端连接;第十一电阻Rf11的两端分别与第四运算放大器T4的输出端和第六运算放大器T6的负输入端连接;第十二电阻Rf12的两端分别与第六运算放大器T6的负输入端和输出端连接;
设偶极子全温跟踪补偿控制器的传递函数为:
式(A15)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Kdcc为偶极子全温跟踪补偿控制器的增益;偶极子全温跟踪补偿控制器的增益由比例环节产生;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;偶极子全温跟踪补偿控制器的两个共轭零点和极点由零极点发生环节产生;
增设偶极子全温跟踪补偿控制器后,微机械陀螺仪的标度因数变为式(A14)和式(A15)的乘积:
式(A16)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;Kdcc为偶极子全温跟踪补偿控制器的增益;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
设计偶极子全温跟踪补偿控制器的两个共轭零点,使得偶极子全温跟踪补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子:
式(A17)中:p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;
通过对式(A16)进行化简可得:
式(A18)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;Kdcc为偶极子全温跟踪补偿控制器的增益;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
根据式(A18)可知,微机械陀螺仪的标度因数不再受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约,而仅受偶极子全温跟踪补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约,由此使得微机械陀螺仪的带宽不再受微机械陀螺仪的模态频差的制约;
根据偶极子全温跟踪补偿控制器的结构可知,偶极子全温跟踪补偿控制器的传递函数为:
式(A19)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Vfo为控制器输出;Vfi为控制器输入;Rf1为等效电阻,且令Rf1b>>Rf1a,则Rf1a为第一温度补偿电阻的阻值;Rf1b为具有正温度系数的热敏电阻的阻值;Rf1c为第二温度补偿电阻的阻值;Rf2为第二电阻的阻值;Rf3为第三电阻的阻值;Rf4为第四电阻的阻值;Rf5为第五电阻的阻值;Rf6为第六电阻的阻值;Rf7为第七电阻的阻值;Rf8为第八电阻的阻值;Rf9为第九电阻的阻值;Rf10为第十电阻的阻值;Rf11为第十一电阻的阻值;Rf12为第十二电阻的阻值;
将式(A8)和式(A17)代入式(A15),可得:
式(A20)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Kdcc为偶极子全温跟踪补偿控制器的增益;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Δω2为偶极子全温跟踪补偿控制器的两个共轭零点的乘积,同时也为微机械陀螺仪在其模态频差处存在的两个共轭极点的乘积;ωFn 2为偶极子全温跟踪补偿控制器的两个极点的乘积;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
将式(A19)和式(A20)进行结合,可得:
式(A21)中:ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Δω2为偶极子全温跟踪补偿控制器的两个共轭零点的乘积,同时也为微机械陀螺仪在其模态频差处存在的两个共轭极点的乘积;ωFn 2为偶极子全温跟踪补偿控制器的两个极点的乘积;Kdcc为偶极子全温跟踪补偿控制器的增益;Rf1为等效电阻,且令Rf1b>>Rf1a,则Rf1a为第一温度补偿电阻的阻值;Rf1b为具有正温度系数的热敏电阻的阻值;Rf1c为第二温度补偿电阻的阻值;Rf2为第二电阻的阻值;Rf3为第三电阻的阻值;Rf4为第四电阻的阻值;Rf5为第五电阻的阻值;Rf6为第六电阻的阻值;Rf7为第七电阻的阻值;Rf8为第八电阻的阻值;Rf9为第九电阻的阻值;Rf10为第十电阻的阻值;Rf11为第十一电阻的阻值;Rf12为第十二电阻的阻值;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
根据式(A21)可知,当外界温度变化时,具有正温度系数的热敏电阻的阻值发生变化,使得等效电阻发生变化,由此使得偶极子全温跟踪补偿控制器的两个共轭零点发生漂移,从而使得偶极子全温跟踪补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点在外界温度变化时始终组成偶极子;
因此,根据式(A18)可知,微机械陀螺仪的标度因数在外界温度变化时始终不受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约,而仅受偶极子全温跟踪补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约,由此使得微机械陀螺仪的带宽在外界温度变化时始终不受微机械陀螺仪的模态频差的制约。
Claims (1)
1.一种提升硅微机械陀螺仪带宽全温性能的方法,其特征在于:该方法是采用如下步骤实现的:
1)以扫频的方式确定微机械陀螺仪驱动模态和检测模态的谐振角频率;
2)根据微机械陀螺仪驱动模态和检测模态扫频测试的结果,计算得出微机械陀螺仪驱动模态和检测模态的品质因数,具体计算公式如下:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Q</mi>
<mi>x</mi>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>x</mi>
<mo>+</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>x</mi>
<mo>-</mo>
<mn>3</mn>
</mrow>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>y</mi>
<mo>+</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>y</mi>
<mo>-</mo>
<mn>3</mn>
</mrow>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>12</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A12)中:Qx为微机械陀螺仪驱动模态的品质因数;ωx为微机械陀螺仪驱动模态的谐振角频率;ωx-3、ωx+3为比微机械陀螺仪驱动模态固有频率状态下的信号幅值小3分贝信号幅值对应的两个输入角速率信号频率点,且ωx-3<ωx<ωx+3;Qy为微机械陀螺仪检测模态的品质因数;ωy为微机械陀螺仪检测模态的谐振角频率;ωy-3、ωy+3为比微机械陀螺仪检测模态固有频率状态下的信号幅值小3分贝信号幅值对应的两个输入角速率信号频率点,且ωy-3<ωy<ωy+3;
根据微机械陀螺仪驱动模态和检测模态的品质因数,计算得出微机械陀螺仪的标度因数,具体计算公式如下:
<mrow>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>O</mi>
<mi>o</mi>
<mi>p</mi>
<mi>e</mi>
<mi>n</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>|</mo>
<mo>=</mo>
<mo>|</mo>
<mfrac>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>A</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>d</mi>
</msub>
<msub>
<mi>V</mi>
<mrow>
<mi>d</mi>
<mi>a</mi>
<mi>c</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>y</mi>
<mi>c</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>p</mi>
<mi>r</mi>
<mi>e</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mi>sec</mi>
</msub>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>2</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<msup>
<mi>s</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mfrac>
<mi>s</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>&omega;</mi>
<mi>d</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mfrac>
<mo>|</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>13</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
<mrow>
<msub>
<mi>p</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mn>2</mn>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mrow>
</mfrac>
<mo>+</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mi>d</mi>
</msub>
<mo>-</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mn>2</mn>
</mfrac>
<msqrt>
<mrow>
<mn>4</mn>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>Q</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
</mfrac>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
<mi>j</mi>
<mo>,</mo>
<msub>
<mi>p</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mn>2</mn>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mrow>
</mfrac>
<mo>+</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mi>d</mi>
</msub>
<mo>+</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mn>2</mn>
</mfrac>
<msqrt>
<mrow>
<mn>4</mn>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>Q</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
</mfrac>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
<mi>j</mi>
</mrow>
<mrow>
<msub>
<mi>p</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mn>2</mn>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mrow>
</mfrac>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mi>d</mi>
</msub>
<mo>-</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mn>2</mn>
</mfrac>
<msqrt>
<mrow>
<mn>4</mn>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>Q</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
</mfrac>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
<mi>j</mi>
<mo>,</mo>
<msub>
<mi>p</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mn>2</mn>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mrow>
</mfrac>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mi>d</mi>
</msub>
<mo>+</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mn>2</mn>
</mfrac>
<msqrt>
<mrow>
<mn>4</mn>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>Q</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
</mfrac>
</mrow>
</msqrt>
<mo>)</mo>
</mrow>
<mi>j</mi>
</mrow>
式(A13)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Ax为驱动轴向结构的运动幅度;ωd为驱动模态驱动力的角频率;Vdac为驱动模态激励信号的幅度;Kyc为检测位移提取结构的转换系数;Kpre为前级放大接口的增益倍数;Ksec为次级放大器的增益倍数;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
通过对式(A13)进行化简可得:
<mrow>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>O</mi>
<mi>o</mi>
<mi>p</mi>
<mi>e</mi>
<mi>n</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>|</mo>
<mo>=</mo>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>2</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mfrac>
<mo>|</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>14</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A14)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
3)在微机械陀螺仪的检测回路中增设偶极子全温跟踪补偿控制器;所述偶极子全温跟踪补偿控制器包括温度补偿环节、零极点发生环节、比例环节;
所述温度补偿环节包括第一运算放大器(T1)、第一温度补偿电阻(Rf1a)、具有正温度系数的热敏电阻(Rf1b)、第二温度补偿电阻(Rf1c);
所述零极点发生环节包括第二运算放大器(T2)、第三运算放大器(T3)、第四运算放大器(T4)、第五运算放大器(T5)、第一电容(Cf1)、第二电容(Cf2)、第二电阻(Rf2)、第三电阻(Rf3)、第四电阻(Rf4)、第五电阻(Rf5)、第六电阻(Rf6)、第七电阻(Rf7)、第八电阻(Rf8)、第九电阻(Rf9)、第十电阻(Rf10);
所述比例环节包括第六运算放大器(T6)、第十一电阻(Rf11)、第十二电阻(Rf12);
第一运算放大器(T1)的正输入端与第一低通滤波器的输出端连接;第二运算放大器(T2)的正输入端、第三运算放大器(T3)的正输入端、第四运算放大器(T4)的正输入端、第五运算放大器(T5)的正输入端、第六运算放大器(T6)的正输入端均接地;第六运算放大器(T6)的输出端与第二低通滤波器的输入端连接;
第一电容(Cf1)的两端分别与第二运算放大器(T2)的负输入端和输出端连接;第二电容(Cf2)的两端分别与第三运算放大器(T3)的负输入端和输出端连接;
第一温度补偿电阻(Rf1a)的一端接地,另一端与第一运算放大器(T1)的负输入端连接;具有正温度系数的热敏电阻(Rf1b)的两端分别与第一运算放大器(T1)的负输入端和输出端连接;第二温度补偿电阻(Rf1c)的两端分别与第一运算放大器(T1)的输出端和第二运算放大器(T2)的负输入端连接;第二电阻(Rf2)的两端分别与第二运算放大器(T2)的输出端和第三运算放大器(T3)的负输入端连接;第三电阻(Rf3)的两端分别与第二运算放大器(T2)的负输入端和第四运算放大器(T4)的输出端连接;第四电阻(Rf4)的两端分别与第五运算放大器(T5)的负输入端和输出端连接;第五电阻(Rf5)的两端分别与第一低通滤波器的输出端和第五运算放大器(T5)的负输入端连接;第六电阻(Rf6)的两端分别与第四运算放大器(T4)的输出端和第五运算放大器(T5)的负输入端连接;第七电阻(Rf7)的两端分别与第四运算放大器(T4)的负输入端和输出端连接;第八电阻(Rf8)的两端分别与第一低通滤波器的输出端和第四运算放大器(T4)的负输入端连接;第九电阻(Rf9)的两端分别与第三运算放大器(T3)的输出端和第四运算放大器(T4)的负输入端连接;第十电阻(Rf10)的两端分别与第五运算放大器(T5)的输出端和第三运算放大器(T3)的负输入端连接;第十一电阻(Rf11)的两端分别与第四运算放大器(T4)的输出端和第六运算放大器(T6)的负输入端连接;第十二电阻(Rf12)的两端分别与第六运算放大器(T6)的负输入端和输出端连接;
设偶极子全温跟踪补偿控制器的传递函数为:
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>15</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A15)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Kdcc为偶极子全温跟踪补偿控制器的增益;偶极子全温跟踪补偿控制器的增益由比例环节产生;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;偶极子全温跟踪补偿控制器的两个共轭零点和极点由零极点发生环节产生;
增设偶极子全温跟踪补偿控制器后,微机械陀螺仪的标度因数变为式(A14)和式(A15)的乘积:
<mrow>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>O</mi>
<mi>o</mi>
<mi>p</mi>
<mi>e</mi>
<mi>n</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>|</mo>
<mo>=</mo>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>2</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
</mfrac>
<mfrac>
<mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mfrac>
<mo>|</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>16</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A16)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;Kdcc为偶极子全温跟踪补偿控制器的增益;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;
设计偶极子全温跟踪补偿控制器的两个共轭零点,使得偶极子全温跟踪补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>p</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>p</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>17</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A17)中:p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;
通过对式(A16)进行化简可得:
<mrow>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>O</mi>
<mi>o</mi>
<mi>p</mi>
<mi>e</mi>
<mi>n</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>|</mo>
<mo>=</mo>
<mo>|</mo>
<mfrac>
<mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>n</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>L</mi>
<mi>P</mi>
<mi>F</mi>
<mn>2</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>(</mo>
<mi>s</mi>
<mo>-</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mfrac>
<mo>|</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>18</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A18)中:VOopen为微机械陀螺仪的输出信号;Ωz为微机械陀螺仪的输入角速率;Kcon为0.5AxωdVdacKycKpreKsec;Kdcc为偶极子全温跟踪补偿控制器的增益;FLPF1为第一低通滤波器的增益;FLPF2为第二低通滤波器的增益;z1、z2为的解;p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
根据式(A18)可知,微机械陀螺仪的标度因数不再受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约,而仅受偶极子全温跟踪补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约,由此使得微机械陀螺仪的带宽不再受微机械陀螺仪的模态频差的制约;
根据偶极子全温跟踪补偿控制器的结构可知,偶极子全温跟踪补偿控制器的传递函数为:
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<msub>
<mi>V</mi>
<mrow>
<mi>f</mi>
<mi>o</mi>
</mrow>
</msub>
<msub>
<mi>V</mi>
<mrow>
<mi>f</mi>
<mi>i</mi>
</mrow>
</msub>
</mfrac>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>12</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>7</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>11</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>8</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mfrac>
<mrow>
<msup>
<mi>s</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mfrac>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>8</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>4</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>5</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>9</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>10</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mi>s</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>8</mn>
</mrow>
</msub>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>9</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mfrac>
</mrow>
<mrow>
<msup>
<mi>s</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mfrac>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>4</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>7</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>6</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>9</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>10</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mi>s</mi>
<mo>+</mo>
<mfrac>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>7</mn>
</mrow>
</msub>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>3</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>9</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mfrac>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>19</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A19)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Vfo为控制器输出;Vfi为控制器输入;Rf1为等效电阻,且令Rf1b>>Rf1a,则Rf1a为第一温度补偿电阻的阻值;Rf1b为具有正温度系数的热敏电阻的阻值;Rf1c为第二温度补偿电阻的阻值;Rf2为第二电阻的阻值;Rf3为第三电阻的阻值;Rf4为第四电阻的阻值;Rf5为第五电阻的阻值;Rf6为第六电阻的阻值;Rf7为第七电阻的阻值;Rf8为第八电阻的阻值;Rf9为第九电阻的阻值;Rf10为第十电阻的阻值;Rf11为第十一电阻的阻值;Rf12为第十二电阻的阻值;
将式(A8)和式(A17)代入式(A15),可得:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>K</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<mfrac>
<mrow>
<msup>
<mi>s</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mfrac>
<mi>s</mi>
<mo>+</mo>
<msup>
<mi>&Delta;&omega;</mi>
<mn>2</mn>
</msup>
</mrow>
<mrow>
<msup>
<mi>s</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
</msub>
<mi>s</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mfrac>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>&Delta;&omega;</mi>
<mn>2</mn>
</msup>
<mo>=</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>2</mn>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>&omega;</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mo>=</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>20</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A20)中:FFn为偶极子全温跟踪补偿控制器的传递函数;Kdcc为偶极子全温跟踪补偿控制器的增益;ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Δω2为偶极子全温跟踪补偿控制器的两个共轭零点的乘积,同时也为微机械陀螺仪在其模态频差处存在的两个共轭极点的乘积;ωFn 2为偶极子全温跟踪补偿控制器的两个极点的乘积;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
将式(A19)和式(A20)进行结合,可得:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>Q</mi>
<mi>y</mi>
</msub>
</mfrac>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>8</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>4</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>5</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>9</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>10</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>&Delta;&omega;</mi>
<mn>2</mn>
</msup>
<mo>=</mo>
<mfrac>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>8</mn>
</mrow>
</msub>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>9</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>=</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>z</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>2</mn>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>F</mi>
<mi>n</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>4</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>7</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>6</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>9</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>10</mn>
</mrow>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>f</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>d</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>12</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>7</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>11</mn>
</mrow>
</msub>
<msub>
<mi>R</mi>
<mrow>
<mi>f</mi>
<mn>8</mn>
</mrow>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>21</mn>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
式(A21)中:ωy为微机械陀螺仪检测模态的谐振角频率;Qy为微机械陀螺仪检测模态的品质因数;Δω2为偶极子全温跟踪补偿控制器的两个共轭零点的乘积,同时也为微机械陀螺仪在其模态频差处存在的两个共轭极点的乘积;ωFn 2为偶极子全温跟踪补偿控制器的两个极点的乘积;Kdcc为偶极子全温跟踪补偿控制器的增益;Rf1为等效电阻,且令Rf1b>>Rf1a,则Rf1a为第一温度补偿电阻的阻值;Rf1b为具有正温度系数的热敏电阻的阻值;Rf1c为第二温度补偿电阻的阻值;Rf2为第二电阻的阻值;Rf3为第三电阻的阻值;Rf4为第四电阻的阻值;Rf5为第五电阻的阻值;Rf6为第六电阻的阻值;Rf7为第七电阻的阻值;Rf8为第八电阻的阻值;Rf9为第九电阻的阻值;Rf10为第十电阻的阻值;Rf11为第十一电阻的阻值;Rf12为第十二电阻的阻值;zdcc1、zdcc2为偶极子全温跟踪补偿控制器的两个共轭零点;pdcc1、pdcc2为偶极子全温跟踪补偿控制器的两个极点;
根据式(A21)可知,当外界温度变化时,具有正温度系数的热敏电阻的阻值发生变化,使得等效电阻发生变化,由此使得偶极子全温跟踪补偿控制器的两个共轭零点发生漂移,从而使得偶极子全温跟踪补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点在外界温度变化时始终组成偶极子;
因此,根据式(A18)可知,微机械陀螺仪的标度因数在外界温度变化时始终不受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约,而仅受偶极子全温跟踪补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约,由此使得微机械陀螺仪的带宽在外界温度变化时始终不受微机械陀螺仪的模态频差的制约。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510334584.0A CN104897150B (zh) | 2015-06-16 | 2015-06-16 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510334584.0A CN104897150B (zh) | 2015-06-16 | 2015-06-16 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104897150A CN104897150A (zh) | 2015-09-09 |
CN104897150B true CN104897150B (zh) | 2017-08-25 |
Family
ID=54029962
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510334584.0A Expired - Fee Related CN104897150B (zh) | 2015-06-16 | 2015-06-16 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104897150B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105737851B (zh) * | 2016-01-30 | 2018-08-21 | 西北工业大学 | 面向精度设计的硅微机械陀螺系统参数获取方法 |
CN106767893A (zh) * | 2017-03-02 | 2017-05-31 | 深圳星震宇信息科技有限公司 | 车辆行驶里程计算方法 |
CN107238381A (zh) * | 2017-05-23 | 2017-10-10 | 东南大学 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
CN109827594B (zh) * | 2019-02-27 | 2023-03-31 | 东南大学 | 基于面内模态旋转的轴对称陀螺仪零位自补偿系统及方法 |
CN110112907B (zh) | 2019-05-22 | 2020-07-03 | 苏州浪潮智能科技有限公司 | 一种降压电路的电压补偿方法和装置 |
CN110542437B (zh) * | 2019-09-21 | 2020-12-29 | 中北大学 | 驱动-检测模态互换的微机械陀螺机械灵敏度自补偿方法 |
CN110866326B (zh) * | 2019-10-11 | 2020-07-03 | 蓝箭航天空间科技股份有限公司 | 结构伺服弹性试验开环扫频信号设计方法、存储介质及检测系统 |
CN111536994B (zh) * | 2020-04-29 | 2021-09-24 | 中国人民解放军国防科技大学 | 一种谐振式微陀螺多模态协同控制方法、系统及谐振式微陀螺 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102944230A (zh) * | 2012-11-14 | 2013-02-27 | 浙江大学 | 一种可调谐微机械陀螺的恒频驱动方法及其装置 |
CN104567849A (zh) * | 2014-12-26 | 2015-04-29 | 东南大学 | 一种硅微机械线振动式陀螺及其带宽拓展方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FI125238B (en) * | 2012-06-29 | 2015-07-31 | Murata Manufacturing Co | Improved vibration gyroscope |
-
2015
- 2015-06-16 CN CN201510334584.0A patent/CN104897150B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102944230A (zh) * | 2012-11-14 | 2013-02-27 | 浙江大学 | 一种可调谐微机械陀螺的恒频驱动方法及其装置 |
CN104567849A (zh) * | 2014-12-26 | 2015-04-29 | 东南大学 | 一种硅微机械线振动式陀螺及其带宽拓展方法 |
Non-Patent Citations (2)
Title |
---|
梳齿式微加速度计闭环系统性能的分析与优化;吴天准等;《仪器仪表学报》;20060331;第27卷(第3期);第285-289页 * |
硅微机械陀螺仪测控电路的温度补偿;曹慧亮等;《光学精密工程》;20131231;第21卷(第12期);第3118-3125页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104897150A (zh) | 2015-09-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104897150B (zh) | 一种提升硅微机械陀螺仪带宽全温性能的方法 | |
CN103822623B (zh) | 一种振动式硅微机械陀螺正交误差闭环补偿电路 | |
US8272267B2 (en) | Angular velocity sensor | |
CN100543418C (zh) | 角速度传感器用音叉型振荡器、使用此振荡器的角速度传感器、以及使用此角速度传感器的车辆 | |
CN104931034B (zh) | 基于偶极子补偿法的微机械陀螺仪带宽拓展方法 | |
US6445195B1 (en) | Drive feedthrough nulling system | |
CN108535511B (zh) | 基于静电负刚度频率解算的fm加速度计力平衡检测方法 | |
US20080190198A1 (en) | Microelectromechanical gyroscope with suppression of capacitive coupling spurious signals and control method | |
CA2460977A1 (en) | Micromechanical inertial sensor having increased pickoff resonance damping | |
CN102353384B (zh) | 微机械陀螺带宽与标度因子的测量方法及系统 | |
CN112066967B (zh) | 一种芯片级谐振式声光耦合固态波动陀螺 | |
CN104567849A (zh) | 一种硅微机械线振动式陀螺及其带宽拓展方法 | |
JP6972845B2 (ja) | 物理量測定装置、電子機器及び移動体 | |
US20160187136A1 (en) | Physical-quantity detection circuit, physical-quantity sensor, and electronic device | |
CN108761134A (zh) | 一种弱耦合谐振式传感器的线性化输出检测方法 | |
CN109029409A (zh) | 一种可调谐栅结构微机械陀螺中的参量放大方法及其装置 | |
CN1764823B (zh) | 物理量测定装置 | |
CN110631570A (zh) | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 | |
CN107238381A (zh) | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 | |
CN106918351A (zh) | 一种基于正交误差信号的微型机械陀螺仪故障自检测方法 | |
US8525591B2 (en) | Signal level conversion circuit, physical quantity detection device and electronic apparatus | |
CN106969785A (zh) | 陀螺仪自校准装置及方法 | |
CN105841685A (zh) | 硅微机械陀螺快速热启动实现方法 | |
CN107238382A (zh) | 一种硅微陀螺仪差分电容检测电路 | |
CN105180969B (zh) | 一种面向闭环检测的微陀螺批量动态测试方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170825 Termination date: 20180616 |
|
CF01 | Termination of patent right due to non-payment of annual fee |