Direction sensor having an earth magnetism sensor and a rate gyro sensor and navigation system having this direction sensor

• US 5,297,050 A
• Filed: 11/06/1991
• Issued: 03/22/1994
• Est. Priority Date: 11/06/1990
• Status: Expired due to Term

• Current Assignee: Fujitsu Ten Limited (DENSO Corporation)
• Original Assignee: Fujitsu Ten Limited (DENSO Corporation)
• Inventors: Nakatani, Yasuhiro, Ichimura, Atsushi
• Primary Examiner(s): Black, Thomas G.
• Assistant Examiner(s): NGUYEN, TAN QUANG
• Application Number:
  US07/788,456
• Time in Patent Office: 867 Days
• Field of Search: 364/449, 364/444, 364/443, 340/995, 340/989, 340/990, 33/361
• US Class Current: 701/208
• CPC Class Codes: B60T 2250/062 loosing zero-point calibration of yaw rate sensors when travelling on banked roads or in case of temperature variations
• CPC Class Codes: G01C 21/28 with correlation of data from several navigational instruments

Abstract

The present invention involves a direction sensor and a navigation system containing the direction sensor. The direction sensor has an earth magnetism sensor and a rate gyro sensor that calculates a compensated direction by weighted means process of the outputs from the earth magnetism sensor and the rate gyro sensor. The compensated direction has a high detection accuracy similar to the rate gyro sensor over a short time period, but does not have an error accumulation of the rate gyro sensor during a long time interval because the rate gyro sensor is substantially calibrated with the accurate direction obtained by the averaging outputs of the earth magnetism sensor. The navigation system has distribution information of the magnetic disturbances to the earth magnetism on a map and it reduces the weighted mean ration to the earth magnetism sensor when the magnetic disturbance at the locating position is large. The accuracy of the compensated direction is further improved by excluding inaccurate outputs of the earth magnetism sensor.

Claims

1. A driving direction sensor of a vehicle outputting a compensated direction, comprising:

an earth magnetism sensor detecting a forward angle, forming the detected forward angle relative to magnetic north of earth, and outputting a first driving direction calculated from said detected forward angle;

a rate gyro sensor, detecting a rotating speed, forming the detected rotating speed, calculating a rotated angle from the detected rotating speed, and outputting a second driving direction, obtained by adding said rotated angle to a reference direction; and

direction compensating means for calculating the compensated direction, using a weighted mean process of said first driving direction from said earth magnetism sensor and said second driving direction from said rate gyro sensor, and for setting said compensated direction to said reference direction of said rate gyro sensor, wherein;

said vehicle travels for a driving time, and

said weighted mean process includes a weighted mean ratio that changes according to the driving time of said vehicle.

2. A driving direction sensor of a vehicle outputting a compensated direction, comprising:

an earth magnetism sensor detecting a forward angle, forming the detected forward angle relative to magnetic north of earth, and outputting a first driving direction calculated from said detected forward angle;

a rate gyro sensor, detecting a rotating speed, forming the detected rotating speed, calculating a rotated angle from the detected rotating speed, and outputting a second driving direction obtained by adding said rotated angle to a reference direction; and

direction compensating means for calculating the compensated direction using a weighted mean process of said first driving direction from said earth magnetism sensor and said second driving direction from said rate gyro sensor, and for setting said compensated direction to said reference direction of said rate gyro sensor, wherein;

a weighted mean ratio of said weighted mean process changes according to one of temperature of said rate gyro sensor and environment temperature.

3. A navigation system of a vehicle providing a locating position on a map, comprising:

an earth magnetism sensor detecting a forward angle, forming the detected forward angle relative to magnetic north of earth, and outputting a first driving direction calculated from said detected forward angle;

a rate gyro sensor, detecting a rotating speed, forming the detected rotating speed, calculating a rotated angle from the detected rotating speed, and outputting a second driving direction, obtained by adding said rotated angle to a reference direction;

direction compensating means for calculating a compensated direction, using a calculating process receiving said first driving direction and said second driving direction;

a driving distance sensor detecting a driving distance;

map storing means for storing map information;

locating position calculating means for calculating the locating position on said road map using said compensated direction received from said direction compensating means, said driving distance received from said driving distance sensor and said map information received from said map storing means;

disturbance data storing means for storing distribution information indicating a magnetic disturbance having an intensity to an earth magnetism in a form corresponding to said map; and

ratio changing means for detecting the intensity of the magnetic disturbance at said locating position received from said disturbance data storing means, and for ratio changing the calculating process used for calculating said compensated direction.

4. A navigation system as set forth in claim 3, wherein:

said direction compensating means calculates the compensated direction, using a weighted mean process of said earth magnetism sensor and said rate gyro sensor, and for setting said compensated direction to said reference direction of said rate gyro sensor; and

said ratio changing means changes a weighted mean ratio of said weighted mean process.

5. A navigation system as set forth in claim 4, wherein:

said disturbance data storing means locates the locating position of specific facilities having respective influence ranges and disturbances to the earth magnetism of said specific facilities, each of the disturbances of said specific facilities to the earth magnetism being more than a predetermined level; and

said ratio changing means comprises a distance calculating means for calculating distances between said specific facilities and said locating position, and changes said weighted means ratio irrespective of whether or not said location position is within said influence range.

6. A navigation system as set forth in claim 5, wherein said ratio changing means changes said weighted mean ratio of said first driving direction to zero, when said locating position is within said disturbance range.

7. A navigation system as set forth in claim 5, wherein said ratio changing means changes said weighted mean ratio between zero and one.