Azimuth detecting device and azimuth detecting method

• US 8,224,573 B2
• Filed: 10/01/2008
• Issued: 07/17/2012
• Est. Priority Date: 10/02/2007
• Status: Expired due to Fees

• Current Assignee: Toyota Jidosha Kabushiki Kaisha (Toyota Motor Corporation)
• Original Assignee: Toyota Jidosha Kabushiki Kaisha (Toyota Motor Corporation)
• Inventors: Maeda, Iwao, Nagamiya, Kiyomi, Shibata, Naoto, Ueda, Akihiro
• Primary Examiner(s): Joerger, Kaitlin
• Assistant Examiner(s): Suarez, Ernesto
• Application Number:
  US12/243,178
• Publication Number:
  US 20090088976A1
• Time in Patent Office: 1,385 Days
• Field of Search: 701/213, 701/216, 701/224, 701/468, 701/469, 701/508, 701/534, 701/472, 701/530
• US Class Current: 701/468
• CPC Class Codes: G01C 17/00 Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes using gyroscopic effect G01C19/00
• CPC Class Codes: G01S 19/45 by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement

Abstract

An azimuth detecting device mounted in a mobile object and having: a geomagnetic sensor; GPS signal receiving means; and measuring means for measuring a position of the mobile object by using a GPS signal, the azimuth detecting device being characterized in calculating a gain correction amount by means of a method of least squares, using an output value of the geomagnetic sensor when a level of the GPS signal received by the GPS signal receiving means is lower than a predetermined level, and calculating a declination correction amount and/or an inclination correction amount on the basis of information obtained from the GPS signal and correcting the output value of the geomagnetic sensor, when the level of the GPS signal is at least the predetermined level.

Claims

1. An azimuth detecting device mounted in a mobile object, comprising:

a satellite signal receiver;

a geomagnetic sensor; and

a computing unit configured to;

calculate a traveling azimuth of the mobile object on the basis of a radio wave received by the satellite signal receiver,

statistically calculate an unknown geomagnetic declination and/or an unknown geomagnetic inclination by using the calculated traveling azimuth and an output of the geomagnetic sensor on the basis of a relational expression representing a relationship between the traveling azimuth, the output of the geomagnetic sensor, and the geomagnetic declination and/or the geomagnetic inclination,

correct the output of the geomagnetic sensor by using the calculated geomagnetic declination and/or the calculated geomagnetic inclination, and

calculate an azimuth of the mobile object on the basis of the corrected output of the geomagnetic sensor.

2. The azimuth detecting device according to claim 1, wherein

the computing unit calculates the traveling azimuth of the mobile object on the basis of a Doppler frequency of the radio wave received by the satellite signal receiver when a speed of the mobile object is greater than a predetermined threshold value, a level of the received radio wave by the satellite signal receiver is at least a predetermined value, and a reliability of speed information is greater than a reliability of position information, and

the computing unit calculates the traveling azimuth of the mobile object on the basis of a difference between two positions of the mobile object that are measured at different times based on the radio wave received by the satellite signal receiver when the speed of the mobile object is greater than the predetermined threshold value, the level of the received radio wave by the satellite signal receiver is at least the predetermined value, and the reliability of the speed information is equal to or less than the reliability of the position information.

3. The azimuth detecting device according to claim 2, wherein

the output of the geomagnetic sensor is based on values that correspond to three axes of the geomagnetic sensor, and

the computing unit corrects the output of the geomagnetic sensor by calculating respective gains, offsets, and inclination angles and/or declination angles of the values that correspond to the three axes of the geomagnetic sensor by using a method of least squares based on an output value of the satellite signal receiver when the speed of the mobile object is greater than the predetermined threshold value, the level of the received radio wave by the satellite signal receiver is at least the predetermined value, and the reliability of the speed information is equal to or less than the reliability of the position information.

4. The azimuth detecting device according to claim 2, wherein

the output of the geomagnetic sensor is based on values that correspond to three axes of the geomagnetic sensor, and

the computing unit corrects the output of the geomagnetic sensor by calculating respective gains, offsets, and inclination angles and/or declination angles of the values that correspond to the three axes of the geomagnetic sensor by using a method of least squares based on an output value of the satellite signal receiver when the speed of the mobile object is greater than the predetermined threshold value, the level of the received radio wave by the satellite signal receiver is at least the predetermined value, and the reliability of the speed information is greater than the reliability of the position information.

5. An azimuth detecting method, comprising:

receiving an output value of a satellite signal receiver;

receiving an output value of a geomagnetic sensor;

calculating, via a computing unit, a traveling azimuth of a mobile object on the basis of a radio wave received by the satellite signal receiver;

calculating, via the computing unit, an unknown geomagnetic declination and/or an unknown geomagnetic inclination by using the calculated traveling azimuth and the output value of the geomagnetic sensor on the basis of a relational expression representing a relationship between the traveling azimuth, the output value of the geomagnetic sensor, and the geomagnetic declination and/or the geomagnetic inclination;

correcting, via the computing unit, the output value of the geomagnetic sensor by using the calculated geomagnetic declination and/or the calculated geomagnetic inclination; and

calculating, via the computing unit, an azimuth of the mobile object on the basis of the corrected output value of the geomagnetic sensor.