MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology
Through the driving circuit system based on electromechanical amplitude modulation technology, the problems of low-frequency noise and feedthrough effect of MEMS four-mass gyroscope are solved, and amplitude and frequency stabilization control is achieved, which improves the quality of signal detection and the stability of the system.
Patent Information
- Application Number
- CN202411031349.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-30
- Publication Date
- 2024-11-15
AI Technical Summary
The MEMS four-mass gyroscope has circuit noise and feedthrough effects in the low frequency domain, resulting in signal detection interference and affecting performance.
The drive circuit system based on electromechanical amplitude modulation technology includes signal detection circuit, analog-to-digital conversion circuit, digital frequency control circuit, digital amplitude control circuit and multiplier. Through high-frequency carrier modulation and demodulation, the feedthrough effect and low frequency are eliminated. Noise, achieve stable amplitude and frequency control.
Effectively eliminate the impact of feedthrough effect and low-frequency noise on MEMS four-mass gyroscope, improve signal-to-noise ratio, and achieve a high stability, low cost and easy-to-maintenance driving circuit system.
Smart Images

Figure CN118960707A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of micro-electromechanical systems, and in particular is a MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology. Background Art
[0002] Micro Electromechanical System (MEMS) gyroscope is a sensor that measures inertial angular rate based on the Coriolis effect and is the core measurement device of the inertial navigation system. Compared with traditional gyroscopes, MEMS gyroscopes have the advantages of small size, high reliability, low power consumption, and low maintenance cost. They are widely used in aerospace, navigation, autonomous driving, virtual reality, and consumer electronics. Among them, the MEMS four-mass gyroscope has a simple structure and lower process accuracy requirements than the ring gyroscope. It has the potential for mass production and is the mainstream solution for commercial gyroscopes. However, the increase in mass of the MEMS four-mass gyroscope leads to an increase in the complexity of the control circuit, which will lead to an increase in circuit noise. The noise is mainly concentrated in the low-frequency domain, which interferes with the extraction of useful signals from the gyroscope. In addition, due to the existence of the feedthrough effect, the parasitic capacitance between the drive electrode and the detection electrode of the gyroscope directly couples the drive excitation signal with the same frequency as the resonant frequency to the detection circuit. The detection output signal obtained in this way must contain a coupling signal, which interferes with the normal operation of the gyroscope and seriously affects the performance of the MEMS four-mass gyroscope. Feedthrough effect and noise will directly or indirectly deteriorate the performance of the gyroscope, so a method that can effectively suppress feedthrough effect and noise coupling is very necessary. Summary of the invention
[0003] The object of the present invention is to provide a MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology to eliminate the influence of feedthrough effect and low-frequency noise on the signal detection of the MEMS four-mass gyroscope and improve the signal-to-noise ratio.
[0004] The technical solution to achieve the purpose of the present invention is: a MEMS four-mass gyroscope drive circuit system based on electromechanical amplitude modulation technology, comprising:
[0005] A signal detection circuit, used for detecting a vibration signal of a resonator of a MEMS four-mass gyroscope by using an electromechanical amplitude modulation technique;
[0006] An analog-to-digital conversion circuit, used for converting the analog electrical signal obtained by the signal detection circuit into a digital signal;
[0007] A digital frequency control circuit is used to track the phase and frequency of the driving mode of the MEMS four-mass gyroscope, generate two reference signals, including a frequency stabilization signal and a phase feedback signal, and achieve the stability of the resonant frequency of the resonator driving the MEMS four-mass gyroscope;
[0008] A digital amplitude control circuit is used to demodulate and filter the drive shaft detection signal output by the analog-to-digital conversion circuit to control the stability of the drive amplitude of the resonator of the MEMS four-mass gyroscope;
[0009] A multiplier, used to multiply the frequency stabilization signal generated by the digital frequency control circuit with the driving voltage signal generated by the digital amplitude control circuit 4, so as to realize the closed-loop control of the amplitude and frequency stabilization of the driving mode of the MEMS four-mass gyroscope;
[0010] The digital-to-analog conversion circuit is used to convert the output digital electrical signal into an analog signal and apply it to the driving electrode of the driving mode of the MEMS four-mass gyroscope.
[0011] Furthermore, the signal detection circuit includes a high frequency carrier v carrier , AM modulator 1, AM modulator 2, AM demodulator 1, AM demodulator 2 and instrument amplifier; the high frequency carrier v carrier One end is connected to the ground, and the other end is connected to AM modulator 1 and AM modulator 2; one end of the AM modulator 1 is connected to the high frequency carrier v carrier The other end is connected to the AM demodulator 1; the AM modulator 1 includes a capacitor C x0 +ΔC x , resistor R f , capacitor C f , operational amplifier 1; the capacitor C x0 +ΔC x One end is connected to the high frequency carrier v carrier The other end is connected to the inverting input terminal of the operational amplifier 1; the resistor R f One end is connected to the inverting input terminal of the operational amplifier 1, and the other end is connected to the output terminal of the operational amplifier 1; the capacitor C f One end is connected to the inverting input end of the operational amplifier 1, and the other end is connected to the output end of the operational amplifier 1; the inverting input end of the operational amplifier 1 is connected to the capacitor C x0 +ΔC x connected, the in-phase input end is connected to the ground, and the output end is connected to the AM demodulator 1; one end of the AM modulator 2 is connected to the high frequency carrier v carrier The other end is connected to the AM demodulator 2; the AM modulator 2 includes a capacitor C' x0 -ΔC' x , operational amplifier 2, resistor R' f , Capacitor C' f The capacitor C' x0 -ΔC' x One end is connected to the high frequency carrier v carrier The other end is connected to the inverting input terminal of the operational amplifier 2; the resistor R' fOne end is connected to the inverting input terminal of the operational amplifier 2, and the other end is connected to the output terminal of the operational amplifier 2; the capacitor C' f One end is connected to the inverting input end of the operational amplifier 2, and the other end is connected to the output end of the operational amplifier 2; the inverting input end of the operational amplifier 2 is connected to the capacitor C' x0 -ΔC' x The in-phase input end is connected to the ground, and the output end is connected to the AM demodulator 2; one end of the AM demodulator 1 is connected to the AM modulator 1, and the other end is connected to the instrument amplifier; the AM demodulator 1 includes a diode D, a resistor R D , capacitor C D One end of the diode D is connected to the AM modulator 1, and the other end is connected to the instrument amplifier; the resistor R D One end is connected to the diode D, and the other end is connected to the ground; the capacitor C D One end is connected to diode D, and the other end is connected to ground; diode D has a diode voltage drop v diode , resistor R D , capacitor C D The RC circuit is formed, and together with the diode D, the time constant is R D C D The demodulator; one end of the AM demodulator 2 is connected to the AM modulator 2, and the other end is connected to the instrument amplifier; the AM demodulator 2 includes a diode D ', a resistor R ' D , Capacitor C' D The diode D' is connected to the AM modulator 2 at one end and to the instrument amplifier at the other end; the resistor R' D One end is connected to the diode D', and the other end is connected to the ground; the capacitor C' D One end is connected to diode D' and the other end is connected to ground; diode D' has a diode voltage drop v' diode , resistance R' D , Capacitor C' D It forms an RC circuit, and together with the diode D', it forms a time constant of R' D C' D Demodulator;
[0012] The AM modulator 1 is used to convert the positive detection signal v of the MEMS four-mass gyroscope drive axis x+ With high frequency carrier signal v carrier Amplify and modulate the amplitude to get v A+ The AM modulator 2 is used to detect the negative pole of the MEMS four-mass gyroscope drive axis v x- With high frequency carrier signal v carrier Amplify and modulate the amplitude to get v A- The AM demodulator 1 is used to amplify the amplitude modulated signal vA+ Demodulation gives v B+ , the high-frequency carrier signal is filtered out and the positive detection signal of the driving axis of the MEMS four-mass gyroscope is transmitted unaffected; the AM demodulator 2 is used to amplify the amplitude modulation signal v A- Demodulation gives v B- , filtering out the high-frequency carrier signal and transmitting the negative pole detection signal of the drive shaft of the MEMS four-mass gyroscope without being affected; the instrument amplifier demodulates the v obtained by the AM demodulator 1 B+ and the demodulated v obtained by AM demodulator 2 B- Differential amplification is performed and the common-mode voltage introduced by parasitic capacitance and parasitic resistance of the feedthrough effect is eliminated, and finally the gyroscope drive end detection signal v after signal conditioning is obtained. out .
[0013] Furthermore, the digital frequency control circuit includes a phase detector, a loop filter, and a digitally controlled oscillator; one end of the phase detector is connected to the drive shaft detection end signal, and the other end is connected to the loop filter; one end of the loop filter is connected to the phase detector, and the other end is connected to the digitally controlled oscillator; one end of the digitally controlled oscillator is connected to the loop filter, and the other end is connected to the frequency stabilization signal;
[0014] The phase detector detects the phase difference between the voltage signal at the detection end of the drive shaft and the phase feedback signal, and converts the phase difference signal into a voltage signal phase error signal; the loop filter filters the phase error signal, removes high-frequency noise, and obtains a frequency control signal; the numerically controlled oscillator adjusts the frequency and phase of the output stable frequency signal according to the frequency control signal, so that the stable frequency signal is gradually synchronized with the voltage signal at the detection end of the drive shaft, and at the same time, the output phase feedback signal is sent back to the phase detector through a feedback loop and compared with the signal at the detection end of the drive shaft, so as to realize the closed-loop control of the gyroscope drive mode frequency.
[0015] Furthermore, the digital amplitude control circuit includes an amplitude detector, an amplitude comparator, a digital PID controller, and a carrier modulator; one end of the amplitude detector is connected to the drive shaft differential detection signal, and the other end is connected to the amplitude comparator; one end of the amplitude comparator is connected to the amplitude detector, and the other end is connected to the digital PID controller; one end of the digital PID controller is connected to the amplitude comparator, and the other end is connected to the carrier modulator; one end of the carrier modulator is connected to the digital PID controller, and the other end is connected to the drive shaft drive voltage signal;
[0016] The amplitude detector includes a multiplication demodulator and a low-pass filter, which are used to detect the amplitude of the differential detection signal of the drive shaft and generate a corresponding amplitude signal; the amplitude comparator is used to compare the amplitude signal output by the amplitude detector with the reference amplitude signal and generate an error signal of the difference between the current amplitude and the reference amplitude; the digital PID controller module calculates the gain value that needs to be adjusted according to the error signal to minimize the error, and converts the error signal of the vibration amplitude into an error control signal; the carrier modulator adjusts the gain of the differential signal of the drive shaft detection end according to the error control signal output by the PID controller and outputs a drive shaft drive voltage signal, and the drive voltage signal is sent back to the drive voltage end of the drive shaft to realize the gyroscope drive mode amplitude closed-loop control.
[0017] Furthermore, the digital frequency control circuit, the digital amplitude control circuit, and the multiplier are all located in the FPGA digital control system.
[0018] A method for driving a MEMS four-mass gyroscope based on electromechanical amplitude modulation technology utilizes the MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology to realize driving of the MEMS four-mass gyroscope based on electromechanical amplitude modulation technology.
[0019] Compared with the prior art, the present invention has the following significant advantages:
[0020] (1) The application of electromechanical amplitude modulation technology in the signal detection circuit of the MEMS four-mass gyroscope can effectively eliminate the influence of feedthrough effect and low-frequency noise coupling on the performance of the MEMS four-mass gyroscope.
[0021] (2) Based on the digital frequency control circuit and the digital amplitude control circuit, the stable amplitude and frequency control of the driving mode of the MEMS four-mass gyroscope can be achieved.
[0022] (3) The FPGA digital control solution is adopted. Both the digital frequency control circuit and the digital amplitude control circuit use digital circuits, which have the advantages of high stability, low cost, easy debugging and maintenance. BRIEF DESCRIPTION OF THE DRAWINGS
[0023] Figure 1 This is a block diagram of the driving circuit system of the present invention.
[0024] Figure 2 This is a signal detection circuit diagram based on electromechanical amplitude modulation technology in the driving circuit system of the present invention.
[0025] Figure 3 This is a block diagram of a digital frequency control circuit in the driving circuit system of the present invention.
[0026] Figure 4 This is a block diagram of a digital amplitude control circuit in the drive circuit system of the present invention.
[0027] Figure 5 This is the influence of the feedthrough effect on the signal detection of the MEMS four-mass gyroscope in the present invention. DETAILED DESCRIPTION
[0028] The present invention is further described below in conjunction with the accompanying drawings and specific embodiments.
[0029] Combination Figure 1 A MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology includes a signal detection circuit 1, an analog-to-digital conversion circuit 2, a digital frequency control circuit 3, a digital amplitude control circuit 4, a multiplier 5, and a digital-to-analog conversion circuit 6.
[0030] (1) Signal detection circuit
[0031] The signal detection circuit 1 and the detection electrode x of the driving mode of the MEMS four-mass gyroscope + 、x - The signal detection circuit is a charge detection circuit that can detect the electrode charge change caused by the vibration of the driving mode of the MEMS four-mass gyroscope resonator; the electromechanical amplitude modulation technology is adopted to eliminate the influence of the feedthrough effect and low-frequency noise on the signal detection of the MEMS four-mass gyroscope.
[0032] Further, such as Figure 2 As shown, the signal detection circuit 1 includes a high frequency carrier v carrier , AM modulator 1, AM modulator 2, AM demodulator 1, AM demodulator 2 and instrument amplifier; the high frequency carrier v carrier One end is connected to the ground, and the other end is connected to AM modulator 1 and AM modulator 2; the AM modulator 1 is used to convert the positive detection signal v of the MEMS four-mass gyroscope drive axis x+ With high frequency carrier signal v carrier Amplify and modulate the amplitude to get v A+ ; One end of the AM modulator 1 is connected to the high frequency carrier v carrier The other end is connected to the AM demodulator 1; the AM modulator 1 includes a capacitor C x0 +ΔC x , resistor R f , capacitor C f , operational amplifier 1; the capacitor C x0 +ΔC x One end is connected to the high frequency carrier v carrier The other end is connected to the inverting input terminal of the operational amplifier 1; the resistor R f One end is connected to the inverting input terminal of the operational amplifier 1, and the other end is connected to the output terminal of the operational amplifier 1; the capacitor Cf One end is connected to the inverting input end of the operational amplifier 1, and the other end is connected to the output end of the operational amplifier 1; the inverting input end of the operational amplifier 1 is connected to the capacitor C x0 +ΔC x connected, the in-phase input terminal is connected to ground, and the output terminal is connected to AM demodulator 1; capacitor C x0 +ΔC x The capacitance of the positive electrode of the drive shaft detection end when the MEMS four-mass gyroscope senses the angular rate is simulated, C x0 is the intrinsic capacitance of the positive electrode of the gyroscope drive shaft detection end, ΔC x is the capacitance change of the positive electrode of the gyroscope drive shaft detection end caused by the angular rate; operational amplifier 1, resistor R f , capacitor C f Together they form a current detector, resistor R f , capacitor C f are respectively the feedback resistor and feedback capacitor of operational amplifier 1; the feedback resistor R f To provide the necessary DC bias current for the negative input of operational amplifier 1, R f With the feedback capacitor C f The AM modulator 2 is used to convert the negative pole detection signal v of the driving axis of the MEMS four-mass gyroscope into x- With high frequency carrier signal v carrier Amplify and modulate the amplitude to get v A- ; One end of the AM modulator 2 is connected to the high frequency carrier v carrier The other end is connected to the AM demodulator 2; the AM modulator 2 includes a capacitor C' x0 -ΔC' x , operational amplifier 2, resistor R' f , Capacitor C' f The capacitor C' x0 -ΔC' x One end is connected to the high frequency carrier v carrier The other end is connected to the inverting input terminal of the operational amplifier 2; the resistor R' f One end is connected to the inverting input terminal of the operational amplifier 2, and the other end is connected to the output terminal of the operational amplifier 2; the capacitor C' f One end is connected to the inverting input end of the operational amplifier 2, and the other end is connected to the output end of the operational amplifier 2; the inverting input end of the operational amplifier 2 is connected to the capacitor C' x0 -ΔC' x connected, the in-phase input terminal is connected to the ground, and the output terminal is connected to the AM demodulator 2; capacitor C' x0 -ΔC' xThe capacitance of the negative electrode of the drive shaft detection end when the MEMS four-mass gyroscope senses the angular rate, C' x0 is the intrinsic capacitance of the negative detection electrode at the gyroscope drive end, ΔC' x is the capacitance change of the negative electrode of the gyroscope drive shaft detection end caused by the angular rate; operational amplifier 2, resistor R' f , Capacitor C' f Together they form a current detector, resistor R' f , Capacitor C' f are respectively the feedback resistance and feedback capacitance of operational amplifier 2; feedback resistance R' f Provides the necessary DC bias current for the negative input of operational amplifier 2, R' f With feedback capacitor C' f together act as a high-pass filter with a certain cut-off frequency; the AM demodulator 1 is used to convert the amplified amplitude modulated signal v A+ Demodulation gives v B+ , filtering out the high-frequency carrier signal and transmitting the positive detection signal of the driving axis of the MEMS four-mass gyroscope without being affected; one end of the AM demodulator 1 is connected to the AM modulator 1, and the other end is connected to the instrument amplifier; the AM demodulator 1 includes a diode D, a resistor R D , capacitor C D One end of the diode D is connected to the AM modulator 1, and the other end is connected to the instrument amplifier; the resistor R D One end is connected to the diode D, and the other end is connected to the ground; the capacitor C D One end is connected to diode D, and the other end is connected to ground; diode D has a diode voltage drop v diode , resistor R D , capacitor C D The RC circuit is formed, and together with the diode D, the time constant is R D C D The AM demodulator 2 is used to amplify the amplitude modulated signal v A- Demodulation gives v B- , filtering out the high-frequency carrier signal and transmitting the negative pole detection signal of the driving axis of the MEMS four-mass gyroscope without being affected; one end of the AM demodulator 2 is connected to the AM modulator 2, and the other end is connected to the instrument amplifier; the AM demodulator 2 includes a diode D', a resistor R' D , Capacitor C' D The diode D' is connected to the AM modulator 2 at one end and to the instrument amplifier at the other end; the resistor R' D One end is connected to the diode D', and the other end is connected to the ground; the capacitor C' D One end is connected to diode D' and the other end is connected to ground; diode D' has a diode voltage drop v'diode , resistance R' D , Capacitor C' D It forms an RC circuit, and together with the diode D', it forms a time constant of R' D C' D The instrument amplifier demodulates the AM demodulator 1 to obtain v B+ and the demodulated v obtained by AM demodulator 2 B- Differential amplification is performed and the common-mode voltage introduced by parasitic capacitance and parasitic resistance of the feedthrough effect is eliminated, and finally the gyroscope drive end detection signal v after signal conditioning is obtained. out .
[0033] (2) Analog-to-digital conversion circuit
[0034] The analog-to-digital conversion circuit 2 is connected to the signal detection circuit 1 and is used to convert the analog electrical signal obtained by the signal detection circuit 1 into a digital signal;
[0035] (3) Digital frequency control circuit
[0036] The digital frequency control circuit 3 is connected to the analog-to-digital conversion circuit 2, and is used to track the phase and frequency of the driving mode, and generate two reference signals, namely, a frequency stabilization signal and a phase feedback signal; the phase feedback signal acts in the digital frequency control circuit loop as a negative feedback control signal, and the frequency stabilization signal is the stable MEMS four-mass gyroscope resonator driving resonant frequency;
[0037] Further, such as Figure 3 As shown, the digital frequency control circuit 3 includes a phase detector, a loop filter, and a digitally controlled oscillator; one end of the phase detector is connected to the signal of the drive shaft detection end, and the other end is connected to the loop filter; one end of the loop filter is connected to the phase detector, and the other end is connected to the digitally controlled oscillator; one end of the digitally controlled oscillator is connected to the loop filter, and the other end is connected to the frequency stabilization signal; the phase detector detects the phase difference between the voltage signal of the drive shaft detection end and the phase feedback signal, and converts the phase difference signal into a voltage signal phase error signal; the loop filter filters the phase error signal to remove high-frequency noise and obtain a frequency control signal; the digitally controlled oscillator adjusts the frequency and phase of the output frequency stabilization signal according to the frequency control signal, so that the frequency stabilization signal is gradually synchronized with the voltage signal of the drive shaft detection end, and the output phase feedback signal is sent back to the phase detector through the feedback loop, and compared with the signal of the drive shaft detection end, so as to realize the closed-loop control of the gyroscope drive mode frequency.
[0038] (4) Digital amplitude control circuit
[0039] The digital amplitude control circuit 4 is connected to the analog-to-digital conversion circuit 2, and is used to demodulate and filter the drive shaft detection signal output by the analog-to-digital conversion circuit 2 to obtain a drive shaft drive voltage signal, so as to control the stability of the drive amplitude of the micro-electromechanical gyroscope resonator;
[0040] Further, such as Figure 4 As shown, the digital amplitude control circuit 4 includes an amplitude detector, an amplitude comparator, a digital PID controller, and a carrier modulator; one end of the amplitude detector is connected to the drive shaft differential detection signal, and the other end is connected to the amplitude comparator; one end of the amplitude comparator is connected to the amplitude detector, and the other end is connected to the digital PID controller; one end of the digital PID controller is connected to the amplitude comparator, and the other end is connected to the carrier modulator; one end of the carrier modulator is connected to the digital PID controller, and the other end is connected to the drive shaft driving voltage signal; the amplitude detector includes a multiplication demodulator and a low-pass filter for detecting the drive shaft differential detection signal. The amplitude of the signal is measured and a corresponding amplitude signal is generated; the amplitude comparator is used to compare the amplitude signal output by the amplitude detector with the reference amplitude signal and generate an error signal of the difference between the current amplitude and the reference amplitude; the digital PID controller module calculates the gain value that needs to be adjusted according to the error signal to minimize the error, and converts the error signal of the vibration amplitude into an error control signal; the carrier modulator adjusts the gain of the differential signal of the drive shaft detection end according to the error control signal output by the PID controller and outputs a drive shaft drive voltage signal, and the drive voltage signal is sent back to the drive shaft drive voltage end to realize the gyroscope drive mode amplitude closed-loop control.
[0041] (5) Multiplier
[0042] The multiplier 5 is connected to the digital frequency control circuit 3 and the digital amplitude control circuit 4 respectively, and is used to multiply the frequency stabilization signal generated by the digital frequency control circuit 3 with the driving voltage signal generated by the digital amplitude control circuit 4, so as to realize the closed-loop control of the stable amplitude and stable frequency of the driving mode of the MEMS four-mass gyroscope;
[0043] (6) Digital-to-analog conversion circuit
[0044] The digital-to-analog conversion circuit 6 is connected to the multiplier 5 and is used to convert the digital electrical signal output by the digital-to-analog conversion circuit into an analog signal, and apply it to the driving electrode of the driving mode of the MEMS four-mass gyroscope.
[0045] Furthermore, the digital frequency control circuit 3, the digital amplitude control circuit 4 and the multiplier 5 are all located in the FPGA digital control system.
[0046] The workflow is as follows:
[0047] Signal detection circuit 1 first converts the detection signal v of the positive and negative poles of the MEMS four-mass gyroscope drive axisx+ 、v x- Respectively with the high frequency carrier signal v carrier AM modulator 1 and AM modulator 2 are used to perform amplitude modulation and amplification to obtain v A+ 、v A- , effectively reducing the interference of low-frequency noise on the signal detection of MEMS four-mass gyroscope. AM demodulator 1 and AM demodulator 2 respectively convert the amplified amplitude modulation signal v A+ and v A- Demodulation gives v B+ and v B- , filtering out the high-frequency carrier signal and transmitting the vibration signal of the drive shaft of the MEMS four-mass gyroscope unaffected. The instrumentation amplifier will demodulate the v B+ and v B- After differential amplification to eliminate the common-mode voltage introduced by parasitic capacitance and parasitic resistance generated by the feedthrough effect, the drive shaft detection signal v is obtained. out . The analog-to-digital conversion circuit 2 converts the analog signal of the drive shaft detection output by the signal detection circuit into a digital signal; the digital frequency control circuit 3 uses a digital demodulation method to demodulate and filter the digital signal of the drive shaft detection end, and uses the frequency control signal generated by the loop filter to control the digital oscillator to generate a stable frequency signal and a phase feedback signal. The stable frequency signal and the phase feedback signal track the frequency and phase changes of the driving mode of the MEMS four-mass gyroscope. The digital amplitude control circuit 4 uses a digital demodulation method to demodulate and filter the digital signal of the drive shaft differential detection, and uses a digital PID controller to control the vibration amplitude of the driving mode of the MEMS four-mass gyroscope to stabilize at a set value. The multiplier 5 multiplies the stable frequency signal generated by the digital frequency control circuit 3 and the drive shaft driving voltage signal generated by the digital amplitude control circuit 4 to obtain a stable frequency and amplitude driving signal; the digital-to-analog conversion circuit 6 converts the digital driving signal obtained by the multiplier 5 into an analog signal and feeds it back to the MEMS four-mass gyroscope.
[0048] In the signal detection circuit 1, considering the influence of the feedthrough effect, parasitic resistance and parasitic capacitance in parallel or in series with the capacitor of the MEMS four-mass gyroscope will appear, such as Figure 5 As shown, C x is the capacitance of the MEMS four-mass gyroscope, C p1 , C p2 , C p3 is the parasitic capacitance, R pp , R ps is the parasitic resistance. p1 , C p2 With high frequency carrier voltage source v carrier and a current sensor with low input impedance, thus limiting the current flowing through the gyroscope capacitor C xThe current detection has almost no effect and can be ignored; when the high-frequency carrier signal v used for electromechanical amplitude modulation technology is selected carrier The frequency f carrier When the following conditions are met, the parasitic resistance R pp and R ps The impact on the MEMS four-mass gyroscope is negligible:
[0049]
[0050]
[0051] Therefore, the amplitude modulated signal v obtained by AM modulator 1 is A+ It can be expressed as:
[0052]
[0053] Among them C x0 is the intrinsic capacitance of the positive detection terminal of the MEMS four-mass gyroscope drive mode, ΔC x Because it has an angular frequency ω signal The angular rate causes the change in capacitance of the positive detection terminal of the MEMS four-mass gyroscope driving mode, C f is the feedback capacitance of operational amplifier 1, V carrierc osω carriert is the high-frequency carrier signal applied to the MEMS four-mass gyroscope, V carrier is the voltage amplitude of the high-frequency carrier signal, ω carrier is the angular frequency of the high frequency carrier used, C p3 is the parasitic capacitance caused by the feedthrough effect, and t is the time variable.
[0054] Since the signal at the detection end of the drive axis of the MEMS four-mass gyroscope is modulated to high frequency by a high-frequency carrier, the influence of low-frequency noise on the gyroscope can be effectively suppressed.
[0055] Amplitude modulated signal v A+ is demodulated in AM demodulator 1, which has a diode voltage drop v diode The diode D and the resistor R D , capacitor C D The RC circuit is composed of the AM demodulator 1 time constant R D C D When the following equation is satisfied, the high-frequency carrier signal v carrier is eliminated, and has a frequency f signal The gyroscope signal will be transmitted unaffected:
[0056]
[0057] The change mechanism of the positive signal at the detection end and the negative signal at the detection end of the driving axis of the MEMS four-mass gyroscope through the AM modulator and AM demodulator is consistent.
[0058] After demodulation by AM demodulator 1 and AM demodulator 2, the generated voltage v B+ and v B- for
[0059] v B+ =V A+ -v diode
[0060] v B- =V A- -v diode
[0061] Then, v B+ and v B- The difference between is amplified by an instrumentation amplifier with a gain factor K. The instrumentation amplifier removes the common-mode voltage, such as that caused by two equal parasitic capacitors C p3 and v diode The common mode voltage introduced. The output voltage v out It can be calculated by the following formula
[0062] v out =K(v B+ -v B- )
[0063]
[0064] When R pp >>R ps , R pp '>>R ps ',c p3 =C p3 ',c x0 =C x0 ',ΔC x =ΔC x ',v diode =v diode 'hour
[0065]
[0066] The output signal of the MEMS four-mass gyroscope is independent of parasitic resistance and capacitance, eliminating the influence of feedthrough signal. p3 ≠C p3 ',C x0 ≠C x0 ',ΔC x ≠ΔC x ',v diode ≠vdiode ', the inequality will cause an offset displacement in the expression, but it can be eliminated by setting the offset to zero. The signal detection circuit finally outputs the detection signal v of the MEMS four-mass gyroscope drive axis detection end out The influence of feedthrough effect and low-frequency noise coupling on the performance of MEMS four-mass gyroscope is effectively eliminated.
Claims
1. A MEMS four-mass gyroscope drive circuit system based on electromechanical amplitude modulation technology, characterized in that: include: A signal detection circuit, used for detecting a vibration signal of a resonator of a MEMS four-mass gyroscope by using an electromechanical amplitude modulation technique; An analog-to-digital conversion circuit, used for converting the analog electrical signal obtained by the signal detection circuit into a digital signal; A digital frequency control circuit is used to track the phase and frequency of the driving mode of the MEMS four-mass gyroscope, generate two reference signals, including a frequency stabilization signal and a phase feedback signal, and achieve the stability of the resonant frequency of the resonator driving the MEMS four-mass gyroscope; A digital amplitude control circuit is used to demodulate and filter the drive shaft detection signal output by the analog-to-digital conversion circuit to control the stability of the drive amplitude of the resonator of the MEMS four-mass gyroscope; A multiplier, used to multiply the frequency stabilization signal generated by the digital frequency control circuit with the driving voltage signal generated by the digital amplitude control circuit 4, so as to realize the closed-loop control of the amplitude and frequency stabilization of the driving mode of the MEMS four-mass gyroscope; The digital-to-analog conversion circuit is used to convert the output digital electrical signal into an analog signal and apply it to the driving electrode of the driving mode of the MEMS four-mass gyroscope.
2. The MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology according to claim 1, characterized in that: The signal detection circuit includes a high frequency carrier V carrier , AM modulator 1, AM modulator 2, AM demodulator 1, AM demodulator 2 and instrument amplifier; the high frequency carrier v carrier One end is connected to the ground, and the other end is connected to AM modulator 1 and AM modulator 2; one end of the AM modulator 1 is connected to the high frequency carrier v carrier The other end is connected to the AM demodulator 1; the AM modulator 1 includes a capacitor C x0 +ΔC x , resistor R f , capacitor C f , operational amplifier 1; the capacitor C x0 +ΔC x One end is connected to the high frequency carrier v carrier The other end is connected to the inverting input terminal of the operational amplifier 1; the resistor R f One end is connected to the inverting input terminal of the operational amplifier 1, and the other end is connected to the output terminal of the operational amplifier 1; the capacitor C f One end is connected to the inverting input end of the operational amplifier 1, and the other end is connected to the output end of the operational amplifier 1; the inverting input end of the operational amplifier 1 is connected to the capacitor C x0 +ΔC x connected, the in-phase input end is connected to the ground, and the output end is connected to the AM demodulator 1; one end of the AM modulator 2 is connected to the high frequency carrier v carrier The other end is connected to the AM demodulator 2; the AM modulator 2 includes a capacitor C' x0 -ΔC' x , operational amplifier 2, resistor R' f , Capacitor C' f The capacitor C' x0 -ΔC' x One end is connected to the high frequency carrier v carrier The other end is connected to the inverting input terminal of the operational amplifier 2; the resistor R' f One end is connected to the inverting input terminal of the operational amplifier 2, and the other end is connected to the output terminal of the operational amplifier 2; the capacitor C' f One end is connected to the inverting input end of the operational amplifier 2, and the other end is connected to the output end of the operational amplifier 2; the inverting input end of the operational amplifier 2 is connected to the capacitor C' x0 -ΔC' x The in-phase input end is connected to the ground, and the output end is connected to the AM demodulator 2; one end of the AM demodulator 1 is connected to the AM modulator 1, and the other end is connected to the instrument amplifier; the AM demodulator 1 includes a diode D, a resistor R D , capacitor C D One end of the diode D is connected to the AM modulator 1, and the other end is connected to the instrument amplifier; the resistor R D One end is connected to the diode D, and the other end is connected to the ground; the capacitor C D One end is connected to diode D and the other end is connected to ground; Diode D has a diode voltage drop v diode , resistor R D , capacitor C D The RC circuit is formed, and together with the diode D, the time constant is R D C D The demodulator; one end of the AM demodulator 2 is connected to the AM modulator 2, and the other end is connected to the instrument amplifier; the AM demodulator 2 includes a diode D ', a resistor R ' d , Capacitor C' D The diode D' is connected to the AM modulator 2 at one end and to the instrument amplifier at the other end; the resistor R' D One end is connected to the diode D', and the other end is connected to the ground; the capacitor C' D One end is connected to diode D' and the other end is connected to ground; diode D' has a diode voltage drop v' diode , resistance R' D , Capacitor C' D It forms an RC circuit, and together with the diode D', it forms a time constant of R' D C' D Demodulator; The AM modulator 1 is used to convert the positive detection signal v of the MEMS four-mass gyroscope drive axis x+ With high frequency carrier signal v carrier Amplify and modulate the amplitude to get v A+ The AM modulator 2 is used to detect the negative pole of the MEMS four-mass gyroscope drive axis v x- With high frequency carrier signal v carrier Amplify and modulate the amplitude to get v A- The AM demodulator 1 is used to amplify the amplitude modulated signal v A+ Demodulation gives v B+ , the high-frequency carrier signal is filtered out and the positive detection signal of the driving axis of the MEMS four-mass gyroscope is transmitted unaffected; the AM demodulator 2 is used to amplify the amplitude modulation signal v A- Demodulation gives v B- , filtering out the high-frequency carrier signal and transmitting the negative pole detection signal of the drive shaft of the MEMS four-mass gyroscope without being affected; the instrument amplifier demodulates the v obtained by the AM demodulator 1 B+ and the demodulated v obtained by AM demodulator 2 B- Differential amplification is performed and the common-mode voltage introduced by parasitic capacitance and parasitic resistance of the feedthrough effect is eliminated, and finally the gyroscope drive end detection signal v after signal conditioning is obtained. out .
3. The MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology according to claim 1, characterized in that: The digital frequency control circuit comprises a phase detector, a loop filter, and a digitally controlled oscillator; one end of the phase detector is connected to the drive shaft detection end signal, and the other end is connected to the loop filter; one end of the loop filter is connected to the phase detector, and the other end is connected to the digitally controlled oscillator; one end of the digitally controlled oscillator is connected to the loop filter, and the other end is connected to the frequency stabilization signal; The phase detector detects the phase difference between the voltage signal at the detection end of the drive shaft and the phase feedback signal, and converts the phase difference signal into a voltage signal phase error signal; the loop filter filters the phase error signal, removes high-frequency noise, and obtains a frequency control signal; the numerically controlled oscillator adjusts the frequency and phase of the output stable frequency signal according to the frequency control signal, so that the stable frequency signal gradually synchronizes with the voltage signal at the detection end of the drive shaft, and at the same time outputs a phase feedback signal that is sent back to the phase detector through a feedback loop and compared with the signal at the detection end of the drive shaft, thereby realizing closed-loop control of the gyroscope drive mode frequency.
4. The MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology according to claim 1, characterized in that: The digital amplitude control circuit includes an amplitude detector, an amplitude comparator, a digital PID controller, and a carrier modulator; One end of the amplitude detector is connected to the drive shaft differential detection signal, and the other end is connected to the amplitude comparator; One end of the amplitude comparator is connected to the amplitude detector, and the other end is connected to the digital PID controller; one end of the digital PID controller is connected to the amplitude comparator, and the other end is connected to the carrier modulator; one end of the carrier modulator is connected to the digital PID controller, and the other end is connected to the drive shaft driving voltage signal; The amplitude detector comprises a multiplication demodulator and a low-pass filter, which are used to detect the amplitude of the drive shaft differential detection signal and generate a corresponding amplitude signal; the amplitude comparator is used to compare the amplitude signal output by the amplitude detector with the reference amplitude signal and generate an error signal of the difference between the current amplitude and the reference amplitude; The digital PID controller module calculates the gain value that needs to be adjusted to minimize the error based on the error signal, and converts the error signal of the vibration amplitude into an error control signal; the carrier modulator adjusts the gain of the differential signal at the drive shaft detection end according to the error control signal output by the PID controller and outputs a drive shaft drive voltage signal, and the drive voltage signal is sent back to the drive shaft drive voltage end to realize closed-loop control of the gyroscope drive mode amplitude.
5. The MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology according to claim 1, characterized in that: The digital frequency control circuit, the digital amplitude control circuit and the multiplier are all located in the FPGA digital control system.
6. A method for driving a MEMS four-mass gyroscope based on electromechanical amplitude modulation technology, characterized in that: The MEMS four-mass gyroscope driving circuit system based on electromechanical amplitude modulation technology described in any one of claims 1 to 5 is used to realize the MEMS four-mass gyroscope driving based on electromechanical amplitude modulation technology.
Citation Information
Cited By
Resonance circuit of MEMS gyroscope and MEMS gyroscope
CN119245620A
