CN107238381A - 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 - Google Patents
用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 Download PDFInfo
- Publication number
- CN107238381A CN107238381A CN201710366532.0A CN201710366532A CN107238381A CN 107238381 A CN107238381 A CN 107238381A CN 201710366532 A CN201710366532 A CN 201710366532A CN 107238381 A CN107238381 A CN 107238381A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- loop
- mfrac
- detection
- 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.)
- Pending
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/5719—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces using planar vibrating masses driven in a translation vibration along an axis
- G01C19/5726—Signal processing
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
技术领域
本发明涉及硅微机械陀螺仪,具体是一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法。
背景技术
硅微机械陀螺仪是指利用微机电系统(MEMS)技术,并根据哥氏效应原理工作的一类用于测量角速度的惯性传感器。其具有体积小、重量轻、低功耗、低成本、易于批量化生产、集成度高、易于数字化等特点,已经在民用领域(如手机、平板电脑、数码相机等消费类电子)和军用领域(如制导弹药、战场机器人、军用无人机等)有着广泛的应用。如图1和如图2所示,硅微机械陀螺仪包括陀螺微结构和陀螺测控电路。所述陀螺结构由驱动框架、检测框架、哥氏框架、驱动梳齿、驱动检测梳齿、检测梳齿、检测反馈梳齿、U型支撑梁及基座等组成。在U型梁的作用下,驱动框架只能沿x轴方向运动,检测框架只能沿y轴方向运动,哥氏框架可以同时沿x轴方向和y轴方向运动。陀螺正常工作时,在静电驱动力作用下,驱动框架和哥氏框架一起沿x轴方向作等幅反向运动;当陀螺有绕z轴的角速度输入时,检测框架和哥氏框架在哥氏力的作用下,沿y轴作等幅反向运动。所述陀螺测控电路包括高性能C/V接口电路,AD/DA转换模块以及FPGA处理模块。其中,FPGA数字平台是该控制系统的核心模块,驱动模态和检测模态的控制及有效输出均由此控制。闭环驱动回路为陀螺检测回路提供稳定的振动位移,当有z轴方向角速度输入时,根据哥氏效应,将在检测方向产生振动,通过检测陀螺检测模态产生的振动位移就可以得到输入角速度的大小。陀螺检测模态的工作方式可以分为开环检测和闭环检测。开环检测工作方式下,陀螺输出的检测位移幅度与输入角速度成比例关系,经过解调输出的电压直接反映角速度信息。闭环检测工作方式需在陀螺检测模态添加力反馈检测电极,通过检测力反馈闭环控制回路,使检测反馈力与哥氏力抵消,保证陀螺检测梳齿始终保持在平衡位置,通过反馈力的大小来得到角速度信息。
如图3所示,硅微机械陀螺仪开环检测的工作原理,采用常用的乘法相敏解调提取哥氏信号。图中,Ωz(t)表示输入角速度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,ωd为驱动角频率,Fc为哥氏力,Gy(s)为陀螺检测模态传递函数,y(t)为陀螺检测模态输出位移,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(s)为相敏解调环节中的低通滤波器传递函数,Vopen(t)为硅微机械陀螺仪开环检测输出电压。
陀螺检测模态传递函数的表达式为:
式(A1)中:Gy(s)为陀螺检测模态传递函数,my为陀螺检测模态检测质量,ωy为检测模态谐振频率,Qy为检测模态品质因数。
根据开环检测工作原理,可以得到角速度检测开环传递函数为:
式(A2)中:Hopen(s)为陀螺检测开环传递函数,Vopen为硅微机械陀螺仪开环检测输出电压,Ωz表示输入角速度,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,Ax为驱动梳齿振动位移,ωd为驱动角频率,Flpf(s)为相敏解调环节中的低通滤波器传递函数,为解调相角,ωy为硅微机械陀螺仪检测模态的谐振角频率,Qy为检测模态品质因数。
对于模态匹配工作方式的硅微机械陀螺仪,即ωy=ωx=ωd,此时理想解调相位可以计算出模态匹配状态下陀螺开环检测传递函数:
式(A3)中:为陀螺检测开环传递函数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,Ax为驱动梳齿振动位移,ωd为驱动角频率,Flpf(s)为相敏解调环节中的低通滤波器传递函数,为解调相角,ωy为硅微机械陀螺仪检测模态的谐振角频率,Qy为检测模态品质因数。
从式(A3)可以发现,当陀螺处于模态匹配状态时,不考虑后级低通滤波器环节的情况下,开环检测传递函数类似为一个截止频率为的一阶低通滤波器。
对于模态匹配工作方式的硅微机械陀螺仪,根据式(A3)得到静态灵敏度为:
式(A4)中,为模态匹配状态下硅微机械陀螺仪静态灵敏度,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,Ax为驱动梳齿振动位移,Flpf(0)为低通滤波器静态增益,Qy为检测模态品质因数,ωy为硅微机械陀螺仪检测模态的谐振角频率。
从式(A4)可知,陀螺模态匹配工作模式下的开环检测灵敏度与检测模态梳齿电容检测增益、前端电路放大增益、解调基准幅度、驱动振幅、检测模态品质因数以及谐振频率有关。增大开环检测增益、增加驱动模态振动幅度Ax、提高检测模态品质因数Qy以及减小检测模态谐振频率ωy均可提高硅微机械陀螺仪静态灵敏度。
根据带宽的定义,开环系统幅频特性相对于频率为零时下降3dB对应的频率点即为陀螺的工作带宽。即满足等式:
式(A5)中:Hopen(s)为陀螺开环检测传递函数,ωb为陀螺工作带宽。
对于模态匹配的硅微机械陀螺仪,由于开环检测传递函数类似为一阶低通滤波器,因此,带宽由式(A5)得:
式(A6)中:ωb为陀螺工作带宽,ωy为硅微机械陀螺仪检测模态的谐振角频率,Qy为检测模态品质因数。
一般硅微机械陀螺仪检测模态品质因数在几百量级,谐振频率在几千量级,因此,模态匹配状态的硅微机械陀螺仪开环检测下的工作带宽只有几赫兹。
从陀螺开环检测系统的工作带宽和静态灵敏度可知,模态匹配状态下的硅微机械陀螺仪是牺牲带宽来换取高灵敏度,二者在开环检测模式下是个矛盾的关系,为了同时兼顾带宽和灵敏度,必须发明一种全新的方法,以解决模态匹配状态下硅微机械陀螺仪无法兼顾静态灵敏度和工作带宽的问题。
发明内容
发明目的:为了克服现有技术中存在的不足,本发明提供一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法。
技术方案:为解决上述技术问题,本发明的一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法,包括以下步骤:
1)对开环检测进行改进,构成陀螺闭环检测环路,根据闭环检测工作原理,可以得到角速度检测闭环传递函数为:
式(A7)中:Hclose(s)为陀螺检测闭环传递函数,Vclose为硅微机械陀螺仪闭环检测输出电压,Ωz表示输入角速度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(s)为相敏解调环节中的低通滤波器传递函数,Gy(s)为陀螺检测模态传递函数,Ffb(s)为力反馈校正器;
闭环检测系统的静态灵敏度可以表示为:
式(A8)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,Hclose(s)为陀螺检测闭环传递函数,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(0)为低通滤波器静态增益,Gy(s)为陀螺检测模态传递函数,Ffb(0)为力反馈校正器静态增益;
当校正器静态增益Ffb(0)很大,即满足环路增益>>1时,此时有:
式(A9)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,ωd为驱动角频率,KyVF为反馈电压到检测反馈力的转换系数;
从式(A9)可以发现,当环路增益很大时,检测闭环控制系统的静态灵敏度与陀螺频差无关,也与前馈检测增益无关;只与检测质量块大小、驱动模态振动幅度和谐振频率以及检测力反馈转换增益有关;比较式(A9)和式(A4)可知,与开环检测系统的静态灵敏度相比,闭环检测系统的静态灵敏度受温度等环境影响较小,因此可以显著改善系统的稳定性和可靠性;
2)为了方便设计闭环校正器,从哥氏力输入和反馈力输出的角度构成单位负反馈系统,该闭环反馈系统的开环传递函数为:
式(A10)中:Hopen(s)表示闭环反馈系统的开环传递函数,Ff为检测反馈力,Ωz表示输入角速度,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,Ax为驱动梳齿振动位移,ωd为驱动角频率,Flpf(s)为低通滤波器传递函数,Ffb(s)为力反馈校正器传递函数,KyVF为反馈电压到检测反馈力的转换系数,为解调相角,ωy为硅微机械陀螺仪检测模态的谐振角频率,Qy为检测模态品质因数;
在系统中加入频率特性合适的校正器,应该使开环系统频率特性形状满足:低频段增益充分大,以保证系统稳态误差的要求;中频段对数幅频特性斜率-20dB/dec,并占据充分宽的频带,以保证系统具备适当的相角裕度;高频段增益应尽快减小,以削弱噪声的影响;由于模态匹配状态下的陀螺检测模型可以看作一阶惯性环节,因此,可以采用PI环节与相位超前环节相结合的串联校正方式来对检测控制回路进行整形;
校正器的传递函数为:
式(A11)中:Ffb(s)为力反馈校正器传递函数,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1和ω2分别为相位超前环节的零极点,且ω1<ω2;
3)由于硅微机械陀螺仪实际控制系统中的校正器由数字电路实现,因此,需要对式(A11)进行离散域变换,比例积分控制器的离散域模型为:
式(A12)中:D1(z)为比例积分控制器的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,T0为离散系统采样间隔;
相位超前环节的离散模型利用双线性变换法得:
式(A13)中:D2(z)为相位超前环节的离散域表达式,ω1和ω2分别为相位超前环节的零极点,T0为离散系统采样间隔;
因此,所发明的比例积分控制器与相位超前环节串联数字校正器的表达式为:
式(A14)中:D(z)为所发明的数字校正器,D1(z)为比例积分控制器的离散域表达式,D2(z)为相位超前环节的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1、ω2分别为相位超前环节的零极点,T0为离散系统采样间隔。
有益效果:本发明的一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法,具有以下有益效果:
通过构建闭环检测环路,用所发明的数字校正器对检测控制回路进行整形,从而使得硅微机械陀螺仪静态灵敏度与工作带宽不再矛盾,进而使得硅微机械陀螺仪能够同时兼顾静态灵敏度和工作带宽。本发明有效解决了模态匹配状态硅微机械陀螺仪无法兼顾静态灵敏度和工作带宽的问题,适用于模态匹配状态的硅微机械陀螺仪。
附图说明
图1为本发明的硅微机械陀螺仪的结构示意图;
图2为本发明的硅微机械陀螺仪的测控电路系统框图;
图3为本发明的硅微机械陀螺仪开环检测工作原理框图;
图4为本发明的硅微机械陀螺仪闭环检测工作原理框图;
图5为本发明的硅微机械陀螺仪闭环检测回路单位负反馈系统框图;
图6为本发明的比例积分相位超前数字校正器结构示意图;
图7为本发明的校正器的伯德图;
其中,图7a为由式(A11)所示的连续域校正器得到的幅频特性曲线图和相频特性曲线图;
图7b为由式(A14)所示的数字域校正器得到幅频特性曲线图和相频特性曲线图。
具体实施方式
下面结合附图对本发明作进一步说明。
本发明提供了一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法,该方法是采用如下步骤实现的:
1)对开环检测进行改进,原理框图如图4所示,构成陀螺闭环检测环路,图中,Ωz(t)表示输入角速度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,ωd为驱动角频率,Fc为哥氏力,Gy(s)为陀螺检测模态传递函数,y(t)为陀螺检测模态输出位移,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(s)为相敏解调环节中的低通滤波器传递函数,Vclose(t)为硅微机械陀螺仪闭环检测输出电压,KyVF为反馈电压到检测反馈力的转换系数,Ffb(s)为力反馈校正器,校正器的输出一方面作为反映输入角速度的有效输出信号,另一方面调制到与哥氏力信号同频反相的参考信号上用于平衡哥氏力。
根据闭环检测工作原理,可以得到角速度检测闭环传递函数为:
式(A7)中:Hclose(s)为陀螺检测闭环传递函数,Vclose为硅微机械陀螺仪闭环检测输出电压,Ωz表示输入角速度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(s)为相敏解调环节中的低通滤波器传递函数,Gy(s)为陀螺检测模态传递函数,Ffb(s)为力反馈校正器。
闭环检测系统的静态灵敏度可以表示为:
式(A8)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,Hclose(s)为陀螺检测闭环传递函数,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(0)为低通滤波器静态增益,Gy(s)为陀螺检测模态传递函数,Ffb(0)为力反馈校正器静态增益。
当校正器静态增益Ffb(0)很大,即满足环路增益>>1时,此时有:
式(A9)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,ωd为驱动角频率,KyVF为反馈电压到检测反馈力的转换系数。
从式(A9)可以发现,当环路增益很大时,检测闭环控制系统的静态灵敏度与陀螺频差无关,也与前馈检测增益无关;只与检测质量块大小、驱动模态振动幅度和谐振频率以及检测力反馈转换增益有关。比较式(A9)和式(A4)可知,与开环检测系统的静态灵敏度相比,闭环检测系统的静态灵敏度受温度等环境影响较小,因此可以显著改善系统的稳定性和可靠性。
2)为了方便设计闭环校正器,对图4进行简化,从哥氏力输入和反馈力输出的角度构成单位负反馈系统,如图5所示。图中,该闭环反馈系统的开环传递函数为:
式(A10)中:Hopen(s)表示闭环反馈系统的开环传递函数,Ff为检测反馈力,Ωz表示输入角速度,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,Ax为驱动梳齿振动位移,ωd为驱动角频率,Flpf(s)为低通滤波器传递函数,Ffb(s)为力反馈校正器传递函数,KyVF为反馈电压到检测反馈力的转换系数,为解调相角,ωy为硅微机械陀螺仪检测模态的谐振角频率,Qy为检测模态品质因数。
当环路增益很大时,检测闭环控制系统的静态灵敏度只与反馈增益有关,与前馈增益无关,受温度等环境影响较小。但是单纯的增大校正器增益无法满足闭环系统稳定性和动态性的要求,因此需要对检测力反馈校正器进行详细设计。在闭环检测系统中加入校正器的目的主要有如下几点:增大开环增益、拓展系统的带宽、增大系统幅值裕度、保证系统相角裕度、保持低频段增益的平坦以及带宽满足后幅度应迅速衰减等。
在系统中加入频率特性合适的校正器,应该使开环系统频率特性形状满足:低频段增益充分大,以保证系统稳态误差的要求;中频段对数幅频特性斜率-20dB/dec,并占据充分宽的频带,以保证系统具备适当的相角裕度;高频段增益应尽快减小,以削弱噪声的影响。由于模态匹配状态下的陀螺检测模型可以看作一阶惯性环节,因此,可以采用比例积分环节与相位超前环节相结合的串联校正方式来对检测控制回路进行整形。
校正器的传递函数为:
式(A11)中:Ffb(s)为力反馈校正器传递函数,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1和ω2分别为相位超前环节的零极点,且ω1<ω2。
3)由于硅微机械陀螺仪实际控制系统中的校正器由数字电路实现,因此,需要对式(A11)进行离散域变换,比例积分控制器的离散域模型为:
式(A12)中:D1(z)为比例积分控制器的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,T0为离散系统采样间隔。
相位超前环节的离散模型利用双线性变换法得:
式(A13)中:D2(z)为相位超前环节的离散域表达式,ω1和ω2分别为相位超前环节的零极点,T0为离散系统采样间隔。
因此,所发明的比例积分控制器与相位超前环节串联数字校正器的表达式为:
式(A14)中:D(z)为所发明的数字校正器,D1(z)为比例积分控制器的离散域表达式,D2(z)为相位超前环节的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1、ω2分别为相位超前环节的零极点,T0为离散系统采样间隔。
图6为本发明的比例积分相位超前数字校正器结构示意图,由比例积分控制器和相位超前环节串联组成,数字校正器的表达式如式(A14)所示;
根据式(A14)得到的伯德图如图7a,7b所示,并将式(A11)的频率特性曲线绘制在图7中。从图可以发现离散域校正器的频率特性曲线与连续域校正器的基本一致,因此,可以用数字校正器(A14)代替式(A11)构成模态匹配状态硅微机械陀螺仪闭环检测系统。其中,图7a的幅频特性曲线图和相频特性曲线图中的两条曲线由式(A11)所示的连续域校正器得到,图7b幅频特性曲线图和相频特性曲线图中的两条曲线由式(A14)所示的数字域校正器得到。
以上所述仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (1)
1.一种用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法,其特征在于,包括以下步骤:
1)对开环检测进行改进,构成陀螺闭环检测环路,根据闭环检测工作原理,可以得到角速度检测闭环传递函数为:
式(A7)中:Hclose(s)为陀螺检测闭环传递函数,Vclose为硅微机械陀螺仪闭环检测输出电压,Ωz表示输入角速度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(s)为相敏解调环节中的低通滤波器传递函数,Gy(s)为陀螺检测模态传递函数,Ffb(s)为力反馈校正器;
闭环检测系统的静态灵敏度可以表示为:
式(A8)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,Hclose(s)为陀螺检测闭环传递函数,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,Hopen(s)为陀螺检测开环传递函数,KyVF为反馈电压到检测反馈力的转换系数,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,为解调相角,Flpf(0)为低通滤波器静态增益,Gy(s)为陀螺检测模态传递函数,Ffb(0)为力反馈校正器静态增益;
当校正器静态增益Ffb(0)很大,即满足环路增益>>1时,此时有:
<mrow>
<msub>
<mi>K</mi>
<mi>s</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>m</mi>
<mi>y</mi>
</msub>
<msub>
<mi>A</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>d</mi>
</msub>
</mrow>
<msub>
<mi>K</mi>
<mrow>
<mi>y</mi>
<mi>V</mi>
<mi>F</mi>
</mrow>
</msub>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
式(A9)中:Ks为硅微机械陀螺仪闭环检测静态灵敏度,my为陀螺检测模态检测质量,Ax为驱动梳齿振动位移,ωd为驱动角频率,KyVF为反馈电压到检测反馈力的转换系数;
从式(A9)可以发现,当环路增益很大时,检测闭环控制系统的静态灵敏度与陀螺频差无关,也与前馈检测增益无关;只与检测质量块大小、驱动模态振动幅度和谐振频率以及检测力反馈转换增益有关;比较式(A9)和式(A4)可知,与开环检测系统的静态灵敏度相比,闭环检测系统的静态灵敏度受温度等环境影响较小,因此可以显著改善系统的稳定性和可靠性;
2)为了方便设计闭环校正器,从哥氏力输入和反馈力输出的角度构成单位负反馈系统,该闭环反馈系统的开环传递函数为:
式(A10)中:Hopen(s)表示闭环反馈系统的开环传递函数,Ff为检测反馈力,Ωz表示输入角速度,Kyc为检测模态梳齿电容转换增益,Kcv为电容电压转换增益,Kamp为检测回路前置放大器增益,Vref为解调基准电压,Ax为驱动梳齿振动位移,ωd为驱动角频率,Flpf(s)为低通滤波器传递函数,Ffb(s)为力反馈校正器传递函数,KyVF为反馈电压到检测反馈力的转换系数,为解调相角,ωy为硅微机械陀螺仪检测模态的谐振角频率,Qy为检测模态品质因数;
在系统中加入频率特性合适的校正器,应该使开环系统频率特性形状满足:低频段增益充分大,以保证系统稳态误差的要求;中频段对数幅频特性斜率-20dB/dec,并占据充分宽的频带,以保证系统具备适当的相角裕度;高频段增益应尽快减小,以削弱噪声的影响;由于模态匹配状态下的陀螺检测模型可以看作一阶惯性环节,因此,可以采用比例积分环节与相位超前环节相结合的串联校正方式来对检测控制回路进行整形;
校正器的传递函数为:
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>f</mi>
<mi>b</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<mfrac>
<msub>
<mi>K</mi>
<mi>i</mi>
</msub>
<mi>s</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
</mrow>
<mrow>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
式(A11)中:Ffb(s)为力反馈校正器传递函数,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1和ω2分别为相位超前环节的零极点,且ω1<ω2;
3)由于硅微机械陀螺仪实际控制系统中的校正器由数字电路实现,因此,需要对式(A11)进行离散域变换,比例积分控制器的离散域模型为:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>z</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>i</mi>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>&CenterDot;</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mn>1</mn>
<mo>-</mo>
<msup>
<mi>z</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>i</mi>
</msub>
<mi>T</mi>
<mo>)</mo>
<mi>z</mi>
<mo>-</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
</mrow>
<mrow>
<mi>z</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
式(A12)中:D1(z)为比例积分控制器的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,T0为离散系统采样间隔;
相位超前环节的离散模型利用双线性变换法得:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>D</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>z</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
</mrow>
<mrow>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
</mrow>
</mfrac>
<msub>
<mo>|</mo>
<mrow>
<mi>s</mi>
<mo>=</mo>
<mfrac>
<mn>2</mn>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
</mfrac>
<mfrac>
<mrow>
<mn>1</mn>
<mo>-</mo>
<msup>
<mi>z</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
<mrow>
<mn>1</mn>
<mo>+</mo>
<msup>
<mi>z</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
</mfrac>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mi>z</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mi>z</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
式(A13)中:D2(z)为相位超前环节的离散域表达式,ω1和ω2分别为相位超前环节的零极点,T0为离散系统采样间隔;
因此,所发明的比例积分控制器与相位超前环节串联数字校正器的表达式为:
<mrow>
<mi>D</mi>
<mrow>
<mo>(</mo>
<mi>z</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>z</mi>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<msub>
<mi>D</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>z</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>i</mi>
</msub>
<mi>T</mi>
<mo>)</mo>
<mi>z</mi>
<mo>-</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
</mrow>
<mrow>
<mi>z</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mfrac>
<mo>&CenterDot;</mo>
<mfrac>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mi>z</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mi>z</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
式(A14)中:D(z)为所发明的数字校正器,D1(z)为比例积分控制器的离散域表达式,D2(z)为相位超前环节的离散域表达式,Kp、Ki分别为比例积分控制器的比例系数和积分系数,ω1、ω2分别为相位超前环节的零极点,T0为离散系统采样间隔。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710366532.0A CN107238381A (zh) | 2017-05-23 | 2017-05-23 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710366532.0A CN107238381A (zh) | 2017-05-23 | 2017-05-23 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107238381A true CN107238381A (zh) | 2017-10-10 |
Family
ID=59984355
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710366532.0A Pending CN107238381A (zh) | 2017-05-23 | 2017-05-23 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107238381A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109029498A (zh) * | 2018-06-15 | 2018-12-18 | 东南大学 | 一种用于振环硅微陀螺仪模态互易的数字测控系统 |
CN109084742A (zh) * | 2018-06-15 | 2018-12-25 | 东南大学 | 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 |
CN109827594A (zh) * | 2019-02-27 | 2019-05-31 | 东南大学 | 基于面内模态旋转的轴对称陀螺仪零位自补偿系统及方法 |
CN110108266A (zh) * | 2019-05-08 | 2019-08-09 | 南京理工大学 | 基于机械vco锁相环的陀螺实时自动闭环模态匹配方法 |
CN110426025A (zh) * | 2019-08-27 | 2019-11-08 | 浙江大学 | 一种微机械陀螺实时自动模态匹配方法 |
CN110631570A (zh) * | 2019-10-17 | 2019-12-31 | 东南大学 | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 |
CN110879532A (zh) * | 2019-12-11 | 2020-03-13 | 中国科学院长春光学精密机械与物理研究所 | 一种控制系统及设计方法 |
CN111024056A (zh) * | 2019-12-19 | 2020-04-17 | 西北工业大学 | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1766528A (zh) * | 2005-11-11 | 2006-05-03 | 中北大学 | 具有较高灵敏度和带宽的差分式微机械陀螺 |
CN102353366A (zh) * | 2011-06-29 | 2012-02-15 | 东南大学 | 硅微动调混合陀螺仪闭环检测装置 |
CN104535057A (zh) * | 2014-12-26 | 2015-04-22 | 东南大学 | 一种硅微机械线振动式陀螺及其正交误差刚度校正方法 |
CN104567849A (zh) * | 2014-12-26 | 2015-04-29 | 东南大学 | 一种硅微机械线振动式陀螺及其带宽拓展方法 |
CN104897150A (zh) * | 2015-06-16 | 2015-09-09 | 中北大学 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
US20160202061A1 (en) * | 2013-09-20 | 2016-07-14 | Albert-Ludwigs-Universitat Freiburg | Method and Circuit For The Time-Continuous Detection Of The Position Of The Sensor Mass With Simultaneous Feedback For Capacitive Sensors |
-
2017
- 2017-05-23 CN CN201710366532.0A patent/CN107238381A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1766528A (zh) * | 2005-11-11 | 2006-05-03 | 中北大学 | 具有较高灵敏度和带宽的差分式微机械陀螺 |
CN102353366A (zh) * | 2011-06-29 | 2012-02-15 | 东南大学 | 硅微动调混合陀螺仪闭环检测装置 |
US20160202061A1 (en) * | 2013-09-20 | 2016-07-14 | Albert-Ludwigs-Universitat Freiburg | Method and Circuit For The Time-Continuous Detection Of The Position Of The Sensor Mass With Simultaneous Feedback For Capacitive Sensors |
CN104535057A (zh) * | 2014-12-26 | 2015-04-22 | 东南大学 | 一种硅微机械线振动式陀螺及其正交误差刚度校正方法 |
CN104567849A (zh) * | 2014-12-26 | 2015-04-29 | 东南大学 | 一种硅微机械线振动式陀螺及其带宽拓展方法 |
CN104897150A (zh) * | 2015-06-16 | 2015-09-09 | 中北大学 | 一种提升硅微机械陀螺仪带宽全温性能的方法 |
Non-Patent Citations (6)
Title |
---|
HUILIANG CAO ET AL: "Sensing mode coupling analysis for dual-mass MEMS gyroscope and bandwidth expansion within wide-temperature range", 《MECHANICAL SYSTEMS AND SIGNAL PROCESSING》 * |
刘宇等: "《固态振动陀螺与导航技术》", 31 May 2010, 中国宇航出版社 * |
曹慧亮等: "双质量硅微机械陀螺仪带宽拓展系统设计", 《中国惯性技术学报》 * |
杨波等: "硅微陀螺仪闭环校正控制系统设计", 《纳米技术与精密工程》 * |
沃克尔•肯普: "《惯性MEMS器件原理与实践》", 31 May 2016, 国防工业出版社 * |
王孝武等: "《自动控制理论》", 31 October 2009, 机械工业出版社 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109029498A (zh) * | 2018-06-15 | 2018-12-18 | 东南大学 | 一种用于振环硅微陀螺仪模态互易的数字测控系统 |
CN109084742A (zh) * | 2018-06-15 | 2018-12-25 | 东南大学 | 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 |
CN109084742B (zh) * | 2018-06-15 | 2022-04-26 | 东南大学 | 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 |
CN109827594A (zh) * | 2019-02-27 | 2019-05-31 | 东南大学 | 基于面内模态旋转的轴对称陀螺仪零位自补偿系统及方法 |
CN110108266A (zh) * | 2019-05-08 | 2019-08-09 | 南京理工大学 | 基于机械vco锁相环的陀螺实时自动闭环模态匹配方法 |
CN110426025A (zh) * | 2019-08-27 | 2019-11-08 | 浙江大学 | 一种微机械陀螺实时自动模态匹配方法 |
CN110631570A (zh) * | 2019-10-17 | 2019-12-31 | 东南大学 | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 |
CN110631570B (zh) * | 2019-10-17 | 2021-03-26 | 东南大学 | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 |
CN110879532A (zh) * | 2019-12-11 | 2020-03-13 | 中国科学院长春光学精密机械与物理研究所 | 一种控制系统及设计方法 |
CN110879532B (zh) * | 2019-12-11 | 2021-12-07 | 中国科学院长春光学精密机械与物理研究所 | 一种控制系统及设计方法 |
CN111024056A (zh) * | 2019-12-19 | 2020-04-17 | 西北工业大学 | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107238381A (zh) | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 | |
CN111578923B (zh) | 一种谐振式陀螺闭环控制方法与系统 | |
CN104535057B (zh) | 一种硅微机械线振动式陀螺及其正交误差刚度校正方法 | |
CN103822623B (zh) | 一种振动式硅微机械陀螺正交误差闭环补偿电路 | |
US8037756B2 (en) | Microelectromechanical gyroscope with open loop reading device and control method | |
CN110631570B (zh) | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 | |
CN104567849B (zh) | 一种硅微机械线振动式陀螺及其带宽拓展方法 | |
CN111551162B (zh) | 一种用于常压封装mems陀螺仪解调相角补偿的系统和方法 | |
CN104897150B (zh) | 一种提升硅微机械陀螺仪带宽全温性能的方法 | |
CN111536993A (zh) | 一种振动陀螺电极角度误差的辨识与补偿方法及系统 | |
CN102607546B (zh) | 用于微机械陀螺的正交误差处理方法及装置 | |
CN102278982B (zh) | 四质量块硅微机械陀螺耦合误差的抑制方法 | |
CN111024056B (zh) | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 | |
CN108681239B (zh) | 一种两轴一体陀螺加速度计解耦伺服控制回路系统及方法 | |
CN102175236A (zh) | 一种可调整降低正交误差的微陀螺仪 | |
CN206378139U (zh) | 一种正交偏置自消除的微机械陀螺仪 | |
CN112066968A (zh) | 一种微机电多环陀螺实时模态自动匹配系统 | |
CN210005012U (zh) | 一种硅mems陀螺仪多回路数字化闭环控制装置 | |
CN109029498B (zh) | 一种用于振环硅微陀螺仪模态互易的数字测控系统 | |
US10302672B2 (en) | Angular velocity detection circuit, angular velocity detection device, electronic apparatus, and moving object | |
CN106441359B (zh) | 一种高精度的微机械陀螺现场模态匹配方法 | |
CN112212849B (zh) | 一种环形三轴解耦微陀螺仪 | |
US20170254645A1 (en) | Angular velocity detection circuit, angular velocity detection device, electronic apparatus, and moving object | |
US20170254644A1 (en) | Drive circuit, angular velocity detection device, electronic apparatus, and moving object | |
CN105258711B (zh) | 一种面向开环检测的微陀螺批量动态测试方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20171010 |
|
RJ01 | Rejection of invention patent application after publication |