Method of correcting magnetization vector

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.sub.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.sub.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 .SIGMA. (.sigma..sub.x, .sigma..sub.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 .sigma..sub.x and .sigma..sub.y is not less than a constant k;
• if at least one of the components .sigma..sub.x and .sigma..sub.y is equal to or greater than the constant k, determining the corrected magnetization vector M.sub.n according to the equation M.sub.n =M.sub.n-1 +.SIGMA.;
• and
• if the components .sigma..sub.x and .sigma..sub.y are both smaller than the constant k, calculating an instantaneous direction vector R.sub.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 .THETA..sub.mn according to the equation R.sub.n =S.sub.n -M.sub.n-1 ;
• calculating an average geomagnetic intensity r.sub.on from the average of past values of the magnitude r.sub.n of the instantaneous direction vector R.sub.n, and a weighing coefficient h.sub.n that is a positive real number of or less than 1 based on the average geomagnetic intensity r.sub.on ;
• calculating a substantially instantaneous magnetization vector H.sub.n for correcting the magnetization vector M.sub.n-1 according to the equation:
• H.sub.n =S.sub.n -r.sub.on .multidot.exp (j.THETA..sub.mn);
• determining the corrected magnetization vector M.sub.n from the magnetization vector M.sub.n-1, the weighing coefficient h.sub.n, and the substantially instantaneous magnetization vector H.sub.n according to the equation:
• M.sub.n =(1-h.sub.n).multidot.M.sub.n-1 =h.sub.n .multidot.H.sub.n and
• correcting said magnetization vector detector output in accordance with said corrected magnetization vector.

A stand alone navigation system for a mobile body comprising:

• a magnetization vector detector for detecting a magnetization vector M.sub.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.sub.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.sub.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 .THETA..sub.mn according to the equation R.sub.n =S.sub.n -M.sub.n-1 ;
• means for calculating an average geomagnetic intensity r.sub.on from the average of past values of the magnitude r.sub.n of the instantaneous direction vector R.sub.n, and a weighing coefficient h.sub.n that is a positive real number no greater than 1 based on the average geomagnetic intensity r.sub.on ;
• means for calculating a substantially instantaneous magnetization vector H.sub.n for correcting the magnetization vector M.sub.n-1 according to the equation:
• H.sub.n =S.sub.n -r.sub.on .multidot.exp(j.THETA..sub.mn);
• means for determining a corrected magnetization vector M.sub.n from the magnetization vector M.sub.n-1, the weighing coefficient h.sub.n, and the substantially instantaneous magnetization vector H.sub.n according to the equation:
• M.sub.n =(1-h.sub.n).multidot.M.sub.n-1 +h.sub.n .multidot.H.sub.n and
• means for correcting the output of said magnetization vector detector in accordance with said corrected magnetization vector.

A stand alone navigation system of a mobile body comprising:

• a magnetization vector detector for detecting a magnetization vector M.sub.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.sub.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 .SIGMA.(.sigma..sub.x, .sigma..sub.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 .sigma..sub.x and .sigma..sub.y is not less than a constant k;
• means for calculating a corrected magnetization vector M.sub.n according to the equation M.sub.n =M.sub.n-1 +.SIGMA. where said determining means determines that the constant k is less than at least one of .sigma..sub.x and .sigma..sub.y and
• means for correcting the output of said magnetization vector detector in accordance with said corrected magnetization vector.