A method for compensating component-level rotation modulation angular rate measurement error of a magnetically suspended gyroscope
By using a motor to drive the torque stator to rotate and perform component-level rotation modulation in the magnetic levitation gyro, the drift error of the angular rate measurement constant value of the gyro is eliminated, the measurement accuracy is improved, and the gyro angular rate output frequency and torque stator under rotation modulation are solved. The contradiction between the rotation frequency achieves high-precision angular rate measurement.
Patent Information
- Application Number
- CN202210696472.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-06-20
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2042-06-20
AI Technical Summary
Under the system-level rotation modulation, the magnetic levitation gyro has problems such as large components and large weight, which leads to limited accuracy of angular rate measurement and difficult to eliminate constant drift errors, affecting navigation accuracy.
The motor drives the torque stator to rotate stably, realize component-level rotation modulation, rotate and demodulate the current signal of the Lorentz coil, solve the integral to obtain the angle measurement results, and eliminate the angular velocity of the gyroscope through the angle signal guidance and sliding smoothing processing. The constant drift error improves measurement accuracy.
It effectively eliminates the constant drift error of the gyroscope's angular rate measurement, so that the measurement accuracy depends only on the random drift error, and improves the angular rate output frequency to meet navigation needs.
Smart Images

Figure CN115164860B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a method for compensating an error in measuring a magnetically suspended gyroscope component-level rotation modulation angular velocity, which is suitable for measuring the attitude angular motion information of a spacecraft using a magnetically suspended gyroscope that controls rotor deflection in two degrees of freedom through a Lorentz force magnetic bearing. Technical Background
[0002] As an inertial sensitive mechanism, the gyroscope plays an important role in the field of navigation. The magnetically suspended gyroscope can calculate the angular motion of the gyroscope relative to the inertial space by detecting the rotor control signal and combining the conservation of rotor angular momentum. The gyroscope controls the deflection of the magnetically suspended rotor in two degrees of freedom through the Lorentz force magnetic bearing. Since the output torque of the Lorentz force magnetic bearing is proportional to the current, the gyroscope has the advantages of high precision, high dynamics, and fast response. At the same time, by detecting the current in the Lorentz coil and the angular displacement of the rotor relative to the gyroscope room, the angular velocity of the two degrees of freedom of the gyroscope can be calculated.
[0003] In order to improve the angular rate measurement accuracy of the gyro, Xin Chaojun established a disturbance torque model for the stator drift error and proposed that ensuring the machining accuracy of the rotor double sphere and the angular displacement control accuracy is an effective measure to reduce the stator drift error. However, the machining process and the accuracy of the public office are limited, so this error has not been fundamentally eliminated. Ren Yuan proposed a magnetic suspension control sensitive gyro four-cross configuration to achieve high-precision measurement of the spacecraft angular rate, but this method requires four gyros to work simultaneously, and will further introduce gyro individual difference errors.
[0004] Component-level rotation modulation is an effective means of realizing rotation modulation by adding a small amount of gyro structures to replace the turntable. Currently, component-level rotation modulation is mainly used to eliminate the angle measurement constant drift error of the sensitive gyro of magnetic suspension control. The method of the present invention realizes the compensation of the angular velocity constant drift error under component-level rotation modulation by deriving the angle of the gyro and sliding smoothing, thereby improving the gyro angular velocity measurement accuracy on the basis of ensuring the angular velocity output frequency. Summary of the invention
[0005] The technical problem solved by the present invention is: in view of the large volume and weight of the components required for system-level rotation modulation, a method for compensating the angular velocity measurement error of a magnetically suspended gyroscope component-level rotation modulation is proposed. The method can effectively eliminate the constant drift error of the angular velocity measurement of the gyroscope, and the angular velocity measurement accuracy of the gyroscope only depends on the random drift error of the gyroscope. The method effectively alleviates the contradiction between the angular velocity output frequency of the gyroscope and the rotation frequency of the torquer stator under rotation modulation.
[0006] The technical solution of the present invention:
[0007] The stator of the torquer is driven by a motor to rotate stably, so as to realize component-level rotation modulation of the current signal in the Lorentz coil; the current signal is rotationally demodulated according to the conversion matrix, and the demodulated signal is integrated to obtain the angle measurement result; the angle signal is derived and sliding smoothing is performed to realize the angular rate measurement error compensation of the gyroscope, which specifically includes the following steps:
[0008] (1) Component-level rotation modulation
[0009] Under component-level rotation modulation, the gyro two-degree-of-freedom angular rate measurement equation can be expressed as
[0010]
[0011] Where, Ι represents the current signal in the torquer coil; Θ represents the angular displacement signal of the gyro rotor relative to the stator; C m Represents OX in the gyro reference coordinate system s , O.Y. s The transformation matrix from the axis to the inertial space; ω represents the rotation angular rate of the torquer stator relative to the gyro reference coordinate system; ω m Represents OX in the gyro reference coordinate system s , O.Y. s The angular velocity of the two degrees of freedom of the axis relative to the inertial space; Represents ω m In the gyro reference frame OX s , O.Y. s Component on the axis; ε c represents the gyro constant drift error; ε cx , ε cy Represents ε c In the stator rotating coordinate system OX r , O.Y. r Component on the axis; ε r represents the gyro constant drift error; ε rx , ε ry Represents ε r In the stator rotating coordinate system OX r , O.Y. r Components on the axis;
[0012] (2) Solve for the gyro angles δ, θ
[0013] Rotate and demodulate equation (1) and solve it by integration to get
[0014]
[0015] Among them, δ and θ represent the gyro motion angle in the gyro reference coordinate system OX s , O.Y. s Components on the axis; It is C m The inverse matrix represents the inertial space to the gyro reference coordinate system OX s , O.Y. s The transformation matrix of the axis; T represents the rotation period of the torquer stator;
[0016] (3) Solving the gyro angular velocity
[0017] The angle in (2) is derived and smoothed by sliding to obtain
[0018]
[0019] (4) Angular rate measurement error of component-level rotation modulation
[0020]
[0021] Among them, ω e Represents the angular rate measurement error of the gyroscope.
[0022] Formula (1) shows that the angular velocity of the gyroscope can be calculated by detecting the current in the Lorentz coil and the angular displacement of the rotor relative to the gyroscope room. The angular velocity measurement error of the gyroscope mainly includes constant drift error and random drift error. In order to improve the angular velocity measurement accuracy of the gyroscope, the component-level rotation modulation of the gyroscope angular velocity measurement signal is realized by driving the stator of the Lorentz force magnetic bearing to rotate stably by the motor; the rotation demodulation is realized by the conversion matrix between coordinate systems, and the demodulated signal is integrated and solved to obtain the angular measurement result of the gyroscope; by derivation of the angle measurement result and sliding smoothing, the gyroscope realizes high-precision measurement under the guaranteed angular velocity measurement output frequency, and the gyroscope angular velocity measurement error expression under component-level rotation modulation is obtained.
[0023] It can be seen from the final angular rate measurement error expression of the gyroscope that this method can effectively eliminate the angular rate constant drift error. Its angular rate measurement accuracy only depends on the size of the angular rate random drift error when the stator is not rotating, and has nothing to do with the size of the angular rate constant drift error when the stator is not rotating. It can greatly improve the angular rate measurement accuracy of the gyroscope.
[0024] The inventive principle of the present invention is: by driving the torquer stator to rotate stably through a motor, component-level rotation modulation of the current signal in the Lorentz coil is realized; the current signal is rotationally demodulated according to the conversion matrix between coordinate systems, and the demodulated signal is solved and integrated to obtain the angle measurement result of the gyroscope; the angle signal is derived and sliding smoothing is performed to realize the angular velocity measurement error compensation of the gyroscope, thereby realizing high-precision angular velocity measurement of the gyroscope.
[0025] Since this method eliminates the constant drift error of the gyro angular rate measurement through rotation modulation, the gyro angular rate measurement error only comes from the random drift error. Due to the use of sliding smoothing processing, the gyro angular rate output frequency is not constrained by the torquer stator rotation frequency, effectively improving the gyro angular rate output frequency, thereby ensuring the navigation solution requirements.
[0026] Compared with the existing solutions, the solution of the present invention has the following main advantages: the constant drift error of the gyroscope's angular velocity is effectively eliminated through rotation modulation, and the high-frequency output of the gyroscope's angular velocity is ensured through sliding smoothing, thereby meeting navigation requirements. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] Figure 1 Specific implementation plan diagram;
[0028] Figure 2 Rotary modulation principle diagram;
[0029] Figure 3 Torque machine stator rotation structure diagram;
[0030] Figure 4 Comparison of gyro angular rate measurement errors before and after component-level rotation modulation at 1 Hz rotation speed;
[0031] Figure 5 Comparison of gyroscope angular rate measurement errors before and after component-level rotation modulation at 2 Hz. Specific implementation plan
[0032] Specific embodiments of the present invention are as follows Figure 1 As shown, the rotation modulation principle diagram and coordinate system diagram are as follows Figure 2 As shown, the specific implementation steps are as follows:
[0033] (1) Component-level rotation modulation
[0034] like Figure 3 This is a schematic diagram of the stator rotation structure of the Lorentz force magnetic bearing in the magnetic levitation control sensitive gyroscope. The Lorentz force magnetic bearing is used as a torque generator. The output torque is linearly related to the current in the Lorentz coil, so it can output high-dynamic and high-precision torque to the magnetic levitation rotor. The two-degree-of-freedom angular velocity of the gyroscope can be calculated by detecting the current in the Lorentz coil and the angular displacement information of the rotor relative to the stator. The Lorentz coil is installed on the Lorentz force magnetic bearing frame, so the component-level rotation modulation of the gyroscope can be achieved by driving the Lorentz force magnetic bearing frame with a motor.
[0035] Under component-level rotation modulation, the gyro two-degree-of-freedom angular rate measurement equation can be expressed as
[0036]
[0037] Where, Ι represents the current signal in the torquer coil; Θ represents the angular displacement signal of the gyro rotor relative to the stator; C m Represents OX in the gyro reference coordinate system s , O.Y. s The transformation matrix from the axis to the inertial space; ω represents the rotation angular rate of the torquer stator relative to the gyro reference coordinate system; ω m Represents OX in the gyro reference coordinate system s , O.Y. s The angular velocity of the two degrees of freedom of the axis relative to the inertial space; Represents ω m In the gyro reference frame OX s , O.Y. s Component on the axis; ε c represents the gyro constant drift error; ε cx , ε cy Represents ε c In the stator rotating coordinate system OX r , O.Y. r Component on the axis; ε r represents the gyro constant drift error; ε rx , ε ry Represents ε r In the stator rotating coordinate system OX r , O.Y. r Components on the axis;
[0038] (2) Solve for the gyro angles δ, θ
[0039] By multiplying both sides by the transformation matrix of the stator rotation coordinate system, we can get
[0040]
[0041] in It is C m The inverse matrix represents the inertial space to the gyro reference coordinate system OX s , O.Y. s The transformation matrix of the axis is expressed as
[0042]
[0043] Because the constant drift error does not change with time, the integral solution of the modulated constant drift error is 0. Therefore, the integral solution of both sides of (2) is 0, and the gyro angle measurement result is obtained by sorting out the integral solution of both sides.
[0044]
[0045] (3) Solving the gyro angular velocity
[0046] The gyroscope angle in equation (4) is derived and smoothed by sliding to obtain
[0047]
[0048] (4) Solving the gyro angular velocity
[0049] From equation (5), we can see that since the random drift error of the gyroscope changes with time, it is still not zero after integral solution of the whole cycle, so the angular rate measurement error of component-level rotation modulation is
[0050]
[0051] Among them, ω e Represents the angular rate measurement error of the gyroscope.
[0052] In order to verify the correctness and superiority of the method of the present invention, a comparative simulation was carried out under the same conditions between the method of the present invention and the case where the stator does not rotate. The angular rates of the two degrees of freedom of the MSCSG carrier are set to be ω m =0.1° / s, the constant drift errors of the two degrees of freedom are both set to 0.001° / s, the random drift errors of the two degrees of freedom are simulated by white noise, and the rotation frequencies of the torquer stator are 1Hz and 2Hz respectively.
[0053] Figure 4 and Figure 5 The comparison results of the angular velocity measurement errors when the stator rotation frequency is 1Hz and 2Hz are given respectively, where the horizontal axis represents time in seconds, and the vertical axis represents the angular velocity error in degrees / second. The angular velocity error is obtained by subtracting the measured value from the true value. Figure 4 and Figure 5 It can be obtained that when the stator does not rotate, the gyro's angular rate constant drift error is 0.001° / s. After component-level rotation modulation, the constant drift error can be reduced to 1.2×10 -6 ° / s, which basically eliminates the gyro's angular velocity constant drift error. At the same time, this method can also reduce the gyro's angular velocity random drift error. Therefore, the method of the present invention effectively improves the gyro's angular velocity measurement accuracy.
[0054] The contents not described in detail in this specification belong to the prior art known to the professionals in this field.
Claims
1. A method for compensating the measurement error of the component-level rotation modulation angular rate of a magnetically suspended gyroscope, characterized in that: The stator of the torquer is driven by the motor to rotate stably, thereby realizing component-level rotation modulation of the current signal in the Lorentz coil; The current signal is rotationally demodulated according to the conversion matrix, and the demodulated signal is integrated to obtain the angle measurement result; the angle signal is derived and sliding smoothing is performed to realize the gyroscope angular rate measurement error compensation, which specifically includes the following steps: (1) Component-level rotation modulation Under component-level rotation modulation, the gyro two-degree-of-freedom angular rate measurement equation can be expressed as Where, Ι represents the current signal in the torquer coil; Θ represents the angular displacement signal of the gyro rotor relative to the stator; C m Represents OX in the gyro reference coordinate system s , O.Y. s The transformation matrix from the axis to the inertial space; ω represents the rotation angular rate of the torquer stator relative to the gyro reference coordinate system; ω m Represents OX in the gyro reference coordinate system s , O.Y. s The angular velocity of the two degrees of freedom of the axis relative to the inertial space; Represents ω m In the gyro reference frame OX s , O.Y. s Component on the axis; ε c represents the gyro constant drift error; ε cx , ε cy Represents ε c In the stator rotating coordinate system OX r , O.Y. r Component on the axis; ε r represents the gyro constant drift error; ε rx , ε ry Represents ε r In the stator rotating coordinate system OX r , O.Y. r Components on the axis; (2) Solve for the gyro angles δ, θ Rotate and demodulate equation (1) and solve it by integration to get Among them, δ and θ represent the gyro motion angle in the gyro reference coordinate system OX s , O.Y. s Components on the axis; It is C m The inverse matrix represents the inertial space to the gyro reference coordinate system OX s , O.Y. s The transformation matrix of the axis; T represents the rotation period of the torquer stator; (3) Solving the gyro angular velocity By taking the derivative of both sides of equation (2) and performing sliding smoothing, we can obtain 2. The method for compensating the component-level rotation modulation angular rate measurement error of a magnetically suspended gyroscope according to claim 1, characterized in that: After the gyro is modulated by component-level rotation, the two-degree-of-freedom angular rate measurement error can be expressed as Among them, ω e Represents the angular rate measurement error of the gyroscope.
