CN103411594A - 微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路 - Google Patents
微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路 Download PDFInfo
- Publication number
- CN103411594A CN103411594A CN2013102943570A CN201310294357A CN103411594A CN 103411594 A CN103411594 A CN 103411594A CN 2013102943570 A CN2013102943570 A CN 2013102943570A CN 201310294357 A CN201310294357 A CN 201310294357A CN 103411594 A CN103411594 A CN 103411594A
- Authority
- CN
- China
- Prior art keywords
- signal
- resonator
- pass filter
- circuit
- low
- 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
Images
Landscapes
- Gyroscopes (AREA)
Abstract
本发明公开了一种微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路,属于利用科氏效应的制导或控制装置领域。该电路由电荷放大器5,高通滤波器6,二极管7,低通滤波器8,全差分放大电路9,相位补偿电路10,谐振电路11,数字转换电路12,模拟开关13,带通滤波器14,解调器15,低通滤波器16组成。本发明的有益效果是:第一,谐振器a17、谐振器b18和谐振器c19与陀螺检测模态一起在整个闭环电路中对噪声具有8阶整形作用;第三,脉宽密度调制数字信号b(t),通过带通滤波器14,解调器15,低通滤波器16的处理得到模拟角速度信号Ω(t)。
Description
技术领域
本发明涉及一种用于微机械陀螺检测模态的闭环控制电路,属于利用科氏效应的制导或控制装置领域。
背景技术
微机械陀螺是一种重要的惯性传感器,具有外形尺寸小、重量轻、功耗低、成本低等优点,使用微机械陀螺实现的惯性仪表广泛的用于各种运动物体的姿态及位置信息检测,特别是在精确制导武器、无人机等军事领域更是对高精度的微型惯性传感器提出了明确的需求。但是传统的微机械陀螺精度无法达到惯导级水平,通常需要借助额外的控制***来对其控制或者对误差进行补偿,从而提高精度。微机械陀螺检测模态的闭环控制***通常有两种:模拟闭环控制***和数字闭环控制***。模拟闭环控制***存在***参数易受外界因素的影响,***实现难度大等缺点。而数字闭环控制可以有效的解决中心质量块容易吸附到电极上的问题,***实现简单,稳定性好等优点,所以微机械陀螺检测模态的数字闭环控制***一直是研究的热点和重点。2005年,英国南安普顿大学的董云峰,Michael Kraft等人提出了微机械陀螺检测模态的6阶连续带通ΣΔΜ闭环控制电路,不仅大大降低了采样频率,使得***更加易于实现,而且提高了***的信噪比(SNR)和带宽等。其原理框图参照图3,信号的提取采用电荷放大器5,然后信号依次经过全差分放大电路9、相位补偿电路10、谐振器a18、谐振器b19、数字转换电路12输出脉宽密度调制数字信号b(t)控制模拟开关13将反馈控制电压Vfb加载到反馈控制电极上,整个闭环控制***对于***噪声具有6阶整形能力,提高了SNR,但是该控制***存在一些问题:
(1)***提取出的有效陀螺信号的SNR仍然不是非常高;(2)***输出的脉宽密度调制数字信号b(t)并不是最终的角速度信号。
发明内容
为克服现有技术中存在的问题,本发明提出了一种用于微机械陀螺检测模态的8阶连续带通ΣΔ闭环控制***,能够进一步的提高检测陀螺信号的信噪比SNR,并且直接输出模拟角速度信号Ω(t)。
参阅图2,MEMS陀螺结构4的检测模态可以等效为公共电极1,固定电极2,固定电极3组成,公共电极1与固定电极2、固定电极3之间的电容变化引起充放电电流变化,产生变化电流信号i(t)。
参阅图4,本发明提出的MEMS陀螺8阶连续带通ΣΔΜ闭环控制电路,由电荷放大器5,高通滤波器6,二极管7,低通滤波器8,全差分放大电路9,相位补偿电路10,谐振电路11,数字转换电路12,模拟开关13,带通滤波器14,解调器15,低通滤波器16组成。变化的电流信号i(t)经过频率为f1的高频载波Vc(t)调制到高频段,Vc(t)加载到MEMS陀螺结构4的质量块上,也即为等效的公共电极1上;调制信号经过电荷放大器5后,将电流信号转换为电压信号Vi(t);电荷放大器5的反馈电容采用可变电容用于调节两路全差分信号Vi(t)和Vi'(t)的匹配性,使得其幅值相等,相位相反;Vi(t)和Vi'(t)经过高通滤波器6将驱动模态耦合信号Vd'(t)滤除得到Vi2(t)和V'i2(t),高通滤波器6的截止频率fc1满足:fc1>fx,其中fx为MEMS陀螺驱动模态的谐振频率也即耦合信号Vd'(t)的频率;Vi2(t)和V'i2(t)再经过由二极管7和低通滤波器8组成的解调电路进行解调和滤波,低通滤波器8的截止频率fc2满足:fy<fc2<f1,其中,fy为陀螺检测模态的谐振频率;解调和滤波后的信号进入增益为G1的全差分放大电路9对其做进一步的全差分放大得到Vi3(t)和V'i3(t);相位补偿电路10对Vi3(t)和V'i3(t)进行一定的相位移动使得整个闭环控制回路的相移不等于2n,因为根据闭环***自激振荡的条件:如果满足闭环控制***的相移等于2n,闭环增益大于1,整个闭环***将会自激振荡;移相后得到信号Vi4(t)和V'i4(t)进入谐振电路11,谐振电路11包括串联的完全相同的三个谐振器a17、谐振器b18和谐振器c19,谐振器a17、谐振器b18和谐振器c19的谐振中心频率f2等于fx,且谐振器a17、谐振器b18和谐振器c19在f2处的增益为10-20dB,在其他频率范围内的增益均小于0dB;经过谐振电路11之后的信号Vi5(t)和V'i5(t)进入数字转换电路12,其包括比较器20和D触发器21,比较器20对Vi5(t)和V'i5(t)两路全差分信号进行比较,产生高低电平的数字比较信号b'(t),D触发器21对b'(t)进行采样和量化,最终输出数字脉宽密度调制信号b(t);b(t)一路用于控制模拟开关13将反馈电压Vfb加载到陀螺检测模态的反馈电极上;另一路经过带通滤波器14将[fy-BW,fy+BW]频率范围外的量化噪声去除,其中BW为陀螺的带宽;带通滤波之后的信号进入解调器15,与驱动信号Vd(t)进行解调,再通过低通滤波器16处理得到角速度信号Ω(t),低通滤波器16的截止频率fc3满足:fc3>BW。
本发明的有益效果是:第一,谐振器a17、谐振器b18和谐振器c19与陀螺检测模态一起在整个闭环电路中对噪声具有8阶整形作用;第三,脉宽密度调制数字信号b(t),通过带通滤波器14,解调器15,低通滤波器16的处理得到模拟角速度信号Ω(t)。
附图说明
图1是本发明所针对的MEMS陀螺检测模态的电学模型示意图;
图2是本发明所针对的MEMS陀螺结构示意图;
图3是现有技术中董云峰等人提出的6阶连续带通ΣΔΜ闭环控制电路示意图;
图4是本发明提出的8阶连续带通ΣΔΜ闭环控制电路示意图;
图5是实施例中8阶连续带通ΣΔΜ闭环控制电路示意图;
图中:
1-公共电极;2-固定电极I;3-固定电极II;4-微机械陀螺结构;5-电荷放大器;6-高通滤波器;7-二极管;8-低通滤波器;9-全差分放大电路;10-相位补偿电路;11-谐振电路;12-数字转换电路;13-模拟开关;14-带通滤波器;15-解调器;16-低通滤波器;17-谐振器a;18-谐振器b;19-谐振器c;20-比较器;21-D触发器;22-反馈电极AI;23-反馈电极AII;24-检测电极AI;25-检测电极AII;
具体实施方式
实施例一:
本实施例中所针对的微机械陀螺如图2所示,驱动和检测模态梳齿中心电容Co=3.43e-13F,驱动模态的谐振频率fx=4.30KHz为,检测模态的谐振频率fy=4.33KHz,带宽BW=50Hz,mx=my=2×10-6Kg。
其检测模态的6阶连续带通ΣΔΜ闭环控制电路参阅图5,整个电路***由全差分电荷放大器5,高通滤波器6,二极管7,低通滤波器8,全差分放大电路9,相位补偿电路10,谐振电路11,数字转换电路12,模拟开关13,带通滤波器14,解调器15,低通滤波器16组成;首先外加驱动电压使得陀螺在驱动模态上谐振,谐振位移为x(t)=a1sin(ωxt+φ),其中ωx=2πfx=2π·4300,当有角速度Ω(t)输入时,由于科里奥利力的作用,陀螺的质量块在检测模态上产生位移y(t),导致检测电极AI24和检测电极AII25电容变化,例如检测电极AI24电容增大,检测电极AII25电容减小,引起充放电电流变化,该变化电流信号i(t)被Vc(t)=10sin(2πf1t)调制到高频段,其中f1=2MHz,Vc(t)加载到陀螺的质量块上。该调制信号经过电荷放大器5,将电流信号转换为全差分电压信号Vi(t)和Vi'(t);其中一路电荷放大器5上的反馈电容为可变电容Cf,调节Cf使得Vi(t)和Vi'(t)幅值相等;然后Vi(t)和Vi'(t)经过高通滤波器6将驱动耦合信号Vd'(t)=a2sin(ωxt+φ)滤除,高通滤波器6的截止频率fc1=100KHz;滤除驱动耦合信号之后得到Vi2(t)和V'i2(t),Vi2(t)和V'i2(t)经过由二极管7和低通滤波器8组成解调电路进行解调和滤波,其中低通滤波器8的截止频率fc2=10KHz;解调和滤波后的两路信号进入增益G1=200的全差分放大电路9对其做进一步的全差分放大得到Vi3(t)和V'i3(t);相位补偿电路10对Vi3(t)和V'i3(t)进行的相位移动,使得整个闭环控制回路的相移总和不等于2nπ,防止闭环回路自激振荡,提高***的稳定性;移相后的信号Vi4(t)和V'i4(t)进入谐振电路11,谐振电路11包括谐振器a17、谐振器b18和谐振器c19;谐振器a17、谐振器b18和谐振器c19具有相同的结构,均包括串联的两个全差分运算放大器,谐振器a17的第一个全差分运算放大器A1的反向输入端一路经过电阻R1连到第二个全差分运算放大器A2的反向输出端,另一路依次串联连接一个电容C1、电阻R2和电容C2,连到A2的正向输出端;谐振器a17的A1的正向输入端一路经过电阻R1'连到A2的正向输出端,另一路依次串联连接一个电容C1'、电阻R'2和电容C'2,连到A2的反向输出端;谐振器a17的A1的正向输出端,连入谐振器b18的第一个全差分运算放大器A1'的负向输入端,谐振器a17的A1的负向输出端,连入谐振器b18的A1'的正向输入端;谐振器b18的A1'的正向输出端,连入谐振器c19的第一个全差分运算放大器A''1的负向输入端,谐振器b18的A1'的负向输出端,连入谐振器c19的A1''的正向输入端;其中R1=R2=R1'=R'2=1.68kΩ,C1=C2=C1'=C'2=22nF,谐振器a17、谐振器b18和谐振器c19的谐振中心频率 谐振器c19的A'1的正向和负向输出端输出信号为Vi5(t)和V'i5(t)作为比较器20的两路输入信号;比较器20对Vi5(t)和V'i5(t)进行比较,输出高电平为5V,低电平为0V的数字比较信号b'(t),D触发器21对b'(t)进行采样和量化,采样频率为32KHz,最终输出1bit的数字脉宽密度调制数字信号b(t),高电平为3.3V,低电平为0V;b(t)一路用于控制模拟开关从而将反馈电压Vfb=1V加载到陀螺检测模态的反馈电极AI22和AII23上;b(t)另一路经过带通滤波器14将[4330-50,4330+50]频率范围外的量化噪声去除,然后进入解调器15,与驱动信号Vd(t)进行第二次解调,再通过截止频率fc3=100Hz的低通滤波器16处理得到陀螺的角速度信号Ω(t)。
Claims (1)
1.MEMS陀螺8阶连续带通sigma-delta闭环控制电路,其特征在于:由电荷放大器(5)、高通滤波器(6)、二极管(7)、低通滤波器(8)、全差分放大电路(9)、相位补偿电路(10)、谐振电路(11)、数字转换电路(12)、模拟开关(13)、带通滤波器(14)、解调器(15)、低通滤波器(16)组成;变化的电流信号i(t)经过频率为f1的高频载波Vc(t)调制到高频段,Vc(t)加载到MEMS陀螺结构(4)的质量块上,也即为等效的公共电极(1)上;调制信号经过电荷放大器(5)后,将电流信号转换为电压信号Vi(t);电荷放大器(5)的反馈电容采用可变电容用于调节两路全差分信号Vi(t)和Vi'(t)的匹配性,使得其幅值相等,相位相反;Vi(t)和Vi'(t)经过高通滤波器(6)将驱动模态耦合信号Vd'(t)滤除得到Vi2(t)和V'i2(t),高通滤波器(6)的截止频率fc1满足:fc1>fx,其中fx为MEMS陀螺驱动模态的谐振频率也即耦合信号Vd'(t)的频率;Vi2(t)和V'i2(t)再经过由二极管7和低通滤波器(8)组成的解调电路进行解调和滤波,低通滤波器(8)的截止频率fc2满足:fy<fc2<f1,其中,fy为陀螺检测模态的谐振频率;解调和滤波后的信号进入增益为G1的全差分放大电路(9)对其做进一步的全差分放大得到Vi3(t)和V'i3(t);相位补偿电路(10)对Vi3(t)和V'i3(t)进行一定的相位移动使得整个闭环控制回路的相移不等于2n;移相后得到信号Vi4(t)和V'i4(t)进入谐振电路(11),谐振电路(11)包括串联的完全相同的三个谐振器a(17)、谐振器b(18)和谐振器c(19),谐振器a(17)、谐振器b(18)和谐振器c(19)的谐振中心频率f2等于fx,且谐振器a(17)、谐振器b(18)和谐振器c(19)在f2处的增益为10-20dB,在其他频率范围内的增益均小于0dB;经过谐振电路(11)之后的信号Vi5(t)和V'i5(t)进入数字转换电路(12),其包括比较器(20)和D触发器(21),比较器(20)对Vi5(t)和V'i5(t)两路全差分信号进行比较,产生高低电平的数字比较信号b'(t),D触发器(21)对b'(t)进行采样和量化,最终输出数字脉宽密度调制信号b(t);b(t)一路用于控制模拟开关(13)将反馈电压Vfb加载到陀螺检测模态的反馈电极上;另一路经过带通滤波器(14)将[fy-BW,fy+BW]频率范围外的量化噪声去除,其中BW为陀螺的带宽;带通滤波之后的信号进入解调器(15),与驱动信号Vd(t)进行解调,再通过低通滤波器(16)处理得到角速度信号Ω(t),低通滤波器(16)的截止频率fc3满足:fc3>BW。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013102943570A CN103411594A (zh) | 2013-07-12 | 2013-07-12 | 微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013102943570A CN103411594A (zh) | 2013-07-12 | 2013-07-12 | 微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103411594A true CN103411594A (zh) | 2013-11-27 |
Family
ID=49604622
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2013102943570A Pending CN103411594A (zh) | 2013-07-12 | 2013-07-12 | 微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103411594A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106289212A (zh) * | 2016-09-21 | 2017-01-04 | 南京理工大学 | 用于硅微音叉陀螺的集成测控单元 |
CN106370170A (zh) * | 2016-08-29 | 2017-02-01 | 南京理工大学 | 硅微陀螺机电结合带通sigma‑delta闭环检测环路参数获取方法 |
CN107504964A (zh) * | 2017-09-22 | 2017-12-22 | 中国科学院上海微***与信息技术研究所 | 自时钟数字式微机械陀螺∑△m闭环检测电路*** |
CN109470228A (zh) * | 2018-10-30 | 2019-03-15 | 北京时代民芯科技有限公司 | 一种基于内嵌式差分电极的mems碟形陀螺及其制备方法 |
CN111220139A (zh) * | 2019-12-30 | 2020-06-02 | 南京理工大学 | 一种微机电多环陀螺力平衡模式测控电路*** |
CN112504258A (zh) * | 2020-11-05 | 2021-03-16 | 东南大学 | 基于全角模式的石英半球谐振陀螺自适应控制电路及方法 |
CN114353775A (zh) * | 2021-12-02 | 2022-04-15 | 上海航天控制技术研究所 | 一种微机械陀螺集成电路 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005075939A1 (en) * | 2004-02-04 | 2005-08-18 | Bae Systems Plc | Method for reducing bias error in a vibrating structure gyroscope |
CN1766528A (zh) * | 2005-11-11 | 2006-05-03 | 中北大学 | 具有较高灵敏度和带宽的差分式微机械陀螺 |
CN102297689A (zh) * | 2011-07-22 | 2011-12-28 | 上海交通大学 | 静电驱动压电检测闭环控制微固体模态陀螺 |
CN102620726A (zh) * | 2012-04-04 | 2012-08-01 | 西北工业大学 | 微机械陀螺的双闭环控制电路 |
-
2013
- 2013-07-12 CN CN2013102943570A patent/CN103411594A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005075939A1 (en) * | 2004-02-04 | 2005-08-18 | Bae Systems Plc | Method for reducing bias error in a vibrating structure gyroscope |
CN1766528A (zh) * | 2005-11-11 | 2006-05-03 | 中北大学 | 具有较高灵敏度和带宽的差分式微机械陀螺 |
CN102297689A (zh) * | 2011-07-22 | 2011-12-28 | 上海交通大学 | 静电驱动压电检测闭环控制微固体模态陀螺 |
CN102620726A (zh) * | 2012-04-04 | 2012-08-01 | 西北工业大学 | 微机械陀螺的双闭环控制电路 |
Non-Patent Citations (1)
Title |
---|
闫子健等: "基于Krylov子空间投影法的MEMS宏建模方法", 《传感器技术学报》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106370170A (zh) * | 2016-08-29 | 2017-02-01 | 南京理工大学 | 硅微陀螺机电结合带通sigma‑delta闭环检测环路参数获取方法 |
CN106289212A (zh) * | 2016-09-21 | 2017-01-04 | 南京理工大学 | 用于硅微音叉陀螺的集成测控单元 |
CN107504964A (zh) * | 2017-09-22 | 2017-12-22 | 中国科学院上海微***与信息技术研究所 | 自时钟数字式微机械陀螺∑△m闭环检测电路*** |
CN109470228A (zh) * | 2018-10-30 | 2019-03-15 | 北京时代民芯科技有限公司 | 一种基于内嵌式差分电极的mems碟形陀螺及其制备方法 |
CN111220139A (zh) * | 2019-12-30 | 2020-06-02 | 南京理工大学 | 一种微机电多环陀螺力平衡模式测控电路*** |
CN111220139B (zh) * | 2019-12-30 | 2022-04-01 | 南京理工大学 | 一种微机电多环陀螺力平衡模式测控电路*** |
CN112504258A (zh) * | 2020-11-05 | 2021-03-16 | 东南大学 | 基于全角模式的石英半球谐振陀螺自适应控制电路及方法 |
CN114353775A (zh) * | 2021-12-02 | 2022-04-15 | 上海航天控制技术研究所 | 一种微机械陀螺集成电路 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102621884B (zh) | MEMS陀螺6阶连续带通sigma-delta闭环控制电路 | |
CN103411594A (zh) | 微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路 | |
CN102620726B (zh) | 微机械陀螺的双闭环控制电路 | |
CN102707088B (zh) | 微机械加速度计的高阶连续低通sigma-delta闭环控制电路 | |
CN201688848U (zh) | 双质量振动式硅微机械陀螺仪接口电路 | |
US10309984B2 (en) | High-precision pendulous accelerometer | |
CN102072737B (zh) | 一种带温度补偿的高精度电容读出电路 | |
CN106289212B (zh) | 用于硅微音叉陀螺的集成测控单元 | |
CN103869098A (zh) | 一种硅微谐振式加速度计电路控制*** | |
CN107449414B (zh) | Mems陀螺仪的闭环锁相驱动电路 | |
CN103308720A (zh) | 微机械加速度计的3阶连续低通反馈型sigma-delta闭环控制电路 | |
CN109029437B (zh) | 三自由度闭环陀螺数字接口电路 | |
CN109633207B (zh) | 一种数字闭环加速度计片上在线自检测***及方法 | |
CN105758402A (zh) | 一种硅微陀螺的闭环检测*** | |
CN103162681A (zh) | 用于微机械陀螺的信号检测方法及装置 | |
CN103424570A (zh) | 微机械加速度计的MASH结构sigma-delta闭环控制电路 | |
CN108931665B (zh) | 一种用于硅微谐振式加速度计的数字锁相测控电路 | |
RU2415442C1 (ru) | Компенсационный акселерометр | |
CN106921383B (zh) | 一种低功耗低噪声mems加速度计接口电路 | |
CN103134950B (zh) | 微机械加速度计的5阶连续低通谐振前馈型sigma-delta modulator闭环控制电路 | |
CN101832788A (zh) | 一种采用斩波稳定技术的电容连续时间读出电路 | |
RU2397498C1 (ru) | Компенсационный акселерометр | |
CN204788410U (zh) | 一种新型陀螺组合 | |
CN109168116B (zh) | 一种提高mems陀螺静态和线性度指标的角速率闭环方法 | |
CN103018485B (zh) | Σ-δ微加速度计接口asic芯片中基于质量块静电力反馈的线性化电路 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20131127 |