PARTICLE FILTER BASED HEADING CORRECTION

• US 20170370722A1
• Filed: 08/15/2017
• Published: 12/28/2017
• Est. Priority Date: 01/06/2015
• Status: Active Grant

• Current Assignee: TRX Systems, Inc.
• Original Assignee: TRX Systems, Inc.
• Inventors: YOUNG, Travis, MILLER, John Riley, KARVOUNIS, John, HAKIM, Dan, NAPORA, Jared, FUNK, Benjamin, TEOLIS, Carole
• Granted Patent: US 10,088,313 B2
• Time in Patent Office: Days
• CPC Class Codes: G01C 17/38 Testing, calibrating, or compensating of compasses
• CPC Class Codes: G01S 19/42 Determining position
• CPC Class Codes: G01S 5/014 Identifying transitions between environments
• CPC Class Codes: G01S 5/015 between indoor and outdoor environments
• CPC Class Codes: G01S 5/0247 Determining attitude
• CPC Class Codes: G01S 5/0278 involving statistical or probabilistic considerations G01S5/0252, G01S5/0294 take precedence

Abstract

A method for computing a correction to a compass heading for a portable device worn or carried by a user is described. The method involves determining a heading for the device based on a compass reading, collecting data from one or more sensors, determining if the device is indoors or outdoors based on the collected data, and correcting the heading based on the determination of whether the device is indoors or outdoors.

Claims

1. A computer-implemented method for correcting a heading of a tracked device, comprising:

receiving sensor data from one or more sensors associated with the tracked device;

determining, using a particle filter, a tracked device heading and a tracked device location, the tracked device location being in or near a building having an outline, wherein particles are weighted based on one or more of;

the building outline; and

a heading confidence based on the sensor data; and

updating the tracked device location and the tracked device heading based on the weighted particles.

2. The method of claim 1, wherein the sensor data further comprises one or more of compass data, magnetic sensor data, location data, gyroscope sensor data, and inertial sensor data.

3. The method of claim 2, wherein the heading confidence is further based on a magnetic sensor confidence.

4. The method of claim 3, wherein the magnetic sensor confidence is based on one or more of expected magnitude, inclination, and data from at least one additional sensor.

5. The method of claim 3, wherein the magnetic sensor confidence is increased when the magnetic sensor receives consistently high reliability heading information and decreased when the magnetic sensor receives inconsistent heading information.

6. The method of claim 1, wherein the building outline comprises a plurality of probable building grid directions.

7. The method of claim 6, wherein determining the heading confidence comprises:

determining a probable building grid direction; and

increasing a weight of a particle associated with the tracked device heading when a heading for the particle is along the probable building grid direction.

8. The method of claim 7, wherein the probable building grid direction varies as a function of the tracked device location.

9. The method of claim 7, wherein the probable building grid direction decreases with a distance the tracked device location is from a wall associated with the building outline.

10. The method of claim 7, wherein the weight of particles increase as a function of time that the particles move along the probable building grid direction.

11. The method of claim 1, wherein the weight of a particle is affected by a location of the particle inside or outside of the building outline.

19. The computing system of claim 1, wherein the weight of particles increase as a function of time that particles move along the probable building grid direction.

12. A computing system for correcting a heading of a tracked device, comprising:

a processor;

a memory communicatively coupled to the processor, the memory bearing instructions that, when executed on the processor, cause the computing system to at least;

receive sensor data from one or more sensors associated with the tracked device;

determine, using a particle filter, a tracked device heading and a tracked device location, the tracked device location being in or near a building have an outline, wherein particles are weighted based on one or more of;

the building outline; and

a heading confidence based on the sensor data; and

update the tracked device location and the tracked device heading based on the weighted particles.

13. The computing system of claim 12, wherein the sensor data further comprises at least one of compass data, magnetic sensor data, location data, gyroscope sensor data, and inertial sensor data.

14. The computing system of claim 13, wherein the heading confidence is further based on a magnetic sensor confidence.

15. The computing system of claim 14, wherein the magnetic sensor confidence is increased when the magnetic sensor receives consistently high reliability heading information and decreased when the magnetic sensor receives inconsistent heading information.

16. The computing system of claim 12, wherein the building outline comprises a plurality of probable building grid directions, and wherein the instructions that determine the heading confidence further cause the computing system to at least:

determine a probable building grid direction; and

increase a weight of a particle associated with the tracked device heading when a heading of the particle is along the probable building grid direction.

17. The computing system of claim 16, wherein the probable building grid direction varies as a function of the tracked device location.

18. The computing system of claim 16, wherein the probable building grid direction decreases with a distance the tracked device location is from a wall associated with the building outline.

20. The computing system of claim 12, wherein the particles located outside of the building outline receive a lower weight than the particles located inside the building outline.

21. A computer readable storage medium comprising instructions that, when executed on a computing system of a tracked device, cause the computing system to at least:

receive sensor data from one or more sensors associated with the tracked device;

determine, using a particle filter, a tracked device heading and a tracked device location, the tracked device location being in or near a building have an outline, wherein particles are weighted based on one or more of;

the building outline; and

a heading confidence based on the sensor data; and

update the tracked device location and the tracked device heading based on the weighted particles.

22. The computer readable storage medium of claim 21, wherein the building outline comprises a plurality of probable building grid directions, and further comprising instructions that cause the computing system to at least:

determine a probable building grid direction; and

increase a weight of a particle associated with the tracked device heading when a location of the particle moves along the building grid direction.

23. The computer readable storage medium of claim 22, wherein the weight of particles increase as a function of time that particles move along the probable building grid direction.

24. The computer readable storage medium of claim 21, wherein the particles located outside of the building outline receive a lower weight than the particles located inside the building outline.