Method and system for compensating for soft iron magnetic disturbances in multiple heading reference systems
A method and system for compensating for soft iron magnetic disturbances in multiple heading reference systems, such as aircraft heading reference systems, integrated standby units; or vehicle inertial systems, detects and provides a heading correction signal to the error prone heading reference system when a detected difference in value between a gyro heading relative to magnetic north and a magnetometer reading during a defined measurement period exceeds a predetermined acceptable threshold value of change, such as one based on the expected gyro drift over that period. Upon receipt of the heading correction signal, the gyro heading is adjusted to maintain an accurate heading relative to true magnetic north. If this threshold value is not exceeded, then the magnetometer reading is used for the heading value. This method is periodically repeated in order to continually maintain an accurate heading and may be employed for each heading measurement axis.
1. A system for compensating for soft iron magnetic disturbances in a heading reference system of a vehicle, the system comprising:
a first magnetometer;
a second magnetometer located at a different location on the vehicle from the first magnetometer;
a first heading gyro coupled to the first magnetometer;
a second heading gyro coupled to the second magnetometer; and
a processor configured to:
receive magnetometer data from the first magnetometer;
receive magnetometer data from the second magnetometer;
determine whether one of the first or second magnetometers is potentially soft iron disturbed using the magnetometer data received from the first and second magnetometers and a magnetometer error threshold; and
in response to determining that one of the first or second magnetometers is potentially soft iron disturbed, determine which of the first or second magnetometers is potentially soft iron disturbed using the first and second heading gyros, a first threshold based on an expected drift of the first heading gyro, and a second threshold based on an expected drift of the second heading gyro.
2. The system of claim 1 , wherein the magnetometer error threshold is based on theoretical magnetic field values obtained from a model of the Earth's magnetic field.
3. The system of claim 1 , wherein in order to determine whether one of the first or second magnetometers is potentially soft iron disturbed, the processor is configured to:
generate a first value and a second value indicating a change of a magnetic field during a detection period based on data received from the first magnetometer and the second magnetometer, respectively;
determine a difference of change of the magnetic field between the first value based on the first magnetometer and the second value based on the second magnetometer; and
determine that a magnitude of the difference of change of the magnetic field exceeds the magnetometer error threshold.
4. The system of claim 1 , wherein in response to determining that neither of the first or second magnetometer is potentially soft iron disturbed, the processor is configured to:
use magnetometer data received from the first magnetometer to provide a first heading value to calibrate the first heading gyro; and
use magnetometer data received from the second magnetometer to provide a second heading value to calibrate the second heading gyro.
5. The system of claim 1 , wherein in order to determine which of the first or second magnetometers is potentially soft iron disturbed, the processor is configured to:
generate a first pair of heading values utilizing the first magnetometer and the first heading gyro, and a second pair of heading values utilizing the second magnetometer and the second heading gyro;
generate a first heading error value based on the first pair of heading values and a second heading error value based on the second pair of heading values; and
compare the first heading error value to the first threshold and the second heading error value to the second threshold.
6. The system of claim 5 , wherein:
in response to determining that the first heading error value exceeds the first threshold, the processor is configured to use a gyro reading from the first heading gyro to calibrate the first magnetometer; and
in response to determining that the second heading error value exceeds the second threshold, the processor is configured to use a gyro reading from the second heading gyro to calibrate the second magnetometer.
7. The system of claim 5 , wherein
in response to determining that the first heading error value does not exceed the first threshold, the processor is configured to use magnetometer data received from the first magnetometer to provide a first heading value to calibrate the first heading gyro; and
in response to determining that the second heading error value does not exceed the second threshold, the processor is configured to use magnetometer data received from the second magnetometer to provide a second heading value to calibrate the second heading gyro.
8. The system of claim 1 , wherein the first magnetometer and the second magnetometer are tri-axial magnetometers and the first heading gyro and the second heading gyro are tri-axial gyroscopes.
9. The system of claim 1 , wherein the heading reference system is an aircraft heading reference system.
10. The system of claim 1 , wherein the heading reference system is an integrated standby unit.
11. The system of claim 1 , wherein the heading reference system is an attitude and heading reference system.
12. The system of claim 1 , wherein the heading reference system is an inertial navigation system.
13. The system of claim 1 , wherein the first magnetometer and the first heading gyro are included in a first heading reference system and the second magnetometer and second heading gyro are included in a second heading reference system.
14. A method for compensating for soft iron magnetic disturbances in a heading reference system of a vehicle, the method comprising:
receiving magnetometer data from a first magnetometer;
receiving magnetometer data from a second magnetometer, wherein the second magnetometer is at a different location on the vehicle from the first magnetometer;
determining whether one of the first or second magnetometers is potentially soft iron disturbed using the magnetometer data received from the first and second magnetometers and a magnetometer error threshold; and
in response to determining that one of the first or second magnetometers is potentially soft iron disturbed, determining which of the first or second magnetometers is potentially soft iron disturbed by using: a first heading gyro associated with the first magnetometer and a second heading gyro associated with the second magnetometer, a first threshold based on an expected drift of the first heading gyro, and a second threshold based on an expected drift of the second heading gyro.
15. The method of claim 14 , wherein the magnetometer error threshold is based on theoretical magnetic field values obtained from a model of the Earth's magnetic field.
16. The method of claim 14 , wherein determining whether one of the first or second magnetometers is potentially soft iron disturbed further comprises:
generating a first value and a second value indicating a change of a magnetic field during a detection period based on data received from the first magnetometer and the second magnetometer, respectively;
determining a difference of change of the magnetic field between the first value based on the first magnetometer and the second value based on the second magnetometer; and
determining that a magnitude of the difference of change of the magnetic field exceeds the magnetometer error threshold.
17. The method of claim 14 further comprising:
in response to determining that neither of the first or second magnetometer is potentially soft iron disturbed,
using magnetometer data received from the first magnetometer to provide a first heading value to calibrate the first heading gyro associated with the first magnetometer; and
using magnetometer data received from the second magnetometer to provide a second heading value to calibrate the second heading gyro associated with the second magnetometer.
18. The method of claim 14 , wherein determining which of the first or second magnetometers is potentially soft iron disturbed further comprises:
generating a first pair of heading values utilizing the first magnetometer and the first heading gyro, and a second pair of heading values utilizing the second magnetometer and the second heading gyro;
generating a first heading error value based on the first pair of heading values and a second heading error value based on the second pair of heading values; and
comparing the first heading error value to the first threshold and the second heading error value to the second threshold.
19. The method of claim 18 further comprising:
in response to determining that the first heading error value exceeds the first threshold, using a gyro reading from the first heading gyro to calibrate the first magnetometer associated with the first heading gyro; and
in response to determining that the second heading error value exceeds the second threshold, using a gyro reading from the second heading gyro to calibrate the second magnetometer associated with the second heading gyro.
20. The method of claim 18 further comprising:
in response to determining that the first heading error value does not exceed the first threshold, using magnetometer data received from the first magnetometer to provide a first heading value to calibrate the first heading gyro associated with the first magnetometer; and
in response to determining that the second heading error value does not exceed the second threshold, using magnetometer data received from the second magnetometer to provide a second heading value to calibrate the second heading gyro associated with the second magnetometer.