CN110763231B - Error-free attitude updating method suitable for fiber optic gyroscope filtering signal - Google Patents

Error-free attitude updating method suitable for fiber optic gyroscope filtering signal Download PDF

Info

Publication number
CN110763231B
CN110763231B CN201910978003.5A CN201910978003A CN110763231B CN 110763231 B CN110763231 B CN 110763231B CN 201910978003 A CN201910978003 A CN 201910978003A CN 110763231 B CN110763231 B CN 110763231B
Authority
CN
China
Prior art keywords
coordinate system
time
optic gyroscope
fiber
carrier coordinate
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910978003.5A
Other languages
Chinese (zh)
Other versions
CN110763231A (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.)
Harbin Hatran Navigation Technology Co ltd
Original Assignee
Harbin Engineering University
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 Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201910978003.5A priority Critical patent/CN110763231B/en
Publication of CN110763231A publication Critical patent/CN110763231A/en
Application granted granted Critical
Publication of CN110763231B publication Critical patent/CN110763231B/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
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18Stabilised platforms, e.g. by gyroscope

Abstract

The invention provides an error-free attitude updating method suitable for a filter signal of a fiber-optic gyroscope, belonging to strapdown inertial navigationThe field of the invention. The method comprises the following steps: 1. giving initial navigation parameters; 2. the system sets a sampling period and an attitude resolving period, and acquires output signals of the fiber optic gyroscope subjected to average filtering processing on three axes in real time; 3. the phase compensation digital filter performs phase compensation on the collected fiber optic gyroscope filtering signal to obtain a gyroscope output signal without phase delay; 4. recursive measurement t k+1 Angular velocity of rotation at a time; 5. recursion measuring t k+1 A conversion matrix from the time carrier coordinate system to the rotating coordinate system; 6. recursive measurement t k+1 Rotating the coordinate system by time t k A conversion matrix of the moment carrier coordinate system b; 7. recursive measurement t k+1 Time carrier coordinate system to t k And combining the result of the last resolving period with the transformation matrix of the moment carrier coordinate system to complete the error-free attitude updating suitable for the filtering signal of the fiber-optic gyroscope. The invention solves the problem of error-free attitude updating of the fiber-optic gyroscope filtering signal.

Description

Error-free attitude updating method suitable for fiber optic gyroscope filtering signal
Technical Field
The invention relates to an attitude updating method of a strapdown inertial navigation system, in particular to an error-free attitude updating method suitable for a fiber-optic gyroscope filtering signal of the strapdown inertial navigation system, and belongs to the field of strapdown inertial navigation.
Background
Since the advent of the strapdown inertial navigation system, scholars at home and abroad have conducted a great deal of research on high-performance strapdown inertial navigation algorithms. The navigation algorithm of the strapdown inertial navigation system consists of a posture updating algorithm, a speed updating algorithm and a position updating algorithm, wherein the posture updating algorithm is the core of the whole strapdown algorithm. This is because the attitude update algorithm not only directly determines the accuracy of the navigation attitude angle, but also has a crucial influence on the output accuracy of speed and position. For a fiber optic gyroscope strapdown inertial navigation system, the output of the gyroscope contains not only the angular velocity of the carrier, but also some high frequency noise. Averaging filtering is usually required to demodulate the angular velocity information of the carrier. Amplitude-frequency and phase-frequency characteristics of the average filter influence gyro signals, so that the filtered signals are distorted. Therefore, it is necessary to develop an error-free attitude updating method suitable for the fiber-optic gyroscope filtering signal.
However, in published articles, such as yellow Lei, liu Jian and ever-celebrated New Cone Algorithm based on high-order compensation model in the book 17 of the book of Chinese inertia technology, no. 6, higher-order analysis of rotational vector differential equations is performed to better compensate for cone errors. In addition, ignagi M B takes the limited bandwidth of the gyro into consideration in the article of "Optimal stripe integration algorithms" published in Journal of guide Control and Dynamics, and designs the Optimal cone compensation algorithm. In addition, wangman and Wu Wen started from the article "High-order approximation in connection and rotation relating" published in IEEE Transactions on Aerospace and Electronic Systems "take the consideration more thoroughly, the six-order approximation of the differential equation of the rotation vector is retained, the attitude updating precision is greatly improved, but the derivation process of the compensation algorithm is very complicated.
The published articles describe and explore the attitude updating algorithm of strapdown inertial navigation, but all the attitude updating algorithms are obtained on the basis of approximation of a rotary vector differential equation, and a principle error exists essentially. In addition, the above algorithms are based on ideal sensor output signals, and in practical situations, the sensor signals are distorted, resulting in reduced algorithm performance. Therefore, the method for researching the error-free attitude updating algorithm based on the output signals of the sensors under the actual conditions has innovativeness and actual engineering value.
Disclosure of Invention
The invention provides an error-free attitude updating method suitable for a filter signal of a fiber-optic gyroscope, and aims to realize error-free attitude updating under the condition of distortion of an output signal of a sensor.
The purpose of the invention is realized by the following steps:
step 1. Given initial navigation parameters (time t = 0): obtaining an initial pitch attitude angle theta by initial alignment of a fiber optic gyroscope strapdown inertial navigation system 0 Initial roll attitude angle gamma 0 Initial azimuth psi 0
Step 2, the system sets a sampling period h, an attitude calculation period T, T = h, and an attitude calculation period cycle mark k, namely T k To t k+1 The time period represents a speed resolving period T, and the output signals omega of the fiber-optic gyroscope on three axes after average filtering processing are collected in real time k ,k=0,1,2…;
Step 3, phase compensation digital filter H F (Z) carrying out phase compensation on the output signal of the fiber-optic gyroscope after average filtering processing to obtain the gyroscope output signal without phase delay
Figure BDA0002234278140000021
Step 4. Recursion measuring t k+1 Angular velocity alpha of rotation of the movement of the time rotation coordinate system s relative to the carrier coordinate system b k+1
Step 5. Recursion measuring t k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure BDA0002234278140000022
Step 6. Recursion measuring t k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000023
Step 7. Recursion measuring t k+1 Time carrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000024
Using t k+1 Time of dayCarrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000025
And the attitude updating without error suitable for the filtering signal of the fiber-optic gyroscope is completed by combining the result of the last resolving period.
The invention also includes:
the specific expression of the phase compensation digital filter in the step 3 is as follows:
Figure BDA0002234278140000026
where M is the order of the phase compensated digital filter, λ 12 ,...,λ M Are weight coefficients, i.e. the undetermined coefficients of the digital filter. Weight coefficient lambda 12 ,...,λ M The expression is as follows:
Figure BDA0002234278140000027
wherein Q 2 Is λ 234 ,…,λ M A column vector of M-1 dimension, Z is a square matrix of (M-1) × (M-1), E is a column vector of M-1 dimension:
Z(r,s)={S(Ω)[1-cos(rΩT)]+C(Ω)sin(rΩT)}·{S(Ω)[1-cos(sΩT)]+C(Ω)sin(sΩT)}
E(r)=S(Ω){S(Ω)[1-cos(rΩT)]+C(Ω)sin(rΩT)}
wherein r is the row number r =0,1,2, \8230;, M-1 of the square matrix Z and the column vector E; s is the number of columns of the square matrix s =0,1,2, \ 8230;, M-1; omega is a vibration main frequency point set by a user according to the working environment of the fiber-optic gyroscope, and S (omega) = sin [ gamma ] F (Ω)],C(Ω)=cos[γ F (Ω)],γ F (Ω) is the phase delay of the phase compensated digital filter at the main frequency point Ω.
The process in the step 4 specifically comprises the following steps: using t k Gyro output signal without phase delay at any moment
Figure BDA0002234278140000028
And t k+1 Gyro output signal without phase delay at any moment
Figure BDA0002234278140000029
Obtaining the rotation angular velocity alpha of the movement of the rotating coordinate system s relative to the carrier coordinate system b k+1 Is composed of
Figure BDA0002234278140000031
Wherein omega is a vibration dominant frequency point, | H, set by a user according to the working environment of the fiber-optic gyroscope F (omega) | is the amplitude-frequency gain of the phase compensation digital filter at the main frequency point omega; sin for medical use -1 (. -) represents the arcsine value of.i | represents the module value of.x represents the vector cross product.
Step 5 said transformation matrix
Figure BDA0002234278140000032
The solving process of (2) is specifically as follows: using t obtained in step 4 k+1 Angular velocity alpha of rotation of the movement of the time rotation coordinate system s relative to the carrier coordinate system b k+1 Calculating to obtain t k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure BDA0002234278140000033
Figure BDA0002234278140000034
Wherein
Figure BDA0002234278140000035
Each represents alpha k+1 The x, y, z axis components of (a).
Step 6 said transformation matrix
Figure BDA0002234278140000036
The solving process is as follows: using t k Gyro output signal without phase delay at moment
Figure BDA0002234278140000037
And t obtained in step 4 k+1 Angular velocity alpha of rotation of the movement of the time-of-day rotating coordinate system s relative to the carrier coordinate system b k+1 Calculating to obtain t k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000038
Figure BDA0002234278140000039
Step 7 the transformation matrix
Figure BDA00022342781400000310
The solving process is as follows: using t obtained in step 5 k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure BDA00022342781400000311
And t obtained in step 6 k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure BDA00022342781400000312
Calculating to obtain t k+1 Time carrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure BDA00022342781400000313
Figure BDA00022342781400000314
The invention has the beneficial effects that:
aiming at the problem of attitude updating of a strapdown inertial navigation system, the invention provides an error-free attitude updating method suitable for a filter signal of a fiber-optic gyroscope, so that error-free attitude updating under the condition of signal distortion of a sensor is realized, and a good foundation is laid for the next speed and position updating.
Drawings
FIG. 1 is a flow chart of an error-free attitude updating method for a fiber optic gyroscope filtering signal according to the present invention;
FIG. 2 is an algorithm error comparison.
Detailed Description
The invention is further described below with reference to the accompanying drawings:
the invention provides an error-free attitude updating method suitable for a fiber optic gyroscope filtering signal. The method comprises the following steps: obtaining an initial pitch attitude angle theta by initial alignment of the fiber-optic gyroscope strapdown inertial navigation system 0 Initial roll attitude angle gamma 0 Initial azimuth psi 0
The system sets a sampling period h and an attitude resolving period T, and acquires output signals omega of the fiber optic gyroscope subjected to average filtering processing on three axes in real time k ,k=0,1,2…;
Phase compensated digital filter H F (Z) carrying out phase compensation on the collected fiber-optic gyroscope filtering signal to obtain a gyroscope output signal without phase delay
Figure BDA0002234278140000041
Using t k Gyro output signal without phase delay at any moment
Figure BDA0002234278140000042
And t k+1 Gyro output signal without phase delay at any moment
Figure BDA0002234278140000043
Calculating the rotation angular velocity alpha of the motion of the rotating coordinate system s relative to the carrier coordinate system b by using vector cross multiplication k+1
Using alpha obtained as above k+1 Calculating to obtain t k+1 Conversion matrix from time carrier coordinate system to rotating coordinate system
Figure BDA0002234278140000044
Using t k Gyro output signal without phase delay at moment
Figure BDA0002234278140000045
And t k+1 Angular velocity alpha of rotation of the movement of the time-of-day rotating coordinate system relative to the carrier coordinate system k+1 Calculating to obtain t k+1 Rotating the coordinate system by time t k Transformation matrix of time carrier coordinate system
Figure BDA0002234278140000046
Using the transformation matrix obtained above
Figure BDA0002234278140000047
And
Figure BDA0002234278140000048
calculating to obtain t k+1 Time carrier coordinate system to t k Transformation matrix of time carrier coordinate system
Figure BDA0002234278140000049
And the attitude updating without error suitable for the filtering signal of the fiber-optic gyroscope is completed by combining the result of the previous resolving period. The invention solves the problem of error-free attitude updating of the fiber-optic gyroscope filtering signal.
The method for updating the attitude of the filtering signal of the fiber-optic gyroscope without error comprises the following steps:
step 1. Given initial navigation parameters (time t = 0): obtaining an initial pitch attitude angle theta by initial alignment of the fiber-optic gyroscope strapdown inertial navigation system 0 Initial roll attitude angle gamma 0 Initial azimuth psi 0
Step 2, the system sets a sampling period h, an attitude calculation period T, T = h, and an attitude calculation period cycle mark k, namely T k To t k+1 The time period represents one speed resolving period T. Acquiring output signals omega of the fiber optic gyroscope subjected to average filtering processing on three axes in real time k ,k=0,1,2…;
Step 3. PhaseCompensating digital filter H F (Z) carrying out phase compensation on the output signal of the fiber-optic gyroscope after average filtering processing to obtain the gyroscope output signal without phase delay
Figure BDA0002234278140000051
The specific expression of the phase compensation digital filter is as follows:
Figure BDA0002234278140000052
where M is the order of the phase compensated digital filter, λ 12 ,...,λ M Are weight coefficients, i.e. the undetermined coefficients of the digital filter. Weight coefficient lambda 12 ,...,λ M The expression is as follows:
Figure BDA0002234278140000053
wherein Q is 2 Is λ 234 ,…,λ M A column vector of M-1 dimension, Z is a square matrix of (M-1) × (M-1), E is a column vector of M-1 dimension:
Z(r,s)={S(Ω)[1-cos(rΩT)]+C(Ω)sin(rΩT)}·{S(Ω)[1-cos(sΩT)]+C(Ω)sin(sΩT)}
E(r)=S(Ω){S(Ω)[1-cos(rΩT)]+C(Ω)sin(rΩT)}
wherein r is the row number r =0,1,2, \8230;, M-1 of the square matrix Z and the column vector E; s is the number of columns of the square matrix s =0,1,2, \ 8230;, M-1; omega is a vibration main frequency point set by a user according to the working environment of the fiber-optic gyroscope, and S (omega) = sin [ gamma ], (gamma) F (Ω)],C(Ω)=cos[γ F (Ω)],γ F (Ω) is the phase delay of the phase compensated digital filter at the main frequency point Ω.
Step 4. Recursion measuring t k+1 Angular velocity alpha of rotation of the movement of the time rotation coordinate system s relative to the carrier coordinate system b k+1 . I.e. using t k Gyro output signal without phase delay at any moment
Figure BDA0002234278140000054
And t k+1 Time of day without phase delayOutput signal of gyro
Figure BDA0002234278140000055
Obtaining the rotation angular velocity alpha of the movement of the rotating coordinate system s relative to the carrier coordinate system b k+1 Is composed of
Figure BDA0002234278140000056
Wherein omega is a vibration dominant frequency point, | H, set by a user according to the working environment of the fiber-optic gyroscope F (omega) is the amplitude-frequency gain of the phase compensation digital filter at the main frequency point omega; sin for medical use -1 (. -) represents the arcsine value of.i | represents the module value of.x represents the vector cross product.
Step 5. Recursion measuring t k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure BDA0002234278140000057
Using t obtained in step 4 k+1 Angular velocity alpha of rotation of the movement of the time-of-day rotating coordinate system s relative to the carrier coordinate system b k+1 Calculating to obtain t k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure BDA0002234278140000058
Figure BDA0002234278140000061
Wherein
Figure BDA0002234278140000062
Each represents alpha k+1 The x, y, z axis components of (a).
Step 6. Recursion measuring t k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000063
Using t k Time of day without phaseDelayed gyro output signal
Figure BDA0002234278140000064
And t obtained in step 4 k+1 Angular velocity alpha of rotation of the movement of the time-of-day rotating coordinate system s relative to the carrier coordinate system b k+1 Calculating to obtain t k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000065
Figure BDA0002234278140000066
Step 7. Recursion measuring t k+1 Time carrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000067
Using t obtained in step 5 k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure BDA0002234278140000068
And t obtained in step 6 k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure BDA0002234278140000069
Calculating to obtain t k+1 Time carrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure BDA00022342781400000610
Figure BDA00022342781400000611
Wherein
Figure BDA00022342781400000612
Wherein
Figure BDA0002234278140000071
Figure BDA0002234278140000072
Figure BDA0002234278140000073
Figure BDA0002234278140000074
Figure BDA0002234278140000075
Figure BDA0002234278140000076
Figure BDA0002234278140000077
Figure BDA0002234278140000078
Figure BDA0002234278140000079
Wherein
Figure BDA00022342781400000710
Representing a transformation matrix
Figure BDA00022342781400000711
The first row and column elements, and so on.
Using t k+1 Time carrier coordinate system to t k Transformation matrix of time carrier coordinate system
Figure BDA00022342781400000712
And the attitude updating without error suitable for the filtering signal of the fiber-optic gyroscope is completed by combining the result of the last resolving period.
The invention realizes the attitude update without error under the condition of sensor signal distortion. In order to verify the beneficial effect of the method, the method is used for simulating in a typical conical environment, so that the algorithm error is mainly reflected on an x axis and the error is dispersed along with time. Taking the half cone angle a of the conical motion to be =5 degrees, the angular frequency omega =20 pi rad/s, the sampling period of the gyroscope is 0.005s, and the simulation time is 60s. Compared with the traditional quaternion four-order Runge Kutta method and the equivalent rotation vector method of angular rate fitting, the result is shown in FIG. 2: group A is the simulation result of the traditional quaternion four-order Runge Kutta method, group B is the simulation result of the equivalent rotation vector method of angular rate fitting, and group C is the simulation result of the invention.

Claims (5)

1. An error-free attitude updating method suitable for a fiber optic gyroscope filtering signal is characterized by comprising the following steps: the method comprises the following steps:
step 1: given the initial navigation parameters, i.e. the parameters at time t = 0: obtaining an initial pitch attitude angle theta by initial alignment of a fiber optic gyroscope strapdown inertial navigation system 0 Initial roll attitude angle gamma 0 Initial azimuth psi 0
Step 2: the system sets a sampling period h, an attitude calculation period T, T = h, and an attitude calculation period cyclic mark k, namely T k To t k+1 The time period represents a speed resolving period T, and the output signals omega of the fiber-optic gyroscope on three axes after average filtering processing are collected in real time k ,k=0,1,2…;
And 3, step 3: phase positionCompensating digital filter H F (Z) carrying out phase compensation on the output signal of the fiber optic gyroscope after average filtering processing to obtain a gyroscope output signal without phase delay
Figure FDA0003835040340000011
And 4, step 4: recursive measurement t k+1 Angular velocity alpha of rotation of the movement of the time rotation coordinate system s relative to the carrier coordinate system b k+1
And 5: recursive measurement t k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure FDA0003835040340000012
Step 6. Recursion measuring t k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure FDA0003835040340000013
Step 7. Recursion measuring t k+1 Time carrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure FDA0003835040340000014
Using t k+1 Time carrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure FDA0003835040340000015
And the result of the last resolving period is combined to complete the error-free attitude update suitable for the filtering signal of the fiber-optic gyroscope;
the specific expression of the phase compensation digital filter in the step 3 is as follows:
Figure FDA0003835040340000016
where M is the order of the phase compensated digital filter, λ 12 ,...,λ M Is a weightCoefficients, i.e. undetermined coefficients of digital filters, weighting coefficients lambda 12 ,...,λ M The expression is as follows:
Figure FDA0003835040340000017
wherein Q is 2 Is λ 234 ,…,λ M A column vector of M-1 dimension, Z is a square matrix of (M-1) × (M-1), E is a column vector of M-1 dimension:
Z(r,s)={S(Ω)[1-cos(rΩT)]+C(Ω)sin(rΩT)}·{S(Ω)[1-cos(sΩT)]+C(Ω)sin(sΩT)}
E(r)=S(Ω){S(Ω)[1-cos(rΩT)]+C(Ω)sin(rΩT)}
wherein r is the row number r =0,1,2, \8230;, M-1 of the square matrix Z and the column vector E; s is the number of columns of the square matrix s =0,1,2, \ 8230;, M-1; omega is a vibration main frequency point set by a user according to the working environment of the fiber-optic gyroscope, and S (omega) = sin [ gamma ] F (Ω)],C(Ω)=cos[γ F (Ω)],γ F (Ω) is the phase delay of the phase compensated digital filter at the main frequency point Ω.
2. The method for updating the attitude of the fiber-optic gyroscope according to claim 1, wherein the method comprises the following steps: the process in the step 4 specifically comprises the following steps: using t k Gyro output signal without phase delay at any moment
Figure FDA0003835040340000021
And t k+1 Gyro output signal without phase delay at moment
Figure FDA0003835040340000022
Obtaining the rotation angular velocity alpha of the motion of the rotating coordinate system s relative to the carrier coordinate system b k+1 Is composed of
Figure FDA0003835040340000023
Wherein omega is a vibration dominant frequency point, | H, set by a user according to the working environment of the fiber-optic gyroscope F (omega) is the amplitude-frequency gain of the phase compensation digital filter at the main frequency point omega; sin for medical use -1 (. -) represents the arcsine value of.i | represents the module value of.x represents the vector cross product.
3. The method for updating the attitude of the fiber-optic gyroscope filtering signal without error according to claim 1, characterized in that: step 5 said transformation matrix
Figure FDA0003835040340000024
The solving process of (2) is specifically as follows: using t from step 4 k+1 Angular velocity alpha of rotation of the movement of the time-of-day rotating coordinate system s relative to the carrier coordinate system b k+1 Calculating to obtain t k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure FDA0003835040340000025
Figure FDA0003835040340000026
Wherein
Figure FDA0003835040340000027
Each represents alpha k+1 The x, y, z axis components of (a).
4. The method for updating the attitude of the fiber-optic gyroscope according to claim 1, wherein the method comprises the following steps: step 6 the transformation matrix
Figure FDA0003835040340000028
The solving process is as follows: using t k Gyro output signal without phase delay at moment
Figure FDA0003835040340000029
And t obtained in step 4 k+1 Angular velocity alpha of rotation of the movement of the time rotation coordinate system s relative to the carrier coordinate system b k+1 Calculating to obtain t k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure FDA00038350403400000210
Figure FDA0003835040340000031
Wherein, | H F (omega) | is the amplitude-frequency gain of the phase compensation digital filter at the main frequency point omega;
Figure FDA0003835040340000032
each represents alpha k+1 The x, y, z axis components of (a).
5. The method for updating the attitude of the fiber-optic gyroscope filtering signal without error according to claim 1, characterized in that: step 7 said transformation matrix
Figure FDA0003835040340000033
The solving process is as follows: using t obtained in step 5 k+1 Transformation matrix from time carrier coordinate system b to rotating coordinate system s
Figure FDA0003835040340000034
And t obtained in step 6 k+1 Time of day rotating coordinate system s to t k Transformation matrix of time carrier coordinate system b
Figure FDA0003835040340000035
Calculating to obtain t k+1 Time carrier coordinate system b to t k Transformation matrix of time carrier coordinate system b
Figure FDA0003835040340000036
Figure FDA0003835040340000037
CN201910978003.5A 2019-10-15 2019-10-15 Error-free attitude updating method suitable for fiber optic gyroscope filtering signal Active CN110763231B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910978003.5A CN110763231B (en) 2019-10-15 2019-10-15 Error-free attitude updating method suitable for fiber optic gyroscope filtering signal

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910978003.5A CN110763231B (en) 2019-10-15 2019-10-15 Error-free attitude updating method suitable for fiber optic gyroscope filtering signal

Publications (2)

Publication Number Publication Date
CN110763231A CN110763231A (en) 2020-02-07
CN110763231B true CN110763231B (en) 2022-11-18

Family

ID=69331257

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910978003.5A Active CN110763231B (en) 2019-10-15 2019-10-15 Error-free attitude updating method suitable for fiber optic gyroscope filtering signal

Country Status (1)

Country Link
CN (1) CN110763231B (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4754280A (en) * 1982-09-10 1988-06-28 The Charles Stark Draper Laboratory, Inc. Attitude sensing system
CN102494686A (en) * 2011-10-17 2012-06-13 北京国科环宇空间技术有限公司 Satellite attitude orbit determining system and method
CN105890593A (en) * 2016-04-06 2016-08-24 浙江大学 MEMS inertial navigation system and track reconstruction method based on same

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6456939B1 (en) * 2000-01-04 2002-09-24 Mccall Hiram Micro inertial measurement unit
CN100547352C (en) * 2007-12-03 2009-10-07 哈尔滨工程大学 The ground speed testing methods that is suitable for fiber optic gyro strapdown inertial navigation system
CN101696883A (en) * 2009-10-29 2010-04-21 哈尔滨工程大学 Damping method of fiber option gyroscope (FOG) strap-down inertial navigation system
CN102183264B (en) * 2011-01-14 2013-04-10 北京理工大学 Testing system and method for high-efficiency integrated optical fiber gyroscope
CN102829781B (en) * 2012-08-29 2014-12-10 东南大学 Implementation method of rotation type strapdown optical-fiber compass
CN103712623B (en) * 2014-01-20 2016-09-07 东南大学 Optical-fiber gyroscope inertial navigation system attitude optimization method based on angular speed input
CN103900565B (en) * 2014-03-04 2016-11-23 哈尔滨工程大学 A kind of inertial navigation system attitude acquisition method based on differential GPS
US10393882B2 (en) * 2016-03-18 2019-08-27 Deere & Company Estimation of inter-frequency bias for ambiguity resolution in global navigation satellite system receivers
CN110319833B (en) * 2019-07-09 2022-07-15 哈尔滨工程大学 Error-free speed updating method for fiber optic gyroscope strapdown inertial navigation system

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4754280A (en) * 1982-09-10 1988-06-28 The Charles Stark Draper Laboratory, Inc. Attitude sensing system
CN102494686A (en) * 2011-10-17 2012-06-13 北京国科环宇空间技术有限公司 Satellite attitude orbit determining system and method
CN105890593A (en) * 2016-04-06 2016-08-24 浙江大学 MEMS inertial navigation system and track reconstruction method based on same

Also Published As

Publication number Publication date
CN110763231A (en) 2020-02-07

Similar Documents

Publication Publication Date Title
CN111426318B (en) Low-cost AHRS course angle compensation method based on quaternion-extended Kalman filtering
CN104898681B (en) A kind of quadrotor attitude acquisition method for approximately finishing card quaternary number using three ranks
CN106482734A (en) A kind of filtering method for IMU Fusion
CN104698485B (en) Integrated navigation system and air navigation aid based on BD, GPS and MEMS
CN113405563B (en) Inertial measurement unit alignment method
CN109931957A (en) SINS self-alignment method for strapdown inertial navigation system based on LGMKF
CN109682377A (en) A kind of Attitude estimation method based on the decline of dynamic step length gradient
CN108458709B (en) Airborne distributed POS data fusion method and device based on vision-aided measurement
CN1664506A (en) Carrier attitude measurement method and system
CN114216456B (en) Attitude measurement method based on fusion of IMU and robot body parameters
CN109724602A (en) A kind of attitude algorithm system and its calculation method based on hardware FPU
WO2020140378A1 (en) Method for post-compensation of motion error of rotating accelerometer gravity gradiometer
CN108489485B (en) Error-free strapdown inertial navigation value updating method
CN111121820B (en) MEMS inertial sensor array fusion method based on Kalman filtering
CN112683274A (en) Unmanned aerial vehicle integrated navigation method and system based on unscented Kalman filtering
CN110319833B (en) Error-free speed updating method for fiber optic gyroscope strapdown inertial navigation system
CN115855046A (en) Six-position temperature compensation calibration method for accelerometer of strapdown inertial navigation system
CN110763231B (en) Error-free attitude updating method suitable for fiber optic gyroscope filtering signal
CN108416387B (en) Height filtering method based on fusion data of GPS and barometer
CN112729332B (en) Alignment method based on rotation modulation
CN109029499A (en) A kind of accelerometer bias iteration optimizing estimation method based on gravity apparent motion model
CN107741228A (en) A kind of SINS Attitude calculation method based on center of gravity Lagrange's interpolation
CN112833918B (en) High-rotation body micro inertial navigation aerial alignment method and device based on function iteration
CN111220182A (en) Rocket transfer alignment method and system
CN110737194A (en) multi-MEMS sensor combined attitude measurement method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20230629

Address after: 210042 Xuanwu Road, Xuanwu District, Nanjing, Jiangsu 699-1

Patentee after: NANJING XINDONGTAI INFORMATION TECHNOLOGY CO.,LTD.

Address before: 150001 Intellectual Property Office, Harbin Engineering University science and technology office, 145 Nantong Avenue, Nangang District, Harbin, Heilongjiang

Patentee before: HARBIN ENGINEERING University

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20230726

Address after: 150000 floor 2, East unit 22, Tianping Road, building 2D, dui'e Park, Yingbin Road concentration area, high tech Industrial Development Zone, Harbin, Heilongjiang Province

Patentee after: HARBIN HATRAN NAVIGATION TECHNOLOGY Co.,Ltd.

Address before: 210042 Xuanwu Road, Xuanwu District, Nanjing, Jiangsu 699-1

Patentee before: NANJING XINDONGTAI INFORMATION TECHNOLOGY CO.,LTD.

TR01 Transfer of patent right