CN109084742B - 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 - Google Patents
基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 Download PDFInfo
- Publication number
- CN109084742B CN109084742B CN201810618988.6A CN201810618988A CN109084742B CN 109084742 B CN109084742 B CN 109084742B CN 201810618988 A CN201810618988 A CN 201810618988A CN 109084742 B CN109084742 B CN 109084742B
- Authority
- CN
- China
- Prior art keywords
- frequency
- phase
- gyroscope
- driving
- silicon 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.)
- Active
Links
Images
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
本发明针对低品质因数、小频差的硅微机械陀螺仪最优解调相角易受外界温度影响的问题,利用驱动谐振频率与温度之间的线性关系,提出了基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法,并在FPGA中实现了该补偿方法。该方法不需要增加额外的元器件,且便于参数调整。
Description
技术领域
本发明涉及硅微机械陀螺仪领域,特别是涉及一种基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法。
背景技术
硅微机械陀螺仪是基于哥氏效应来测量敏感轴的输入角速度,它是MEMS技术和惯性技术相结合的产物。相比于传统陀螺仪,它具有体积小、重量轻、成本低、功耗低、易于集成化、可批量生产等特点,这使得它在军用和民用领域都有广阔的应用前景。
美国的Drapper实验室在1988年研制出了第一个硅微机械陀螺仪,此后,随着在MEMS加工工艺以及微电子工艺上不断取得的技术突破,陀螺仪精度大大提高,使得很多研究成果转化为产品被应用到不同领域。现阶段,在陀螺测控系统中运用数字电路的灵活性,实现一些较为复杂的控制算法,在提升陀螺仪测量精度上发挥越来越大的作用。
硅微陀螺的加工材料薄硅片是热敏材料,温度对其机械尺寸和材料弹性模量都有影响,当温度发生变化时,不仅结构尺寸要变性,材料的弹性模量也会发生巨大变化。这些变化体现在对陀螺谐振频率和品质因数等关键参数上,由于检测模态相位与陀螺谐振频率和品质因数有关,检测模态相位决定了最优解调相角。
然而,现有技术中品质因数低、频差小的硅微陀螺仪的最优解调相角易受外界温度影响。
发明内容
发明目的:本发明的目的是针对现有技术中品质因数低、频差小的硅微陀螺仪的最优解调相角易受外界温度影响的问题,提供一种基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法。
技术方案:为达到此目的,本发明采用以下技术方案:
本发明所述的基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法,包括以下步骤:
S1:在-40~60℃的温度范围内,硅微机械陀螺仪数字测控系统工作在稳定状态,对陀螺仪驱动谐振频率f进行提取;
S4:将步骤S3得到的关系模型中的检测模态相位转化为延时计数值N,驱动谐振频率f转换为FPGA中的驱动谐振量化频率F,得到驱动谐振量化频率F与延时计数值N之间的F-N模型,F-N模型用于表征不同温度下通过延时补偿的解调相角;在FPGA中实现F-N模型,并将其嵌入到陀螺仪测控电路中,实现解调相角的最优补偿。
进一步,所述步骤S1中,通过以下方法得到驱动谐振频率f:陀螺仪驱动模态采用锁相环保证其工作在谐振状态,硅微机械陀螺仪数字测控系统稳定时,将锁相环中压控振荡器的频率通过串口进行采集,得到驱动谐振频率f。
式(1)中,Ac1为第一次测量的哥氏信号,Aq1为第一次测量的正交误差信号,Ac2为第二次测量的哥氏信号,Aq2为第二次测量的正交误差信号。
进一步,所述步骤S3中,关系模型通过式(2)得到:
式(2)中,i=1,2,3,表示线性分段数;表示驱动谐振频率f对应的检测模态相位ai和bi为步骤S3中分段线性拟合的第i段的系数,fi-1为为第i段频率区间的起始频率,fi为第i段频率区间的终止频率。
进一步,所述步骤S4中,F-N模型表示为:
式(3)中,j=1,2,3,表示线性分段数;N(F)为驱动谐振量化频率F对应的延时计数值,也即F-N模型;A为角度与弧度之间转换常系数,B为FPGA系统的输入时钟频率,C是与寄存器位数有关的常数,aj和bj为通过原始数据拟合得到的第j段的系数,Fj-1为第j段频率区间的起始频率,Fj为第j段频率区间的终止频率。
有益效果:本发明针对低品质因数、小频差的硅微机械陀螺仪最优解调相角易受外界温度影响的问题,利用驱动谐振频率与温度之间的线性关系,提出了基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法,并在FPGA中实现了该补偿方法。该方法不需要增加额外的元器件,且便于参数调整。
附图说明
图1为本发明具体实施方式中方法所针对的系统的框图;
图2为本发明具体实施方式中硅微机械陀螺仪驱动谐振频率提取电路的原理框图;
图3为本发明具体实施方式中的硅微机械陀螺仪解调相角提取原理框图;
图4为本发明具体实施方式中的基于驱动谐振频率的最优解调相角实现原理框图。
具体实施方式
下面结合具体实施方式和附图对本发明的技术方案作进一步的介绍。
本具体实施方式公开了一种基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法,包括以下步骤:
S1:在-40~60℃的温度范围内,硅微机械陀螺仪数字测控系统工作在稳定状态,对陀螺仪驱动谐振频率f进行提取;
S4:将步骤S3得到的关系模型中的检测模态相位转化为延时计数值N,驱动谐振频率f转换为FPGA中的驱动谐振量化频率F,得到驱动谐振量化频率F与延时计数值N之间的F-N模型,F-N模型用于表征不同温度下通过延时补偿的解调相角;在FPGA中实现F-N模型,并将其嵌入到陀螺仪测控电路中,实现解调相角的最优补偿。如图4所示。
如图1所示,本方法最终基于FPGA实现,嵌入到陀螺测控系统的数字电路中。陀螺测控系统包括陀螺表头、C/V转换电路、同步积分解调电路、AD/DA转换电路、FPGA数字处理平台以及相关的电源及配置电路。其中,FPGA数字平台是控制系统的核心模块,驱动控制模块、相位补偿模块、解调基准模块以及串口模块均在此实现。驱动控制模块由基于自动增益控制来保证幅度稳定,基于锁相环控制使得陀螺驱动模态稳定后工作在谐振频率上;相位补偿模块根据实验所建立的模型来实现,其输入为驱动控制模块中的陀螺驱动谐振频率,输出为延时计数值;解调基准模块根据输入的延时计数值,使得检测输出的解调基准方波产生一定延迟来调整相位,达到调整解调相角的目的;串口模块将需要采集的数据输出到上位机。
步骤S1中,通过以下方法得到驱动谐振频率f:陀螺仪驱动模态采用锁相环保证其工作在谐振状态,硅微机械陀螺仪数字测控系统稳定时,将锁相环中压控振荡器的频率通过串口进行采集,得到驱动谐振频率f。
如图2所示,陀螺驱动谐振频率提取是通过锁相环技术实现的,锁相环由三部分组成:鉴相器、环路滤波器和压控振荡器,所述锁相环在本发明的测控系统中具体实现为:
同步积分解调电路实现鉴相器作用,PI控制器实现环路滤波,压控振荡器由直接数字频率合成(DDS)技术实现。
f=f0+Δf(A2)
由于DDS是在FPGA中进行实现的,能够很容易将得到的谐振频率f通过串口传输到上位机进行采集。
如图3所示,令θ=0,可得正交通道输出为:
式中,Aq、Ac由上位机通过串口采集得到,所以为已知量。Ayq、Ayc分别为哥氏力和正交力引起的检测模态响应,无法得到确定值,所以为未知量。由于驱动回路采用了AGC方案,系统稳定时,陀螺振幅不变,耦合到检测模态引起的正交力大小理论上不会随温度发生改变,所以可认为Ayq大小也不变。
假设在Δt时间内,温度变化很小,引起检测模态相位变化可以忽略,对检测模态施加两个大小不同的哥氏力Fc1、Fc2,检测模态哥氏响应分别为Ayc1、Ayc2,正交响应不发生变化。正交通道和哥氏通道在不同哥氏力下测量值为:
式(1)中,Ac1为第一次测量的哥氏信号,Aq1为第一次测量的正交误差信号,Ac2为第二次测量的哥氏信号,Aq2为第二次测量的正交误差信号。
步骤S3中,关系模型通过式(2)得到:
式(2)中,i=1,2,3,表示线性分段数;表示驱动谐振频率f对应的检测模态相位ai和bi为步骤S3中分段线性拟合的第i段的系数,fi-1为为第i段频率区间的起始频率,fi为第i段频率区间的终止频率。
步骤S4中,F-N模型表示为:
式(3)中,j=1,2,3,表示线性分段数;N(F)为驱动谐振量化频率F对应的延时计数值,也即F-N模型;A为角度与弧度之间转换常系数,B为FPGA系统的输入时钟频率,C是与寄存器位数有关的常数,aj和bj为通过原始数据拟合得到的第j段的系数,Fj-1为第j段频率区间的起始频率,Fj为第j段频率区间的终止频率。
Claims (4)
1.基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法,其特征在于:包括以下步骤:
S1:在-40~60℃的温度范围内,硅微陀螺仪数字测控系统工作在稳定状态,对陀螺仪驱动谐振频率f进行提取;
S4:将步骤S3得到的关系模型中的检测模态相位转化为延时计数值N,驱动谐振频率f转换为FPGA中的驱动谐振量化频率F,得到驱动谐振量化频率F与延时计数值N之间的F-N模型,F-N模型用于表征不同温度下通过延时补偿的解调相角;在FPGA中实现F-N模型,并将其嵌入到陀螺仪测控电路中,实现解调相角的最优补偿;
所述步骤S4中,F-N模型表示为:
2.根据权利要求1所述的基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法,其特征在于:所述步骤S1中,通过以下方法得到驱动谐振频率f:陀螺仪驱动模态采用锁相环保证其工作在谐振状态,硅微陀螺仪数字测控系统稳定时,将锁相环中压控振荡器的频率通过串口进行采集,得到驱动谐振频率f。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810618988.6A CN109084742B (zh) | 2018-06-15 | 2018-06-15 | 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810618988.6A CN109084742B (zh) | 2018-06-15 | 2018-06-15 | 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109084742A CN109084742A (zh) | 2018-12-25 |
CN109084742B true CN109084742B (zh) | 2022-04-26 |
Family
ID=64839617
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810618988.6A Active CN109084742B (zh) | 2018-06-15 | 2018-06-15 | 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109084742B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111435091B (zh) * | 2019-01-14 | 2021-08-31 | 中国科学院微电子研究所 | 自适应相位对准模块和方法、及振动式陀螺仪测控电路 |
CN115127534B (zh) * | 2022-09-01 | 2022-11-18 | 中国船舶重工集团公司第七0七研究所 | 一种基于载波调制的石英陀螺正弦波相位检测补偿方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102109345A (zh) * | 2010-12-13 | 2011-06-29 | 谢元平 | 微机械陀螺数字信号处理方法与装置 |
CN103822623A (zh) * | 2014-03-03 | 2014-05-28 | 中国兵器工业集团第二一四研究所苏州研发中心 | 一种振动式硅微机械陀螺正交误差闭环补偿电路 |
CN104362929A (zh) * | 2014-12-09 | 2015-02-18 | 哈尔滨工业大学 | 机电伺服系统谐振在线识别及动态抑制方法 |
CN107238381A (zh) * | 2017-05-23 | 2017-10-10 | 东南大学 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
CN107389979A (zh) * | 2017-06-28 | 2017-11-24 | 东南大学 | 基于谐振频率的硅微谐振式加速度计在线温度补偿方法 |
-
2018
- 2018-06-15 CN CN201810618988.6A patent/CN109084742B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102109345A (zh) * | 2010-12-13 | 2011-06-29 | 谢元平 | 微机械陀螺数字信号处理方法与装置 |
CN103822623A (zh) * | 2014-03-03 | 2014-05-28 | 中国兵器工业集团第二一四研究所苏州研发中心 | 一种振动式硅微机械陀螺正交误差闭环补偿电路 |
CN104362929A (zh) * | 2014-12-09 | 2015-02-18 | 哈尔滨工业大学 | 机电伺服系统谐振在线识别及动态抑制方法 |
CN107238381A (zh) * | 2017-05-23 | 2017-10-10 | 东南大学 | 用于模态匹配状态硅微机械陀螺仪带宽拓展数字校正方法 |
CN107389979A (zh) * | 2017-06-28 | 2017-11-24 | 东南大学 | 基于谐振频率的硅微谐振式加速度计在线温度补偿方法 |
Non-Patent Citations (2)
Title |
---|
基于锁相解调的硅微谐振陀螺检测电路研究;盛平等;《舰船电子工程》;20091231;第29卷(第3期);第61-64页 * |
真空封装硅微陀螺品质因数的标定;王玉朝等;《光学精密工程》;20141031;第22卷(第10期);第2708-2713页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109084742A (zh) | 2018-12-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4437699B2 (ja) | センサ | |
US10088333B2 (en) | Method and system for gyroscope real-time calibration | |
CN110108266B (zh) | 基于机械vco锁相环的陀螺实时自动闭环模态匹配方法 | |
CN109084742B (zh) | 基于谐振频率的硅微陀螺仪最优解调相角数字补偿方法 | |
CN113532409B (zh) | 一种高精度数字mems陀螺控制系统及方法 | |
CN109211275A (zh) | 一种陀螺仪的零偏温度补偿方法 | |
CN102435774A (zh) | 一种电容式微机械加速度计温度补偿系统及其方法 | |
CN107525968B (zh) | 一种基于压控晶体振荡器的频率测量系统 | |
CN110631570A (zh) | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 | |
US20210276858A1 (en) | Dual-Output Microelectromechanical Resonator and Method of Manufacture and Operation Thereof | |
CN108489512A (zh) | 一种半球谐振陀螺标度因数的补偿标定方法及装置 | |
CN106482747A (zh) | 一种高精度陀螺仪的零偏温度补偿方法 | |
CN109029498B (zh) | 一种用于振环硅微陀螺仪模态互易的数字测控系统 | |
CN105258689A (zh) | 一种数字陀螺仪信号控制处理系统 | |
CN106885563A (zh) | 一种防电学振荡的微机械陀螺仪闭环驱动电路 | |
CN206378139U (zh) | 一种正交偏置自消除的微机械陀螺仪 | |
US20150153174A1 (en) | Apparatus for driving gyro sensor and control method thereof | |
CN115127533A (zh) | 一种基于谐振陀螺振型旋转调制下的误差拟合补偿方法 | |
CN207218667U (zh) | 一种卫星导航时间修正装置 | |
CN108931665A (zh) | 一种用于硅微谐振式加速度计的数字锁相测控电路 | |
CN117490729B (zh) | 一种半球谐振陀螺仪的正交漂移误差检测方法 | |
CN106441359B (zh) | 一种高精度的微机械陀螺现场模态匹配方法 | |
CN106289209A (zh) | 一种适用于宽量程的陀螺仪控制方法和控制系统 | |
CN206593664U (zh) | 一种防电学振荡的微机械陀螺仪闭环驱动电路 | |
CN110988760B (zh) | 一种Mx型铯光泵磁力仪的数字化信号检测系统 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |