Navigation system furnished with means for estimating error of mounted sensor
First Claim
1. A navigation system comprising at least a GPS sensor, turning angular velocity measurement means and azimuth measurement means for measuring a traveling azimuth of a mobile object, wherein said azimuth measurement means calculate the traveling azimuth from one of a vector velocity and a plurality of positions measured by the GPS sensor, the navigation system further comprising:
- turning angular velocity error estimation means for estimating an error of the turning angular velocity measurement means by using output from the turning angular velocity measurement means and the azimuth measurement means; and
traveling azimuth calculation means for correcting a measured value of the turning angular velocity measurement means by using output of the turning angular velocity error estimation means, and calculating the traveling azimuth of the mobile object from the corrected measured value and the output from the azimuth measurement means,wherein the turning angular velocity error estimation means includes a Kalman filter wherein at least one of state variables to-be-estimated is an error parameter included in a predetermined model equation for simulating output of the turning angular velocity measurement means.
2 Assignments
0 Petitions
Accused Products
Abstract
A navigation system which can enhance the position determining accuracy of a mobile object without employing any high precision measuring instrument. The navigation system comprises a GPS range measuring device, an angular velocity measuring device, a velocity measuring device and an azimuth measuring device, which measure the motion of the mobile object; a GPS range error estimating device, an angular velocity error estimating device, a velocity error estimating device and an azimuth error estimating device, which estimate errors involved in the respectively corresponding measuring devices; and a position calculating device which calculates the position of the mobile object from the outputs of the error estimating devices. The error estimating devices are implemented by Kalman filters and averaging processes. The factors of the errors of the individual measuring devices are assumed, and the outputs thereof are corrected, so that the position of the mobile object can always be determined at a high accuracy without employing any high precision sensor.
-
Citations
9 Claims
-
1. A navigation system comprising at least a GPS sensor, turning angular velocity measurement means and azimuth measurement means for measuring a traveling azimuth of a mobile object, wherein said azimuth measurement means calculate the traveling azimuth from one of a vector velocity and a plurality of positions measured by the GPS sensor, the navigation system further comprising:
-
turning angular velocity error estimation means for estimating an error of the turning angular velocity measurement means by using output from the turning angular velocity measurement means and the azimuth measurement means; and traveling azimuth calculation means for correcting a measured value of the turning angular velocity measurement means by using output of the turning angular velocity error estimation means, and calculating the traveling azimuth of the mobile object from the corrected measured value and the output from the azimuth measurement means, wherein the turning angular velocity error estimation means includes a Kalman filter wherein at least one of state variables to-be-estimated is an error parameter included in a predetermined model equation for simulating output of the turning angular velocity measurement means. - View Dependent Claims (2, 3, 4, 5, 6)
-
-
7. A navigation system comprising at least a GPS sensor, turning angular velocity measurement means and azimuth measurement means for measuring a traveling azimuth of a mobile object, wherein said azimuth measurement means calculate the traveling azimuth from one of a vector velocity and a plurality of positions measured by the GPS sensor, the navigation system further comprising:
-
turning angular velocity error estimation means for estimating an error of the turning angular velocity measurement means by using output from the turning angular velocity measurement means and the azimuth measurement means; wherein the turning angular velocity error estimation means includes a Kalman filter wherein at least one of state variables to-be-estimated is an error parameter included in a predetermined model equation for simulating output of the azimuth measurement means; azimuth error estimation means for estimating an error of the azimuth measurement means by using the output from the turning angular velocity measurement means and the azimuth measurement means, the traveling azimuth calculation means correcting a measured value of the azimuth measurement means by using output of the azimuth error estimation means, besides correcting the measured value of the turning angular velocity measurement means by using the output of the turning angular velocity error estimation means, and calculating the traveling azimuth of the mobile object from corrected measured values, wherein the azimuth error estimation means includes a Kalman filter wherein at least one of state variables to-be-estimated is an error parameter included in a predetermined model equation for simulating output of the azimuth measurement means; velocity measurement means for measuring a velocity of the mobile object; first position calculation means for calculating a current position of the mobile object from the output of the velocity measurement means, and a traveling azimuth obtained by a traveling azimuth calculation means; range measurement means for receiving a radio wave signal containing predetermined information sent from a transmitting station, and measuring at least one of a distance from the transmitting station to the mobile object and a change rate of the distance; second position calculation means for calculating the current position of the mobile object by using output from the range measurement means, the traveling azimuth calculation means and the velocity measurement means; signal changeover means for receiving the output of the traveling azimuth calculation means and the velocity measurement means, delivering both output to the first position calculation means on condition that the radio wave signal cannot be received, and delivering both output to the second position calculation means on condition that the radio wave signal can be received, wherein the second position calculation means includes an error estimation portion for estimating an error of at least one of the range measurement means and the velocity measurement means. - View Dependent Claims (8, 9)
-
Specification