CN103278178A - Flexural deformation measurement method capable of considering transmission delay in transfer alignment - Google Patents
Flexural deformation measurement method capable of considering transmission delay in transfer alignment Download PDFInfo
- Publication number
- CN103278178A CN103278178A CN2013101566464A CN201310156646A CN103278178A CN 103278178 A CN103278178 A CN 103278178A CN 2013101566464 A CN2013101566464 A CN 2013101566464A CN 201310156646 A CN201310156646 A CN 201310156646A CN 103278178 A CN103278178 A CN 103278178A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- navigation system
- omega
- sub
- main
- 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 provides a flexural deformation measurement method capable of considering transmission delay in transfer alignment. The method comprises the steps: firstly, installing a main inertial navigation system and a sub inertial navigation system on a ship; then building a model of a state updating transmitted to the sub inertial navigation system by the main inertial navigation system; next by using a direction cosine method, calculating out an error caused by the transmission delay and compensating the error; and finally, estimating an installation error angle and a flexural deformation angle between the main and the sub inertial navigation system by a Kalman filter. The flexural deformation measurement method can effectively suppress effects caused by the transmission delay, and thereby improving the measurement precision.
Description
(1) technical field
What the present invention relates to is a kind of measuring method of deflection deformation, specifically a kind of deflection deformation measuring method of considering transmission delay in Transfer Alignment.
(2) background technology
Transfer Alignment is a kind of moving alignment, it refers to utilize the information of the main inertial navigation of having aimed to aim to need a kind of method of the sub-inertial navigation system of aiming at, its basic thought is exactly to be benchmark with the high main inertial navigation information of precision, by the output information of boss's inertial navigation relatively, adopt suitable filtering algorithm to come to such an extent that the error parameter of antithetical phrase inertial navigation system compensates.Since Transfer Alignment have the aligning time short, alignment precision is high, looser to the requirement of inertia device, overcome in the past the drawback of the alignment so that the adopts requirement that can not arrive simultaneously because of time and precision, become the focus of research at present.The precision of Transfer Alignment is subjected to the influence of many-sided factor, as lever arm effect, deflection deformation, transmission delay etc., therefore these disturbing factors is compensated, and will improve the precision of aligning, has certain practical significance.
When carrying out the measurement at deflection deformation angle, owing to main inertial navigation system is installed on the different positions with sub-inertial navigation system, so main inertial navigation will relate to the problem of transmission delay when relevant navigation information is transmitted in sub-inertial navigation.Discover that transmission delay is bigger to the influence of attitude, thus need upgrade attitude matrix, make main, when information matches is carried out in sub-inertial navigation on synchronization.To be considered as the random value of certain limit time delay in the document " in the Transfer Alignment measure postpone compensation method ", set up the Transfer Alignment model that comprises state time delay, and with the Transfer Alignment wave filter to estimating time delay and compensating.It is considered herein that be normal value time delay, by the renewal to attitude matrix, obtained the error term that caused by transmission delay, adopt direction cosine method that error term is compensated, and then with Kalman filtering alignment error angle and deflection deformation angle are estimated.
(3) summary of the invention
The object of the present invention is to provide a kind of deflection deformation measuring method of in Transfer Alignment, considering transmission delay.
The object of the present invention is achieved like this:
(1) two cover strapdown inertial navitation system (SINS) are installed aboard ship, what wherein precision was higher is main inertial navigation system, and what precision was lower is sub-inertial navigation system;
(2) start main inertial navigation system, make it be operated in navigational state;
(3) promoter inertial navigation system, the output data of gathering its gyro and accelerometer;
(4) information (mainly being speed and attitude information) with main inertial navigation system passes to sub-inertial navigation system, finishes initial alignment;
(5) set up the model of main inertial navigation system posture renewal;
(6) according to the information of main inertial navigation system, adopt direction cosine method to calculate the error in the posture renewal model and it is compensated;
(7) set up state equation and the observation equation of system;
(8) go out alignment error angle and deflection deformation angle between main, the sub-inertial navigation system with Kalman Filter Estimation.
The described model of setting up main inertial navigation system posture renewal is:
φ wherein
m* be the antisymmetric matrix of the misalignment between master, the sub-inertial navigation system, I is the unit matrixs of 3 * 3 dimensions,
Be t the going to of attitude matrix of sub-inertial navigation system constantly,
Be the attitude matrix of t main inertial navigation system of the moment,
Be the t first order derivative of the attitude matrix of main inertial navigation system constantly, the time of Δ t for postponing, its value is a constant.
Described employing direction cosine method calculate in the posture renewal model error and to its compensate into:
The differential equation according to direction cosine matrix can get:
Wherein:
It is angular velocity projection on the carrier coordinate system of main inertial navigation of the relative navigation coordinate of the carrier coordinate system system of main inertial navigation.
Because
With
Initial value all be as can be known, so can obtain by the differential equation of direction cosine matrix
So just can be to the error term that is caused by transmission delay
Compensate.
Describedly set up the state equation of system and the step of observation equation is:
State equation and the observation equation of system are respectively:
Z(t)=H(t)X(t)+V(t)
In the formula:
State vector X (t) is chosen for:
δ v
E, δ v
NBe respectively east orientation velocity error and north orientation velocity error, φ
Mx, φ
My, φ
MzBe respectively the component of misalignment on three axles between master, the sub-inertial navigation system, φ
Ax, φ
Ay, φ
AzBe respectively the component of alignment error angle on three axles between master, the sub-inertial navigation system, θ
x, θ
y, θ
zBe respectively the component of distortion angle on three axles.
The system noise acoustic matrix is:
a
x, a
yBe respectively east orientation accelerometer error and north orientation accelerometer error, ε
x, ε
y, ε
zBe respectively the component of gyroscopic drift on three.
In the formula:
v
EBe east orientation speed, ω
IeBe the spin velocity of the earth,
Be the attitude matrix of sub-inertial navigation system,
Be the gyro output of three of sub-inertial navigations, R
eBe earth fourth of the twelve Earthly Branches radius-of-curvature at the tenth of the twelve Earthly Branches,
Be the latitude of locality, A
4And A
5In coefficient all are the correlations at deflection deformation angle,
Be angular velocity the projection on sub-inertial navigation system carrier coordinate system of sub-inertial navigation system carrier coordinate system with respect to navigation coordinate system.
In the formula:
The systematic perspective measurement is elected as:
Wherein: observing matrix is H=[I
5 * 50
5 * 9]
T, V (t) is the measurement noise battle array of system.
Beneficial effect of the present invention is verified by the following method:
(1) Matlab l-G simulation test
The l-G simulation test condition:
The motion model of carrier is: the pitch angle of establishing carrier is ψ, and roll angle is θ, and course angle is γ, then:
ψ wherein
m=5 °, θ
m=5 °, λ
m=5 °, ω
ψ=2 π/6 (rad/s), ω
θ=2 π/8 (rad/s), ω
γ=2 π/10 (tad/s), initial phase angle: ψ
0=0 °, θ
0=0 °, γ
0=0 °.Initial latitude
Initial longitude λ=126.6705 °; Alignment error angle φ
Ax=1 °, φ
Ay=1 °, φ
Az=1 °; Gyroscope constant value drift is 0.01 °/h; Accelerometer bias is 10
-4g
0, the propagation delay time is 10 seconds.
The evaluated error curve at alignment error angle before and after Simulation results: Fig. 2, Fig. 3 are respectively and compensate, Fig. 4, Fig. 5 are respectively the curve at the distortion angle of the estimation of compensation front and back and reality.
(4) description of drawings
Fig. 1 is process flow diagram of the present invention;
Fig. 2 is the evaluated error curve map that does not compensate the alignment error angle of transmission delay;
Fig. 3 is the evaluated error curve map at the alignment error angle of compensation transmission delay;
Estimation and the actual distortion angular curve figure of Fig. 4 for not compensating transmission delay;
Fig. 5 is estimation and the actual distortion angular curve figure of compensation transmission delay.
(5) embodiment
Below the present invention is done concrete description:
(1) two cover strapdown inertial navitation system (SINS) are installed aboard ship, what wherein precision was higher is main inertial navigation system, and what precision was lower is sub-inertial navigation system;
(2) start main inertial navigation system, make it be operated in navigational state;
(3) promoter inertial navigation system, the output data of gathering its gyro and accelerometer;
(4) information (mainly being speed and attitude information) with main inertial navigation system passes to sub-inertial navigation system, finishes initial alignment;
(5) set up the model of main inertial navigation system posture renewal;
The model of main inertial navigation system posture renewal is:
φ wherein
m* be the antisymmetric matrix of the misalignment between master, the sub-inertial navigation system, I is the unit matrixs of 3 * 3 dimensions,
Be t the going to of attitude matrix of sub-inertial navigation system constantly,
Be the attitude matrix of t main inertial navigation system of the moment,
Be the t first order derivative of the attitude matrix of main inertial navigation system constantly, the time of Δ t for postponing, its value is a constant.
(6) according to the information of main inertial navigation system, adopt direction cosine method to calculate the error in the posture renewal model and it is compensated;
The differential equation according to direction cosine matrix can get:
Wherein:
It is angular velocity projection on the carrier coordinate system of main inertial navigation of the relative navigation coordinate of the carrier coordinate system system of main inertial navigation.
Because
With
Initial value all be as can be known, so can obtain by the differential equation of direction cosine matrix
So just can be to the error term that is caused by transmission delay
Compensate
(7) set up state equation and the observation equation of system;
State equation and the observation equation of system are respectively:
Z(t)=H(t)X(t)+V(t)
In the formula:
State vector X (t) is chosen for:
δ v
E, δ v
NBe respectively east orientation velocity error and north orientation velocity error, φ
Mx, φ
My, φ
MzBe respectively the component of misalignment on three axles between master, the sub-inertial navigation system, φ
Ax, φ
Ay, φ
AzBe respectively the component of alignment error angle on three axles between master, the sub-inertial navigation system, θ
x, θ
y, θ
zBe respectively the component of distortion angle on three axles.
The system noise acoustic matrix is:
a
x, a
yBe respectively east orientation accelerometer error and north orientation accelerometer error, ε
x, ε
y, ε
zBe respectively the component of gyroscopic drift on three.
In the formula:
v
EBe east orientation speed, ω
IeBe the spin velocity of the earth,
Be the attitude matrix of sub-inertial navigation system,
Be the gyro output of three of sub-inertial navigations, R
eBe earth fourth of the twelve Earthly Branches radius-of-curvature at the tenth of the twelve Earthly Branches,
Be the latitude of locality, A
4And A
5In coefficient all are the correlations at deflection deformation angle,
Be angular velocity the projection on sub-inertial navigation system carrier coordinate system of sub-inertial navigation system carrier coordinate system with respect to navigation coordinate system.
In the formula:
The systematic perspective measurement is elected as:
Wherein: observing matrix is H=[I
5 * 50
5 * 9]
T, V (t) is the measurement noise battle array of system.
(8) go out alignment error angle and deflection deformation angle between main, the sub-inertial navigation system with Kalman Filter Estimation.
Claims (1)
1. in Transfer Alignment, consider the deflection deformation measuring method of transmission delay, it is characterized in that:
(1) two cover strapdown inertial navitation system (SINS) are installed aboard ship, what wherein precision was higher is main inertial navigation system, and what precision was lower is sub-inertial navigation system;
(2) start main inertial navigation system, make it be operated in navigational state;
(3) promoter inertial navigation system, the output data of gathering its gyro and accelerometer;
(4) information (mainly being speed and attitude information) with main inertial navigation system passes to sub-inertial navigation system, finishes initial alignment;
(5) set up the model of main inertial navigation system posture renewal;
The model of main inertial navigation system posture renewal is:
φ wherein
m* be the antisymmetric matrix of the misalignment between master, the sub-inertial navigation system, I is the unit matrixs of 3 * 3 dimensions,
Be t the going to of attitude matrix of sub-inertial navigation system constantly,
Be the attitude matrix of t main inertial navigation system of the moment,
Be the t first order derivative of the attitude matrix of main inertial navigation system constantly, the time of Δ t for postponing, its value is a constant.
(6) according to the information of main inertial navigation system, adopt direction cosine method to calculate the error in the posture renewal model and it is compensated;
The differential equation according to direction cosine matrix can get:
Wherein:
It is angular velocity projection on the carrier coordinate system of main inertial navigation of the relative navigation coordinate of the carrier coordinate system system of main inertial navigation.
Because
With
Initial value all be as can be known, so can obtain by the differential equation of direction cosine matrix
So just can be to the error term that is caused by transmission delay
Compensate
(7) set up state equation and the observation equation of system;
State equation and the observation equation of system are respectively:
Z(t)=H(t)X(t)+V(t)
In the formula:
State vector X (t) is chosen for:
δ v
E, δ v
NBe respectively east orientation velocity error and north orientation velocity error, φ
Mx, φ
My, φ
MzBe respectively the component of misalignment on three axles between master, the sub-inertial navigation system, φ
Ax, φ
Ay, φ
AzBe respectively the component of alignment error angle on three axles between master, the sub-inertial navigation system, θ
x, θ
y, θ
zBe respectively the component of distortion angle on three axles.
The system noise acoustic matrix is:
a
x, a
yBe respectively east orientation accelerometer error and north orientation accelerometer error, ε
x, ε
y, ε
zBe respectively the component of gyroscopic drift on three, T represents vector or transpose of a matrix.In the formula:
v
EBe east orientation speed, ω
IeBe the spin velocity of the earth,
Be the attitude matrix of sub-inertial navigation system,
Be the gyro output of three of sub-inertial navigations, R
eBe earth fourth of the twelve Earthly Branches radius-of-curvature at the tenth of the twelve Earthly Branches,
Be the latitude of locality, A
4And A
5In coefficient all are the correlations at deflection deformation angle,
For sub-inertial navigation system carrier coordinate system with respect to the f among the projection A2 of angular velocity on sub-inertial navigation system carrier coordinate system of navigation coordinate system
x, f
y, f
zAccelerometer output for three of sub-inertial navigations; A3 is
Antisymmetric matrix; Parameter among A4 and the A5 is the constant coefficient in the second order Markovian process.
In the formula:
The systematic perspective measurement is elected as:
Wherein: observing matrix is H=[I
5 * 50
5 * 9]
T, V (t) is the measurement noise battle array of system.
(8) go out alignment error angle and deflection deformation angle between main, the sub-inertial navigation system with Kalman Filter Estimation.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013101566464A CN103278178A (en) | 2013-04-26 | 2013-04-26 | Flexural deformation measurement method capable of considering transmission delay in transfer alignment |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013101566464A CN103278178A (en) | 2013-04-26 | 2013-04-26 | Flexural deformation measurement method capable of considering transmission delay in transfer alignment |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103278178A true CN103278178A (en) | 2013-09-04 |
Family
ID=49060766
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2013101566464A Pending CN103278178A (en) | 2013-04-26 | 2013-04-26 | Flexural deformation measurement method capable of considering transmission delay in transfer alignment |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103278178A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104567930A (en) * | 2014-12-30 | 2015-04-29 | 南京理工大学 | Transfer alignment method capable of estimating and compensating wing deflection deformation |
CN105157724A (en) * | 2015-07-30 | 2015-12-16 | 北京航空航天大学 | Transfer alignment time delay estimation and compensation method based on velocity plus attitude matching |
CN107764268A (en) * | 2017-10-13 | 2018-03-06 | 北京航空航天大学 | A kind of method and apparatus of airborne distributed POS Transfer Alignments |
CN111289013A (en) * | 2020-04-03 | 2020-06-16 | 北京航空航天大学 | Wing deflection angular velocity estimation method for separating and combining multi-source disturbance influence |
CN113405572A (en) * | 2020-03-16 | 2021-09-17 | 半导体元件工业有限责任公司 | Propagation delay compensation circuit and method for calculating propagation delay compensation |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6094163A (en) * | 1998-01-21 | 2000-07-25 | Min-I James Chang | Ins alignment method using a doppler sensor and a GPS/HVINS |
CN102175095A (en) * | 2011-03-02 | 2011-09-07 | 浙江大学 | Strap-down inertial navigation transfer alignment algorithm parallel implementation method |
CN102607330A (en) * | 2012-03-23 | 2012-07-25 | 东南大学 | Optimization method of baseline information in transfer alignment of inertial navigation system |
-
2013
- 2013-04-26 CN CN2013101566464A patent/CN103278178A/en active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6094163A (en) * | 1998-01-21 | 2000-07-25 | Min-I James Chang | Ins alignment method using a doppler sensor and a GPS/HVINS |
CN102175095A (en) * | 2011-03-02 | 2011-09-07 | 浙江大学 | Strap-down inertial navigation transfer alignment algorithm parallel implementation method |
CN102607330A (en) * | 2012-03-23 | 2012-07-25 | 东南大学 | Optimization method of baseline information in transfer alignment of inertial navigation system |
Non-Patent Citations (2)
Title |
---|
刘彬: "光纤捷联惯导***传递对准技术研究", 《中国优秀硕士学位论文全文数据库信息科技辑》, 15 March 2013 (2013-03-15) * |
徐林等: "三种传递对准延时误差补偿方法的比较研究", 《兵工自动化》, 28 February 2011 (2011-02-28) * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104567930A (en) * | 2014-12-30 | 2015-04-29 | 南京理工大学 | Transfer alignment method capable of estimating and compensating wing deflection deformation |
CN105157724A (en) * | 2015-07-30 | 2015-12-16 | 北京航空航天大学 | Transfer alignment time delay estimation and compensation method based on velocity plus attitude matching |
CN105157724B (en) * | 2015-07-30 | 2017-12-26 | 北京航空航天大学 | A kind of Transfer Alignment time delay estimadon and compensation method for adding attitude matching based on speed |
CN107764268A (en) * | 2017-10-13 | 2018-03-06 | 北京航空航天大学 | A kind of method and apparatus of airborne distributed POS Transfer Alignments |
CN107764268B (en) * | 2017-10-13 | 2020-03-24 | 北京航空航天大学 | Method and device for transfer alignment of airborne distributed POS (point of sale) |
CN113405572A (en) * | 2020-03-16 | 2021-09-17 | 半导体元件工业有限责任公司 | Propagation delay compensation circuit and method for calculating propagation delay compensation |
CN111289013A (en) * | 2020-04-03 | 2020-06-16 | 北京航空航天大学 | Wing deflection angular velocity estimation method for separating and combining multi-source disturbance influence |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101893445B (en) | Rapid initial alignment method for low-accuracy strapdown inertial navigation system under swinging condition | |
CN103256942A (en) | Deformation angle measuring method in transfer alignment by considering lever arm compensation | |
CN101963513B (en) | Alignment method for eliminating lever arm effect error of strapdown inertial navigation system (SINS) of underwater carrier | |
CN102486377B (en) | Method for acquiring initial course attitude of fiber optic gyro strapdown inertial navigation system | |
CN103913181B (en) | A kind of airborne distributed POS Transfer Alignments based on parameter identification | |
CN102830414B (en) | Combined navigation method based on SINS/GPS (strapdown inertial navigation system/global position system) | |
CN102621565B (en) | Transfer aligning method of airborne distributed POS (Position and Orientation System) | |
CN103471616B (en) | Initial Alignment Method under a kind of moving base SINS Large azimuth angle condition | |
US20100121601A1 (en) | Method and system for estimation of inertial sensor errors in remote inertial measurement unit | |
CN103344260B (en) | Based on the strapdown inertial navitation system (SINS) Initial Alignment of Large Azimuth Misalignment On method of RBCKF | |
CN103542816B (en) | Deformation of hull measuring method based on time delay equalization | |
CN103245360A (en) | Autocollimation method of carrier aircraft rotating type strapdown inertial navigation system under shaking base | |
CN103076025B (en) | A kind of optical fibre gyro constant error scaling method based on two solver | |
CN103822633A (en) | Low-cost attitude estimation method based on second-order measurement update | |
CN103076026B (en) | A kind of method determining Doppler log range rate error in SINS | |
CN103278178A (en) | Flexural deformation measurement method capable of considering transmission delay in transfer alignment | |
CN104697526A (en) | Strapdown inertial navitation system and control method for agricultural machines | |
CN104567930A (en) | Transfer alignment method capable of estimating and compensating wing deflection deformation | |
CN101915579A (en) | Novel CKF(Crankshaft Fluctuation Sensor)-based SINS (Ship Inertial Navigation System) large misalignment angle initially-aligning method | |
CN103090867A (en) | Error restraining method for fiber-optic gyroscope strapdown inertial navigation system rotating relative to geocentric inertial system | |
CN105783943A (en) | Method for performing transfer alignment on large azimuth misalignment angle of ship in polar region environment based on unscented Kalman filtering | |
CN102519485A (en) | Gyro information-introduced double-position strapdown inertial navigation system initial alignment method | |
CN103217699B (en) | Integrated navigation system recursion optimizing initial-alignment method based on polarization information | |
CN102879011A (en) | Lunar inertial navigation alignment method assisted by star sensor | |
CN103900608A (en) | Low-precision inertial navigation initial alignment method based on quaternion CKF |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for 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: 20130904 |