System and method of magnetic compass calibration

• US 8,577,637 B2
• Filed: 07/15/2010
• Issued: 11/05/2013
• Est. Priority Date: 09/28/2009
• Status: Active Grant

• Current Assignee: Teledyne Instruments Incorporated (Teledyne Technologies Incorporated)
• Original Assignee: Teledyne Industries Incorporated (Teledyne Technologies Incorporated)
• Inventors: Vogt, Mark A.
• Primary Examiner(s): Charioui, Mohamed
• Application Number:
  US12/836,908
• Publication Number:
  US 20110077889A1
• Time in Patent Office: 1,209 Days
• Field of Search: 702/57, 702/85, 702 91- 95, 702/146, 702/150, 367/90, 333/19, 333/20
• US Class Current: 702/92
• CPC Class Codes: G01C 17/38 Testing, calibrating, or compensating of compasses

Abstract

A system and method of determining a magnetic field and magnetic compass calibration is disclosed. One embodiment is a method of determining a magnetic field vector, the method comprising storing, for each of a plurality of sensor orientations, one or more calibration components, determining, for a sensor orientation not included in the plurality of sensor orientations, a magnetic field vector and a gravity vector, iteratively estimating one or more calibration coefficients based on the stored components, the determined magnetic field vector, and the determined gravity vector, wherein the calibration coefficients are updated during each of a plurality of iterations, and determining a sensor-orientation-independent magnetic field vector based on at least one of the calibration coefficients.

Claims

1. A method of determining a magnetic field vector, the method comprising:

storing, for each of a plurality of sensor orientations, one or more calibration components;

determining, for a sensor orientation not included in the plurality of sensor orientations, a magnetic field vector and a gravity vector;

iteratively estimating, by a processor, one or more calibration coefficients based on the stored components, the determined magnetic field vector, and the determined gravity vector, wherein the calibration coefficients are updated during each of a plurality of iterations; and

determining a sensor-orientation-independent magnetic field vector based on at least one of the calibration coefficients.

2. The method of claim 1, wherein the sensor-orientation-independent magnetic field vector is an estimate of the magnetic field in geographic coordinates.

3. The method of claim 1, wherein the one or more calibration coefficients comprises a coefficient dependent on at least one or soft iron perturbations or hard iron perturbations.

4. The method of claim 1, wherein at least one of the calibration coefficients is updated so as to reduce a sum over the sensor orientation of squared errors between an estimated magnetic field in geographic coordinates and the actual magnetic field in geographic coordinates.

5. The method of claim 1, wherein at least one of the calibration coefficients is updated based on the observability of one or more parameters.

6. The method of claim 1, wherein a magnetometer determines the magnetic field vector and the gravity vector for the sensor orientation not included in the plurality of sensor orientations.

7. A system for determining a magnetic field vector, the system comprising:

a magnetic compass comprising;

a memory configured to store, for each of a plurality of compass orientations, one or more calibration components;

a magnetometer configured to determine a magnetic field vector for a compass orientation not included in the plurality of compass orientations;

an accelerometer configured to determine a gravity vector for the compass orientation not included in the plurality of compass orientations; and

a processor configured to i) iteratively estimate one or more calibration coefficients based on the stored components, the determined magnetic field vector, and the determined gravity vector, wherein the calibration coefficients are updated during each of a plurality of iterations, and ii) determine a compass-orientation-independent magnetic field vector based on at least one of the calibration coefficients,

wherein the magnetic compass is mounted to a vessel configured to be navigable in bodies of water.

8. The system of claim 7, wherein the system further comprises an acoustic Doppler current profiler.

9. The system of claim 7, wherein the system further comprises a Doppler log.

10. The system of claim 7, wherein the system further comprises a surface-going boat.

11. The system of claim 7, wherein the system further comprises an underwater autonomous vehicle.

12. A method of calibrating a magnetic compass, the method comprising:

receiving sample data indicative of a measured magnetic field vector and gravity vector from at least one sensor oriented at a first plurality of orientations;

receiving a plurality of stored magnetic compass calibration components associated with a second plurality of orientations of the at least one sensor, wherein the second plurality of orientations includes at least one orientation that is absent from the first plurality of orientations; and

estimating, by a processor, a plurality of calibration coefficients based on the sample data and based on the plurality of stored magnetic compass calibration components,

wherein the estimating comprises;

partitioning a first estimate of the calibration coefficients based on observability of the calibration coefficients at the first plurality of orientations, wherein observability of the calibration coefficients is determined based on the sample data at the first plurality of orientations;

generating a weighting of the stored magnetic compass calibration components and the first estimate of the calibration coefficients based on the sample data; and

determining the estimated plurality of coefficients based at least in part on the weighting.

13. The method of claim 12, wherein estimating the plurality of calibration coefficients comprises performing an iterative least squares estimate based on minimizing a distance minimizes the sum of the squared error between the actual and estimated magnetic field in geographic coordinates over the sample data.

14. The method of claim 13, wherein the iterative least square estimate is further based on minimizing a distance between the estimated plurality of calibration coefficients and the plurality of stored magnetic compass calibration components.

15. The method of claim 12, further comprising:

receiving accelerometer data indicative of, pitch, and roll of the magnetic compass; and

estimating the plurality of calibration coefficients based on the received accelerometer data.

16. The method of claim 12, wherein generating the weighting comprises weighting the stored magnetic compass calibration components based on an inverse relationship to the observability of the first estimate of the calibration coefficients at the first plurality of orientations.

17. A system for determining a magnetic field vector, the system comprising:

a memory configured to store, for each of a plurality of sensor orientations, one or more calibration components;

a magnetometer configured to determine a magnetic field vector for a sensor orientation not included in the plurality of sensor orientations;

an accelerometer configured to determine a gravity vector for the sensor orientation not included in the plurality of sensor orientations; and

a processor configured to i) iteratively estimate one or more calibration coefficients based on the stored components, the determined magnetic field vector, and the determined gravity vector, wherein the calibration coefficients are updated during each of a plurality of iterations and ii) determine a sensor-orientation-independent magnetic field vector based on at least one of the calibration coefficients.

18. The system of claim 17, wherein the processor is configured to update at least one of the calibration coefficients so as to reduce a sum over the sensor orientation of squared errors between an estimated magnetic field in geographic coordinates and the actual magnetic field in geographic coordinates.

19. The system of claim 17, wherein the processor is configured to update at least one of the calibration coefficients based on the observability of one or more parameters.

20. A system for determining a magnetic field vector, the system comprising:

means for storing, for each of a plurality of sensor orientations, one or more calibration components;

means for determining, for a sensor orientation not included in the plurality of sensor orientations, a magnetic field vector and a gravity vector;

means for iteratively estimating one or more calibration coefficients based on the stored components, the determined magnetic field vector, and the determined gravity vector, wherein the calibration coefficients are updated during each of a plurality of iterations; and

means for determining a sensor-orientation-independent magnetic field vector based on at least one of the calibration coefficients.

21. A non-transitory computer-readable storage medium comprising instructions stored thereon relating to determination of a magnetic field vector, which when executed by a processor, cause the processor to:

process received data, for each of a plurality of sensor orientations, indicative of one or more calibration components;

determine, for a sensor orientation not included in the plurality of sensor orientations, a magnetic field vector and a gravity vector;

iteratively estimate one or more calibration coefficients based on the data indicative of one or more calibration components, the determined magnetic field vector, and the determined gravity vector, wherein the calibration coefficients are updated during each of a plurality of iterations; and

determine a sensor-orientation-independent magnetic field vector based on at least one of the calibration coefficients.