CN112630471B - Output compensation method of gyro accelerometer - Google Patents
Output compensation method of gyro accelerometer Download PDFInfo
- Publication number
- CN112630471B CN112630471B CN202011461327.0A CN202011461327A CN112630471B CN 112630471 B CN112630471 B CN 112630471B CN 202011461327 A CN202011461327 A CN 202011461327A CN 112630471 B CN112630471 B CN 112630471B
- Authority
- CN
- China
- Prior art keywords
- gyro
- accelerometer
- acceleration
- gyro accelerometer
- shaft
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
- G01P15/14—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of gyroscopes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
- G01P15/18—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration in two or more dimensions
Abstract
The invention provides an output compensation method of a gyro accelerometer, which is based on time-varying input acceleration a x Lateral accelerationCalculating the real acceleration output value of the gyro accelerometer by adopting an error compensation method according to the size of the non-vertical angle beta; the calculated output acceleration value of the gyro accelerometer not only comprises a relevant item of the acceleration of the input shaft, but also comprises an error item introduced under the action of the transverse acceleration.
Description
Technical Field
The invention belongs to the technical field of high-precision apparent acceleration measurement, relates to accelerometer navigation calculation for an inertially stabilized platform, and particularly relates to an output compensation method for a gyro accelerometer.
Background
In a high-precision inertially stabilized platform, a quartz flexible accelerometer and a pendulum type integral gyro accelerometer are mainly adopted at present, the quartz flexible accelerometer and the pendulum type integral gyro accelerometer are both single-degree-of-freedom accelerometers, and each accelerometer is sensitive to the apparent acceleration in one direction.
A Pendulum Integral Gyro Accelerometer (PIGA) is a pendulum accelerometer using gyro moment for feedback, and its operation principle is shown in fig. 1 below. In the figure, OX 0 Y 0 Z 0 For a coordinate system fixedly connected to the outer frame, OX 0 Is an input shaft; oxyz is a Lei-Difference coordinate system, and an Oz axis is superposed with a rotor axis;the angular velocities of the outer frame relative to the instrument base (the shell of the pendulum-type integral gyro accelerometer) and the inner frame relative to the outer frame are respectively; a is x Apparent acceleration input for the instrument along the outer frame axis; ml ofThe pendulum property of the instrument along the inner frame shaft; h is the angular momentum of the instrument rotor; m x The sum of various interference moments around the outer frame shaft; m is a group of D Is the motor torque. The figure also comprises: 1-angle sensor, 2-amplifier, 3-torque motor, 4-output device.
As can be seen from fig. 1, such a gyroscopic accelerometer is similar in structure to a two-degree-of-freedom gyroscope: the gyro rotor is provided with an inner frame and an outer frame. An angle sensor is arranged at one end of the inner frame shaft, and an output device and a torque motor are respectively arranged at the upper end and the lower end of the outer frame shaft. Along the rotor axis Oz there is an eccentric mass m, the centre of mass of which is at a distance l from the inner frame axis, thus forming a pendulum ml around the inner frame axis.
When the instrument is along the outer frame axis OX 0 Direction apparent acceleration a x While, an inertia moment mla proportional to the apparent acceleration is generated on the inner frame shaft x . Under the ideal condition, that is, under the condition of that there is no any interference moment along the inner and outer frame shafts, according to the gyro precession principle, the rotor can drive the inner and outer frames to wind OX together 0 The shaft precessing at a precessional angular velocity ofAs a result of precession, a gyroscopic reaction moment is generated on the axis of the inner frameUnder steady state conditions, moment of inertia mla x Will be precisely torsioned by spinning topIs balanced, therefore, has OrUnder the zero initial condition, the ideal output value is obtained:
In order to ensure that H is vertical to the axis OX of the outer frame, the gyro accelerometer is additionally provided with a servo loop when suffering interference moment M x When the angle beta of the inner frame is not 0, the angle sensor outputs corresponding voltage signals, and the voltage signals are amplified and converted and then fed to the torque motor to generate a motor torque M Dx To counteract M x . It can be seen that the sensor of the servo loop is an inner frame angle sensor, and the measured value is β. Although the servo loop can keep the measured value β of the angle sensor at zero, it cannot be guaranteed that the rotor axis Oz and the outer frame axis OX are perpendicular to each other when there is a deviation in the mechanical zero position of the angle sensor, and for this reason, such non-perpendicular angle is collectively denoted by β. At this time, the output equation of the gyro accelerometer is:
in the formula 2, the first step is,is Y 0 Axis and Z 0 Lateral acceleration of the shaft; OX 0 Y 0 Z 0 Is a coordinate system fixedly connected with the base of the gyro accelerometer.
The above equation 2 is a transcendental equation, and needs to be simplified to give some local qualitative analysis expressions. In engineering applications, the angular velocity is output according to a gyro accelerometerThe method of calculating acceleration is a simplified equation:
however, the simplified method can cause the measurement error of the gyro accelerometer, thereby influencing the use precision of the instrument and directly causing the point-falling error of the navigation and guidance of the missile.
In order to further construct a measurement error model of the gyro accelerometer and improve the use precision through error compensation, the invention provides a novel output compensation method of the gyro accelerometer so as to improve the visual acceleration precision measurement capability of the gyro accelerometer.
Disclosure of Invention
The technical problem of the invention is solved: the method is used for calculating the accurate acceleration output value of the gyro accelerometer and has high accuracy.
The technical scheme provided by the invention is as follows:
an output compensation method of a gyro accelerometer comprises the following steps:
step (1), measuring a coordinate system OX of the gyro accelerometer fixedly connected with the base 0 Y 0 Z 0 Input acceleration a of x And lateral accelerationWherein, a x And OX 0 The directions of the axes are consistent with each other,and OY 0 The directions of the axes are consistent with each other,and OZ 0 The axial directions are consistent;and withIs a constant value;
measuring a non-vertical angle beta of an outer frame shaft and a rotor shaft of the gyro accelerometer;
step (3) according to Y in step (1) 0 Axis and Z 0 Transverse acceleration of the shaftDetermining the resultant accelerationAnd OY 0 The included angle gamma of the shaft satisfies:
at this time, at Y 0 Axis and Z 0 Transverse acceleration of the shaftThe differential equation of the gyro accelerometer in action is as follows:
in formula 6, m is the eccentric mass of the rotor, l is the eccentric distance of the rotor, H is the angular momentum of the instrument rotor, alpha is the rotation angle of the outer frame relative to the instrument base, referred to as the outer frame rotation angle for short,the angular velocity of rotation of the outer frame;
Step (5), setting the initial value of the outer frame angle alpha of the gyro accelerometer as alpha 0 For the angular velocity of the outer frame output by the gyro accelerometerCompensating to output OX 0 Acceleration on axis a x ’:
In the formula (9), the first and second groups,
t is time.
The output compensation method of the gyro accelerometer provided by the invention has the following beneficial effects:
the invention comprehensively considers the influence of the time-varying input shaft acceleration and the transverse acceleration of the gyro accelerometer on the output, and provides a method for accurately calculating the theoretical acceleration value of the gyro accelerometer by using the accelerations of the base in three orthogonal directions and the non-vertical angle beta between the outer frame shaft and the rotor shaft as known quantities. Compared with the existing linear output calculation method only considering the action of the input acceleration, the acceleration compensated by the gyro accelerometer is more accurate and comprehensive and has wider applicability.
Drawings
FIG. 1 is a schematic diagram of a gyroscopic accelerometer;
FIG. 2 is a flow chart of a gyro accelerometer output calculation of the present invention;
FIG. 3 shows a base axis X of a gyroscopic accelerometer of example 1 0 、Y 0 The value of the overload experienced;
FIG. 4 is a raw acceleration calculation for a gyroscopic accelerometer of example 1;
FIG. 5 is an acceleration error caused by the gyro accelerometer in example 1 using the original calculation method;
FIG. 6 is a calculated value of an accelerometer of a gyroscopic accelerometer of example 1 compensated using the present invention;
fig. 7 shows the calculation error of the compensated acceleration of the gyro accelerometer in example 1.
Detailed Description
The features and advantages of the present invention will become more apparent and appreciated from the following detailed description of the invention.
The invention provides an output compensation method of a gyro accelerometer, as shown in figure 2, according to an input acceleration a x 、Y 0 Axis and Z 0 Transverse acceleration of shaftAnd the size of the non-vertical angle beta, and calculating the real output of the gyro accelerometer by adopting different output models, wherein the method specifically comprises the following steps:
step (1), measuring a coordinate system OX of the gyro accelerometer fixedly connected with the base 0 Y 0 Z 0 Input acceleration a of x And lateral accelerationWherein, a x And OX 0 The directions of the axes are consistent with each other,and OY 0 The directions of the axes are consistent with each other,and OZ 0 The axial directions are consistent;andis a constant value;
measuring a non-vertical angle beta of an outer frame shaft and a rotor shaft of the gyro accelerometer;
step (3) according to Y in step (1) 0 Axis and Z 0 Transverse acceleration of the shaftDetermining the resultant accelerationAnd OY 0 The included angle gamma of the shaft satisfies:
at this time, at Y 0 Axis and Z 0 Transverse acceleration of shaftThe differential equation of the gyro accelerometer in action is as follows:
wherein m is the eccentric mass of the rotor, l is the eccentric distance of the rotor, H is the angular momentum of the rotor of the instrument, alpha is the rotation angle of the outer frame relative to the base of the instrument (namely the shell of the pendulum type integral gyro accelerometer), which is called the rotation angle of the outer frame for short,the angular velocity of rotation of the outer frame;
Step (5), setting the initial value of the outer frame angle alpha of the gyro accelerometer as alpha 0 For the angular velocity of the outer frame output by the gyro accelerometerCompensating to output OX 0 Acceleration on axis a x ' the method is as follows:
in the formula (I), the compound is shown in the specification,
t is time.
In the invention, in the step (1), the input acceleration a of the gyro accelerometer x And Y 0 Axis and Z 0 Transverse acceleration of the shaftBased on 3 orthogonally mounted quartz accelerometers with gyroscopic accelerometers mounted on the inertial platform bodyAnd (4) obtaining the amount.
In the invention, in the step (1), the gyro accelerometer can adopt an inclined installation mode relative to the thrust of the platform missile engine to ensure the input acceleration
In the invention, in the step (1), the input acceleration a of the gyro accelerometer x And Y 0 Axis and Z 0 Transverse acceleration of the shaftAcceleration with the amplitude less than or equal to 1g can be excited in the fixed orientation of the gravity field in a mode of inclining relative to the vector direction of the gravity acceleration.
In the invention, in the step (1), the input acceleration a of the gyro accelerometer x And Y 0 Axis and Z 0 Transverse acceleration of the shaftAccelerations with amplitudes greater than 1g can be excited at large overloads including centrifuge, rocket sledge, live-action flight.
In the invention, in the step (1), a gyro rotor of the gyro accelerometer can be realized by adopting dynamic pressure air flotation, liquid floating support and other modes, a bias pendulum structure of the gyro accelerometer can be realized by an eccentric pendulum structure, a shifting shaft type pendulum structure and other modes, and a carrier measured by the gyro accelerometer can be an airplane, a ship, a motor vehicle, a missile and the like.
In the invention, in the step (2), the non-perpendicular angle beta of the outer frame shaft and the rotor shaft of the gyro accelerometer is measured by the optical sighting mechanism of the static base.
Examples
Example 1
Is provided withβ=1000″,α 0 =π/4,When the theoretical acceleration a x 、In case of time-varying overload, as shown in FIG. 3, the two satisfy the relationIf according to the original calculation formula of the gyro accelerometerCalculation was performed with the output acceleration as shown in fig. 4; compared with fig. 3, the difference value between the theoretical acceleration value and the error value is shown in fig. 5, and it can be seen that the error is an alternating variable, the amplitude of the error becomes larger with the increase of the acceleration, and the maximum acceleration error can reach 0.05 g. The result of the compensation method of the present invention is shown in FIG. 6, in which the ordinate represents the acceleration a output from the gyro accelerometer x ', units are g; the difference between the two is shown in FIG. 7, and the error of the maximum acceleration is 0.0015 g. Therefore, the output result of the gyro accelerometer compensated by the method is more accurate.
The invention has been described in detail with reference to specific embodiments and illustrative examples, but the description is not intended to be construed in a limiting sense. Those skilled in the art will appreciate that various equivalent substitutions, modifications or improvements may be made to the technical solution of the present invention and its embodiments without departing from the spirit and scope of the present invention, which fall within the scope of the present invention. The scope of the invention is defined by the appended claims.
Those skilled in the art will appreciate that those matters not described in detail in the present specification are well known in the art.
Claims (7)
1. An output compensation method of a gyro accelerometer is characterized by comprising the following steps:
step (1), measuringOutput gyro accelerometer is along coordinate system OX that links firmly with base 0 Y 0 Z 0 Input acceleration a of x And lateral accelerationWherein, a x And OX 0 The directions of the axes are consistent with each other,and OY 0 The directions of the axes are consistent with each other,and OZ 0 The axial directions are consistent;andis a constant value;
measuring a non-vertical angle beta of an outer frame shaft and a rotor shaft of the gyro accelerometer;
step (3) according to Y in step (1) 0 Axis and Z 0 Transverse acceleration of the shaftTo determine the resultant accelerationAnd OY 0 The included angle gamma of the shaft satisfies:
at this time, at Y 0 Axis and Z 0 Transverse acceleration of the shaftThe differential equation of the gyro accelerometer in action is as follows:
in formula 6, m is the eccentric mass of the rotor, l is the eccentric distance of the rotor, H is the angular momentum of the rotor of the gyro accelerometer, alpha is the rotation angle of the outer frame relative to the base, referred to as the rotation angle of the outer frame for short,the angular velocity of rotation of the outer frame;
Step (5), setting an initial value of an outer frame rotation angle alpha of the gyro accelerometer as alpha 0 For the angular velocity of the outer frame output by the gyro accelerometerCompensating to output OX 0 Acceleration on axis a x ’:
In the formula (9), the first and second groups,
t is time.
2. The method for compensating the output of the gyro accelerometer according to claim 1, wherein in the step (1), the gyro accelerometer is mounted on an inertial platform body, and the input acceleration a of the gyro accelerometer is x And Y 0 Axis and Z 0 Transverse acceleration of the shaftMeasured from 3 orthogonally mounted quartz accelerometers on the inertial platform stage.
4. The output compensation method of the gyro-accelerometer according to claim 1, wherein in the step (1), the input acceleration a of the gyro-accelerometer is x And Y 0 Axis and Z 0 Transverse acceleration of the shaftIn a manner inclined with respect to the vector direction of gravitational accelerationAnd exciting the acceleration with the amplitude less than or equal to 1g in the fixed orientation of the gravity field.
5. The output compensation method of a gyro accelerometer according to claim 1, wherein in step (1), the input acceleration a of the gyro accelerometer is x And Y 0 Axis and Z 0 Transverse acceleration of the shaftThe acceleration with the amplitude larger than 1g is excited on the large overload including the centrifuge, the rocket sled and the live ammunition flying.
6. The output compensation method of the gyro accelerometer according to claim 1, wherein in the step (1), the gyro rotor of the gyro accelerometer is implemented by using a dynamic pressure air flotation or liquid floating support mode, and the yaw structure of the gyro accelerometer is implemented by using an eccentric pendulum structure or a tilt-shift pendulum structure.
7. The method for compensating the output of the gyro-accelerometer according to claim 1, wherein in the step (2), the non-perpendicular angle β of the outer frame axis and the rotor axis of the gyro-accelerometer is measured by a static base optical aiming mechanism.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011461327.0A CN112630471B (en) | 2020-12-11 | 2020-12-11 | Output compensation method of gyro accelerometer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011461327.0A CN112630471B (en) | 2020-12-11 | 2020-12-11 | Output compensation method of gyro accelerometer |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112630471A CN112630471A (en) | 2021-04-09 |
CN112630471B true CN112630471B (en) | 2022-09-27 |
Family
ID=75312281
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011461327.0A Active CN112630471B (en) | 2020-12-11 | 2020-12-11 | Output compensation method of gyro accelerometer |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112630471B (en) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105180936A (en) * | 2015-08-25 | 2015-12-23 | 北京航天控制仪器研究所 | Servo loop decoupling method of four-axle inertial stabilization platform system |
CN108710001A (en) * | 2018-04-28 | 2018-10-26 | 北京航天控制仪器研究所 | Two axis one gyroaccelerometers of one kind and method of servo-controlling |
CN110954137A (en) * | 2019-12-13 | 2020-04-03 | 陕西瑞特测控技术有限公司 | Method for correcting assembly error scalar quantity of inertial navigation accelerometer |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8005635B2 (en) * | 2007-08-14 | 2011-08-23 | Ching-Fang Lin | Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS) |
-
2020
- 2020-12-11 CN CN202011461327.0A patent/CN112630471B/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105180936A (en) * | 2015-08-25 | 2015-12-23 | 北京航天控制仪器研究所 | Servo loop decoupling method of four-axle inertial stabilization platform system |
CN108710001A (en) * | 2018-04-28 | 2018-10-26 | 北京航天控制仪器研究所 | Two axis one gyroaccelerometers of one kind and method of servo-controlling |
CN110954137A (en) * | 2019-12-13 | 2020-04-03 | 陕西瑞特测控技术有限公司 | Method for correcting assembly error scalar quantity of inertial navigation accelerometer |
Non-Patent Citations (1)
Title |
---|
陀螺加速度计在精密线振动台上的测试方法及误差分析;师少龙;《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》;20170215;28-29 * |
Also Published As
Publication number | Publication date |
---|---|
CN112630471A (en) | 2021-04-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112611887B (en) | Output compensation method of gyro accelerometer based on model parameter identification | |
Barbour et al. | Inertial instruments-Where to now? | |
US3279086A (en) | Compensated gyroscopic directional reference | |
CN108710001B (en) | Two-axis integrated gyroscope accelerometer and servo control method | |
CN106895853B (en) | Marine gyro compass alignment method assisted by electromagnetic log | |
US3414899A (en) | Apparatus for calibrating doppler-inertial navigation systems | |
US4275605A (en) | Acceleration sensitive gyroscope stabilized platform | |
RU2324897C1 (en) | Azimuthal orientation of free gyro platform by precession angle of gyro unit | |
CN111780752B (en) | Method for improving inertial guidance precision with observable attitude error | |
US4472978A (en) | Stabilized gyrocompass | |
CN111006663B (en) | Three-axis inertial platform system based on SERF gyroscope and rate gyroscope | |
CN111637883B (en) | Method for improving inertial guidance precision based on speed and position error closed-loop feedback | |
CN112630471B (en) | Output compensation method of gyro accelerometer | |
CN111006665B (en) | Atomic spin gyroscope strapdown system based on magnetic field feedback | |
Sushchenko | Mathematical model of triaxial multimode attitude and heading reference system | |
CN112557699B (en) | Method for measuring output of gyro accelerometer caused by time-varying acceleration | |
US3050995A (en) | Autonavigator | |
Matthews et al. | Cost‐Effective, High‐Accuracy Inertial Navigation | |
CN113865585B (en) | Method and system for separating and compensating combined high-order error coefficient of gyroscope | |
CN112578147B (en) | Gyro accelerometer output determination method caused by constant acceleration | |
CN113029140B (en) | Three-axis rotation modulation method of strapdown inertial navigation system based on geocentric inertial system | |
CN108593966A (en) | Two axis frame pendulous accelerometer self-calibrating methods of one kind and system | |
Bezvesilnaya et al. | Electromechanical gravimeter | |
RU2711572C1 (en) | Method for independent determination of three-axis gyrostabilizer platform departures | |
US3214983A (en) | Attitude reference |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |