[发明专利]微机械陀螺检测模态8阶连续带通sigma-delta闭环控制电路

说明书

技术领域

本发明涉及一种用于微机械陀螺检测模态的闭环控制电路，属于利用科氏效应的制导或控制装置领域。

背景技术

微机械陀螺是一种重要的惯性传感器，具有外形尺寸小、重量轻、功耗低、成本低等优点，使用微机械陀螺实现的惯性仪表广泛的用于各种运动物体的姿态及位置信息检测，特别是在精确制导武器、无人机等军事领域更是对高精度的微型惯性传感器提出了明确的需求。但是传统的微机械陀螺精度无法达到惯导级水平，通常需要借助额外的控制系统来对其控制或者对误差进行补偿，从而提高精度。微机械陀螺检测模态的闭环控制系统通常有两种：模拟闭环控制系统和数字闭环控制系统。模拟闭环控制系统存在系统参数易受外界因素的影响，系统实现难度大等缺点。而数字闭环控制可以有效的解决中心质量块容易吸附到电极上的问题，系统实现简单，稳定性好等优点，所以微机械陀螺检测模态的数字闭环控制系统一直是研究的热点和重点。2005年，英国南安普顿大学的董云峰,Michael Kraft等人提出了微机械陀螺检测模态的6阶连续带通ΣΔΜ闭环控制电路，不仅大大降低了采样频率，使得系统更加易于实现，而且提高了系统的信噪比（SNR）和带宽等。其原理框图参照图3，信号的提取采用电荷放大器5，然后信号依次经过全差分放大电路9、相位补偿电路10、谐振器a18、谐振器b19、数字转换电路12输出脉宽密度调制数字信号b(t)控制模拟开关13将反馈控制电压V_fb加载到反馈控制电极上，整个闭环控制系统对于系统噪声具有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)经过频率为f₁的高频载波V_c(t)调制到高频段，V_c(t)加载到MEMS陀螺结构4的质量块上，也即为等效的公共电极1上；调制信号经过电荷放大器5后，将电流信号转换为电压信号V_i(t)；电荷放大器5的反馈电容采用可变电容用于调节两路全差分信号V_i(t)和V_i'(t)的匹配性，使得其幅值相等，相位相反；V_i(t)和V_i'(t)经过高通滤波器6将驱动模态耦合信号V_d'(t)滤除得到V_i2(t)和V'_i2(t)，高通滤波器6的截止频率f_c1满足：f_c1＞f_x,其中f_x为MEMS陀螺驱动模态的谐振频率也即耦合信号V_d'(t)的频率；V_i2(t)和V'_i2(t)再经过由二极管7和低通滤波器8组成的解调电路进行解调和滤波，低通滤波器8的截止频率f_c2满足：f_y＜f_c2＜f₁，其中，f_y为陀螺检测模态的谐振频率；解调和滤波后的信号进入增益为G₁的全差分放大电路9对其做进一步的全差分放大得到V_i3(t)和V'_i3(t)；相位补偿电路10对V_i3(t)和V'_i3(t)进行一定的相位移动使得整个闭环控制回路的相移不等于2n，因为根据闭环系统自激振荡的条件：如果满足闭环控制系统的相移等于2n，闭环增益大于1，整个闭环系统将会自激振荡；移相后得到信号V_i4(t)和V'_i4(t)进入谐振电路11，谐振电路11包括串联的完全相同的三个谐振器a17、谐振器b18和谐振器c19，谐振器a17、谐振器b18和谐振器c19的谐振中心频率f₂等于f_x，且谐振器a17、谐振器b18和谐振器c19在f₂处的增益为10-20dB，在其他频率范围内的增益均小于0dB；经过谐振电路11之后的信号V_i5(t)和V'_i5(t)进入数字转换电路12，其包括比较器20和D触发器21，比较器20对V_i5(t)和V'_i5(t)两路全差分信号进行比较，产生高低电平的数字比较信号b'(t)，D触发器21对b'(t)进行采样和量化，最终输出数字脉宽密度调制信号b(t)；b(t)一路用于控制模拟开关13将反馈电压V_fb加载到陀螺检测模态的反馈电极上；另一路经过带通滤波器14将[f_y-BW,f_y+BW]频率范围外的量化噪声去除，其中BW为陀螺的带宽；带通滤波之后的信号进入解调器15，与驱动信号V_d(t)进行解调，再通过低通滤波器16处理得到角速度信号Ω(t),低通滤波器16的截止频率f_c3满足：f_c3＞BW。