CN102997915A - POS post-processing method with combination of closed-loop forward filtering and reverse smoothing - Google Patents
POS post-processing method with combination of closed-loop forward filtering and reverse smoothing Download PDFInfo
- Publication number
- CN102997915A CN102997915A CN2011102730467A CN201110273046A CN102997915A CN 102997915 A CN102997915 A CN 102997915A CN 2011102730467 A CN2011102730467 A CN 2011102730467A CN 201110273046 A CN201110273046 A CN 201110273046A CN 102997915 A CN102997915 A CN 102997915A
- Authority
- CN
- China
- Prior art keywords
- error
- unit
- amount
- formula
- inertial navigation
- 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
Landscapes
- Navigation (AREA)
Abstract
The invention belongs to a POS post-processing method, and specifically relates to a POS post-processing method with the combination of closed-loop forward filtering and reverse-smoothing. The invention aims at providing a high-precision position and attitude post-processing method. The method comprises a Kalman filtering step and a reverse R-T-S smoothing step. Horizontal velocity error and height error estimated by forward Kalman filtering is fed back to an input end of an inertial navigation solver in real time through feedback controlling parameters; inertial velocity and position divergences are inhibited, and error model linearity is improved; and reverse R-T-S smoothing is carried out on the basis, such that a POS high-precision position and attitude post-processing result is obtained. The method has the advantages that: POS application requirements are satisfied; and high-precision position and attitude information is provided for a related image processing system (such as radar or a camera) and the like.
Description
Technical field
The present invention relates to the high precision position attitude post-processing approach of a kind of POS of being applicable to (Position and Orientation System).
Background technology
POS has high requirement to the position in the whole task process and attitude accuracy, after particularly working long hours, increase very fast in the inertial navigation error short time, the error model of system is out of true gradually, the filter effect variation that causes system, the forward Kalman filtering of usually adopting can't address this problem with the post-processing approach that reverse R-T-S (Rauch-Tung-Striebel) smoothly combines.
Summary of the invention
The purpose of this invention is to provide a kind of high-precision position and attitude post-processing approach, by adopting the closed loop real-time feedback method, control parameter reasonable in design, the error oscillation amplitude of establishment system, improve the degree of accuracy of error model, thereby improve position and attitude accuracy in the whole task process of POS.
The present invention is achieved in that a kind of closed loop forward filtering in conjunction with reverse level and smooth POS post-processing approach, is the method for the position and attitude data of POS being carried out aftertreatment, comprising: the step of Kalman filtering, and the reverse level and smooth step of R-T-S, wherein,
In the process of Kalman filtering, the process of setting up Kalman filter model is as follows:
Step 1, use second order model are described inertial navigation system;
Design inertial navigation system horizontal channel becomes typical second-order system;
In the formula: K
1, K
2Two real-time feedback control coefficients of horizontal channel;
Design inertial navigation system vertical passage becomes typical second-order system;
In the formula: C
1, C
2Two real-time feedback control coefficients of vertical passage;
The secular equation of typical case's second-order system is
According to POS system afterwards processing procedure ξ, w are determined in the requirement of filtering regulating cycle and overshoot
nThen calculate according to the following procedure feedback control coefficient;
1, determines filtering regulating cycle and overshoot according to the performance requirement of system;
2, according to regulating cycle and overshoot, determine ξ, w
n
3, respectively formula (1), (2) are carried out namely obtaining formula (4), (5) with the coefficient contrast with formula (3), resolve to get feedback control coefficient K according to formula (4), (5)
1, K
2, C
1, C
2
K
1=2ξw
n
C
1=2ξw
n
Step 2, set up the error equation of POS:
In the formula:
v
N, v
U, v
EBe respectively north orientation speed, vertical velocity, the east orientation speed of inertial navigation system, unit: meter per second was the amount in a upper moment;
δ v
N, δ v
U, δ v
EBe respectively north orientation velocity error, vertical velocity error, the east orientation velocity error of inertial navigation system, unit: meter per second was the amount in a upper moment;
Be the latitude of inertial navigation system, unit: radian was the amount in a upper moment;
H is the height of inertial navigation system, unit: rice was the amount in a upper moment;
δ h is the height error of inertial navigation system, unit: rice was the amount in a upper moment;
φ
U, φ
EBe respectively vertical error angle, the east orientation error angle of inertial navigation system, unit: radian was the amount in a upper moment;
f
U, f
EBe respectively vertical acceleration, east orientation acceleration, unit: meter per second
2, be the amount of current time;
Being respectively carrier is partially error, y axis accelerometer zero inclined to one side error, Z axis accelerometer bias error of x axis accelerometer zero, unit: meter per second
2, be the amount of current time;
C
1j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
R
M, R
NBe respectively earth meridian circle, prime vertical radius, unit: rice was the amount in a upper moment;
ω
IeBe the earth rotation angular speed, unit: radian per second is constant;
Be system's fast error in north that Kalman filtering is estimated, unit: meter per second is the amount of current time;
K
1Real-time feedback control coefficient for the horizontal channel is calculated by said process;
In the formula:
f
NBe the north orientation acceleration, unit: meter per second
2, be the amount of current time;
φ
NBe the north orientation error angle of inertial navigation system, unit: radian was the amount in a upper moment;
C
2j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
Be the system height error that Kalman filtering is estimated, unit: rice is the amount of current time;
C
2Real-time feedback control coefficient for vertical passage is calculated by said process;
In the formula:
C
3j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
Be system's fast error in east that Kalman filtering is estimated, unit: meter per second is the amount of current time;
In the formula:
C
1Real-time feedback control coefficient for vertical passage is calculated by said process;
In the formula:
Being respectively the carrier that is processed into first-order Markov process is x axle gyroscopic drift error, y axle gyroscopic drift error, z axle gyroscopic drift error, unit: radian per second;
Step 3, set up Kalman filter model;
Get state variable
Observed quantity
Wherein subscript G represents the information that GPS provides;
λ
GBe respectively latitude, longitude that GPS provides, unit: radian; h
GBe the height that GPS provides, unit: rice;
Be respectively north orientation speed, vertical velocity, east orientation speed that GPS provides, unit: meter per second; λ is the longitude of inertial navigation system, unit: radian;
According to the error equation that provides, determine that the state equation of system is
In the formula:
A (t) 15 * 15 maintains the system parameter matrix, calculates according to formula (6);
L (t) is 15 * 3 dimension control coefrficient matrixes, L (t)=[0
3 * 2L
3 * 70
3 * 6]
T, wherein
W (t) 15 * 1 maintains system excitation noise vector;
Measurement equation is:
Z=HX(t)+V(t)
(8)
In the formula:
H is 6 * 15 dimension measurement matrixes;
V (t) is the measurement noise vector;
Turn to state equation and measurement equation are discrete:
X
k=Φ
k,k-1X
k-1+L
kU
k-1+W
k-1 (9)
Z
k=HX
k+V
k (10)
Φ wherein
K, k-1State transitions battle array for system; T
dBe the filtering cycle of system, unit: second; N is the frequency of resolving of inertial navigation system;
Kalman filter Filtering Model with controlled quentity controlled variable is:
(12a)
(12b)
K
k=P
k,k-1H
T(HP
k,k-1H
T+R
k)
-1
(12c)
(12d)
P
k=(I-K
kH)P
k,k-1(I-K
kH)
T+K
kR
k(K
k)
T
(12e)
In the formula:
P
K, k-1Prediction square error battle array for wave filter;
P
kEstimation square error battle array for wave filter;
Q
kSystem noise variance battle array for wave filter;
K
kGain battle array for wave filter;
R
kMeasuring noise square difference battle array for wave filter.
The present invention uses in POS system work: closed loop real-time feedback control parameter model; Horizontal velocity error and height error that forward Kalman filtering is estimated, the input end that resolves to inertial navigation by the feedback control parameters Real-time Feedback, and then suppress dispersing of velocity inertial and position, improve the linearity of error model, and it is level and smooth on this basis the filtering estimator to be carried out reverse R-T-S, thereby obtains the high precision position attitude aftertreatment result of POS.
Advantage is: introduce closed loop Real-time Feedback (damping is arranged) in filtering, can suppress dispersing of velocity inertial and position, improve the degree of accuracy of error model.After the closed loop Real-Time Filtering, it is level and smooth that the filtering estimator is carried out reverse R-T-S, adopt the level and smooth estimate of error of reverse R-T-S that the inertial navigation result is carried out output calibration, not only can improve in the whole Filtering and smoothing process estimated accuracy to error, and adopt high-precision smoothing error estimator that the inertial navigation result is carried out output calibration, can obtain high-precision position and attitude aftertreatment result, satisfy the application demand of POS, provide high-precision position and attitude information to associated picture disposal system (for example comprising radar, perhaps camera) etc.
Embodiment
The present invention is described further below in conjunction with specific embodiment:
Inertia, the gps measurement data of certain model POS are used said method carry out aftertreatment.
The closed loop Real-time Feedback is divided into level and vertical two passages, and the specific implementation process was divided into for two steps:
1) determines feedback control parameters.
The secular equation of conventional inertial navigation system horizontal channel is
(vibration can occur), wherein R
e=6378137 meters is the earth radius under the WGS84 coordinate system, g
0=9.780318 meter per seconds
2Gravitational constant for the earth.It is designed to typical second-order system
(1)
In the formula: K
1, K
2Two real-time feedback control coefficients of horizontal channel.
The secular equation of inertial navigation system vertical passage is
It is designed to typical second-order system
In the formula: C
1, C
2Two real-time feedback control coefficients of vertical passage.
The secular equation of typical case's second-order system is
(3)
According to POS system afterwards processing procedure ξ, w are determined in the requirement of filtering regulating cycle and overshoot
n
Then, resolve in accordance with the following steps feedback control coefficient:
1, determines filtering regulating cycle and overshoot, with System Dependent, set respectively;
2, according to regulating cycle and overshoot, determine ξ, w
n, (common practise);
3, respectively formula (1), (2) are carried out namely obtaining formula (4), (5) with the coefficient contrast with formula (3), resolve to get feedback control coefficient K according to formula (4), (5)
1, K
2, C
1, C
2
Calculating K
1, K
2
K
1=2ξw
n
C
1=2ξw
n
2) realize close-loop feedback
It is poor that position, the speed that inertia and GPS (Global Positioning System) are provided is done, as observed quantity.
Adopt Kalman filtering to realize inertia/GPS combination, the margin of error of system is estimated.
System's fast error in north with the filtering estimation
The fast error in east
Pass through K
1Feed back to horizontal velocity resolve in, pass through K
2Feed back to the horizontal attitude angle resolve in (detailed process is as described below);
System height error with Kalman filtering estimation
Pass through C
1And C
2Feed back to respectively resolving of inertia vertical velocity, height, realize closed loop Real-time Feedback (detailed process is as described below);
Above-mentioned thinking is specifically by following process implementation:
The closed loop forward filtering is as follows in conjunction with oppositely level and smooth POS post-processing approach implementation procedure:
According to the above-mentioned close-loop feedback scheme that provides, the error equation that can set up POS is as follows:
In the formula:
v
N, v
U, v
EBe respectively north orientation speed, vertical velocity, the east orientation speed of inertial navigation system, unit: meter per second was the amount in a upper moment;
δ v
N, δ v
U, δ v
EBe respectively north orientation velocity error, vertical velocity error, the east orientation velocity error of inertial navigation system, unit: meter per second was the amount in a upper moment;
H is the height of inertial navigation system, unit: rice was the amount in a upper moment;
δ h is the height error of inertial navigation system, unit: rice was the amount in a upper moment;
φ
U, φ
EBe respectively vertical error angle, the east orientation error angle of inertial navigation system, unit: radian was the amount in a upper moment;
f
U, f
EBe respectively vertical acceleration, east orientation acceleration, unit: meter per second
2, be the amount of current time;
Being respectively carrier is partially error, y axis accelerometer zero inclined to one side error, the zero partially error of z axis accelerometer of x axis accelerometer zero, unit: meter per second
2, be the amount of current time;
C
1j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
R
M, R
NBe respectively earth meridian circle, prime vertical radius, unit: rice was the amount in a upper moment;
ω
IeBe the earth rotation angular speed, unit: radian per second is constant;
Be system's fast error in north that Kalman filtering is estimated, unit: meter per second is the amount of current time;
K
1Being the real-time feedback control coefficient of horizontal channel, is constant after determining.Compared with prior art, added K
1Item.
In the formula:
f
NBe the north orientation acceleration, unit: meter per second
2, be the amount of current time;
φ
NBe the north orientation error angle of inertial navigation system, unit: radian was the amount in a upper moment;
C
2j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
Be the system height error that Kalman filtering is estimated, unit: rice is the amount of current time;
C
2Being the real-time feedback control coefficient of vertical passage, is constant after determining.
In the formula:
C
3j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
Be system's fast error in east that Kalman filtering is estimated, unit: meter per second is the amount of current time;
In the formula:
C
1Being the real-time feedback control coefficient of vertical passage, is constant after determining.
(6g)
In the formula:
Being respectively the carrier that is processed into first-order Markov process is x axle gyroscopic drift error, y axle gyroscopic drift error, z axle gyroscopic drift error, unit: radian per second.
According to error equation, set up Kalman filter equation:
Get state variable
Observed quantity
Wherein subscript G represents the information that GPS provides;
λ
GBe respectively latitude, longitude that GPS provides, unit: radian; h
GBe the height that GPS provides, unit: rice;
Be respectively north orientation speed, vertical velocity, east orientation speed that GPS provides, unit: meter per second; λ is the longitude of inertial navigation system, unit: radian.
According to the error equation that provides, determine that the state equation of system is
In the formula:
A (t) 15 * 15 maintains the system parameter matrix, calculates according to formula (6);
L (t) is 15 * 3 dimension control coefrficient matrixes, L (t)=[0
3 * 2L
3 * 70
3 * 6]
T, wherein
W (t) 15 * 1 maintains system excitation noise vector.
Measurement equation is:
Z=HX(t)+V(t) (8)
In the formula:
H is 6 * 15 dimension measurement matrixes;
V (t) is the measurement noise vector.
Turn to state equation and measurement equation are discrete:
X
k=Φ
k,k-1X
k-1+L
kU
k-1+W
k-1 (9)
Z
k=HX
k+V
k (10)
Φ wherein
K, k-1State transitions battle array for system; T
dBe the filtering cycle of system, unit: second; N is the frequency of resolving of inertial navigation system.
Kalman filter Filtering Model with controlled quentity controlled variable is:
K
k=P
k,k-1H
T(HP
k,k-1H
T+R
k)
-1 (12c)
P
k=(I-K
kH)P
k,k-1(I-K
kH)
T+K
kR
k(K
k)
T (12e)
In the formula:
P
K, k-1Prediction square error battle array for wave filter;
P
kEstimation square error battle array for wave filter;
Q
kSystem noise variance battle array for wave filter;
K
kGain battle array for wave filter;
R
kMeasuring noise square difference battle array for wave filter.
2) oppositely R-T-S is level and smooth
Oppositely the level and smooth model of R-T-S is
In the formula:
Subscript S represents the R-T-S smoothing process;
Be level and smooth estimation variance battle array.
In the forward processing procedure of 0 → n-hour, determine the state initial value
Estimate square error battle array initial value P
0, system noise variance battle array initial value Q
0And measuring noise square difference battle array initial value R
0After, adopt formula (12) to carry out forward filtering, store simultaneously the Φ in the filtering
K, k-1,
P
K, k-1,
P
kInitial value is set just according to known method commonly used, does not have particular determination.
In the inverse process constantly of N → 0, make k=N,
To oppositely smoothly carrying out initialization, it is level and smooth to adopt formula (13) to carry out reverse R-T-S.
3) output calibration
Adopt the level and smooth estimate of error of reverse R-T-S
The inertial navigation result is carried out output calibration.The output calibration equation of position is
In the formula:
Anti-Wei latitude, the level and smooth estimated value of reverse R-T-S of longitude error, unit: radian;
The output calibration equation of attitude matrix is
Be the attitude matrix behind the output calibration, be used for the attitude angle of calculation combination navigation.
More concrete, in the said process, wherein the implementation procedure of closed loop Real-time Feedback is:
Get ratio of damping
Oscillation frequency
According to formula (4), (5) respectively with formula (1), (2) and modular system
Carry out with the coefficient contrast, namely
C
1=2ξw
n
(5)
Calculate the control parameter K
1=0.1481, K
2=0.0011, C
1=0.1481, C
2=0.0109.The Kalman filtering with controlled quentity controlled variable according to formula (12) provides carries out forward filtering, stores simultaneously the Φ that filtering estimates
K, k-1,
P
K, k-1,
P
kWhen GPS week, be 19500.000 seconds second, the inertia measurement value under the navigation coordinate system was: north gyro measured value ω
N=0.00565658 radian per second, vertical gyro to measure value ω
U=-0.00171431 radian per second, east orientation gyro to measure value ω
E=-0.00000911 radian per second, north orientation acceleration measuring value f
N=-0.243338 meter per second
2, vertical acceleration instrumentation value f
U=9.872432 meter per seconds
2, east orientation acceleration measuring value f
E=-0.095566 meter per second
2The partial status estimator that filtering is calculated is:
(illustrate:
The system state that expression Kalman filtering is estimated, 1st element that be listed as capable to flow control i),
Then the filtering estimator be multiply by control coefrficient K
1, K
2, C
1, C
2After feed back to the input end that resolves of inertia measurement value and elevation, namely
ω
U=-0.00171431 radian per second,
Carry out navigation calculation again, namely realized with the filtering estimator inertial navigation result being carried out the process of real-time feedback control, the latitude that this moment, inertial navigation resolved is
Longitude is λ=75.09655065 degree, highly is h=11174.5415 rice, and roll angle is γ=0.1334 degree, and course angle is ψ=19.2063 degree, and the angle of pitch is θ=1.4596 degree.
After whole filtering finishes, adopt the final estimator of filtering to after oppositely smoothly carrying out initialization, it is level and smooth to carry out reverse R-T-S.When calculating to such an extent that GPS week, be 19200.000 seconds second, the latitude state estimator is X
S(1,1)=0.48282718 degree (illustrates: X
SThe level and smooth system state of estimating of (i, 1) expression R-T-S, 1st element that be listed as capable to flow control i), longitude state estimator X
S(2,1)=-0.57648990 degree, height state estimator X
S(3,1)=-3.4812 meter, roll angle state estimator X
S(7,1)=0.0133 degree, course angle state estimator X
S(8,1)=-0.0117 degree, angle of pitch state estimator X
S(9,1)=0.0066 degree.Adopt these estimate of errors that the inertial navigation result is carried out output calibration, solve the integrated navigation latitude and be
Longitude is λ
F=75.09671079 degree highly are h
F=11178.023 meters, roll angle is γ
F=0.1440 degree, course angle is ψ
F=19.1945 degree, the angle of pitch is θ
F=1.4700 degree.
Claims (1)
1. a closed loop forward filtering is the method for the position and attitude data of POS being carried out aftertreatment in conjunction with reverse level and smooth POS post-processing approach, comprising: the step of Kalman filtering, and the reverse level and smooth step of R-T-S is characterized in that:
In the process of Kalman filtering, the process of setting up Kalman filter model is as follows:
Step 1, use second order model are described inertial navigation system;
Design inertial navigation system horizontal channel becomes typical second-order system;
In the formula: K
1, K
2Two real-time feedback control coefficients of horizontal channel;
Design inertial navigation system vertical passage becomes typical second-order system;
In the formula: C
1, C
2Two real-time feedback control coefficients of vertical passage;
The secular equation of typical case's second-order system is
According to POS system afterwards processing procedure ξ, w are determined in the requirement of filtering regulating cycle and overshoot
nThen calculate according to the following procedure feedback control coefficient;
1, determines filtering regulating cycle and overshoot according to the performance requirement of system;
2, according to regulating cycle and overshoot, determine ξ, w
n
3, respectively formula (1), (2) are carried out namely obtaining formula (4), (5) with the coefficient contrast with formula (3), resolve to get feedback control coefficient K according to formula (4), (5)
1, K
2, C
1, C
2
K
1=2ξw
n
(4)
C
1=2ξw
n
(5)
Step 2, set up the error equation of POS:
In the formula:
v
N, v
U, v
EBe respectively north orientation speed, vertical velocity, the east orientation speed of inertial navigation system, unit: meter per second was the amount in a upper moment;
δ v
N, δ v
U, δ v
EBe respectively north orientation velocity error, vertical velocity error, the east orientation velocity error of inertial navigation system, unit: meter per second was the amount in a upper moment;
Be the latitude of inertial navigation system, unit: radian was the amount in a upper moment;
H is the height of inertial navigation system, unit: rice was the amount in a upper moment;
δ h is the height error of inertial navigation system, unit: rice was the amount in a upper moment;
φ
U, φ
EBe respectively vertical error angle, the east orientation error angle of inertial navigation system, unit: radian was the amount in a upper moment;
f
U, f
EBe respectively vertical acceleration, east orientation acceleration, unit: meter per second
2, be the amount of current time;
Being respectively carrier is partially error, y axis accelerometer zero inclined to one side error, the zero partially error of z axis accelerometer of x axis accelerometer zero, unit: meter per second
2, be the amount of current time;
C
1j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
R
M, R
NBe respectively earth meridian circle, prime vertical radius, unit: rice was the amount in a upper moment;
ω
IeBe the earth rotation angular speed, unit: radian per second is constant;
Be system's fast error in north that Kalman filtering is estimated, unit: meter per second is the amount of current time;
K
1Real-time feedback control coefficient for the horizontal channel is calculated by said process;
In the formula:
f
NBe the north orientation acceleration, unit: meter per second
2, be the amount of current time;
φ
NBe the north orientation error angle of inertial navigation system, unit: radian was the amount in a upper moment;
C
2j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
Be the system height error that Kalman filtering is estimated, unit: rice is the amount of current time;
C
2Real-time feedback control coefficient for vertical passage is calculated by said process;
In the formula:
C
3j(j=1,2,3) are respectively the element of attitude matrix, are the amount in a upper moment;
Be system's fast error in east that Kalman filtering is estimated, unit: meter per second is the amount of current time;
In the formula:
C
1Real-time feedback control coefficient for vertical passage is calculated by said process;
In the formula:
Being respectively the carrier that is processed into first-order Markov process is x axle gyroscopic drift error, y axle gyroscopic drift error, z axle gyroscopic drift error, unit: radian per second;
Step 3, set up Kalman filter model;
Get state variable
Observed quantity
Wherein subscript G represents the information that GPS provides;
λ
GBe respectively latitude, longitude that GPS provides, unit: radian; h
GBe the height that GPS provides, unit: rice;
Be respectively north orientation speed, vertical velocity, east orientation speed that GPS provides, unit: meter per second; λ is the longitude of inertial navigation system, unit: radian;
According to the error equation that provides, determine that the state equation of system is
In the formula:
A (t) 15 * 15 maintains the system parameter matrix, calculates according to formula (6);
L (t) is 15 * 3 dimension control coefrficient matrixes, L (t)=[0
3 * 2L
3 * 70
3 * 6]
T, wherein
W (t) 15 * 1 maintains system excitation noise vector;
Measurement equation is:
Z=HX(t)+V(t)
(8)
In the formula:
H is 6 * 15 dimension measurement matrixes;
V (t) is the measurement noise vector;
Turn to state equation and measurement equation are discrete:
X
k=Φ
k,k-1X
k-1+L
kU
k-1+W
k-1 (9)
Z
k=HX
k+V
k (10)
Φ wherein
K, k-1State transitions battle array for system; T
dBe the filtering cycle of system, unit: second; N is the frequency of resolving of inertial navigation system;
Kalman filter Filtering Model with controlled quentity controlled variable is:
(12a)
(12b)
K
k=P
k,k-1H
T(HP
k,k-1H
T+R
k)
-1
(12c)
(12d)
P
k=(I-K
kH)P
k,k-1(I-K
kH)
T+K
kR
k(K
k)
T
(12e)
In the formula:
P
K, k-1Prediction square error battle array for wave filter;
P
kEstimation square error battle array for wave filter;
Q
kSystem noise variance battle array for wave filter;
K
kGain battle array for wave filter;
R
kMeasuring noise square difference battle array for wave filter.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011102730467A CN102997915A (en) | 2011-09-15 | 2011-09-15 | POS post-processing method with combination of closed-loop forward filtering and reverse smoothing |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011102730467A CN102997915A (en) | 2011-09-15 | 2011-09-15 | POS post-processing method with combination of closed-loop forward filtering and reverse smoothing |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102997915A true CN102997915A (en) | 2013-03-27 |
Family
ID=47926791
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2011102730467A Pending CN102997915A (en) | 2011-09-15 | 2011-09-15 | POS post-processing method with combination of closed-loop forward filtering and reverse smoothing |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102997915A (en) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103281054A (en) * | 2013-05-10 | 2013-09-04 | 哈尔滨工程大学 | Self adaption filtering method adopting noise statistic estimator |
CN103364817A (en) * | 2013-07-11 | 2013-10-23 | 北京航空航天大学 | POS system double-strapdown calculating post-processing method based on R-T-S smoothness |
CN103712620A (en) * | 2013-11-27 | 2014-04-09 | 北京机械设备研究所 | Inertia autonomous navigation method by utilizing vehicle body non-integrity constraint |
CN103955005A (en) * | 2014-05-12 | 2014-07-30 | 北京航天控制仪器研究所 | Rocket sled orbit gravity real-time measuring method |
CN104949687A (en) * | 2014-03-31 | 2015-09-30 | 北京自动化控制设备研究所 | Whole parameter precision evaluation method for long-time navigation system |
CN110068325A (en) * | 2019-04-11 | 2019-07-30 | 同济大学 | A kind of lever arm error compensating method of vehicle-mounted INS/ visual combination navigation system |
CN111007468A (en) * | 2019-12-25 | 2020-04-14 | 中国航空工业集团公司西安飞机设计研究所 | Radar SAR imaging positioning error eliminating method |
CN111121774A (en) * | 2020-01-14 | 2020-05-08 | 上海曼恒数字技术股份有限公司 | Infrared positioning camera capable of detecting self posture in real time |
CN111141279A (en) * | 2019-12-20 | 2020-05-12 | 北京小马慧行科技有限公司 | Method and device for processing driving track |
CN111238473A (en) * | 2020-01-21 | 2020-06-05 | 西北工业大学 | Second-order damping method for height channel of inertial navigation system under geocentric geostationary coordinate system |
CN116088020A (en) * | 2022-12-23 | 2023-05-09 | 中国铁路设计集团有限公司 | Fusion track three-dimensional reconstruction method based on low-cost sensor integration |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1617563A1 (en) * | 1988-05-31 | 1990-12-30 | Предприятие П/Я В-2969 | Stabilizing converter |
CN102109351A (en) * | 2010-12-31 | 2011-06-29 | 北京航空航天大学 | Laser gyro POS (Point of Sales) data acquisition and pre-processing system |
-
2011
- 2011-09-15 CN CN2011102730467A patent/CN102997915A/en active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1617563A1 (en) * | 1988-05-31 | 1990-12-30 | Предприятие П/Я В-2969 | Stabilizing converter |
CN102109351A (en) * | 2010-12-31 | 2011-06-29 | 北京航空航天大学 | Laser gyro POS (Point of Sales) data acquisition and pre-processing system |
Non-Patent Citations (1)
Title |
---|
邱宏波等: "基于闭环误差控制器的高精度POS后处理算法", 《中国惯性技术学报》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103281054A (en) * | 2013-05-10 | 2013-09-04 | 哈尔滨工程大学 | Self adaption filtering method adopting noise statistic estimator |
CN103364817A (en) * | 2013-07-11 | 2013-10-23 | 北京航空航天大学 | POS system double-strapdown calculating post-processing method based on R-T-S smoothness |
CN103364817B (en) * | 2013-07-11 | 2015-04-29 | 北京航空航天大学 | POS system double-strapdown calculating post-processing method based on R-T-S smoothness |
CN103712620A (en) * | 2013-11-27 | 2014-04-09 | 北京机械设备研究所 | Inertia autonomous navigation method by utilizing vehicle body non-integrity constraint |
CN103712620B (en) * | 2013-11-27 | 2016-03-30 | 北京机械设备研究所 | A kind of inertia autonomous navigation method utilizing vehicle body non-integrity constraint |
CN104949687A (en) * | 2014-03-31 | 2015-09-30 | 北京自动化控制设备研究所 | Whole parameter precision evaluation method for long-time navigation system |
CN103955005A (en) * | 2014-05-12 | 2014-07-30 | 北京航天控制仪器研究所 | Rocket sled orbit gravity real-time measuring method |
CN110068325A (en) * | 2019-04-11 | 2019-07-30 | 同济大学 | A kind of lever arm error compensating method of vehicle-mounted INS/ visual combination navigation system |
CN111141279B (en) * | 2019-12-20 | 2022-07-01 | 北京小马慧行科技有限公司 | Method and device for processing driving track |
CN111141279A (en) * | 2019-12-20 | 2020-05-12 | 北京小马慧行科技有限公司 | Method and device for processing driving track |
CN111007468A (en) * | 2019-12-25 | 2020-04-14 | 中国航空工业集团公司西安飞机设计研究所 | Radar SAR imaging positioning error eliminating method |
CN111007468B (en) * | 2019-12-25 | 2023-06-23 | 中国航空工业集团公司西安飞机设计研究所 | Radar SAR imaging positioning error eliminating method |
CN111121774A (en) * | 2020-01-14 | 2020-05-08 | 上海曼恒数字技术股份有限公司 | Infrared positioning camera capable of detecting self posture in real time |
CN111238473A (en) * | 2020-01-21 | 2020-06-05 | 西北工业大学 | Second-order damping method for height channel of inertial navigation system under geocentric geostationary coordinate system |
CN111238473B (en) * | 2020-01-21 | 2022-11-22 | 西北工业大学 | Second-order damping method for height channel of inertial navigation system under geocentric geostationary coordinate system |
CN116088020A (en) * | 2022-12-23 | 2023-05-09 | 中国铁路设计集团有限公司 | Fusion track three-dimensional reconstruction method based on low-cost sensor integration |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102997915A (en) | POS post-processing method with combination of closed-loop forward filtering and reverse smoothing | |
CN100516775C (en) | Method for determining initial status of strapdown inertial navigation system | |
CN101033973B (en) | Attitude determination method of mini-aircraft inertial integrated navigation system | |
CN1330935C (en) | Microinertia measuring unit precisive calibration for installation fault angle and rating factor decoupling | |
CN106597017B (en) | A kind of unmanned plane Angular Acceleration Estimation and device based on Extended Kalman filter | |
CN101949703B (en) | Strapdown inertial/satellite combined navigation filtering method | |
CN101706284B (en) | Method for increasing position precision of optical fiber gyro strap-down inertial navigation system used by ship | |
CN106291645A (en) | Be suitable to the volume kalman filter method that higher-dimension GNSS/INS couples deeply | |
CN103033186A (en) | High-precision integrated navigation positioning method for underwater glider | |
CN102508278A (en) | Adaptive filtering method based on observation noise covariance matrix estimation | |
CN102853837B (en) | MIMU and GNSS information fusion method | |
CN104977004A (en) | Method and system for integrated navigation of laser inertial measuring unit and odometer | |
CN103557864A (en) | Initial alignment method for micro electro mechanical system (MEMS) strap-down inertial navigation adaptive square-root cubature Kalman filtering (SCKF) | |
CN105806363A (en) | Alignment method of an underwater large misalignment angle based on SINS (Strapdown Inertial Navigation System)/DVL (Doppler Velocity Log) of SRQKF (Square-root Quadrature Kalman Filter) | |
CN102538788B (en) | Low-cost damping navigation method based on state estimation and prediction | |
CN104374405A (en) | MEMS strapdown inertial navigation initial alignment method based on adaptive central difference Kalman filtering | |
CN103424127B (en) | A kind of speed adds specific force coupling Transfer Alignment | |
CN103968843A (en) | Self-adaption mixed filtering method of GPS/SINS (Global Positioning System/Strapdown Inertial Navigation System) super-compact integrated navigation system | |
CN103792561A (en) | Tight integration dimensionality reduction filter method based on GNSS channel differences | |
CN103727940A (en) | Gravity acceleration vector fitting-based nonlinear initial alignment method | |
CN105157724A (en) | Transfer alignment time delay estimation and compensation method based on velocity plus attitude matching | |
CN103217174A (en) | Initial alignment method of strap-down inertial navigation system based on low-precision micro electro mechanical system | |
CN103697878A (en) | Rotation-modulation north-seeking method utilizing single gyroscope and single accelerometer | |
CN105988129A (en) | Scalar-estimation-algorithm-based INS/GNSS combined navigation method | |
CN101929862A (en) | Method for determining initial attitude of inertial navigation system based on Kalman filtering |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C12 | Rejection of a patent application after its publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20130327 |