CN104931034B - 基于偶极子补偿法的微机械陀螺仪带宽拓展方法 - Google Patents

基于偶极子补偿法的微机械陀螺仪带宽拓展方法 Download PDF

Info

Publication number
CN104931034B
CN104931034B CN201510334592.5A CN201510334592A CN104931034B CN 104931034 B CN104931034 B CN 104931034B CN 201510334592 A CN201510334592 A CN 201510334592A CN 104931034 B CN104931034 B CN 104931034B
Authority
CN
China
Prior art keywords
micro
mechanical gyroscope
mode
dipole
gain
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
Application number
CN201510334592.5A
Other languages
English (en)
Other versions
CN104931034A (zh
Inventor
曹慧亮
刘俊
石云波
申冲
秦丽
唐军
李�杰
张晓明
马宗敏
鲍爱达
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
North University of China
Original Assignee
North University of China
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by North University of China filed Critical North University of China
Priority to CN201510334592.5A priority Critical patent/CN104931034B/zh
Publication of CN104931034A publication Critical patent/CN104931034A/zh
Application granted granted Critical
Publication of CN104931034B publication Critical patent/CN104931034B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

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

Landscapes

  • Engineering & Computer Science (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Gyroscopes (AREA)

Abstract

本发明涉及微机械陀螺仪，具体是一种基于偶极子补偿法的微机械陀螺仪带宽拓展方法。本发明解决了微机械陀螺仪无法兼顾机械灵敏度和带宽的问题。基于偶极子补偿法的微机械陀螺仪带宽拓展方法，该方法是采用如下步骤实现的：1)以扫频的方式确定微机械陀螺仪驱动模态和检测模态的谐振角频率；2)根据微机械陀螺仪驱动模态和检测模态扫频测试的结果，计算得出微机械陀螺仪驱动模态和检测模态的品质因数；3)在微机械陀螺仪的检测回路中增设偶极子补偿控制器；所述偶极子补偿控制器包括零极点发生环节、比例环节。本发明适用于微机械陀螺仪。

Description

基于偶极子补偿法的微机械陀螺仪带宽拓展方法
技术领域
本发明涉及微机械陀螺仪，具体是一种基于偶极子补偿法的微机械陀螺仪带宽拓展方法。
背景技术
微机械陀螺仪是一种采用哥氏效应原理敏感载体输入角速率信息的传感器，其具有体积小、功耗低、重量轻、成本低、抗过载特性强、易于集成化和批量生产等优点，并广泛应用于诸多领域(比如惯性导航、汽车安全、工业控制、消费电子等)。如图1-图2所示，微机械陀螺仪包括陀螺结构、陀螺测控电路。所述陀螺结构包括驱动轴向结构、检测轴向结构。所述检测轴向结构包括哥氏质量、检测位移提取结构(若检测回路为闭环回路，则检测轴向结构还包括检测力反馈结构)。所述陀螺测控电路包括驱动闭环回路、检测回路。所述检测回路包括前级放大接口、次级放大器、解调器、第一低通滤波器、第二低通滤波器(若检测回路为闭环回路，则检测回路还包括调制器和直流信号叠加装置)。微机械陀螺仪的工作模态包含驱动模态和检测模态。工作时，沿微机械陀螺仪输入轴施加输入角速率信号，则微机械陀螺仪的检测回路产生输出信号。
微机械陀螺仪的动力方程为：
Fdx＝Fd sin(ωdt)
ωd＝ωx
式(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为微机械陀螺仪在其模态频和处存在的两个共轭极点。
如图4所示，微机械陀螺仪在其模态频差处存在的两个共轭极点会使得微机械陀螺仪的标度因数在微机械陀螺仪的模态频差处达到峰值，并使得微 机械陀螺仪的相位剧烈变化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)可知，微机械陀螺仪的带宽与微机械陀螺仪的模态频差成正比。
然而在实际应用中，一方面为了提高微机械陀螺仪的机械灵敏度(以此提高微机械陀螺仪的分辨率、阈值、信噪比、零偏稳定性、噪声特性)，需要减小微机械陀螺仪的模态频差，另一方面为了增大微机械陀螺仪的带宽，需要增大微机械陀螺仪的模态频差，由此使得提高微机械陀螺仪的机械灵敏度和增大微机械陀螺仪的带宽成为一对矛盾，从而导致微机械陀螺仪无法兼顾机械灵敏度和带宽。基于此，有必要发明一种全新的方法，以解决微机械陀 螺仪无法兼顾机械灵敏度和带宽的问题。
发明内容
本发明为了解决微机械陀螺仪无法兼顾机械灵敏度和带宽的问题，提供了一种基于偶极子补偿法的微机械陀螺仪带宽拓展方法。
本发明是采用如下技术方案实现的：基于偶极子补偿法的微机械陀螺仪带宽拓展方法，该方法是采用如下步骤实现的：
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)中：Fdcc为偶极子补偿控制器的传递函数；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为微机械陀螺仪在其模态频和处存在的两个共轭极点；
设计偶极子补偿控制器的两个共轭零点，使得偶极子补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子：
p1＝zdcc1
p2＝zdcc2 (A17)；
式(A17)中：p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极 点；zdcc1、zdcc2为偶极子补偿控制器的两个共轭零点；
通过对式(A16)进行化简可得：
式(A18)中：VOopen为微机械陀螺仪的输出信号；Ωz为微机械陀螺仪的输入角速率；Kcon为0.5AxωdVdacKycKpreKsec；Kdcc为偶极子补偿控制器的增益；FLPF1为第一低通滤波器的增益；FLPF2为第二低通滤波器的增益；z1、z2为 的解；p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点；pdcc1、pdcc2为偶极子补偿控制器的两个极点；
根据式(A18)可知，微机械陀螺仪的标度因数不再受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约，而仅受偶极子补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约，由此使得微机械陀螺仪的带宽不再受微机械陀螺仪的模态频差的制约。
本发明所述的基于偶极子补偿法的微机械陀螺仪带宽拓展方法基于偶极子补偿原理，通过将偶极子补偿控制器产生的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子，消除了微机械陀螺仪的模态频差对带宽的制约，由此使得增大微机械陀螺仪的带宽不再需要增大微机械陀螺仪的模态频差，从而使得提高微机械陀螺仪的机械灵敏度和增大微机械陀螺仪的带宽不再矛盾，进而使得微机械陀螺仪能够完全兼顾机械灵敏度和带宽。
本发明有效解决了微机械陀螺仪无法兼顾机械灵敏度和带宽的问题，适用于微机械陀螺仪。
附图说明
图1是本发明的微机械陀螺仪的结构示意图。
图2是本发明的微机械陀螺仪的检测回路的结构示意图。
图3是本发明的偶极子补偿控制器的结构示意图。
图4是微机械陀螺仪在其模态频差处存在的两个共轭极点对微机械陀螺仪的标度因数和相位的影响示意图。
图5是本发明的偶极子的形成原理示意图。
图中：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)在微机械陀螺仪的检测回路中增设偶极子补偿控制器；所述偶极子补 偿控制器包括零极点发生环节、比例环节；零极点发生环节的输入端与第一低通滤波器的输出端连接，零极点发生环节的输出端与比例环节的输入端连接，比例环节的输出端与第二低通滤波器的输入端连接；
设偶极子补偿控制器的传递函数为：
式(A15)中：Fdcc为偶极子补偿控制器的传递函数；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为微机械陀螺仪在其模态频和处存在的两个共轭极点；
设计偶极子补偿控制器的两个共轭零点，使得偶极子补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子：
p1＝zdcc1
p2＝zdcc2(A17)；
式(A17)中：p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极 点；zdcc1、zdcc2为偶极子补偿控制器的两个共轭零点；
通过对式(A16)进行化简可得：
式(A18)中：VOopen为微机械陀螺仪的输出信号；Ωz为微机械陀螺仪的输入角速率；Kcon为0.5AxωdVdacKycKpreKsec；Kdcc为偶极子补偿控制器的增益；FLPF1为第一低通滤波器的增益；FLPF2为第二低通滤波器的增益；z1、z2为 的解；p3、p4为微机械陀螺仪在其模态频和处存在的两个共轭极点；pdcc1、pdcc2为偶极子补偿控制器的两个极点；
根据式(A18)可知，微机械陀螺仪的标度因数不再受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约，而仅受偶极子补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约，由此使得微机械陀螺仪的带宽不再受微机械陀螺仪的模态频差的制约。

Claims (1)

1.一种基于偶极子补偿法的微机械陀螺仪带宽拓展方法，其特征在于：该方法是采用如下步骤实现的：
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）中：Fdcc为偶极子补偿控制器的传递函数；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为微机械陀螺仪在其模态频和处存在的两个共轭极点；
设计偶极子补偿控制器的两个共轭零点，使得偶极子补偿控制器的两个共轭零点与微机械陀螺仪在其模态频差处存在的两个共轭极点组成偶极子：
p1＝zdcc1
p2＝zdcc2（A17）；
式（A17）中：p1、p2为微机械陀螺仪在其模态频差处存在的两个共轭极点；zdcc1、zdcc2为偶极子补偿控制器的两个共轭零点；
通过对式（A16）进行化简可得：
式（A18）中：VOopen为微机械陀螺仪的输出信号；Ωz为微机械陀螺仪的输入角速率；Kcon为0.5AxωdVdacKycKpreKsec；Kdcc为偶极子补偿控制器的增益；FLPF1为第一低通滤波器的增益；FLPF2为第二低通滤波器的增益；z1、z2为 的解；p3、p4为微机械陀螺仪在其模态频和处存在的两个共 轭极点；pdcc1、pdcc2为偶极子补偿控制器的两个极点；
根据式（A18）可知，微机械陀螺仪的标度因数不再受微机械陀螺仪在其模态频差处存在的两个共轭极点的制约，而仅受偶极子补偿控制器的两个极点以及第一低通滤波器的增益和第二低通滤波器的增益的制约，由此使得微机械陀螺仪的带宽不再受微机械陀螺仪的模态频差的制约。
CN201510334592.5A 2015-06-16 2015-06-16 基于偶极子补偿法的微机械陀螺仪带宽拓展方法 Expired - Fee Related CN104931034B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510334592.5A CN104931034B (zh) 2015-06-16 2015-06-16 基于偶极子补偿法的微机械陀螺仪带宽拓展方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510334592.5A CN104931034B (zh) 2015-06-16 2015-06-16 基于偶极子补偿法的微机械陀螺仪带宽拓展方法

Publications (2)

Publication Number Publication Date
CN104931034A CN104931034A (zh) 2015-09-23
CN104931034B true CN104931034B (zh) 2017-07-14

Family

ID=54118313

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510334592.5A Expired - Fee Related CN104931034B (zh) 2015-06-16 2015-06-16 基于偶极子补偿法的微机械陀螺仪带宽拓展方法

Country Status (1)

Country Link
CN (1) CN104931034B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106289209B (zh) * 2016-07-22 2019-07-23 北京时代民芯科技有限公司 一种适用于宽量程的陀螺仪控制方法和控制系统
CN109827594B (zh) * 2019-02-27 2023-03-31 东南大学 基于面内模态旋转的轴对称陀螺仪零位自补偿系统及方法
CN110866326B (zh) * 2019-10-11 2020-07-03 蓝箭航天空间科技股份有限公司 结构伺服弹性试验开环扫频信号设计方法、存储介质及检测系统
CN111536994B (zh) * 2020-04-29 2021-09-24 中国人民解放军国防科技大学 一种谐振式微陀螺多模态协同控制方法、系统及谐振式微陀螺

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5465620A (en) * 1993-06-14 1995-11-14 Rensselaer Polytechnic Institute Micromechanical vibratory gyroscope sensor array
DE19654304A1 (de) * 1995-12-27 1997-07-03 Samsung Electronics Co Ltd Mikrogyroskop
CN1766528A (zh) * 2005-11-11 2006-05-03 中北大学 具有较高灵敏度和带宽的差分式微机械陀螺
CN102297689A (zh) * 2011-07-22 2011-12-28 上海交通大学 静电驱动压电检测闭环控制微固体模态陀螺
CN104567849A (zh) * 2014-12-26 2015-04-29 东南大学 一种硅微机械线振动式陀螺及其带宽拓展方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6845669B2 (en) * 2001-05-02 2005-01-25 The Regents Of The University Of California Non-resonant four degrees-of-freedom micromachined gyroscope

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5465620A (en) * 1993-06-14 1995-11-14 Rensselaer Polytechnic Institute Micromechanical vibratory gyroscope sensor array
DE19654304A1 (de) * 1995-12-27 1997-07-03 Samsung Electronics Co Ltd Mikrogyroskop
CN1766528A (zh) * 2005-11-11 2006-05-03 中北大学 具有较高灵敏度和带宽的差分式微机械陀螺
CN102297689A (zh) * 2011-07-22 2011-12-28 上海交通大学 静电驱动压电检测闭环控制微固体模态陀螺
CN104567849A (zh) * 2014-12-26 2015-04-29 东南大学 一种硅微机械线振动式陀螺及其带宽拓展方法

Also Published As

Publication number Publication date
CN104931034A (zh) 2015-09-23

Similar Documents

Publication Publication Date Title
CN104897150B (zh) 一种提升硅微机械陀螺仪带宽全温性能的方法
CN104931034B (zh) 基于偶极子补偿法的微机械陀螺仪带宽拓展方法
CN104567849B (zh) 一种硅微机械线振动式陀螺及其带宽拓展方法
US9003883B2 (en) Angular velocity sensor and synchronous detection circuit used therein
CN103822623B (zh) 一种振动式硅微机械陀螺正交误差闭环补偿电路
EP3279608B1 (en) Improved vibratory gyroscope
CN105203132A (zh) 一种谐振式振动陀螺的输出频率检测方法
CN108535511B (zh) 基于静电负刚度频率解算的fm加速度计力平衡检测方法
CN101685119A (zh) 谐振式微型电场传感器
CN108761134A (zh) 一种弱耦合谐振式传感器的线性化输出检测方法
CN109029409A (zh) 一种可调谐栅结构微机械陀螺中的参量放大方法及其装置
JPWO2015072090A1 (ja) 物理量検出回路、物理量センサ及び電子機器
CN110631570A (zh) 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法
CN105258689A (zh) 一种数字陀螺仪信号控制处理系统
CN107063307A (zh) 基于虚拟哥氏力的微机械陀螺仪自标定方法
CN106918351A (zh) 一种基于正交误差信号的微型机械陀螺仪故障自检测方法
CN106969785A (zh) 陀螺仪自校准装置及方法
CN105180969B (zh) 一种面向闭环检测的微陀螺批量动态测试方法
CN107238382A (zh) 一种硅微陀螺仪差分电容检测电路
Verma et al. Analytical modeling and simulation of a 2-DOF drive and 1-DOF sense gyro-accelerometer
JP6337444B2 (ja) 振動片、角速度センサー、電子機器及び移動体
CN204705358U (zh) 偶极子全温跟踪补偿控制器
CN112797968B (zh) 一种力平衡闭环检测下的陀螺带宽拓展方法、装置及系统
US7861588B2 (en) Force rebalance control system and method using automatic gain control loop
CN105258711B (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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20170714

Termination date: 20180616