CN116683871A - 一种微机电陀螺的幅频控制驱动电路系统 - Google Patents
一种微机电陀螺的幅频控制驱动电路系统 Download PDFInfo
- Publication number
- CN116683871A CN116683871A CN202310590112.6A CN202310590112A CN116683871A CN 116683871 A CN116683871 A CN 116683871A CN 202310590112 A CN202310590112 A CN 202310590112A CN 116683871 A CN116683871 A CN 116683871A
- Authority
- CN
- China
- Prior art keywords
- digital
- frequency
- amplitude
- signal
- circuit
- 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
- 238000006243 chemical reaction Methods 0.000 claims abstract description 22
- 230000003321 amplification Effects 0.000 claims abstract description 6
- 238000003199 nucleic acid amplification method Methods 0.000 claims abstract description 6
- 238000006073 displacement reaction Methods 0.000 claims description 8
- 238000001914 filtration Methods 0.000 claims description 7
- 230000010354 integration Effects 0.000 claims description 4
- 230000006641 stabilisation Effects 0.000 claims description 4
- 238000011105 stabilization Methods 0.000 claims description 4
- 238000001514 detection method Methods 0.000 abstract description 8
- 230000010355 oscillation Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 4
- 230000005284 excitation Effects 0.000 description 3
- 230000002457 bidirectional effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 229910021421 monocrystalline silicon Inorganic materials 0.000 description 1
Classifications
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03B—GENERATION OF OSCILLATIONS, DIRECTLY OR BY FREQUENCY-CHANGING, BY CIRCUITS EMPLOYING ACTIVE ELEMENTS WHICH OPERATE IN A NON-SWITCHING MANNER; GENERATION OF NOISE BY SUCH CIRCUITS
- H03B5/00—Generation of oscillations using amplifier with regenerative feedback from output to input
- H03B5/02—Details
- H03B5/04—Modifications of generator to compensate for variations in physical values, e.g. power supply, load, temperature
-
- 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
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03B—GENERATION OF OSCILLATIONS, DIRECTLY OR BY FREQUENCY-CHANGING, BY CIRCUITS EMPLOYING ACTIVE ELEMENTS WHICH OPERATE IN A NON-SWITCHING MANNER; GENERATION OF NOISE BY SUCH CIRCUITS
- H03B5/00—Generation of oscillations using amplifier with regenerative feedback from output to input
- H03B5/30—Generation of oscillations using amplifier with regenerative feedback from output to input with frequency-determining element being electromechanical resonator
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03J—TUNING RESONANT CIRCUITS; SELECTING RESONANT CIRCUITS
- H03J7/00—Automatic frequency control; Automatic scanning over a band of frequencies
- H03J7/02—Automatic frequency control
- H03J7/04—Automatic frequency control where the frequency control is accomplished by varying the electrical characteristics of a non-mechanically adjustable element or where the nature of the frequency controlling element is not significant
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03L—AUTOMATIC CONTROL, STARTING, SYNCHRONISATION OR STABILISATION OF GENERATORS OF ELECTRONIC OSCILLATIONS OR PULSES
- H03L7/00—Automatic control of frequency or phase; Synchronisation
- H03L7/06—Automatic control of frequency or phase; Synchronisation using a reference signal applied to a frequency- or phase-locked loop
- H03L7/08—Details of the phase-locked loop
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03L—AUTOMATIC CONTROL, STARTING, SYNCHRONISATION OR STABILISATION OF GENERATORS OF ELECTRONIC OSCILLATIONS OR PULSES
- H03L7/00—Automatic control of frequency or phase; Synchronisation
- H03L7/06—Automatic control of frequency or phase; Synchronisation using a reference signal applied to a frequency- or phase-locked loop
- H03L7/08—Details of the phase-locked loop
- H03L7/099—Details of the phase-locked loop concerning mainly the controlled oscillator of the loop
- H03L7/0991—Details of the phase-locked loop concerning mainly the controlled oscillator of the loop the oscillator being a digital oscillator, e.g. composed of a fixed oscillator followed by a variable frequency divider
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种微机电陀螺的幅频控制驱动电路系统,包括信号放大电路、模数转换电路、数字锁相环电路、数字幅值控制电路、数字频率控制电路、加法器和数模转换电路;信号放大电路与微机电陀螺驱动模态的检测电极相连;模数转换电路与信号放大电路相连;模数转换电路分别与数字锁相环电路、数字幅值控制电路、数字频率控制电路相连;加法器分别与数字幅值控制电路和数字频率控制电路相连;数模转换电路与加法器相连,且与陀螺驱动模态的驱动电极相连。本发明可以通过参数调谐的方案实现陀螺驱动模态的频率闭环控制,避免因外界环境温度变化使频率发生漂移,实现微机电陀螺驱动模态的稳幅稳频振荡。
Description
技术领域
本发明属于微机电领域,特别是一种微机电陀螺的幅频控制驱动电路系统。
背景技术
微机电陀螺是一种通过科里奥利效应实现角速度检测的传感器,其加工材料为单晶硅,采用成熟的微机电技术加工。与传统陀螺仪相比,微机电陀螺具有体积小、重量轻、功耗小、成本低以及可以大规模加工等优点。因此,微机电陀螺是陀螺仪发展的未来方向,在陀螺仪领域中占据重要地位。
微机电陀螺通常被分为驱动模态和检测模态两个工作模态。当驱动模态以稳定的频率和幅值保持振荡且微机电陀螺在敏感方向旋转时,检测模态会因为科里奥利效应产生相应的位移。因此,检测模态位移可以被敏感并用于角速度检测。在实际的应用中,大多数的微机电陀螺通常只采用了稳幅驱动电路,陀螺驱动模态只是以稳定的幅值振动,而频率会随着环境温度等因素的变化而产生漂移,导致陀螺的温度性能较差。
发明内容
本发明的目的在于提供一种微机电陀螺的幅频控制驱动电路系统,以实现陀螺驱动模态的稳幅稳频振荡。
实现本发明目的的技术解决方案为:
一种微机电陀螺的幅频控制驱动电路系统,包括:
信号放大电路,用于将微机电陀螺谐振子的驱动振动信号放大;
模数转换电路,用于将信号放大电路放大后的模拟电信号转换为数字信号;
数字锁相环电路,用于跟踪驱动模态的相位和频率,产生两路参考正弦信号:同相参考正弦信号和正交参考正弦信号;
数字幅值控制电路,用于对模数转换电路的输出信号进行解调和滤波,以控制微机电陀螺谐振子驱动幅值的稳定;由数字锁相环电路产生的同相参考正弦信号用于幅值信息的解调和调制;
数字频率控制电路,用于对数字锁相环电路中谐振频率模块产生的谐振频率进行控制,以实现微机电陀螺谐振子驱动谐振频率的稳定;由数字锁相环电路产生的正交参考正弦信号用于调制频率控制信号;
加法器,用于将数字幅值控制电路4产生的驱动电压信号与数字频率控制电路5产生的参数调谐电压信号相加,以实现微机电陀螺驱动模态的稳幅稳频闭环控制;
数模转换电路,用于输出的数字电信号转换为模拟信号,施加至微机电陀螺驱动模态的驱动电极上。
本发明与现有技术相比,其显著优点是:
(1)本发明基于数字幅值控制电路、数字频率控制电路可以实现微机电陀螺驱动模态的稳幅稳频控制。
(2)本发明采用FPGA数字化控制方案,数字锁相环电路、数字幅值控制电路、数字频率控制电路均采用数字电路,具有高稳定性、低成本、易调试和维护的优势。
(3)本发明中微机电陀螺驱动电路系统采用参数调谐的方案实现频率闭环控制,不仅具有双向调谐的能力,还能减小外界环境等因素对系统的干扰。
附图说明
图1为本发明驱动电路系统框图。
图2为本发明驱动电路系统中锁相环电路框图。
图3为本发明驱动电路系统中幅值控制电路框图。
图4为本发明驱动电路系统中基于参数调谐的频率控制电路框图。
具体实施方式
下面结合附图及具体实施例对本发明做进一步的介绍。
结合图1,本实施例的一种微机电陀螺的幅频控制驱动电路系统,包括信号放大电路1、模数转换电路2、数字锁相环电路3、数字幅值控制电路4、数字频率控制电路5、加法器6、数模转换电路7;
所述信号放大电路1与微机电陀螺驱动模态的检测电极x+、x-相连,用于将微机电陀螺谐振子的驱动振动信号放大。信号放大电路为电荷检测电路,可以检测出微机电陀螺谐振子驱动模态因振动而引起的电极电荷变化。
所述模数转换电路2与信号放大电路1相连,用于将信号放大电路1放大后的模拟电信号转换为数字信号;
所述数字锁相环电路3与模数转换电路2相连,用于跟踪驱动模态的相位和频率,产生两路参考正弦信号,其相位分别为同相和正交;同相参考正弦信号作用于数字幅值控制电路4,正交参考正弦信号作用于数字频率控制电路5;
所述数字幅值控制电路4与模数转换电路2相连,用于对模数转换电路2的输出信号进行解调和滤波,以控制微机电陀螺谐振子驱动幅值的稳定;由数字锁相环电路3产生的同相参考正弦信号用于幅值信息的解调和调制;
所述数字频率控制电路5与模数转换电路2相连,用于对数字锁相环电路3中谐振频率模块产生的谐振频率进行控制,以实现微机电陀螺谐振子驱动谐振频率的稳定;由数字锁相环电路3产生的正交参考正弦信号用于调制频率控制信号;
所述加法器6分别与数字幅值控制电路4和数字频率控制电路5相连,用于将数字幅值控制电路4产生的驱动电压信号与数字频率控制电路5产生的参数调谐电压信号相加,以实现微机电陀螺驱动模态的稳幅稳频闭环控制;
所述数模转换电路7与加法器6相连,用于将电路输出的数字电信号转换为模拟信号,施加至微机电陀螺驱动模态的驱动电极上。
进一步的,如图2所示,所述数字锁相环电路3包括第一乘法器、第一低通滤波器、第一PID控制器、谐振频率模块、数字振荡器;所述第一乘法器用于输入信号(数字电信号)与参考信号2cos(ωt)相乘,利用积化和差公式将信号的常数系数转化为1,并且解调频率和相位信息;所述第一低通滤波器用于将相乘后的二倍频信号滤除,保留微机电陀螺驱动模态的频率和相位信息;所述第一PID控制器将第一低通滤波器的输出信号转换为控制信号;所述谐振频率模块用于输出初始频率变化后的驱动谐振频率;所述数字振荡器用于将控制信号转换为两路相位为同相和正交的参考正弦信号。
进一步的,如图3所示,所述数字幅值控制电路4包括第二乘法器、第二低通滤波器、基准幅值模块、第二PID控制器、第三乘法器;所述第二乘法器用于输入信号(数字电信号)与参考信号2sin(ωt)相乘,利用积化和差公式将信号的常数系数转化为1,并且解调振动幅值信息;所述第二低通滤波器用于将相乘后的二倍频信号滤除,保留微机电陀螺驱动模态的振动幅值信息;所述基准幅值模块用于输出振动幅值与参考幅值设定值之间的差值信息;所述第二PID控制器用于将振动幅值的差值信息转换为幅值控制信号;所述第三乘法器用于将幅值控制信号与数字锁相环电路产生的同相参考正弦信号sin(ωt)相乘,调制幅值控制信号,实现驱动模态幅值闭环控制。
进一步的,如图4所示,所述数字频率控制电路5包括基准频率模块、第三PID控制器、第四乘法器;所述基准频率模块用于输出驱动模态谐振频率与参考频率设定值之间的差值信息;所述第三PID控制器用于将频率差值信息转换为频率控制信号;所述第四乘法器用于将频率控制信号与数字锁相环电路产生的正交参考正弦信号cos(ωt)相乘,调制频率控制信号,实现驱动模态频率闭环控制。
本实施例中,数字锁相环电路3、数字幅值控制电路4、数字频率控制电路5、加法器6都位于同一个FPGA芯片内。
本实施例中,数字锁相环电路3使用数字解调方式对信号进行解调和滤波,利用PID控制器1产生的相位控制信号控制数字振荡器产生参考正弦信号,参考正弦信号跟踪微机电陀螺驱动模态的频率和相位变化。数字幅值控制电路4使用数字解调方式对信号进行解调和滤波,利用PID控制器2控制微机电陀螺驱动模态的振动幅值稳定在设定值。数字频率控制电路5中先将数字锁相环电路3实时跟踪陀螺驱动模态的谐振频率与参考频率设定值进行实时比较,将比较后的信号输入PID控制器3,PID控制器3输出参数调谐电压的幅值,其与正交参考正弦信号cos(ωt)调制产生相应的交流参数调谐电压。该参数调谐电压与数字幅值控制电路4产生的驱动电压相加后施加到陀螺驱动模态的驱动电极上。因此,尽管外界环境温度变化会导致陀螺驱动模态的谐振频率发生漂移,但通过自动调整反馈的参数调谐电压能使陀螺驱动模态的谐振频率保持不变。
施加参数调谐电压时的陀螺驱动运动方程可以表示为:
其中mx为陀螺驱动模态的等效质量,cxx为陀螺驱动模态的阻尼系数,kxx为陀螺驱动模态的刚度系数,x为陀螺驱动模态的位移信号,为陀螺驱动模态的振动速度,/>为陀螺驱动模态的振动加速度,ηvf为电压-反馈静电力转换系数,Fdsin(ωt)为陀螺驱动模态的激励信号,Fd为陀螺驱动模态激励信号的幅值,Vptcos(ωt)为陀螺驱动模态的参数调谐电压信号,Vpt为陀螺驱动模态的参数调谐电压幅值,ω为陀螺驱动模态激励信号和参数调谐电压信号的频率,t为时间变量。
驱动模态位移信号表示为:
x=-xp cos(ωt)
其中xp为驱动模态位移信号的幅值,ω为驱动模态位移信号的频率,t为时间变量。
陀螺驱动模态的运动方程可改写为:
因施加了参数调谐电压,陀螺驱动模态的初始谐振频率fx0会发生变化,此时陀螺驱动模态的谐振频率表示为:
分析可知:通过调整参数调谐电压的幅值Vpt可以实现双向调整陀螺驱动模态的等效谐振频率,同时其调谐能力也与电压-反馈静电力转换系数ηvf成正比,且与陀螺振动位移xp成反比。
Claims (6)
1.一种微机电陀螺的幅频控制驱动电路系统,其特征在于,包括:
信号放大电路,用于将微机电陀螺谐振子的驱动振动信号放大;
模数转换电路,用于将信号放大电路放大后的模拟电信号转换为数字信号;
数字锁相环电路,用于跟踪驱动模态的相位和频率,产生两路参考正弦信号:同相参考正弦信号和正交参考正弦信号;
数字幅值控制电路,用于对模数转换电路的输出信号进行解调和滤波,以控制微机电陀螺谐振子驱动幅值的稳定,由数字锁相环电路产生的同相参考正弦信号用于幅值信息的解调和调制;
数字频率控制电路,用于对数字锁相环电路中谐振频率模块产生的谐振频率进行控制,以实现微机电陀螺谐振子驱动谐振频率的稳定,由数字锁相环电路产生的正交参考正弦信号用于调制频率控制信号;
加法器,用于将数字幅值控制电路产生的驱动电压信号与数字频率控制电路产生的参数调谐电压信号相加,以实现微机电陀螺驱动模态的稳幅稳频闭环控制;
数模转换电路,用于输出的数字电信号转换为模拟信号,施加至微机电陀螺驱动模态的驱动电极上。
2.根据权利要求1所述的微机电陀螺的幅频控制驱动电路系统,其特征在于,所述数字锁相环电路包括:
第一乘法器,用于输入信号与参考信号相乘,利用积化和差公式将信号的常数系数转化为1,并且解调频率和相位信息;
第一低通滤波器,用于将相乘后的二倍频信号滤除,保留微机电陀螺驱动模态的频率和相位信息;
第一PID控制器,用于将第一低通滤波器的输出信号转换为控制信号;
谐振频率模块,用于输出初始频率变化后的驱动谐振频率;
数字振荡器,用于将控制信号转换为两路相位为同相和正交的参考正弦信号。
3.根据权利要求1所述的微机电陀螺的幅频控制驱动电路系统,其特征在于,所述数字幅值控制电路包括:
第二乘法器,用于输入信号与参考信号相乘,利用积化和差公式将信号的常数系数转化为1,并且解调振动幅值信息;
第二低通滤波器,用于将相乘后的二倍频信号滤除,保留微机电陀螺驱动模态的振动幅值信息;
基准幅值模块,用于输出振动幅值与参考幅值设定值之间的差值信息;
第二PID控制器,用于将振动幅值的差值信息转换为幅值控制信号;
第三乘法器,用于将幅值控制信号与数字锁相环电路产生的同相参考正弦信号相乘,调制幅值控制信号,实现驱动模态幅值闭环控制。
4.根据权利要求1所述的微机电陀螺的幅频控制驱动电路系统,其特征在于,所述数字频率控制电路包括:
基准频率模块,用于输出驱动模态谐振频率与参考频率设定值之间的差值信息;
第三PID控制器,用于将频率差值信息转换为频率控制信号;
第四乘法器,用于将频率控制信号与数字锁相环电路产生的正交参考正弦信号相乘,调制频率控制信号,实现驱动模态频率闭环控制。
5.根据权利要求1或2所述的微机电陀螺的幅频控制驱动电路系统,其特征在于,所述数字锁相环电路产生的陀螺驱动模态的谐振频率为:
其中fx0为陀螺驱动模态的初始谐振频率,ηvf为电压-反馈静电力转换系数,Vpt为陀螺驱动模态的参数调谐电压幅值,kxx为陀螺驱动模态的刚度系数,xp为驱动模态位移信号的幅值。
6.根据权利要求1所述的微机电陀螺的幅频控制驱动电路系统,其特征在于,数字锁相环电路、数字幅值控制电路、数字频率控制电路、加法器位于同一个FPGA芯片内。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310590112.6A CN116683871A (zh) | 2023-05-24 | 2023-05-24 | 一种微机电陀螺的幅频控制驱动电路系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310590112.6A CN116683871A (zh) | 2023-05-24 | 2023-05-24 | 一种微机电陀螺的幅频控制驱动电路系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116683871A true CN116683871A (zh) | 2023-09-01 |
Family
ID=87786463
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310590112.6A Pending CN116683871A (zh) | 2023-05-24 | 2023-05-24 | 一种微机电陀螺的幅频控制驱动电路系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116683871A (zh) |
-
2023
- 2023-05-24 CN CN202310590112.6A patent/CN116683871A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108253952B (zh) | 一种零偏自校准mems陀螺仪及其零偏自校准方法 | |
CN102109345B (zh) | 微机械陀螺数字信号处理方法与装置 | |
US7481111B2 (en) | Micro-electro-mechanical sensor with force feedback loop | |
US7305880B2 (en) | Resonant micro-electro-mechanical system with analog driving | |
JP4690652B2 (ja) | マイクロ電子機械システム | |
CN1764824B (zh) | 检波电路、检波方法以及物理量测定装置 | |
US7827864B2 (en) | Microelectromechanical gyroscope with suppression of capacitive coupling spurious signals and control method | |
US7849744B2 (en) | Driving device, physical quantity measurement device, and electronic instrument | |
US9869552B2 (en) | Gyroscope that compensates for fluctuations in sensitivity | |
US9310203B2 (en) | Physical quantity sensor | |
EP2466257A1 (en) | Method for matching the natural frequencies of the drive and sense oscillators in a vibrating coriolis gyroscope | |
CN110631570B (zh) | 一种用于提升硅微陀螺仪标度因数温度稳定性的系统和方法 | |
KR20090074788A (ko) | 진동 센서를 사용하여 회전율을 측정하는 장치 | |
CN111412907B (zh) | 一种微机电多环陀螺的全角测控电路系统 | |
CN111551162B (zh) | 一种用于常压封装mems陀螺仪解调相角补偿的系统和方法 | |
US20130025368A1 (en) | Microelectromechanical gyroscope with improved reading stage and method | |
CN112747730B (zh) | 一种微机械陀螺的基于自激驱动的非线性控制系统和方法 | |
CN105258689A (zh) | 一种数字陀螺仪信号控制处理系统 | |
Kline | Frequency modulated gyroscopes | |
CN111220139B (zh) | 一种微机电多环陀螺力平衡模式测控电路系统 | |
CN112066968A (zh) | 一种微机电多环陀螺实时模态自动匹配系统 | |
CN113607150A (zh) | 一种时分驱动和正交力反馈闭环的石英陀螺误差抑制方法 | |
TW201741624A (zh) | 陀螺儀裝置及陀螺儀裝置之控制方法 | |
CN116683871A (zh) | 一种微机电陀螺的幅频控制驱动电路系统 | |
Zhang et al. | The structure principle of silicon micromachined gyroscope driven by the rotating carrier |
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 |