CN102997892A - Land type navigation system height combination method based on inertia/mileage meter/barometric height - Google Patents
Land type navigation system height combination method based on inertia/mileage meter/barometric height Download PDFInfo
- Publication number
- CN102997892A CN102997892A CN201110273435XA CN201110273435A CN102997892A CN 102997892 A CN102997892 A CN 102997892A CN 201110273435X A CN201110273435X A CN 201110273435XA CN 201110273435 A CN201110273435 A CN 201110273435A CN 102997892 A CN102997892 A CN 102997892A
- Authority
- CN
- China
- Prior art keywords
- inertia
- height
- expression
- mileage
- odometer
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Navigation (AREA)
Abstract
The invention belongs to the technical field of land type inertial navigation, and particularly relates to a land type navigation system height combination method based on inertia/mileage meter/barometric height. According to the method, a difference value between a barometric height and an inertia/mileage combination height is adopted as an observation value, a least square method is adopted to evaluate parameters in an inertia/mileage meter height combination error model, and the inertia/mileage height is corrected by using the evaluated parameters. In the prior art, the existing land type navigation system height combination method can not concurrently meet requirements of high precision, electromagnetic interference resistance, and no limitation by barometric altimeter height accuracy and pitch angle error. A purpose of the present invention is to solve technical problems in the prior art. The land type navigation system height combination method has the following beneficial effects: three information such as the inertial navigation, the mileage meter and the barometric height are fused, such that height error inhibition at different vehicle/road condition changes can be achieved, and requirements of high precision, electromagnetic interference resistance, and no limitation by barometric altimeter height accuracy and pitch angle error can be concurrently met.
Description
Technical field
The invention belongs to land inertia field of navigation technology, be specifically related to a kind of land based on inertia/odometer/barometer altitude navigational system altitude combination method.
Background technology
Inertia/combinations of satellites, inertia/barometer altitude combination and inertia/forms such as odometer combination are adopted usually with the altitude channel of navigational system in existing land.The vertical accuracy of inertia/combinations of satellites is high, but depends on the satellite navigation systems such as foreign GPS, GLOANSS, and is subject to the impact that electromagnetic interference (EMI) and landform such as block at the many factors; The vertical accuracy of inertia/barometer altitude combination is subject to the vertical accuracy of pressure altimeter; The combination of inertia/odometer is owing to exist angle of pitch error, and angle of pitch error can change to some extent with the fluctuating on carload and road surface, and its vertical error is with the mileage accumulation of travelling.
Summary of the invention
To be existing land can't satisfy high precision, anti-electromagnetic interference (EMI), not be subjected to the requirement of pressure altimeter vertical accuracy and angle of pitch error limitation with navigational system altitude combination method the technical problem to be solved in the present invention simultaneously.
Technical scheme of the present invention is as described below:
A kind of land based on inertia/odometer/barometer altitude navigational system altitude combination method, the method is take the difference of barometer altitude and inertia/mileage combined altitudes as observed quantity, adopt least square method that the parameter in inertia/odometer altitude combination error model is estimated, and utilize the parameter of estimating that inertia/mileage height is revised; Specifically comprise the steps:
Step 1. is set up inertia/odometer combined altitudes error model; Step 2. parameter estimation; Step 3. error compensation.
As preferred implementation, inertia in the step 1/odometer combined altitudes error model is:
h
k=h
k-1+ΔD
k×sinα
k
Δh
k=k
1D
k,cosα+k
2D
k,sin2α
D
k,cosα=D
k-1,cosα+ΔD
k×cosα
k
D
k,sin2α=D
k-1,sin2α+ΔD
k×sin2α
k
In the formula:
h
kExpression k is inertia/mileage combined altitudes constantly, unit: rice;
Δ D
kExpression k-1 is constantly to the mileage increment of k between the moment, unit: rice;
α
kThe expression k angle of pitch constantly, unit: radian;
Δ h
kExpression k is the error of inertia/mileage combined altitudes constantly, unit: rice;
D
K, cos αThe expression k moment, the cosine mileage accumulation amount of odometer, unit: rice;
D
K, sin2 αThe expression k moment, the sinusoidal mileage accumulation amount of odometer, unit: rice;
k
1, k
2The evaluated error parameter is treated in expression.
Carry out parameter estimation by following formula in the step 2:
In the formula:
Expression is treated to be [k by estimated parameter
1k
2]
T, X
0=[0 0]
T
P
kExpression 2 * 2 dimension matrixes,
H
kExpression [D
K, cos αD
K, sin2 α];
Z
kThe expression observed quantity, namely barometer altitude and inertia/mileage combined altitudes is poor;
With Z
kBe independent variable, with k
1, k
2Be dependent variable, adopt least square method to determine k
1, k
2
Carry out error compensation by following formula in the step 3:
In the formula:
h
kExpression k is inertia/mileage combined altitudes constantly, unit: rice;
Beneficial effect of the present invention is:
Inertial navigation, odometer and three kinds of information fusion of barometer altitude are passed through to adopt with navigational system altitude combination method in land based on inertia/odometer/barometer altitude of the present invention, realize that the vertical error under different car/road condition change suppresses, can satisfy simultaneously high precision, anti-electromagnetic interference (EMI), not be subjected to the requirement of pressure altimeter vertical accuracy and angle of pitch error limitation.
Embodiment
Below in conjunction with embodiment the land based on inertia/odometer/barometer altitude of the present invention is elaborated with navigational system altitude combination method.
Land based on inertia/odometer/barometer altitude of the present invention with navigational system altitude combination method take the difference of barometer altitude and inertia/mileage combined altitudes as observed quantity, adopt least square method that the parameter in inertia/odometer altitude combination error model is estimated, and utilize the parameter of estimating that inertia/mileage height is revised.Concrete steps are as follows:
Step 1. is set up inertia/odometer combined altitudes error model
h
k=h
k-1+ΔD
k×sinα
k (1)
Δh
k=k
1D
k,cosα+k
2D
k,sin2α (2)
D
k,cosα=D
k-1,cosα+ΔD
k×cosα
k (3)
D
k,sin2α=D
k-1,sin2α+ΔD
k×sin2α
k (4)
In the formula:
h
kExpression k is inertia/mileage combined altitudes constantly, unit: rice;
Δ D
kExpression k-1 is constantly to the mileage increment of k between the moment, unit: rice;
α
kThe expression k angle of pitch constantly, unit: radian;
Δ h
kExpression k is the error of inertia/mileage combined altitudes constantly, unit: rice;
D
K, cos αThe expression k moment, the cosine mileage accumulation amount of odometer, unit: rice;
D
K, sin2 αThe expression k moment, the sinusoidal mileage accumulation amount of odometer, unit: rice;
k
1, k
2The evaluated error parameter is treated in expression.
Step 2. parameter estimation
In the formula:
P
kExpression 2 * 2 dimension matrixes,
H
kExpression [D
K, cos αD
K, sin2 α];
Z
kThe expression observed quantity, namely barometer altitude and inertia/mileage combined altitudes is poor.
With Z
kBe independent variable, with k
1, k
2Be dependent variable, adopt least square method to determine k
1, k
2
Step 3. error compensation
In the formula:
h
kExpression k is inertia/mileage combined altitudes constantly, unit: rice;
Represent revised height, unit: rice.
Embodiment 1
At first carry out parameter initialization: X
0=[0 0]
T,
And then carry out parameter estimation:
If during 1s, D
0, cos α=0, D
0, sin2 α=0, measure Δ D by odometer
1=1.194, measure α by inertial navigation
1=-28.248 °, by the D that inertia/odometer combined altitudes error model Chinese style (3) calculates
1, cos αBe 1.1518m, the D that is calculated by formula (4)
1, sin2 αFor-0.8999m, the difference Z of barometer altitude and inertia/mileage combined altitudes
1Be 0.0978m, the method for obtaining barometer altitude and inertia/odometer combined altitudes is general knowledge as well known to those skilled in the art, then H
1=[1.1518-0.8999], Z
1=[0.9078].
During 1s, can be calculated according to formula (5):
K when being 1s
1=0.3334, k
2=-0.2604.
Adopt least square method to carry out the parameter recursion when estimating, estimates of parameters increases and is tending towards stable state with observation data, and estimated accuracy improves thereupon.
If during 499s, each parameter that calculates according to last beat of data is
X
499=[0.0004-0.7315]
T,
H
499=[3000.0367.706]。
During 500s, measure Δ D by odometer
500=2.3, measure α by inertial navigation
500=10.1 ° is H by formula (3) and formula (4) calculated value
500=[3002.38.5]; According to 500s barometer altitude and inertia/mileage combined altitudes constantly, the difference that can obtain the two is Z
500=[3.5922].
Then during 500s, as follows according to each estimates of parameters of formula (5):
K when being 500s
1=0.0004, k
2=-0.728.
Carry out at last error compensation:
If during 500s, inertia/mileage combined altitudes is h
500=32.6941, the height behind the parametric compensation that then utilization estimates according to formula (6) is
In the present embodiment, the height measurements that utilization is generally considered the higher GPS of precision is 38m, the measured value of pressure altimeter is 40.1m, inertia/odometer combined altitudes is 42.1m, hence one can see that, the combined altitudes that patent of the present invention calculates will closer to the measured value of GPS height, improve measuring accuracy with respect to pressure altimeter and inertia/odometer combined method; And it more can resist electromagnetic interference (EMI) than gps system; The combination of barometer altitude and inertia/odometer combined altitudes makes this method can not be subjected to the requirement of pressure altimeter vertical accuracy and angle of pitch error limitation.
Claims (4)
- One kind based on inertia/odometer/barometer altitude land with navigational system altitude combination method, it is characterized in that: the method is take the difference of barometer altitude and inertia/mileage combined altitudes as observed quantity, adopt least square method that the parameter in inertia/odometer altitude combination error model is estimated, and utilize the parameter of estimating that inertia/mileage height is revised; Specifically comprise the steps:Step 1. is set up inertia/odometer combined altitudes error model;Step 2. parameter estimation;Step 3. error compensation.
- 2. described based on inertia/odometer/barometer altitude land navigational system altitude combination method according to claim 1, it is characterized in that: inertia in the step 1/odometer combined altitudes error model is:h k=h k-1+ΔD k×sinα kΔh k=k 1D k,cosα+k 1D k,sin2αD k,cosα=D k-1,cosα+ΔD k×cosα kD k,sin2α=D k-1,sin2α+ΔD k×sin2α kIn the formula:h kExpression k is inertia/mileage combined altitudes constantly, unit: rice;Δ D kExpression k-1 is constantly to the mileage increment of k between the moment, unit: rice;α kThe expression k angle of pitch constantly, unit: radian;Δ h kExpression k is the error of inertia/mileage combined altitudes constantly, unit: rice;D K, cos αThe expression k moment, the cosine mileage accumulation amount of odometer, unit: rice;D K, sin2 αThe expression k moment, the sinusoidal mileage accumulation amount of odometer, unit: rice;k 1, k 2The evaluated error parameter is treated in expression.
- 3. described based on inertia/odometer/barometer altitude land navigational system altitude combination method according to claim 2, it is characterized in that: carry out parameter estimation by following formula in the step 2:In the formula:P kExpression 2 * 2 dimension matrixes,H kExpression [D K, cos αD K, sin2 α];Z kThe expression observed quantity, namely barometer altitude and inertia/mileage combined altitudes is poor;With Z kBe independent variable, with k 1, k 2Be dependent variable, adopt least square method to determine k 1, k 2
- 4. described based on inertia/odometer/barometer altitude land navigational system altitude combination method according to claim 3, it is characterized in that: carry out error compensation by following formula in the step 3:In the formula:h kExpression k is inertia/mileage combined altitudes constantly, unit: rice;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110273435.XA CN102997892B (en) | 2011-09-15 | 2011-09-15 | Land type navigation system height combination method based on inertia/mileage meter/barometric height |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110273435.XA CN102997892B (en) | 2011-09-15 | 2011-09-15 | Land type navigation system height combination method based on inertia/mileage meter/barometric height |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102997892A true CN102997892A (en) | 2013-03-27 |
CN102997892B CN102997892B (en) | 2015-02-11 |
Family
ID=47926773
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110273435.XA Active CN102997892B (en) | 2011-09-15 | 2011-09-15 | Land type navigation system height combination method based on inertia/mileage meter/barometric height |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102997892B (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104154916A (en) * | 2013-08-30 | 2014-11-19 | 北京航天发射技术研究所 | Vehicle positioning device based on laser gyroscope strapdown inertial measurement unit |
CN107588769A (en) * | 2017-10-17 | 2018-01-16 | 北京航天发射技术研究所 | A kind of vehicle-mounted inertial navigation, odometer and altimeter Combinated navigation method |
CN108303063A (en) * | 2017-12-21 | 2018-07-20 | 中国船舶重工集团公司第七0七研究所 | A kind of vehicle-mounted combination measurement of higher degree method of high-precision |
CN114234910A (en) * | 2021-12-08 | 2022-03-25 | 南京航空航天大学 | Inertia and ADS height fusion method based on air pressure reference self-adaptive correction |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101021879A (en) * | 2007-01-17 | 2007-08-22 | 南京航空航天大学 | Inertial measuring system error model demonstration test method |
CN101241178A (en) * | 2007-02-09 | 2008-08-13 | 陈刘成 | High precision navigational satellite ephemeris fitting technology |
CN101270993A (en) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | Remote high-precision independent combined navigation locating method |
CN101793529A (en) * | 2010-03-03 | 2010-08-04 | 北京航空航天大学 | Double pseudo satellite aided position calibration method of inertial navigation system |
-
2011
- 2011-09-15 CN CN201110273435.XA patent/CN102997892B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101021879A (en) * | 2007-01-17 | 2007-08-22 | 南京航空航天大学 | Inertial measuring system error model demonstration test method |
CN101241178A (en) * | 2007-02-09 | 2008-08-13 | 陈刘成 | High precision navigational satellite ephemeris fitting technology |
CN101270993A (en) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | Remote high-precision independent combined navigation locating method |
CN101793529A (en) * | 2010-03-03 | 2010-08-04 | 北京航空航天大学 | Double pseudo satellite aided position calibration method of inertial navigation system |
Non-Patent Citations (4)
Title |
---|
刘峰等: "水平初始对准误差对旋转IMU导航***的精度影响", 《中国惯性技术学报》 * |
刘辉等: "陆用光纤捷联惯导***定位误差自主抑制技术", 《惯性技术发展动态发展方向研讨会文集》 * |
张凌宇等: "安装误差角引起的加速度计旋转误差建模", 《中国惯性技术学报》 * |
王文辉等: "自适应RLS算法及其在SINS/SAR组合导航中的应用", 《空间控制技术与应用》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104154916A (en) * | 2013-08-30 | 2014-11-19 | 北京航天发射技术研究所 | Vehicle positioning device based on laser gyroscope strapdown inertial measurement unit |
CN104154916B (en) * | 2013-08-30 | 2018-11-30 | 北京航天发射技术研究所 | A kind of vehicle positioning equipment based on the used group of laser gyro strap down |
CN107588769A (en) * | 2017-10-17 | 2018-01-16 | 北京航天发射技术研究所 | A kind of vehicle-mounted inertial navigation, odometer and altimeter Combinated navigation method |
CN108303063A (en) * | 2017-12-21 | 2018-07-20 | 中国船舶重工集团公司第七0七研究所 | A kind of vehicle-mounted combination measurement of higher degree method of high-precision |
CN108303063B (en) * | 2017-12-21 | 2020-12-15 | 中国船舶重工集团公司第七0七研究所 | High-precision vehicle-mounted combined elevation measurement method |
CN114234910A (en) * | 2021-12-08 | 2022-03-25 | 南京航空航天大学 | Inertia and ADS height fusion method based on air pressure reference self-adaptive correction |
Also Published As
Publication number | Publication date |
---|---|
CN102997892B (en) | 2015-02-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101476894B (en) | Vehicle-mounted SINS/GPS combined navigation system performance reinforcement method | |
EP2095148B1 (en) | Arrangement for and method of two dimensional and three dimensional precision location and orientation determination | |
CN104061899B (en) | A kind of vehicle side inclination angle based on Kalman filtering and angle of pitch method of estimation | |
CN101949703B (en) | Strapdown inertial/satellite combined navigation filtering method | |
CN101963513B (en) | Alignment method for eliminating lever arm effect error of strapdown inertial navigation system (SINS) of underwater carrier | |
CN108562917B (en) | Constraint filtering resolving method and device for additional orthogonal function fitting condition | |
CN103093088B (en) | The safety evaluation method of abrupt slope and crankcase ventilaton | |
CN101750619B (en) | Method for directly positioning ground target by self-checking POS | |
CN103344260B (en) | Based on the strapdown inertial navitation system (SINS) Initial Alignment of Large Azimuth Misalignment On method of RBCKF | |
CN104680008A (en) | Multi-reference station-based network RTK (Real Time Kinematic) area atmospheric error modeling method | |
US10809390B2 (en) | Positioning apparatus | |
CN105301617B (en) | A kind of integer ambiguity validity check method in satellite navigation system | |
CN102680002B (en) | Online calibrating method of zero-point voltage of micro-machine gyroscope for automobile | |
CN102508278A (en) | Adaptive filtering method based on observation noise covariance matrix estimation | |
CN101893445A (en) | Rapid initial alignment method for low-accuracy strapdown inertial navigation system under swinging condition | |
CN109059909A (en) | Satellite based on neural network aiding/inertial navigation train locating method and system | |
CN106370179A (en) | Systems and methods for navigating using corrected yaw bias values | |
CN107687114A (en) | A kind of track absolute position and bias measurement method | |
CN102997892B (en) | Land type navigation system height combination method based on inertia/mileage meter/barometric height | |
CN104677361A (en) | Comprehensive positioning method | |
CN107015259A (en) | The tight integration method of pseudorange/pseudorange rates is calculated using Doppler anemometer | |
CN104215262A (en) | On-line dynamic inertia sensor error identification method of inertia navigation system | |
CN103148853A (en) | Satellite attitude determination method and system based on star sensors | |
CN103217699A (en) | Integrated navigation system recursion optimizing initial-alignment method based on polarization information | |
CN103389115A (en) | Integrated error calibrating method of SINS/DVL (strapdown inertial navigation system/doppler velocity sonar) combined navigation system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |