CN103884356A - Method for calibrating combination of strapdown inertial combination gyroscope - Google Patents

Method for calibrating combination of strapdown inertial combination gyroscope Download PDF

Info

Publication number
CN103884356A
CN103884356A CN201410114551.0A CN201410114551A CN103884356A CN 103884356 A CN103884356 A CN 103884356A CN 201410114551 A CN201410114551 A CN 201410114551A CN 103884356 A CN103884356 A CN 103884356A
Authority
CN
China
Prior art keywords
omega
axis
coefficient
error model
combination
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
Application number
CN201410114551.0A
Other languages
Chinese (zh)
Other versions
CN103884356B (en
Inventor
魏宗康
刘璠
李念滨
赵龙
魏子寅
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Aerospace Times Electronics Corp
Beijing Aerospace Control Instrument Institute
Original Assignee
China Aerospace Times Electronics Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Aerospace Times Electronics Corp filed Critical China Aerospace Times Electronics Corp
Priority to CN201410114551.0A priority Critical patent/CN103884356B/en
Publication of CN103884356A publication Critical patent/CN103884356A/en
Application granted granted Critical
Publication of CN103884356B publication Critical patent/CN103884356B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, 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 calibrating the combination of a strapdown inertial combination gyroscope. The method comprises the steps of after the scale factor and the installation error angle of the combination of the gyroscope are known, carrying out significance analysis on the quadratic term coefficient in an error model without a zero order term by sequentially measuring the output values of the strapdown inertial combination at eighteen positions to obtain an actual error model of the gyroscope related to apparent acceleration; calculating all coefficient values in the error model by a calculation formula. Compared with other error coefficient calibration methods, the method can be used for obtaining the error term model of the gyroscope related to apparent acceleration within three coordinate axes of the strapdown inertial combination, and calibrating the error terms of the combination of the gyroscope related to apparent acceleration, thus improving the degree of accuracy of the error model; furthermore, the calibrating process is simple and the needed time is short.

Description

A kind of method of demarcating the combination of strap down inertial navigation combination gyroscope
Technical field
The present invention relates to a kind of error coefficient scaling method, relate in particular to a kind of method of demarcating the strap down inertial navigation combination gyroscope combination error coefficient relevant with apparent acceleration, belong to strap down inertial navigation combination calibration technique, can be used for demarcating the occasion of gyroscope combination.
Background technology
Gyroscope is the core component of inertia system, for angular displacement or the angular velocity in sensitive carrier relative inertness space, the performance of inertia system is played a part crucial, is one of key content of inertial technology research.In order to measure motion angular velocity and the angular displacement of carrier in space completely, in strap down inertial navigation combination, three mutually perpendicular gyroscopes of sensitive axes are housed, its sensitive axes direction is pointed to the X, Y, Z axis positive dirction of strap down inertial navigation combination definition.Because during earth rate uses with respect to gyroscope is actual, the angular velocity of induction is less, so can use speed trial to demarcate constant multiplier and the alignment error angle of gyroscope combination.Combine in gyroscope combination error model except these two kinds of error terms at strap down inertial navigation, the apparent acceleration that gyroscope output size is born with it is also relevant, error model comprised zero degree item, once, four kinds of quadratic term and cross-couplings items, generally demarcate this class error term with multi-position test.But in theory, zero degree item and 3 quadratic term linear dependences, when calculate this 4 numerical value in an equation time, correct value can cannot be obtained simultaneously, so general scaling method can only calibrate zero degree item relevant with apparent acceleration in gyroscope combination and the coefficient of item once, cannot calibrate quadratic term, also can not demarcate cross-couplings item coefficient.This scaling method calibrates reduction the validity of coefficient, and while causing carrier to be in non-measured angular speed, deviation appears in calculation result.Therefore, in order to calibrate all error term coefficients relevant with apparent acceleration in strap down inertial navigation combination gyro error model, and improve the precision of calibration coefficient, need to study a kind of novel gyroscope combination error calibrating method.
Summary of the invention
The technical matters that the present invention solves is: the deficiency that overcomes existing scaling method, a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope is provided, realize the demarcation to all error coefficients in the gyroscope combination error model relevant with apparent acceleration, solve the problem that quadratic term coefficient cannot be demarcated, improved the precision that inertial navigation resolves.
Technical solution of the present invention is: a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope, and step is as follows:
(1) strap down inertial navigation combination is statically placed in to 18 positions, in the time of i position, gathers the combination of X, Y, Z axis gyroscope and pass through the pulse number G that Δ t exports second x(i), G yand G (i) z(i), i ∈ [1,18] wherein;
(2), according to the pulse number of exporting through Measuring Time Δ t in step (1), utilize known gyroscope combination constant multiplier, alignment error angle factor and rotational-angular velocity of the earth to calculate the offset ω of each position j axle b-ji, wherein, j is X, Y or Z;
(3) strap down inertial navigation combination gyroscope error model relevant with apparent acceleration on j direction of principal axis is ω ' j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 5ja y 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa z, according to the offset of 18 the position j axles of gyroscope combination that obtain in step (2), utilize formula
Figure BDA0000481899700000021
obtain the zero degree item error coefficient D in this error model 0jinitial value D 0j-O;
Wherein, ω ' jfor the output valve of this error model, a x, a y, a zfor the apparent acceleration component in X, Y, Z axis direction respectively; D 0jfor strap down inertial navigation combination gyroscope zero degree item error coefficient; D 1j, D 2j, D 3jfor strap down inertial navigation combination gyroscope combination once the error coefficient relevant with apparent acceleration; D 4j, D 5j, D 6jfor the strap down inertial navigation combination gyroscope combination quadratic term error coefficient relevant with apparent acceleration; D 7j, D 8j, D 9jfor the strap down inertial navigation combination gyroscope combination cross-couplings item error coefficient relevant with apparent acceleration; J is X, Y or Z;
(4) according to the initial value of the zero degree item error coefficient in the error model relevant with apparent acceleration of strap down inertial navigation combination gyroscope combination on the j direction of principal axis obtaining in the offset of 18 the position j axles of gyroscope combination that obtain in step (2) and step (3), calculate strap down inertial navigation combination gyroscope on j direction of principal axis and combine the every coefficient value in the error model that does not comprise zero degree item coefficient relevant with apparent acceleration, wherein, j is X, Y or Z;
(5) according on the j direction of principal axis obtaining in step (4) not containing the error coefficient value in the error model of zero degree item coefficient, calculate on j direction of principal axis not containing the quadratic term coefficient D in the error model of zero degree item coefficient 4j, D 5jand D 6jconspicuousness numerical value, if quadratic term coefficient significantly carries out step (6) entirely, if quadratic term coefficient be not complete significantly, carry out step (8);
(6) calculate respectively the combination of strap down inertial navigation on the j direction of principal axis gyroscope combination error model that do not comprise zero degree item coefficient relevant with apparent acceleration, do not comprise the error model of X-axis to j axle quadratic term coefficient, do not comprise the error model of Y-axis to j axle quadratic term coefficient and do not comprise the conspicuousness numerical value of the error model of Z axis to j axle quadratic term coefficient;
(7) 4 conspicuousness numerical value that obtain according to step (6), choose the error model of conspicuousness numerical value maximum as the actual error model of j axle; When the actual error model on j direction of principal axis is that while not containing the error model of zero degree item, the coefficient value calculating in step (4) is Gyro unit and is combined in the every coefficient value in error model relevant with apparent acceleration on j direction of principal axis; In the time that the actual error model on j direction of principal axis is other model, all error coefficient values in error of calculation model;
Every coefficient value in error model is fed back in the strap down inertial navigation combination gyroscope combination error model relevant with apparent acceleration, thereby complete the demarcation that strap down inertial navigation combination gyroscope combines;
(8), on the j direction of principal axis of analyzing in step (5), choose the error model of the quadratic term coefficient that does not comprise conspicuousness numerical value minimum as the actual error model on j direction of principal axis; When the actual error model on j direction of principal axis is that while not containing the error model of zero degree item, the coefficient value calculating in step (4) is Gyro unit and is combined in the every coefficient value in error model relevant with apparent acceleration on j direction of principal axis; In the time that the actual error model on j direction of principal axis is other model, all error coefficient values in error of calculation model;
Every coefficient value in error model is fed back in the strap down inertial navigation combination gyroscope combination error model relevant with apparent acceleration, thereby complete the demarcation that strap down inertial navigation combination gyroscope combines.
In described step (1), 18 positions of strap down inertial navigation combination are respectively:
Position 1: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system east, sky, southern to;
Position 2: around 45 ° of X-axis forwards, now X-axis is pointed to east to the strap down inertial navigation block position in position 1,45 °, the inclined to one side sky of Y-axis energized south, 45 ° partially of Z axis energized south;
Position 3: around 180 ° of X-axis forwards, now X-axis is pointed to east to the strap down inertial navigation block position in position 2,45 ° partially of Y-axis energized north, 45 °, the inclined to one side sky of Z axis energized north;
Position 4: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively sky, south, the Dong Fangxiang of test point geographic coordinate system;
Position 5: around 45 ° of Z axis forwards, now Z axis points to east to the strap down inertial navigation block position in position 4,45 °, the inclined to one side sky of X-axis energized south, 45 ° partially of Y-axis energized south;
Position 6: around 180 ° of Z axis forwards, now Z axis points to east to the strap down inertial navigation block position in position 5,45 ° partially of X-axis energized north, 45 °, the inclined to one side sky of Y-axis energized north;
Position 7: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively south, east, day direction of test point geographic coordinate system;
Position 8: around 45 ° of Y-axis forwards, now Y-axis is pointed to east to the strap down inertial navigation block position in position 7,45 °, the inclined to one side sky of Z axis energized south, 45 ° partially of X-axis energized south;
Position 9: around 180 ° of Y-axis forwards, now Y-axis is pointed to east to the strap down inertial navigation block position in position 8,45 ° partially of Z axis energized north, 45 °, the inclined to one side sky of X-axis energized north;
Position 10: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system north,, west to;
Position 11: around 45 ° of Z axis forwards, now Z axis points to west, 45 ° partially of X-axis energized north, 45 ° partially of Y-axis energized south to the strap down inertial navigation block position in position 10;
Position 12: around 180 ° of Z axis forwards, now Z axis sensing is western to the strap down inertial navigation block position in position 11,45 °, the inclined to one side sky of X-axis energized south, 45 °, the inclined to one side sky of Y-axis energized north;
Position 13: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system west, north, local to;
Position 14: around 45 ° of X-axis forwards, now X-axis is pointed to west, 45 ° partially of Y-axis energized north, 45 ° partially of Z axis energized south to the strap down inertial navigation block position in position 13;
Position 15: around 180 ° of X-axis forwards, now X-axis sensing is western to the strap down inertial navigation block position in position 14,45 °, the inclined to one side sky of Y-axis energized south, 45 °, the inclined to one side sky of Z axis energized north;
Position 16: make ground, west, the north that strap down inertial navigation combination X, Y, Z axis gyroscope points to respectively test point geographic coordinate system to;
Position 17: around 45 ° of Y-axis forwards, now Y-axis is pointed to west, 45 ° partially of Z axis energized north, 45 ° partially of X-axis energized south to the strap down inertial navigation block position in position 16;
Position 18: around 180 ° of Y-axis forwards, now Y-axis sensing is western to the strap down inertial navigation block position in position 17,45 °, the inclined to one side sky of Z axis energized south, 45 °, the inclined to one side sky of X-axis energized north.
The offset ω of i position X, Y, Z axis in described step (2) b-xi, ω b-yi, ω b-zicomputing formula be:
ω b - xi ω b - yi ω b - zi = G x ( i ) / ( Δt × K gx ) G y ( i ) / ( Δt × K gy ) G z ( i ) / ( Δt × K gz ) - 1 E YX E ZX E XY 1 E ZY E XZ E YZ 1 ω x ( i ) ω y ( i ) ω z ( i )
Wherein, K gx, K gy, K gzfor strap down inertial navigation combination gyroscope combination constant multiplier; E xY, E xZ, E yX, E yZ, E zX, E zYfor the alignment error angle of strap down inertial navigation combination gyroscope combination; ω x(i), ω y(i), ω z(i) while being i position, rotational-angular velocity of the earth is at the component of X, Y, Z axis direction.
The implementation method of described step (4) is:
The error model that does not comprise zero degree item coefficient on j direction of principal axis is:
ω′ j=D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji-D 0j-O;
The computing formula of every coefficient is as follows:
Once the error coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( ω j 4 ' - ω j 16 ' ) + 2 ( ω j 5 ' - ω j 6 ' - ω j 8 ' + ω j 9 ' - ω j 11 ' + ω j 12 ' - ω j 17 ' + ω j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( ω j 1 ' - ω j 10 ' ) + 2 ( ω j 2 ' - ω j 3 ' - ω j 5 ' + ω j 6 ' - ω j 11 ' + ω j 12 ' - ω j 14 ' + ω j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( ω j 7 ' - ω j 13 ' ) + 2 ( - ω j 2 ' + ω j 3 ' - ω j 8 ' - ω j 9 ' - ω j 14 ' + ω j 15 ' - ω j 17 ' + ω j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 18 [ 5 ( ω j 4 ' + ω j 16 ' ) + 2 ( ω j 5 ' + ω j 6 ' + ω j 8 ' + ω j 9 ' + ω j 11 ' + ω j 12 ' + ω j 17 ' + ω j 18 ' ) - ω j 1 ' - ω j 2 ' - ω j 3 ' - ω j 7 ' - ω j 10 ' - ω j 13 ' - ω j 14 ' - ω j 15 ' ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 18 [ 5 ( ω j 1 ' + ω j 10 ' ) + 2 ( ω j 2 ' + ω j 3 ' + ω j 5 ' + ω j 6 ' + ω j 11 ' + ω j 12 ' + ω j 14 ' + ω j 15 ' ) - ω j 4 ' - ω j 7 ' - ω j 8 ' - ω j 9 ' - ω j 13 ' - ω j 16 ' - ω j 17 ' - ω j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 18 [ 5 ( ω j 7 ' + ω j 13 ' ) + 2 ( ω j 2 ' + ω j 3 ' + ω j 8 ' + ω j 9 ' + ω j 14 ' + ω j 15 ' + ω j 17 ' + ω j 18 ' ) - ω j 1 ' - ω j 4 ' - ω j 5 ' - ω j 6 ' - ω j 10 ' - ω j 11 ' - ω j 12 ' - ω j 16 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - ω j 5 ' - ω j 6 ' + ω j 11 ' + ω j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - ω j 2 ' - ω j 3 ' + ω j 14 ' + ω j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - ω j 8 ' - ω j 9 ' + ω j 17 ' + ω j 18 ' ) .
The implementation method of described step (5) is:
For on j direction of principal axis not containing k error coefficient D in the error model of zero degree item kj, wherein k=4,5,6, its conspicuousness numerical value F 0-kfor:
F 0 - k = D kj 2 l k , k M / ( 18 - 9 - 1 )
Wherein, l k,kfor Φ -1the value of the capable k of k row, Φ=A ta,
A = a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 ;
M=Y ty-Y ta Φ -1a ty, and Y=[ω ' j1ω ' j2ω ' j18] t, the output valve ω ' that does not contain the error model of zero degree item on j direction of principal axis when i the position jib-ji-D 0j-O, a xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
By F 0-kwith numerical value F 0.99(1,9)=10.6 compare, and work as F 0-k>=F 0.99when (1,9), this term system digital display work; Work as F 0-k<F 0.99when (1,9), this coefficient is not remarkable.
The implementation method of described step (6) is as follows:
The error model that does not comprise zero degree item on j direction of principal axis is:
ω′ j=D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji-D 0j-O;
Its error model conspicuousness numerical value F 0for:
F 0 = U 0 / 9 P 0 / ( 18 - 9 - 1 )
Wherein, U 0=Y ta Φ 0 -1a ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ 0=A ta, A = a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P 0 = Y T Y - U 0 , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
On j direction of principal axis, not comprising X-axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its error model conspicuousness numerical value F xfor:
F x = U x / 9 P x / ( 18 - 9 - 1 )
Wherein, U x=Y tb xΦ x -1b x ty, Y=[ω ' j1ω ' j2ω ' j18] t, Φ x=B x tb x, B x = 1 a x 1 a y 1 a z 1 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P x = Y T Y - U x , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
On j direction of principal axis, not comprising Y-axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its error model conspicuousness numerical value F yfor:
F y = U y / 9 P y / ( 18 - 9 - 1 )
Wherein, U y=Y tb yΦ y -1b y ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ y=B y tb y, B y = 1 a x 1 a y 1 a z 1 a x 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a x 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a x 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P y = Y T Y - U y , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
On j direction of principal axis, not comprising Z axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its error model conspicuousness numerical value F zfor:
F z = U z / 9 P z / ( 18 - 9 - 1 )
Wherein, U z=Y tb zΦ z -1b z ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ z=B z tb z B z = 1 a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P z = Y T Y - U z , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value.
The actual error model of working as on j direction of principal axis in described step (7) and (8) is not comprise the error model ω ' of X-axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 5ja y 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 4 ' + &omega; j 16 ' ) + 2 ( &omega; j 5 ' + &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 2 ' - &omega; j 3 ' - &omega; j 7 ' - &omega; j 10 ' - &omega; j 13 ' - &omega; j 14 ' - &omega; j 15 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 6 [ 2 ( &omega; j 1 ' - &omega; j 14 ' + &omega; j 10 ' - &omega; j 16 ' ) + &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 6 [ 2 ( - &omega; j 4 ' + &omega; j 7 ' + &omega; j 13 ' - &omega; j 16 ' ) + &omega; j 2 ' + &omega; j 3 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 11 ' - &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
The actual error model of working as on j direction of principal axis in described step (7) and (8) is not comprise the error model ω ' of Y-axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 1 ' + &omega; j 10 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ) - &omega; j 4 ' - &omega; j 7 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 13 ' - &omega; j 16 ' - &omega; j 17 ' - &omega; j 18 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 6 [ 2 ( - &omega; j 1 ' + &omega; j 4 ' - &omega; j 10 ' + &omega; j 16 ' ) - &omega; j 2 ' - &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' - &omega; j 14 ' - &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 6 [ 2 ( - &omega; j 1 ' + &omega; j 7 ' - &omega; j 10 ' + &omega; j 13 ' ) - &omega; j 5 ' - &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' - &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
The actual error model of working as on j direction of principal axis in described step (7) and (8) is not comprise the error model ω ' of Z axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 5ja y 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 7 ' + &omega; j 13 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 14 ' + &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 4 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 10 ' - &omega; j 11 ' - &omega; j 12 ' - &omega; j 16 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 6 [ 2 ( &omega; j 4 ' - &omega; j 7 ' - &omega; j 13 ' + &omega; j 16 ' ) - &omega; j 2 ' - &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' - &omega; j 18 ' ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 6 [ 2 ( &omega; j 1 ' - &omega; j 7 ' + &omega; j 10 ' - &omega; j 13 ' ) + &omega; j 5 ' + &omega; j 6 ' - &omega; j 8 ' - &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' - &omega; j 18 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
The present invention's advantage is compared with prior art as follows:
(1) existing strap down inertial navigation combination gyroscope combination calibration algorithm can only be demarcated zero degree item relevant to apparent acceleration in strap down inertial navigation combination gyro error model and item once, method of the present invention can complete the demarcation of all coefficients (comprising quadratic term and cross-couplings item coefficient) in error model, because consider that in error model, all coefficients are on the impact of exporting simultaneously, the error coefficient that uses this method to calculate has higher stated accuracy;
(2) because carrying out having carried out conspicuousness consideration when zero degree item and quadratic term are chosen, so the error model of selecting has the highest degree of conformity, the output error minimum that uses this group calibration result to calculate with actual output;
(3) existing scaling method test position is few, and the detecting information comprising is also less, and method test position of the present invention is many, comprises more information, and this can improve precision and the reliability of calibration result;
(4), compared with existing scaling method, method test of the present invention is consuming time less, calculating is simple, can complete fast the demarcation of inertia combination gyroscope combination.
Brief description of the drawings
Fig. 1 is the calibration process process flow diagram of the inventive method;
Fig. 2 is the calibration position layout figure of the inventive method.
Embodiment
Calibrating after the constant multiplier and alignment error angle of gyroscope combination, also needing to calibrate the error term coefficient relevant to apparent acceleration and just can complete the compensation that gyroscope combination is exported, obtaining high-precision carrier angular velocity measurement value.
Traditional strap down inertial navigation combination gyroscope combination calibration algorithm can only calibrate zero degree item relevant to apparent acceleration in strap down inertial navigation combination gyroscope combination error model and item error coefficient once, cannot calibrate quadratic term, also can not demarcate cross-couplings item coefficient.In order to calibrate all error term coefficients relevant with apparent acceleration in strap down inertial navigation combination gyroscope combination error model, and improve the precision of calibration coefficient, the invention provides a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope, for the computing gyroscope combination error coefficient relevant with apparent acceleration.Umber of pulse output frequency can be according to following formula and carrier apparent acceleration and angular velocity opening relationships, and this is strapdown and is used to organize gyro error model:
G xp G yp G zp = K gx 0 0 0 K gy 0 0 0 K gz D 0 x D 0 y D 0 z + D 1 x D 2 x D 3 x D 1 y D 2 y D 3 y D 1 z D 2 z D 3 z a x a y a z D 4 x D 5 x D 6 x D 4 y D 5 y D 6 y D 4 z D 5 z D 6 z a x 2 a y 2 a z 2 + D 7 x D 8 x D 9 x D 7 y D 8 y D 9 y D 7 z D 8 z D 9 z a x a y a y a z a x a z + 1 E YX E ZX E XY 1 E ZY E XZ E YZ 1 &omega; x &omega; y &omega; z
In formula, G xp, G yp, G zpbe respectively X, Y, Z axis gyroscope output pulse frequency (unit is Pulse/s); K gx, K gy, K gzbe respectively constant multiplier (unit is Pulse/ rad); D 0x, D 0y, D 0zbe respectively zero degree item coefficient (unit for °/h); D 1x, D 1y, D 1z, D 2x, D 2y, D 2z, D 3x, D 3y, D 3zfor Monomial coefficient relevant to apparent acceleration, (unit is °/h/g 0); D 4x, D 4y, D 4z, D 5x, D 5y, D 5z, D 6x, D 6y, D 6zfor quadratic term coefficient relevant to apparent acceleration, (unit is °/h/g 0 2); D 7x, D 7y, D 7z, D 8x, D 8y, D 8z, D 9x, D 9y, D 9zfor cross-couplings item coefficient relevant to apparent acceleration, (unit is °/h/g 0 2); a x, a y, a zbeing respectively strapdown is used to organize X, Y, Z axis (unit is g to apparent acceleration component 0); E yX, E zX, E xY, E zY, E xZ, E yZfor alignment error angle (unit is rad); ω x, ω y, ω zbe respectively strapdown be used to organize X, Y, Z axis to angular velocity component (unit for °/h); g 0for testing location terrestrial gravitation acceleration.
Can obtain the error model relevant with apparent acceleration on gyroscope combination j axle by above-mentioned error model is ω ' j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 5ja y 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa z, wherein, ω ' jfor the output valve of this error model (unit is °/h), j is X, Y or Z.
As shown in Figure 1, step is as follows for step of the present invention:
(1) strap down inertial navigation combination is statically placed in to 18 positions, in the time of i position, gathers the combination of X, Y, Z axis gyroscope and pass through the pulse number G that Δ t exports second x(i), G yand G (i) z(i), i ∈ [1,18] wherein;
Be implemented as follows:
Position 1: make east, sky, south that strap down inertial navigation combination X, Y, Z axis gyroscope points to respectively test point geographic coordinate system to, record X, Y, Z axis gyroscope and pass through the pulse number that Δ t exports second, be respectively G x(1), G yand G (1) z(1);
Position 2: around 45 ° of X-axis forwards, now X-axis is pointed to east to the strap down inertial navigation block position in position 1, days 45 ° partially of Y-axis energized south, 45 ° partially of Z axis energized south, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(2), G yand G (2) z(2);
Position 3: around 180 ° of X-axis forwards, now X-axis is pointed to east to the strap down inertial navigation block position in position 2,45 ° partially of Y-axis energized north, days 45 ° partially of Z axis energized north, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(3), G yand G (3) z(3);
Position 4: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively sky, south, the Dong Fangxiang of test point geographic coordinate system, record X, Y, Z axis gyroscope and pass through the pulse number that Δ t exports second, be respectively G x(4), G yand G (4) z(4);
Position 5: around 45 ° of Z axis forwards, now Z axis points to east to the strap down inertial navigation block position in position 4, days 45 ° partially of X-axis energized south, 45 ° partially of Y-axis energized south, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(5), G yand G (5) z(5);
Position 6: around 180 ° of Z axis forwards, now Z axis points to east to the strap down inertial navigation block position in position 5,45 ° partially of X-axis energized north, days 45 ° partially of Y-axis energized north, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(6), G yand G (6) z(6);
Position 7: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively south, east, day direction of test point geographic coordinate system, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, be respectively G x(7), G yand G (7) z(7);
Position 8: around 45 ° of Y-axis forwards, now Y-axis is pointed to east to the strap down inertial navigation block position in position 7, days 45 ° partially of Z axis energized south, 45 ° partially of X-axis energized south, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(8), G yand G (8) z(8);
Position 9: around 180 ° of Y-axis forwards, now Y-axis is pointed to east to the strap down inertial navigation block position in position 8,45 ° partially of Z axis energized north, days 45 ° partially of X-axis energized north, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(9), G yand G (9) z(9);
Position 10: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system north,, west to, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, be respectively G x(10), G yand G (10) z(10);
Position 11: around 45 ° of Z axis forwards, now Z axis points to west to the strap down inertial navigation block position in position 10,45 ° partially of X-axis energized north, 45 ° partially of Y-axis energized south, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(11), G yand G (11) z(11);
Position 12: around 180 ° of Z axis forwards, now Z axis points to west to the strap down inertial navigation block position in position 11, days 45 ° partially of X-axis energized south, days 45 ° partially of Y-axis energized north, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(12), G yand G (12) z(12);
Position 13: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system west, north, local to, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, be respectively G x(13), G yand G (13) z(13);
Position 14: around 45 ° of X-axis forwards, now X-axis is pointed to west to the strap down inertial navigation block position in position 13,45 ° partially of Y-axis energized north, 45 ° partially of Z axis energized south, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(14), G yand G (14) z(14);
Position 15: around 180 ° of X-axis forwards, now X-axis is pointed to west to the strap down inertial navigation block position in position 14, days 45 ° partially of Y-axis energized south, days 45 ° partially of Z axis energized north, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(15), G yand G (15) z(15);
Position 16: make ground, west, the north that strap down inertial navigation combination X, Y, Z axis gyroscope points to respectively test point geographic coordinate system to, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, be respectively G x(16), G yand G (16) z(16);
Position 17: around 45 ° of Y-axis forwards, now Y-axis is pointed to west to the strap down inertial navigation block position in position 16,45 ° partially of Z axis energized north, 45 ° partially of X-axis energized south, record the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(17), G yand G (17) z(17);
Position 18: around 180 ° of Y-axis forwards, now Y-axis is pointed to west to the strap down inertial navigation block position in position 17, days 45 ° partially of Z axis energized south, days 45 ° partially of X-axis energized north, write down the pulse number that X, Y, Z axis gyroscope is exported through Δ t second, are respectively G x(18), G yand G (18) z(18).
(2), according to the pulse number of exporting through Measuring Time Δ t in step (1), utilize known gyroscope combination constant multiplier, alignment error angle factor and rotational-angular velocity of the earth to calculate the offset ω of each position j axle b-ji, wherein, j is X, Y or Z;
The offset ω of i position X, Y, Z axis b-xi, ω b-yi, ω b-zicomputing formula be:
&omega; b - xi &omega; b - yi &omega; b - zi = G x ( i ) / ( &Delta;t &times; K gx ) G y ( i ) / ( &Delta;t &times; K gy ) G z ( i ) / ( &Delta;t &times; K gz ) - 1 E YX E ZX E XY 1 E ZY E XZ E YZ 1 &omega; x ( i ) &omega; y ( i ) &omega; z ( i )
Wherein, K gx, K gy, K gzfor strap down inertial navigation combination gyroscope combination constant multiplier (unit is Pulse/ rad); E xY, E xZ, E yX, E yZ, E zX, E zYfor the alignment error angle (unit is rad) of strap down inertial navigation combination gyroscope combination; ω x(i), ω y(i), ω z(i) while being i position rotational-angular velocity of the earth the component of X, Y, Z axis direction (unit for °/h), the rotational-angular velocity of the earth of each position is as shown in the table at the component of X, Y, Z axis direction, ω efor earth rotation angular speed (unit is °/h),
Figure BDA0000481899700000173
for testing location latitude.
Figure BDA0000481899700000172
Figure BDA0000481899700000181
(3) according to the offset of 18 the position j axles of gyroscope combination that obtain in step (2), utilize formula
Figure BDA0000481899700000182
obtain the strap down inertial navigation combination gyroscope combination error model ω ' relevant with apparent acceleration on j direction of principal axis j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 5ja y 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa zin zero degree item error coefficient D 0jinitial value D 0j-O;
Wherein, ω ' jfor the output valve of this error model (unit is °/h), a x, a y, a zfor apparent acceleration respectively the component in X, Y, Z axis direction (unit is g 0), be given value, the component a of the apparent acceleration of each position in X, Y, Z axis direction xi, a yi, a zias shown in the table.
Figure BDA0000481899700000191
D 0jfor strap down inertial navigation combination gyroscope zero degree item error coefficient (unit is °/h); D 1j, D 2, D 3jfor the strap down inertial navigation combination gyroscope combination once item error coefficient relevant with apparent acceleration, (unit is °/h/g 0); D 4j, D 5j, D 6jfor the strap down inertial navigation combination gyroscope combination quadratic term error coefficient relevant with apparent acceleration, (unit is °/h/g 0 2); D 7j, D 8j, D 9jfor the strap down inertial navigation combination gyroscope combination cross-couplings item error coefficient relevant with apparent acceleration, (unit is °/h/g 0 2); J is X, Y or Z.
(4) according to the initial value of the zero degree item error coefficient in the error model relevant with apparent acceleration of strap down inertial navigation combination gyroscope combination on the j direction of principal axis obtaining in the offset of 18 the position j axles of gyroscope combination that obtain in step (2) and step (3), calculate strap down inertial navigation combination gyroscope on j direction of principal axis and combine the every coefficient value in the error model that does not comprise zero degree item coefficient relevant with apparent acceleration, wherein, j is X, Y or Z;
The error model that does not comprise zero degree item coefficient on j direction of principal axis is:
ω′ j=D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model (unit is °/h), now its output valve computing formula is when i position:
ω′ xib-xi-D 0x-O
ω′ yib-yi-D 0y-O
ω′ zib-zi-D 0z-O
The computing formula of every coefficient is as follows:
Once the error coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 18 [ 5 ( &omega; j 4 ' + &omega; j 16 ' ) + 2 ( &omega; j 5 ' + &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 2 ' - &omega; j 3 ' - &omega; j 7 ' - &omega; j 10 ' - &omega; j 13 ' - &omega; j 14 ' - &omega; j 15 ' ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 18 [ 5 ( &omega; j 1 ' + &omega; j 10 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ) - &omega; j 4 ' - &omega; j 7 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 13 ' - &omega; j 16 ' - &omega; j 17 ' - &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 18 [ 5 ( &omega; j 7 ' + &omega; j 13 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 14 ' + &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 4 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 10 ' - &omega; j 11 ' - &omega; j 12 ' - &omega; j 16 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
(5) according on the j direction of principal axis obtaining in step (4) not containing the error coefficient value in the error model of zero degree item coefficient, calculate on j direction of principal axis not containing the quadratic term coefficient D in the error model of zero degree item coefficient 4j, D 5jand D 6jconspicuousness numerical value, if quadratic term coefficient significantly carries out step (6) entirely, if quadratic term coefficient be not complete significantly, carry out step (8); J is X, Y or Z;
For on j direction of principal axis not containing k error coefficient D in the error model of zero degree item kj(k=4,5,6), its conspicuousness numerical value F 0-kfor:
F 0 - k = D kj 2 l k , k M / ( 18 - 9 - 1 )
Wherein, l k,kfor Φ -1the value of the capable k of k row, and, Φ=A ta,
A = a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 ;
M=Y ty-Y ta Φ -1a ty, and Y=[ω ' j1ω ' j2ω ' j18] t, the output valve ω ' that does not contain the error model of zero degree item on j direction of principal axis when i the position jib-ji-D 0j-O, a xi, a yi, a ziwhile being i position apparent acceleration respectively the component in X, Y, Z axis direction (unit is g 0), be given value;
By F 0-kwith numerical value F 0.99(1,9)=10.6 compare, and work as F 0-k>=F 0.99when (1,9), this term system digital display work; Work as F 0-k<F 0.99when (1,9), this coefficient is not remarkable.
(6) calculate respectively the combination of strap down inertial navigation on the j direction of principal axis gyroscope combination error model that do not comprise zero degree item coefficient relevant with apparent acceleration, do not comprise the error model of X-axis to j axle quadratic term coefficient, do not comprise the error model of Y-axis to j axle quadratic term coefficient and do not comprise the conspicuousness numerical value of the error model of Z axis to j axle quadratic term coefficient; J is X, Y or Z;
The error model that does not comprise zero degree item on j direction of principal axis is:
ω′ j=D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model (unit is °/h), now its output valve is ω ' when i position jib-ji-D 0j-O;
Its error model conspicuousness numerical value F 0for:
F 0 = U 0 / 9 P 0 / ( 18 - 9 - 1 )
Wherein, U 0=Y ta Φ 0 -1a ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ 0=A ta, A = a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P 0 = Y T Y - U 0 , A xi, a yi, a ziwhile being i position apparent acceleration respectively the component in X, Y, Z axis direction (unit is g 0), be given value;
On j direction of principal axis, not comprising X-axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model (unit is °/h), now its output valve is ω ' when i position jib-ji;
Its error model conspicuousness numerical value F xfor:
F x = U x / 9 P x / ( 18 - 9 - 1 )
Wherein, U x=Y tb xΦ x -1b x ty, Y=[ω ' j1ω ' j2ω ' j18] t, Φ x=B x tb x, B x = 1 a x 1 a y 1 a z 1 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P x = Y T Y - U x , A xi, a yi, a ziwhile being i position apparent acceleration respectively the component in X, Y, Z axis direction (unit is g 0), be given value;
On j direction of principal axis, not comprising Y-axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model (unit is °/h), now its output valve is ω ' when i position jib-ji;
Its error model conspicuousness numerical value F yfor:
F y = U y / 9 P y / ( 18 - 9 - 1 )
Wherein, U y=Y tb yΦ y -1b y ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ y=B y tb y, B y = 1 a x 1 a y 1 a z 1 a x 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a x 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a x 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P y = Y T Y - U y , A xi, a yi, a ziwhile being i position apparent acceleration respectively the component in X, Y, Z axis direction (unit is g 0), be given value;
On j direction of principal axis, not comprising Z axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model (unit is °/h), now its output valve is ω ' when i position jib-ji.
Its error model conspicuousness numerical value F zfor:
F z = U z / 9 P z / ( 18 - 9 - 1 )
Wherein, U z=Y tb zΦ z -1b z ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ z=B z tb z B z = 1 a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P z = Y T Y - U z , A xi, a yi, a ziwhile being i position, the apparent acceleration component in X, Y, Z axis direction (unit is g0) respectively, is given value.
(7) 4 conspicuousness numerical value that obtain according to step (6), choose the error model of conspicuousness numerical value maximum as the actual error model of j axle; When the actual error model on j direction of principal axis is that while not containing the error model of zero degree item, the coefficient value calculating in step (4) is Gyro unit and is combined in the every coefficient value in error model relevant with apparent acceleration on j direction of principal axis; In the time that the actual error model on j direction of principal axis is other model, all error coefficient values in error of calculation model;
Every coefficient value in error model is fed back in the strap down inertial navigation combination gyroscope combination error model relevant with apparent acceleration, thereby complete the demarcation that strap down inertial navigation combination gyroscope combines;
(8), on the j direction of principal axis of analyzing in step (5), choose the error model of the quadratic term coefficient that does not comprise conspicuousness numerical value minimum as the actual error model on j direction of principal axis; When the actual error model on j direction of principal axis is that while not containing the error model of zero degree item, the coefficient value calculating in step (4) is Gyro unit and is combined in the every coefficient value in error model relevant with apparent acceleration on j direction of principal axis; In the time that the actual error model on j direction of principal axis is other model, all error coefficient values in error of calculation model;
Every coefficient value in error model is fed back in the strap down inertial navigation combination gyroscope combination error model relevant with apparent acceleration, thereby complete the demarcation that strap down inertial navigation combination gyroscope combines.
When the actual error model on j direction of principal axis is not comprise the error model ω ' of X-axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 5ja y 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 4 ' + &omega; j 16 ' ) + 2 ( &omega; j 5 ' + &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 2 ' - &omega; j 3 ' - &omega; j 7 ' - &omega; j 10 ' - &omega; j 13 ' - &omega; j 14 ' - &omega; j 15 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 6 [ 2 ( &omega; j 1 ' - &omega; j 14 ' + &omega; j 10 ' - &omega; j 16 ' ) + &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 6 [ 2 ( - &omega; j 4 ' + &omega; j 7 ' + &omega; j 13 ' - &omega; j 16 ' ) + &omega; j 2 ' + &omega; j 3 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 11 ' - &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
When the actual error model on j direction of principal axis is not comprise the error model ω ' of Y-axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 1 ' + &omega; j 10 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ) - &omega; j 4 ' - &omega; j 7 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 13 ' - &omega; j 16 ' - &omega; j 17 ' - &omega; j 18 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 6 [ 2 ( - &omega; j 1 ' + &omega; j 4 ' - &omega; j 10 ' + &omega; j 16 ' ) - &omega; j 2 ' - &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' - &omega; j 14 ' - &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 6 [ 2 ( - &omega; j 1 ' + &omega; j 7 ' - &omega; j 10 ' + &omega; j 13 ' ) - &omega; j 5 ' - &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' - &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
When the actual error model on j direction of principal axis is not comprise the error model ω ' of Z axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 5ja y 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 7 ' + &omega; j 13 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 14 ' + &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 4 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 10 ' - &omega; j 11 ' - &omega; j 12 ' - &omega; j 16 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 6 [ 2 ( &omega; j 4 ' - &omega; j 7 ' - &omega; j 13 ' + &omega; j 16 ' ) - &omega; j 2 ' - &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' - &omega; j 18 ' ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 6 [ 2 ( &omega; j 1 ' - &omega; j 7 ' + &omega; j 10 ' - &omega; j 13 ' ) + &omega; j 5 ' + &omega; j 6 ' - &omega; j 8 ' - &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' - &omega; j 18 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
In practical application, first, determine the X, Y, Z axis direction of strap down inertial navigation combination, and before demarcation, gyroscope is combined and carries out abundant preheating.Then, inertia combination is successively discharged as position shown in Fig. 2, and in the time of i position record through the pulse value G of three accelerometer outputs after Δ t second x(i), G yand G (i) z(i).For a change in coordinate axis direction, calculate the each error coefficient in this error model that does not axially comprise zero degree item and carry out significance analysis according to formula.In the time that quadratic term coefficient is entirely remarkable, calculating respectively this axle does not comprise zero degree item, does not comprise X-axis quadratic term, do not comprise Y-axis quadratic term and does not comprise the conspicuousness numerical value of four kinds of error models of Z axis quadratic term, the actual error model that the model of choosing conspicuousness numerical value maximum is this axle, and use respective formula to calculate the each error coefficient in model; When quadratic term coefficient is complete significantly time, using the error model of quadratic term coefficient that does not comprise conspicuousness numerical value minimum as the actual error model of this axle, and use respective formula to calculate the each error coefficient in model.Three coordinate axis are as above calculated respectively, can be calculated all gyroscope combinations all error coefficients relevant to apparent acceleration.
The present invention not detailed description is known to the skilled person technology.

Claims (9)

1. a method of demarcating the combination of strap down inertial navigation combination gyroscope, is characterized in that step is as follows:
(1) strap down inertial navigation combination is statically placed in to 18 positions, in the time of i position, gathers the combination of X, Y, Z axis gyroscope and pass through the pulse number G that Δ t exports second x(i), G yand G (i) z(i), i ∈ [1,18] wherein;
(2), according to the pulse number of exporting through Measuring Time Δ t in step (1), utilize known gyroscope combination constant multiplier, alignment error angle factor and rotational-angular velocity of the earth to calculate the offset ω of each position j axle b-ji, wherein, j is X, Y or Z;
(3) strap down inertial navigation combination gyroscope error model relevant with apparent acceleration on j direction of principal axis is ω ' j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 5ja y 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa z, according to the offset of 18 the position j axles of gyroscope combination that obtain in step (2), utilize formula obtain the zero degree item error coefficient D in this error model 0jinitial value D 0j-O;
Wherein, ω ' jfor the output valve of this error model, a x, a y, a zfor the apparent acceleration component in X, Y, Z axis direction respectively; D 0jfor strap down inertial navigation combination gyroscope zero degree item error coefficient; D 1j, D 2j, D 3jfor strap down inertial navigation combination gyroscope combination once the error coefficient relevant with apparent acceleration; D 4j, D 5j, D 6jfor the strap down inertial navigation combination gyroscope combination quadratic term error coefficient relevant with apparent acceleration; D 7j, D 8j, D 9jfor the strap down inertial navigation combination gyroscope combination cross-couplings item error coefficient relevant with apparent acceleration; J is X, Y or Z;
(4) according to the initial value of the zero degree item error coefficient in the error model relevant with apparent acceleration of strap down inertial navigation combination gyroscope combination on the j direction of principal axis obtaining in the offset of 18 the position j axles of gyroscope combination that obtain in step (2) and step (3), calculate strap down inertial navigation combination gyroscope on j direction of principal axis and combine the every coefficient value in the error model that does not comprise zero degree item coefficient relevant with apparent acceleration, wherein, j is X, Y or Z;
(5) according on the j direction of principal axis obtaining in step (4) not containing the error coefficient value in the error model of zero degree item coefficient, calculate on j direction of principal axis not containing the quadratic term coefficient D in the error model of zero degree item coefficient 4j, D 5jand D 6jconspicuousness numerical value, if quadratic term coefficient significantly carries out step (6) entirely, if quadratic term coefficient be not complete significantly, carry out step (8);
(6) calculate respectively the combination of strap down inertial navigation on the j direction of principal axis gyroscope combination error model that do not comprise zero degree item coefficient relevant with apparent acceleration, do not comprise the error model of X-axis to j axle quadratic term coefficient, do not comprise the error model of Y-axis to j axle quadratic term coefficient and do not comprise the conspicuousness numerical value of the error model of Z axis to j axle quadratic term coefficient;
(7) 4 conspicuousness numerical value that obtain according to step (6), choose the error model of conspicuousness numerical value maximum as the actual error model of j axle; When the actual error model on j direction of principal axis is that while not containing the error model of zero degree item, the coefficient value calculating in step (4) is Gyro unit and is combined in the every coefficient value in error model relevant with apparent acceleration on j direction of principal axis; In the time that the actual error model on j direction of principal axis is other model, all error coefficient values in error of calculation model;
Every coefficient value in error model is fed back in the strap down inertial navigation combination gyroscope combination error model relevant with apparent acceleration, thereby complete the demarcation that strap down inertial navigation combination gyroscope combines;
(8), on the j direction of principal axis of analyzing in step (5), choose the error model of the quadratic term coefficient that does not comprise conspicuousness numerical value minimum as the actual error model on j direction of principal axis; When the actual error model on j direction of principal axis is that while not containing the error model of zero degree item, the coefficient value calculating in step (4) is Gyro unit and is combined in the every coefficient value in error model relevant with apparent acceleration on j direction of principal axis; In the time that the actual error model on j direction of principal axis is other model, all error coefficient values in error of calculation model;
Every coefficient value in error model is fed back in the strap down inertial navigation combination gyroscope combination error model relevant with apparent acceleration, thereby complete the demarcation that strap down inertial navigation combination gyroscope combines.
2. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: in described step (1), 18 positions of strap down inertial navigation combination are respectively:
Position 1: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system east, sky, southern to;
Position 2: around 45 ° of X-axis forwards, now X-axis is pointed to east to the strap down inertial navigation block position in position 1,45 °, the inclined to one side sky of Y-axis energized south, 45 ° partially of Z axis energized south;
Position 3: around 180 ° of X-axis forwards, now X-axis is pointed to east to the strap down inertial navigation block position in position 2,45 ° partially of Y-axis energized north, 45 °, the inclined to one side sky of Z axis energized north;
Position 4: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively sky, south, the Dong Fangxiang of test point geographic coordinate system;
Position 5: around 45 ° of Z axis forwards, now Z axis points to east to the strap down inertial navigation block position in position 4,45 °, the inclined to one side sky of X-axis energized south, 45 ° partially of Y-axis energized south;
Position 6: around 180 ° of Z axis forwards, now Z axis points to east to the strap down inertial navigation block position in position 5,45 ° partially of X-axis energized north, 45 °, the inclined to one side sky of Y-axis energized north;
Position 7: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively south, east, day direction of test point geographic coordinate system;
Position 8: around 45 ° of Y-axis forwards, now Y-axis is pointed to east to the strap down inertial navigation block position in position 7,45 °, the inclined to one side sky of Z axis energized south, 45 ° partially of X-axis energized south;
Position 9: around 180 ° of Y-axis forwards, now Y-axis is pointed to east to the strap down inertial navigation block position in position 8,45 ° partially of Z axis energized north, 45 °, the inclined to one side sky of X-axis energized north;
Position 10: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system north,, west to;
Position 11: around 45 ° of Z axis forwards, now Z axis points to west, 45 ° partially of X-axis energized north, 45 ° partially of Y-axis energized south to the strap down inertial navigation block position in position 10;
Position 12: around 180 ° of Z axis forwards, now Z axis sensing is western to the strap down inertial navigation block position in position 11,45 °, the inclined to one side sky of X-axis energized south, 45 °, the inclined to one side sky of Y-axis energized north;
Position 13: make strap down inertial navigation combination X, Y, Z axis gyroscope point to respectively test point geographic coordinate system west, north, local to;
Position 14: around 45 ° of X-axis forwards, now X-axis is pointed to west, 45 ° partially of Y-axis energized north, 45 ° partially of Z axis energized south to the strap down inertial navigation block position in position 13;
Position 15: around 180 ° of X-axis forwards, now X-axis sensing is western to the strap down inertial navigation block position in position 14,45 °, the inclined to one side sky of Y-axis energized south, 45 °, the inclined to one side sky of Z axis energized north;
Position 16: make ground, west, the north that strap down inertial navigation combination X, Y, Z axis gyroscope points to respectively test point geographic coordinate system to;
Position 17: around 45 ° of Y-axis forwards, now Y-axis is pointed to west, 45 ° partially of Z axis energized north, 45 ° partially of X-axis energized south to the strap down inertial navigation block position in position 16;
Position 18: around 180 ° of Y-axis forwards, now Y-axis sensing is western to the strap down inertial navigation block position in position 17,45 °, the inclined to one side sky of Z axis energized south, 45 °, the inclined to one side sky of X-axis energized north.
3. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: the offset ω of i position X, Y, Z axis in described step (2) b-xi, ω b-yi, ω b-zicomputing formula be:
&omega; b - xi &omega; b - yi &omega; b - zi = G x ( i ) / ( &Delta;t &times; K gx ) G y ( i ) / ( &Delta;t &times; K gy ) G z ( i ) / ( &Delta;t &times; K gz ) - 1 E YX E ZX E XY 1 E ZY E XZ E YZ 1 &omega; x ( i ) &omega; y ( i ) &omega; z ( i )
Wherein, K gx, K gy, K gzfor strap down inertial navigation combination gyroscope combination constant multiplier; E xY, E xZ, E yX, E yZ, E zX, E zYfor the alignment error angle of strap down inertial navigation combination gyroscope combination; ω x(i), ω y(i), ω z(i) while being i position, rotational-angular velocity of the earth is at the component of X, Y, Z axis direction.
4. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: the implementation method of described step (4) is:
The error model that does not comprise zero degree item coefficient on j direction of principal axis is:
ω′ j=D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji-D 0j-O;
The computing formula of every coefficient is as follows:
Once the error coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 18 [ 5 ( &omega; j 4 ' + &omega; j 16 ' ) + 2 ( &omega; j 5 ' + &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 2 ' - &omega; j 3 ' - &omega; j 7 ' - &omega; j 10 ' - &omega; j 13 ' - &omega; j 14 ' - &omega; j 15 ' ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 18 [ 5 ( &omega; j 1 ' + &omega; j 10 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ) - &omega; j 4 ' - &omega; j 7 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 13 ' - &omega; j 16 ' - &omega; j 17 ' - &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 18 [ 5 ( &omega; j 7 ' + &omega; j 13 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 14 ' + &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 4 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 10 ' - &omega; j 11 ' - &omega; j 12 ' - &omega; j 16 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
5. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: the implementation method of described step (5) is:
For on j direction of principal axis not containing k error coefficient D in the error model of zero degree item kj,, wherein k=4,5,6, its conspicuousness numerical value F 0-kfor:
F 0 - k = D kj 2 l k , k M / ( 18 - 9 - 1 )
Wherein, l k,kfor Φ -1the value of the capable k of k row, Φ=A ta,
A = a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 ;
M=Y ty-Y ta Φ -1a ty, and Y=[ω ' j1ω ' j2ω ' j18] t, the output valve ω ' that does not contain the error model of zero degree item on j direction of principal axis when i the position jib-ji-D 0j-O, a xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
By F 0-kwith numerical value F 0.99(1,9)=10.6 compare, and work as F 0-k>=F 0.99when (1,9), this term system digital display work; Work as F 0-k<F 0.99when (1,9), this coefficient is not remarkable.
6. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: the implementation method of described step (6) is as follows:
The error model that does not comprise zero degree item on j direction of principal axis is:
ω′ j=D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji-D 0j-O;
Its error model conspicuousness numerical value F 0for:
F 0 = U 0 / 9 P 0 / ( 18 - 9 - 1 )
Wherein, U 0=Y ta Φ 0 -1a ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ 0=A ta, A = a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P 0 = Y T Y - U 0 , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
On j direction of principal axis, not comprising X-axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 5ja y 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its error model conspicuousness numerical value F xfor:
F x = U x / 9 P x / ( 18 - 9 - 1 )
Wherein, U x=Y tb xΦ x -1b x ty, Y=[ω ' j1ω ' j2ω ' j18] t, Φ x=B x tb x, B x = 1 a x 1 a y 1 a z 1 a y 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a y 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a y 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P x = Y T Y - U x , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
On j direction of principal axis, not comprising Y-axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 6ja z 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its error model conspicuousness numerical value F yfor:
F y = U y / 9 P y / ( 18 - 9 - 1 )
Wherein, U y=Y tb yΦ y -1b y ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ y=B y tb y, B y = 1 a x 1 a y 1 a z 1 a x 1 2 a z 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a x 2 2 a z 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a x 18 2 a z 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P y = Y T Y - U y , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value;
On j direction of principal axis, not comprising Z axis to the error model of j axle quadratic term coefficient is:
ω′ j=D 0j+D 1ja x+D 2ja y+D 3ja z+D 4ja x 2+D 5ja y 2+D 7ja xa y+D 8ja ya z+D 9ja xa z
Wherein, ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its error model conspicuousness numerical value F zfor:
F z = U z / 9 P z / ( 18 - 9 - 1 )
Wherein, U z=Y tb zΦ z -1b z ty, and, Y=[ω ' j1ω ' j2ω ' j18] t, Φ z=B z tb z B z = 1 a x 1 a y 1 a z 1 a x 1 2 a y 1 2 a x 1 a y 1 a y 1 a z 1 a x 1 a z 1 1 a x 2 a y 2 a z 2 a x 2 2 a y 2 2 a x 2 a y 2 a y 2 a z 2 a x 2 a z 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 a x 18 a y 18 a z 18 a x 18 2 a y 18 2 a x 18 a y 18 a y 18 a z 18 a x 18 a z 18 , P z = Y T Y - U z , A xi, a yi, a zithe apparent acceleration component in X, Y, Z axis direction respectively while being i position is given value.
7. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: the actual error model of working as on j direction of principal axis in described step (7) and (8) is not comprise the error model ω ' of X-axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 5ja y 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Its zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 4 ' + &omega; j 16 ' ) + 2 ( &omega; j 5 ' + &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 2 ' - &omega; j 3 ' - &omega; j 7 ' - &omega; j 10 ' - &omega; j 13 ' - &omega; j 14 ' - &omega; j 15 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 6 [ 2 ( &omega; j 1 ' - &omega; j 14 ' + &omega; j 10 ' - &omega; j 16 ' ) + &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 6 [ 2 ( - &omega; j 4 ' + &omega; j 7 ' + &omega; j 13 ' - &omega; j 16 ' ) + &omega; j 2 ' + &omega; j 3 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 11 ' - &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
8. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: the actual error model of working as on j direction of principal axis in described step (7) and (8) is not comprise the error model ω ' of Y-axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 6ja z 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 1 ' + &omega; j 10 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' + &omega; j 14 ' + &omega; j 15 ' ) - &omega; j 4 ' - &omega; j 7 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 13 ' - &omega; j 16 ' - &omega; j 17 ' - &omega; j 18 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' - &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 6 [ 2 ( - &omega; j 1 ' + &omega; j 4 ' - &omega; j 10 ' + &omega; j 16 ' ) - &omega; j 2 ' - &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' - &omega; j 14 ' - &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ]
The quadratic term coefficient D of Z axis to j axle 6jcomputing formula be:
D 6 j = 1 6 [ 2 ( - &omega; j 1 ' + &omega; j 7 ' - &omega; j 10 ' + &omega; j 13 ' ) - &omega; j 5 ' - &omega; j 6 ' + &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' - &omega; j 12 ' + &omega; j 17 ' + &omega; j 18 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
9. a kind of method of demarcating the combination of strap down inertial navigation combination gyroscope according to claim 1, is characterized in that: the actual error model of working as on j direction of principal axis in described step (7) and (8) is not comprise the error model ω ' of Z axis to j axle quadratic term coefficient j=D 0j+ D 1ja x+ D 2ja y+ D 3ja z+ D 4ja x 2+ D 5ja y 2+ D 7ja xa y+ D 8ja ya z+ D 9ja xa ztime, wherein ω ' jfor the output valve of this error model,, its output valve is ω ' when i the position jib-ji;
Zero degree item coefficient D 0jcomputing formula be:
D 0 j = 1 18 [ 5 ( &omega; j 7 ' + &omega; j 13 ' ) + 2 ( &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' + &omega; j 9 ' + &omega; j 14 ' + &omega; j 15 ' + &omega; j 17 ' + &omega; j 18 ' ) - &omega; j 1 ' - &omega; j 4 ' - &omega; j 5 ' - &omega; j 6 ' - &omega; j 10 ' - &omega; j 11 ' - &omega; j 12 ' - &omega; j 16 ' ]
The Monomial coefficient D of X-axis to j axle 1jcomputing formula be:
D 1 j = 1 12 [ 2 ( &omega; j 4 ' - &omega; j 16 ' ) + 2 ( &omega; j 5 ' - &omega; j 6 ' - &omega; j 8 ' + &omega; j 9 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The Monomial coefficient D of Y-axis to j axle 2jcomputing formula be:
D 2 j = 1 12 [ 2 ( &omega; j 1 ' - &omega; j 10 ' ) + 2 ( &omega; j 2 ' - &omega; j 3 ' - &omega; j 5 ' + &omega; j 6 ' - &omega; j 11 ' + &omega; j 12 ' - &omega; j 14 ' + &omega; j 15 ' ) ]
The Monomial coefficient D of Z axis to j axle 3jcomputing formula be:
D 3 j = 1 12 [ 2 ( &omega; j 7 ' - &omega; j 13 ' ) + 2 ( - &omega; j 2 ' + &omega; j 3 ' + &omega; j 8 ' - &omega; j 9 ' - &omega; j 14 ' + &omega; j 15 ' - &omega; j 17 ' + &omega; j 18 ' ) ]
The quadratic term coefficient D of X-axis to j axle 4jcomputing formula be:
D 4 j = 1 6 [ 2 ( &omega; j 4 ' - &omega; j 7 ' - &omega; j 13 ' + &omega; j 16 ' ) - &omega; j 2 ' - &omega; j 3 ' + &omega; j 5 ' + &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' - &omega; j 18 ' ]
The quadratic term coefficient D of Y-axis to j axle 5jcomputing formula be:
D 5 j = 1 6 [ 2 ( &omega; j 1 ' - &omega; j 7 ' + &omega; j 10 ' - &omega; j 13 ' ) + &omega; j 5 ' + &omega; j 6 ' - &omega; j 8 ' - &omega; j 9 ' + &omega; j 11 ' + &omega; j 12 ' - &omega; j 17 ' - &omega; j 18 ' ]
X, the cross-couplings item coefficient D of Y-axis product to j axle 7jcomputing formula be:
D 7 j = 1 2 ( - &omega; j 5 ' - &omega; j 6 ' + &omega; j 11 ' + &omega; j 12 ' )
Y, the cross-couplings item coefficient D of Z-axis direction product to j axle 8jcomputing formula be:
D 8 j = 1 2 ( - &omega; j 2 ' - &omega; j 3 ' + &omega; j 14 ' + &omega; j 15 ' )
X, the cross-couplings item coefficient D of Z-axis direction product to j axle 9jcomputing formula be:
D 9 j = 1 2 ( - &omega; j 8 ' - &omega; j 9 ' + &omega; j 17 ' + &omega; j 18 ' ) .
CN201410114551.0A 2014-03-25 2014-03-25 A kind of method demarcating strap down inertial navigation combination gyrostat combination Active CN103884356B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410114551.0A CN103884356B (en) 2014-03-25 2014-03-25 A kind of method demarcating strap down inertial navigation combination gyrostat combination

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410114551.0A CN103884356B (en) 2014-03-25 2014-03-25 A kind of method demarcating strap down inertial navigation combination gyrostat combination

Publications (2)

Publication Number Publication Date
CN103884356A true CN103884356A (en) 2014-06-25
CN103884356B CN103884356B (en) 2016-06-01

Family

ID=50953379

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410114551.0A Active CN103884356B (en) 2014-03-25 2014-03-25 A kind of method demarcating strap down inertial navigation combination gyrostat combination

Country Status (1)

Country Link
CN (1) CN103884356B (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104297525A (en) * 2014-09-30 2015-01-21 北京航天控制仪器研究所 Accelerometer calibration method for inertia measurement system on basis of rocket sled test
CN104296779A (en) * 2014-09-30 2015-01-21 北京航天控制仪器研究所 Rocket-sled-test-based iterative compensation method applied to accelerometer of inertial measurement system
CN105242070A (en) * 2014-07-09 2016-01-13 北京自动化控制设备研究所 Accelerometer unit calibration method without vector standard
CN104596543B (en) * 2015-01-13 2017-07-28 北京航天控制仪器研究所 Gyroscope combined error coefficient scaling method under a kind of benchmark uncertain condition
CN113865585A (en) * 2021-09-07 2021-12-31 北京航天控制仪器研究所 Method and system for separating and compensating combined high-order error coefficient of gyroscope

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101029833A (en) * 2007-03-12 2007-09-05 北京航空航天大学 Method for calibrating connected MEMS gyro dynamic error
CN101377422A (en) * 2008-09-22 2009-03-04 北京航空航天大学 Method for calibrating optimum 24 positions of flexible gyroscope static drift error model
CN101738203A (en) * 2009-12-08 2010-06-16 北京航空航天大学 Optimal position calibration method of static drifting zero and primary acceleration related term error model of flexible gyroscope

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101029833A (en) * 2007-03-12 2007-09-05 北京航空航天大学 Method for calibrating connected MEMS gyro dynamic error
CN101377422A (en) * 2008-09-22 2009-03-04 北京航空航天大学 Method for calibrating optimum 24 positions of flexible gyroscope static drift error model
CN101738203A (en) * 2009-12-08 2010-06-16 北京航空航天大学 Optimal position calibration method of static drifting zero and primary acceleration related term error model of flexible gyroscope

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
RONG ZHU等: "Calibration of three-dimensional intergrated sensors for improved system accuracy.pdf", 《A PHYSICAL ACTUATORS AND SENSORS》, 18 January 2006 (2006-01-18) *
Z F SYED等: "A new multi-position calibration method for MEMS inertial navigation system", 《MEASUREMENT SCIENCE AND TECHNLOLOGY》, no. 18, 31 December 2007 (2007-12-31) *
张皓之: "平台系统精密离心机测试方法研究", 《中国优秀硕士学位论文全文数据库工程科技II辑》, 15 December 2011 (2011-12-15) *
程源: "激光陀螺捷联惯性组合的标定方法研究", 《中国优秀硕士学位论文全文数据库工程科技II辑》, 15 May 2011 (2011-05-15) *
肖龙旭等: "惯测组合快速高精度标定方法研究", 《宇航学报》, vol. 29, no. 1, 31 January 2008 (2008-01-31) *
谢波等: "激光陀螺捷联惯导系统多位置标定方法", 《中国惯性技术学报》, vol. 19, no. 2, 30 April 2011 (2011-04-30) *
郑云霞等: "某陀螺仪二次项测试方法研究", 《导航与控制》, vol. 10, no. 4, 30 November 2011 (2011-11-30) *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105242070A (en) * 2014-07-09 2016-01-13 北京自动化控制设备研究所 Accelerometer unit calibration method without vector standard
CN105242070B (en) * 2014-07-09 2018-09-18 北京自动化控制设备研究所 A kind of accelerometer combination scaling method of scalar potential standard
CN104297525A (en) * 2014-09-30 2015-01-21 北京航天控制仪器研究所 Accelerometer calibration method for inertia measurement system on basis of rocket sled test
CN104296779A (en) * 2014-09-30 2015-01-21 北京航天控制仪器研究所 Rocket-sled-test-based iterative compensation method applied to accelerometer of inertial measurement system
CN104596543B (en) * 2015-01-13 2017-07-28 北京航天控制仪器研究所 Gyroscope combined error coefficient scaling method under a kind of benchmark uncertain condition
CN113865585A (en) * 2021-09-07 2021-12-31 北京航天控制仪器研究所 Method and system for separating and compensating combined high-order error coefficient of gyroscope
CN113865585B (en) * 2021-09-07 2023-08-29 北京航天控制仪器研究所 Method and system for separating and compensating combined high-order error coefficient of gyroscope

Also Published As

Publication number Publication date
CN103884356B (en) 2016-06-01

Similar Documents

Publication Publication Date Title
CN101975872B (en) Method for calibrating zero offset of quartz flexible accelerometer component
CN101887068B (en) Calibration compensation method for triaxial vector sensor and biaxial vector sensor
CN110006450B (en) Calibration method of laser strapdown inertial navigation system on horizontal three-axis turntable
CN101290326B (en) Parameter identification calibration method for rock quartz flexibility accelerometer measuring component
CN102221372B (en) Method for calibrating error of inertia measurement unit by using centrifugal machine and turntable
CN102393210B (en) Temperature calibration method of laser gyro inertia measurement unit
CN104165638B (en) Multi-position self-calibration method for biaxial rotating inertial navigation system
CN103884356A (en) Method for calibrating combination of strapdown inertial combination gyroscope
CN104165641B (en) Milemeter calibration method based on strapdown inertial navigation/laser velocimeter integrated navigation system
CN101706284B (en) Method for increasing position precision of optical fiber gyro strap-down inertial navigation system used by ship
CN104596543B (en) Gyroscope combined error coefficient scaling method under a kind of benchmark uncertain condition
RU2406973C2 (en) Method for calibration of platform-free inertial navigation systems
CN102278108B (en) Calibration method for continuous measurement mode of small-bore directional gyro inclinometer
CN104197958B (en) Speedometer calibration method based on laser velocimeter dead reckoning system
CN102589573A (en) Sensor field calibration method in miniature integrated navigation system
CN103941042A (en) Method for calibrating multiposition error coefficients of gyroaccelerometer
CN103954299B (en) A kind of method demarcating strap down inertial navigation combination gyroscope combination
CN104121928A (en) Method for calibrating inertial measurement unit applicable to low-precision single-shaft transposition device with azimuth reference
Feng et al. A new method of initial alignment and self-calibration based on dual-axis rotating strapdown inertial navigation system
CN101738203A (en) Optimal position calibration method of static drifting zero and primary acceleration related term error model of flexible gyroscope
CN107576977A (en) The UAV Navigation System and method adaptively merged based on multi-source information
CN103364842B (en) A kind of error separation method of strapdown airborne gravitometer
CN103983274A (en) Inertial measurement unit calibration method suitable for low-precision no-azimuth reference biaxial transfer equipment
CN103868527B (en) A kind of method for demarcating strap down inertial navigation combination accelerometer combination
CN104501833B (en) Accelerometer combined error coefficient scaling method under a kind of benchmark uncertain condition

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant