CN109029437B - 三自由度闭环陀螺数字接口电路 - Google Patents

三自由度闭环陀螺数字接口电路 Download PDF

Info

Publication number
CN109029437B
CN109029437B CN201811250740.5A CN201811250740A CN109029437B CN 109029437 B CN109029437 B CN 109029437B CN 201811250740 A CN201811250740 A CN 201811250740A CN 109029437 B CN109029437 B CN 109029437B
Authority
CN
China
Prior art keywords
module
switch
capacitor
loop
output end
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
Application number
CN201811250740.5A
Other languages
English (en)
Other versions
CN109029437A (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.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
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 Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201811250740.5A priority Critical patent/CN109029437B/zh
Publication of CN109029437A publication Critical patent/CN109029437A/zh
Application granted granted Critical
Publication of CN109029437B publication Critical patent/CN109029437B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18Stabilised platforms, e.g. by gyroscope

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Gyroscopes (AREA)

Abstract

本发明公开了一种三自由度闭环陀螺数字接口电路,所述陀螺数字接口电路的主要功能是激励陀螺微机械敏感结构产生驱动模态的恒定幅度稳定振动以及测量科里奥利力作用下检测模态的振动状态并从中解算得出角速度信号,包含二个基本控制环路,其中幅值控制环路和相位控制环路组成驱动控制环路,速率控制环路和正交控制环路组成检测控制环路。本发明的三自由度闭环陀螺数字接口电路应用元器件的分时复用方案实现陀螺接口电路的共享设计,具有表征三维空间角速度信息的信号处理能力,有效解决三自由度闭环陀螺数字接口电路的元件共享设计问题,达到高集成度、高可靠性、低功耗、低成本的设计目的,并满足高精度陀螺的性能需求。

Description

三自由度闭环陀螺数字接口电路
技术领域
本发明属于传感器技术领域,涉及一种传感器接口电路,尤其是一种陀螺接口电路。
背景技术
陀螺作为测量运载体角速度的传感器,是惯性导航控制系统的一种基础核心元器件,成为现代航空、航海、航天和国防工业等领域中广泛应用的惯性导航仪器。其中,微机械陀螺以其高精度、高集成度、高可靠性、低功耗、低成本等突出优势成为现代陀螺仪的重要发展方向。近年来我国军事科技和国防工业领域的长足发展对陀螺的研究水平,尤其是对陀螺接口电路的性能提出了更高的要求。
三维空间角速度测量的应用环境下通常需要陀螺具有三自由度的角速度敏感特性。目前的设计方案普遍采用三只陀螺设备通过空间装配分别测量各自敏感方向的角速度信息。这种方案实现简单,避免了二次设计,能够方便地组合形成产品,但降低了整体传感器的集成度和可靠性,同时增加功耗、体积和成本,在实际应用中存在缺陷,应用在军事和国防领域并不理想。
发明内容
为了解决现有技术中使用三只独立陀螺装配组合满足三维空间角速度测量需求,而导致三自由度陀螺参数指标下降的问题,本发明提供了一种三自由度闭环陀螺数字接口电路,该数字接口电路具有三自由度陀螺角速度信号处理能力,应用元器件的分时复用方案实现陀螺接口电路的共享设计。
本发明的目的是通过以下技术方案实现的:
一种三自由度闭环陀螺数字接口电路,包括驱动控制环路和检测控制环路,其中:
所述驱动控制环路由幅值控制环路和相位控制环路组成;
所述幅值控制环路用于在陀螺机械敏感结构的驱动方向形成闭环驱动控制,保证闭环驱动控制信号幅值稳定性,由电压转换模块A、模数转换模块A、峰值检测模块A、PI控制模块A、加减运算模块A、数模转换模块A组成;
所述相位控制环路用于陀螺在工作环境变化或受到外界干扰时确保驱动控制环路中交流控制信号实时跟踪并锁定陀螺机械敏感结构的固有频率和锁定相位变化,抑制非理想特性,由锁相环模块A组成;
所述检测控制环路由速率控制环路和正交控制环路组成;
所述速率控制环路用于在陀螺机械敏感结构的检测方向形成闭环检测控制,抑制由于机械振动引起的误差并实现角速度信号输出,由电压转换模块B、模数转换模块B、减法运算模块B、解调模块B、低通滤波模块B、PI控制模块B、加减运算模块B、数模转换模块B组成;
所述正交控制环路用于抑制由陀螺机械敏感结构加工精度误差引起的检测控制环路中角速度信号包含的正交分量,弥补工艺误差导致的陀螺整机性能降低,由解调模块C、低通滤波模块C、PI控制模块C组成;
所述陀螺机械敏感结构的一对驱动检测电极分别连接电压转换模块A的一对差分输入端,电压转换模块A的交流电压信号输出端连接模数转换模块A的输入端,模数转换模块A的数字信号输出端连接峰值检测模块A和锁相环模块A的输入端,峰值检测模块A输出的幅值信息输入PI控制模块A的输入端,由PI控制模块A完成驱动信号幅度自动控制,PI控制模块A的输出端连接加减运算模块A的一个输入端,锁相环模块A的同相输出端连接加减运算模块A的另一个输入端,加减运算模块A完成信号运算操作,加减运算模块A的输出端连接数模转换模块A的输入端,数模转换模块A的一对差分输出端分别连接陀螺机械敏感结构的一对驱动电极;
所述陀螺机械敏感结构的一对检测电极分别连接电压转换模块B的一对差分输入端,电压转换模块B的交流电压信号输出端连接模数转换模块B的输入端,模数转换模块B的数字信号输出端连接减法运算模块B的一个输入端和解调模块C的一个输入端,锁相环模块A的正交输出端连接解调模块C的另一个输入端,由解调模块C完成陀螺角速度信号正交分量解算操作,解调模块C的交流信号输出端连接低通滤波模块C的输入端,由低通滤波模块C滤除高频交流信号分量,低通滤波模块C的输出端连接PI控制模块C的输入端,由PI控制模块C完成检测交流信号正交分量幅度自动控制,PI控制模块C的输出端连接减法运算模块B的另一个输入端,由减法运算模块B剔除检测交流信号中的正交成分,减法运算模块B的输出端连接解调模块B的一个输入端,锁相环模块A的同相输出端连接解调模块B的另一个输入端,由解调模块B完成陀螺角速度信号解算操作,解调模块B的交流信号输出端连接低通滤波模块B的输入端,由低通滤波模块B滤除高频交流信号分量,低通滤波模块B的输出端连接PI控制模块B的输入端,由PI控制模块B完成陀螺机械敏感结构在检测方向的角速度信号幅度自动控制,PI控制模块B的输出端连接加减运算模块B的一个输入端,锁相环模块A的同相输出端连接加减运算模块B的另一个输入端,加减运算模块B完成信号运算操作,加减运算模块B的输出端连接数模转换模块B的输入端,数模转换模块B的一对差分输出端分别连接陀螺机械敏感结构的一对检测反馈电极。
相比于现有技术,本发明具有如下优点:
1、本发明的三自由度闭环陀螺数字接口电路应用元器件的分时复用方案实现陀螺接口电路的共享设计,具有表征三维空间角速度信息的信号处理能力,有效解决三自由度闭环陀螺数字接口电路的元件共享设计问题,达到高集成度、高可靠性、低功耗、低成本的设计目的,并满足高精度陀螺的性能需求。
2、本发明的三自由度闭环陀螺数字接口电路的主要功能是激励陀螺微机械敏感结构产生驱动模态的恒定幅度稳定振动以及测量科里奥利力作用下检测模态的振动状态并从中解算得出角速度信号,包含二个基本控制环路,其中幅值控制环路和相位控制环路组成驱动控制环路,速率控制环路和正交控制环路组成检测控制环路。在陀螺机械敏感结构的驱动方向上,驱动控制环路和陀螺机械敏感结构的一对驱动检测电极和一对驱动电极形成闭合控制环路,保证驱动信号的幅值和相位稳定性,确保形成低噪声、低失真和高稳定性的驱动控制,为陀螺的高精度检测性能提供前提条件;在陀螺机械敏感结构的检测方向上,检测控制环路和陀螺机械敏感结构的一对检测电极和一对检测反馈电极形成闭合控制环路,在检测方向的一对检测反馈电极上形成静电力,用于抵消检测方向科里奥利力作用,避免开环检测电路设计中由于陀螺机械敏感结构的中心质量块在科里奥利力作用下简谐振动引入的非理想因素。
3、本发明采用的模数转换器具有三通道数据转换功能,实现了三自由度陀螺空间角速度信号的采集,实现接口电路的复用,避免电路元件冗余引起的传感器性能下降。
4、本发明采用的数字接口电路设计在陀螺抵抗环境干扰和提高温度特性方面具有有益效果。
附图说明
图1为本发明所述三自由度闭环陀螺数字接口电路的原理图;
图2为模数转换模块的原理图;
图3为模数转换模块中调制器部分的电路图。
具体实施方式
下面结合附图对本发明的技术方案作进一步的说明,但并不局限于此,凡是对本发明技术方案进行修改或者等同替换,而不脱离本发明技术方案的范围,均应涵盖在本发明的保护范围中。
具体实施方式一:下面结合图1说明本实施方式,本实施方式中的三自由度闭环陀螺数字接口电路包括驱动控制环路和检测控制环路,其中:
所述驱动控制环路由幅值控制环路和相位控制环路组成。由于存在阻尼,驱动控制环路中的交流驱动电压信号幅值会随运行时间推移而产生衰减,因此驱动控制环路需要具有补充驱动信号能量的作用。另外,外部环境变化带来的温度漂移和机械结构老化等影响会导致谐振特性发生改变。所述幅值控制环路用于在陀螺机械敏感结构100的驱动方向形成闭环驱动控制,保证外界因素变化条件下的闭环驱动控制信号幅值稳定性,由电压转换模块A101、模数转换模块A102、峰值检测模块A103、PI控制模块A104、加减运算模块A106、数模转换模块A107组成。所述相位控制环路用于陀螺在工作环境变化或受到外界干扰时确保驱动控制环路中交流控制信号实时跟踪并锁定陀螺机械敏感结构的固有频率和锁定相位变化,抑制非理想特性,由锁相环模块A105组成,所述锁相环模块A105一般包括鉴相器、环路滤波器和压控振荡器。所述陀螺机械敏感结构100和驱动控制环路的具体连接方式为:陀螺机械敏感结构100的一对驱动检测电极分别连接电压转换模块A101的一对差分输入端,电压转换模块A101的交流电压信号输出端连接模数转换模块A102的输入端,模数转换模块A102的数字信号输出端连接峰值检测模块A103和锁相环模块A105的输入端,峰值检测模块A103输出的幅值信息输入PI控制模块A104的输入端,由PI控制模块A104完成驱动信号幅度自动控制,PI控制模块A104的输出端连接加减运算模块A106的一个输入端,锁相环模块A105的同相输出端连接加减运算模块A106的另一个输入端,加减运算模块A106完成信号运算操作,加减运算模块A106的输出端连接数模转换模块A107的输入端,数模转换模块A107的一对差分输出端分别连接陀螺机械敏感结构100的一对驱动电极。
所述检测控制环路由速率控制环路和正交控制环路组成,其中:所述速率控制环路用于在陀螺机械敏感结构的检测方向形成闭环检测控制,抑制由于机械振动引起的误差并实现角速度信号输出,由电压转换模块B108、模数转换模块B109、减法运算模块B110、解调模块B111、低通滤波模块B112、PI控制模块B113、加减运算模块B114、数模转换模块B115组成。所述正交控制环路用于抑制由陀螺机械敏感结构加工精度误差引起的检测控制环路中角速度信号包含的正交分量,弥补工艺误差导致的陀螺整机性能降低,由解调模块C116、低通滤波模块C117、PI控制模块C118组成。所述陀螺机械敏感结构100和检测控制环路的具体连接方式为:陀螺机械敏感结构100的一对检测电极分别连接电压转换模块B108的一对差分输入端,电压转换模块B108的交流电压信号输出端连接模数转换模块B109的输入端,模数转换模块B109的数字信号输出端连接减法运算模块B110的一个输入端和解调模块C116的一个输入端,锁相环模块A105的正交输出端连接解调模块C116的另一个输入端,由解调模块C116完成陀螺角速度信号正交分量解算操作,解调模块C116的交流信号输出端连接低通滤波模块C117的输入端,由低通滤波模块C117滤除高频交流信号分量,低通滤波模块C117的输出端连接PI控制模块C118的输入端,由PI控制模块C118完成检测交流信号正交分量幅度自动控制,PI控制模块C118的输出端连接减法运算模块B110的另一个输入端,由减法运算模块B110剔除检测交流信号中的正交成分,减法运算模块B110的输出端连接解调模块B111的一个输入端,锁相环模块A105的同相输出端连接解调模块B111的另一个输入端,由解调模块B111完成陀螺角速度信号解算操作,解调模块B111的交流信号输出端连接低通滤波模块B112的输入端,由低通滤波模块B112滤除高频交流信号分量,低通滤波模块B112的输出端连接PI控制模块B113的输入端,由PI控制模块B113完成陀螺机械敏感结构100在检测方向的角速度信号幅度自动控制,PI控制模块B113的输出端连接加减运算模块B114的一个输入端,锁相环模块A105的同相输出端连接加减运算模块B114的另一个输入端,加减运算模块B114完成信号运算操作,加减运算模块B114的输出端连接数模转换模块B115的输入端,数模转换模块B115的一对差分输出端分别连接陀螺机械敏感结构100的一对检测反馈电极。
具体实施方式二:下面结合图2说明本实施方式,本实施方式对具体实施方式一作进一步说明。三自由度闭环陀螺数字接口电路的技术要点在于接口电路具有表征三维空间角速度信息的信号处理能力,即接口电路必须采用分时复用设计技术。本发明应用采样保持技术和增量型数模转换器设计出三通道增量型数据转换器作为模数转换模块A102和模数转换模块B109,有效解决了三自由度闭环陀螺数字接口电路的元件共享设计问题,达到高集成度、高可靠性、低功耗、低成本的设计目的。
本实施方式中,所述模数转换模块A102和模数转换模块B109包括采样保持模块201、模拟斩波模块202、环路滤波模块203、量化模块204、抽取滤波模块205、加法运算模块206、数字斩波模块207、寄存器模块208、动态元件匹配模块209、量化反馈模块210、逐次逼近模块211、减法运算模块212。
本实施方式,所述模数转换模块A102和模数转换模块B109的工作原理为:输入电压信号经采样保持模块201处理后,由模拟斩波模块202完成信号调制操作,先由逐次逼近模块211锁定输入信号区间范围,作为由环路滤波模块203执行的ΣΔ数据转换过程的参考电压,同时作为最终输出数字信号的高位信息,再由环路滤波模块203执行ΣΔ数据转换过程,由抽取滤波模块205执行低通滤波操作,输出信号作为最终输出数字信号的低位信息。加法运算模块206将高位和低位信息叠加后合成输出数字信号,经数字斩波模块207处理恢复信号形式,作为整体模数转换模块A102和模数转换模块B109的输出。其中,模拟斩波模块202和数字斩波模块207组合形成系统级斩波,将低频干扰噪声调制到高频处,进一步提高噪声抑制能力。
本实施方式,所述模数转换模块A102和模数转换模块B109内部元件的具体连接方式为:采样保持模块201的输入端作为整体模数转换模块A102和模数转换模块B109的输入端,采样保持模块201的输出端连接由斩波信号控制的模拟斩波模块202的输入端,模拟斩波模块202的输出端连接减法运算模块212的一个输入端,减法运算模块212的输出端同时连接环路滤波模块203的输入端和逐次逼近模块211的输入端,减法运算模块212的输出信号作为由环路滤波模块203实现的噪声整形操作的输入信号,环路滤波模块203的输出端连接量化模块204的输入端,量化模块204的输出端同时连接抽取滤波模块205的输入端和量化反馈模块210的一个输入端,量化模块204的输出信号作为由抽取滤波模块205实现的低通滤波操作的输入信号,抽取滤波模块205的输出端连接加法运算模块206的一个输入端,逐次逼近模块211的输出端连接寄存器模块208的输入端,寄存器模块208的一个输出端连接加法运算模块206的另一个输入端,寄存器模块208的另一个输出端连接动态元件匹配模块209的输入端,由动态元件匹配模块209降低数字模拟信号转换操作的积分非线性,动态元件匹配模块209的输出端连接量化反馈模块210的另一个输入端,量化反馈模块210的输出端连接减法运算模块212的另一个输入端,减法运算模块212的输出信号作为由逐次逼近模块211实现的预量化操作的输入信号,加法运算模块206将抽取滤波模块205的输出信号和寄存器模块208的输出信号进行叠加操作,加法运算模块206的输出端连接由斩波信号控制的数字斩波模块207的输入端,数字斩波模块207的输出端作为整体模数转换模块A102和模数转换模块B109的输出端。
具体实施方式三:下面结合图3说明本实施方式,本实施方式对具体实施方式二作进一步说明。本实施方式中,所述模数转换模块A102和模数转换模块B109中核心信号转换部分环路滤波模块203应用开关电容设计结构,避免使用集成电路工艺中浪费面积的电阻,节约芯片面积并降低成本;利用电容比例实现电路参数,提高电路系数精度。
本实施方式中,所述环路滤波模块203包括运算放大器A1、运算放大器A2、运算放大器A3、电容CI1、电容CS2、电容CI2、电容CS3、电容CI3、电容CF1、电容CF2、电容CF3、开关S3、开关S4、开关S5、开关S6、开关S7、开关S8、开关S9、开关S10、开关S11、开关S12、开关S13、开关S14、开关S15、开关S16、开关S17、开关S18、开关S19;开关S3的一端和开关S4的一端连接,并和运算放大器A1的负输入端连接,开关S3的另一端连接到中间电位GND;开关S4的另一端和开关S5的一端连接,并和电容CI1的一端连接;开关S5的另一端和电容CI1的另一端连接,并和运算放大器A1的输出端连接;运算放大器A1的正输入端连接到中间电位GND;开关S6的一端和运算放大器A1的输出端连接,另一端和开关S7、电容CS2、电容CF1的一端连接;开关S7的另一端连接到中间电位GND;电容CS2的另一端和开关S8、开关S9的一端连接;开关S8的另一端连接到中间电位GND;开关S9的另一端和开关S10的一端连接,并和电容CI2的一端连接;开关S10的另一端和电容CI2的另一端连接,并和运算放大器A2的输出端连接;运算放大器A2的正输入端连接到中间电位GND;开关S11的一端和运算放大器A2的输出端连接,另一端和开关S12、电容CS3、电容CF2的一端连接;开关S12的另一端连接到中间电位GND;电容CS3的另一端和开关S13、开关S14的一端连接;开关S13的另一端连接到中间电位GND;开关S14的另一端和开关S15的一端连接,并和电容CI3的一端连接;开关S15的另一端和电容CI3的另一端连接,并和运算放大器A3的输出端连接;运算放大器A3的正输入端连接到中间电位GND;开关S16的一端和运算放大器A3的输出端连接,另一端和开关S17、电容CF3的一端连接;开关S17的另一端连接到中间电位GND;电容CF3的另一端和电容CF1、电容CF2相连,并和开关S18、开关S19的一端连接;开关S18的另一端连接到中间电位GND;开关S19的另一端连接到量化模块204的输入端。
本实施方式中,所述模数转换模块A102和模数转换模块B109中前级的量化反馈模块210用于形成负反馈,锁定参考电压范围,实现环路量化误差校正,由若干开关电容阵列组成,开关电容阵列的具体数量取决于模数转换模块A102和模数转换模块B109的实际性能指标,包括开关S1n、开关S2n、开关S1、开关S2、电容CSn;开关S1n和开关S2n的一端分别和负参考电位VREF-和正参考电位VREF+连接,开关S1n和开关S2n的另一端互相连接,并和开关S2的一端连接,开关S1的一端作为斩波信号输入端,即连接模拟斩波模块202的输出端,开关S1的另一端和开关S2的另一端连接,并和电容CSn的一端连接。

Claims (4)

1.一种三自由度闭环陀螺数字接口电路,其特征在于所述陀螺数字接口电路包括驱动控制环路和检测控制环路,其中:
所述驱动控制环路由幅值控制环路和相位控制环路组成;
所述幅值控制环路用于在陀螺机械敏感结构的驱动方向形成闭环驱动控制,保证闭环驱动控制信号幅值稳定性,由电压转换模块A、模数转换模块A、峰值检测模块A、PI控制模块A、加减运算模块A、数模转换模块A组成;
所述相位控制环路用于陀螺在工作环境变化或受到外界干扰时确保驱动控制环路中交流控制信号实时跟踪并锁定陀螺机械敏感结构的固有频率和锁定相位变化,抑制非理想特性,由锁相环模块A组成;
所述检测控制环路由速率控制环路和正交控制环路组成;
所述速率控制环路用于在陀螺机械敏感结构的检测方向形成闭环检测控制,抑制由于机械振动引起的误差并实现角速度信号输出,由电压转换模块B、模数转换模块B、减法运算模块B、解调模块B、低通滤波模块B、PI控制模块B、加减运算模块B、数模转换模块B组成;
所述正交控制环路用于抑制由陀螺机械敏感结构加工精度误差引起的检测控制环路中角速度信号包含的正交分量,弥补工艺误差导致的陀螺整机性能降低,由解调模块C、低通滤波模块C、PI控制模块C组成;
所述陀螺机械敏感结构的一对驱动检测电极分别连接电压转换模块A的一对差分输入端,电压转换模块A的交流电压信号输出端连接模数转换模块A的输入端,模数转换模块A的数字信号输出端连接峰值检测模块A和锁相环模块A的输入端,峰值检测模块A输出的幅值信息输入PI控制模块A的输入端,由PI控制模块A完成驱动信号幅度自动控制,PI控制模块A的输出端连接加减运算模块A的一个输入端,锁相环模块A的同相输出端连接加减运算模块A的另一个输入端,加减运算模块A完成信号运算操作,加减运算模块A的输出端连接数模转换模块A的输入端,数模转换模块A的一对差分输出端分别连接陀螺机械敏感结构的一对驱动电极;
所述陀螺机械敏感结构的一对检测电极分别连接电压转换模块B的一对差分输入端,电压转换模块B的交流电压信号输出端连接模数转换模块B的输入端,模数转换模块B的数字信号输出端连接减法运算模块B的一个输入端和解调模块C的一个输入端,锁相环模块A的正交输出端连接解调模块C的另一个输入端,由解调模块C完成陀螺角速度信号正交分量解算操作,解调模块C的交流信号输出端连接低通滤波模块C的输入端,由低通滤波模块C滤除高频交流信号分量,低通滤波模块C的输出端连接PI控制模块C的输入端,由PI控制模块C完成检测交流信号正交分量幅度自动控制,PI控制模块C的输出端连接减法运算模块B的另一个输入端,由减法运算模块B剔除检测交流信号中的正交成分,减法运算模块B的输出端连接解调模块B的一个输入端,锁相环模块A的同相输出端连接解调模块B的另一个输入端,由解调模块B完成陀螺角速度信号解算操作,解调模块B的交流信号输出端连接低通滤波模块B的输入端,由低通滤波模块B滤除高频交流信号分量,低通滤波模块B的输出端连接PI控制模块B的输入端,由PI控制模块B完成陀螺机械敏感结构在检测方向的角速度信号幅度自动控制,PI控制模块B的输出端连接加减运算模块B的一个输入端,锁相环模块A的同相输出端连接加减运算模块B的另一个输入端,加减运算模块B完成信号运算操作,加减运算模块B的输出端连接数模转换模块B的输入端,数模转换模块B的一对差分输出端分别连接陀螺机械敏感结构的一对检测反馈电极。
2.根据权利要求1所述的三自由度闭环陀螺数字接口电路,其特征在于所述模数转换模块A和模数转换模块B包括采样保持模块、模拟斩波模块、减法运算模块、环路滤波模块、量化模块、抽取滤波模块、加法运算模块、数字斩波模块、寄存器模块、动态元件匹配模块、量化反馈模块、逐次逼近模块,其中:采样保持模块的输入端作为整体模数转换模块A和模数转换模块B的输入端,采样保持模块的输出端连接由斩波信号控制的模拟斩波模块的输入端,模拟斩波模块的输出端连接减法运算模块的一个输入端,减法运算模块的输出端同时连接环路滤波模块的输入端和逐次逼近模块的输入端,减法运算模块的输出信号作为由环路滤波模块实现的噪声整形操作的输入信号,环路滤波模块的输出端连接量化模块的输入端,量化模块的输出端同时连接抽取滤波模块的输入端和量化反馈模块的一个输入端,量化模块的输出信号作为由抽取滤波模块实现的低通滤波操作的输入信号,抽取滤波模块的输出端连接加法运算模块的一个输入端,逐次逼近模块的输出端连接寄存器模块的输入端,寄存器模块的一个输出端连接加法运算模块的另一个输入端,寄存器模块的另一个输出端连接动态元件匹配模块的输入端,由动态元件匹配模块降低数字模拟信号转换操作的积分非线性,动态元件匹配模块的输出端连接量化反馈模块的另一个输入端,量化反馈模块的输出端连接减法运算模块的另一个输入端,减法运算模块的输出信号作为由逐次逼近模块实现的预量化操作的输入信号,加法运算模块将抽取滤波模块的输出信号和寄存器模块的输出信号进行叠加操作,加法运算模块的输出端连接由斩波信号控制的数字斩波模块的输入端,数字斩波模块的输出端作为整体模数转换模块A和模数转换模块B的输出端。
3.根据权利要求2所述的三自由度闭环陀螺数字接口电路,其特征在于所述环路滤波模块包括运算放大器A1、运算放大器A2、运算放大器A3、电容CI1、电容CS2、电容CI2、电容CS3、电容CI3、电容CF1、电容CF2、电容CF3、开关S3、开关S4、开关S5、开关S6、开关S7、开关S8、开关S9、开关S10、开关S11、开关S12、开关S13、开关S14、开关S15、开关S16、开关S17、开关S18、开关S19,其中:开关S3的一端和开关S4的一端连接,并和运算放大器A1的负输入端连接,开关S3的另一端连接到中间电位GND;开关S4的另一端和开关S5的一端连接,并和电容CI1的一端连接;开关S5的另一端和电容CI1的另一端连接,并和运算放大器A1的输出端连接;运算放大器A1的正输入端连接到中间电位GND;开关S6的一端和运算放大器A1的输出端连接,另一端和开关S7、电容CS2、电容CF1的一端连接;开关S7的另一端连接到中间电位GND;电容CS2的另一端和开关S8、开关S9的一端连接;开关S8的另一端连接到中间电位GND;开关S9的另一端和开关S10的一端连接,并和电容CI2的一端连接;开关S10的另一端和电容CI2的另一端连接,并和运算放大器A2的输出端连接;运算放大器A2的正输入端连接到中间电位GND;开关S11的一端和运算放大器A2的输出端连接,另一端和开关S12、电容CS3、电容CF2的一端连接;开关S12的另一端连接到中间电位GND;电容CS3的另一端和开关S13、开关S14的一端连接;开关S13的另一端连接到中间电位GND;开关S14的另一端和开关S15的一端连接,并和电容CI3的一端连接;开关S15的另一端和电容CI3的另一端连接,并和运算放大器A3的输出端连接;运算放大器A3的正输入端连接到中间电位GND;开关S16的一端和运算放大器A3的输出端连接,另一端和开关S17、电容CF3的一端连接;开关S17的另一端连接到中间电位GND;电容CF3的另一端和电容CF1、电容CF2相连,并和开关S18、开关S19的一端连接;开关S18的另一端连接到中间电位GND;开关S19的另一端连接到量化模块的输入端。
4.根据权利要求2所述的三自由度闭环陀螺数字接口电路,其特征在于所述量化反馈模块用于形成负反馈,锁定参考电压范围,实现环路量化误差校正,由若干开关电容阵列组成,所述开关电容阵列包括开关S1n、开关S2n、开关S1、开关S2、电容CSn,其中:开关S1n和开关S2n的一端分别和负参考电位VREF-和正参考电位VREF+连接,开关S1n和开关S2n的另一端互相连接,并和开关S2的一端连接,开关S1的一端作为斩波信号输入端,即连接模拟斩波模块的输出端,开关S1的另一端和开关S2的另一端连接,并和电容CSn的一端连接,CSn的另一端为量化反馈模块的输出端。
CN201811250740.5A 2018-10-25 2018-10-25 三自由度闭环陀螺数字接口电路 Active CN109029437B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811250740.5A CN109029437B (zh) 2018-10-25 2018-10-25 三自由度闭环陀螺数字接口电路

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811250740.5A CN109029437B (zh) 2018-10-25 2018-10-25 三自由度闭环陀螺数字接口电路

Publications (2)

Publication Number Publication Date
CN109029437A CN109029437A (zh) 2018-12-18
CN109029437B true CN109029437B (zh) 2021-03-30

Family

ID=64613874

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811250740.5A Active CN109029437B (zh) 2018-10-25 2018-10-25 三自由度闭环陀螺数字接口电路

Country Status (1)

Country Link
CN (1) CN109029437B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110865580B (zh) * 2019-11-27 2022-07-26 中国船舶重工集团公司第七0七研究所 基于时分复用的半球谐振陀螺全差分控制系统及控制方法
CN111220139B (zh) * 2019-12-30 2022-04-01 南京理工大学 一种微机电多环陀螺力平衡模式测控电路系统
CN111637876B (zh) * 2020-05-15 2021-12-07 北京控制工程研究所 一种高带宽高精度速率积分陀螺模拟器实现方法
CN115290061B (zh) * 2022-06-29 2024-08-06 北京航天控制仪器研究所 一种serf陀螺仪数字式饱和吸收稳频控制系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102620726A (zh) * 2012-04-04 2012-08-01 西北工业大学 微机械陀螺的双闭环控制电路
CN103822623A (zh) * 2014-03-03 2014-05-28 中国兵器工业集团第二一四研究所苏州研发中心 一种振动式硅微机械陀螺正交误差闭环补偿电路
CN105301284A (zh) * 2015-10-30 2016-02-03 哈尔滨工程大学 一种低功耗数字加速度计接口电路系统
CN106370172A (zh) * 2016-08-30 2017-02-01 上海交通大学 基于数字化嵌入式系统的微陀螺驱动与检测装置及方法
CN107747952A (zh) * 2017-09-20 2018-03-02 北京航空航天大学 一种光纤陀螺闭环反馈控制三角形相位调制波驱动装置
CN107830851A (zh) * 2017-10-26 2018-03-23 哈尔滨工业大学 角速度传感器的数字化驱动控制集成电路

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6222425B2 (ja) * 2013-04-24 2017-11-01 セイコーエプソン株式会社 物理量検出回路、物理量検出装置、電子機器及び移動体

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102620726A (zh) * 2012-04-04 2012-08-01 西北工业大学 微机械陀螺的双闭环控制电路
CN103822623A (zh) * 2014-03-03 2014-05-28 中国兵器工业集团第二一四研究所苏州研发中心 一种振动式硅微机械陀螺正交误差闭环补偿电路
CN105301284A (zh) * 2015-10-30 2016-02-03 哈尔滨工程大学 一种低功耗数字加速度计接口电路系统
CN106370172A (zh) * 2016-08-30 2017-02-01 上海交通大学 基于数字化嵌入式系统的微陀螺驱动与检测装置及方法
CN107747952A (zh) * 2017-09-20 2018-03-02 北京航空航天大学 一种光纤陀螺闭环反馈控制三角形相位调制波驱动装置
CN107830851A (zh) * 2017-10-26 2018-03-23 哈尔滨工业大学 角速度传感器的数字化驱动控制集成电路

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
《A Fully Integrated Circuit for MEMS Vibrating Gyroscope Using Standard》;Sheng-Ren Chiu等;《International Microsystems,Packaging Assembly and Circuits Technology conference》;20151231;第315-318页 *
双片集成数字硅陀螺接口ASIC的设计与测试;付强 等;《哈尔滨工业大学学报》;20171031;第49卷(第10期);第90-94页 *

Also Published As

Publication number Publication date
CN109029437A (zh) 2018-12-18

Similar Documents

Publication Publication Date Title
CN109029437B (zh) 三自由度闭环陀螺数字接口电路
US10309984B2 (en) High-precision pendulous accelerometer
US7454967B2 (en) Signal conditioning methods and circuits for a capacitive sensing integrated tire pressure sensor
CN102620726B (zh) 微机械陀螺的双闭环控制电路
CN102707088B (zh) 微机械加速度计的高阶连续低通sigma-delta闭环控制电路
CN106289212B (zh) 用于硅微音叉陀螺的集成测控单元
CN105699694B (zh) 基于fpga的微机电混合σδm加速度计闭环检测电路系统
CN105758402B (zh) 一种硅微陀螺的闭环检测系统
AU2004236400A1 (en) Operating method for a coriolis gyroscope and evaluation/adjustment electronic system and pulse modulator suitable therefor
CN107504964B (zh) 自时钟数字式微机械陀螺σδm闭环检测电路系统
CN108931665B (zh) 一种用于硅微谐振式加速度计的数字锁相测控电路
CN115479595A (zh) 一种半球谐振陀螺分时复用参数辨识系统及方法
CN103411594A (zh) 微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路
Almutairi et al. Multi stage noise shaping sigma–delta modulator (MASH) for capacitive MEMS accelerometers
Ismail et al. A high performance MEMS based digital-output gyroscope
CN109168116B (zh) 一种提高mems陀螺静态和线性度指标的角速率闭环方法
CN115773740B (zh) 一种谐振陀螺控制方法及控制系统
Shi et al. A miniatured fully integrated high resolution and accuracy capacitive angle encoder
Xia et al. Design of a digitalized microgyroscope system using $\Sigma\Delta $ modulation technology
Bestetti et al. Low-power frequency-to-digital-converter for a 6-axis MEMS frequency-modulated inertial measurement unit
CN106323277A (zh) 一种激光陀螺惯导仪表信号采集电路
CN114152266B (zh) Mems陀螺正交误差校正系统
Chen et al. Self-clocking electro-mechanical sigma-delta modulator quadrature error cancellation for MEMS gyroscope
CN210198392U (zh) 一种新型mems谐振式陀螺仪测控装置
Liu et al. A high precision time-multiplexed fully differential interface ASIC for capacitive MEMS accelerometer

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