Apparatus for correcting the detected heading of a vehicle

• US 5,469,158 A
• Filed: 06/21/1994
• Issued: 11/21/1995
• Est. Priority Date: 04/20/1992
• Status: Expired due to Fees

• Current Assignee: Sumitomo Electric Industries Limited (Sumitomo Corporation)
• Original Assignee: Sumitomo Electric Industries Limited (Sumitomo Corporation)
• Inventors: Morita, Kazuya
• Primary Examiner(s): Williams, Hezron E.
• Assistant Examiner(s): Oda, Christine K.
• Application Number:
  US08/263,417
• Time in Patent Office: 518 Days
• Field of Search: 340/988, 340/990, 340/995, 364/460
• US Class Current: 340/988
• CPC Class Codes: G01C 21/28 with correlation of data from several navigational instruments
• CPC Class Codes: G01S 19/47 the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
• CPC Class Codes: G01S 19/53 Determining attitude
• CPC Class Codes: G01S 5/12 by co-ordinating position lines of different shape, e.g. hyperbolic, circular, elliptical or radial

Abstract

A vehicle heading correcting apparatus comprising a gyro, an integrating unit for integrating output data of the gyro, a global positioning system receiver, an acquisition unit for acquiring heading data of a vehicle supplied from the global positioning system receiver, a first computing unit for computing a first turning angle of the vehicle based on two consecutive data of the heading data acquired by the acquisition unit, a second computing unit for computing a second turning angle of the vehicle based on an integrated value of the output data of the gyro obtained by the integrating unit during a period of time that the two consecutive data are acquired, an offset computing unit for computing a difference between the first and second turning angles and for computing an offset value of the output data of the gyro by diving the difference by the period of time, and an offset correcting unit for correcting the output data of the gyro with the offset value calculated by the offset computing unit.

Claims

1. A vehicle heading correcting apparatus comprising:

a gyro,

integrating means for integrating output data of said gyro;

a global positioning system receiver for receiving waves from a plurality of satellites revolving around the earth to measure Doppler shift which occurs by receiving waves during travel of a vehicle, and for outputting heading data of the vehicle;

acquisition means for acquiring said heading data of said vehicle supplied from said global positioning system receiver;

first computing means for computing a first turning angle of said vehicle based on two consecutive data of said heading data acquired by said acquisition means;

second computing means for computing a second turning angle of said vehicle based on an integrated value of said output data of said gyro obtained by said integrating means during a period of time that said two consecutive data are acquired;

offset computing means for computing a difference between said first and second turning angles and for computing an offset value of said output data of said gyro by dividing said difference by said period of time; and

offset correcting means for correcting said output data of said gyro with said offset value calculated by said offset computing means.

2. A vehicle location detecting apparatus comprising:

sensor means for sensing distances traveled by a vehicle;

a gyro;

integrating means for integrating output data of said gyro;

a global positioning system receiver for receiving waves from a plurality of satellites revolving around the earth to measure Doppler shift which occurs by receiving waves during the travel of said vehicle, and for outputting heading data of said vehicle;

acquisition means for acquiring said heading data of said vehicle supplied from said global positioning system receiver;

first computing means for computing a first turning angle of said vehicle based on two consecutive data of said heading data acquired by said acquisition means;

second computing means for computing a second turning angle of said vehicle based on an integrated value of said output data of said gyro obtained by said integrating means during a period of time that said two consecutive data are acquired;

offset computing means for computing a difference between said first and second turning angles and for computing an offset value of said output data of said gyro by dividing said difference by said period of time;

offset correcting means for correcting said output data of said gyro with said offset value calculated by said offset computing means; and

location detecting means connected to said sensor means, said global positioning system receiver and said gyro, said location detecting means detecting a current location of said vehicle based on the corrected output data of said gyro and on said distances obtained from said sensor means.

3. The vehicle location detecting apparatus as set forth in claim 2, which further comprises a buffer memory connected to said location detecting means, a navigation controller connected to said location detecting means, a road map memory connected to said navigation controller, a display connected to said navigation controller, and a keyboard connected to said navigation controller.

4. A heading detecting apparatus comprising:

a global positioning system receiver for receiving waves from a plurality of satellites revolving around the earth to measure Doppler shift which occurs by receiving waves during travel of a vehicle, and for outputting first heading data of the vehicle;

a gyro for outputting angular velocity data of said vehicle;

deriving means for deriving second heading data dependent upon said angular velocity data;

first means connected to said gyro for calculating an error of an offset value that is contained in said angular velocity data of said gyro;

second means connected to said first means for calculating an error that is contained in said angular velocity data of said gyro, on the basis of said error of said offset value calculated by said first means, a change rate of time of said error of said offset value multiplied by a predetermined time, and said angular velocity data of said gyro multiplied by an error of scale factor of said gyro;

third means connected to said global positioning system receiver for calculating an error that is contained in said first heading data of said global positioning system receiver and depends on at least a velocity of said vehicle;

fourth means connected to said second means and said third means for calculating a variance of said angular velocity data based on said error of said angular velocity data of said gyro calculated by said second means and variance of said first heading data based on said error calculated by said third means and calculating a Kalman filter gain which is used for weighting said second heading data and said first heading data according to said variance of said angular velocity data and said variance of said first heading data; and

fifth means connected to said fourth means for calculating a current estimated heading of said vehicle by the following equation;

space="preserve" listing-type="equation">θ

(t)=k(t)o(t)+{((1-k(t)}{θ

(t-1)+w(t)}

where θ

(t) is said current estimated heading,

k(t) is said Kalman filter gain variable of 0<

k(t)<

1,

o(t) is said first heading data,

θ

(t-1) is a previously estimated heading, and

w(t) is said second heading data.

5. A location detecting apparatus comprising:

sensor means for sensing distance traveled by a vehicle,

a global positioning system receiver for receiving waves from a plurality of satellites revolving around the earth to measure Doppler shift which occurs by receiving waves during the travel of said vehicle, and for outputting first heading data of said vehicle,

a gyro for outputting angular velocity data of said vehicle;

deriving means for deriving second heading data dependent upon said angular velocity data;

first means connected to said gyro for calculating an error of an offset value that is contained in said angular velocity data of said gyro,

second means connected to said first means for calculating an error that is contained in said angular velocity data of said gyro, on the basis of said error of said offset value calculated by said first means, a change rate of time of said error of said offset value multiplied by a predetermined time, and said angular velocity data of said gyro multiplied by an error of a scale factor of said gyro;

third means connected to said global positioning system receiver for calculating an error that is contained in said first heading data of said global positioning system receiver and depends on at least a velocity of said vehicle;

fourth means connected to said second means and said third means for calculating a variance of said angular velocity data based on said error of said angular velocity data of said gyro calculated by said second means and a variance of said first heading data based on said error calculated by said third means and calculating a Kalman filter gain which is used for weighting said second heading data and said first heading data according to said variance of said angular velocity data and said first variance of said first heading data;

fifth means connected to said fourth means for calculating a current estimated heading of said vehicle by the following equation;

space="preserve" listing-type="equation">θ

(t)=k(t)o(t)+{(1-k(t)}{θ

(t-1)+w(t)}

where θ

(t) is said current estimated heading;

k(t) is said Kalman filter gain variable of 0<

k(t)<

1,

o(t) is said first heading data,

θ

(t-1) is a previously estimated heading, and

w(t) is said second heading data, and

location detecting means connected to said sensor means, said global positioning system receiver and said gyro, said location detecting means detecting a current location of said vehicle based on said current estimated heading calculated by said fifth means and on said distances obtained from said sensor means.

6. The vehicle location detecting apparatus as set forth in claim 5, which further comprises a data memory connected to said location detecting means, a navigation controller connected to said location detecting means, a road map memory connected to said navigation controller, a display connected to said navigation controller, and a keyboard connected to said navigation controller.