CN114152266B - Mems陀螺正交误差校正系统 - Google Patents
Mems陀螺正交误差校正系统 Download PDFInfo
- Publication number
- CN114152266B CN114152266B CN202010935517.5A CN202010935517A CN114152266B CN 114152266 B CN114152266 B CN 114152266B CN 202010935517 A CN202010935517 A CN 202010935517A CN 114152266 B CN114152266 B CN 114152266B
- Authority
- CN
- China
- Prior art keywords
- phase
- quadrature
- signal
- mems gyroscope
- sigma
- 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
- 238000012937 correction Methods 0.000 title claims abstract description 46
- 238000006073 displacement reaction Methods 0.000 claims abstract description 25
- 238000007781 pre-processing Methods 0.000 claims abstract description 14
- 238000001914 filtration Methods 0.000 claims description 26
- 238000001514 detection method Methods 0.000 claims description 7
- 230000005764 inhibitory process Effects 0.000 abstract description 4
- 230000014509 gene expression Effects 0.000 description 8
- 238000000034 method Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 5
- 238000012546 transfer Methods 0.000 description 5
- 230000008878 coupling Effects 0.000 description 4
- 238000010168 coupling process Methods 0.000 description 4
- 238000005859 coupling reaction Methods 0.000 description 4
- 238000013139 quantization Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000010354 integration Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000006872 improvement Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001629 suppression Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 101000872083 Danio rerio Delta-like protein C Proteins 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005459 micromachining Methods 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000010363 phase shift Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000003595 spectral effect Effects 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Classifications
-
- 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)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供一种MEMS陀螺正交误差校正系统,包括:MEMS陀螺敏感模态电极,用于生成位移信号;预处理组件,与所述MEMS陀螺敏感模态电极相连,用于将所述位移信号转换为数字电压信号;数字解调组件,与所述多位量化器和所述MEMS陀螺敏感模态电极相连,用于根据所述数字电压信号生成同相1比特脉宽密度调制信号和正交相1比特脉宽密度调制信号,并反馈至所述MEMS陀螺敏感模态电极。本发明的MEMS陀螺正交误差校正系统能够在不增加特定校正电极的前提下,解决现有技术中对MEMS陀螺正交误差抑制能力和校正实时性不强的问题,有效提高了MEMS陀螺的精度。
Description
技术领域
本发明涉及微机电系统(Micro-Electro-Mechanical System,MEMS)惯性传感器领域的技术领域,特别是涉及一种MEMS陀螺正交误差校正系统。
背景技术
陀螺仪是惯性导航系统的关键传感器之一,其性能直接决定了导航系统的精度。传统的激光陀螺、光纤陀螺和原子陀螺等具有精度高、稳定性好等优点,但是价格昂贵、体积较大,无法满足导航系统的小型化要求。基于MEMS技术的微机械陀螺,体积小、功耗低且易批量化生产,是未来陀螺仪传感器的一个重要发展方向。因此,如何实现MEMS陀螺达到导航级精度水平一直是该领域研究的重点和难点。
正交误差是目前影响MEMS陀螺精度提高的最显著误差源之一。这是由于MEMS陀螺在微加工过程中不可避免的存在非线性刚度耦合误差。与敏感模态的角速率位移相比,陀螺驱动位移较大,导致刚度耦合误差产生的正交位移也很大。这严重影响了MEMS陀螺的各项指标精度。现有的MEMS陀螺正交误差校正(抑制)技术主要包括以下两种:
(1)机械校正技术
机械校正需要MEMS陀螺结构具有特定的校正电极,通过在校正电极加载DC直流电压来调整陀螺刚度误差,实现陀螺模态刚度同性对称。
(2)电路校正技术
电路校正需要外围接口电路产生反馈静电力去平衡抵消MEMS陀螺上的等效正交误差力,达到校正的结果。
现有研究表明,基于高阶微机电Sigma-Delta力平衡闭环调制的MEMS陀螺技术,兼具数字静电力反馈平衡和高阶Sigma-Delta信号调制输出的优点,是实现高精度导航级MEMS陀螺传感器的有效技术之一,在传感器系统的灵活性、稳定性和集成性等方面均具有显著的优势。但是,现有的微机电Sigma-Delta陀螺技术还无法对MEMS陀螺正交误差进行有效的校正,这也制约了微机电Sigma-Delta陀螺精度的进一步提高。
发明内容
鉴于以上所述现有技术的缺点,本发明的目的在于提供一种MEMS陀螺正交误差校正系统,能够在不增加特定校正电极的前提下,解决现有技术中对MEMS陀螺正交误差抑制能力和校正实时性不强的问题,有效提高了MEMS陀螺的精度。
为实现上述目的及其他相关目的,本发明提供一种MEMS陀螺正交误差校正系统,包括:MEMS陀螺敏感模态电极,用于生成位移信号;预处理组件,与所述MEMS陀螺敏感模态电极相连,用于将所述位移信号转换为数字电压信号;数字解调组件,与所述多位量化器和所述MEMS陀螺敏感模态电极相连,用于根据所述数字电压信号生成同相1比特脉宽密度调制信号和正交相1比特脉宽密度调制信号,并反馈至所述MEMS陀螺敏感模态电极。
于本发明一实施例中,所述MEMS陀螺敏感模态电极包括检测电极和反馈电极;所述检测电极用于生成所述位移信号;所述反馈电极用于接收所述同相1比特脉宽密度调制信号和所述正交相1比特脉宽密度调制信号。
于本发明一实施例中,所述预处理组件包括:
前置电路,与所述MEMS陀螺敏感模态电极相连,用于将所述MEMS陀螺敏感模态电极生成的位移信号转换为模拟电压信号;
多位量化器,与所述前置电路相连,用于将所述模拟电压信号转换为数字电压信号。
于本发明一实施例中,所述数字解调组件包括同向解调模块、正交相解调模块、同相低通滤波模块、正交相低通滤波模块、同向调制模块、正交相调制模块、同相Sigma-Delta调制单元、正交相Sigma-Delta调制单元和反馈控制开关;
所述同向解调模块与所述预处理组件的输出端相连,用于根据所述数字电压信号生成同相解调信号;
所述正交相解调模块与所述预处理组件的输出端相连,用于根据所述数字电压信号生成正交相解调信号;
所述同相低通滤波模块与所述同向解调模块相连,用于对所述同相解调信号进行低通滤波;
所述正交相低通滤波模块与所述正交向解调模块相连,用于对所述正交相解调信号进行低通滤波;
所述同向调制模块与所述同相低通滤波模块相连,用于将低通滤波后的同相解调信号调制为高频同相信号;
所述正交相调制模块与所述正交相低通滤波模块相连,用于将低通滤波后的正交相解调信号调制为高频正交相信号;
所述同相Sigma-Delta调制单元与所述同相调制模块相连,用于根据所述高频同相信号生成所述同相1比特脉宽密度调制信号;
所述正交相Sigma-Delta调制单元与所述正交相调制模块相连,用于根据所述高频正交相信号生成所述正交相1比特脉宽密度调制信号;
所述反馈控制开关与所述同相Sigma-Delta调制单元和所述正交相Sigma-Delta调制单元相连,用于根据控制时序将所述同相1比特脉宽密度调制信号和所述正交相1比特脉宽密度调制信号反馈至所述MEMS陀螺敏感模态电极。
于本发明一实施例中,所述同相Sigma-Delta调制单元包括Sigma-Delta调制器、数字补偿器和1比特量化器;所述Sigma-Delta调制器用于对所述高频同相信号进行Sigma-Delta调制,生成同相脉宽密度调制信号;所述数字补偿器用于对所述同相脉宽密度调制信号进行数字补偿;所述1比特量化器用于根据所述同相脉宽密度调制信号生成所述同相1比特脉宽密度调制信号。
于本发明一实施例中,所述Sigma-Delta调制器采用Sigma-Delta前馈结构或分布多反馈结构。
于本发明一实施例中,所述正交相Sigma-Delta调制单元包括Sigma-Delta调制器、数字补偿器和1比特量化器;所述Sigma-Delta调制器用于对所述高频正交相信号进行Sigma-Delta调制,生成正交相脉宽密度调制信号;所述数字补偿器用于对所述正交相脉宽密度调制信号进行数字补偿;所述1比特量化器用于根据所述正交相脉宽密度调制信号生成所述正交相1比特脉宽密度调制信号。
于本发明一实施例中,所述Sigma-Delta调制器采用Sigma-Delta前馈结构或分布多反馈结构。
于本发明一实施例中,所述数字解调组件还包括时序控制单元,用于生成控制时序并输入所述反馈控制开关。
于本发明一实施例中,所述数字解调组件基于FPGA实现。
如上所述,本发明的MEMS陀螺正交误差校正系统,具有以下有益效果:
(1)通过将MEMS陀螺敏感模态的输出信号进行解调和调制,形成两路正交的微机电Sigma-Delta调制闭环测控回路,从而在实现角速率科氏力平衡闭环的同时,对陀螺正交误差力进行平衡闭环校正;
(2)能够在不增加特定校正电极的前提下,解决现有技术中对MEMS陀螺正交误差抑制能力和校正实时性不强的问题,有效提高了MEMS陀螺的精度;
(3)相比借助于特定电极的传统机械校正方法,能够在数字域实现,具有较高的灵活性和集成性。
附图说明
图1显示为本发明的MEMS陀螺正交误差校正系统于一实施例中的结构示意图;
图2显示为本发明的MEMS陀螺于一实施例中的微机械结构原理图;
图3显示为本发明的Sigma-Delta调制单元于一实施例中的结构原理图;
图4显示为本发明的MEMS陀螺进行Sigma-Delta正交误差校正前后的仿真结果图;
图5显示为本发明的MEMS陀螺进行Sigma-Delta正交误差校正前后的测试结果图。
具体实施方式
以下通过特定的具体实例说明本发明的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本发明的精神下进行各种修饰或改变。需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合。
需要说明的是,以下实施例中所提供的图示仅以示意方式说明本发明的基本构想,遂图式中仅显示与本发明中有关的组件而非按照实际实施时的组件数目、形状及尺寸绘制,其实际实施时各组件的型态、数量及比例可为一种随意的改变,且其组件布局型态也可能更为复杂。
本发明的MEMS陀螺正交误差校正系统通过将MEMS陀螺敏感模态的输出信号进行解调和调制,能够在不增加特定校正电极的前提下,有效提高MEMS陀螺的精度,同时解决现有技术中对MEMS陀螺正交误差抑制能力和校正实时性不强的问题,极具实用性。
如图1和图2所示,于一实施例中,本发明的MEMS陀螺正交误差校正系统包括MEMS陀螺敏感模态电极1、预处理组件2和数字解调组件3。
所述MEMS陀螺敏感模态电极1用于生成位移信号。具体地,所述MEMS陀螺敏感模态电极包括检测电极和反馈电极。所述检测电极用于生成位移信号,其中所述位移信号包括正交位移误差信号和角速率位移信号,为二者的叠加。所述反馈电极用于接收所述数字解调组件3返回的同相1比特脉宽密度调制信号和正交相1比特脉宽密度调制信号,从而通过闭环方式实现MEMS陀螺正交误差校正。
所述预处理组件2与所述MEMS陀螺敏感模态电极1相连,用于将所述位移信号转换为数字电压信号。于本发明一实施例中,所述预处理组件2包括串联的前置电路21和多位量化器22。所述前置电路21与所述MEMS陀螺敏感模态电极1相连,用于将所述MEMS陀螺敏感模态电极1生成的位移信号转换为模拟电压信号Vsense(t)。优选地,所述前置电路21采用电容电压特征测试装置,从而将以电容表征的位移信号转换模拟电压信号。所述多位量化器22用于将所述模拟电压信号Vsense(t)转换为数字电压信号Vsense(z)。
数字解调组件3与所述多位量化器22和所述MEMS陀螺敏感模态电极1相连,用于根据所述数字电压信号生成同相1比特脉宽密度调制信号和正交相1比特脉宽密度调制信号,并反馈至所述MEMS陀螺敏感模态电极1。
于本发明一实施例中,所述数字解调组件3包括同向解调模块31、正交相解调模块32、同相低通滤波模块33、正交相低通滤波模块34、同向调制模块35、正交相调制模块36、同相Sigma-Delta调制单元37、正交相Sigma-Delta调制单元38和反馈控制开关39。
所述同向解调模块31与所述预处理组件2的输出端相连,用于根据所述数字电压信号Vsense(z)生成同相解调信号Vrate(z)。其中,所述同相解调信号Vrate(z)为角速率位移信号。所述同相解调模块31包括一路输入的解调基准信号,即0°相移的驱动模态位移信号VIn-phase(z)。
所述正交相解调模块32与所述预处理组件2的输出端相连,用于根据所述数字电压信号Vsense(z)生成正交相解调信号Verror(z)。其中,所述正交相解调信号Verror(z)为正交位移误差信号。所述正交相解调模块32包括一路输入的解调基准信号,即90°相移的驱动模态位移信号VQuad-phase(z)。
所述同相低通滤波模块33与所述同向解调模块31相连,用于对所述同相解调信号Vrate(z)进行低通滤波。
所述正交相低通滤波模块34与所述正交向解调模块32相连,用于对所述正交相解调信号Verror(z)进行低通滤波。
所述同向调制模块35与所述同相低通滤波模块33相连,用于将低通滤波后的同相解调信号Vrate(z)调制为高频同相信号V’rate(z)。其中,所述同相调制模块35包括一路输入的调制基准信号,即同相调制基准信号V’In-phase(z)。
所述正交相调制模块36与所述正交相低通滤波模块34相连,用于将低通滤波后的正交相解调信号调制为高频正交相信号V’error(z)。其中,所述正交相调制模块36包括一路输入的调制基准信号,即正交相调制基准信号V’Quad-phase(z)。
所述同相Sigma-Delta调制单元37与所述同相调制模块35相连,用于根据所述高频同相信号V’rate(z)生成所述同相1比特脉宽密度调制信号BIn-phase(t)。于本发明一实施例中,所述同相Sigma-Delta调制单元37包括Sigma-Delta调制器371、数字补偿器372和1比特量化器373。所述Sigma-Delta调制器371用于对所述高频同相信号V’rate(z)进行Sigma-Delta调制,生成同相脉宽密度调制信号。所述数字补偿器372用于对所述同相脉宽密度调制信号进行数字补偿。所述1比特量化器373用于根据所述同相脉宽密度调制信号生成所述同相1比特脉宽密度调制信号BIn-phase(t)。优选地,所述Sigma-Delta调制器371采用可选的高阶Sigma-Delta调制器,可以是Sigma-Delta前馈结构(Feed-forward)或分布多反馈结构(Multi-feedback)。
所述正交相Sigma-Delta调制单元38与所述正交相调制模块36相连,用于根据所述高频正交相信号V’error(z)生成所述正交相1比特脉宽密度调制信号BQuad-phase(t)。于本发明一实施例中,所述正交相Sigma-Delta调制单元38包括Sigma-Delta调制器381、数字补偿器382和1比特量化器383。所述Sigma-Delta调制器381用于对所述高频正交相信号V’error(z)进行Sigma-Delta调制,生成正交相脉宽密度调制信号。所述数字补偿器382用于对所述正交相脉宽密度调制信号进行数字补偿。所述1比特量化器383用于根据所述正交相脉宽密度调制信号生成所述正交相1比特脉宽密度调制信号BQuad-phase(t)。优选地,所述Sigma-Delta调制器381采用可选的高阶Sigma-Delta调制器,可以是Sigma-Delta前馈结构(Feed-forward)或分布多反馈结构(Multi-feedback)。
所述反馈控制开关39与所述同相Sigma-Delta调制单元37和所述正交相Sigma-Delta调制单元38相连,用于根据控制时序将所述同相1比特脉宽密度调制信号BIn-phase(t)和所述正交相1比特脉宽密度调制信号BQuad-phase(t)反馈至所述MEMS陀螺敏感模态电极1,从而与所述MEMS陀螺敏感模态电极1一起形成了同相微机电Sigma-Delta闭环调制回路和正交相微机电Sigma-Delta闭环调制回路。
于本发明一实施例中,所述数字解调组件3还包括时序控制单元(图中未示出),用于生成控制时序并输入所述反馈控制开关39。其中,所述反馈控制开关34包括第一端、第二端、第三端和第四端;所述第一端和所述第二端分别与所述同相1比特脉宽密度调制信号BIn-phase(t)和所述正交相1比特脉宽密度调制信号BQuad-phase(t)相连;所述第三端和所述第四端分别与所述MEMS陀螺敏感模态电极1和所述时序控制单元相连接。
优选地,本发明的MEMS陀螺正交误差校正系统还包括频率电压转换电路(F/V),与所述反馈控制开关39和所述MEMS陀螺敏感模态电极1,用于将所述反馈控制开关39输出的频率形式的控制信号转换电压信号再反馈至所述MEMS陀螺敏感模态电极1中。
于本发明一实施例中,所述数字解调组件基于FPGA实现。
下面通过具体实施例来进一步阐述本发明的MEMS陀螺正交误差校正系统。
在该实施例中,采用的MEMS陀螺为圆盘轮式谐振结构,首先陀螺在驱动电极激励作用下,内环和外环惯性转子沿着Z轴平面内转动谐振,当陀螺基座沿着X/Y轴转动时,角速率与惯性谐振转子一起在陀螺结构上产生科氏力,该科氏力导致惯性转子在Z轴方向进行差分振动,通过提取该差分振动信号就可以用于表征角速率信号。其中,MEMS陀螺驱动模态和敏感模态中心转动惯量(μg×μm2)分别为Id=1.11×107、Is=1.11×107;谐振品质因素(Q值)分别为:Qd=5.1×105、Qs=8000;谐振频率(Hz)分别为fd=4660、fs=4760。MEMS陀螺敏感结构同时受产生的科氏力和正交误差力作用,作用力的表达式分别可以写为:
FCoriolis(t)=2·m·Ω·ωd·A·sin(ωdt)
FTotal(t)=FCoriolis(t)+FQuad(t)
=ωd·A·m(2·Ω·sin(ωdt)+ε·ωd·cos(ωdt))
其中,m、Ω、ωd、A和ε分别为MEMS陀螺的有效转动惯量、外部输入角速率、驱动谐振频率、驱动谐振幅值和正交耦合系数。通过以上计算可以看出,MEMS陀螺敏感模态检测电极输出的是正交位移误差信号和角速率位移信号叠加的电容信号ΔC(t)。该电容信号ΔC(t)经过前置电路转换为电压信号ΔV(t),电压信号ΔV(t)经过18位量化器转换为数字电压信号Vsense(z),其中z=nT,n为采样数,T为采样周期。
该数字电压信号Vsense(z)进入数字解调组件中的同相解调模块、正交相解调模块、同相低通滤波模块和正交相低通滤波模块。在同相解调模块和正交相解调模块中分别与解调参考信号和/>进行同相和正交相解调,解调之后分别得到信号V′rate(nT)和V′error(nT);V′rate(nT)和V′error(nT)再分别经过同相低通滤波模块和正交相低通滤波模块分别得到同相角速率电压信号Vrate(nT)和正交相误差电压信号Verror(nT)。以上各部分信号的表达式如下所示:
V′rate(nT)=ωd·A·m·(2Ω(1-cos(2ωdnT))+0.5εωdsin(2ωdnT))
V′error(nT)=ωd·A·m·(2Ωsin(2ωdnT))+0.5εωd(1+cos(2ωdnT))
|Vrate(nT)|=|2ωd·A·m·Ω|
同相角速率信号Vrate(nT)和正交相误差信号Verror(nT)分别进入数字调制组件中的同相调制模块和正交相调制模块,与调制参考信号sin(ωdnT+θ1)和cos(ωdnT+θ2)分别进行调制得到高频同相角速率调制电压信号V″rate(nT)和高频正交相误差调制电压信号V″error(nT)。V″rate(nT)和V″error(nT)的信号表达式分别如下:
V″rate(nT)=2ωd·A·m·Ω·sin(ωdnT+θ1)
图3所示即为同相回路和正交相回路中的二阶分布反馈式Sigma-Delta调制器,调制器中包括多分布式反馈通道B和B1、C和C1、电前馈通道D和D1。
同相回路要处理的信号包括科氏力信号Fc、电噪声信号Enoise和量化噪声信号Qnoise1和Qnoise2,正交相回路输出数字信号BIn-phase(t)表达式为BIn-phase(t)=STF×(FCoriolis force)+ENTF×Enoise+Q1NTF×Qnoise_1+Q2NTF×Qnoise_2。正交相回路要处理的信号包括正交耦合误差力信号Fq、电噪声信号E'noise和量化噪声信号Q'noise_1和Q'noise_2,正交相回路输出数字信号BQuad-phase(t)表达式为BIn-phase(t)=STF'×(FCoriolisforce)+ENTF×Enoise+Q1NTF×Q'noise_1+Q2NTF×Q'noise_2。其中包括科氏力传递函数(STF)、正交误差力传递函数(STF')、电噪声传递函数(ENTF)和量化噪声传递函数(Q1NTF和Q2NTF),表达式分别为:
其中,M(z)为陀螺敏感模态传递函数表达式,Kpo为C/V前置接口电路增益系数,Kfb为反馈增益系数,其中T(z)和L(z)的表达式分别为和Kq1和Kq2分别为多位ADC和1位量化器的量化增益。
如图4所示为本发明MEMS陀螺Simulink系统模型仿真输出信号功率谱密度(PSD),其中输出信号的Sigma-Delta噪声整形中心频率位于4760Hz,正交误差信号频率位于4660Hz,在正交误差校准前陀螺系统正交误差等效输出角速率值为200/s,经过Sigma-Delta正交误差校准之后陀螺正交误差幅值的衰减度超过了80dB,小于0.02/s。
基于加工封装完成的MEMS陀螺芯片构建了角速率传感系统,如图5所示,整个MEMS陀螺传感系统的面积为6cm×3cm,采用单电源+5V供电。输出信号的功率谱密度也如图5所示。其中Sigma-Delta噪声整形中心频率也位于4760Hz,正交误差等效输入角速率值为200/s,64Hz带宽范围内底噪为-120dB。经过Sigma-Delta正交误差校准之后陀螺正交误差幅值的衰减度达到了80dB,与仿真结果相吻合。
综上所述,本发明的MEMS陀螺正交误差校正系统通过将MEMS陀螺敏感模态的输出信号进行解调和调制,形成两路正交的微机电Sigma-Delta调制闭环测控回路,从而在实现角速率科氏力平衡闭环的同时,对陀螺正交误差力进行平衡闭环校正;能够在不增加特定校正电极的前提下,解决现有技术中对MEMS陀螺正交误差抑制能力和校正实时性不强的问题,有效提高了MEMS陀螺的精度;相比借助于特定电极的传统机械校正方法,能够在数字域实现,具有较高的灵活性和集成性。所以,本发明有效克服了现有技术中的种种缺点而具高度产业利用价值。
上述实施例仅例示性说明本发明的原理及其功效,而非用于限制本发明。任何熟悉此技术的人士皆可在不违背本发明的精神及范畴下,对上述实施例进行修饰或改变。因此,举凡所属技术领域中具有通常知识者在未脱离本发明所揭示的精神与技术思想下所完成的一切等效修饰或改变,仍应由本发明的权利要求所涵盖。
Claims (9)
1.一种MEMS陀螺正交误差校正系统,其特征在于:包括:
MEMS陀螺敏感模态电极,用于生成位移信号;
预处理组件,与所述MEMS陀螺敏感模态电极相连,用于将所述位移信号转换为数字电压信号;所述预处理组件包括:前置电路,与所述MEMS陀螺敏感模态电极相连,用于将所述MEMS陀螺敏感模态电极生成的位移信号转换为模拟电压信号;多位量化器,与所述前置电路相连,用于将所述模拟电压信号转换为数字电压信号;
数字解调组件,与所述多位量化器和所述MEMS陀螺敏感模态电极相连,用于根据所述数字电压信号生成同相1比特脉宽密度调制信号和正交相1比特脉宽密度调制信号,并反馈至所述MEMS陀螺敏感模态电极。
2.根据权利要求1所述的MEMS陀螺正交误差校正系统,其特征在于:所述MEMS陀螺敏感模态电极包括检测电极和反馈电极;所述检测电极用于生成所述位移信号;所述反馈电极用于接收所述同相1比特脉宽密度调制信号和所述正交相1比特脉宽密度调制信号。
3.根据权利要求1所述的MEMS陀螺正交误差校正系统,其特征在于:所述数字解调组件包括同相解调模块、正交相解调模块、同相低通滤波模块、正交相低通滤波模块、同相调制模块、正交相调制模块、同相Sigma-Delta调制单元、正交相Sigma-Delta调制单元和反馈控制开关;
所述同相解调模块与所述预处理组件的输出端相连,用于根据所述数字电压信号生成同相解调信号;
所述正交相解调模块与所述预处理组件的输出端相连,用于根据所述数字电压信号生成正交相解调信号;
所述同相低通滤波模块与所述同相解调模块相连,用于对所述同相解调信号进行低通滤波;
所述正交相低通滤波模块与所述正交相解调模块相连,用于对所述正交相解调信号进行低通滤波;
所述同相调制模块与所述同相低通滤波模块相连,用于将低通滤波后的同相解调信号调制为高频同相信号;
所述正交相调制模块与所述正交相低通滤波模块相连,用于将低通滤波后的正交相解调信号调制为高频正交相信号;
所述同相Sigma-Delta调制单元与所述同相调制模块相连,用于根据所述高频同相信号生成所述同相1比特脉宽密度调制信号;
所述正交相Sigma-Delta调制单元与所述正交相调制模块相连,用于根据所述高频正交相信号生成所述正交相1比特脉宽密度调制信号;
所述反馈控制开关与所述同相Sigma-Delta调制单元和所述正交相Sigma-Delta调制单元相连,用于根据控制时序将所述同相1比特脉宽密度调制信号和所述正交相1比特脉宽密度调制信号反馈至所述MEMS陀螺敏感模态电极。
4.根据权利要求3所述的MEMS陀螺正交误差校正系统,其特征在于:所述同相Sigma-Delta调制单元包括Sigma-Delta调制器、数字补偿器和1比特量化器;所述Sigma-Delta调制器用于对所述高频同相信号进行Sigma-Delta调制,生成同相脉宽密度调制信号;所述数字补偿器用于对所述同相脉宽密度调制信号进行数字补偿;所述1比特量化器用于根据所述同相脉宽密度调制信号生成所述同相1比特脉宽密度调制信号。
5.根据权利要求4所述的MEMS陀螺正交误差校正系统,其特征在于:所述Sigma-Delta调制器采用Sigma-Delta前馈结构或分布多反馈结构。
6.根据权利要求3所述的MEMS陀螺正交误差校正系统,其特征在于:所述正交相Sigma-Delta调制单元包括Sigma-Delta调制器、数字补偿器和1比特量化器;所述Sigma-Delta调制器用于对所述高频正交相信号进行Sigma-Delta调制,生成正交相脉宽密度调制信号;所述数字补偿器用于对所述正交相脉宽密度调制信号进行数字补偿;所述1比特量化器用于根据所述正交相脉宽密度调制信号生成所述正交相1比特脉宽密度调制信号。
7.根据权利要求6所述的MEMS陀螺正交误差校正系统,其特征在于:所述Sigma-Delta调制器采用Sigma-Delta前馈结构或分布多反馈结构。
8.根据权利要求3所述的MEMS陀螺正交误差校正系统,其特征在于:所述数字解调组件还包括时序控制单元,用于生成控制时序并输入所述反馈控制开关。
9.根据权利要求1所述的MEMS陀螺正交误差校正系统,其特征在于:所述数字解调组件基于FPGA实现。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010935517.5A CN114152266B (zh) | 2020-09-08 | 2020-09-08 | Mems陀螺正交误差校正系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010935517.5A CN114152266B (zh) | 2020-09-08 | 2020-09-08 | Mems陀螺正交误差校正系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114152266A CN114152266A (zh) | 2022-03-08 |
CN114152266B true CN114152266B (zh) | 2024-04-02 |
Family
ID=80460696
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010935517.5A Active CN114152266B (zh) | 2020-09-08 | 2020-09-08 | Mems陀螺正交误差校正系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114152266B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114894221B (zh) * | 2022-07-06 | 2022-09-23 | 中国船舶重工集团公司第七0七研究所 | 一种半球谐振陀螺正交耦合误差标定方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104344821A (zh) * | 2013-07-26 | 2015-02-11 | 大西洋惯性系统有限公司 | 信号处理 |
CN105874303A (zh) * | 2013-08-26 | 2016-08-17 | 罗伯特·博世有限公司 | 用于通过解调相位误差校正的陀螺仪零速率偏移漂移降低的系统和方法 |
CN107436144A (zh) * | 2016-05-26 | 2017-12-05 | 中国科学院微电子研究所 | 自动消除陀螺仪正交误差的电路 |
CN109073381A (zh) * | 2016-05-11 | 2018-12-21 | 株式会社村田制作所 | 具有力反馈能力的副感测回路 |
CN109931959A (zh) * | 2019-03-27 | 2019-06-25 | 河海大学常州校区 | 硅微陀螺仪正交误差校正方法 |
CN111024056A (zh) * | 2019-12-19 | 2020-04-17 | 西北工业大学 | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6983024B2 (en) * | 2003-03-18 | 2006-01-03 | Qualcomm Inc. | Quadra-polar modulator |
US11365983B2 (en) * | 2016-06-03 | 2022-06-21 | Invensense, Inc. | Demodulation phase calibration using external input |
US10267650B2 (en) * | 2016-06-03 | 2019-04-23 | Invensense, Inc. | Demodulation phase calibration |
-
2020
- 2020-09-08 CN CN202010935517.5A patent/CN114152266B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104344821A (zh) * | 2013-07-26 | 2015-02-11 | 大西洋惯性系统有限公司 | 信号处理 |
CN105874303A (zh) * | 2013-08-26 | 2016-08-17 | 罗伯特·博世有限公司 | 用于通过解调相位误差校正的陀螺仪零速率偏移漂移降低的系统和方法 |
CN109073381A (zh) * | 2016-05-11 | 2018-12-21 | 株式会社村田制作所 | 具有力反馈能力的副感测回路 |
CN107436144A (zh) * | 2016-05-26 | 2017-12-05 | 中国科学院微电子研究所 | 自动消除陀螺仪正交误差的电路 |
CN109931959A (zh) * | 2019-03-27 | 2019-06-25 | 河海大学常州校区 | 硅微陀螺仪正交误差校正方法 |
CN111024056A (zh) * | 2019-12-19 | 2020-04-17 | 西北工业大学 | 一种高动态输入的mems陀螺带宽扩展闭环控制方法 |
Non-Patent Citations (2)
Title |
---|
基于非线性模态和一种数值迭代法的陀螺连续体 参数振动研究;齐辉 等;力学与实践;第40卷(第1期);全文 * |
硅微陀螺仪正交误差校正系统的分析与设计;王晓雷 等;中国惯性技术学报;第21卷(第6期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114152266A (zh) | 2022-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR100758426B1 (ko) | 코리올리 자이로를 위한 작동방법 및 측정/제어 전자시스템및 펄스 변조기 | |
CN105758402B (zh) | 一种硅微陀螺的闭环检测系统 | |
US9374069B2 (en) | Signal processing | |
CN110426025B (zh) | 一种微机械陀螺实时自动模态匹配方法 | |
CN107504964B (zh) | 自时钟数字式微机械陀螺σδm闭环检测电路系统 | |
CN111412907B (zh) | 一种微机电多环陀螺的全角测控电路系统 | |
CN105258689B (zh) | 一种数字陀螺仪信号控制处理系统 | |
CN114152266B (zh) | Mems陀螺正交误差校正系统 | |
Bu et al. | Effect of circuit phase delay on bias stability of MEMS gyroscope under force rebalance detection and self-compensation method | |
CN1206110A (zh) | 惯性传感器的信号处理系统 | |
Sheng et al. | Design of a dual quantization electromechanical sigma–delta modulator MEMS vibratory wheel gyroscope | |
CN115479595A (zh) | 一种半球谐振陀螺分时复用参数辨识系统及方法 | |
CN109029437B (zh) | 三自由度闭环陀螺数字接口电路 | |
CN112066968A (zh) | 一种微机电多环陀螺实时模态自动匹配系统 | |
CN113819898B (zh) | 一种正交力反馈闭环的小频差石英陀螺误差抑制方法 | |
CN206378139U (zh) | 一种正交偏置自消除的微机械陀螺仪 | |
Fan et al. | High performance MEMS disk gyroscope with force-to-rebalance operation mode | |
CN106323263B (zh) | 硅微陀螺机电结合带通sigma-delta闭环检测电路 | |
CN108332732B (zh) | 微机械单振子三轴陀螺仪的驱动和检测装置 | |
CN106370170A (zh) | 硅微陀螺机电结合带通sigma‑delta闭环检测环路参数获取方法 | |
CN210198392U (zh) | 一种新型mems谐振式陀螺仪测控装置 | |
CN108332734B (zh) | 测量微机械单振子三轴陀螺仪的三轴角速度的方法 | |
CN108318019B (zh) | 测量微机械单振子三轴陀螺仪的三轴角速度的方法 | |
CN105258711B (zh) | 一种面向开环检测的微陀螺批量动态测试方法 | |
CN106595714A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |