Method of correcting magnetization vector

• US 5,349,529 A
• Filed: 06/22/1992
• Issued: 09/20/1994
• Est. Priority Date: 06/25/1991
• Status: Expired due to Fees

• Current Assignee: Pioneer Electronic Corporation (Pioneer Corporation)
• Original Assignee: Pioneer Electronic Corporation (Pioneer Corporation)
• Inventors: Masumoto, Yutaka, Odagawa, Satoshi
• Primary Examiner(s): Black, Thomas G.
• Assistant Examiner(s): DAY, JULIE
• Application Number:
  US07/901,921
• Time in Patent Office: 820 Days
• Field of Search: 364/571.01, 364/559, 364/424.01, 33/355 R, 33/356, 33/357, 33/358
• US Class Current: 702/85
• CPC Class Codes: G01C 17/38 Testing, calibrating, or compensating of compasses

Abstract

When the body of an automobile equipped with a stand-alone navigation system is magnetized by an external magnetism, an unknown magnetization vector is determined by correcting the known magnetization vector. Even very small changes in the magnetization vector can be corrected without putting a burden on the user of the automobile. A magnetization vector directed from a reference position toward the center of a magnetic circle which indicates the magnetized condition of the automobile body is detected, and a geomagnetic vector which is directed from the reference position in the direction in which the mobile body progresses is detected. An instantaneous direction vector which is directed from the center of the magnetic circle in the direction in which the mobile body progresses and which has a direction angle is calculated. Then, an average geomagnetic intensity is calculated from the average of past values of the magnitude of the instantaneous direction vector, and a weighting coefficient that is a positive real number of or less than 1 is calculated based on the average geomagnetic intensity. A substantially instantaneous magnetization vector for correcting the magnetization vector is calculated. Thereafter, a corrected magnetization vector is calculated from the magnetization vector, the weighting coefficient, and the substantially instantaneous magnetization vector.

Claims

1. A method of correcting the output of a magnetization vector detector of a stand alone navigation system of a mobile body, said mobile body having said magnetization vector detector and a geomagnetic vector detector, said method comprising:

detecting a magnetization vector M_n-1 with said magnetization vector detector, said magnetization vector being directed from a reference position toward the center of a magnetic circle which indicates the magnetized condition of the mobile body;

determining the direction of progression of the mobile body and detecting a geomagnetic vector S_n which is directed from the reference position in the direction in which the mobile body progresses;

calculating an instantaneous direction vector R_n which is directed from the center of the magnetic circle in the direction in which the mobile body progresses and which has a direction angle Θ

_mn according to the equation R_n =S_n -M_n-1 ;

calculating an average geomagnetic intensity r_on from the average of past values of the magnitude r_n of the instantaneous direction vector R_n, and a weighing coefficient h_n that is a positive real number no greater than 1 based on the average geomagnetic intensity r_on ;

calculating a substantially instantaneous magnetization vector H_n for correcting the magnetization vector M_n-1 according to the equation;

H_n =S_n -r_on ·

exp(jΘ

_mn);

determining the corrected magnetization vector M_n from the magnetization vector M_n-1, the weighing coefficient h_n, and the substantially instantaneous magnetization vector H_n according to the equation;

M_n =(1-h_n)·

M_n-1 +h_n ·

H_n and

correcting an output of said magnetization vector detector in accordance with said determined corrected magnetization vector.

2. A method of correcting the output of a magnetization vector detector of a stand alone navigation system of a mobile body having said magnetization vector detector and a geomagnetic vector detector, said method comprising:

detecting with said magnetization vector detector a magnetization vector M_n-1 directed from a reference position toward the center of a magnetic circle which indicates the magnetized condition of the mobile body;

detecting with said geomagnetic vector detector a geomagnetic vector S_n which is directed from the reference position in the direction in which the mobile body progresses;

obtaining an output signal from an angular velocity sensor, and calculating a deviation vector Σ

(σ

_x, σ

_y) which indicates the deviation of the output signal of the angular velocity sensor from the geomagnetic vector;

determining if at least one of the components σ

_x and σ

_y is not less than a constant k;

if at least one of the components σ

_x and σ

_y is equal to or greater than the constant k, determining the corrected magnetization vector M_n according to the equation M_n =M_n-1 +Σ

; and

if the components σ

_x and σ

_y are both smaller than the constant k, calculating an instantaneous direction vector R_n which is directed from the center of the magnetic circle in the direction in which the mobile body progresses and which has a direction angle Θ

_mn according to the equation R_n =S_n -M_n-1 ;

calculating an average geomagnetic intensity r_on from the average of past values of the magnitude r_n of the instantaneous direction vector R_n, and a weighing coefficient h_n that is a positive real number of or less than 1 based on the average geomagnetic intensity r_on ;

calculating a substantially instantaneous magnetization vector H_n for correcting the magnetization vector M_n-1 according to the equation;

H_n =S_n -r_on ·

exp (jΘ

_mn);

determining the corrected magnetization vector M_n from the magnetization vector M_n-1, the weighing coefficient h_n, and the substantially instantaneous magnetization vector H_n according to the equation;

M_n =(1-h_n)·

M_n-1 =h_n ·

H_n and

correcting said magnetization vector detector output in accordance with said corrected magnetization vector.

3. A stand alone navigation system for a mobile body comprising:

a magnetization vector detector for detecting a magnetization vector M_n-1 directed from a reference position toward the center of a magnetic circle which indicates a magnetized condition of the mobile body;

means for detecting a geomagnetic vector S_n which is directed from the reference position in a direction in which the mobile body progresses;

means for calculating an instantaneous direction vector R_n which is directed from the center of the magnetic circle in the direction in which the mobile body progresses and which has a direction angle Θ

_mn according to the equation R_n =S_n -M_n-1 ;

means for calculating an average geomagnetic intensity r_on from the average of past values of the magnitude r_n of the instantaneous direction vector R_n, and a weighing coefficient h_n that is a positive real number no greater than 1 based on the average geomagnetic intensity r_on ;

means for calculating a substantially instantaneous magnetization vector H_n for correcting the magnetization vector M_n-1 according to the equation;

H_n =S_n -r_on ·

exp(jΘ

_mn);

means for determining a corrected magnetization vector M_n from the magnetization vector M_n-1, the weighing coefficient h_n, and the substantially instantaneous magnetization vector H_n according to the equation;

M_n =(1-h_n)·

M_n-1 +h_n ·

H_n and

means for correcting the output of said magnetization vector detector in accordance with said corrected magnetization vector.

4. A stand alone navigation system of a mobile body comprising:

a magnetization vector detector for detecting a magnetization vector M_n-1 directed from a reference position toward the center of a magnetic circle which indicates a magnetized condition of the mobile body;

means for detecting a geomagnetic vector S_n which is directed from the reference position in the direction in which the mobile body progresses;

an angular velocity sensor;

means for obtaining an output signal from said angular velocity sensor and calculating a deviation vector Σ

(σ

_x, σ

_y) which indicates the deviation of the output signal of the angular velocity sensor from the geomagnetic vector;

means for determining if at least one of the components σ

_x and σ

_y is not less than a constant k;

means for calculating a corrected magnetization vector M_n according to the equation M_n =M_n-1 +Σ

where said determining means determines that the constant k is less than at least one of σ

_x and σ

_y and

means for correcting the output of said magnetization vector detector in accordance with said corrected magnetization vector.

5. The navigation system in accordance with claim 4, wherein said calculating means further calculates:

an instantaneous vector R_n which is directed from the center of the magnetic circle in the direction in which the mobile body progresses and which has a direction angle Θ

_mn according to the equation R_n =S_n -M_n-1 ;

an average geometric intensity r_on from the average of past values of the magnitude r_n of the instantaneous direction vector R_n, and a weighting coefficient h_n that is a positive real number of or less than 1 based on the average geomagnetic intensity r_on ;

a substantially instantaneous magnetization vector H_n for correcting the magnetization vector M_n-1 according to the equation;

H_n =S_n -r_on ·

exp(jΘ

_mn); and

the corrected magnetization vector M_n from the magnetization vector M_n-1, the weighting coefficient h_n, and the substantially instantaneous magnetization vector H_n according to the equation;

M_n =(1-h_n)·

M_n-1 +h_n ·

H_n.