Method for identifying position of outer ring of pendulum type integrating gyro accelerometer

By fitting the visual acceleration matrix expression and the least squares method, the absolute angular position of the outer ring of the pendulum integral gyro accelerometer is calculated, and closed-loop driving control is adopted to solve the problem of unknown and uncontrollable external ring position in the prior art. Improves the accuracy and application performance of the instrument.

CN119044539AActive Publication Date: 2024-11-29BEIJING INST OF AEROSPACE CONTROL DEVICES

Patent Information

Application Number
CN202411056257.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-02
Publication Date
2024-11-29
Estimated Expiration
2044-08-02

AI Technical Summary

Technical Problem

In the prior art, the pendulum integral gyroscope cannot provide absolute position information of the outer ring, resulting in errors in the output, affecting the accuracy of the instrument usage, especially when the power is out, the outer ring cannot be controlled to stop at the target position.

Method used

By obtaining the matrix expression of the apparent acceleration, the parameters C11, C21, and C31 are fitted using the least squares method to obtain the parameters C11, C21, and C31. Combining the precession angular velocity of the outer ring and the number of pulses, the starting angular position of the outer ring and the real-time absolute angular position are calculated, and Closed-loop drive is used to control the outer ring to stop at the specified angle.

Benefits of technology

The identification and control of the outer ring angular position of the pendulum integral gyro accelerometer is realized, which improves the accuracy and performance of the instrument and can accurately stop to the target position when the power is cut off.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119044539A_ABST
    Figure CN119044539A_ABST
Patent Text Reader

Abstract

The invention discloses a method for identifying the position of an outer ring of a pendulum type integrating gyro accelerometer. The method comprises the following steps: obtaining an expression of apparent acceleration; processing the expression of the apparent acceleration to obtain a matrix expression of the apparent acceleration; obtaining a plurality of outer ring precession angular velocities, and obtaining continuous record data according to the plurality of outer ring precession angular velocities; obtaining a plurality of outer ring precession angles, and obtaining continuous record data according to the plurality of outer ring precession angles; parameters C11, C21 and C31 in a matrix expression of the apparent acceleration are obtained according to the continuous recorded data, and an outer ring starting angle position is obtained according to the apparent acceleration and the parameters C11 and C21 sensed by a sensitive shaft of the pendulum-type integrating gyroscope accelerometer; and obtaining the real-time outer ring absolute angle position of the pendulum type integrating gyro accelerometer according to the outer ring starting angle position and the outer ring precession angle. The method solves the problem that the position of the outer ring of the pendulum-type integrating gyro accelerometer is unknown and cannot be controlled, and has the characteristics of rapidness, reliability and practicability.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the field of inertial technology, and in particular relates to a method for identifying the position of an outer ring of a pendulum-type integrating gyro accelerometer. Background Art

[0002] In high-precision mechanical inertial navigation systems, pendulum-type integrating gyro accelerometers are currently used to measure apparent acceleration in the direction of projection, which has the characteristics of high-precision navigation.

[0003] The pendulum-type integrating gyro accelerometer is a pendulum-type accelerometer that uses gyro torque for feedback. The working principle is shown in Figure 1 . Figure 1 In the figure, OX1Y1Z1 is the coordinate system fixed to the outer frame. OX1 is the acceleration output axis. The angle of rotation of the outer frame around the OX1 axis is called α, which is the angle of the outer frame relative to the instrument base. Oxyz is the Lecha coordinate system, which is fixed to the inner frame. Oz is the rotor axis, Oy is the inner ring axis of the float, and the inner ring angle refers to the angle of rotation of the float along the inner ring axis, which is called β, which is the angle of the inner frame relative to the outer frame. They are the angular velocity of the outer frame relative to the instrument base and the angular velocity of the inner frame relative to the outer frame. M is the apparent acceleration along the outer frame axis OX1 to which the pendulum-type integrating gyro accelerometer is sensitive. X1 is the combined disturbance torque of various disturbance torques around the outer frame axis. ml is the pendulum of the instrument along the inner frame axis. H is the angular momentum of the instrument rotor. M D is the torque of the torque motor. The instrument also includes an angle sensor, a servo digital control circuit, a torque motor and an output device.

[0004] When there is apparent acceleration When the instrument is along the outer frame axis OX1, the inner frame of the instrument generates an inertia moment In the ideal case where there is no interference torque on the inner and outer frames, according to the gyro precession principle, the rotor will precess along the OX1 direction with the inner and outer frames, and the precession angular velocity is Since the angular momentum H has a precession speed The inner frame generates a gyroscopic torque When reaching steady state, the moment of inertia Accurate gyroscopic torque The balance, that is

[0005] or

[0006] With zero as the initial condition, there is an ideal output:

[0007]

[0008] During the actual precession of the instrument, due to the interference torque on the outer frame axis The angular momentum H will slowly move toward The vector direction precesses, causing the rotation angle β of the inner frame relative to the outer frame to gradually increase. In order to ensure that the inner frame rotor axis can always be perpendicular to the outer frame axis (β≈0), it is necessary to try to eliminate Therefore, the pendulum-type integrating gyro accelerometer is designed with a servo control loop consisting of an angle sensor, a servo digital control circuit and a torque motor to eliminate the interference torque. Ensure that H is perpendicular to the outer frame axis OX1, and at the same time give the pendulum-type integrating gyro accelerometer the static and dynamic characteristics it should have. When the torque causes the angle β, the angle sensor will output an AC voltage signal proportional to the angle β. After amplification, demodulation, collection, and correction network transformation, it is fed to the torque motor to generate an angle proportional to the angle β. The electromagnetic torque M is equal in magnitude and opposite in direction D , to offset Interference is prevented so that H always remains perpendicular to the outer frame axis.

[0009] Figure 1 The output device is used to measure the angular velocity of the outer frame (also called the outer ring) of the pendulum-type integrating gyro accelerometer relative to the instrument base. The output device of the pendulum-type integrating gyro accelerometer consists of a variable reluctance rotary transformer (called a variable reluctance angle sensor) installed on an outer ring and an external output circuit. The variable reluctance rotary transformer has n pairs of poles and outputs n electrical cycles for one precession. The output circuit is responsible for processing the output signal of the variable reluctance rotary transformer into positive and negative pulse signals for output. The number of pulses per unit time represents the magnitude of the angular velocity. The positive pulse represents the positive angular velocity, and the outer ring rotates positively. The negative pulse represents the negative angular velocity, and the outer ring rotates negatively. Since the variable reluctance rotary transformer does not have absolute position information, the output device of the prior art pendulum-type integrating gyro accelerometer provides the relative position of the outer ring, but cannot provide the absolute angular position of the outer ring. The absolute position of the outer ring and the float on the outer frame cannot be obtained when the power is on and the precession is stopped, or when the power is off and stopped.

[0010] In the actual application of the pendulum-type integrating gyro accelerometer, there are processing errors and installation errors in the variable reluctance rotary transformer. These errors are precession-periodic with the position of the outer ring, as well as other errors related to the position of the outer ring. Because there is no absolute position information of the outer ring, it is impossible to establish a relationship to compensate for these errors in the output pulse, resulting in errors in the output of the output device of the pendulum-type integrating gyro accelerometer, affecting the accuracy of the instrument. If the errors related to the position of the outer ring can be compensated, the accuracy of the instrument can be improved. In addition, in actual applications, users pay attention to the outer ring position of the pendulum-type integrating gyro accelerometer at the time of power-on and power-off, especially the outer ring of the pendulum-type integrating gyro accelerometer that can control the horizontal attitude to stop at the target position at the time of power-off. However, the existing technology is powerless to do this. Summary of the invention

[0011] The technical problem solved by the present invention is: to overcome the shortcomings of the prior art, to provide a method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer, to solve the problem that the outer ring position of the pendulum-type integrating gyro accelerometer is unknown and uncontrollable, and to have the characteristics of being fast, reliable and practical, and to improve the engineering accuracy of the pendulum-type integrating gyro accelerometer.

[0012] The object of the present invention is achieved by the following technical scheme: a method for identifying the position of the outer ring of a pendulum-type integrating gyro accelerometer, comprising: obtaining an expression of the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer; processing the expression of the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer to obtain a matrix expression of the apparent acceleration; and calculating the matrix expression of the apparent acceleration according to the timing counting result V N The number of full-circle pulses Q of the pendulum-type integrating gyro accelerometer is used to obtain the angular velocity of multiple outer rings Continuously recorded data A is obtained based on the precession angular velocity of multiple outer rings N*1 ;According to the cumulative value of the comprehensive pulse number P N The number of pulses Q of the pendulum-type integrating gyro accelerometer in a full circle is used to obtain multiple outer ring precession angles α N , according to the multiple outer ring precession angles, the continuously recorded data B is obtained N*3 ; Based on the continuous recording data A N*1 and continuously record data B N*3 , the parameter C in the matrix expression of apparent acceleration is obtained by fitting using the least squares method 11 , C 21 , C 31 According to the apparent acceleration a and parameter C of the sensitive axis of the pendulum-type integrating gyro accelerometer, 11 , C 21 Get the starting angle position of the outer ring According to the starting angle position of the outer ring and the outer ring precession angle α N Get the real-time absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer

[0013] In the above-mentioned method for identifying the outer ring position of the pendulum-type integrating gyro accelerometer, the expression of the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is:

[0014]

[0015] Among them, a is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, α is the precession angle of the outer ring axis of the outer frame, β is the inner ring angle, θ is the angle between the outer ring axis of the outer frame and the horizontal, g0 is the gravitational acceleration, It is the angle between the rotor axis and the OX1Z1 plane at the moment of power-on.

[0016] In the above-mentioned method for identifying the outer ring position of the pendulum-type integrating gyro accelerometer, the matrix expression of the apparent acceleration is:

[0017] A=C 11 sin(α)+C 21 cos(α)+C 31 =B*C;

[0018] A=a;

[0019] B = [sin(α)cos(α)1];

[0020] C=[C 11 C 21 C 31 ] T ;

[0021]

[0022] C 31 = sin(θ)*cos(β)*g0;

[0023] Among them, a is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, α is the precession angle of the outer ring axis of the outer frame, β is the inner ring angle, θ is the angle between the outer ring axis of the outer frame and the horizontal, g0 is the gravitational acceleration, is the angle between the rotor axis and the OX1Z1 plane at the moment of power-on; A is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, which is another expression of a; B is the coordinate transformation matrix of the rotation α around the outer ring axis of the outer frame, and C is the coordinate transformation matrix of C 11 , C 21 , C 31 The 3×1 matrix, C 11 is the first acceleration input component of the gravitational acceleration g0 at OX1 caused by angle β, C 21 is the second acceleration input component of the gravitational acceleration g0 in OZ1 caused by the angle β, C31 It is the acceleration input caused by angle β of the component of gravitational acceleration g0 at OX1.

[0024] In the above-mentioned outer ring position identification method of the pendulum-type integrating gyro accelerometer, the outer ring precession angular velocity It is obtained by the following formula:

[0025]

[0026] in, is the angular velocity of the outer ring, V N is the timing counting result, Q is the number of pulses in a full circle of the pendulum integrating gyro accelerometer, and N is the time series.

[0027] In the above-mentioned pendulum-type integrating gyro accelerometer outer ring position identification method, data A is continuously recorded. N*1 It is obtained by the following formula:

[0028]

[0029] Among them, A N*1 To continuously record data, is the outer ring precession angular velocity, is the angular velocity of the outer ring precession recorded when the time series is 1, and N is the time series.

[0030] In the above-mentioned outer ring position identification method of the pendulum-type integrating gyro accelerometer, the outer ring precession angle α N It is obtained by the following formula:

[0031]

[0032] Among them, α N is the precession angle of the outer ring, P N is the cumulative value of the comprehensive pulse number, Q is the number of pulses in a full circle of the pendulum integrating gyro accelerometer, and N is the time series.

[0033] In the above-mentioned pendulum-type integrating gyro accelerometer outer ring position identification method, data B is continuously recorded. N*3 It is obtained by the following formula:

[0034]

[0035] Among them, B N*3 To continuously record data, α N is the precession angle of the outer ring, α1 is the precession angle of the outer ring recorded when the time series is 1, and N is the time series.

[0036] In the above-mentioned method for identifying the outer ring position of the pendulum-type integrating gyro accelerometer, the parameter C 11 , C 21 , C31 It is obtained by the following formula:

[0037] C=(B N*3 '*B N*3 ) -1 *B N*3 '*A N*1 ;

[0038] C=[C 11 C 21 C 31 ] T ;

[0039] Among them, A N*1 To continuously record data, B N*3 To continuously record data, C is the 11 , C 21 , C 31 The 3×1 matrix, C 11 is the first acceleration input component of the gravitational acceleration g0 at OX1 caused by angle β, C 21 is the second acceleration input component of the gravitational acceleration g0 in OZ1 caused by the angle β, C 31 It is the acceleration input caused by angle β of the component of gravitational acceleration g0 at OX1.

[0040] In the above-mentioned outer ring position identification method of the pendulum-type integrating gyro accelerometer, the outer ring starting angular position It is obtained by the following formula:

[0041]

[0042] in, is the starting angle position of the outer ring, C 11 is the first acceleration input component of the gravitational acceleration g0 at OX1 caused by angle β, C 21 It is the second acceleration input component caused by angle β of the component of gravity acceleration g0 at OZ1.

[0043] In the above-mentioned outer ring position identification method of the pendulum-type integrating gyro accelerometer, the real-time outer ring absolute angular position of the pendulum-type integrating gyro accelerometer is It is obtained by the following formula:

[0044]

[0045] in, is the real-time absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer, is the starting angle position of the outer ring, α N is the outer ring precession angle.

[0046] Compared with the prior art, the present invention has the following beneficial effects:

[0047] The present invention takes into account that the output pulse of the outer ring output device of the gyro accelerometer contains errors such as processing and installation related to the precession period (angle α) of the outer ring, and the use requirements of controlling the angular position of the outer ring when the instrument is in a horizontal attitude, and provides a method for identifying the absolute angular position of the outer ring of a pendulum-type integrating gyro accelerometer, identifies the angular position α of the outer ring, and further provides a method for controlling the outer ring to stop at a target position when the pendulum-type integrating gyro accelerometer is powered off. Compared with the engineering application of the prior art in which the α angle of the outer ring position is unknown and the outer ring position cannot be controlled, and there is no basic condition for establishing an error model and compensation related to the α angle, the present invention proposes for the first time a method for identifying and controlling the angular position of the outer ring of a pendulum-type integrating gyro accelerometer, the angular position α of the outer ring can be known during the power-on test of the pendulum-type integrating gyro accelerometer, and the outer ring can be controlled to stop at the target position when the power is off, laying a foundation for establishing an error model and error compensation related to the α angle, which is beneficial to improving the accuracy and performance of the engineering application of the pendulum-type integrating gyro accelerometer. BRIEF DESCRIPTION OF THE DRAWINGS

[0048] Various other advantages and benefits will become apparent to those of ordinary skill in the art by reading the detailed description of the preferred embodiments below. The accompanying drawings are only for the purpose of illustrating the preferred embodiments and are not to be considered as limiting the present invention. Moreover, the same reference symbols are used throughout the accompanying drawings to represent the same components. In the accompanying drawings:

[0049] Figure 1 It is a schematic diagram of a pendulum-type integrating gyro accelerometer in the prior art;

[0050] Figure 2 1. It is a diagram of a closed-loop control implementation scheme for the angular position of the outer ring of a pendulum-type integrating gyro accelerometer provided in an embodiment of the present invention;

[0051] Figure 3 Schematic diagram of a pendulum-type integrating gyro accelerometer provided by an embodiment of the present invention with the rotor axis facing upward at a small angle;

[0052] Figure 4 It is a schematic diagram of a pendulum-type integrating gyro accelerometer provided in an embodiment of the present invention with the rotor axis facing the ground at a small angle. DETAILED DESCRIPTION

[0053] Exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. Although exemplary embodiments of the present disclosure are shown in the accompanying drawings, it should be understood that the present disclosure can be implemented in various forms and should not be limited by the embodiments set forth herein. On the contrary, these embodiments are provided in order to enable a more thorough understanding of the present disclosure and to be able to fully convey the scope of the present disclosure to those skilled in the art. It should be noted that, in the absence of conflict, the embodiments of the present invention and the features described in the embodiments can be combined with each other. The present invention will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

[0054] This embodiment provides a method for identifying the position of an outer ring of a pendulum-type integrating gyro accelerometer, the method comprising:

[0055] Step S1: Obtain an expression for the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer.

[0056] The expression of apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is:

[0057]

[0058] Among them, a is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, α is the precession angle of the outer ring axis of the outer frame, β is the inner ring angle, θ is the angle between the outer ring axis of the outer frame and the horizontal, g0 is the gravitational acceleration, is the angle between the rotor shaft and the OX1Z1 plane at the time of power-on, i.e. the starting angular position of the outer ring

[0059] Step S2: Processing the expression of the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer to obtain a matrix expression of the apparent acceleration.

[0060] The matrix expression of apparent acceleration is:

[0061] A=C 11 sin(α)+C 21 cos(α)+C 31 =B*C;

[0062] A=a;

[0063] B = [sin(α)cos(α)1];

[0064] C=[C 11 C 21 C 31 ] T ;

[0065]

[0066] C 31= sin(θ)*cos(β)*g0;

[0067] Among them, a is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, α is the precession angle of the outer ring axis of the outer frame, β is the inner ring angle, θ is the angle between the outer ring axis of the outer frame and the horizontal, g0 is the gravitational acceleration, is the angle between the rotor axis and the OXZ plane at the moment of power-on; A is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, which is another expression of a; B is the coordinate transformation matrix of α rotation around the outer ring axis of the outer frame; C is the coordinate transformation matrix of C 11 , C 21 , C 31 The 3×1 matrix composed of 11 The first acceleration input component caused by the angle β of the gravitational acceleration g0 at OX1 is related to the starting angular position of the outer ring. Sinusoidal relationship; C 21 The second acceleration input component caused by the angle β of the gravity acceleration g0 in OZ1 is related to the starting angular position of the outer ring. Into a cosine relationship; C 31 It is the acceleration input caused by angle β of the component of gravitational acceleration g0 at OX1.

[0068] Step S3: According to the timing counting result V N The number of full-circle pulses Q of the pendulum-type integrating gyro accelerometer is used to obtain the angular velocity of multiple outer rings Continuously recorded data A is obtained based on the precession angular velocity of multiple outer rings N*1 ;According to the cumulative value of the comprehensive pulse number P N The number of pulses Q of the pendulum-type integrating gyro accelerometer in a full circle is used to obtain multiple outer ring precession angles α N , according to the multiple outer ring precession angles, the continuously recorded data B is obtained N*3 .

[0069] Outer ring precession angular velocity It is obtained by the following formula:

[0070]

[0071] in, is the angular velocity of the outer ring, V N is the timing counting result, Q is the number of pulses of the pendulum integrating gyro accelerometer in a full circle, N is the time series, N = 1, 2, 3...

[0072] Continuously record data A N*1 It is obtained by the following formula:

[0073]

[0074] Among them, AN*1 To continuously record data, is the outer ring precession angular velocity, is the angular velocity of the outer ring precession recorded when the time series is 1, and N is the time series.

[0075] Outer ring precession angle α N It is obtained by the following formula:

[0076]

[0077] Among them, α N is the precession angle of the outer ring, P N is the cumulative value of the comprehensive pulse number, Q is the number of pulses in a full circle of the pendulum integrating gyro accelerometer, and N is the time series.

[0078] Continuously record data B N*3 It is obtained by the following formula:

[0079]

[0080] Among them, B N*3 To continuously record data, α N is the outer ring precession angle, α1 is the outer ring precession speed recorded when the time series is 1, and N is the time series.

[0081] Step S4: Based on the continuous recording data A N*1 and continuously record data B N*3 , the parameter C in the matrix expression of apparent acceleration is obtained by fitting using the least squares method 11 , C 21 , C 31 According to the apparent acceleration a and parameter C of the sensitive axis of the pendulum-type integrating gyro accelerometer, 11 , C 21 Get the starting angle position of the outer ring

[0082] Parameter C 11 , C 21 , C 31 It is obtained by the following formula:

[0083] C=(B N*3 '*B N*3 ) -1 *B N*3 '*A N*1 ;

[0084] C=[C 11 C 21 C 31 ] T ;

[0085] Among them, AN*1 To continuously record data, B N*3 is to continuously record data; C is the 11 , C 21 , C 31 The 3×1 matrix composed of 11 The first acceleration input component caused by the angle β of the gravitational acceleration g0 at OX1 is related to the starting angular position of the outer ring. Sinusoidal relationship; C 21 The second acceleration input component 2 caused by the angle β of the gravity acceleration g0 in OZ1 is related to the starting angular position of the outer ring. Into a cosine relationship; C 31 It is the acceleration input caused by angle β of the component of gravitational acceleration g0 at OX1.

[0086] Outer ring starting angle position It is obtained by the following formula:

[0087]

[0088] in, is the starting angle position of the outer ring; C 11 The first acceleration input component caused by the angle β of the gravitational acceleration g0 at OX1 is related to the starting angular position of the outer ring. Sinusoidal relationship; C 21 The second acceleration input component caused by the angle β of the gravity acceleration g0 in OZ1 is related to the starting angular position of the outer ring. A cosine relationship.

[0089] Step S5: According to the starting angle position of the outer ring and the outer ring precession angle α N Get the real-time absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer

[0090] Real-time outer ring absolute angular position of pendulum-type integrating gyro accelerometer It is obtained by the following formula:

[0091]

[0092] in, is the real-time absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer, is the starting angle position of the outer ring, α N is the outer ring precession angle.

[0093] Specifically, step 1: in the gravity field, after the pendulum-type integrating gyro accelerometer is powered on, its attitude is adjusted to a small angle tilt state (the angle θ between the outer ring axis of the outer frame and the horizontal is 0.5° to 10°). After the coordinate transformation is performed through the direction cosine matrix, the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is:

[0094]

[0095] in,

[0096] α is the precession angle of the outer ring axis of the outer frame, with the inner ring axis in the OXY plane as the starting position (α = 0);

[0097] β is the inner ring angle, which is a fixed value;

[0098] θ is the angle between the outer ring axis of the outer frame and the horizontal, which is a fixed value;

[0099] g0 is the acceleration due to gravity;

[0100] It is the angle between the rotor axis and the OXZ plane at the moment of power-on.

[0101] Step 2: Based on equation 1 in step 1, expand equation 1 through trigonometric functions and difference formulas to obtain a new expression:

[0102]

[0103] in:

[0104]

[0105] C 31 =sin(θ)*cos(β)*g0. Formula 5

[0106] Transform equation 2 into a matrix expression:

[0107] A=C 11 sin(α)+C 21 cos(α)+C 31 =B*C Formula 6

[0108] in,

[0109] A = a, is the sensitive apparent acceleration;

[0110] B = [sin(α)cos(α)1];

[0111] C=[C 11 C 21 C 31 ] T .

[0112] Step 3: According to the inner loop angle β in step 2, the servo digital control circuit controls the closed loop to 10 arc minutes. Assume that the cumulative value of the integrated pulse number is P, P = 0 at initialization, and the number of pulses of the pendulum-type integrating gyro accelerometer in a full circle is Q. From the beginning of the outer loop, the timing counting test is synchronized, the timing time is 1s, and the timing counting result is recorded as V N , the angular velocity of the outer ring precession per second is recorded as At the same time, the pulse increment is calculated:

[0113] P N =P N-1 +V N Formula 7

[0114] Among them, P N P is the cumulative value of the number of comprehensive pulses recorded in time series N; N-1 It is the cumulative value of the number of comprehensive pulses recorded at time series N-1, where N is the time series.

[0115] Calculate the outer ring precession angular velocity:

[0116]

[0117] Calculate the precession angle of the outer ring:

[0118]

[0119] Continuously record data:

[0120]

[0121] Where N is the time series.

[0122] Step 4: According to the cumulative value P of the comprehensive pulse number in step 3 N , when P N ≥Q, N is a value greater than 60, and the solution can be performed as follows. Based on the data A in step 3 N*1 and B N*3 , use the least squares method to fit the parameter C in step 2 11 , C 21 , C 31 , that is, according to C=(B N*3 '*B N*3 ) -1 *B N*3 '*A N*1 Calculation coefficient C = [C 11 C 21 C 31 ] T , get the starting angle position of the outer ring

[0123] Step 5: According to the outer ring starting angle position in step 4 And the outer ring precession angle α in step 3 N ,pass Calculate the real-time absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer (Range 0°~360°). The above realizes the identification of the absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer.

[0124] Step 6: When the pendulum-type integrating gyro accelerometer is powered off, first adjust its attitude to a small angle tilt state (the angle θ between the outer ring axis of the outer frame and the horizontal is 0.5°~10°), and then adjust the outer ring absolute angular position according to the real-time absolute angular position of the outer ring in step 5. When approaching the specified angular position (within a distance of 0.05° to 1°), the attitude of the pendulum-type integrating gyro accelerometer is adjusted to be horizontal, and the outer ring of the pendulum-type integrating gyro accelerometer stops precessing and stops at the specified angular position, thereby realizing the control of the absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer.

[0125] After the pendulum-type integrating gyro accelerometer is powered on, the absolute angular position of the outer ring is identified, and when the power is turned off, the outer ring is controlled to move to the target absolute angular position.

[0126] The absolute angular position identification method of the outer ring of the pendulum-type integrating gyro accelerometer is based on the variable reluctance rotary transformer as the outer ring angular position sensor, which cannot provide zero position information, and the outer ring output device formed by the output circuit cannot provide absolute position information. In this case, the starting angular position of the pendulum-type integrating gyro accelerometer relative to the outer ring at the power-on time (with the rotor axis as the reference) can be obtained through the identification method, and then the outer ring angular position of the entire power-on test process can be obtained in real time, such as Figure 2 shown.

[0127] The starting angle position of the outer ring of the gyro accelerometer is defined as being on the rotor axis, and the angle of precession clockwise around the outer ring axis is positive. For a pendulum-type integrating gyro accelerometer installed at a certain small angle θ in the gravitational field, after using the direction cosine matrix for coordinate transformation, the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is:

[0128] a=g0*(sin(α)*cos(θ)*sin(β)+sin(θ)*cos(β))

[0129] in:

[0130] α is the precession angle of the outer ring axis of the outer frame, with the inner ring axis in the OXY plane as the starting position (α = 0);

[0131] β is the inner ring angle, which is a fixed value;

[0132] θ is the angle between the outer ring axis of the outer frame and the horizontal, which is a fixed value;

[0133] g0 is the acceleration due to gravity.

[0134] At the moment of power-on, the initial position of the outer ring of the pendulum integrating gyro accelerometer Unknown, it becomes:

[0135]

[0136] in, It is the angle between the rotor axis and the OX1Z1 plane at the moment of power-on.

[0137] Expand, get

[0138]

[0139] in:

[0140]

[0141] C 31 =sin(θ)*cos(β)*g0

[0142] The outer ring of the pendulum-type integrating gyro accelerometer precesses for one week to obtain the angular velocity data (timing count) at equal time intervals for one week, and the C in the above formula is obtained by fitting using the least squares method. 11 , C 21 , C 31 When the pendulum-type integrating gyro accelerometer is set to be horizontally tilted toward the sky, the starting position of the outer ring of the pendulum-type integrating gyro accelerometer is calculated according to the following formula according to the axis system of the pendulum-type integrating gyro accelerometer:

[0143]

[0144] Comprehensive consideration C 11 , C 21 Symbol, can identify the starting position of the full range within ±180°

[0145] After the pendulum-type integrating gyro accelerometer is powered on in any posture, the pendulum-type integrating gyro accelerometer is adjusted to a small angle tilt state, that is, the angle between the outer ring axis and the horizontal is between 0° and 10°. The servo digital control circuit controls the inner ring axis angle β of the pendulum-type integrating gyro accelerometer to the target position in a closed loop. In principle, the larger the better. Generally, the angle is graded to tens of arc minutes. Assume that the cumulative value of the number of integrated pulses is P. When initialized, P=0. The number of pulses of the pendulum-type integrating gyro accelerometer in a whole circle is Q. Start to close the servo control loop to allow the outer ring to precess and synchronize the timing counting test. The timing time is 1s, and the timing counting result is recorded as V N, the angular velocity of the outer ring precession per second is recorded as

[0146] At the same time, the pulse increment is calculated:

[0147] P N =P N-1 +V N

[0148] Among them, P N P is the cumulative value of the number of comprehensive pulses recorded in time series N; N-1 It is the cumulative value of the number of comprehensive pulses recorded at time series N-1, where N is the time series.

[0149] Calculate the outer ring precession angular velocity:

[0150]

[0151] Calculate the precession angle of the outer ring:

[0152]

[0153] Continuously record data:

[0154]

[0155] Where N is the time series 1, 2, 3…

[0156] When P N When ≥Q, the outer loop starting angular position is calculated. The integrated pulse P is accumulated throughout the power-on process.

[0157] According to C=(B N*3 '*B N*3 ) -1 *B N*3 '*A N*1 Calculation coefficient C = [C 11 C 21 C 31 ] T , get the starting angle position of the outer ring Further obtain the real-time angular position of the outer ring (Range 0°~360°).

[0158] Based on the identification of the real-time absolute position of the outer ring, a closed-loop drive method is used to control the outer ring of the pendulum-type integrating gyro accelerometer to move to a specified angle position. During the test, the variable P that records the number of comprehensive pulses is retained to find the remainder of the whole circle, P = P% Q, and then continue to accumulate.

[0159] After the test project is completed, before power is turned off, the pendulum-type integrating gyro accelerometer is turned to a nearly horizontal posture through a dividing head or other mechanism. The angle θ can be 1° to 5°. The smaller the angle θ, the more accurate the stopping position. When the precession is close to the specified angle position (within a distance of 0.05° to 1°), the pendulum-type integrating gyro accelerometer is turned to a horizontal posture, and the outer ring of the pendulum-type integrating gyro accelerometer stops precessing and stops at the specified angle position.

[0160] Starting position After it is known, the real-time precession angle α of the outer ring of the pendulum-type integrating gyro accelerometer is obtained by dividing the total number of comprehensive pulses P (total number of positive pulses - total number of negative pulses) output by the output device in real time by the number of pulses N in a full circle. Get the absolute position of the outer ring of the pendulum integrating gyro accelerometer.

[0161] Based on the identification of the real-time absolute position of the outer ring, a closed-loop drive method is used to control the outer ring of the pendulum integrating gyro accelerometer to move to a specified angle position.

[0162] First, turn the pendulum integrating gyro accelerometer to a nearly horizontal posture. According to the real-time absolute position of the outer ring, wait for it to precess to a position close to the specified angle. Then turn the pendulum integrating gyro accelerometer to a horizontal posture. The outer ring of the pendulum integrating gyro accelerometer will no longer precess and will stop at about the specified angle.

[0163] When the pendulum-type integrating gyro accelerometer is used on a moving carrier, the pendulum-type integrating gyro accelerometer is sensitive to the apparent acceleration along the outer ring axis X1. When the inner ring axis has an angle β, the float sensitive axis direction X2 does not coincide with the outer ring axis direction X1 of the pendulum-type integrating gyro accelerometer, which results in a certain difference in the apparent acceleration sensed by the pendulum-type integrating gyro accelerometer when the outer ring precesses to different angles. The pendulum-type integrating gyro accelerometer is installed at a certain small angle θ in the gravity field to simulate the acceleration oblique input in engineering applications. Figure 3 As shown, when the rotor axis Z2 is pointing upward, the apparent acceleration sensed by the pendulum-type integrating gyro accelerometer is a=g0*sin(θ+β); Figure 4 As shown, after rotating 180° around the X1 axis, when the rotor axis Z2 is pointing downward, the apparent acceleration sensed by the pendulum-type integrating gyro accelerometer is a=g0*sin(θ-β).

[0164] The starting angle position of the outer ring of the pendulum-type integrating gyro accelerometer is defined as being on the rotor axis, and the angle of precession clockwise around the outer ring axis is positive. For a pendulum-type integrating gyro accelerometer installed at a certain small angle θ in the gravitational field, after using the direction cosine matrix for coordinate transformation, the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is:

[0165] a=g0*(sin(α)*cos(θ)*sin(β)+sin(θ)*cos(β)) Equation 12

[0166] in:

[0167] α is the precession angle of the outer ring axis of the outer frame, with the inner ring axis in the OXY plane as the starting position (α = 0);

[0168] β is the inner ring angle, which is a fixed value;

[0169] θ is the angle between the outer ring axis of the outer frame and the horizontal, which is a fixed value;

[0170] g0 is the acceleration due to gravity.

[0171] At the moment of power-on, the initial position of the outer ring of the pendulum integrating gyro accelerometer If is unknown, then Equation 12 becomes:

[0172]

[0173] in, It is the angle between the rotor axis and the OX1Z1 plane at the moment of power-on.

[0174] Expanding equation 13, we get

[0175]

[0176] in:

[0177]

[0178] C 31 =sin(θ)*cos(β)*g0. Equation 17

[0179] Transform equation 14 into a matrix expression:

[0180] A=C 11 sin(α)+C 21 cos(α)+C 31 =B*C Formula 18

[0181] in,

[0182] A = a, is the sensitive apparent acceleration;

[0183] B = [sin(α)cos(α)1];

[0184] C=[C 11 C 21 C 31 ] T .

[0185] The outer ring of the pendulum-type integrating gyro accelerometer precesses for one week to obtain the angular velocity data (timing count) at equal time intervals for one week, and the C in the above formula is obtained by fitting using the least squares method. 11 , C 21 , C 31 When the pendulum-type integrating gyro accelerometer is set to be horizontally tilted toward the sky, the starting position of the outer ring of the pendulum-type integrating gyro accelerometer is calculated by dividing equation 15 and equation 16 according to the axis system of the pendulum-type integrating gyro accelerometer.

[0186]

[0187] Comprehensive consideration C 11 , C 21 Symbol, can identify the starting position of the full amount within ±180°

[0188] After the pendulum-type integrating gyro accelerometer is powered on in any posture, the pendulum-type integrating gyro accelerometer is adjusted to a small angle tilt state, that is, the angle between the outer ring axis and the horizontal is between 0° and 10°. The servo digital control circuit controls the inner ring axis angle β of the pendulum-type integrating gyro accelerometer to the target position in a closed loop. In principle, the larger the better. Generally, the angle is graded to tens of arc minutes. Assume that the cumulative value of the number of integrated pulses is P. When initialized, P=0. The number of pulses of the pendulum-type integrating gyro accelerometer in a whole circle is Q. Start to close the servo control loop to allow the outer ring to precess and synchronize the timing counting test. The timing time is 1s, and the timing counting result is recorded as V N , the angular velocity of the outer ring precession per second is recorded as

[0189] At the same time, the pulse increment is calculated:

[0190] P N =P N-1 +V N

[0191] Among them, P N P is the cumulative value of the number of comprehensive pulses recorded in time series N; N-1 is the cumulative value of the number of comprehensive pulses recorded at time series N-1, where N is time series 1, 2, 3, etc. Calculate the angular velocity of the outer ring precession:

[0192]

[0193] Calculate the precession angle of the outer ring:

[0194]

[0195] Continuously record data:

[0196]

[0197] Where N is the time series 1, 2, 3…

[0198] When P N When ≥Q, the outer loop starting angular position is calculated. The integrated pulse P is accumulated throughout the power-on process.

[0199] According to C=(B N*3 '*B N*3 ) -1 *B N*3 '*A N*1 Calculation coefficient C = [C 11 C 21 C 31 ] T , get the starting angle position of the outer ring Further obtain the real-time angular position of the outer ring (Range 0°~360°).

[0200] Based on the identification of the real-time absolute position of the outer ring, a closed-loop drive method is used to control the outer ring of the pendulum-type integrating gyro accelerometer to move to a specified angle position. During the test, the variable P that records the number of comprehensive pulses is retained to find the remainder of the whole circle, P = P% Q, and then continue to accumulate.

[0201] After the test project is completed, before power is turned off, the pendulum-type integrating gyro accelerometer is turned to a nearly horizontal posture through a dividing head or other mechanism. The angle θ can be 1° to 5°. The smaller the angle θ, the more accurate the stopping position. When the precession is close to the specified angle position (within a distance of 0.05° to 1°), the pendulum-type integrating gyro accelerometer is turned to a horizontal posture, and the outer ring of the pendulum-type integrating gyro accelerometer stops precessing and stops at the specified angle position.

[0202] This embodiment takes into account that the output pulse of the outer ring output device of the gyro accelerometer contains processing and installation errors related to the outer ring precession period (angle α), and considers the use requirements of controlling the outer ring angular position when the instrument is in a horizontal attitude, and provides a method for identifying the absolute angular position of the outer ring of a pendulum-type integrating gyro accelerometer, identifies the outer ring angular position angle α, and further provides a method for controlling the outer ring to stop at a target position when the pendulum-type integrating gyro accelerometer is powered off. Compared with the engineering application of the prior art where the outer ring position angle α is unknown and the outer ring position cannot be controlled, and there is no basic condition for establishing an error model and compensation related to the angle α, this embodiment first proposes a method for identifying and controlling the outer ring angular position of a pendulum-type integrating gyro accelerometer, the outer ring angular position angle α can be known during the power-on test of the pendulum-type integrating gyro accelerometer, and the outer ring can be controlled to stop at the target position when the power is off, laying a foundation for establishing an error model and error compensation related to the angle α, which is beneficial to improving the accuracy and performance of the engineering application of the pendulum-type integrating gyro accelerometer.

[0203] Although the present invention has been disclosed as above in the form of a preferred embodiment, it is not intended to limit the present invention. Any person skilled in the art may make possible changes and modifications to the technical solution of the present invention by using the methods and technical contents disclosed above without departing from the spirit and scope of the present invention. Therefore, any simple modifications, equivalent changes and modifications made to the above embodiments based on the technical essence of the present invention without departing from the content of the technical solution of the present invention shall fall within the protection scope of the technical solution of the present invention.

Claims

1. A method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer, characterized in that include: The expression of the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is obtained; The expression of apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is processed to obtain the matrix expression of apparent acceleration; According to the timing counting result and the number of full-circle pulses of the pendulum-type integrating gyro accelerometer, a plurality of outer ring precession angular velocities are obtained, and continuous recording data is obtained according to the plurality of outer ring precession angular velocities; According to the integrated pulse number cumulative value and the full circle pulse number of the pendulum-type integrating gyro accelerometer, a plurality of outer ring precession angles are obtained, and continuous recording data is obtained according to the plurality of outer ring precession angles; According to the continuous recording data and the continuous recording data, the parameter C in the matrix expression of the apparent acceleration is obtained by fitting using the least squares method. 11 , C 21 , C 31 , according to the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, parameter C 11 , C 21 Get the starting angle position of the outer ring; The real-time absolute angular position of the outer ring of the pendulum-type integrating gyro accelerometer is obtained according to the starting angular position of the outer ring and the precession angle of the outer ring.

2. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: The expression of apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer is: Among them, a is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, α is the precession angle of the outer ring axis of the outer frame, β is the inner ring angle, θ is the angle between the outer ring axis of the outer frame and the horizontal, g0 is the gravitational acceleration, It is the angle between the rotor axis and the OX1Z1 plane at the moment of power-on.

3. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: The matrix expression of apparent acceleration is: A=C 11 sin(a)+C 21 cos(α)+C 31 =B*C; A=a; B = [sin(α)cos(α)1]; C=[C 11 C 21 C 31 ] T ; C 31 =sin(θ)*cos(β)*g0; Among them, a is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, α is the precession angle of the outer ring axis of the outer frame, β is the inner ring angle, θ is the angle between the outer ring axis of the outer frame and the horizontal, g0 is the gravitational acceleration, is the angle between the rotor axis and the OX1Z1 plane at the moment of power-on; A is the apparent acceleration sensed by the sensitive axis of the pendulum-type integrating gyro accelerometer, which is another expression of a; B is the coordinate transformation matrix of the rotation α around the outer ring axis of the outer frame, and C is the coordinate transformation matrix of C 11 , C 21 , C 31 The 3×1 matrix, C 11 is the first acceleration input component of the gravitational acceleration g0 at OX1 caused by angle β, C 21 is the second acceleration input component of the gravitational acceleration g0 in OZ1 caused by the angle β, C 31 It is the acceleration input caused by angle β of the component of gravitational acceleration g0 at OX1.

4. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: Outer ring precession angular velocity It is obtained by the following formula: in, is the angular velocity of the outer ring, V N is the timing counting result, Q is the number of pulses in a full circle of the pendulum integrating gyro accelerometer, and N is the time series.

5. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: Continuously record data A N*1 It is obtained by the following formula: Among them, A N*1 To continuously record data, is the outer ring precession angular velocity, is the angular velocity of the outer ring precession recorded when the time series is 1, and N is the time series.

6. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: Outer ring precession angle α N It is obtained by the following formula: Among them, α N is the precession angle of the outer ring, P N is the cumulative value of the comprehensive pulse number, Q is the number of pulses in a full circle of the pendulum integrating gyro accelerometer, and N is the time series.

7. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: Continuously record data B N*3 It is obtained by the following formula: Among them, B N*3 To continuously record data, α N is the precession angle of the outer ring, α1 is the precession angle of the outer ring recorded when the time series is 1, and N is the time series.

8. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: Parameter C 11 , C 21 , C 31 It is obtained by the following formula: C=(B N*3 '*B N*3 ) -1 *B N*3 '*A N*1 ; C=[C 11 C 21 C 31 ] T ; Among them, A N*1 To continuously record data, B N*3 To continuously record data, C is the 11 , C 21 , C 31 The 3×1 matrix, C 11 is the first acceleration input component of the gravitational acceleration g0 at OX1 caused by angle β, C 21 is the second acceleration input component of the gravitational acceleration g0 in OZ1 caused by the angle β, C 31 It is the acceleration input caused by angle β of the component of gravitational acceleration g0 at OX1.

9. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: Outer ring starting angle position It is obtained by the following formula: in, is the starting angle position of the outer ring, C 11 is the first acceleration input component of the gravitational acceleration g0 at OX1 caused by angle β, C 21 It is the second acceleration input component caused by angle β of the component of gravity acceleration g0 at OZ1.

10. The method for identifying the outer ring position of a pendulum-type integrating gyro accelerometer according to claim 1, characterized in that: Real-time outer ring absolute angular position of pendulum-type integrating gyro accelerometer It is obtained by the following formula: in, is the real-time outer ring absolute angular position of the pendulum-type integrating gyro accelerometer, is the starting angle position of the outer ring, α N is the outer ring precession angle.

Citation Information

Patent Citations

  • Modeling method for pendulous integrating gyro accelerometer (PIGA) on basis of MAPLESIM

    CN104156596A

  • Self-calibration method and system for two-shaft frame type pendulous accelerometer

    CN108593966A

  • Accelerometer zero offset estimation method based on gravity apparent velocity and parameter identification

    CN109084755A

  • Gyro accelerometer output compensation method based on model parameter identification

    CN112611887A

  • Output compensation method of gyro accelerometer

    CN112630471A

Cited By

  • Method for compensating output error of pendulum type integrating gyro accelerometer

    CN120970627A

  • A method for compensating the output error of a pendulum integrator gyroscope accelerometer

    CN120970627B