A method and device for adaptive jitter removal of laser gyroscope
By using a combination of a dual-channel FIR filter and an adaptive FIR filter in the laser gyroscope, the problem of jitter estimation error under the influence of noise in the prior art is solved, and a high-precision jitter stripping effect is achieved, ensuring the system's signal Accuracy and phase accuracy.
Patent Information
- Application Number
- CN202110142450.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-02-02
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2041-02-02
AI Technical Summary
The existing laser gyroscope jitter stripping technology has quantization errors, external angular velocity parameters and ADC noise in noise processing, resulting in large errors in jitter estimation, reduced signal-to-noise ratio, and reduced accuracy of the adaptive filter weight coefficient update. The jitter signal cannot be completely eliminated.
Use a dual-channel FIR filter to maintain the original phase relationship of the two signals, update the weight coefficient through the adaptive FIR filter, adjust the jitter signal using the FIR filter, subtract the jitter noise estimation signal to obtain a jitter-free output signal to ensure the signal accuracy and phase accuracy.
The accuracy and phase accuracy of the signal are improved, and the residual machine jitter deviation frequency after jitter stripping is reduced. The system accuracy is high, and the phase difference between the output results and the actual measured data is small, and the delay is small.
Smart Images

Figure CN114838720B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a laser gyro correction technology, and more particularly to an adaptive jitter stripping method and device for a laser gyro. Background Art
[0002] Laser gyro is a sensitive inertial angular velocity optical device based on Sagnac effect. Compared with other types of gyro, it has the characteristics of high precision, strong resistance to harsh environment, large dynamic range and high reliability. Mechanically shaken laser gyro (abbreviated as mechanically shaken laser gyro) is the earliest and most widely used laser gyro, and has been widely used in important fields such as inertial navigation and angle measurement.
[0003] Due to the locking effect of the laser gyro, in order to overcome the influence of the locking area, an alternating sinusoidal frequency offset is introduced into the machine-shaking gyro. Therefore, its readout signal contains not only the number of pulses caused by the speed to be measured, but also the machine-shaking frequency offset. The jitter signal introduced must be removed in some way to obtain the measured signal, that is, to demodulate the gyro output signal.
[0004] In order to improve the real-time performance of the signal, the core idea of jitter removal is to make the jitter reference signal consistent with the jitter component in the gyro counting signal through appropriate amplitude and phase adjustment methods, so that it can be directly deducted. It can be roughly divided into two categories: time domain correspondence method and adaptive filtering algorithm. The time domain correspondence method is to correct the phase, amplitude and nonlinearity separately, which is more complicated to implement; the adaptive filtering algorithm uses recursive least squares (RLS) or minimum mean square error (LMS) algorithm to achieve simultaneous correction of amplitude and phase. This algorithm is simple to implement, has high tracking accuracy, and can achieve relatively ideal accuracy.
[0005] The existing jitter stripping technology (for example: Fan Zhenfang, Luo Hui, Hu Shaomin, "Self-locked phase jitter stripping of dual-frequency machine jitter gyro", China Laser, April 2011, Vol. 38, No. 4) basically uses the two sinusoidal signals of the gyro phototube as reference signals after orthogonal demodulation, and uses an adaptive filter to directly filter the sampling results of the gyro's jitter feedback signal to obtain the jitter amount, and then subtract the known jitter amount from the gyro output to obtain the gyro's input angular velocity. The jitter amount directly obtained by using the adaptive filter is affected by quantization errors, external angular velocity parameters, and ADC noise during the stripping process because the noise in the two collected signals is not processed, resulting in a large error in the jitter estimation amount, which leads to an increase in the nonlinearity of the gyro output. Its shortcomings are obvious.
[0006] The invention patent "A laser gyro jitter stripping device" (CN102175237A, Xie Yuanping et al.) strips the jitter signal of the gyro. The device uses an adaptive cancellation technology based on the LMS algorithm to strip the laser gyro jitter signal. The sampling frequency of the stripping device is an integer multiple of the jitter frequency. The sine and cosine reference signal pairs used for stripping are obtained by a simple digital delay of a sampled differential signal. The input and output responses of the system are approximately time-invariant, which can improve the jitter stripping effect. The invention uses a phase-locked loop to integer-multiply the reference signal to obtain a sampling clock, and its accuracy is difficult to guarantee, and synchronous output cannot be achieved; the sine and cosine reference signal pairs used for stripping are obtained by a simple digital delay of a sampled differential signal. This process reduces the signal-to-noise ratio, thereby reducing the accuracy of updating the weight coefficients of the adaptive filter; the jitter-stripped signal is filtered through a bandpass filter for weight coefficient update. This process will produce a phase error, so that the jitter signal cannot be completely cancelled. Summary of the invention
[0007] In order to solve the above technical problems, the present invention proposes an adaptive jitter stripping method for a laser gyro, comprising: using the same weight coefficient to remove the jitter signal X obtained from the jitter feedback mechanism of the laser gyro 1 (n) and the output increment of the laser gyro X 2 The method further comprises filtering a signal X(n) and a reference signal D(n) to obtain an input signal X(n) and a reference signal D(n); generating a weight coefficient signal W(z) based on the input signal X(n) and the reference signal D(n); and adjusting the jitter signal X(n) based on the weight coefficient signal W(z). 1 (n) signal, obtain the jitter noise estimation signal S(n); the output increment X 2 The jitter noise estimation signal S(n) is subtracted from the signal S(n).
[0008] Optionally, the method of the present invention further comprises: obtaining the output increment X of the machine-shaking laser gyro by orthogonally decoding the two sine and cosine signals generated by the laser gyro 2 (n).
[0009] Optionally, the method of the present invention further comprises: converting the jitter signal X 1 (n) and the output increment of the laser gyro X 2 (n) is input into a dual-channel bandpass FIR filter to obtain the input signal X(n) and the reference signal D(n);
[0010] Optionally, the method of the present invention further comprises: inputting the input signal X(n) and the reference signal D(n) into an adaptive FIR filter to obtain the coefficient signal W(z).
[0011] Optionally, the method of the present invention further comprises: converting the jitter signal X 1(n) and the coefficient signal W(z) are input to the FIR filter to obtain the jitter noise estimation signal S(n).
[0012] Optionally, the method of the present invention further comprises: obtaining the jitter signal X by sequentially performing signal modulation, ADC acquisition and bandpass IIR filter on the signal obtained from the jitter feedback mechanism of the laser gyro. 1 (n).
[0013] The present invention proposes an adaptive jitter stripping device for a laser gyro, comprising: a first filter for filtering two signals with the same weight coefficient, the input of which is an output increment X obtained from the laser gyro 2 (n) and the jitter signal X obtained from the jitter feedback mechanism of the laser gyro 1 (n), and obtain two output signals: the input signal and the X(n) reference signal D(n); the second filter, whose input signals are the input signal and the X(n) reference signal D(n), and the output signal is the weight coefficient signal W(z); the third filter, whose input is the weight coefficient signal W(z) and the jitter signal X 1 (n), the output is the noise estimation signal S(n); the subtractor, the input of which is the output increment X 2 (n) and the noise estimation signal S(n).
[0014] Optionally, the first filter is a dual-channel FIR filter, the second filter is an adaptive FIR filter, and the third filter is a FIR filter.
[0015] Optionally, the device of the present invention further comprises: an orthogonal decoder, which performs orthogonal decoding on the signal output by the laser gyro to obtain the output increment X 2 (n).
[0016] Optionally, the device of the present invention further comprises: a signal modulator, wherein the receiver of the signal modulator receives the jitter signal X output by the jitter feedback mechanism of the laser gyro. 1 (n), and modulates; ADC collector, which outputs the jitter signal X of the signal modulator 1 (n) to collect; a bandpass IIR filter, which receives the jitter signal collected by the ADC collector 1 (n) to remove DC noise and high-order harmonics.
[0017] The beneficial effects of the present invention include:
[0018] 1. Use a dual-channel FIR filter to maintain the two input signals X 1 (n) and X 2 (n)’s original phase relationship.
[0019] 2. The adaptive filter is only used to update the weighting coefficients of the FIR and does not process the output signal of the laser gyro.
[0020] 3. The output result is the result of orthogonal decoding subtracted from the jitter information. The output result has a small phase difference and delay with the actual measured data, and the system has high accuracy. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] In order to make the present invention more easily understood, the present invention will be described in more detail by referring to the specific embodiments shown in the accompanying drawings. These drawings only depict typical embodiments of the present invention and should not be considered as limiting the scope of protection of the present invention.
[0022] Figure 1 A schematic diagram of an embodiment of the method of the present invention.
[0023] Figure 2 A schematic diagram of another embodiment of the method of the present invention. DETAILED DESCRIPTION
[0024] The following describes the embodiments of the present invention with reference to the accompanying drawings, wherein the same components are denoted by the same reference numerals. In the absence of conflict, the following embodiments and the technical features in the embodiments may be combined with each other.
[0025] like Figure 1 As shown, the adaptive jitter removal method for a laser gyro of the present invention includes steps S1-S6.
[0026] S1, obtain the jitter signal X from the jitter feedback mechanism of the laser gyro 1 (n).
[0027] S2, for the two sine and cosine signals generated by the machine-shaking laser gyro, orthogonal decoding is performed to obtain the output increment X of the machine-shaking laser gyro 2 (n).
[0028] S3, the jitter signal X 1 (n) and output increment X 2 (n) After passing through a dual-channel bandpass FIR filter, the two signals are filtered using the same weight coefficients to obtain two output signals, wherein the first signal X(n) serves as the input signal X(n) of the subsequent adaptive FIR filter, and the second signal D(n) serves as the reference signal D(n) of the adaptive FIR filter.
[0029] The dual-channel bandpass FIR filter maintains the two input signals X 1 (n) and X 2The original phase relationship of (n) is maintained, and no phase distortion is generated. At the same time, the DC noise, quantization noise, ADC circuit noise, etc. in the loop are removed, making the weight coefficient update of the adaptive FIR filter (described in detail below) more accurate.
[0030] S4, the input signal X(n) and the reference signal D(n) are input to the adaptive FIR filter, and the output of the adaptive FIR filter is used as the weight coefficient signal W(z). The weight coefficient signal W(z) is updated in real time according to the input signal X(n) and the reference signal D(n), and the weight coefficient W(z) is output to the FIR filter.
[0031] S5, jitter signal X 1 (n) and the coefficient signal W(z) are input to the FIR filter, where the weight coefficient signal W(z) is used to adjust X in real time. 1 The amplitude and phase of the (n) signal are used to obtain the jitter noise estimation signal S(n) of the machine-shake laser gyro.
[0032] S6, using the output increment X of orthogonal decoding 2 The jitter noise estimation signal S(n) is subtracted from the jitter noise estimation signal S(n) to obtain the jitter-free output angular rate of the machine-jittered laser gyro.
[0033] In another embodiment, Figure 2 As shown, the adaptive jitter stripping method for a laser gyroscope of the present invention comprises:
[0034] S1, obtains the jitter signal from the jitter feedback mechanism of the machine-jitter laser gyro. After signal modulation, the signal collected by ADC passes through a bandpass IIR filter (to remove DC noise and high-order harmonics) to obtain the jitter signal X 1 (n).
[0035] The collected jitter signal is filtered by an IIR filter to remove the DC component and noise, and then passes through an FIR filter with updateable coefficients to obtain jitter information. The bandpass IIR filter filters out the DC noise, quantization noise, ADC circuit noise, etc. in the signal, making the weight coefficient update of the adaptive FIR filter more accurate and the jitter stripping effect better.
[0036] S2, for the two sine and cosine signals generated by the machine-shaking laser gyro, orthogonal decoding is performed to obtain the output increment X of the machine-shaking laser gyro 2 (n).
[0037] S3, the jitter signal X 1 (n) and output increment X 2 (n) passes through a dual-channel bandpass FIR filter to obtain the signal X(n) and the reference signal D(n).
[0038] The dual-channel bandpass FIR filter maintains the two input signals X 1 (n) and X 2 The original phase relationship of (n) is maintained, and the DC noise, quantization noise, ADC circuit noise, etc. in the loop are removed, so that the weight coefficients of the adaptive FIR filter (described in detail below) are updated more accurately.
[0039] S4, the input signal X(n) and the reference signal D(n) are input to the adaptive FIR filter, and the output of the adaptive FIR filter is used as the weight coefficient signal W(z). The weight coefficient signal W(z) is updated in real time according to the input signal X(n) and the reference signal D(n), and the weight coefficient W(z) is output to the FIR filter.
[0040] S5, jitter signal X 1 (n) and the weight coefficient signal W(z) are input to the FIR filter, where the weight coefficient signal W(z) is used to adjust X in real time. 1 The amplitude and phase of the (n) signal are used to obtain the jitter noise estimation signal S(n) of the machine-shake laser gyro.
[0041] S6, using the output increment X of orthogonal decoding 2 The jitter noise estimation signal S(n) is subtracted from the jitter noise estimation signal S(n) to obtain the jitter-free output angular rate of the machine-jittered laser gyro.
[0042] In the present invention, the jitter signal X 1 The jitter noise estimation S(n) of the machine-shake laser gyro is obtained by using the (n) signal instead of the X(n) signal, which minimizes the phase error. This makes the residual machine-shake frequency offset in the jitter stripping output very small.
[0043] In the present invention, the output of the orthogonal decoding is not subjected to FIR filtering, but is directly subtracted from the jitter signal to obtain the output result, and the jitter stripping output has no delay.
[0044] In the present invention, an adaptive FIR filter is used to update the weight coefficients of the FIR filter, and the measured signal has no bandwidth limitation.
[0045] The embodiments described above are only preferred specific implementations of the present invention. Common changes and substitutions made by those skilled in the art within the scope of the technical solution of the present invention should be included in the protection scope of the present invention.
Claims
1. An adaptive jitter stripping method for laser gyroscope, It is characterized in that include: The output increment X of the machine-shaking laser gyro is obtained by orthogonally decoding the two sine and cosine signals generated by the laser gyro. 2 (n); The jitter signal X obtained by the jitter feedback mechanism of the laser gyro is obtained using the same weight coefficient 1 (n) and the output increment of the laser gyro X 2 (n) The signal is input to a dual-channel bandpass FIR filter to obtain the input signal X(n) and the reference signal D(n); Generating a weight coefficient signal W(z) based on the input signal X(n) and the reference signal D(n); The jitter signal X is adjusted based on the weight coefficient signal W(z) 1 (n) signal, and obtain a jitter noise estimation signal S(n); Increment the output by X 2 The jitter noise estimation signal S(n) is subtracted from the signal S(n).
2. The adaptive jitter removal method for a laser gyro according to claim 1, It is characterized in that The input signal X(n) and the reference signal D(n) are input into an adaptive FIR filter to obtain the weight coefficient signal W(z).
3. The adaptive jitter removal method for a laser gyro according to claim 1, It is characterized in that The jitter signal X 1 (n) and the weight coefficient signal W(z) are input to the FIR filter to obtain the jitter noise estimation signal S(n).
4. The adaptive jitter removal method for a laser gyro according to claim 1, It is characterized in that Also includes: The signal obtained from the jitter feedback mechanism of the laser gyro is sequentially modulated, acquired by ADC and filtered by a bandpass IIR filter to obtain the jitter signal X. 1 (n).
5. An adaptive jitter stripping device for a laser gyroscope, It is characterized in that include: The output increment X of the machine-shaking laser gyro is obtained by orthogonally decoding the two sine and cosine signals generated by the laser gyro. 2 (n); The first filter is used to filter the two signals with the same weight coefficient. The first filter is a dual-channel bandpass FIR filter, and its input is the output increment X obtained from the laser gyro. 2 (n) and the jitter signal X obtained from the jitter feedback mechanism of the laser gyro 1 (n), and obtain two output signals: the input signal and the X(n) reference signal D(n); A second filter, whose input signal is the input signal and the X(n) reference signal D(n), and whose output signal is the weight coefficient signal W(z); The third filter, whose input is the weight coefficient signal W(z) and the jitter signal X 1 (n), the output is the noise estimation signal S(n); Subtractor, whose input is the output increment X 2 (n) and the noise estimation signal S(n).
6. The adaptive jitter stripping device for a laser gyro according to claim 5, It is characterized in that The second filter is an adaptive FIR filter, and the third filter is a FIR filter.
7. The adaptive jitter stripping device for a laser gyro according to claim 6, It is characterized in that Also includes: The orthogonal decoder performs orthogonal decoding on the signal output by the laser gyro to obtain the output increment X 2 (n).
8. The adaptive jitter stripping device for a laser gyro according to claim 6, It is characterized in that Also includes: The signal modulator, whose receiver shakes the jitter signal X output by the jitter feedback mechanism of the laser gyro 1 (n), and modulate; ADC collector, which outputs the jitter signal X of the signal modulator 1 (n) collecting data; The bandpass IIR filter receives the jitter signal collected by the ADC collector. 1 (n) to remove DC noise and high-order harmonics.
