High-Q-value small-frequency-difference micromechanical gyroscope detection modal phase calibration compensation method
The phase compensation method for micromechanical gyroscopes with high Q value and small frequency difference addresses detection modal phase inaccuracies by using a specialized system to calculate and adjust phase errors, enhancing precision and stability.
Patent Information
- Application Number
- CN202411180077.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-27
- Publication Date
- 2024-12-06
AI Technical Summary
Existing micromechanical gyroscopes with high Q value and small frequency difference suffer from insufficient detection modal phase accuracy, leading to inaccurate angular velocity demodulation and loss of control due to phase errors and environmental sensitivity.
A phase compensation method involving a phase compensation system with a micromechanical gyroscope, CV module, ADC, OPAs, DAC, and FPGA module, coupled with a turntable setup to calculate and adjust phase errors through differential operations, ensuring accurate demodulation.
Achieves high-precision phase compensation without increasing control circuit complexity, improving the long-term stability and environmental adaptability of micromechanical gyroscopes.
Smart Images

Figure CN119085705A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of gyroscopes, and in particular to a method for calibrating and compensating a detection modal phase of a micromechanical gyroscope with a high Q value and a small frequency difference. Background Art
[0002] Micromechanical gyroscopes have the advantages of small size, low cost, light weight, low power consumption and easy batch manufacturing. They have become the key research direction of inertial devices in the future and can be widely used in aerospace, unmanned systems and intelligent driving. Its main body includes a sensitive mechanical structure for high-frequency vibration and a circuit for signal demodulation and modulation. The sensitive structure of the micromechanical gyroscope is processed by semiconductor silicon technology. There are processing defects in the microstructure, which leads to orthogonal errors between the drive and detection modes, and there is a difference between the natural frequency of the drive mode and the natural frequency of the detection mode, that is, there is a frequency difference. The demodulation phase of the detection mode is related to the gyro frequency difference. Especially for high-Q gyroscopes, when the frequency difference is small to a certain extent, the phase difference will change dramatically. If the phase is not accurately compensated, the orthogonal signal and the force balance signal will be coupled, and the change in the orthogonal signal with environmental changes will also directly affect the force balance channel, thereby reducing the long-term stability and environmental adaptability of the micromechanical gyroscope.
[0003] However, most existing micromechanical gyros use a large frequency difference open-loop working mode, which only considers the phase error in the gyro drive hardware circuit, and the detection mode phase error is roughly estimated by default at -180°. For a small frequency difference gyro, the detection mode phase gradually approaches -90° as the frequency difference changes. The phase error obtained by the above method is not accurate enough and the angular velocity information cannot be accurately demodulated, resulting in gyro out of control. Summary of the invention
[0004] In view of the problems existing in the prior art, the present invention provides a high-Q value and small frequency difference micromechanical gyroscope detection modal phase calibration compensation method to solve the technical problem that the detection modal phase accuracy is insufficient in the prior art and the angular velocity information cannot be accurately demodulated, resulting in gyroscope out of control.
[0005] The present invention provides a high-Q value and small frequency difference micro-mechanical gyroscope detection mode phase calibration compensation method, comprising:
[0006] S1. Construct a phase compensation system, which at least includes a micromechanical gyroscope, a CV module, an ADC, two OPAs, a DAC and an FPGA module, wherein the output end of the FPGA module is connected to the input end of the DAC, the output end of the DAC is connected to the input end of any of the OPAs, the output end of any of the OPAs is connected to the input end of the micromechanical gyroscope, the output end of the micromechanical gyroscope is connected to the input end of the CV module, the output end of the CV module is connected to the input end of another of the OPAs, the output end of another of the OPAs is connected to the input end of the ADC, and the output end of the ADC is connected to the input end of the FPGA module;
[0007] S2, placing the micromechanical gyroscope on a turntable and fixing the micromechanical gyroscope, wherein the sensitive axis of the micromechanical gyroscope is perpendicular to the plane of the turntable;
[0008] S3, given a first fixed angular velocity of the micromechanical gyroscope, collecting fixed time after the micromechanical gyroscope rotates, and calculating the first output average value of the orthogonal channel and the first output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively;
[0009] S4, given a second fixed angular velocity of the micromechanical gyroscope, collecting fixed time after the micromechanical gyroscope rotates, and calculating the second output average value of the orthogonal channel and the second output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively;
[0010] S5, respectively performing differential operations on the first output average value and the second output average value of the orthogonal channel, and the first output average value and the second output average value of the force balance channel, calculating a phase error based on the differential operation results, and compensating the phase error to the demodulation phase of the detection mode;
[0011] S6. Rotate the micromechanical gyroscope again to determine the value of the orthogonal output before and after the rotation. If there is a change, it means that the detection mode phase compensation is not in place, otherwise it means that the detection mode phase compensation is in place.
[0012] Optionally, the FPGA module at least includes:
[0013] Control unit, NCO unit, phase compensator, multiplication demodulator, two LPFs, two PI controllers, integrated modulator, DAC driver;
[0014] The output end of the control unit is respectively connected to the input end of the NCO unit and the two PI controllers. The NCO unit is used to generate a sinusoidal signal, and its output end is connected to the input end of the phase compensator. The phase compensator is used to implement a phase shift function for the sinusoidal signal. The output end of the control unit is connected to the multiplication demodulator. The input end of the multiplication demodulator is connected to the output end of the ADC. The multiplication demodulator is used to separate the I-channel and Q-channel signals of the ADC data. The output end of the control unit is respectively connected to the input ends of the two LPFs. The LPFs are used to implement filtering of the I-channel and Q-channel signals respectively. The output end of any LPF is connected to the input end of any PI controller. The input end of the LPF forms a force balance channel, the output end of another LPF is connected to the input end of another PI controller to form an orthogonal channel, the PI controller is used to realize the loop calculation of the size of the orthogonal and force balance signals, the output ends of any one of the PI controllers and the other PI controller are respectively connected to the input end of the integrated modulator and the input end of the control unit, the integrated modulator is used to realize the mixed modulation of the orthogonal and force balance signals, and its output end is connected to the input end of the DAC driver, the DAC driver is used to control the DAC to generate a sinusoidal signal corresponding to the mixed modulation, and the output end of the DAC driver is connected to the input end of the DAC.
[0015] Optionally, the first fixed angular velocity of the micromechanical gyroscope is given, a fixed time is collected after the micromechanical gyroscope rotates, and a first output average value of a orthogonal channel and a first output average value of a force balance channel in a detection mode of the micromechanical gyroscope are respectively calculated, including:
[0016]
[0017] Among them, V Ω1 Represents the average value of the first output of the force balance channel, V q1 Represents the average value of the first output of the orthogonal channel, A I Represents the signal amplitude in phase with the angular velocity, A q represents the signal amplitude that is in phase with the angular velocity, is the structural phase of the micromechanical gyroscope.
[0018] Optionally, the second fixed angular velocity of the micromechanical gyroscope is given, a fixed time is collected after the micromechanical gyroscope rotates, and a second output average value of the orthogonal channel and a second output average value of the force balance channel in the detection mode of the micromechanical gyroscope are respectively calculated, including:
[0019]
[0020] Among them, V Ω2 Represents the average value of the first output of the force balance channel, V q2 Represents the average value of the first output of the orthogonal channel.
[0021] Optionally, performing differential operations on the first output average value and the second output average value of the orthogonal channel, and the first output average value and the second output average value of the force balance channel, respectively, calculating a phase error based on the differential operation results, and compensating the phase error to a demodulation phase of the detection mode, comprises:
[0022] The difference operation is expressed as:
[0023]
[0024] The phase error is expressed as:
[0025]
[0026] The phase error value Set to the phase compensator.
[0027] Optionally, the fixed acquisition time includes:
[0028] The fixed acquisition time is set to 10S.
[0029] Compared with the existing detection technology, the present invention has the following beneficial effects:
[0030] The present invention controls the micromechanical gyroscope to rotate twice through a phase compensation system, calculates the phase error of the micromechanical gyroscope detection mode, and realizes high-precision phase compensation without increasing the complexity of the control circuit. The method has high phase compensation accuracy at the micromechanical gyroscope detection end, is easy to operate, and has simple circuit implementation. BRIEF DESCRIPTION OF THE DRAWINGS
[0031] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the invention and, together with the description, serve to explain the principles of the invention.
[0032] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.
[0033] Figure 1 It is a schematic diagram of the method flow of the present invention;
[0034] Figure 2 A schematic diagram of the relationship between the phase error and the frequency difference of the high-Q value and small frequency difference gyro detection end in the present invention;
[0035] Figure 3 is a logical schematic diagram of the phase compensation system in the present invention;
[0036] Figure 4 It is a logic schematic diagram of the FPGA module in the present invention;
[0037] Figure 5 It is a schematic diagram of the principle of the phase error compensation step in the present invention. DETAILED DESCRIPTION
[0038] In order to make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in the present application, all other implementation cases obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application. The functional units with the same labels in the examples of the present invention have the same and similar structures and functions.
[0039] See also Figure 1 The present invention provides a high-Q value and small frequency difference micro-mechanical gyroscope detection mode phase calibration compensation method, comprising:
[0040] S1. Construct a phase compensation system, which at least includes a micromechanical gyroscope, a CV module, an ADC, two OPAs, a DAC and an FPGA module, wherein the output end of the FPGA module is connected to the input end of the DAC, the output end of the DAC is connected to the input end of any of the OPAs, the output end of any of the OPAs is connected to the input end of the micromechanical gyroscope, the output end of the micromechanical gyroscope is connected to the input end of the CV module, the output end of the CV module is connected to the input end of another of the OPAs, the output end of another of the OPAs is connected to the input end of the ADC, and the output end of the ADC is connected to the input end of the FPGA module;
[0041] S2, placing the micromechanical gyroscope on a turntable and fixing the micromechanical gyroscope, wherein the sensitive axis of the micromechanical gyroscope is perpendicular to the plane of the turntable;
[0042] S3, given a first fixed angular velocity of the micromechanical gyroscope, collecting fixed time after the micromechanical gyroscope rotates, and calculating the first output average value of the orthogonal channel and the first output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively;
[0043] S4, given a second fixed angular velocity of the micromechanical gyroscope, collecting fixed time after the micromechanical gyroscope rotates, and calculating the second output average value of the orthogonal channel and the second output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively;
[0044] S5, respectively performing differential operations on the first output average value and the second output average value of the orthogonal channel, and the first output average value and the second output average value of the force balance channel, calculating a phase error based on the differential operation results, and compensating the phase error to the demodulation phase of the detection mode;
[0045] S6. Rotate the micromechanical gyroscope again to determine the value of the orthogonal output before and after the rotation. If there is a change, it means that the detection mode phase compensation is not in place, otherwise it means that the detection mode phase compensation is in place.
[0046] See also Figure 2 For a micromechanical gyroscope with a Q value of 50,000, the phase difference φy at the detection end changes with the frequency difference Δf. When the frequency difference is large (≥0.5Hz), the phase is close to 0° or -180°. When the frequency difference is further reduced, the phase difference changes more dramatically. For a gyroscope close to mode matching, it is still calculated according to the phase difference of 0° or -180° of the large frequency difference gyroscope, which will bring a large solution error and even cause the gyroscope to lose control.
[0047] See also Figure 3 and Figure 4 In this embodiment, S1, a phase compensation system is constructed, which at least includes a micromechanical gyroscope, a CV module, an ADC, two OPAs, a DAC and an FPGA module. The output end of the FPGA module is connected to the input end of the DAC, the output end of the DAC is connected to the input end of any one of the OPAs, the output end of any one of the OPAs is connected to the input end of the micromechanical gyroscope, the output end of the micromechanical gyroscope is connected to the input end of the CV module, the output end of the CV module is connected to the input end of another one of the OPAs, the output end of the other one of the OPAs is connected to the input end of the ADC, and the output end of the ADC is connected to the input end of the FPGA module. Since the signal analysis process covers every device to which the signal flows, one phase is generally used to compensate for the phase delay of the entire loop.
[0048] The FPGA module at least includes:
[0049] Control unit, NCO unit, phase compensator, multiplication demodulator, two LPFs, two PI controllers, integrated modulator, DAC driver;
[0050] The output end of the control unit is respectively connected to the input end of the NCO unit and the two PI controllers. The NCO unit is used to generate a sinusoidal signal, and its output end is connected to the input end of the phase compensator. The phase compensator is used to implement a phase shift function for the sinusoidal signal. The output end of the control unit is connected to the multiplication demodulator. The input end of the multiplication demodulator is connected to the output end of the ADC. The multiplication demodulator is used to separate the I-channel and Q-channel signals of the ADC data. The output end of the control unit is respectively connected to the input ends of the two LPFs. The LPFs are used to implement filtering of the I-channel and Q-channel signals respectively. The output end of any LPF is connected to the input end of any PI controller to form a force balance channel. The output end of the other LPF is connected to the input end of another PI controller. The input end of the controller forms an orthogonal channel, the PI controller is used to realize the loop calculation of the size of the orthogonal and force balance signals, the output ends of any one of the PI controllers and the other PI controller are respectively connected to the input end of the integrated modulator and the input end of the control unit, the integrated modulator is used to realize the mixed modulation of the orthogonal and force balance signals, and its output end is connected to the input end of the DAC driver, the DAC driver is used to control the DAC to generate a sinusoidal signal corresponding to the mixed modulation, the output end of the DAC driver is connected to the input end of the DAC to realize the closed-loop function of the detection mode, the control unit can adopt a 422 driver, and the control unit mainly realizes the data interaction between the FPGA module and the host computer.
[0051] In this scheme, the micromechanical gyroscope adopts a phase-sensitive demodulation method. By adjusting the phase value of a given demodulated signal, on the one hand, the amplitude and phase of the driving signal are obtained, which are used for the amplitude driving loop and the PLL phase locking loop respectively; on the other hand, the orthogonal signal size and angular velocity size in the detection mode are obtained, and the detection mode amplitude is controlled near 0 in real time through modules such as a PI controller to realize a detection closed loop.
[0052] In another embodiment, see Figure 5 , taking the control signal output by the NCO module of the digital circuit FPGA device as the reference, after passing through the DAC, the phase of the voltage signal applied to the gyro electrode is For the drive side, Figure 5 As shown in the green loop, after the signal passes through the front-end CV amplifier circuit and ADC, the total phase shift of the signal includes the phase shift of the DAC, gyro mechanical structure, CV circuit, and ADC, that is, the phase change is in Similarly, for the detection end, Figure 5 As shown in the red loop, after the signal passes through the front-end CV amplifier circuit, the phase change is
[0053] The excitation signal of the driving mode is Then, the resulting driving mode vibration displacement is According to the Coriolis effect, the in-phase coupling force FI and the Coriolis force FΩ generated by the detection mode are related to the vibration velocity, and the orthogonal force is related to the vibration displacement x, which can be expressed as
[0054]
[0055] In the above formula, AΩ=-mωdΩ Coriolis force amplitude, AI=-cyxmωdt in-phase coupling force amplitude, Aq=-kyxAx. Kyx represents the coupling stiffness coefficient, cyx represents the damping coefficient, and the detection modal displacement y caused by the orthogonal force and the in-phase force is:
[0056]
[0057] In the above formula, Ays is the detection modal gain, is the phase shift of the detection mode. When the resonant frequencies of the detection mode and the driving mode are equal, Ays is the maximum, and
[0058] However, in the dual-path FTR closed-loop detection, the detection mode is kept relatively static through the feedback force, making the detection output It is insensitive to changes in and Ays, effectively reducing the impact of environmental parameters on zero bias and scale factor.
[0059] The digital feedback signal generated by FTR control in FPGA is VΩcos(ωdt)+Vqsin(ωdt), where VΩ and Vq are the amplitudes of the in-phase and quadrature feedback signals, respectively. The analog feedback signal after DA conversion is:
[0060]
[0061] According to the FTR principle, in an ideal state, when the system is in a steady state, the detection mode is stationary, and the resultant force input to the detection mode is 0, that is:
[0062] F Ω+I +F q -V balance K vf =0
[0063] When testing dual feedback closed-loop control, the orthogonal and force balance voltages satisfy:
[0064]
[0065] In order to eliminate the interference of AI on phase calculation, a differential method is used here to calculate the detection phase. By inputting different angular rates Ω, the AΩ value changes, while AI and Aq do not change.
[0066] S2. placing the micromechanical gyroscope on a turntable and fixing the micromechanical gyroscope so that the sensitive axis of the micromechanical gyroscope is perpendicular to the plane of the turntable.
[0067] S3, given a first fixed angular velocity of the micromechanical gyroscope, collecting fixed time after the micromechanical gyroscope rotates, and calculating the first output average value of the orthogonal channel and the first output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively:
[0068]
[0069] Among them, V Ω1 Represents the average value of the first output of the force balance channel, V q1 Represents the average value of the first output of the orthogonal channel, A I Represents the signal amplitude in phase with the angular velocity, A q represents the signal amplitude that is in phase with the angular velocity, is the structural phase of the micromechanical gyroscope.
[0070] S4, given the second fixed angular velocity of the micromechanical gyroscope, the micromechanical gyroscope collects fixed time after rotation, and calculates the second output average value of the orthogonal channel and the second output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively:
[0071]
[0072] Among them, V Ω2 Represents the average value of the first output of the force balance channel, V q2 Represents the average value of the first output of the orthogonal channel.
[0073] S5, respectively performing differential operations on the first output average value and the second output average value of the orthogonal channel, and the first output average value and the second output average value of the force balance channel, calculating a phase error based on the differential operation results, and compensating the phase error to the demodulation phase of the detection mode:
[0074] The difference operation is expressed as:
[0075]
[0076] The phase error is expressed as:
[0077]
[0078] The phase error value Set to the phase compensator.
[0079] S6. Rotate the micromechanical gyroscope again to determine the value of the orthogonal output before and after the rotation. If there is a change, it means that the detection mode phase compensation is not in place, otherwise it means that the detection mode phase compensation is in place.
[0080] The output value of the orthogonal channel before and after the rotation is judged. If there is a change, it means that the detection mode phase compensation is not in place, otherwise it means that the detection mode phase compensation is in place. The present invention controls the micromechanical gyroscope to rotate twice through the phase compensation system, calculates the phase error of the micromechanical gyroscope detection mode, and realizes high-precision phase compensation without increasing the complexity of the control circuit. The method has high precision of phase compensation at the detection end of the micromechanical gyroscope, is easy to operate, and has simple circuit implementation.
[0081] It should be noted that, in this article, relational terms such as "first" and "second" are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.
[0082] The foregoing is merely a specific embodiment of the present invention, which enables those skilled in the art to understand or implement the present invention. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features claimed herein.
Claims
1. A method for calibrating and compensating the detection modal phase of a micromechanical gyroscope with a high Q value and a small frequency difference, characterized in that: include: S1. Construct a phase compensation system, which at least includes a micromechanical gyroscope, a CV module, an ADC, two OPAs, a DAC and an FPGA module, wherein the output end of the FPGA module is connected to the input end of the DAC, the output end of the DAC is connected to the input end of any of the OPAs, the output end of any of the OPAs is connected to the input end of the micromechanical gyroscope, the output end of the micromechanical gyroscope is connected to the input end of the CV module, the output end of the CV module is connected to the input end of another of the OPAs, the output end of another of the OPAs is connected to the input end of the ADC, and the output end of the ADC is connected to the input end of the FPGA module; S2, placing the micromechanical gyroscope on a turntable and fixing the micromechanical gyroscope, wherein the sensitive axis of the micromechanical gyroscope is perpendicular to the plane of the turntable; S3, given a first fixed angular velocity of the micromechanical gyroscope, collecting fixed time after the micromechanical gyroscope rotates, and calculating the first output average value of the orthogonal channel and the first output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively; S4, given a second fixed angular velocity of the micromechanical gyroscope, collecting fixed time after the micromechanical gyroscope rotates, and calculating the second output average value of the orthogonal channel and the second output average value of the force balance channel in the detection mode of the micromechanical gyroscope respectively; S5, respectively performing differential operations on the first output average value and the second output average value of the orthogonal channel, and the first output average value and the second output average value of the force balance channel, calculating a phase error based on the differential operation results, and compensating the phase error to the demodulation phase of the detection mode; S6. Rotate the micromechanical gyroscope again to determine the value of the orthogonal output before and after the rotation. If there is a change, it means that the detection mode phase compensation is not in place, otherwise it means that the detection mode phase compensation is in place.
2. The high-Q value and small frequency difference micro-machined gyroscope detection mode phase calibration compensation method according to claim 1, characterized in that: The FPGA module at least includes: Control unit, NCO unit, phase compensator, multiplication demodulator, two LPFs, two PI controllers, integrated modulator, DAC driver; The output end of the control unit is respectively connected to the input end of the NCO unit and the two PI controllers. The NCO unit is used to generate a sinusoidal signal, and its output end is connected to the input end of the phase compensator. The phase compensator is used to implement a phase shift function for the sinusoidal signal. The output end of the control unit is connected to the multiplication demodulator. The input end of the multiplication demodulator is connected to the output end of the ADC. The multiplication demodulator is used to separate the I-channel and Q-channel signals of the ADC data. The output end of the control unit is respectively connected to the input ends of the two LPFs. The LPFs are used to implement filtering of the I-channel and Q-channel signals respectively. The output end of any LPF is connected to the input end of any PI controller. The input end of the LPF forms a force balance channel, the output end of another LPF is connected to the input end of another PI controller to form an orthogonal channel, the PI controller is used to realize the loop calculation of the size of the orthogonal and force balance signals, the output ends of any one of the PI controllers and the other PI controller are respectively connected to the input end of the integrated modulator and the input end of the control unit, the integrated modulator is used to realize the mixed modulation of the orthogonal and force balance signals, and its output end is connected to the input end of the DAC driver, the DAC driver is used to control the DAC to generate a sinusoidal signal corresponding to the mixed modulation, and the output end of the DAC driver is connected to the input end of the DAC.
3. The high-Q value and small frequency difference micro-machined gyroscope detection mode phase calibration compensation method as claimed in claim 2, characterized in that: The first fixed angular velocity of the micromechanical gyroscope is given, a fixed time is collected after the micromechanical gyroscope rotates, and a first output average value of the orthogonal channel and a first output average value of the force balance channel in the detection mode of the micromechanical gyroscope are respectively calculated, including: Among them, V Ω1 Represents the average value of the first output of the force balance channel, V q1 Represents the average value of the first output of the orthogonal channel, A I Represents the signal amplitude in phase with the angular velocity, A q represents the signal amplitude that is in phase with the angular velocity, is the structural phase of the micromechanical gyroscope.
4. The method for calibrating and compensating the detection modal phase of a micromechanical gyroscope with a high Q value and a small frequency difference as claimed in claim 3, characterized in that: The second fixed angular velocity of the micromechanical gyroscope is given, a fixed time is collected after the micromechanical gyroscope rotates, and a second output average value of the orthogonal channel and a second output average value of the force balance channel in the detection mode of the micromechanical gyroscope are respectively calculated, including: Among them, V Ω2 Represents the average value of the first output of the force balance channel, V q2 Represents the average value of the first output of the orthogonal channel.
5. The method for calibrating and compensating the detection modal phase of a micromechanical gyroscope with a high Q value and a small frequency difference according to claim 4, characterized in that: The method comprises: performing differential operations on the first output average value and the second output average value of the orthogonal channel, the first output average value and the second output average value of the force balance channel, calculating a phase error based on the differential operation results, and compensating the phase error to the demodulation phase of the detection mode, including: The difference operation is expressed as: The phase error is expressed as: The phase error value Set to the phase compensator.
6. The method for calibrating and compensating the detection modal phase of a micromechanical gyroscope with a high Q value and a small frequency difference according to claim 1, characterized in that: The fixed acquisition time includes: The fixed acquisition time is set to 10S.
