Resonant gyro measurement and control system based on circuit time-division multiplexing
By adopting a new time-sharing multiplexing architecture and frequency multiplication parameter excitation method in the resonant gyroscope measurement and control system, the problem of insufficient measurement and control performance in traditional systems is solved, driving and detection efficiency and signal-to-noise ratio are improved, crosstalk is avoided, and crosstalk is achieved More efficient measurement and control performance.
Patent Information
- Application Number
- CN202410984933.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-07-22
AI Technical Summary
The resonant gyroscope measurement and control system with time-sharing multiplexing of traditional circuits has the problem of insufficient measurement and control performance, especially in terms of driving and detection efficiency and signal-to-noise ratio, and it is difficult to effectively avoid crosstalk of control signals to detect.
A resonant gyro measurement and control system based on circuit time-sharing multiplexing is designed, and a new time-sharing multiplexing architecture is adopted to control the time-sharing switching connection detection and driving circuit of X-mode and Y-mode differential electrodes through switching circuits, and signal reconstruction is carried out. The module reconstructs the time-sharing discontinuous signal. The gyro control module generates a control force signal based on the reconstruction signal, and drives the electrodes through the frequency multiplication parameter excitation method to achieve closed-loop control.
It effectively reduces circuit inconsistent errors, improves driving and detection efficiency and signal-to-noise ratio, avoids crosstalk between control signals and detection, and achieves improvement in resonant gyroscope measurement and control performance.
Smart Images

Figure CN118518087B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of resonant gyroscopes, and in particular relates to a resonant gyroscope measurement and control system based on circuit time-division multiplexing. Background Art
[0002] Resonant gyroscopes, such as hemispherical gyroscopes, have an important position and broad application prospects. When a resonant gyroscope is working, it is necessary to detect and drive two modes (X mode and Y mode). In the traditional drive detection method, the X mode and the Y mode each use a set of detection and drive circuits. However, there are problems of inconsistent circuit gain and phase shift between the two sets of drive circuits and detection circuits, and the baseband drive method used will inevitably produce crosstalk when the detection is carried out at the same time. These problems seriously restrict the performance of the gyroscope.
[0003] The control method of circuit time-sharing multiplexing can make the X mode and Y mode share the same set of detection and drive circuits through time-sharing switching to reduce inconsistency errors, such as the single-channel control system and method of the full-angle hemispherical resonant gyroscope, which converts the control of the gyroscope from dual channels to single channels. Under this time-sharing scheme, the drive and detection of the single mode occupies one quarter of each time-sharing cycle. When the time-sharing sequence is designed to multiplex the detection and drive of the electrodes, and the detection stage of the single mode occupies one-half of each time-sharing cycle to improve efficiency, the problem of drive-to-detection crosstalk is inevitable, such as the hemispherical resonant gyroscope excitation detection method and system, which uses the superposition of carrier signals on the detection to avoid crosstalk.
[0004] When the circuit time-division multiplexing control method is adopted, the single-mode detection signal will be discontinuous, which has a negative impact on signal demodulation and information extraction. For example, the variable-period time-division demodulation and control method for the hemispherical resonant gyroscope keeps the time-division period the same as the gyroscope resonance period so that the segmented signal is closer to a continuous signal after splicing. However, in the process of implementing the present invention, the above-mentioned traditional technology still has the technical problem of insufficient measurement and control performance when facing the limitations of the circuit time-division multiplexing control method. Summary of the invention
[0005] Based on this, it is necessary to provide a resonant gyroscope measurement and control system based on circuit time-sharing multiplexing to address the above technical problems, which can effectively improve the measurement and control performance of the resonant gyroscope.
[0006] In order to achieve the above objectives, the embodiments of the present invention adopt the following technical solutions:
[0007] Provided is a resonant gyro measurement and control system based on circuit time-sharing multiplexing, comprising a switch circuit, a detection circuit, a signal reconstruction module, a reconstructor, a gyro control module, a drive circuit and a time-sharing generation module, wherein the switch circuit is respectively connected to the detection circuit, the drive circuit and the time-sharing generation module, the detection circuit is respectively connected to the signal reconstruction module and the reconstructor, the signal reconstruction module is respectively connected to the reconstructor and the gyro control module, and the gyro control module is connected to the drive circuit;
[0008] The time-sharing generation module is used to output a switch control signal to the switch circuit according to the time-sharing timing sequence, and the switch circuit is used to switch and connect the X-mode differential electrode and the Y-mode differential electrode of the resonant gyroscope to the detection circuit and the drive circuit in a time-sharing manner under the action of the switch control signal, so that in one time-sharing half cycle, the X-mode differential electrode is connected to the detection circuit, and the Y-mode differential electrode is connected to the drive circuit, and in another time-sharing half cycle, the Y-mode differential electrode is connected to the detection circuit, and the X-mode differential electrode is connected to the drive circuit;
[0009] The detection circuit is used to detect the output of the X-mode differential electrode and the Y-mode differential electrode in a time-sharing manner. The signal reconstruction module is used to generate a reconstruction signal according to the reconstruction algorithm and the output. The reconstructor is used to modulate the reconstruction signal according to the switch control signal and output it to the detection circuit to complete the reconstruction of the time-sharing discontinuous signal. The gyro control module is used to generate a control force signal by using a frequency doubling parameter excitation method according to the gyro displacement information in the reconstructed signal. The drive circuit is used to apply the control force signal to the X-mode differential electrode and the Y-mode differential electrode through the switch circuit in a time-sharing manner.
[0010] In one embodiment, the signal reconstruction module reconstructs the four components of sine, cosine, offset and slope in the output by reconstructing the baseband signal, and converts the output into a continuous reconstructed signal.
[0011] In one embodiment, the detection circuit includes an inverter, a resistor R1, a resistor R2, a differential capacitor voltage conversion circuit and an analog-to-digital converter AD;
[0012] The input end of the inverter and one end of the resistor R1 are both connected to the output end of the reconstructor, the output end of the inverter is connected to one end of the resistor R2, the other end of the resistor R1 is connected to the first inverting input end of the differential capacitor voltage conversion circuit, the other end of the resistor R2 is connected to the second inverting input end of the differential capacitor voltage conversion circuit, the output end of the differential capacitor voltage conversion circuit is connected to the input end of the signal reconstruction module through the analog-to-digital converter AD, and the two inverting input ends of the differential capacitor voltage conversion circuit are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit.
[0013] In one embodiment, the detection circuit includes a differential capacitance voltage conversion circuit, a proportional subtractor and an analog-to-digital converter AD;
[0014] The two inverting input terminals of the differential capacitance voltage conversion circuit are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode in time-sharing through the switching circuit, the output terminal of the differential capacitance voltage conversion circuit is connected to the non-phase input terminal of the proportional subtractor, the inverting input terminal of the proportional subtractor is connected to the output terminal of the reconstructor, and the output terminal of the proportional subtractor is connected to the input terminal of the signal reconstruction module through the analog-to-digital converter AD.
[0015] In one embodiment, the detection circuit includes a differential capacitance voltage conversion circuit, a carrier demodulation module, a proportional subtractor and an analog-to-digital converter AD;
[0016] The two inverting input terminals of the differential capacitance voltage conversion circuit are respectively used to connect to the X-mode differential electrode or the Y-mode differential electrode through the switching circuit, the output terminal of the differential capacitance voltage conversion circuit is connected to the non-phase input terminal of the proportional subtractor through the carrier demodulation module, the inverting input terminal of the proportional subtractor is connected to the output terminal of the reconstructor, the output terminal of the proportional subtractor is connected to the input terminal of the signal reconstruction module through the analog-to-digital converter AD, and the reference input terminal of the carrier demodulation module is used to connect the high-frequency carrier voltage.
[0017] In one of the embodiments, the frequency-doubled parameter excitation method includes generating a control force signal using a doubled frequency parameter excitation voltage according to gyro displacement information in the reconstructed signal;
[0018] The switch circuit is composed of two pairs of cross switches, and the driving circuit includes a digital-to-analog converter DA and an amplifier K connected in series. The input end of the digital-to-analog converter DA is connected to the output end of the gyro control module, and the output end of the amplifier K is connected to the driving input ends of the two pairs of cross switches. The detection output ends of the two pairs of cross switches are respectively connected to the input ends of the detection circuit, and the other two ends of the two pairs of cross switches are respectively used to connect the X-mode differential electrode and the Y-mode differential electrode.
[0019] In one of the embodiments, the frequency-doubled parameter excitation method includes generating a control force signal using a doubled frequency parameter excitation voltage and a base frequency excitation voltage according to the gyro displacement information in the reconstructed signal;
[0020] The driving circuit includes a digital-to-analog converter DA1, a digital-to-analog converter DA2, an amplifier K1, an amplifier K2, a first adder and a second adder, and the switch circuit is composed of two pairs of cross switches;
[0021] The input end of the digital-to-analog converter DA1 is used to access the double frequency parameter excitation voltage, the input end of the digital-to-analog converter DA2 is used to access the baseband excitation voltage, the output end of the digital-to-analog converter DA1 is connected to the input ends of the first adder and the second adder respectively through the amplifier K1, the output end of the digital-to-analog converter DA2 is connected to the input ends of the first adder and the second adder respectively through the amplifier K2, the output ends of the first adder and the second adder are respectively connected to the driving input ends of two pairs of cross switches, the detection output ends of the two pairs of cross switches are respectively connected to the input ends of the detection circuit, and the other two ends of the two pairs of cross switches are respectively used to connect the X-mode differential electrode and the Y-mode differential electrode.
[0022] In one of the embodiments, the frequency-doubling parameter excitation method includes generating a control force signal using a triple frequency parameter excitation voltage and a base frequency excitation voltage according to the gyro displacement information in the reconstructed signal;
[0023] The driving circuit includes a digital-to-analog converter DA, an amplifier K and an inverter, and the switching circuit consists of two pairs of cross switches;
[0024] The input end of the digital-to-analog converter DA is used to access the excitation voltage obtained by adding the triple frequency parameter excitation voltage and the base frequency excitation voltage. The output end of the digital-to-analog converter DA is connected to the input end of the amplifier K. The output end of the amplifier K is connected to the driving input end of a pair of cross switches. The output end of the amplifier K is also connected to the input end of the inverter. The output end of the inverter is connected to the driving input end of another pair of cross switches. The detection output ends of the two pairs of cross switches are respectively connected to the input end of the detection circuit. The other two ends of the two pairs of cross switches are respectively used to connect to the X-mode differential electrode or the Y-mode differential electrode.
[0025] One of the above technical solutions has the following advantages and beneficial effects:
[0026] The above-mentioned resonant gyro measurement and control system based on circuit time-division multiplexing has designed a new time-division multiplexing architecture. The switch circuit controls the X-mode differential electrode and the Y-mode differential electrode of the resonant gyro to be connected to the detection circuit and the drive circuit in a time-division manner. The output end of the detection circuit is connected to the input end of the signal reconstruction module to reconstruct the time-division discontinuous signal. The output end of the signal reconstruction module is connected to the input end of the reconstructor. The reconstructor outputs the reconstructed signal modulated by the switch control signal to the detection circuit. In addition, the signal reconstruction module also outputs the reconstructed signal to the gyro control module. The gyro control module controls it according to the gyro displacement information in the reconstructed signal, and outputs the control force signal to the drive circuit to realize the closed-loop control of the gyro. The time-division generation module will output the switch control signal of the corresponding switch circuit according to the designed time-division timing sequence, which is used to control the switching of the switch circuit, so that the electrodes of the gyro are driven and detected in a time-division manner according to the set timing sequence. Compared with traditional technologies, the new time-sharing multiplexing architecture adopts a binary time-sharing timing, so that the detection and drive of the two modes share a set of circuits, which can effectively reduce circuit inconsistency errors. Compared with the four-state time-sharing timing, it can improve the efficiency and signal-to-noise ratio of drive and detection. The detection method adopts baseband signal reconstruction, and the drive method adopts frequency doubling parameter excitation, which effectively avoids crosstalk of control signals on detection, and realizes the restoration and extraction of discontinuous detection signals, thereby effectively improving the measurement and control performance of the resonant gyroscope. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] In order to more clearly illustrate the technical solutions in the embodiments of the present application or the conventional technology, the drawings required for use in the embodiments or the conventional technology descriptions are briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0028] Figure 1 is a schematic diagram of a resonant gyro electrode;
[0029] Figure 2 A schematic diagram of the module structure of a resonant gyro measurement and control system based on circuit time-division multiplexing in one embodiment;
[0030] Figure 3 is a schematic diagram of a time-sharing sequence in one embodiment;
[0031] Figure 4 A schematic diagram of a partial circuit of a resonant gyro measurement and control system based on circuit time-division multiplexing in one embodiment;
[0032] Figure 5Schematic diagram of the process of generating a reconstructed signal in one embodiment, wherein (a) represents the reconstructed signals of the X mode and the Y mode respectively generated by the reconstruction algorithm in the signal reconstruction module, and (b) represents the signal output by the reconstructor;
[0033] Figure 6 A schematic diagram of a detection circuit structure used in a resonant gyro measurement and control system based on circuit time-division multiplexing in one embodiment;
[0034] Figure 7 It is a schematic diagram of another detection circuit structure adopted by a resonant gyro measurement and control system based on circuit time-division multiplexing in one embodiment;
[0035] Figure 8 A schematic diagram of another detection circuit structure used in a resonant gyro measurement and control system based on circuit time-division multiplexing in one embodiment;
[0036] Fig. 9 Schematic diagram of a driving method of a resonant gyroscope in an embodiment, wherein (a) is a driving circuit, and (b) is a driving method;
[0037] Fig.10 Schematic diagram of a driving method of a resonant gyroscope in another embodiment, wherein (a) is a driving circuit, and (b) is a driving method;
[0038] Fig.11 Schematic diagram of a driving method of a resonant gyroscope in another embodiment, wherein (a) is a driving circuit and (b) is a driving method. DETAILED DESCRIPTION
[0039] In order to make the purpose, technical scheme and advantages of the present application clearer, the present application is further described in detail below in conjunction with the accompanying drawings and Examples. It should be understood that the specific embodiments described herein are only used to explain the present application and are not intended to limit the present application. Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art of the present application. The terms used in the specification of the present application are only for the purpose of describing specific embodiments and are not intended to limit the present application.
[0040] It should be noted that the reference to "embodiment" in this document means that the specific features, structures or characteristics described in conjunction with the embodiment may be included in at least one embodiment of the present invention. The presentation of the phrase at various locations in the specification does not necessarily refer to the same embodiment, nor is it an independent or alternative embodiment that is mutually exclusive with other embodiments.
[0041] In the process of realizing the present invention, it is found that the traditional full-angle hemispherical resonant gyroscope single-channel control system and method convert the control of the gyroscope from dual channels to single channels, but the electrodes are not differentiated and multiplexed during driving and detection, and the detection and driving of the single mode only account for one quarter of each time-sharing period, which significantly affects the driving, detection efficiency and signal-to-noise ratio. The traditional hemispherical resonant gyroscope excitation detection method and system utilizes the superposition of carrier signals on the detection to avoid crosstalk, but it is inevitable to increase the additional software and hardware costs to realize the generation, modulation and demodulation of the carrier. The traditional variable period time-sharing demodulation and control method for the hemispherical resonant gyroscope keeps the time-sharing period the same as the gyroscope resonance period so that the segmented signal is closer to the continuous signal after splicing, but the time-sharing period will change with the resonant frequency disturbance, bringing additional instability to the control. This makes it still impossible to truly and effectively take into account the driving, detection efficiency and signal-to-noise ratio in practical applications, avoid the crosstalk of the control signal to the detection, and realize the restoration and extraction of the discontinuous detection signal, facing the technical problem of insufficient measurement and control performance.
[0042] The following will describe the implementation of the present invention in detail with reference to the accompanying drawings in the embodiment diagram of the present invention.
[0043] The resonant gyro electrodes can be Figure 1 As shown, the 0° and 90° electrodes constitute the X-mode differential electrodes, and the 45° and 135° electrodes constitute the Y-mode differential electrodes.
[0044] In one embodiment, Figure 2 As shown, a resonant gyro measurement and control system 100 based on circuit time-sharing multiplexing is provided, including a switch circuit 11, a detection circuit 12, a signal reconstruction module 13, a reconstructor 14, a gyro control module 15, a drive circuit 16 and a time-sharing generation module 17. The switch circuit 11 is respectively connected to the detection circuit 12, the drive circuit 16 and the time-sharing generation module 17. The detection circuit 12 is respectively connected to the signal reconstruction module 13 and the reconstructor 14. The signal reconstruction module 13 is respectively connected to the reconstructor 14 and the gyro control module 15. The gyro control module 15 is connected to the drive circuit 16. The time-sharing generation module 17 is used to output a switch control signal to the switch circuit 11 according to the time-sharing timing sequence. The switch circuit 11 is used to switch and connect the X-mode differential electrode and the Y-mode differential electrode of the resonant gyroscope to the detection circuit 12 and the drive circuit 16 in a time-sharing manner under the action of the switch control signal, so that in one time-sharing half cycle, the X-mode differential electrode is connected to the detection circuit 12, and the Y-mode differential electrode is connected to the drive circuit 16, and in another time-sharing half cycle, the Y-mode differential electrode is connected to the detection circuit 12, and the X-mode differential electrode is connected to the drive circuit 16.
[0045] The detection circuit 12 is used to detect the output of the X-mode differential electrode and the Y-mode differential electrode in time-sharing mode, and the signal reconstruction module 13 is used to generate a reconstructed signal according to the reconstruction algorithm and the output. The reconstructor 14 is used to modulate the reconstructed signal according to the switch control signal and output it to the detection circuit 12 to complete the reconstruction of the time-sharing discontinuous signal. The gyro control module 15 is used to generate a control force signal by frequency doubling parameter excitation according to the gyro displacement information in the reconstructed signal. The drive circuit 16 is used to apply the control force signal to the X-mode differential electrode and the Y-mode differential electrode in time-sharing mode through the switch circuit 11.
[0046] It can be understood that the output end of the detection circuit 12 is connected to the input end of the signal reconstruction module 13 to reconstruct the discontinuous signal of the output of the detected gyro electrode into a continuous signal (also called a reconstructed signal). The output end of the signal reconstruction module 13 is connected to the input end of the reconstructor 14, and the reconstructor 14 outputs the reconstructed signal modulated by the switch control signal to the detection circuit 12; in addition, the signal reconstruction module 13 also outputs the reconstructed signal to the gyro control module 15, and the gyro control module 15 generates a corresponding control force signal according to the gyro displacement information in the reconstructed signal, and outputs the control force signal to the drive circuit 16, so as to realize the closed-loop control of the resonant gyro. The gyro control module 15 can adopt the control module of the existing resonant gyro, such as but not limited to the force balance mode controller or the full-angle mode controller.
[0047] The time-sharing generation module 17 will output the switch control signal of the corresponding switch circuit 11 according to the designed time-sharing sequence, which is used to control the time-sharing switching of the switch circuit 11, so that the gyro electrode is driven and detected in time-sharing according to the set sequence. The time-sharing generation module 17 can adopt various types of square wave signal sources available in the art, which can be equipped with an existing square wave generation software module to generate the required square wave switch signal to achieve the switch switching control under the designed time-sharing sequence.
[0048] Among them, the designed time-sharing sequence can be as follows Figure 3 As shown, the horizontal axis t represents time, and the vertical axis represents the signal level. At the same time, when the detection circuit 12 detects the X-mode differential electrode, the drive circuit 16 drives the Y-mode differential electrode; when the detection circuit 12 detects the Y-mode differential electrode, the drive circuit 16 drives the X-mode differential electrode. The local circuit structure of the resonant gyro measurement and control system 100 based on circuit time-division multiplexing can be as follows Figure 4As shown, in actual application, the resonant gyro electrodes (including the X-mode differential electrodes and the Y-mode differential electrodes) are connected to the switch circuit 11. The switch circuit 11 can control the X-mode differential electrodes and the Y-mode differential electrodes of the resonant gyro to be connected to the input end of the detection circuit 12 and the output end of the driving circuit 16 in a time-sharing manner under the action of the switch control signal generated by the time-sharing generation module 17.
[0049] For example, when Figure 4 When the switch control signal received by the switch circuit 11 in the analog domain is at a low level (the switch control signal is a digital signal used to control the on and off of the switch circuit 11 in the analog domain), Figure 4 The switches in the circuit are in a cross state, the 0° and 90° electrodes are connected to the input end of the detection circuit 12 for X-mode detection, and the 45° and 135° electrodes are connected to the output end of the drive circuit 16 for Y-mode driving. Figure 4 When the switch control signal received by the switch circuit 11 in the embodiment is at a high level, Figure 4 The switches in the circuit 11 are in parallel state, the 0° and 90° electrodes are connected to the output end of the driving circuit 16 for driving in X mode; the 45° and 135° electrodes are connected to the input end of the detection circuit 12 for detecting in Y mode. In this way, the time-sharing generation module 17 generates a switch control signal based on this time-sharing sequence, and can effectively control the X-mode differential electrode and the Y-mode differential electrode of the resonant gyroscope to be connected to the input end of the detection circuit 12 and the output end of the driving circuit 16 in a time-sharing manner through the switch circuit 11.
[0050] The above-mentioned resonant gyro measurement and control system 100 based on circuit time-division multiplexing has designed a new time-division multiplexing architecture. The switch circuit 11 controls the X-mode differential electrode and the Y-mode differential electrode of the resonant gyro to be connected to the detection circuit 12 and the drive circuit 16 in a time-division manner. The output end of the detection circuit 12 is connected to the input end of the signal reconstruction module 13 to reconstruct the time-division discontinuous signal. The output end of the signal reconstruction module 13 is connected to the input end of the reconstructor 14. The reconstructor 14 outputs the reconstructed signal modulated by the switch control signal to the detection circuit 12. In addition, the signal reconstruction module 13 also outputs the reconstructed signal to the gyro control module 15. The gyro control module 15 controls it according to the gyro displacement information in the reconstructed signal, and outputs the control force signal to the drive circuit 16 to realize the closed-loop control of the gyro. The time-division generation module 17 will output the switch control signal of the corresponding switch circuit 11 according to the designed time-division timing sequence, which is used to control the switching of the switch circuit 11, so that the electrodes of the gyro are driven and detected in a time-division manner according to the set timing sequence. Compared with traditional technologies, the new time-sharing multiplexing architecture adopts a binary time-sharing timing, so that the detection and drive of the two modes share a set of circuits, which can effectively reduce circuit inconsistency errors. Compared with the four-state time-sharing timing, it can improve the efficiency and signal-to-noise ratio of drive and detection. The detection method adopts baseband signal reconstruction, and the drive method adopts frequency doubling parameter excitation, which effectively avoids crosstalk of control signals on detection, and realizes the restoration and extraction of discontinuous detection signals, thereby effectively improving the measurement and control performance of the resonant gyroscope.
[0051] In one embodiment, the signal reconstruction module 13 reconstructs the four components of sine, cosine, bias and ramp in the output quantity by reconstructing the baseband signal, and converts the output quantity into a continuous reconstructed signal. The reconstruction algorithm includes any one of the PID (proportional-integral-differential control) algorithm, the LQR (linear quadratic regulator) algorithm, the adaptive control algorithm and the neural network prediction algorithm.
[0052] It can be understood that in this embodiment, the detection method of the detection circuit 12 can adopt baseband signal reconstruction, such as Figure 5 As shown, the baseband reconstructed signal (i.e., the modulated reconstructed signal) generated by the reconstructor 14 and the detection signal of the X / Y mode selected by the switch circuit 11 are both input to the detection circuit 12, and the corresponding outputs thereof can update the reconstructed signal after passing through the signal reconstruction module 13. The reconstructor 14 can be, but is not limited to, a digital-to-analog converter DA, or can be Any modulator or the like can be used as long as it can modulate the reconstructed signal using the switch control signal and output the modulated signal to the detection circuit 12 .
[0053] The generation process of the reconstructed signal can be as follows Figure 5 As shown, Figure 5(a) shows the reconstructed signals of the X mode and the Y mode generated by the reconstruction algorithm in the signal reconstruction module 13, which are both continuous signals, and are reconstructions of the four components of the sine, cosine, bias and ramp in the discrete output quantity output by the detection circuit 12, so as to convert the output quantity into a continuous reconstructed signal, thereby achieving the purpose of restoring the discontinuous signal to a continuous signal. The implementation method of the reconstruction algorithm can be, but is not limited to, a PID algorithm, an LQR algorithm, an adaptive control algorithm, a neural network prediction algorithm, etc., as long as it can be used to achieve the reconstruction of a time-sharing discontinuous signal. Figure 5 (b) shows the signal output by the reconstructor 14, which is generated by the reconstructed signals of the continuous X mode and Y mode, modulated by the switch control signal of the switch circuit 11 according to the time-sharing timing design. Figure 5 In the figure, the horizontal axis t represents time, and the vertical axis A represents the amplitude of the signal.
[0054] In one embodiment, Figure 6 As shown, the detection circuit 12 may include an inverter 120, a resistor R1, a resistor R2, a differential capacitance voltage conversion circuit 121, and an analog-to-digital converter AD. The input end of the inverter 120 and one end of the resistor R1 are both connected to the output end of the reconstructor 14, the output end of the inverter 120 is connected to one end of the resistor R2, the other end of the resistor R1 is connected to the first inverting input end of the differential capacitance voltage conversion circuit 121, and the other end of the resistor R2 is connected to the second inverting input end of the differential capacitance voltage conversion circuit 121. The output end of the differential capacitance voltage conversion circuit 121 is connected to the input end of the signal reconstruction module 13 through the analog-to-digital converter AD, and the two inverting input ends of the differential capacitance voltage conversion circuit 121 are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit 11.
[0055] It can be understood that the differential capacitance voltage conversion circuit 121 may include a comparator CP1, a comparator CP2, a capacitor C1, a capacitor C2 and an adder A1. The other end of the resistor R1 is connected to the inverting input of the comparator CP1 and one end of the capacitor C1, the other end of the capacitor C1 is connected to the output of the comparator CP1, and the output of the comparator CP1 is connected to the positive input of the adder A1. The other end of the resistor R2 is connected to the inverting input of the comparator CP2 and one end of the capacitor C2, the other end of the capacitor C2 is connected to the output of the comparator CP2, and the output of the comparator CP2 is connected to the negative input of the adder A1. The output of the adder A1 is connected to the input of the signal reconstruction module 13 through the analog-to-digital converter AD. The positive input of the comparator CP1 and the positive input of the comparator CP2 are both grounded, and the inverting input of the comparator CP1 and the inverting input of the comparator CP2 are used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit 11.
[0056] By means of the detection circuit 12 structure designed as above, the output measurement of the X-mode differential electrode and the Y-mode differential electrode can be effectively realized by adopting the detection method of baseband signal reconstruction.
[0057] In one embodiment, Figure 7 As shown, another optional detection circuit 12 may include a differential capacitance voltage conversion circuit 121, a proportional subtractor 123 and an analog-to-digital converter AD. The two inverting input terminals of the differential capacitance voltage conversion circuit 121 are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode in time division through the switch circuit 11. The output terminal of the differential capacitance voltage conversion circuit 121 is connected to the positive input terminal of the proportional subtractor 123, the inverting input terminal of the proportional subtractor 123 is connected to the output terminal of the reconstructor 14, and the output terminal of the proportional subtractor 123 is connected to the input terminal of the signal reconstruction module 13 through the analog-to-digital converter AD.
[0058] It can be understood that the differential capacitance voltage conversion circuit 121 may include a comparator CP1, a comparator CP2, a capacitor C1, a capacitor C2 and an adder A1. The proportional subtractor 123 may include a resistor R3, a resistor R4, a resistor R5, a resistor R6 and a comparator CP3. The output terminal and the inverting input terminal of the comparator CP1 are connected through a capacitor C1, the output terminal and the inverting input terminal of the comparator CP2 are connected through a capacitor C2, the output terminal of the comparator CP1 is connected to the positive input terminal of the adder A1, and the output terminal of the comparator CP2 is connected to the negative input terminal of the adder A1. The inverting input terminal of the comparator CP1 and the inverting input terminal of the comparator CP2 are used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit 11, and the positive input terminal of the comparator CP1 and the positive input terminal of the comparator CP2 are both grounded.
[0059] The output end of the adder A1 is connected to the non-inverting input end of the comparator CP3 through a resistor R4, and the non-inverting input end of the comparator CP3 is also grounded through a resistor R5. The inverting input end of the comparator CP3 is connected to the output end of the reconstructor 14 through a resistor R3. The output end and the inverting input end of the comparator CP3 are connected through a resistor R6. The output end of the comparator CP3 is connected to the input end of the signal reconstruction module 13 through an analog-to-digital converter AD.
[0060] By means of the detection circuit 12 structure designed as above, the output measurement of the X-mode differential electrode and the Y-mode differential electrode can also be effectively realized by adopting the detection method of baseband signal reconstruction.
[0061] In one embodiment, Figure 8As shown, another detection circuit 12 includes a differential capacitance voltage conversion circuit 121, a carrier demodulation module 125, a proportional subtractor 123 and an analog-to-digital converter AD. The two inverting input terminals of the differential capacitance voltage conversion circuit 121 are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit 11. The output terminal of the differential capacitance voltage conversion circuit 121 is connected to the positive input terminal of the proportional subtractor 123 through the carrier demodulation module, the inverting input terminal of the proportional subtractor 123 is connected to the output terminal of the reconstructor 14, the output terminal of the proportional subtractor 123 is connected to the input terminal of the signal reconstruction module 13 through the analog-to-digital converter AD, and the reference input terminal of the carrier demodulation module is used to connect the high-frequency carrier voltage V C .
[0062] It can be understood that the differential capacitance voltage conversion circuit 121 may include a comparator CP1, a comparator CP2, a capacitor C1, a capacitor C2 and an adder A1. The proportional subtractor 123 may include a resistor R3, a resistor R4, a resistor R5, a resistor R6 and a comparator CP3. The output terminal and the inverting input terminal of the comparator CP1 are connected through a capacitor C1, the output terminal and the inverting input terminal of the comparator CP2 are connected through a capacitor C2, the output terminal of the comparator CP1 is connected to the positive input terminal of the adder A1, and the output terminal of the comparator CP2 is connected to the negative input terminal of the adder A1. The inverting input terminal of the comparator CP1 and the inverting input terminal of the comparator CP2 are used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit 11, and the positive input terminal of the comparator CP1 and the positive input terminal of the comparator CP2 are both grounded.
[0063] The output of adder A1 is connected to the non-inverting input of comparator CP3 through carrier demodulation module 125 and resistor R4. The non-inverting input of comparator CP3 is also grounded through resistor R5. The inverting input of comparator CP3 is connected to the output of reconstructor 14 through resistor R3. The output and inverting input of comparator CP3 are connected through resistor R6. The output of comparator CP3 is connected to the input of signal reconstruction module 13 through analog-to-digital converter AD. The reference signal input of carrier demodulation module 125 is taken from high-frequency carrier voltage V C The carrier demodulation module 125 may adopt various types of signal demodulation circuit modules existing in the art, and is used to demodulate the output signal of the differential capacitance voltage conversion circuit 121 to obtain the X-mode or Y-mode displacement signal.
[0064] By means of the detection circuit 12 structure designed as above, the output measurement of the X-mode differential electrode and the Y-mode differential electrode can also be effectively realized by adopting the detection method of baseband signal reconstruction.
[0065] In one embodiment, the frequency doubling parameter excitation method may include generating a control force signal using a double frequency parameter excitation voltage according to the gyro displacement information in the reconstructed signal. The switch circuit 11 may be composed of two pairs of cross switches, and the drive circuit 16 may include a digital-to-analog converter DA and an amplifier K connected in series. The input end of the digital-to-analog converter DA is connected to the output end of the gyro control module 15, the output end of the amplifier K is connected to the driving input end of the two pairs of cross switches, and the detection output ends of the two pairs of cross switches are respectively connected to the input end of the detection circuit 12. The other two ends of the two pairs of cross switches are respectively used to connect the X-mode differential electrode and the Y-mode differential electrode.
[0066] It can be understood that in this embodiment, the driving method of the resonant gyroscope can adopt frequency doubling parameter excitation, which can be as follows: Fig. 9 As shown, (a) is an optional circuit structure of the driving circuit 16 under this driving mode, and (b) is a schematic diagram of the driving mode. is the DC voltage, is the double frequency parameter excitation voltage, which can be expressed as:
[0067] (1)
[0068] in, represents the amplitude of the double frequency excitation voltage, represents the excitation frequency, represents the phase of the frequency-doubled parameter excitation, is the vibration time. The electrostatic force on the resonant structure It can be expressed as:
[0069] (2)
[0070] Ignoring higher-order terms, we get:
[0071] (3)
[0072] in, represents the amplitude of the double frequency excitation voltage, represents the dielectric constant, represents the electrode area, represents the electrode gap, Represents the detection displacement, Represents the electrode capacitance.
[0073] Assumptions: , represents the amplitude of the detected displacement. Substituting the electrostatic force F In the expression of , and only considering the effective control force of the resonant frequency, the control force signal can be obtained:
[0074] (4)
[0075] Simplified to:
[0076] (5)
[0077] in, is the electrostatic negative stiffness, and They are orthogonal and in-phase driving forces respectively, which can realize the driving control of the resonant gyroscope. Through the above driving mode and the design of the driving circuit 16, reliable driving control of the resonant gyroscope is achieved.
[0078] In one embodiment, the frequency doubling parameter excitation method may include generating a control force signal using a double frequency parameter excitation voltage and a baseband excitation voltage according to the gyro displacement information in the reconstructed signal. The drive circuit 16 may include a digital-to-analog converter DA1, a digital-to-analog converter DA2, an amplifier K1, an amplifier K2, a first adder A2, and a second adder A3. The switch circuit 11 is composed of two pairs of cross switches. The input end of the digital-to-analog converter DA1 is used to access the double frequency parameter excitation voltage, the input end of the digital-to-analog converter DA2 is used to access the baseband excitation voltage, and the output end of the digital-to-analog converter DA1 is connected to the input end of the first adder A2 and the input end of the second adder A3 through the amplifier K1. The output end of the digital-to-analog converter DA2 is connected to the input end of the first adder A2 and the input end of the second adder A3 through the amplifier K2, and the output end of the first adder A2 and the output end of the second adder A3 are respectively connected to the driving input end of the two pairs of cross switches. The detection output terminals of the two pairs of cross switches are respectively connected to the input terminals of the detection circuit 12, and the other two terminals of the two pairs of cross switches are respectively used to connect the X-mode differential electrodes and the Y-mode differential electrodes.
[0079] Alternatively, another implementation of parameter excitation can be as follows Fig.10 As shown, (a) is an optional circuit structure of the driving circuit 16 under this driving mode, and (b) is a schematic diagram of the driving mode. and are the double frequency parameter excitation voltage and the fundamental frequency excitation voltage respectively, which can be expressed as:
[0080] (6)
[0081] represents the amplitude of the double frequency excitation voltage, represents the fundamental frequency excitation voltage amplitude, represents the excitation frequency, represents the phase of the frequency-doubled parameter excitation, t is the vibration time. The electrostatic force generated on the resonant structure at this time F It can be expressed as:
[0082] (7)
[0083] Ignore the higher-order terms and consider , formula (7) can be simplified to:
[0084] (8)
[0085] in, represents the dielectric constant, represents the electrode area, represents the electrode gap, Represents the detection displacement, Represents the electrode capacitance.
[0086] Substituting formula (8) into the dynamic equation of the gyroscope, we can obtain:
[0087] (9)
[0088] Indicates the acceleration corresponding to the detected displacement, Indicates that the detected displacement corresponds to the velocity. represents the electrostatic negative stiffness, represents the resonant frequency, represents the quality factor, represents the parameter excitation stiffness coefficient, represents the fundamental frequency driving force. Solving equation (9) yields that when resonance occurs , and when the phase of the parameter excitation is π, the solution of the equation has the largest amplitude, expressed as:
[0089] (10)
[0090] represents the amplitude, Represents an intermediate variable.
[0091] Compared with no parameter excitation, it has an amplified gain , which can be expressed as:
[0092] (11)
[0093] Right now:
[0094] (12)
[0095] The inverse of the amplification factor is linearly related to the voltage amplitude of the applied parameter excitation. At this time, the parameter excitation can amplify the baseband driving signal, thereby reducing the amplitude of the required baseband driving signal, and also achieving the effect of suppressing the crosstalk of the control signal on the detection end.
[0096] In one embodiment, the frequency-doubling parameter excitation method may include generating a control force signal using a triple frequency parameter excitation voltage and a base frequency excitation voltage according to the gyro displacement information in the reconstructed signal. The driving circuit 16 includes a digital-to-analog converter DA, an amplifier K and an inverter (such as Fig.11 The switching circuit 11 is composed of two pairs of cross switches. The input end of the digital-to-analog converter DA is used to access the excitation voltage of the triple frequency parameter excitation voltage and the base frequency excitation voltage. The output end of the digital-to-analog converter DA is connected to the input end of the amplifier K, and the output end of the amplifier K is connected to the driving input end of a pair of cross switches. The output end of the amplifier K is also connected to the input end of the inverter. The output end of the inverter is connected to the driving input end of another pair of cross switches, and the detection output ends of the two pairs of cross switches are respectively connected to the input end of the detection circuit 12. The other two ends of the two pairs of cross switches are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode.
[0097] Alternatively, another implementation of parameter excitation can be as follows Fig.11 As shown, (a) is an optional circuit structure of the driving circuit 16 under this driving mode, and (b) is a schematic diagram of the driving mode. and are the triple frequency parameter excitation voltage and the fundamental frequency excitation voltage respectively, which can be expressed as:
[0098] (13)
[0099] represents the amplitude of the triple frequency parameter excitation voltage, represents the fundamental frequency excitation voltage amplitude, represents the excitation frequency, represents the phase of the frequency-doubled parameter excitation, is the vibration time. The electrostatic force generated on the resonant structure at this time It can be expressed as:
[0100] (14)
[0101] in, represents the dielectric constant, represents the electrode area, represents the electrode gap, represents the detected displacement. Ignore the higher-order terms and consider , formula (14) can be simplified to:
[0102] (15)
[0103] Substituting into the dynamic equation of the gyroscope, we get:
[0104] (16)
[0105] Indicates the acceleration corresponding to the detected displacement, represents the electrostatic negative stiffness, represents the resonant frequency, represents the quality factor, represents the parameter excitation stiffness coefficient, represents the fundamental frequency driving force, The gyro dynamic equation of the same form as that of the previous embodiment is obtained, so that the effect of parameter excitation can also be achieved to suppress the crosstalk of the control signal to the detection end.
[0106] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0107] The above embodiments only express several implementation methods of the present application, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of protection of the invention. It should be pointed out that, for a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present application, and these all belong to the scope of protection of the present application. Therefore, the scope of protection of the present application shall be subject to the attached claims.
Claims
1. A resonant gyro measurement and control system based on circuit time-division multiplexing, characterized in that: It includes a switch circuit, a detection circuit, a signal reconstruction module, a reconstructor, a gyro control module, a drive circuit and a time-sharing generation module, wherein the switch circuit is respectively connected to the detection circuit, the drive circuit and the time-sharing generation module, the detection circuit is respectively connected to the signal reconstruction module and the reconstructor, the signal reconstruction module is respectively connected to the reconstructor and the gyro control module, and the gyro control module is connected to the drive circuit; The time-sharing generation module is used to output a switch control signal to the switch circuit according to the time-sharing timing sequence, and the switch circuit is used to switch and connect the X-mode differential electrode and the Y-mode differential electrode of the resonant gyroscope to the detection circuit and the drive circuit in a time-sharing manner under the action of the switch control signal, so that in one time-sharing half cycle, the X-mode differential electrode is connected to the detection circuit, and the Y-mode differential electrode is connected to the drive circuit, and in another time-sharing half cycle, the Y-mode differential electrode is connected to the detection circuit, and the X-mode differential electrode is connected to the drive circuit; The detection circuit is used to detect the output of the X-mode differential electrode and the Y-mode differential electrode in a time-sharing manner, the signal reconstruction module is used to generate a reconstructed signal according to a reconstruction algorithm and the output, the reconstructor is used to modulate the reconstructed signal according to the switch control signal and output it to the detection circuit to complete the reconstruction of the time-sharing discontinuous signal, the gyro control module is used to generate a control force signal by frequency doubling parameter excitation according to the gyro displacement information in the reconstructed signal, and the drive circuit is used to apply the control force signal to the X-mode differential electrode and the Y-mode differential electrode through the switch circuit in a time-sharing manner; The signal reconstruction module reconstructs the four components of sine, cosine, offset and slope in the output by means of baseband signal reconstruction, and converts the output into the continuous reconstructed signal.
2. The resonant gyro measurement and control system based on circuit time-division multiplexing according to claim 1 is characterized in that: The detection circuit includes an inverter, a resistor R1, a resistor R2, a differential capacitor voltage conversion circuit and an analog-to-digital converter AD; The input end of the inverter and one end of the resistor R1 are both connected to the output end of the reconstructor, the output end of the inverter is connected to one end of the resistor R2, the other end of the resistor R1 is connected to the first inverting input end of the differential capacitor-voltage conversion circuit, the other end of the resistor R2 is connected to the second inverting input end of the differential capacitor-voltage conversion circuit, the output end of the differential capacitor-voltage conversion circuit is connected to the input end of the signal reconstruction module through the analog-to-digital converter AD, and the two inverting input ends of the differential capacitor-voltage conversion circuit are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit.
3. The resonant gyro measurement and control system based on circuit time-division multiplexing according to claim 1 is characterized in that: The detection circuit includes a differential capacitance voltage conversion circuit, a proportional subtractor and an analog-to-digital converter AD; The two inverting input terminals of the differential capacitance-to-voltage conversion circuit are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode in a time-sharing manner through the switch circuit, the output terminal of the differential capacitance-to-voltage conversion circuit is connected to the non-phase input terminal of the proportional subtractor, the inverting input terminal of the proportional subtractor is connected to the output terminal of the reconstructor, and the output terminal of the proportional subtractor is connected to the input terminal of the signal reconstruction module through the analog-to-digital converter AD.
4. The resonant gyro measurement and control system based on circuit time-division multiplexing according to claim 1 is characterized in that: The detection circuit includes a differential capacitance voltage conversion circuit, a carrier demodulation module, a proportional subtractor and an analog-to-digital converter AD; The two inverting input terminals of the differential capacitance voltage conversion circuit are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode through the switch circuit, the output terminal of the differential capacitance voltage conversion circuit is connected to the non-phase input terminal of the proportional subtractor through the carrier demodulation module, the inverting input terminal of the proportional subtractor is connected to the output terminal of the reconstructor, the output terminal of the proportional subtractor is connected to the input terminal of the signal reconstruction module through the analog-to-digital converter AD, and the reference input terminal of the carrier demodulation module is used to connect the high-frequency carrier voltage.
5. The resonant gyro measurement and control system based on circuit time-division multiplexing according to claim 1, characterized in that: The method of frequency doubling parameter excitation includes generating the control force signal by using a frequency doubling parameter excitation voltage according to the gyro displacement information in the reconstructed signal; The switch circuit is composed of two pairs of cross switches, and the drive circuit includes a digital-to-analog converter DA and an amplifier K connected in series. The input end of the digital-to-analog converter DA is connected to the output end of the gyro control module, the output end of the amplifier K is connected to the drive input ends of the two pairs of cross switches, the detection output ends of the two pairs of cross switches are respectively connected to the input ends of the detection circuit, and the other two ends of the two pairs of cross switches are respectively used to connect the X-mode differential electrode and the Y-mode differential electrode.
6. The resonant gyro measurement and control system based on circuit time-division multiplexing according to claim 1, characterized in that: The method of frequency doubling parameter excitation includes generating the control force signal by using a double frequency parameter excitation voltage and a base frequency excitation voltage according to the gyro displacement information in the reconstructed signal; The driving circuit includes a digital-to-analog converter DA1, a digital-to-analog converter DA2, an amplifier K1, an amplifier K2, a first adder and a second adder, and the switch circuit is composed of two pairs of cross switches; The input end of the digital-to-analog converter DA1 is used to access the double frequency parameter excitation voltage, the input end of the digital-to-analog converter DA2 is used to access the baseband excitation voltage, the output end of the digital-to-analog converter DA1 is connected to the input ends of the first adder and the second adder respectively through the amplifier K1, the output end of the digital-to-analog converter DA2 is connected to the input ends of the first adder and the second adder respectively through the amplifier K2, the output ends of the first adder and the second adder are respectively connected to the driving input ends of two pairs of the cross switches, the detection output ends of the two pairs of the cross switches are respectively connected to the input ends of the detection circuit, and the other two ends of the two pairs of the cross switches are respectively used to connect the X-mode differential electrode and the Y-mode differential electrode.
7. The resonant gyro measurement and control system based on circuit time-division multiplexing according to claim 1 is characterized in that: The method of frequency-doubling parameter excitation includes generating the control force signal by using a triple frequency parameter excitation voltage and a base frequency excitation voltage according to the gyro displacement information in the reconstructed signal; The driving circuit includes a digital-to-analog converter DA, an amplifier K and an inverter, and the switching circuit is composed of two pairs of cross switches; The input end of the digital-to-analog converter DA is used to receive an excitation voltage that is a sum of a triple frequency parameter excitation voltage and a base frequency excitation voltage. The output end of the digital-to-analog converter DA is connected to the input end of the amplifier K. The output end of the amplifier K is connected to a pair of driving input ends of the cross switches. The output end of the amplifier K is also connected to the input end of the inverter. The output end of the inverter is connected to the driving input end of another pair of cross switches. The detection output ends of the two pairs of cross switches are respectively connected to the input end of the detection circuit. The other two ends of the two pairs of cross switches are respectively used to connect the X-mode differential electrode or the Y-mode differential electrode.
