CN111089606A - Rapid self-calibration method for key parameters of three-self laser inertial measurement unit - Google Patents
Rapid self-calibration method for key parameters of three-self laser inertial measurement unit Download PDFInfo
- Publication number
- CN111089606A CN111089606A CN201911327341.9A CN201911327341A CN111089606A CN 111089606 A CN111089606 A CN 111089606A CN 201911327341 A CN201911327341 A CN 201911327341A CN 111089606 A CN111089606 A CN 111089606A
- Authority
- CN
- China
- Prior art keywords
- correction
- inertial measurement
- sampling time
- measurement unit
- error
- 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.)
- Granted
Links
- 238000005259 measurement Methods 0.000 title claims abstract description 93
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000005070 sampling Methods 0.000 claims abstract description 163
- 238000012937 correction Methods 0.000 claims abstract description 147
- 230000001133 acceleration Effects 0.000 claims description 40
- 239000011159 matrix material Substances 0.000 claims description 32
- 230000009466 transformation Effects 0.000 claims description 25
- 238000004364 calculation method Methods 0.000 claims description 20
- 239000000126 substance Substances 0.000 claims description 16
- 230000005484 gravity Effects 0.000 claims description 11
- 230000003068 static effect Effects 0.000 claims description 6
- 238000009434 installation Methods 0.000 claims description 5
- 239000013598 vector Substances 0.000 claims description 5
- 230000001131 transforming effect Effects 0.000 claims description 4
- 238000012423 maintenance Methods 0.000 description 6
- 238000004590 computer program Methods 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 102000002274 Matrix Metalloproteinases Human genes 0.000 description 1
- 108010000684 Matrix Metalloproteinases Proteins 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 239000012855 volatile organic compound Substances 0.000 description 1
Classifications
-
- 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
Abstract
The invention discloses a method for quickly self-calibrating key parameters of a three-self laser inertial measurement unit, which realizes error correction of inertial measurement unit parameters by calculating parameter residual errors of 6 positions at each sampling time, takes the inertial measurement unit parameters corrected at the current sampling time of the current position as the inertial measurement unit parameters at the next sampling time of the current position, superposes the error correction of each sampling time of each position, carries out next round of error correction if the error correction does not reach a residual error set value after one round of error correction, and takes the inertial measurement unit parameters corrected at the last sampling time of the last position of the current round as the inertial measurement unit parameters at the first sampling time of the first position of the next round, superposes the error correction of each round, accelerates the error correction of the inertial measurement unit parameters and improves the self-calibration speed of the inertial measurement unit parameters.
Description
Technical Field
The invention belongs to the technical field of inertial measurement unit parameter calibration, and particularly relates to a rapid self-calibration method for key parameters of a three-self laser inertial measurement unit.
Background
The inertial measurement unit consists of three accelerometers in orthogonal distribution and three gyroscopes in orthogonal distribution, and can carry out positioning, orientation and tracking navigation by measuring acceleration increment and angular velocity increment of three axial directions of a space coordinate system. The navigation function of the inertia measurement unit does not depend on external signals, and the inertia measurement unit is high in concealment and wide in application in the military field. However, since the outputs of the accelerometer and the gyroscope have error drift with time, an error model needs to be established according to time-varying parameters such as zero offset and scale factors for compensation.
The gyro scale factors of the three-self laser inertial measurement unit are inherent parameters related to the optical path length, the installation error of the angular velocity channel and the installation error of the acceleration channel of the laser inertial measurement unit depend on the structural deformation of the table body, and the numerical value change of the gyro scale factors can be ignored. Under the condition of long-term storage of a missile weapon system, errors of zero offset of a gyroscope, a scale factor of an accelerometer and zero offset parameters of the accelerometer drift along with time need to be calibrated and corrected again in a parameter retention period to ensure the hitting precision of the weapon system, although the on-missile inertial measurement unit is calibrated in a disassembly-free and self-calibration mode (the calibration needs 90min once) can be achieved at present, compared with the prior art, the calibration of high-precision calibration equipment in a position takes a great step forward, the use and maintenance after arming still has great workload, and the difference from the lifelong calibration-free maintenance is large.
Disclosure of Invention
Aiming at the defects of the prior art, the invention provides a method for quickly and automatically calibrating key parameters of a three-self laser inertial measurement unit, so that the quick and automatic calibration of the key parameters of the inertial measurement unit is realized, the system precision is improved, and the maintenance cost is reduced.
The invention solves the technical problems through the following technical scheme: a three-self laser inertial measurement unit key parameter rapid self-calibration method comprises the following steps:
step 1: enabling the inertial measurement units to be sequentially located at 6 positions, carrying out error correction on the inertial measurement unit key parameters at each sampling moment of each position through parameter residual errors, updating the inertial measurement unit output parameters at the next sampling moment of the position by using the inertial measurement unit key parameters corrected at the current sampling moment of the position, or updating the inertial measurement unit output parameters at the first sampling moment of the next position by using the inertial measurement unit key parameters corrected at the last sampling moment of the position until the error correction of the inertial measurement unit key parameters at the last sampling moment of the last position is finished; judging whether the residual error of the key parameter at the last sampling moment at the last position is smaller than a residual error set value, if so, completing the self-calibration of the key parameter, otherwise, turning to the step 2;
step 2: and (3) updating the inertial measurement unit output parameter at the first sampling moment at the first position by using the inertial measurement unit key parameter corrected at the last sampling moment at the last position, and circularly executing the step (1) until the residual error of the key parameter at the last sampling moment at the last position is less than the residual error set value.
The calibration method of the invention realizes the self-calibration of the key parameters of the inertial measurement unit by calculating the parameter residual error of each sampling moment at each position, carries out judgment once after each error correction is finished until the residual error set value is met, the method is characterized in that the self-calibration of the key parameters is completed, the calculation of the residual error of the key parameters is completed through a computer program, the error correction of the inertial set key parameters can be rapidly realized at each position, the corrected inertial set key parameters are used as the inertial set output parameters at the next sampling time or the next position, the inertial set key parameters corrected at the last position are used as the inertial set output parameters at the first sampling time of the first position during the next round of error correction, the error correction at each sampling time of each position and the error correction of each round are superposed, the error correction of the inertial set key parameters is accelerated, and the self-calibration speed of the inertial set key parameters is improved; the method can finish the calibration of the key parameters of the three-self laser inertial measurement unit drifting along with time within 10min, ensures the hitting precision of a missile weapon system, and greatly reduces the use and maintenance cost.
Further, in the step 1, performing error correction on the inertial measurement unit key parameter at each sampling time of each position includes the following steps:
step 1.1, constructing an initial attitude transformation matrix corresponding to the position during the mth round correction through the measured acceleration data;
step 1.2, resolving a speed error and a space direction rotation angle error according to the initial attitude transformation matrix navigation in the step 1.1 so as to update the speed and the space direction rotation angle of the inertial measurement unit;
step 1.3, calculating the components of the gyro error and the accelerometer error under the geographic coordinate system when the position is not corrected according to the speed error and the sky rotation angle error in the step 1.2;
step 1.4, calculating parameter residual errors of the inertial measurement units according to the amount in the step 1.3;
and step 1.5, carrying out error correction on the key parameters of the inertial measurement unit according to the parameter residual error in the step 1.4.
Further, in the step 1.1, the initial posture conversion matrix of the jth position at the mth round correction is usedTo indicate that the user is not in a normal position,
wherein j is 1,2,3,4,5, Δ DjmIs an angle transformation matrix when the m-th correction is transformed to the j-th position,respectively obtaining x, y and z-direction acceleration values at the first sampling moment of the jth position in the mth round correction, wherein q is a middle calculation auxiliary parameter;
wherein the content of the first and second substances,and the initial attitude angle of the inertial set at the first position during the m-th wheel correction is obtained.
Further, in step 1.2, the calculation formula of the speed error is as follows:
wherein R represents the x, y or z direction,the x, y or z-direction speed error of the kth sampling time at the jth position at the mth round correction,is the x, y or z-direction speed error of the k-1 sampling time of the jth position at the mth round correction,is the attitude transformation matrix of the kth sampling moment of the jth position at the mth round of correction,is the posture transformation matrix of the k-1 sampling moment of the jth position at the mth round of correction,the vector is output for the kth sampling time x, y or z of the jth position during the mth round correction, g is the local gravity acceleration, omega is the rotational angular velocity of the earth,in order to be the local latitude,respectively the x, y and z-direction speed errors at the k-1 th sampling time of the jth position in the mth round correction, delta tjmA sampling time of the jth position in the mth round correction, k is a sampling time, k is 1,2,3 …, and:
wherein, I is a unit diagonal matrix,outputting angular velocities of the gyroscope in x, y and z directions at the kth sampling time of the jth position at the mth round correction;
the calculation formula of the errors of the rotation angles in the sky direction is as follows:
wherein the content of the first and second substances,is the day-wise rotation angle error of the kth sampling moment of the jth position in the mth round correction,for the posture of the kth sampling time of the jth position at the mth round correctionThe matrix error is transformed.
Further, in step 1.3, the calculation formula of the components of the gyro error and the accelerometer error in the geographic coordinate system when not corrected is as follows:
wherein the content of the first and second substances,respectively representing the x-direction, y-direction and z-direction speed error components of the kth sampling time of the jth position at the mth round correction under the geographic coordinate system,are all initial attitude transformation matricesThe elements (A) and (B) in (B),respectively x-direction speed error, y-direction speed error and z-direction speed error of kth sampling time of jth position at mth round correction,the acceleration values in the x direction, the y direction and the z direction of the kth sampling time of the jth position at the mth round correction are respectively,is static at the j-th positionAt the end of the state, the time of the state,is the static start time of the jth position, k is the sampling time, Δ tjmIs the sampling time of the jth position in the mth round correction, g is the local gravity acceleration, NjmIs the sampling number of the jth position in the mth round of correction, R represents the x, y or z direction,is the k sampling time x, y or z angular speed error of the jth position at the mth round correction,and the k sampling time x, y and z of the jth position during the mth round correction are respectively the output angular velocities of the gyroscope in the z direction.
Further, in step 1.4, the calculation formula of the parameter residual of the inertial set is as follows:
wherein the content of the first and second substances,computing residual errors for the zero offset of the k sampling time x, y and z of the accelerometer at the jth position in the mth round of correction,computing residual errors for the kth sampling time x, y and z accelerometer scaling factors of the jth position at the mth round correction,r represents the x, y or z direction,calculating residual error for the k-th sampling time x, y or z-direction gyro zero offset of the j-th position in the k-th round correction,respectively are the x-direction speed error components of the kth sampling time x of the 1 st, 2 nd, 3 th, 4 th and 5 th positions in the mth round correction,respectively are the z-direction speed error components of the kth sampling time at the 1 st, 2 nd and 4 th positions in the mth round correction,the k-th sampling time x, y or z-direction angular speed errors of the 1 st, 2 nd, 3 th, 4 th, 5 th and 6 th positions in the m-th correction are respectively.
Further, in step 1.5, an error correction formula of the inertial measurement unit key parameter is as follows:
wherein R represents the x, y or z direction,zero offset is carried out on the accelerometer in the kth sampling time x, y or z direction of the jth position after the mth round of correction,the calibration factor of the x, y or z direction accelerometer at the kth sampling time of the jth position after the mth round of correction,zero-offset for the k sampling time x, y or z of the jth position after the mth round of correction,computing residual error for the zero offset of the k sampling time x, y or z direction accelerometer of the jth position at the mth round correction,computing residual error for the kth sampling time x, y or z accelerometer scaling factor of the jth position at the mth round of correction,and computing a residual error for the k-th sampling time x, y or z-direction gyro zero offset of the j-th position in the m-th round correction, wherein when k is 1, the k-1 time is the last sampling time of the last position in the previous round correction.
Further, in step 1 or 2, a specific formula for updating the inertial measurement unit output parameter is as follows:
wherein the content of the first and second substances,respectively updated acceleration values in x, y and z directions, Kxy、Kyx、Kzx、Kzy、Kxz、KyzAre all the installation errors of the accelerometer,respectively outputting vectors of the acceleration in the x direction, the y direction or the z direction at the kth sampling time of the jth position at the mth round correction,respectively calibrating factors of the x-direction accelerometer, the y-direction accelerometer and the z-direction accelerometer at the kth sampling time of the jth position after the mth round of correction,respectively zero-offset g of the x, y and z accelerometers at the kth sampling time of the jth position after the mth round of correction0Is the standard gravity acceleration, and the acceleration is the standard gravity acceleration,respectively updated x-, y-, and z-directional gyro output angular velocities, Exy、Eyx、Ezx、Ezy、Exz、EyzMounting errors, e, of both gyrosx、εy、εzOutput angular velocities measured by the gyroscope in x, y and z directions, respectively, E1x、E1y、E1zAre gyro scale factors in x, y and z directions respectively,and respectively zero-offset for the k-th sampling time x, y and z of the j-th position after the m-th round of correction.
Further, in step 1, a second position is obtained by rotating the first position by 90 ° around the Z axis, a third position is obtained by rotating the second position by 90 ° around the Z axis, a fourth position is obtained by rotating the third position by 90 ° around the Z axis, a fifth position is obtained by rotating the fourth position by 90 ° around the Y axis, and a sixth position is obtained by rotating the fifth position by 180 ° around the Y axis, that is, six positions in which the inertial group is located in sequence.
Further, the residual error set value comprises an accelerometer zero-offset residual error set value, an accelerometer scale factor residual error set value and a gyroscope zero-offset residual error set value; the zero offset residual error set value of the accelerometer is 1e-5g0The residual error setting value of the accelerometer scale factor is 1e-5And the zero offset residual error setting value of the gyroscope is 0.03 degree/h.
Advantageous effects
Compared with the prior art, the method for quickly self-calibrating the key parameters of the three-self laser inertial measurement unit realizes error correction of the inertial measurement unit parameters by calculating the parameter residual error of each sampling time of 6 positions, the inertial measurement unit parameters corrected at the current sampling time of the current position are used as the inertial measurement unit parameters of the next sampling time of the position, the error correction of each sampling time of each position is superposed, if the residual error does not reach a set value after one round of error correction, the next round of error correction is carried out, the inertial measurement unit parameters corrected at the last sampling time of the last position of the current round are used as the inertial measurement unit parameters of the first sampling time of the first position of the next round, the error correction of each round is superposed, the error correction of the inertial measurement unit parameters is accelerated, and the self-calibration speed of the inertial measurement unit parameters is improved; the method can finish the calibration of the key parameters of the three-self laser inertial measurement unit drifting along with time within 10min, ensures the hitting precision of a missile weapon system, and greatly reduces the use and maintenance cost.
Detailed Description
The technical solutions in the present invention are clearly and completely described below, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The invention provides a rapid self-calibration method for key parameters of a three-self laser inertial measurement unit, which comprises the following steps:
1. enabling the inertial measurement units to be sequentially located at 6 positions, carrying out error correction on the key parameters of the inertial measurement units at each sampling moment of each position through parameter residual errors, updating the output parameters of the inertial measurement units at the next sampling moment of the position by the key parameters of the inertial measurement units corrected at the current sampling moment of the position or updating the output parameters of the inertial measurement units at the first sampling moment of the next position by the key parameters of the inertial measurement units corrected at the last sampling moment of the position until the error correction of the key parameters of the inertial measurement units at the last sampling moment of the last position is finished; and (3) judging whether the parameter residual error at the last sampling moment at the last position is smaller than a residual error set value, if so, completing the self-calibration of the key parameter, and otherwise, turning to the step 2.
TABLE 1 sequence listing of the rotational sequence of six positions
Taking the first position (j ═ 0) as north and east (i.e., x axis facing north, Y axis facing up, and Z axis facing east), the second position is obtained by rotating the first position 90 ° around the Z axis, the third position is obtained by rotating the second position 90 ° around the Z axis, the fourth position is obtained by rotating the third position 90 ° around the Z axis, the fifth position is obtained by rotating the fourth position 90 ° around the Y axis, and the sixth position is obtained by rotating the fifth position 180 ° around the Y axis, i.e., six positions in which the inerter group is located in sequence, as shown in table 1 below.
According to the principle of coordinate transformation, any two coordinate systems with three orthogonal axes can be superposed together through three rotations, and if the actual first position needs to pass through the rotation α around the Z axis, the rotation β around the rotated X axis and the rotation gamma around the rotated Y axis, the coordinate transformation matrix is usedAnd preprocessing the data.
The inertial measurement unit key parameters comprise accelerometer zero offset, accelerometer calibration factors and gyro zero offset, and the error correction of the inertial measurement unit key parameters at each sampling moment at each position comprises the following steps:
1.1, an initial attitude transformation matrix corresponding to the position at the mth round correction is constructed through the measured acceleration data.
Setting the initial posture transformation matrix of the jth position in the mth round correction asThen
wherein j is 1,2,3,4,5, Δ DjmFor the angle transformation matrix when the mth correction is transformed to the jth position, the calculation of the angle transformation matrix can be referred to the "inertia theory" of the inventor's book of the Qin Yong Yuan,x, y and z direction acceleration values of the first sampling time at the jth position respectively at the mth wheel correctionAnd the acceleration value is equal to the acceleration value updated at the last sampling moment of the j-1 th position in the mth round of correction, and q is an intermediate calculation auxiliary parameter.
wherein the content of the first and second substances,and (3) obtaining an initial attitude angle of the inertia set at the first position (j ═ 0) in the mth wheel correction through measurement.
1.2 transforming the matrix according to the initial pose in step 1.1And the navigation solves the speed error and the sky-direction rotation angle error so as to update the speed and the sky-direction rotation angle of the inertial measurement unit.
The velocity error is calculated as:
wherein R represents the x, y or z direction,the x, y or z-direction speed error of the kth sampling time at the jth position at the mth round correction,is the x, y or z-direction speed error of the k-1 sampling time of the jth position at the mth round correction,is the attitude transformation matrix of the kth sampling moment of the jth position at the mth round of correction,is the posture transformation matrix of the k-1 sampling moment of the jth position at the mth round of correction,the acceleration output vector (obtained by parameter correction after real-time measurement by an accelerometer) in x, y or z direction at the kth sampling time of the jth position in the mth round of correction, g is the local gravity acceleration, omega is the rotational angular velocity of the earth,in order to be the local latitude,respectively the x, y and z-direction speed errors at the k-1 th sampling time of the jth position in the mth round correction, delta tjmThe sampling time of the j-th position in the mth round correction, k is the sampling time, k is 1,2,3 …, when k is 1, k-1 is equal to 0,is a non-volatile organic compound (I) with a value of 0,transforming a matrix for the initial attitude; and the number of the first and second electrodes,
wherein, I is a unit diagonal matrix,and respectively outputting angular velocities of the gyroscope in the k-th sampling time x, y and z directions at the j-th position during the m-th round correction, wherein the output angular velocities are the output angular velocities updated at the last sampling time of the position or the output angular velocities updated at the last sampling time of the position.
The calculation formula of the errors of the rotation angles in the sky direction is as follows:
wherein the content of the first and second substances,is the day-wise rotation angle error of the kth sampling moment of the jth position in the mth round correction,and transforming the matrix error for the k sampling moment of the j position at the m round of correction.
1.3, calculating the components of the gyro error and the accelerometer error under the geographic coordinate system when the position is not corrected according to the speed error and the sky rotation angle error in the step 1.2, wherein the calculation formula of the components is as follows:
wherein the content of the first and second substances,respectively representing the x-direction, y-direction and z-direction speed error components of the kth sampling time of the jth position at the mth round correction under the geographic coordinate system,are all initial attitude transformation matricesThe elements (A) and (B) in (B),respectively x-direction speed error, y-direction speed error and z-direction speed error of kth sampling time of jth position at mth round correction,the x-direction acceleration value, the y-direction acceleration value and the z-direction acceleration value of the kth sampling moment of the jth position at the mth round correction (the acceleration value is the acceleration value updated by the last sampling moment of the position or the acceleration value updated by the last sampling moment of the position),is the static end time of the jth location,is the static start time of the jth position, NjmThe number of samples of the jth position at the mth round correction,and the k sampling time x, y or z angular speed error of the j position at the m round correction.
1.4 calculating the parameter residual of the inertial measurement unit according to the calculation in the step 1.3, wherein the calculation formula of the parameter residual is as follows:
wherein the content of the first and second substances,computing residual errors for the zero offset of the k sampling time x, y and z of the accelerometer at the jth position in the mth round of correction,computing residual errors for the kth sampling time x, y and z accelerometer scaling factors of the jth position at the mth round correction,calculating residual error for the k-th sampling time x, y or z-direction gyro zero offset of the j-th position in the k-th round correction,respectively are the x-direction speed error components of the kth sampling time x of the 1 st, 2 nd, 3 th, 4 th and 5 th positions in the mth round correction,respectively are the z-direction speed error components of the kth sampling time at the 1 st, 2 nd and 4 th positions in the mth round correction,the k-th sampling time x, y or z-direction angular speed errors of the 1 st, 2 nd, 3 th, 4 th, 5 th and 6 th positions in the m-th correction are respectively.
1.5, carrying out error correction on the key parameters of the inertial measurement unit according to the parameter residual error in the step 1.4, wherein the error correction formula is as follows:
wherein the content of the first and second substances,zero offset is carried out on the accelerometer in the kth sampling time x, y or z direction of the jth position after the mth round of correction,the calibration factor of the x, y or z direction accelerometer at the kth sampling time of the jth position after the mth round of correction,zero-offset is carried out on the k sampling time x, y or z-direction gyro at the j position after the m round of correction, and when k is equal to 1, the k-1 time is the last sampling of the last position in the previous round of correctionAnd (6) engraving.
1.6 updating the inertial set output parameter at the next sampling moment of the position according to the inertial set key parameter corrected in the step 1.5, or updating the inertial set output parameter at the first sampling moment of the next position according to the inertial set key parameter corrected at the last sampling moment of the position. The output parameters of the inertia set comprise an acceleration value and an output angular velocity, and the specific updating formula is as follows:
wherein the content of the first and second substances,respectively updated acceleration values in x, y and z directions, Kxy(representing the output of the y-axis accelerometer with the x-axis facing the sky), Kyx(representing the output of the x-axis accelerometer with the y-axis facing the sky), Kzx(representing the output of the x-axis accelerometer with the z-axis facing the sky), Kzy(indicating the output of the y-axis accelerometer with the z-axis facing the sky), Kxz(representing the output of the z-axis accelerometer with the x-axis pointing towards the sky), Kyz(indicating the output of the z-axis accelerometer with the y-axis facing the sky) is the mounting error of the accelerometer (factory-specified), g0Is the standard gravity acceleration, and the acceleration is the standard gravity acceleration,respectively updated x-, y-, and z-directional gyro output angular velocities, Exy、Eyx、Ezx、Ezy、Exz、EyzAll are the installation errors (factory given when leaving factory) of the gyro, epsilonx、εy、εzRespectively the output angular velocities measured by the gyroscope in the x, y and z directions (measured by the gyroscope), E1x、E1y、E1zThe x, y, and z gyro scale factors (factory specified) are provided. Acceleration updated at the current time of the positionThe value and the output angular velocity participate in the attitude transformation matrix of the next sampling moment of the positionIn the calculation of components, etc., or participate in the initial attitude transformation matrix of the first sampling moment of the next positionAttitude transformation matrixIn the calculation of components and the like, the superposition of error correction is realized, and the self-calibration speed of the key parameters of the inertial measurement unit is accelerated.
And (3) judging whether the parameter residual error at the last sampling moment at the last position is smaller than a residual error set value, if so, completing the self-calibration of the key parameter, and otherwise, turning to the step 2.
The residual error set value comprises an accelerometer zero-offset residual error set value, an accelerometer scale factor residual error set value and a gyroscope zero-offset residual error set value; the zero offset residual error setting value of the accelerometer is 1e-5g0The accelerometer scale factor residual error setting value is 1e-5The zero offset residual error setting value of the gyroscope is 0.03 degree/h, namely, the judgment is carried outWhether or not less than 1e-5g0(in this example, g0The value is 9.80665m/s2),Whether or not less than 1e-5,Whether the temperature is less than 0.03 DEG/h.
2. And (3) updating the inertial measurement unit output parameter at the first sampling moment at the first position by using the inertial measurement unit key parameter corrected at the last sampling moment at the last position (an updating formula is shown in step 1.6), and circularly executing the step 1 until the residual error of the key parameter at the last sampling moment at the last position is less than the residual error set value.
The calibration method realizes the self-calibration of the key parameters of the inertial measurement unit by calculating the parameter residual error of each sampling moment at each position, carries out judgment once after each error correction is finished until the residual error set value is met, the method is characterized in that the self-calibration of the key parameters is completed, the calculation of the residual error of the key parameters is completed through a computer program, the error correction of the inertial set key parameters can be rapidly realized at each position, the corrected inertial set key parameters are used as the inertial set output parameters at the next sampling time or the next position, the inertial set key parameters corrected at the last position are used as the inertial set output parameters at the first sampling time of the first position during the next round of error correction, the error correction at each sampling time of each position and the error correction of each round are superposed, the error correction of the inertial set key parameters is accelerated, and the self-calibration speed of the inertial set key parameters is improved; the method can finish the calibration of the key parameters of the three-self laser inertial measurement unit drifting along with time within 10min, and other non-drifting along with time parameters are determined through the last full-parameter calibration, so that the hitting precision of a missile weapon system is ensured, and the use and maintenance cost is greatly reduced.
The above disclosure is only for the specific embodiments of the present invention, but the scope of the present invention is not limited thereto, and any person skilled in the art can easily conceive of changes or modifications within the technical scope of the present invention, and shall be covered by the scope of the present invention.
Claims (10)
1. A three-self laser inertial measurement unit key parameter rapid self-calibration method is characterized by comprising the following steps:
step 1: enabling the inertial measurement units to be sequentially located at 6 positions, carrying out error correction on the inertial measurement unit key parameters at each sampling moment of each position through parameter residual errors, updating the inertial measurement unit output parameters at the next sampling moment of the position by using the inertial measurement unit key parameters corrected at the current sampling moment of the position, or updating the inertial measurement unit output parameters at the first sampling moment of the next position by using the inertial measurement unit key parameters corrected at the last sampling moment of the position until the error correction of the inertial measurement unit key parameters at the last sampling moment of the last position is finished; judging whether the residual error of the key parameter at the last sampling moment at the last position is smaller than a residual error set value, if so, completing the self-calibration of the key parameter, otherwise, turning to the step 2;
step 2: and (3) updating the inertial measurement unit output parameter at the first sampling moment at the first position by using the inertial measurement unit key parameter corrected at the last sampling moment at the last position, and circularly executing the step (1) until the residual error of the key parameter at the last sampling moment at the last position is less than the residual error set value.
2. The method for fast self-calibration of the key parameters of the three-self laser inertial measurement unit according to claim 1, wherein in the step 1, the error correction of the key parameters of the inertial measurement unit at each sampling time of each position comprises the following steps:
step 1.1, constructing an initial attitude transformation matrix corresponding to the position during the mth round correction through the measured acceleration data;
step 1.2, resolving a speed error and a space direction rotation angle error according to the initial attitude transformation matrix navigation in the step 1.1 so as to update the speed and the space direction rotation angle of the inertial measurement unit;
step 1.3, calculating the components of the gyro error and the accelerometer error under the geographic coordinate system when the position is not corrected according to the speed error and the sky rotation angle error in the step 1.2;
step 1.4, calculating parameter residual errors of the inertial measurement units according to the amount in the step 1.3;
and step 1.5, carrying out error correction on the key parameters of the inertial measurement unit according to the parameter residual error in the step 1.4.
3. The method for rapidly self-calibrating the key parameters of the three-self laser inertial measurement unit according to claim 2, wherein in the step 1.1, the initial attitude transformation matrix of the jth position in the mth round of correction is usedTo indicate that the user is not in a normal position,is provided with
wherein j is 1,2,3,4,5, Δ DjmIs an angle transformation matrix when the m-th correction is transformed to the j-th position,respectively obtaining x, y and z-direction acceleration values at the first sampling moment of the jth position in the mth round correction, wherein q is a middle calculation auxiliary parameter;
4. The method for fast self-calibration of key parameters of a three-self laser inertial measurement unit according to claim 2, wherein in step 1.2, the calculation formula of the speed error is as follows:
wherein R represents the x, y or z direction,the x, y or z-direction speed error of the kth sampling time at the jth position at the mth round correction,is the x, y or z-direction speed error of the k-1 sampling time of the jth position at the mth round correction,is the attitude transformation matrix of the kth sampling moment of the jth position at the mth round of correction,is the posture transformation matrix of the k-1 sampling moment of the jth position at the mth round of correction, the vector is output for the kth sampling time x, y or z of the jth position during the mth round correction, g is the local gravity acceleration, omega is the rotational angular velocity of the earth,in order to be the local latitude,respectively the x, y and z-direction speed errors at the k-1 th sampling time of the jth position in the mth round correction, delta tjmA sampling time of the jth position in the mth round correction, k is a sampling time, k is 1,2,3 …, and:
wherein, I is a unit diagonal matrix, outputting angular velocities of the gyroscope in x, y and z directions at the kth sampling time of the jth position at the mth round correction;
the calculation formula of the errors of the rotation angles in the sky direction is as follows:
5. The method for fast self-calibration of key parameters of the three-self laser inertial measurement unit according to claim 2, wherein in step 1.3, the calculation formulas of the components of the gyro error and the accelerometer error in the geographic coordinate system when not corrected are as follows:
wherein the content of the first and second substances,respectively representing the x-direction, y-direction and z-direction speed error components of the kth sampling time of the jth position at the mth round correction under the geographic coordinate system,are all initial attitude transformation matricesThe elements (A) and (B) in (B),respectively x-direction speed error, y-direction speed error and z-direction speed error of kth sampling time of jth position at mth round correction,the acceleration values in the x direction, the y direction and the z direction of the kth sampling time of the jth position at the mth round correction are respectively,is the static end time of the jth location,is the static start time of the jth position, k is the sampling time, Δ tjmIs the sampling time of the jth position in the mth round correction, g is the local gravity acceleration, NjmIs the sampling number of the jth position in the mth round of correction, R represents the x, y or z direction, is the k sampling time x, y or z angular speed error of the jth position at the mth round correction, and the k sampling time x, y and z of the jth position during the mth round correction are respectively the output angular velocities of the gyroscope in the z direction.
6. The method for fast self-calibration of key parameters of a three-self laser inertial measurement unit according to claim 2, wherein in step 1.4, the calculation formula of the parameter residuals of the inertial measurement unit is as follows:
wherein the content of the first and second substances,computing residual errors for the zero offset of the k sampling time x, y and z of the accelerometer at the jth position in the mth round of correction,computing residual errors for the kth sampling time x, y and z accelerometer scaling factors of the jth position at the mth round correction,r represents the x, y or z direction,calculating residual error for the k-th sampling time x, y or z-direction gyro zero offset of the j-th position in the k-th round correction,respectively are the x-direction speed error components of the kth sampling time x of the 1 st, 2 nd, 3 th, 4 th and 5 th positions in the mth round correction,respectively are the z-direction speed error components of the kth sampling time at the 1 st, 2 nd and 4 th positions in the mth round correction,the k-th sampling time x, y or z-direction angular speed errors of the 1 st, 2 nd, 3 th, 4 th, 5 th and 6 th positions in the m-th correction are respectively.
7. The method for fast self-calibration of the key parameters of the three-self laser inertial measurement unit according to claim 2, wherein in the step 1.5, an error correction formula of the key parameters of the inertial measurement unit is as follows:
wherein R represents the x, y or z direction,corrected j th for m th roundThe location sample time k x, y or z is zero offset to the accelerometer,the calibration factor of the x, y or z direction accelerometer at the kth sampling time of the jth position after the mth round of correction,zero-offset for the k sampling time x, y or z of the jth position after the mth round of correction,computing residual error for the zero offset of the k sampling time x, y or z direction accelerometer of the jth position at the mth round correction,computing residual error for the kth sampling time x, y or z accelerometer scaling factor of the jth position at the mth round of correction,and computing a residual error for the k-th sampling time x, y or z-direction gyro zero offset of the j-th position in the m-th round correction, wherein when k is 1, the k-1 time is the last sampling time of the last position in the previous round correction.
8. The method for fast self-calibration of key parameters of a three-self laser inertial measurement unit according to claim 1 or 2, wherein in the step 1 or 2, a specific formula for updating the inertial measurement unit output parameters is as follows:
wherein the content of the first and second substances,respectively updated acceleration values in x, y and z directions, Kxy、Kyx、Kzx、Kzy、Kxz、KyzAre all the installation errors of the accelerometer,respectively outputting vectors of the acceleration in the x direction, the y direction or the z direction at the kth sampling time of the jth position at the mth round correction,respectively calibrating factors of the x-direction accelerometer, the y-direction accelerometer and the z-direction accelerometer at the kth sampling time of the jth position after the mth round of correction,respectively zero-offset g of the x, y and z accelerometers at the kth sampling time of the jth position after the mth round of correction0Is the standard gravity acceleration, and the acceleration is the standard gravity acceleration,respectively updated x-, y-, and z-directional gyro output angular velocities, Exy、Eyx、Ezx、Ezy、Exz、EyzMounting errors, e, of both gyrosx、εy、εzOutput angular velocities measured by the gyroscope in x, y and z directions, respectively, E1x、E1y、E1zAre gyro scale factors in x, y and z directions respectively,and respectively zero-offset for the k-th sampling time x, y and z of the j-th position after the m-th round of correction.
9. The method for fast self-calibration of key parameters of the three-self laser inertial measurement unit according to claim 1, wherein in step 1, the second position is obtained by rotating the first position by 90 ° around the Z axis, the third position is obtained by rotating the second position by 90 ° around the Z axis, the fourth position is obtained by rotating the third position by 90 ° around the Z axis, the fifth position is obtained by rotating the fourth position by 90 ° around the Y axis, and the sixth position is obtained by rotating the fifth position by 180 ° around the Y axis, namely the six positions where the inertial measurement unit is located in sequence.
10. The method of claim 1, wherein the residual settings comprise an accelerometer zero-offset residual setting, an accelerometer scale factor residual setting, and a gyroscope zero-offset residual setting; the zero offset residual error set value of the accelerometer is 1e-5g0The residual error setting value of the accelerometer scale factor is 1e-5And the zero offset residual error setting value of the gyroscope is 0.03 degree/h.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911327341.9A CN111089606B (en) | 2019-12-20 | 2019-12-20 | Rapid self-calibration method for key parameters of three-self laser inertial measurement unit |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911327341.9A CN111089606B (en) | 2019-12-20 | 2019-12-20 | Rapid self-calibration method for key parameters of three-self laser inertial measurement unit |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111089606A true CN111089606A (en) | 2020-05-01 |
CN111089606B CN111089606B (en) | 2023-11-14 |
Family
ID=70395203
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911327341.9A Active CN111089606B (en) | 2019-12-20 | 2019-12-20 | Rapid self-calibration method for key parameters of three-self laser inertial measurement unit |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111089606B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114353828A (en) * | 2021-12-23 | 2022-04-15 | 湖南航天机电设备与特种材料研究所 | Laser strapdown inertial measurement unit calibration test device and test method |
RU2803878C2 (en) * | 2021-12-20 | 2023-09-21 | Публичное акционерное общество Арзамасское научно-производственное предприятие "ТЕМП-АВИА" | Method for calibrating errors of inertial measuring unit based on laser gyroscopes using a dynamic bench |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011227017A (en) * | 2010-04-23 | 2011-11-10 | Univ Of Tokyo | Device and method for attitude estimation of moving body using inertial sensor, magnetic sensor, and speed meter |
CN103983274A (en) * | 2014-04-11 | 2014-08-13 | 湖北航天技术研究院总体设计所 | Inertial measurement unit calibration method suitable for low-precision no-azimuth reference biaxial transfer equipment |
WO2016112571A1 (en) * | 2015-01-16 | 2016-07-21 | 北京航天时代光电科技有限公司 | High-precision fiber-optic gyroscope inertial measurement device calibration method |
CN105973271A (en) * | 2016-07-25 | 2016-09-28 | 北京航空航天大学 | Self-calibration method of hybrid type inertial navigation system |
CN106705992A (en) * | 2015-11-12 | 2017-05-24 | 北京自动化控制设备研究所 | Biaxial optical fiber inertial navigation system rapid self-calibration self-alignment method |
CN108458725A (en) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | Systematic calibration method on Strapdown Inertial Navigation System swaying base |
CN108562288A (en) * | 2018-05-08 | 2018-09-21 | 北京航天时代激光导航技术有限责任公司 | A kind of Laser strapdown used group of system-level online self-calibration system and method |
CN110361031A (en) * | 2019-07-05 | 2019-10-22 | 东南大学 | A kind of IMU population parameter error quick calibrating method theoretical based on backtracking |
-
2019
- 2019-12-20 CN CN201911327341.9A patent/CN111089606B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011227017A (en) * | 2010-04-23 | 2011-11-10 | Univ Of Tokyo | Device and method for attitude estimation of moving body using inertial sensor, magnetic sensor, and speed meter |
CN103983274A (en) * | 2014-04-11 | 2014-08-13 | 湖北航天技术研究院总体设计所 | Inertial measurement unit calibration method suitable for low-precision no-azimuth reference biaxial transfer equipment |
WO2016112571A1 (en) * | 2015-01-16 | 2016-07-21 | 北京航天时代光电科技有限公司 | High-precision fiber-optic gyroscope inertial measurement device calibration method |
CN106705992A (en) * | 2015-11-12 | 2017-05-24 | 北京自动化控制设备研究所 | Biaxial optical fiber inertial navigation system rapid self-calibration self-alignment method |
CN105973271A (en) * | 2016-07-25 | 2016-09-28 | 北京航空航天大学 | Self-calibration method of hybrid type inertial navigation system |
CN108458725A (en) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | Systematic calibration method on Strapdown Inertial Navigation System swaying base |
CN108562288A (en) * | 2018-05-08 | 2018-09-21 | 北京航天时代激光导航技术有限责任公司 | A kind of Laser strapdown used group of system-level online self-calibration system and method |
CN110361031A (en) * | 2019-07-05 | 2019-10-22 | 东南大学 | A kind of IMU population parameter error quick calibrating method theoretical based on backtracking |
Non-Patent Citations (3)
Title |
---|
JIANLI LI 等: "Integrated Calibration Method for Dithered RLG POS Using a Hybrid Analytic/Kalman Filter Approach", 《IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT》, vol. 62, no. 12, pages 1 - 10 * |
姜睿 等: "基于双轴旋转惯导的激光陀螺仪与g有关偏置自标定法", 《中国惯性技术学报》, vol. 25, no. 5, pages 664 - 669 * |
胡鑫;韩崇伟;李伟;马捷;: "基于四位置转位法实现激光捷联惯性测量组合标定", 科学技术与工程, no. 08, pages 2034 - 2038 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2803878C2 (en) * | 2021-12-20 | 2023-09-21 | Публичное акционерное общество Арзамасское научно-производственное предприятие "ТЕМП-АВИА" | Method for calibrating errors of inertial measuring unit based on laser gyroscopes using a dynamic bench |
CN114353828A (en) * | 2021-12-23 | 2022-04-15 | 湖南航天机电设备与特种材料研究所 | Laser strapdown inertial measurement unit calibration test device and test method |
CN114353828B (en) * | 2021-12-23 | 2024-01-16 | 湖南航天机电设备与特种材料研究所 | Laser strapdown inertial measurement unit calibration test device and test method |
Also Published As
Publication number | Publication date |
---|---|
CN111089606B (en) | 2023-11-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110160554B (en) | Single-axis rotation strapdown inertial navigation system calibration method based on optimization method | |
CN107655493B (en) | SINS six-position system-level calibration method for fiber-optic gyroscope | |
CN108759798B (en) | Method for realizing precision measurement of high-precision spacecraft | |
CN108458725B (en) | System-level calibration method on shaking base of strapdown inertial navigation system | |
CN109459065B (en) | Gyro installation matrix calibration method based on satellite inertial space rotation attitude | |
CN108132060B (en) | Non-reference system-level calibration method for strapdown inertial navigation system | |
CN110296719B (en) | On-orbit calibration method | |
CN113503894B (en) | Inertial navigation system error calibration method based on gyro reference coordinate system | |
CN109708663B (en) | Star sensor online calibration method based on aerospace plane SINS assistance | |
CN115265590B (en) | Biaxial rotation inertial navigation dynamic error suppression method | |
CN112129322B (en) | Method for detecting and correcting installation error of strapdown inertial measurement unit and three-axis rotary table | |
CN112129321B (en) | Gyro zero offset calibration value determining method and device and computer storage medium | |
CN107246883A (en) | A kind of Rotating Platform for High Precision Star Sensor installs the in-orbit real-time calibration method of matrix | |
CN113916256A (en) | Calibration method for triaxial MEMS gyroscope combined inertial measurement unit | |
CN113804185A (en) | Novel inertial navigation system based on MEMS array | |
CN111486870A (en) | System-level calibration method for inclined strapdown inertial measurement unit | |
CN111238532B (en) | Inertial measurement unit calibration method suitable for shaking base environment | |
CN111089606B (en) | Rapid self-calibration method for key parameters of three-self laser inertial measurement unit | |
CN110940357B (en) | Inner rod arm calibration method for self-alignment of rotary inertial navigation single shaft | |
CN109506645B (en) | Star sensor mounting matrix ground accurate measurement method | |
CN113551688A (en) | Quick non-support disassembly-free calibration method and device for vehicle-mounted positioning and directional navigation equipment | |
CN110411478B (en) | Rapid calibration method for inertial device of carrier rocket | |
Wang et al. | Research on joint calibration and compensation of the inclinometer installation and instrument errors in the celestial positioning system | |
CN113465570A (en) | High-precision IMU-based air bearing table initial alignment method and system | |
CN113375692B (en) | Method for rapidly evaluating calibration precision of fiber-optic gyroscope |
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 |