CN103308046A - Correction method of gyroscope drift of strapdown inertial navigation system by using position and course information under inertial system - Google Patents
Correction method of gyroscope drift of strapdown inertial navigation system by using position and course information under inertial system Download PDFInfo
- Publication number
- CN103308046A CN103308046A CN2013101565353A CN201310156535A CN103308046A CN 103308046 A CN103308046 A CN 103308046A CN 2013101565353 A CN2013101565353 A CN 2013101565353A CN 201310156535 A CN201310156535 A CN 201310156535A CN 103308046 A CN103308046 A CN 103308046A
- Authority
- CN
- China
- Prior art keywords
- inertial
- sins
- gyroscopic drift
- following formula
- under
- 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.)
- Pending
Links
Images
Landscapes
- Navigation (AREA)
Abstract
The invention discloses a correction method of gyroscope drift of a strapdown inertial navigation system by using position and course information under an inertial system. Compared with the traditional method, the correction method only requires keeping a horizontal misalignment angle as a small angle at a correction moment, and does not require keeping the horizontal misalignment angle as the small angle all the time.
Description
One, technical field
What the present invention relates to is a kind of integrated calibration technology, particularly relate to the strapdown inertial navitation system (SINS) gyroscopic drift alignment technique of use location and course information under a kind of inertial system, relate in particular to a kind of need not the to limit use location of carrier movement state and the strapdown inertial navitation system (SINS) gyroscopic drift alignment technique of course information.
Two, background technology
For ship's inertial navigation system, its difficulty just is that the cycle of operation is long, and accuracy requirement is high, must regularly carry out biharmonic to system and proofread and correct.With regard to Methods of Strapdown Inertial Navigation System, the precision of gyro has determined the precision of whole system to a great extent, improve the precision of system, and its key is exactly to improve Gyro Precision.Adopt system-level algorithm can effectively reduce cost, by introducing external reference information the gyroscopic drift of system is proofreaied and correct, can limit the error of inertial navigation system, improve the precision of inertial navigation system.The alignment technique comparative maturity of current platform formula inertial navigation system, but be not suitable for Methods of Strapdown Inertial Navigation System, and larger to the restriction of the maneuver mode of carrier, therefore research can effectively reduce the requirement of carrier maneuver mode and the integrated calibration technology that is applicable to Methods of Strapdown Inertial Navigation System are significant and practical value for the precision that improves strapdown inertial navitation system (SINS).
Three, summary of the invention
Goal of the invention: the object of the present invention is to provide does not a kind ofly need to limit the carrier movement state and just can utilize external position and course information to proofread and correct out the bearing calibration of the gyroscopic drift of strapdown inertial navitation system (SINS) accurately.
The object of the present invention is achieved like this:
The present invention includes the following step:
(1) navigation coordinate system is projected under the inertial system with the azimuth of computing machine coordinate system, obtain the differential expressions of the ψ equation under the inertial system, and then obtain the relational expression between the ψ angle and strapdown inertial navitation system (SINS) gyroscopic drift under the inertial system;
(2) relational expression under the inertial system of step (1) being set up between ψ angle and the strapdown inertial navitation system (SINS) gyroscopic drift is carried out integration, can get arbitrarily the relational expression between the ψ angle increment and gyroscopic drift between two moment;
(3) set up the relation between the ψ angle under position and course error and the inertial system, can get arbitrarily the constantly relational expression between upper/lower positions and the course error of ψ angle increment between two moment and two;
(4) utilize step (2) and step (3) can obtain relational expression between twice position and course error and the gyroscopic drift, thereby calculate gyroscopic drift and the compensation of strapdown inertial navitation system (SINS), improve navigation accuracy.
Method of the present invention has the following advantages:
Therefore 1. classic method is to set up the ψ angle equation under the OEPQ coordinate system, needs the motion state of restriction carrier to be: low speed, etc. the latitude motion, and be not suitable for Methods of Strapdown Inertial Navigation System.And the present invention does not need to limit the carrier movement state, especially is fit to Methods of Strapdown Inertial Navigation System.
2. compare with classic method, it is that low-angle gets final product that the present invention only needs at the horizontal misalignment of corrected time maintenance, does not need horizontal misalignment to remain on low-angle always.
Description of drawings
Fig. 1 is the strapdown inertial navitation system (SINS) gyroscopic drift bearing calibration process flow diagram of indication of the present invention;
Fig. 2 does not carry out the site error curve that gyroscopic drift is proofreaied and correct in the embodiments of the invention;
Fig. 3 does not carry out the speed-error curve that gyroscopic drift is proofreaied and correct in the embodiments of the invention;
Fig. 4 does not carry out the attitude error curve that gyroscopic drift is proofreaied and correct in the embodiments of the invention;
Fig. 5 carries out the site error curve that gyroscopic drift is proofreaied and correct in the embodiments of the invention;
Fig. 6 carries out the speed-error curve that gyroscopic drift is proofreaied and correct in the embodiments of the invention;
Fig. 7 carries out the attitude error curve that gyroscopic drift is proofreaied and correct in the embodiments of the invention.
Embodiment:
1. ψ equation being projected as under inertial coordinates system:
In the following formula (20):
For calculating the projection of differential under inertial coordinates system i of the azimuth between navigation coordinate system and the computing machine coordinate system, ε
iBe the projection of gyroscopic drift under inertial coordinates system i.ε
bBe the gyroscopic drift of the strapdown inertial navitation system (SINS) projection at carrier coordinate system b,
Be the transition matrix between carrier coordinate system b and the inertial coordinates system i, can be obtained in real time by gyro output:
In the following formula (21):
Be gyro output;
* be to be exported by gyro
The antisymmetric matrix that consists of:
Initial value
Determined by following formula (22):
In the following formula (22):
T
0Constantly calculated by strapdown inertial navitation system (SINS);
In the following formula (24): latitude L
0With longitude λ
0Can be by t
0External position information provides ω constantly
IeBeing the earth rotation angular speed, is accurately known.T is from t
0The time that constantly begins to calculate.
By above step, set up the gyroscopic drift of strapdown inertial navitation system (SINS) and the relation between the ψ angle.
2. can solve (20) formula integration:
In the following formula (25), ψ
i(0) is t
0ψ constantly
iInitial value.
Get any two moment t
nAnd t
N+1, can draw according to (25) formula:
Can be obtained by following formula (26) and formula (27):
ψ
i(t
n+1)=ψ
i(t
n)+ψ
i(t
n+1|t
n) (28)
In the following formula (28), ψ
i(t
N+1| t
n) ψ that produces for gyroscopic drift
iIncrement:
ψ
i(t
n+1|t
n)=A(t
n+1|t
n)ε
b (29)
In the following formula (29)
Set up ψ under the inertial coordinates system by (29) following formula
iIncrement and strapdown inertial navitation system (SINS) gyroscopic drift ε
bBetween relation.
3. at first need to control strapdown inertial navitation system (SINS) and be operated in the horizontal damping state, behind system stability, the lateral error angle φ of strapdown inertial navitation system (SINS)
xAnd φ
yThe accelerometer bias that only depends on east orientation and north orientation.General high-precision inertial navigation system accelerometer bias is better than 1 * 10
-4So g is φ
xAnd φ
yBe generally less than 0.5 jiao minute, can ignore, i.e. φ
x=0, φ
y=0.
Therefore, the definition according to coordinate system has following relation:
Φ=δθ+ψ (30)
In the following formula (30), Φ represents to calculate the projection that the azimuth between navigation coordinate system and the navigation coordinate system is fastened at navigation coordinate:
Φ=[φ
x φ
y φ
z]
T (31)
δ θ represents the projection that the azimuth between computing machine coordinate system and the navigation coordinate system is fastened at navigation coordinate.
δθ=[δθ
x δθ
y δθ
z]
T=[-δL δλ·cosL δλ·sinL]
T (33)
In the following formula (32), δ L is latitude error, and δ λ is trueness error.
Can find out according to above definition:
By external accessory, we can obtain accurately latitude L, longitude λ and course K information, and the calculating latitude of strapdown inertial navitation system (SINS) is L
c, the calculating longitude is λ
c, the calculating course is K
c, so the position of strapdown inertial navitation system (SINS) and course error are:
Can be derived by formula (30), formula (33)~formula (34):
Note P (t)=[δ L δ λ δ K]
T
Transformational relation according to coordinate system has:
So have:
Following formula is set up the relation between the ψ angle under position and course error and the inertial system, to moment t
nAnd t
N+1, can draw according to formula (37):
Can obtain according to following formula (38) and formula (39):
4. by (29) formula and (40) formula, can obtain:
Therefore can obtain:
Claims (5)
1. the strapdown inertial navitation system (SINS) gyroscopic drift bearing calibration of use location and course information under the inertial system is characterized in that performing step is as follows:
(1) navigation coordinate system and the azimuth ψ of computing machine coordinate system are projected under the inertial coordinates system, obtain the differential expressions of the ψ equation under the inertial system, and then obtain the relational expression between the ψ angle and strapdown inertial navitation system (SINS) gyroscopic drift under the inertial system;
(2) relational expression under the inertial system of step (1) being set up between ψ angle and the strapdown inertial navitation system (SINS) gyroscopic drift is carried out Integration Solving, can get arbitrarily the relational expression between the ψ angle increment and gyroscopic drift between two moment;
(3) set up the relation between the ψ angle under position and course error and the inertial system, can get arbitrarily ψ angle increment and the position in these two moment and the relational expression between the course error between two moment;
(4) utilize step (2) and step (3) can obtain relational expression between the two constantly gyroscopic drifts of positions and course error and strapdown inertial navitation system (SINS), thereby calculate gyroscopic drift and the compensation of strapdown inertial navitation system (SINS), raising navigation accuracy.
2. the strapdown inertial navitation system (SINS) gyroscopic drift bearing calibration of use location and course information under a kind of inertial system described in according to claim 1, it is characterized in that: the relational expression under the inertial system described in the described step (1) between ψ angle and the strapdown inertial navitation system (SINS) gyroscopic drift is:
In the following formula (1):
For calculating the projection of differential under inertial coordinates system i of the azimuth between navigation coordinate system and the computing machine coordinate system; ε
iThe projection of gyroscopic drift under inertial coordinates system i for strapdown inertial navitation system (SINS); ε
bBe the gyroscopic drift of the strapdown inertial navitation system (SINS) projection at carrier coordinate system b;
Be the transition matrix between carrier coordinate system b and the inertial coordinates system i, can be obtained in real time by gyro output:
In the following formula (2):
Be gyro output;
* be to be exported by gyro
The antisymmetric matrix that consists of;
Initial value
Determined by following formula (3):
In the following formula (3):
T
0Constantly calculated by strapdown inertial navitation system (SINS)
In following formula (4) and (5): latitude L
0With longitude λ
0Can be by t
0External position information provides constantly: ω
IeBeing the earth rotation angular speed, is accurately known; T is from t
0The time that constantly begins to calculate.
3. the strapdown inertial navitation system (SINS) gyroscopic drift bearing calibration of use location and course information under a kind of inertial system described in according to claim 1 is characterized in that: in the described step (2) between any two moment the implementation procedure of the relational expression between ψ angle increment and the gyroscopic drift be:
Can solve (1) formula equal sign two ends while integration:
In the following formula (6), ψ
i(0) is t
0ψ constantly
iInitial value.
Get any two moment t
nAnd t
N+1, can draw according to (6) formula:
Can be obtained by following formula (7) and (8)
ψ
i(t
n+1)=ψ
i(t
n)+ψ
i(t
n+1|t
n) (9)
In the following formula (9), ψ
i(t
N+1| t
n) ψ that produces for gyroscopic drift
iIncrement:
ψ
i(t
n+1|t
n)=A(t
n+1|t
n)ε
b (10)
Set up ψ under the inertial coordinates system by following formula (10)
iIncrement and strapdown inertial navitation system (SINS) gyroscopic drift ε
bBetween relation.
4. the strapdown inertial navitation system (SINS) gyroscopic drift bearing calibration of use location and course information under a kind of inertial system described in according to claim 1, it is characterized in that: the implementation procedure of ψ angle increment and the position in these two moment and the relational expression between the course error is as follows between any two moment described in the described step (3):
The ψ angle in the projection of navigation coordinate system and the relational expression between position and the course error is:
P(t)=M(t).ψ
n(t) (11)
Have according to the transformational relation between the coordinate system:
To obtain in (12) formula substitution (11) formula:
Following formula (13) is set up the relation between the ψ angle, then t under position and course error and the inertial system
nThe moment and t
N+1Shi Keyou:
Can obtain according to formula (14) and formula (15) that ψ angle increment and the position in these two moment and the relational expression between the course error are under the inertial system:
5. the strapdown inertial navitation system (SINS) gyroscopic drift bearing calibration of use location and course information under a kind of inertial system described in according to claim 1 is characterized in that: two described in the described step (4) constantly the position and the relational expression between the gyroscopic drift of course error and strapdown inertial navitation system (SINS) be:
The calculating formula that can obtain strapdown inertial navitation system (SINS) gyroscopic drift by (17) formula is:
Strapdown inertial navitation system (SINS) gyroscopic drift compensation formula is:
In the following formula (19),
Be the output of the gyro after the compensation.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013101565353A CN103308046A (en) | 2013-04-26 | 2013-04-26 | Correction method of gyroscope drift of strapdown inertial navigation system by using position and course information under inertial system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013101565353A CN103308046A (en) | 2013-04-26 | 2013-04-26 | Correction method of gyroscope drift of strapdown inertial navigation system by using position and course information under inertial system |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103308046A true CN103308046A (en) | 2013-09-18 |
Family
ID=49133536
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2013101565353A Pending CN103308046A (en) | 2013-04-26 | 2013-04-26 | Correction method of gyroscope drift of strapdown inertial navigation system by using position and course information under inertial system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103308046A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105424062A (en) * | 2015-12-17 | 2016-03-23 | 北京理工大学 | Combined comprehensive correction method for inertial navigation system |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030028340A1 (en) * | 2001-06-26 | 2003-02-06 | Etienne Brunstein | Hybrid inertial navigation method and device |
CN101706284A (en) * | 2009-11-09 | 2010-05-12 | 哈尔滨工程大学 | Method for increasing position precision of optical fiber gyro strap-down inertial navigation system used by ship |
WO2012049492A1 (en) * | 2010-10-13 | 2012-04-19 | University Of Nottingham | Positioning system |
CN103033197A (en) * | 2012-12-20 | 2013-04-10 | 西安电子工程研究所 | Method for correcting zero drift of MEMS gyroscope |
-
2013
- 2013-04-26 CN CN2013101565353A patent/CN103308046A/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030028340A1 (en) * | 2001-06-26 | 2003-02-06 | Etienne Brunstein | Hybrid inertial navigation method and device |
CN101706284A (en) * | 2009-11-09 | 2010-05-12 | 哈尔滨工程大学 | Method for increasing position precision of optical fiber gyro strap-down inertial navigation system used by ship |
WO2012049492A1 (en) * | 2010-10-13 | 2012-04-19 | University Of Nottingham | Positioning system |
CN103033197A (en) * | 2012-12-20 | 2013-04-10 | 西安电子工程研究所 | Method for correcting zero drift of MEMS gyroscope |
Non-Patent Citations (3)
Title |
---|
YUE-YANG BEN ET AL: "Analysis of Error for a Rotating Strap-down Inertial Navigation System with Fibro Gyro", 《JOURNAL OF MARINE SCIENCE AND APPLICATION》 * |
冯培德等: "一种新的舰载惯导***综合校正方法", 《中国惯性技术学报》 * |
张鑫: "船用单轴旋转光纤陀螺捷联惯导初始对准/测漂及综合校正研究", 《中国博士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105424062A (en) * | 2015-12-17 | 2016-03-23 | 北京理工大学 | Combined comprehensive correction method for inertial navigation system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104501838B (en) | SINS Initial Alignment Method | |
CN102608596B (en) | Information fusion method for airborne inertia/Doppler radar integrated navigation system | |
CN102829781B (en) | Implementation method of rotation type strapdown optical-fiber compass | |
CN102830414B (en) | Combined navigation method based on SINS/GPS (strapdown inertial navigation system/global position system) | |
CN103245359B (en) | A kind of inertial sensor fixed error real-time calibration method in inertial navigation system | |
CN103528584B (en) | Based on the polar region inertial navigation of horizontal geographic coordinate system | |
CN103575299A (en) | Alignment and error correction method for double-axis rotational inertial navigation system based on appearance measurement information | |
CN102519485B (en) | Gyro information-introduced double-position strapdown inertial navigation system initial alignment method | |
CN103940446B (en) | A kind of polar navigation boats and ships strapdown inertial navigation system readjustment method based on abscissa system | |
CN102679978B (en) | Initial alignment method of static base of rotary type strap-down inertial navigation system | |
CN103217174B (en) | A kind of strapdown inertial navitation system (SINS) Initial Alignment Method based on low precision MEMS (micro electro mechanical system) | |
CN103674059A (en) | External measured speed information-based horizontal attitude error correction method for SINS (serial inertial navigation system) | |
CN101793523A (en) | Combined navigation and photoelectric detection integrative system | |
CN104374388A (en) | Flight attitude determining method based on polarized light sensor | |
CN103900607A (en) | Rotation type strapdown inertial navigation system transposition method based on inertial system | |
CN103900566B (en) | A kind of eliminate the method that rotation modulation type SINS precision is affected by rotational-angular velocity of the earth | |
CN108592946B (en) | Inertial device drift online monitoring method based on two sets of rotary inertial navigation redundancy configuration | |
CN107270938A (en) | Single-shaft-rotation inertial navigation system posture demodulation method based on Taylor series fitting | |
Xiong et al. | A two-position SINS initial alignment method based on gyro information | |
CN102393204B (en) | Combined navigation information fusion method based on SINS (Ship's Inertial Navigation System)/CNS (Communication Network System) | |
CN103697911A (en) | Initial attitude determination method for strapdown inertial navigation system under circumstance of unknown latitude | |
CN102645223A (en) | Serial inertial navigation vacuum filtering correction method based on specific force observation | |
CN103499348A (en) | High-precision attitude data calculation method for AHRS (Attitude and Heading Reference System) | |
CN105444762A (en) | Rapid inertial navigation error correction method for onboard satellite communication in motion | |
CN102168978B (en) | Marine inertial navigation system swing pedestal open loop aligning method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20130918 |