Navigation system furnished with means for estimating error of mounted sensor

Claim 2

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.

Claim 3

The navigation system of claim 1 further comprising: 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.

Claim 4

The navigation system of claim 2 wherein the traveling azimuth calculation means includes a Kalman filter using at least the traveling azimuth of the mobile object as a state variable to-be-estimated.

Claim 5

The navigation system of claim 3 wherein the mobile object includes a magnetic material in at least one of a plurality of constituent members, the azimuth measurement means includes a geomagnetism sensor attached to a predetermined position of the mobile object for measuring a geomagnetic field, and the azimuth error estimation means estimates a magnitude of at least one of a magnetization effect and a (Mu) effect, each being an error parameter included in a predetermined model equation for simulating output of the geomagnetism sensor.

Claim 6

The navigation system of claim 2 further comprising: velocity measurement means for measuring a velocity of the mobile object; and first position calculation means for calculating a current position of the mobile object from the output of the velocity measurement means, and the traveling azimuth obtained by the traveling azimuth calculation means.

Claim 7

A navigation system for providing a current position and a traveling azimuth of a mobile object, comprising: a directional antenna for receiving a radio wave signal from a transmitting station; and antenna attitude control means for controlling an attitude of the antenna so as to cancel any change in a relative positional relationship between the transmitting station and the antenna arising from movement of the mobile object, in accordance with the position and traveling azimuth of the mobile object, so that the antenna can always receive the radio wave signal in spite of the movement of the mobile object, wherein the current position and traveling azimuth of the mobile object are obtained by a system of claim 1.

Claim 8

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.

Claim 9

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.

Claim 10

The navigation system of claim 7 wherein the second position calculation 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.

Claim 11

A navigation system for providing a current position and a traveling azimuth of a mobile object, comprising: a directional antenna for receiving a radio wave signal from a transmitting station; and antenna attitude control means for controlling an attitude of the antenna so as to cancel any change in a relative positional relationship between the transmitting station and the antenna arising from movement of the mobile object, in accordance with the position and traveling azimuth of the mobile object, so that the antenna can always receive the radio wave signal in spite of the movement of the mobile object, wherein the current position and traveling azimuth of the mobile object are obtained by a system of claim 7.