System and method for determining a uniform external magnetic field

• US 9,228,842 B2
• Filed: 03/22/2013
• Issued: 01/05/2016
• Est. Priority Date: 03/25/2012
• Status: Expired due to Fees

• Current Assignee: Sensor Platforms, Incorporated (Knowles Corporation)
• Original Assignee: Sensor Platforms, Incorporated (Knowles Corporation)
• Inventors: Joseph, Benjamin E., Chen, Ian, Vitus, Deborah Kathleen
• Primary Examiner(s): Badii, Behrang
• Assistant Examiner(s): GREENE, DANIEL LAWSON
• Application Number:
  US13/849,447
• Publication Number:
  US 20130253821A1
• Time in Patent Office: 1,019 Days
• Field of Search: 701/501
• US Class Current: 1/1
• CPC Class Codes: G01C 17/38 Testing, calibrating, or compensating of compasses
• CPC Class Codes: G01C 21/1654 with electromagnetic compass
• CPC Class Codes: G06F 3/0346 with detection of the device orientation or free movement in a 3D space, e.g. 3D mice, 6-DOF [six degrees of freedom] pointers using gyroscopes, accelerometers or tilt-sensors

Abstract

A processing apparatus, optionally integrated into a device having a plurality of sensors including a magnetometer, generates navigational state estimates for the device. The processing apparatus has a magnetometer-assisted mode of operation in which measurements from the magnetometer are used to estimate the navigational state and an alternate mode of operation in which the navigational state of the device is estimated without measurements from the magnetometer. For a respective time period, the processing apparatus operates in the alternate mode of operation. During the respective time period, the processing apparatus collects a plurality of magnetometer measurements and determines whether they meet measurement-consistency requirements. If the measurements meet the measurement-consistency requirements, the processing apparatus transitions to the magnetometer-assisted mode of operation. If the measurements do not meet the measurement-consistency requirements, the processing apparatus continues to operate in the alternate mode of operation.

Claims

1. A method comprising:

at a processing apparatus having one or more processors and memory storing one or more programs that when executed by the one or more processors cause the respective processing apparatus to perform the method,

generating navigational state estimates for a device having a plurality of sensors, the plurality of sensors including a magnetometer, wherein the processing apparatus has a plurality of modes of operation including;

a magnetometer-assisted mode of operation in which measurements from the magnetometer are used to estimate the navigational state of the device; and

an alternate mode of operation in which measurements from a subset of sensors of the plurality of sensors that does not include the magnetometer are used to estimate the navigational state of the device;

for a respective time period, operating in the alternate mode of operation;

during the respective time period;

collecting a plurality of magnetometer measurements;

determining a first estimated direction of the external magnetic field based on the plurality of magnetometer measurements;

determining a second estimated direction of the external magnetic field based on measurements from one or more of the other sensors and a predetermined relationship between an estimated orientation of the device and the external magnetic field; and

determining whether the plurality of magnetometer measurements meet predefined measurement-consistency requirements while the first estimated magnetic field is not consistent with the second estimated magnetic field;

in accordance with the determination that the plurality of magnetometer measurements meet predefined measurement-consistency requirements while the first estimated magnetic field is not consistent with the second estimated magnetic field, transitioning to the magnetometer-assisted mode of operation, including adjusting the estimate of the navigational state of the device in accordance with a difference between the first estimated magnetic field and the second estimated magnetic field; and

in accordance with the determination that the plurality of magnetometer measurements do not meet predefined measurement-consistency requirements, continuing to operate in the alternate mode of operation.

2. The method of claim 1, wherein the processing apparatus is a component of the device.

3. The method of claim 1, further comprising:

for a prior time period that occurs prior to the respective time period, operating in the magnetometer-assisted mode of operation, using measurements from the plurality of sensors, including the magnetometer, to estimate the navigational state of the device;

during the prior time period, determining whether a current operating environment of the device will distort measurements from the magnetometer; and

in accordance with a determination that the current operating environment of the device will distort measurements from the magnetometer, transitioning to the alternate mode of operation in which measurements from the magnetometer are not used to estimate the navigational state of the device.

4. The method of claim 1, further comprising, after transitioning to the magnetometer-assisted mode of operation, using measurements of the plurality of sensors, including the magnetometer, to estimate the navigational state of the device.

5. The method of claim 1, wherein:

a set of estimated directions of the external magnetic field are determined based on corresponding magnetometer measurements; and

the plurality of magnetometer measurements meet the predefined measurement-consistency requirements when the set of estimated directions have a statistical dispersion below a predefined dispersion threshold.

6. The method of claim 1, wherein:

a set of estimated magnitudes of the external magnetic field are determined based on corresponding magnetometer measurements; and

the plurality of magnetometer measurements meet the predefined measurement-consistency requirements when the set of estimated magnitudes have a statistical dispersion below a predefined dispersion threshold.

7. The method of claim 1, further comprising, while in the alternate mode of operation comparing the first estimated direction with the second estimated direction, wherein the plurality of magnetometer measurements meet the predefined measurement-consistency requirements when the first estimated direction is consistent with the second estimated direction.

8. The method of claim 1, wherein determining whether the plurality of magnetometer measurements meet predefined measurement-consistency requirements includes determining whether the plurality of magnetometer measurements are internally consistent.

9. The method of claim 1, wherein:

a Kalman filter is used to estimate the navigational state of the device in accordance with measurements from sensors in the plurality of sensors;

the Kalman filter includes a magnetic field residual term corresponding to a difference between the estimated magnetic field and the measured magnetic field; and

the method further comprises;

while operating in the magnetometer-assisted mode of operation;

calculating a first value of the magnetic field residual; and

using the first value of the magnetic field residual to estimate the navigational state of the device; and

while operating in the alternate mode of operation;

calculating a second value of the magnetic field residual; and

forgoing use of the second value of the magnetic field residual to estimate the navigational state of the device.

10. The method of claim 9, wherein:

forgoing use of a value of the magnetic field residual to estimate the navigational state of the device includes setting a gain of the magnetic field residual to zero in the Kalman filter; and

the method further comprises, in accordance with a determination that the magnetic field residual has decreased below a predefined minimum threshold, increasing the gain of the magnetic field residual to a non-zero value.

11. The method of claim 1, further comprising:

comparing the plurality of magnetometer measurements to one or more models of predefined magnetic disturbances; and

in accordance with a determination that the plurality of magnetometer measurements are consistent with a respective model of the one or more models;

retrieving information about a respective predefined magnetic disturbance that corresponds to the respective model; and

adjusting operation of the processing apparatus in accordance with the information about the respective predefined magnetic disturbance.

12. The method of claim 11, wherein adjusting operation of the processing apparatus includes:

determining a difference between the magnetic field measured by the magnetometer and a magnetic field predicted in accordance with measurements from the subset of sensors; and

adjusting the estimate of the navigational state of the device in accordance with the determined difference.

13. A computer system, comprising:

a processing apparatus including one or more processors and memory; and

one or more programs, wherein the one or more programs are stored in the memory and configured to be executed by the one or more processors, the one or more programs including instructions for;

generating navigational state estimates for a device having a plurality of sensors, the plurality of sensors including a magnetometer, wherein the processing apparatus has a plurality of modes of operation including;

a magnetometer-assisted mode of operation in which measurements from the magnetometer are used to estimate the navigational state of the device; and

an alternate mode of operation in which measurements from a subset of sensors of the plurality of sensors that does not include the magnetometer are used to estimate the navigational state of the device; and

for a respective time period, operating the processing apparatus in the alternate mode of operation;

during the respective time period;

collecting a plurality of magnetometer measurements;

determining a first estimated direction of the external magnetic field based on the plurality of magnetometer measurements;

determining a second estimated direction of the external magnetic field based on measurements from one or more of the other sensors and a predetermined relationship between an estimated orientation of the device and the external magnetic field; and

determining whether the plurality of magnetometer measurements meet predefined measurement-consistency requirements while the first estimated magnetic field is not consistent with the second estimated magnetic field;

in accordance with the determination that the plurality of magnetometer measurements meet predefined measurement-consistency requirements while the first estimated magnetic field is not consistent with the second estimated magnetic field, transitioning to the magnetometer-assisted mode of operation, including adjusting the estimate of the navigational state of the device in accordance with a difference between the first estimated magnetic field and the second estimated magnetic field; and

in accordance with the determination that the plurality of magnetometer measurements do not meet predefined measurement-consistency requirements, continuing to operate the processing apparatus in the alternate mode of operation.

14. The computer system of claim 13, wherein the one or more programs include instructions for:

for a prior time period that occurs prior to the respective time period, operating in the magnetometer-assisted mode of operation, using measurements from the plurality of sensors, including the magnetometer, to estimate the navigational state of the device;

during the prior time period, determining whether a current operating environment of the device will distort measurements from the magnetometer; and

in accordance with a determination that the current operating environment of the device will distort measurements from the magnetometer, transitioning to the alternate mode of operation in which measurements from the magnetometer are not used to estimate the navigational state of the device.

15. The computer system of claim 13, wherein the one or more programs include instructions for, while in the alternate mode of operation comparing the first estimated direction with the second estimated direction, wherein the plurality of magnetometer measurements meet the predefined measurement-consistency requirements when the first estimated direction is consistent with the second estimated direction.

16. The computer system of claim 13, wherein determining whether the plurality of magnetometer measurements meet predefined measurement-consistency requirements includes determining whether the plurality of magnetometer measurements are internally consistent.

17. A non-transitory computer readable storage medium storing one or more programs, the one or more programs comprising instructions, which when executed by a processing apparatus with one or more processors, cause the processing apparatus to:

generate navigational state estimates for a device having a plurality of sensors, the plurality of sensors including a magnetometer, wherein the processing apparatus has a plurality of modes of operation including;

a magnetometer-assisted mode of operation in which measurements from the magnetometer are used to estimate the navigational state of the device; and

an alternate mode of operation in which measurements from a subset of sensors of the plurality of sensors that does not include the magnetometer are used to estimate the navigational state of the device; and

for a respective time period, operate the processing apparatus in the alternate mode of operation;

during the respective time period;

collect a plurality of magnetometer measurements;

determine a first estimated direction of the external magnetic field based on the plurality of magnetometer measurements;

determine a second estimated direction of the external magnetic field based on measurements from one or more of the other sensors and a predetermined relationship between an estimated orientation of the device and the external magnetic field; and

determine whether the plurality of magnetometer measurements meet predefined measurement-consistency requirements while the first estimated magnetic field is not consistent with the second estimated magnetic field;

in accordance with the determination that the plurality of magnetometer measurements meet predefined measurement-consistency requirements while the first estimated magnetic field is not consistent with the second estimated magnetic field, transition to the magnetometer-assisted mode of operation, including adjusting the estimate of the navigational state of the device in accordance with a difference between the first estimated magnetic field and the second estimated magnetic field; and

in accordance with the determination that the plurality of magnetometer measurements do not meet predefined measurement-consistency requirements, continue to operate the processing apparatus in the alternate mode of operation.

18. The non-transitory computer readable storage medium of claim 17, further comprising instructions to:

for a prior time period that occurs prior to the respective time period, operating in the magnetometer-assisted mode of operation, use measurements from the plurality of sensors, including the magnetometer, to estimate the navigational state of the device;

during the prior time period, determine whether a current operating environment of the device will distort measurements from the magnetometer; and

in accordance with a determination that the current operating environment of the device will distort measurements from the magnetometer, transition to the alternate mode of operation in which measurements from the magnetometer are not used to estimate the navigational state of the device.

19. The non-transitory computer readable storage medium of claim 17, further comprising instructions to compare the first estimated direction with the second estimated direction, wherein the plurality of magnetometer measurements meet the predefined measurement-consistency requirements when the first estimated direction is consistent with the second estimated direction.

20. The non-transitory computer readable storage medium of claim 17, wherein determining whether the plurality of magnetometer measurements meet predefined measurement-consistency requirements includes determining whether the plurality of magnetometer measurements are internally consistent.