Method and system for multiple pass smoothing

Patent metadata

Field	Value
Publication number	US-9719787-B2
Application number	US-201615054792-A
Country	US
Kind code	B2
Filing date	Feb 26, 2016
Priority date	Feb 26, 2015
Publication date	Aug 1, 2017
Grant date	Aug 1, 2017

Abstract

The navigation solution of a device may be enhanced by perforating multiple pass smoothing. Forward and backward processing of the input data may be performed to derive interim navigation solutions. One or more quantities of the interim navigation solutions may be combined to smooth the quantities. At least one additional pass of forward and backward processing may then be performed using quantities of the navigation solution that were combined to enhance the interim navigation solutions. Next, at least one uncombined quantity of the navigation solution from the enhanced interim navigation solution is combined to provide an enhanced smoothed navigation solution. Additional passes may be performed to combine other quantities of the navigation solution as desired.

First claim

What is claimed is:

1. A method configured to enhance a navigation solution for a device and a platform through multiple pass smoothing, wherein the mobility of the device is constrained or unconstrained within the platform and wherein the device may be tilted to any orientation, the method comprising:
a) obtaining input data comprising sensor data acquired from a sensor assembly integrated with the device and representing motion of the device at a plurality of epochs from a first instant to a subsequent second instant;
b) performing forward processing of the input data to derive interim forward navigation solutions for the epochs;
c) performing backward processing of the input data to derive interim backward navigation solutions for the epochs;
d) combining at least one quantity of the navigation solution from the interim forward and backward navigation solutions to obtain a smoothed version of the at least one combined quantity;
e) performing forward processing of the input data and the at least one combined quantity to derive enhanced interim forward navigation solutions for the epochs;
f) performing backward processing of the input data and the at least one combined quantity to derive enhanced interim backward navigation solutions for the epochs;
g) combining at least one uncombined quantity of the navigation solution from the enhanced interim forward and backward navigation solutions to obtain an enhanced smoothed navigation solution; and
h) providing the enhanced smoothed navigation solution.

2. The method of claim 1 , further comprising performing at least one additional smoothing pass by performing d), e) and f) with respect to at least one additional quantity of the navigation solution before performing g), wherein the interim forward and backward in step d) of the additional pass are replaced by the enhanced interim forward and backward from previous pass step e) and f).

3. The method of claim 1 , wherein performing forward processing of the input data to derive interim forward navigation solutions for the epochs comprises applying a forward processing algorithm and wherein performing backward processing of the input data to derive interim backward navigation solutions for the epochs comprises transforming the input data and applying the forward processing algorithm to the transformed sensor data from the second instant to the first instant.

4. The method of claim 3 , wherein transforming the input data comprises transforming sensor data.

5. The method of claim 4 , wherein transforming the sensor data comprises transforming accelerometer and gyroscope data.

6. The method of claim 4 , wherein transforming the sensor data comprises transforming available sensor data selected from the group consisting of accelerometer, gyroscope, magnetometer, barometer and odometer data.

7. The method of claim 1 , wherein the input data comprises absolute navigational information.

8. The method of claim 7 , wherein the absolute navigation information is at least one of the group consisting of: (i) a global navigation satellite system (GNSS) information; (ii) cell-based navigational information; (iii) WiFi-based navigational information; and (iv) other wireless-based navigational information.

9. The method of claim 3 , wherein the input data comprises absolute navigational information and transforming the input data comprises transforming absolute navigational information.

10. The method of claim 9 , wherein transforming the absolute navigational information comprises transforming any available quantity selected from the group consisting of: (i) absolute position; (ii) absolute velocity; (iii) absolute attitude angles; and (iv) absolute heading angle.

11. The method of claim 9 , wherein transforming the absolute navigational information comprises transforming any available information selected from the group consisting of: (i) a global navigation satellite system (GNSS); (ii) cell-based navigational information; (iii) WiFi-based navigational information; and (iv) other wireless-based navigational information.

12. The method of claim 1 , wherein performing backward processing of the input data to derive interim backward navigation solutions for the epochs comprises applying a backward processing algorithm without transforming the input data.

13. The method of claim 1 , further comprising combining multiple quantities of the navigation solution that do not depend on each other from the interim forward and backward navigation solutions.

14. The method of claim 13 , wherein the multiple quantities comprise heading and misalignment angle.

15. The method of claim 1 , wherein combining a quantity of the navigation solution comprises weighting quantities derived from forward and backward processing.

16. The method of claim 15 , wherein weighting quantities derived from forward and backward processing comprises assessing forward and backward accuracy.

17. The method of claim 16 , wherein assessing forward and backward accuracy is based at least in part on a standard deviation of solution errors.

18. The method of claim 15 , wherein weighting quantities derived from forward and backward processing comprises a linear combination.

19. The method of claim 1 , further comprising characterizing an error in the input data and compensating for the error before performing at least one of the forward and backward processing.

20. The method of claim 19 , further comprising detecting a predefined motion pattern of the device and characterizing the error in the input data based at least in part on the detected predefined motion period.

21. The method of claim 20 , wherein the predefined motion pattern comprises a static period and wherein the error comprises a gyroscope bias.

22. The method of claim 21 , further comprising transforming the gyroscope bias and performing backward processing using the transformed gyroscope bias.

23. The method of claim 1 , further comprising identifying an anchor point, wherein at least one of the first instant and the second instant corresponds to when the device is at the identified anchor point.

24. The method of claim 23 , further comprising identifying a plurality of anchor points, wherein both the first instant and the second instant correspond to when the device is at identified anchor points.

25. The method of claim 1 , wherein the input data further comprises supplemental navigation information for the device obtained from at least one of a barometer, a magnetometer, an odometer, a speedometer and a pedestrian motion model.

26. The method of claim 1 , further comprising performing at least one time-based smoothing process for at least one quantity of the navigation solution.

27. The method of claim 26 , wherein the time-based smoothing process smoothing is a non-causal process.

28. The method of claim 26 , wherein the time-based smoothing process is performed for height.

29. The method of claim 26 , wherein the time-based smoothing process is performed for latitude.

30. The method of claim 26 , wherein the time-based smoothing process is performed for longitude.

31. The method of claim 26 , wherein the time-based smoothing process is performed for velocity.

32. The method of claim 26 , wherein the time-based smoothing process is performed for speed.

33

Assignees

• Invensense Inc

Inventors

• Georgy Jacques
• Li You
• Omr Medhat
• Goodall Christopher
• Chang Hsui-Wen

Classifications

• G01C21/1654 Primary

  with electromagnetic compass · CPC title

• G01C21/165 Primary

  combined with non-inertial navigation instruments · CPC title

• G01C21/18

  Stabilised platforms, e.g. by gyroscope · CPC title

• G01S19/49

  whereby the further system is an inertial position system, e.g. loosely-coupled · CPC title

• G01C21/20 Primary

  Instruments for performing navigational calculations (G01C21/24, G01C21/26 take precedence) · CPC title