Inertial sensor aided heading and positioning for GNSS vehicle navigation

• US 9,803,983 B2
• Filed: 12/01/2011
• Issued: 10/31/2017
• Est. Priority Date: 12/03/2010
• Status: Active Grant

• Current Assignee: Qualcomm, Inc.
• Original Assignee: Qualcomm, Inc.
• Inventors: Czompo, Joseph, Joshi, Ashutosh, Namburi, Shanta Pavan, Ahuja, Disha
• Primary Examiner(s): Barbee, Manuel L
• Application Number:
  US13/309,519
• Publication Number:
  US 20120173190A1
• Time in Patent Office: 2,161 Days
• Field of Search: 702141, 702150, 702151, 702153, 702154, 735033, 7351401
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01C 21/188 for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
• CPC Class Codes: G01C 21/26 specially adapted for navigation in a road network
• CPC Class Codes: G01C 25/005 initial alignment, calibration or starting-up of inertial devices
• CPC Class Codes: G01S 19/14 specially adapted for specific applications
• CPC Class Codes: G01S 19/393 Trajectory determination or predictive tracking, e.g. Kalman filtering
• CPC Class Codes: G01S 19/47 the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
• CPC Class Codes: G01S 19/52 Determining velocity

Abstract

An apparatus and method for providing an improved heading estimate of a mobile device in a vehicle is presented. First, the mobile device determines if it is mounted in a cradle attached to the vehicle; if so, inertia sensor data may be valid. While in a mounted stated, the mobile device determines whether it has been rotated in the cradle; if so, inertia sensor data may no longer be reliable and a recalibration to determine a new relative orientation between the vehicle and the mobile device is needed. If the mobile device is mounted and not recently rotated, heading data from multiple sensors (e.g., GPS, gyroscope, accelerometer) may be computed and combined to form the improved heading estimate. This improved heading estimate may be used to form an improved velocity estimate. The improved heading estimate may also be used to compute a bias to correct a gyroscope.

Claims

1. A method in a mobile device to detect if the mobile device is unmounted, the method comprising:

receiving, in the mobile device, accelerometer measurements;

determining, by the mobile device, an average of the accelerometer measurements;

computing a parameter based on the accelerometer measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring, by the mobile device, the mobile device is unmounted based on the variance being greater than the threshold.

2. The method of claim 1, wherein the parameter comprise an angle between the accelerometer measurements and the average, and the variance comprises a variance of the angle.

3. The method of claim 1, wherein the parameter comprise a magnitude of the accelerometer measurements, and wherein the variance comprises a variance comprising a variance of the magnitude ∥

{right arrow over (a)}∥

from a magnitude of the average.

4. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

an inertial measurement unit comprising an accelerometer;

a processor coupled to the inertial measurement unit; and

memory coupled to the processor, comprising code for;

receiving accelerometer measurements;

determining an average of the accelerometer measurements;

computing a parameter based on the accelerometer measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring the mobile device is unmounted based on the variance being greater than the threshold.

5. The mobile device of claim 4, wherein the parameter comprise an angle between the accelerometer measurements and the average, and the variance comprises a variance of the angle.

6. The mobile device of claim 4, wherein the parameter comprise a magnitude of the accelerometer measurements, and wherein the variance comprises a variance comprising a variance of the magnitude from a magnitude of the average.

7. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

means for receiving accelerometer measurements;

means for determining an average of the accelerometer measurements;

means for computing a parameter based on the accelerometer measurements and the average;

means for computing a variance of the parameter;

means for comparing the variance to a threshold; and

means for declaring the mobile device is unmounted based on the variance being greater than the threshold.

8. The mobile device of claim 7, wherein the parameter comprise an angle between the accelerometer measurements and the average, and the variance comprises a variance of the angle.

9. The mobile device of claim 7, wherein the parameter comprise a magnitude of the accelerometer measurements, and wherein the variance comprises a variance of the magnitude from a magnitude of the average.

10. A mobile device comprising a processor and a memory wherein the memory includes software instructions for:

receiving accelerometer measurements;

determining an average of the accelerometer measurements;

computing a parameter based on the accelerometer measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring the mobile device is unmounted based on the variance being greater than the threshold.

11. A non-transitory computer-readable storage medium including program code stored thereon, comprising program code for a mobile device for:

receiving accelerometer measurements;

determining an average of the accelerometer measurements;

computing a parameter based on the accelerometer measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring the mobile device is unmounted based on the variance being greater than the threshold.

12. A method in a mobile device to detect if the mobile device is unmounted, the method comprising:

receiving, in the mobile device, gyroscope measurements;

determining, by the mobile device, an average of the gyroscope measurements;

computing a parameter based on the gyroscope measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring, by the mobile device, the mobile device is unmounted based on the variance being greater than the threshold.

13. The method of claim 12, wherein the parameter comprise an angle between the gyroscope measurements and the average, and the variance comprises a variance of the angle.

14. The method of claim 12, wherein the parameter comprise a magnitude of the gyroscope measurements, and wherein the variance comprises a variance of the magnitude from a magnitude of the average.

15. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

an inertial measurement unit comprising a gyroscope;

a processor coupled to the inertial measurement unit; and

memory coupled to the processor, comprising code for;

receiving gyroscope measurements;

determining an average of the gyroscope measurements;

computing a parameter based on the gyroscope measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring the mobile device is unmounted based on the variance being greater than the threshold.

16. The mobile device of claim 15, wherein the parameter comprise an angle between the gyroscope measurements and the average, and the variance comprises a variance of the angle.

17. The mobile device of claim 15, wherein the parameter comprise a magnitude of the gyroscope measurements, and wherein the variance comprises a variance comprising a variance of the magnitude from a magnitude of the average.

18. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

means for receiving gyroscope measurements;

means for determining an average of the gyroscope measurements;

means for computing a parameter based on the gyroscope measurements and the average;

means for computing a variance of the parameter;

means for comparing the variance to a threshold; and

means for declaring the mobile device is unmounted based on the variance being greater than the threshold.

19. The mobile device of claim 18, wherein the parameter comprise an angle between the gyroscope measurements and the average, and the variance comprises a variance of the angle.

20. The mobile device of claim 18, wherein the parameter comprise a magnitude of the gyroscope measurements, and wherein the variance comprises a variance comprising a variance of the magnitude from a magnitude of the average.

21. A mobile device comprising a processor and a memory wherein the memory includes software instructions for:

receiving gyroscope measurements;

determining an average of the gyroscope measurements;

computing a parameter based on the gyroscope measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring the mobile device is unmounted based on the variance being greater than the threshold.

22. A non-transitory computer-readable storage medium including program code stored thereon, comprising program code for a mobile device for:

receiving gyroscope measurements;

determining an average of the gyroscope measurements;

computing a parameter based on the gyroscope measurements and the average;

computing a variance of the parameter;

comparing the variance to a threshold; and

declaring the mobile device is unmounted based on the variance being greater than the threshold.

23. A method in a mobile device to detect if the mobile device is unmounted, the method comprising:

receiving, in the mobile device, accelerometer measurements;

determining, by the mobile device, an average of the accelerometer measurements;

computing an angle between the average and an axis perpendicular to a viewable display on the mobile device;

comparing the angle to a threshold; and

declaring, by the mobile device, the mobile device is unmounted based on the angle being less than the threshold.

24. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

an inertial measurement unit comprising an accelerometer;

a processor coupled to the inertial measurement unit; and

memory coupled to the processor, comprising code for;

receiving accelerometer measurements;

determining an average of the accelerometer measurements;

computing an angle between the average and an axis perpendicular to a viewable display on the mobile device;

comparing the angle to a threshold; and

declaring the mobile device is unmounted based on the angle being less than the threshold.

25. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

means for receiving accelerometer measurements;

means for determining an average of the accelerometer measurements;

means for computing an angle between the average and an axis perpendicular to a viewable display on the mobile device;

means for comparing the angle to a threshold; and

means for declaring the mobile device is unmounted based on the angle being less than the threshold.

26. A mobile device comprising a processor and a memory wherein the memory includes software instructions for:

receiving accelerometer measurements;

determining an average of the accelerometer measurements;

computing an angle between the average and an axis perpendicular to a viewable display on the mobile device;

comparing the angle to a threshold; and

declaring the mobile device is unmounted based on the angle being less than the threshold.

27. A non-transitory computer-readable storage medium including program code stored thereon, comprising program code for a mobile device for:

receiving accelerometer measurements;

determining an average of the accelerometer measurements;

computing an angle between the average and an axis perpendicular to a viewable display on the mobile device;

comparing the angle to a threshold; and

declaring the mobile device is unmounted based on the angle being less than the threshold.

28. A method in a mobile device to detect if the mobile device is unmounted, the method comprising:

computing, in the mobile device, variance values for a virtual gyroscope heading rate;

setting a flag if any of the variance values exceed a respective threshold; and

declaring, by the mobile device, the mobile device is not in a mounted state based on the flag.

29. The method of claim 28, wherein setting and declaring comprise:

counting a number of times any of the variance values over a window of time exceed a respective threshold; and

declaring the mobile device is not in a mounted state based on the number being greater than a threshold.

30. The method of claim 28, wherein computing the variance values for the virtual gyroscope heading rate further comprises computing the variance values for at least one of:

(a) a sequence of accelerometer measurements;

(b) a sequence of averages of accelerometer measurements;

(c) a sequence of gyroscope measurements; and

(d) three sequences of scalar channelized gyroscope measurements.

31. The method of claim 28, wherein computing the variance values for the virtual gyroscope heading rate further comprises computing the variance values for at least two of:

(a) a sequence of accelerometer measurements;

(b) a sequence of averages of accelerometer measurements;

(c) a sequence of gyroscope measurements; and

(d) three sequences of scalar channelized gyroscope measurements.

32. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

an inertial measurement unit comprising an accelerometer;

a processor coupled to the inertial measurement unit; and

memory coupled to the processor, comprising code for;

computing variance values for a virtual gyroscope heading rate;

setting a flag if any of the variance values exceed a respective threshold; and

declaring the mobile device is not in a mounted state based on the flag.

33. A mobile device to detect if the mobile device is unmounted, the mobile device comprising:

means for computing variance values for a virtual gyroscope heading rate;

means for setting a flag if any of the variance values exceed a respective threshold; and

means for declaring the mobile device is not in a mounted state based on the flag.

34. A device comprising a processor and a memory wherein the memory includes software instructions for:

computing variance values for a virtual gyroscope heading rate;

setting a flag if any of the variance values exceed a respective threshold; and

declaring the mobile device is not in a mounted state based on the flag.

35. A non-transitory computer-readable storage medium including program code stored thereon, comprising program code for:

computing variance values for a virtual gyroscope heading rate;

setting a flag if any of the variance values exceed a respective threshold; and

declaring the mobile device is not in a mounted state based on the flag.