CN105021176B - Mems陀螺仪测控电路 - Google Patents
Mems陀螺仪测控电路 Download PDFInfo
- Publication number
- CN105021176B CN105021176B CN201410166890.3A CN201410166890A CN105021176B CN 105021176 B CN105021176 B CN 105021176B CN 201410166890 A CN201410166890 A CN 201410166890A CN 105021176 B CN105021176 B CN 105021176B
- Authority
- CN
- China
- Prior art keywords
- circuit
- signal
- mems gyroscope
- mems
- telemetry
- 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
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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种MEMS陀螺仪测控电路,为基于IP核的SOPC数字处理电路,其特征在于所述IP核接收MEMS陀螺仪驱动轴检测信号,并输出相应的驱动信号;且所述IP核接收MEMS陀螺仪敏感轴检测信号,并输出MEMS陀螺仪的角速率;在现有MEMS陀螺仪的基础上,通过SOPC数字处理技术、电荷放大器、失调电容补偿来实现测控电路的高增益、低噪声,从而提高陀螺整体的稳定性和抗干扰能力的方法来提高陀螺仪的精度。
Description
技术领域
本发明属于误差信号处理技术领域,具体涉及一种MEMS陀螺仪测控电路。
背景技术
微机电***(Micro Electro Mechanical System,MEMS),是在微电子技术基础上结合精密机械技术发展起来的一个新的学科领域。MEMS技术具有体积小、重量轻、功耗低等优点,基于此技术发展起来的微惯性器件就是一类典型的MEMS传感器,它的出现极大地扩展了惯性技术的应用范围,使得基于微惯性器件构建低成本、高性能的微惯性导航***迅速成为当前惯性技术领域的一个研究热点。
目前,MEMS陀螺仪的性能,尤其是精度指标,与传统的陀螺还有较大差距,只能应用于低精度要求的场合。影响MEMS陀螺仪精度的因素除了敏感原件制造工艺,最大影响因子在于测控电路本身的漂移。本发明因此而来。
发明内容
本发明目的在于提供一种MEMS陀螺仪测控电路,解决了现有技术中MEMS陀螺仪的测控电路的漂移问题,本发明在现有MEMS陀螺仪的基础上,通过SOPC数字处理技术、电荷放大器、失调电容补偿方法来实现测控电路的高增益、低噪声,从而提高陀螺整体的稳定性和抗干扰能力的方法。
为了解决现有技术中的这些问题,本发明提供的技术方案是:
一种MEMS陀螺仪测控电路,为基于IP核的SOPC数字处理电路,其特征在于所述IP核接收MEMS陀螺仪驱动轴检测信号,并输出相应的驱动信号;且所述IP核接收MEMS陀螺仪敏感轴检测信号,并输出MEMS陀螺仪的角速率;所述驱动轴检测信号作为载波信号经LMSD解调电路解调后,其正交分量经Butterworth4阶低通滤波器进行滤波处理,进行幅度设定后通过PI控制器进行幅度闭环;其同相分量经Butterworth4阶低通滤波器进行滤波处理,进行相位设定后通过PI控制器进行相位闭环;闭环后的两分量进行正弦波合成,输出驱动信号;所述敏感轴检测信号作为载波信号经LMSD解调电路解调后,其同相分量经Butterworth4阶低通滤波器进行滤波处理,进行温度补偿后输出MEMS陀螺仪的角速率。
优选的技术方案中,所述温度补偿是通过所述驱动轴检测信号作为载波信号经LMSD解调电路解调后,其同相分量经Butterworth4阶低通滤波器进行滤波处理,进行相位设定后通过PI控制器进行相位闭环并通过PI控制器向滤波处理后的载波信号进行温度补偿。
优选的技术方案中,所述测控电路还包括对MEMS陀螺仪的变化电容噪声信号进行检测的变化电容检测电路,所述变化电容检测电路包括级联设置的前级电荷放大器(CSA)电路、高通滤波器电路、同步解调电路和低通滤波器电路。
优选的技术方案中,所述测控电路还包括利用分离出的失调电容信号来控制可变增益放大器的增益的失调电容信号补偿电路,其中可变增益放大器的输出负反馈到电荷放大器的输入端,将失调电容所引起的输出电压信号从电荷放大器的输出中消除。
本发明公开了一种高稳定性MEMS陀螺仪测控电路的设计,其特征是:在现有MEMS陀螺仪的基础上,通过SOPC数字处理技术、电荷放大器、失调电容补偿来实现测控电路的高增益、低噪声,从而提高陀螺整体的稳定性和抗干扰能力的方法来提高陀螺仪的精度。本发明涉及一种MEMS陀螺仪测控电路,尤其涉及通过SOPC数字处理技术、电荷放大器、失调电容补偿来实现测控电路的高增益、低噪声,从而提高陀螺整体的稳定性和抗干扰能力的方法。
影响现有技术中MEMS陀螺仪精度的因素除了敏感原件制造工艺,最大影响因子在于测控电路本身的漂移,因此,通过SOPC数字处理技术、电荷放大器、失调电容补偿以及一套陀螺信号处理、控制算法,有效的解决了陀螺电路漂移和复杂性的问题,从而提升MEMS陀螺仪的进度和稳定性。
所谓的SOPC数字处理电路,由于MEMS陀螺在微型化的同时,带来的一个负面效应就是其信号非常微弱,因此检测电路的增益较大,进而导致其温度稳定性对其总体性能的影响较传统陀螺更大,因此必须设计高温度稳定性的测控电路。
提高测控电路稳定性的途径有三条:
(1)在电路设计上采取措施,避免温度敏感的电路形式,同时采取增益补偿等措施将温度漂移降低到尽可能低的程度;
(2)对电路进行充分的老化稳定处理,使电路的稳定性进一步提高;
(3)设计必要的补偿机制,补偿最后残余的温度漂移;
本发明采用基于IP核的SOPC数字处理电路的方式,这样一是可以实现复杂的控制方法,以达到陀螺运动的全闭环控制,二是可以数字化的输出,三是可以尽量避免模拟电路的温漂问题。
在数字式MEMS陀螺的研制基础上,已开发了用于MEMS陀螺测控的专用IP核(如图1),结合软核处理器已可完成MEMS惯性传感器的信号读出和闭环控制,因此对于MEMS惯性仪表的测控,通过使用FPGA可进一步减小***的体积,并可大幅提高电路的灵活性。通过数字化技术,MEMS惯性仪表测控参数的调整更加简单,且可实现复杂的误差补偿算法,因此采用数字化测控方案不仅可提高仪表的稳定性,并可降低器件产业化后的调试、校准和标定成本。
所谓的电荷放大器,由于变化电容信号的频率在几KHz到几十KHz的频带范围,电荷放大器的主要噪声来源为MOS管的1/f噪声。为了抑制1/f噪声、运放失调和低频干扰,我们在CSA电路中采用CHS(Chopper Stabilization)技术,如附图2。在实际的陀螺结构中,各组梳齿电容之间会存在寄生的耦合电容,如附图3所示。这时就需要高通滤波器配合CHS技术来有效抑制低频电学耦合信号的干扰。变化电容检测电路的整体结构如附图4所示,主要由四个部分组成:前级电荷放大器(CSA)、高通滤波器、同步解调和低通滤波器。
所谓的陀螺失调电容补偿,由于实际工艺加工的误差,陀螺差分检测电容存在失调电容(差分电容初始值之间的差别),会降低电容检测电路的动态范围,需要进行补偿。
传统的抑制失调电容的方法主要有两种:外加补偿电压和片上补偿电容阵列。这两种传统的失调电容补偿方法都需要针对每一个陀螺进行单独的测试和校正。本发明提出了一种自适应实现失调电容补偿的方法,原理如图5所示。利用分离出的失调电容信号来控制可变增益放大器的增益,然后将可变增益放大器(VGA:Variable Gain Amplifier)的输出负反馈到电荷放大器的输入端,将失调电容所引起的输出电压信号从电荷放大器的输出中消除,从而实现对失调电容的补偿。由于失调电容的补偿过程中不需要进行额外的测试调节,而且补偿的效果由负反馈环路的增益决定,因此该方法相对于传统的失调电容补偿方法更具有实用性。图6为失调电容自适应补偿的一种具体实现的电路图。
综上所述,在MEMS陀螺仪测控电路中,利用SOPC数字处理技术、电荷放大器以及陀螺失调电容补偿技术,来实现测控电路的高增益、低噪声,从而提高陀螺整体的稳定性和抗干扰能力,有效的提高MEMS陀螺的精度。
附图说明
下面结合附图及实施例对本发明作进一步描述:
图1为本发明的单轴数字式MEMS陀螺测控原理;
图2为本发明的采用CHS技术的CSA电路结构;
图3为本发明的陀螺结构中的寄生耦合电容;
图4为本发明的电容检测电路的整体结构;
图5为本发明的失调电容自适应补偿的原理图;
图6为本发明的失调电容自适应补偿的一种具体实现的电路图。
具体实施方式
以下结合具体实施例对上述方案做进一步说明。应理解,这些实施例是用于说明本发明而不限于限制本发明的范围。实施例中采用的实施条件可以根据具体厂家的条件做进一步调整,未注明的实施条件通常为常规实验中的条件。
实施例
如图1所示,本实施例的MEMS陀螺仪测控电路,为基于IP核的SOPC数字处理电路,所述IP核接收MEMS陀螺仪驱动轴检测信号,并输出相应的驱动信号;且所述IP核接收MEMS陀螺仪敏感轴检测信号,并输出MEMS陀螺仪的角速率;所述驱动轴检测信号作为载波信号经LMSD解调电路解调后,其正交分量经Butterworth4阶低通滤波器进行滤波处理,进行幅度设定后通过PI控制器进行幅度闭环;其同相分量经Butterworth4阶低通滤波器进行滤波处理,进行相位设定后通过PI控制器进行相位闭环;闭环后的两分量进行正弦波合成,输出驱动信号;所述敏感轴检测信号作为载波信号经LMSD解调电路解调后,其同相分量经Butterworth4阶低通滤波器进行滤波处理,进行温度补偿后输出MEMS陀螺仪的角速率。
由于MEMS陀螺在微型化的同时,带来的一个负面效应就是其信号非常微弱,因此检测电路的增益较大,进而导致其温度稳定性对其总体性能的影响较传统陀螺更大。
本发明采用基于IP核的SOPC数字处理电路的方式,这样一是可以实现复杂的控制方法,以达到陀螺运动的全闭环控制,二是可以数字化的输出,三是可以尽量避免模拟电路的温漂问题。
在数字式MEMS陀螺的研制基础上,已开发了用于MEMS陀螺测控的专用IP核,结合软核处理器已可完成MEMS惯性传感器的信号读出和闭环控制,因此对于MEMS惯性仪表的测控,通过使用FPGA可进一步减小***的体积,并可大幅提高电路的灵活性。通过数字化技术,MEMS惯性仪表测控参数的调整更加简单,且可实现复杂的误差补偿算法,因此采用数字化测控方案不仅可提高仪表的稳定性,并可降低器件产业化后的调试、校准和标定成本。
所述温度补偿是通过所述驱动轴检测信号作为载波信号经LMSD解调电路解调后,其同相分量经Butterworth4阶低通滤波器进行滤波处理,进行相位设定后通过PI控制器进行相位闭环并通过PI控制器向滤波处理后的载波信号进行温度补偿。
如图4所示,所述测控电路还包括对MEMS陀螺仪的变化电容噪声信号进行检测的变化电容检测电路,所述变化电容检测电路包括级联设置的前级电荷放大器(CSA)电路、高通滤波器电路、同步解调电路和低通滤波器电路。
由于变化电容信号的频率在几KHz到几十KHz的频带范围,电荷放大器的主要噪声来源为MOS管的1/f噪声。为了抑制1/f噪声、运放失调和低频干扰,在CSA电路中采用CHS(Chopper Stabilization)技术,如图2。在实际的陀螺结构中,各组梳齿电容之间会存在寄生的耦合电容,如图3所示。这时就需要高通滤波器配合CHS技术来有效抑制低频电学耦合信号的干扰。
如图5和图6所示,所述测控电路还包括利用分离出的失调电容信号来控制可变增益放大器的增益的失调电容信号补偿电路,其中可变增益放大器的输出负反馈到电荷放大器的输入端,将失调电容所引起的输出电压信号从电荷放大器的输出中消除。
由于实际工艺加工的误差,陀螺差分检测电容存在失调电容(差分电容初始值之间的差别),会降低电容检测电路的动态范围,需要进行补偿。本发明利用分离出的失调电容信号来控制可变增益放大器的增益,然后将可变增益放大器(VGA:Variable GainAmplifier)的输出负反馈到电荷放大器的输入端,将失调电容所引起的输出电压信号从电荷放大器的输出中消除,从而实现对失调电容的补偿。由于失调电容的补偿过程中不需要进行额外的测试调节,而且补偿的效果由负反馈环路的增益决定,因此该方法相对于传统的失调电容补偿方法更具有实用性。图6为失调电容自适应补偿的一种具体实现的电路图。
上述实施例只为说明本发明的技术构思及特点,其目的在于让熟悉此项技术的人能够了解本发明的内容并据以实施,并不能以此限制本发明的保护范围。凡根据本发明精神实质所做的等效变换或修饰,都应涵盖在本发明的保护范围之内。
Claims (3)
1.MEMS 陀螺仪测控电路,为基于 IP 核的 SOPC 数字处理电路,其特征在于,所述 IP核接收MEMS 陀螺仪驱动轴检测信号,并输出相应的驱动信号;且所述 IP 核接收 MEMS 陀螺仪敏感轴检测信号,并输出 MEMS 陀螺仪的角速率;所述驱动轴检测信号作为载波信号经 LMSD解调电路解调后,其正交分量经 Butterworth 4 阶低通滤波器进行滤波处理,进行幅度设定后通过 PI 控制器进行幅度闭环;其同相分量经 Butterworth 4 阶低通滤波器进行滤波处理,进行相位设定后通过 PI 控制器进行相位闭环 ;闭环后的两分量进行正弦波合成,输出驱动信号;所述敏感轴检测信号作为载波信号经 LMSD 解调电路解调后,其同相分量经Butterworth 4 阶低通滤波器进行滤波处理,进行温度补偿后输出MEMS 陀螺仪的角速率;所述温度补偿是通过所述驱动轴检测信号作为载波信号经 LMSD 解调电路解调后,其同相分量经 Butterworth 4 阶低通滤波器进行滤波处理,进行相位设定后通过PI 控制器进行相位闭环并通过 PI 控制器向滤波处理后的载波信号进行温度补偿。
2.根据权利要求 1 所述的 MEMS 陀螺仪测控电路,其特征在于所述测控电路还包括对MEMS陀螺仪的变化电容噪声信号进行检测的变化电容检测电路,所述变化电容检测电路包括级联设置的前级电荷放大器电路、高通滤波器电路、同步解调电路和低通滤波器电路。
3.根据权利要求 1 所述的 MEMS 陀螺仪测控电路,其特征在于所述测控电路还包括利用分离出的失调电容信号来控制可变增益放大器的增益的失调电容信号补偿电路,其中可变增益放大器的输出负反馈到电荷放大器的输入端,将失调电容所引起的输出电压信号从电荷放大器的输出中消除。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410166890.3A CN105021176B (zh) | 2014-04-24 | 2014-04-24 | Mems陀螺仪测控电路 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410166890.3A CN105021176B (zh) | 2014-04-24 | 2014-04-24 | Mems陀螺仪测控电路 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105021176A CN105021176A (zh) | 2015-11-04 |
CN105021176B true CN105021176B (zh) | 2018-03-16 |
Family
ID=54411328
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410166890.3A Active CN105021176B (zh) | 2014-04-24 | 2014-04-24 | Mems陀螺仪测控电路 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105021176B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107817432B (zh) * | 2017-10-23 | 2019-12-20 | 北京晨晶电子有限公司 | 一种mems陀螺仪电路板检测方法及装置 |
CN109883409A (zh) * | 2019-01-31 | 2019-06-14 | 无锡城市职业技术学院(无锡高等师范学校无锡环境科学与工程研究中心) | 一种基于fpga陀螺阵列信号处理方法 |
CN117647240A (zh) * | 2024-01-29 | 2024-03-05 | 中科亿海微电子科技(苏州)有限公司 | 一种对光纤陀螺仪进行相敏检波的装置及方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101424533B (zh) * | 2008-08-29 | 2010-12-08 | 北京大学 | Mems陀螺电容读出电路中失调电容的补偿方法及电路 |
JP5371505B2 (ja) * | 2009-03-25 | 2013-12-18 | ローム株式会社 | 温度補償回路ならびに加速度または角速度センサ |
CN102121829B (zh) * | 2010-08-09 | 2013-06-12 | 汪滔 | 一种微型惯性测量*** |
CN102288173B (zh) * | 2011-07-22 | 2013-02-27 | 上海交通大学 | 静电驱动电容检测微固体模态陀螺 |
-
2014
- 2014-04-24 CN CN201410166890.3A patent/CN105021176B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105021176A (zh) | 2015-11-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104535057B (zh) | 一种硅微机械线振动式陀螺及其正交误差刚度校正方法 | |
CN105021176B (zh) | Mems陀螺仪测控电路 | |
CN104049109B (zh) | 一种mems加速度传感器伺服读出电路 | |
CN102650526B (zh) | 一种基于相位比较调频连续波光纤陀螺的开环检测电路 | |
CN103389084A (zh) | 基于双耦合光纤环形谐振腔相干效应的谐振式光纤陀螺 | |
US20190025056A1 (en) | Electrostatic offset correction | |
CN102278982B (zh) | 四质量块硅微机械陀螺耦合误差的抑制方法 | |
CN105892293A (zh) | 一种硅微陀螺数字化驱动闭环控制*** | |
CN102506859B (zh) | 三轴惯性稳定平台陀螺信号采集电路及信号滤波*** | |
CN102538774A (zh) | 微固体模态陀螺闭环锁相稳幅驱动电路 | |
CN105716596B (zh) | 压电半球谐振微陀螺仪的数字控制检测*** | |
CN106597839A (zh) | 一种基于负刚度效应的mems陀螺自动模态匹配控制装置及方法 | |
CN103713159B (zh) | 一种闭环微机械加速度计反馈方法 | |
CN110554333A (zh) | 一种钾光泵磁力仪的光磁共振信号数字化检测*** | |
CN206378139U (zh) | 一种正交偏置自消除的微机械陀螺仪 | |
WO2015084980A2 (en) | Offset suppression in micromachined lorentz force magnetic sensor by current chopping | |
CN103148847B (zh) | 一种基于作差消除微机械陀螺同相误差***及方法 | |
CN103983260A (zh) | 一种静电驱动电容式微机械陀螺仪有效抑制正交误差的方法 | |
CN113819898A (zh) | 一种正交力反馈闭环的小频差石英陀螺误差抑制方法 | |
CN103162679A (zh) | 一种基于乘法消除微机械陀螺同相误差***及方法 | |
CN109030850A (zh) | 一种mhd角速度传感器稳定调制磁场的驱动装置 | |
Zhang et al. | Design of MEMS gyroscope interface ASIC with on-chip temperature compensation | |
CN103728880B (zh) | 一种伞降式小型无人飞行器稳定控制方法和*** | |
RU2411522C1 (ru) | Компенсационный акселерометр | |
CN203163738U (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 |