Calibration of magnetic compasses
First Claim
1. A magnetic compass for a vehicle in which the output of the compass is compensated by disturbance to the magnetic field caused by said vehicle, including:
- three magnetic sensors responsive to respective nominally orthogonal components of the disturbed magnetic field acting along respective nominally orthogonal body axes of the vehicle for producing signals corresponding to said components;
data storage means for accumulating data output by said sensors during a setting maneuver of the vehicle;
data processing means for processing data stored in said data storage means to fit a generalized reduced quadric equation having no more than six coefficients and defining an ellipsoid representing the locus of values of said signals and for determining said coefficients;
calibration means for deriving from said coefficients a calibration function for adjusting values output by said magnetic sensors so that said locus of adjusted values is a spheroid centered on the origin of the body axes; and
compensation means for receiving raw data from said magnetic sensors and for implementing said calibration function thereby to obtain signals corresponding to orthogonal components of the magnetic field in which said disturbance has been compensated,wherein said data processing means processes data stored in said data storage means to fit a generalized reduced quadric equation of the form;
space="preserve" listing-type="equation">ax.sup.2 +by.sup.2 +1/2(a+b)z.sup.2 +2hxy+2px+2qy+2sz-1=0where x, y and z are values representing the magnetic field in the x, y and z directions, and determine the coefficients a, b, h, p, q and s.
2 Assignments
0 Petitions
Accused Products
Abstract
Magnetic compasses may be affected by local disturbances in the magnetic field in their vicinity. These disturbances may be caused by the addition or removal of a metal article concerned with a vehicle in which the compass is mounted, and may also be due to local variations in the Earth'"'"'s magnetic field. The system described herein compensates for such disturbances in the magnetic field to maintain the accuracy of the magnetic compass by transforming an ellipsoidal locus to a spherical locus at a different orientation in space. For example, a one-shot algorithm is employed in which data collected during a setting maneuver of the vehicle is processed to fit a generalized reduced quadric equation having six or less coefficients rather than the nine calibration points required in the prior art for fitting a generalized quadric equation for an ellipsoid. The present invention thus significantly reduces the processing power required.
-
Citations
8 Claims
-
1. A magnetic compass for a vehicle in which the output of the compass is compensated by disturbance to the magnetic field caused by said vehicle, including:
-
three magnetic sensors responsive to respective nominally orthogonal components of the disturbed magnetic field acting along respective nominally orthogonal body axes of the vehicle for producing signals corresponding to said components; data storage means for accumulating data output by said sensors during a setting maneuver of the vehicle; data processing means for processing data stored in said data storage means to fit a generalized reduced quadric equation having no more than six coefficients and defining an ellipsoid representing the locus of values of said signals and for determining said coefficients; calibration means for deriving from said coefficients a calibration function for adjusting values output by said magnetic sensors so that said locus of adjusted values is a spheroid centered on the origin of the body axes; and compensation means for receiving raw data from said magnetic sensors and for implementing said calibration function thereby to obtain signals corresponding to orthogonal components of the magnetic field in which said disturbance has been compensated, wherein said data processing means processes data stored in said data storage means to fit a generalized reduced quadric equation of the form;
space="preserve" listing-type="equation">ax.sup.2 +by.sup.2 +1/2(a+b)z.sup.2 +2hxy+2px+2qy+2sz-1=0where x, y and z are values representing the magnetic field in the x, y and z directions, and determine the coefficients a, b, h, p, q and s. - View Dependent Claims (2, 3)
-
-
4. A magnetic compass for a vehicle in which an output of the compass is compensated both for disturbance to a magnetic field caused by said vehicle and its load, and for errors of the magnetic compass, said compass comprising:
-
three magnetic sensors, respectively responsive to nominally orthogonal components of a disturbed magnetic field acting along respective nominally orthogonal body axes of the vehicle, for continuously producing signals corresponding to said orthogonal components; and data processing means, receiving said signals from said three magnetic sensors, for processing said signals to fit, and to continuously determine coefficients a, b, h, p, q and s of a reduced quadric equation of the form;
space="preserve" listing-type="equation">ax.sup.2 +by.sup.2 +1/2(a+b)z.sup.2 +2hxy+2px+2qy+2sz-1=0which define ellipsoids representing a locus of values of said signals, where x, y and z are values representing the magnetic field in the x, y and z directions as the magnetic field changes, said data processing means including means for executing a continuously updated, recursive algorithm, in which an initial matrix inverse and vector are used for initiation purposes, and which derives, from said coefficients, calibration functions for transforming said ellipsoids to a spheroid centered on an origin of said body axes of the vehicle, and compensation means which receives both said signals from said magnetic sensors and said calibration functions from said executing means, for continuously compensating said signals for disturbance to the magnetic field and compensation for any errors of the sensors to produce said output of said compass. - View Dependent Claims (5, 6, 7)
-
-
8. A method for operating a magnetic compass for a vehicle in which an output of the compass is compensated both for disturbance to a magnetic field caused by said vehicle and its load, and for errors of the magnetic compass, said method comprising the steps of:
-
providing three magnetic sensors, which are respectively responsive to nominally orthogonal components of a disturbed magnetic field acting along respective nominally orthogonal body axes of the vehicle, and using said sensors for continuously producing signals corresponding to said orthogonal components; receiving said signals and processing said signals to fit, and to continuously determine coefficients a, b, h, p, q and s of a reduced quadric equation of the form;
space="preserve" listing-type="equation">ax.sup.2 +by.sup.2 +1/2(a+b)z.sup.2 +2hxy+2px+2qy+2sz-1=0which define ellipsoids representing a locus of values of said signals, where x, y and z are values representing the magnetic field in the x, y and z directions as the magnetic field changes, executing a continuously updated, recursive algorithm in which an initial matrix inverse and vector are used for initiation purposes, and which derives, from said coefficients, calibration functions for transforming said ellipsoids to a spheroid centered on an origin of said body axes of the vehicle; and continuously compensating said signals for disturbance to the magnetic field and compensation for any errors of the sensors using both said signals from said magnetic sensors and said calibration functions to produce said output of said compass.
-
Specification