CN101082496A - System capable of effectively decreasing vehicle GPS navigation error - Google Patents
System capable of effectively decreasing vehicle GPS navigation error Download PDFInfo
- Publication number
- CN101082496A CN101082496A CN 200610027128 CN200610027128A CN101082496A CN 101082496 A CN101082496 A CN 101082496A CN 200610027128 CN200610027128 CN 200610027128 CN 200610027128 A CN200610027128 A CN 200610027128A CN 101082496 A CN101082496 A CN 101082496A
- Authority
- CN
- China
- Prior art keywords
- filter
- gps
- module
- error
- phi
- 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
This invention discloses a sort of system which reduces effectively the GPS navigation error to the cars; it can reduce effectively the navigation error, and increase the positioning accuracy. Its technical project is that: This invention combines the GPS with the dead reckoning and the electronic map information in the revolutionary method by the manner of federation filtering according to the principle of federation Kalman filter. The system in this invention consists of the module of electronic map filter, the module of GPS filter, the module of the time revolution and data amalgamation. This invention applies to the field of the GPS navigation system.
Description
Technical field
The present invention relates to a kind of GPS Vehicular navigation system, relate in particular to a kind of system that can effectively reduce the navigation time error.
Background technology
In the existing GPS navigation, correlation techniques such as reckoning and electronic map match are arranged.Wherein reckoning is by accumulation time dependent travelling speed of automobile and angle, extrapolates the travel track of automobile, thereby learns the position of particular moment automobile.The electronic map match technology is to compare with road characteristic points by current anchor point and last anchor point are put into map datum, draws the most probable site of road of current anchor point by exclusive method.
But there is certain error in existing GPS navigation, in some field that need carry out accurate relatively vehicle location, needs to reduce navigation error, improves bearing accuracy.
Summary of the invention
The objective of the invention is to address the above problem, a kind of system that effectively reduces the vehicle GPS navigation error is provided, it can effectively reduce navigation error, improves bearing accuracy.
Technical scheme of the present invention is: a kind of system that effectively reduces the vehicle GPS navigation error comprises:
The electronic chart filter module, position that when map datum satisfies filtering condition reckoning is obtained and course information adopt with position that is obtained by map match and course information concentrates kalman filter method to carry out combined filter, and the filter value time that outputs to upgraded and data fusion module as one of data source of data fusion, and the initial value of next filtering iteration is obtained by the fusion results feedback;
The GPS filter module, position that when gps data satisfies filtering condition reckoning is obtained and course information adopt with position that is obtained by GPS and course information concentrates kalman filter method to carry out combined filter, and the filter value time that outputs to upgraded and data fusion module as one of data source of data fusion, and the initial value of next iteration is obtained by the fusion results feedback;
Time upgrades and data fusion module, the filter value time of carrying out that described electronic chart filter module and GPS filter module are sent upgrades and the processing of data fusion, and the result of data fusion is fed back to described electronic chart filter module and GPS filter module.
The above-mentioned system that effectively reduces the vehicle GPS navigation error, wherein, in the described electronic chart filter module, the state equation of this wave filter and measurement equation are
Wherein
In the above-mentioned formula, δ
, δ
λ, δ
Ψ, δ
k, δ
vBe respectively latitude error, longitude error, course error, gyro calibration factor sum of errors gyro zero error partially,
M, λ
M, Ψ
MBe respectively carrier longitude and latitude and the course angle that obtains by map,
R, λ
R, Ψ
RBe respectively carrier longitude and latitude and the course angle that is obtained by reckoning, Ψ is the current course angle of vehicle, U, U
0, K is respectively current gyroscope output voltage, total null voltage and calibration factor, , λ are represented latitude and the longitude that vehicle is current respectively, v is the current travelling speed of vehicle, Re is a reference ellipsoid equatorial plane radius, β
k, β
vBe the inverse correlation time constant, W
K-1Be that K-1 r constantly maintains system noise, V
kIt is K m dimension measurement noise constantly.
The above-mentioned system that effectively reduces the vehicle GPS navigation error, wherein, in the described GPS filter module, the state equation of this wave filter and measurement equation are:
Wherein
In the above-mentioned formula,
G, λ
G, Ψ
GBe respectively carrier longitude and latitude and the course angle that obtains by GPS.
The above-mentioned system that effectively reduces the vehicle GPS navigation error, wherein, in described time renewal and the data fusion module, the equation that the described time upgrades is:
In the formula
P
G, k-1Be respectively the state estimation and the estimation variance matrix of senior filter,
P
G, k/k-1Be respectively the status predication value and the predicated error variance matrix of senior filter;
The data fusion equation of global optimum is:
P in the formula
G, k, P
M, kBe respectively the state error variance battle array of GPS wave filter and electronic chart wave filter,
Be respectively the state estimation of GPS wave filter and electronic chart wave filter, Φ is the transition matrix of system's current time, and Q is the covariance matrix of current time system noise W.
The above-mentioned system that effectively reduces the vehicle GPS navigation error, wherein, described system makes up GPS, reckoning and the electronic map information mode by federal filtering according to federal Kalman filter principle.
System of the present invention has following beneficial effect compared to existing technology: the present invention makes up GPS, reckoning and the electronic map information mode by federal filtering according to federal Kalman filter principle, with the error of effective minimizing vehicle GPS navigation.
Description of drawings
Fig. 1 is the synoptic diagram that the present invention effectively reduces the system embodiment of vehicle GPS navigation error.
Embodiment
The invention will be further described below in conjunction with drawings and Examples.
See also Fig. 1, system 10 mainly comprises electronic chart filter module 11, GPS filter module 12 and senior filter module 13.Wherein, comprise time updating submodule 131 and optimum fusion submodule 132 in the senior filter module 13 again.
In electronic chart filter module 11, position that when map datum satisfies filtering condition reckoning 14 is obtained and course information adopt with position that is obtained by map match 15 and course information concentrates kalman filter method to carry out combined filter, and this filter value is outputed to optimum fusion submodule 132 in the senior filter module 13 as one of data source of data fusion.Result after the initial value of filtering next time iteration is merged by senior filter 13 obtains through feedback.
In the above-mentioned formula, δ
, δ
λ, δ
Ψ, δ
k, δ
vBe respectively latitude error, longitude error, course error, gyro calibration factor sum of errors gyro zero error partially,
M, λ
ω, Ψ
MBe respectively carrier longitude and latitude and the course angle that obtains by map match 15,
R, λ
δ, Ψ
RBe respectively carrier longitude and latitude and the course angle that is obtained by reckoning 14, Ψ is the current course angle of vehicle, U, U
0, K is respectively current gyroscope output voltage, total null voltage and calibration factor, , λ are represented latitude and the longitude that vehicle is current respectively, v is the current travelling speed of vehicle, Re is a reference ellipsoid equatorial plane radius, β
k, β
vBe the inverse correlation time constant, W
K-1Be that K-1 r constantly maintains system noise, V
kIt is K m dimension measurement noise constantly.
In GPS filter module 12, when gps data satisfies filtering condition, position that reckoning 14 is obtained and course information adopt with position that is obtained by GPS 16 and course information concentrates kalman filter method to carry out combined filter, and filter value is outputed to optimum fusion submodule 132 in the senior filter module 13 as one of data source of data fusion.Result after the initial value of filtering next time iteration is merged by senior filter module 13 obtains through feedback.The state equation of this wave filter and measurement equation are:
Wherein
Wherein, δ
, δ
λ, δ
Ψ, δ
k, δ
vBe respectively latitude error, longitude error, course error, gyro calibration factor sum of errors gyro zero error partially,
G, λ
G, Ψ
GBe respectively carrier longitude and latitude and the course angle that obtains by GPS 16,
R, λ
R, Ψ
RBe respectively carrier longitude and latitude and the course angle that obtains by reckoning 14, Φ
K, k-1, Γ, H definition and electronic chart filter module 11 in identical.
Should be understood that inventive point of the present invention is that mainly according to federal Kalman filter principle, innovatively with GPS, reckoning and electronic map information make up by the mode of federal filtering, to effectively reduce the error of vehicle GPS navigation.Wherein Kalman filtering is a kind of minimum variance estimate in the optimal estimation theory that proposes nineteen sixty, estimates desired signal by algorithm from the measured value relevant with being extracted signal.
The foregoing description provides to those of ordinary skills and realizes or use of the present invention; those of ordinary skills can be under the situation that does not break away from invention thought of the present invention; the foregoing description is made various modifications or variation; thereby protection scope of the present invention do not limit by the foregoing description, and should be the maximum magnitude that meets the inventive features that claims mention.
Claims (5)
1 one kinds of systems that effectively reduce the vehicle GPS navigation error is characterized in that, described system comprises:
The electronic chart filter module, position that when map datum satisfies filtering condition reckoning is obtained and course information adopt with position that is obtained by map match and course information concentrates kalman filter method to carry out combined filter, and the filter value time that outputs to upgraded and data fusion module as one of data source of data fusion, and the initial value of next filtering iteration is obtained by the fusion results feedback;
The GPS filter module, position that when gps data satisfies filtering condition reckoning is obtained and course information adopt with position that is obtained by GPS and course information concentrates kalman filter method to carry out combined filter, and the filter value time that outputs to upgraded and data fusion module as one of data source of data fusion, and the initial value of next iteration is obtained by the fusion results feedback;
Time upgrades and data fusion module, the filter value time of carrying out that described electronic chart filter module and GPS filter module are sent upgrades and the processing of data fusion, and the result of data fusion is fed back to described electronic chart filter module and GPS filter module.
2 systems that effectively reduce the vehicle GPS navigation error according to claim 1 is characterized in that in the described electronic chart filter module, the state equation of this wave filter and measurement equation are
Wherein
In the above-mentioned formula, δ
, δ
λ, δ
Ψ, δ
k, δ
vBe respectively latitude error, longitude error, course error, gyro calibration factor sum of errors gyro zero error partially,
M, λ
M, Ψ
MBe respectively carrier longitude and latitude and the course angle that obtains by map,
R, λ
R, Ψ
RBe respectively carrier longitude and latitude and the course angle that is obtained by reckoning, Ψ is the current course angle of vehicle, U, U
0, k is respectively current gyroscope output voltage, total null voltage and calibration factor, , λ are represented latitude and the longitude that vehicle is current respectively, v is the current travelling speed of vehicle, Re is a reference ellipsoid equatorial plane radius, β
k, β
vBe the inverse correlation time constant, W
K-1Be that k-1 r constantly maintains system noise, V
kIt is k m dimension measurement noise constantly.
3 systems that effectively reduce the vehicle GPS navigation error according to claim 2 is characterized in that, in the described GPS filter module, the state equation of this wave filter and measurement equation are:
Wherein
In the above-mentioned formula,
G, λ
G, Ψ
GBe respectively carrier longitude and latitude and the course angle that obtains by GPS.
4 systems that effectively reduce the vehicle GPS navigation error according to claim 3 is characterized in that, in described time renewal and the data fusion module, the equation that the described time upgrades is:
In the formula
P
G, k-1Be respectively the state estimation and the estimation variance matrix of senior filter,
P
G, k/k-1Be respectively the status predication value and the predicated error variance matrix of senior filter;
The data fusion equation of global optimum is:
P in the formula
G, k, P
M, kBe respectively the state error variance battle array of GPS wave filter and electronic chart wave filter,
Be respectively the state estimation of GPS wave filter and electronic chart wave filter, Φ is the transition matrix of system's current time, and Q is the covariance matrix of current time system noise W.
5 systems that effectively reduce the vehicle GPS navigation error according to claim 1 is characterized in that, described system makes up GPS, reckoning and the electronic map information mode by federal filtering according to federal Kalman filter principle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 200610027128 CN101082496A (en) | 2006-05-31 | 2006-05-31 | System capable of effectively decreasing vehicle GPS navigation error |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 200610027128 CN101082496A (en) | 2006-05-31 | 2006-05-31 | System capable of effectively decreasing vehicle GPS navigation error |
Publications (1)
Publication Number | Publication Date |
---|---|
CN101082496A true CN101082496A (en) | 2007-12-05 |
Family
ID=38912184
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 200610027128 Pending CN101082496A (en) | 2006-05-31 | 2006-05-31 | System capable of effectively decreasing vehicle GPS navigation error |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101082496A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102254431A (en) * | 2011-06-14 | 2011-11-23 | 上海雷腾软件有限公司 | Vehicle position data acquiring and processing method and system |
CN105912019A (en) * | 2016-04-29 | 2016-08-31 | 南开大学 | Powered parafoil system's air-drop wind field identification method |
CN107024216A (en) * | 2017-03-14 | 2017-08-08 | 重庆邮电大学 | Introduce the intelligent vehicle fusion alignment system and method for panoramic map |
CN109031373A (en) * | 2018-06-08 | 2018-12-18 | 北京航天光华电子技术有限公司 | A kind of Intelligent Mobile Robot navigation system and method |
CN111949030A (en) * | 2020-08-17 | 2020-11-17 | 江苏常发农业装备股份有限公司 | Agricultural machinery positioning method, agricultural machinery vehicle and storage medium |
-
2006
- 2006-05-31 CN CN 200610027128 patent/CN101082496A/en active Pending
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102254431A (en) * | 2011-06-14 | 2011-11-23 | 上海雷腾软件有限公司 | Vehicle position data acquiring and processing method and system |
CN102254431B (en) * | 2011-06-14 | 2014-05-21 | 上海雷腾软件有限公司 | Vehicle position data acquiring and processing method and system |
CN105912019A (en) * | 2016-04-29 | 2016-08-31 | 南开大学 | Powered parafoil system's air-drop wind field identification method |
CN107024216A (en) * | 2017-03-14 | 2017-08-08 | 重庆邮电大学 | Introduce the intelligent vehicle fusion alignment system and method for panoramic map |
CN109031373A (en) * | 2018-06-08 | 2018-12-18 | 北京航天光华电子技术有限公司 | A kind of Intelligent Mobile Robot navigation system and method |
CN111949030A (en) * | 2020-08-17 | 2020-11-17 | 江苏常发农业装备股份有限公司 | Agricultural machinery positioning method, agricultural machinery vehicle and storage medium |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7831389B2 (en) | Map evaluation system and map evaluation method | |
US9921065B2 (en) | Unit and method for improving positioning accuracy | |
US6381536B1 (en) | Apparatus for generating road information from stored digital map database | |
US7751973B2 (en) | Curve warning system | |
US20160061627A1 (en) | Sensor offset calibration using map information | |
Bevly et al. | The use of GPS based velocity measurements for measurement of sideslip and wheel slip | |
US6502033B1 (en) | Turn detection algorithm for vehicle positioning | |
US20150291176A1 (en) | Apparatus and method of estimating road slope by using gravitational acceleration sensor | |
Melendez-Pastor et al. | A data fusion system of GNSS data and on-vehicle sensors data for improving car positioning precision in urban environments | |
US20100076681A1 (en) | Dead reckoning system | |
JPH0694472A (en) | Vehicle-position determining device and vehicle having device thereof | |
WO2011156706A1 (en) | Gps location refinement method in environments with low satellite visibility | |
JP2014235510A (en) | Traveling path information generation device | |
CN102914785A (en) | Vehicle navigation on the basis of satellite positioning data and vehicle sensor data | |
CN109696177B (en) | Device for compensating gyro sensing value, system having the same and method thereof | |
EP3499187B1 (en) | Method and apparatus for determining object position | |
CN110006421B (en) | Vehicle-mounted navigation method and system based on MEMS and GPS | |
CN107247275A (en) | City GNSS fragility monitoring system and its method based on bus | |
CN101082496A (en) | System capable of effectively decreasing vehicle GPS navigation error | |
JP6248559B2 (en) | Vehicle trajectory calculation device | |
JP2015094690A (en) | Vehicle travelling track calculation device | |
WO2000050917A1 (en) | Vehicle navigation system with correction for selective availability | |
CN106646569A (en) | Navigation and positioning method and device | |
CN113074757B (en) | Calibration method for vehicle-mounted inertial navigation installation error angle | |
CN109059913A (en) | A kind of zero-lag integrated navigation initial method for onboard navigation system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |