Cradle rotation insensitive inertial navigation

• US 10,088,318 B2
• Filed: 08/27/2015
• Issued: 10/02/2018
• Est. Priority Date: 08/27/2015
• Status: Active Grant

• Current Assignee: Qualcomm, Inc.
• Original Assignee: Qualcomm, Inc.
• Inventors: Zhang, Wentao
• Primary Examiner(s): Black, Thomas G
• Assistant Examiner(s): Smith-Stewart, Demetra R
• Application Number:
  US14/837,815
• Publication Number:
  US 20170059326A1
• Time in Patent Office: 1,132 Days
• Field of Search: None
• CPC Class Codes: G01C 21/1656 with passive imaging devices, e.g. cameras
• CPC Class Codes: G01C 25/00 Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass testing, calibrating or compensating compasses G01C17/38
• CPC Class Codes: G06T 2207/30244 Camera pose
• CPC Class Codes: G06T 7/74 involving reference images or patches
• CPC Class Codes: H04B 1/3877 Arrangements for enabling portable transceivers to be used in a fixed position, e.g. cradles or boosters
• CPC Class Codes: H04W 4/027 using movement velocity, acceleration information
• CPC Class Codes: H04W 4/80 Services using short range communication, e.g. near-field communication [NFC], radio-frequency identification [RFID] or low energy communication

Abstract

Techniques are provided which may be implemented using various methods and/or apparatuses in a mobile device to provide cradle insensitive inertial navigation. An example method for determining alignment changes between a first body frame and a second body frame according to the disclosure includes obtaining one or more images from an image capture device associated with the first body frame in response to detecting a change in alignment between the first body frame and the second body frame, determining a compensation information based on an analysis of the one or more images, and determining a position based on one or more inertial sensors and the compensation information.

Claims

1. An apparatus for determining alignment changes between a first body frame and a second body frame, comprising:

a memory unit;

one or more inertial sensors;

at least one processor communicatively coupled to the memory unit and the one or more inertial sensors and configured to;

determine a distance between a first position of the apparatus computed based on global navigation satellite system (GNSS) signals received by a GNSS receiver of the apparatus and a second position of the apparatus computed based on measurements of the one or more inertial sensors of the apparatus;

obtain one or more images from an image capture device associated with the first body frame in response to detecting a change in alignment between the first body frame and the second body frame responsive to distance exceeding a distance threshold value, wherein the one or more images include an image of a fixed object associated with the second body frame, and wherein the first body frame is associated with a mobile device and the second body frame is associated with a vehicle;

determine a compensation information, representative of an estimate of the detected change in alignment between the first body frame and the second body frame, based on an analysis of the one or more images; and

determine a position based on the one or more inertial sensors and the compensation information representative of the estimate of the detected change in alignment between the first body frame and the second body frame.

2. The apparatus of claim 1, wherein the compensation information includes a displacement change and a pose change.

3. The apparatus of claim 1, wherein the analysis of the one or more images comprises:

identifying features in the one or more images;

calculating a rotation matrix based on the identified features; and

generating a pose change estimate based on the rotation matrix.

4. The apparatus of claim 3, wherein the pose change estimate further comprises an uncertainty value generated by the at least one processor.

5. The apparatus of claim 1, wherein the one or more inertial sensors is an accelerometer.

6. The apparatus of claim 1, wherein detecting the change in alignment between the first body frame and the second body frame is derived at least from the one or more inertial sensors.

7. The apparatus of claim 1, wherein the at least one processor is configured to provide a synchronization signal.

8. The apparatus of claim 1, wherein the at least one processor is configured to:

determine a first orientation between the first body frame and the second body frame;

obtain an initial first image with the image capture device, wherein the initial first image includes the image of the fixed object associated with the second body frame and is associated with the first orientation; and

determine the compensation information based the analysis of the one or more images and the initial first image.

9. The apparatus of claim 1, wherein the at least one processor configured to obtain the one or more images in response to detecting the change in alignment between the first body frame and the second body frame is configured to:

obtain the one or more images in response to detecting the change in alignment between the first body frame and the second body frame based on measurements of the one or more inertial sensors.

10. A method for determining alignment changes between a first body frame and a second body frame, comprising:

determining a distance between a first position of the first body frame based on global navigation satellite system (GNSS) signals received by a GNSS receiver of the apparatus and a second position of the first body frame computed based on measurements of the one or more inertial sensors of the apparatus;

obtaining one or more images from an image capture device associated with the first body frame in response to detecting a change in alignment between the first body frame and the second body frame responsive to distance exceeding a distance threshold value, wherein the one or more images include an image of a fixed object associated with the second body frame, and wherein the first body frame is associated with a mobile device and the second body frame is associated with a vehicle;

determining a compensation information, representative of an estimate of the detected change in alignment between the first body frame and the second body frame, based on an analysis of the one or more images; and

determining a position based on one or more inertial sensors and the compensation information representative of the estimate of the detected change in alignment between the first body frame and the second body frame.

11. The method of claim 10, wherein the compensation information includes a displacement change and a pose change.

12. The method of claim 10, wherein the analysis of the one or more images comprises:

identifying common features in the one or more images;

calculating a rotation matrix based on the identified common features; and

generating a pose change estimate based on the rotation matrix.

13. The method of claim 12, wherein generating the pose change estimate includes generating an uncertainty value.

14. The method of claim 10, wherein detecting the change in alignment between the first body frame and the second body frame is based on information received from an inertial sensor.

15. The method of claim 14, further comprising synchronizing a detection of the change in alignment and the determining of the compensation information.

16. The method of claim 10, further comprising:

determining a first orientation between the first body frame and the second body frame;

obtaining an initial first image with the image capture device, wherein the initial first image includes the image of the fixed object associated with the second body frame and is associated with the first orientation; and

determining the compensation information based the analysis of the one or more images and the initial first image.

17. The method of claim 10, further comprising outputting the compensation information to an inertial navigation system.

18. A non-transitory machine-readable medium comprising instructions for determining alignment changes between a first body frame and a second body frame, the instructions comprising:

code for determining a distance between a first position of the first body frame based on global navigation satellite system (GNSS) signals received by a GNSS receiver associated with the first body frame and a second position of the first body frame computed based on measurements of the one or more inertial sensors associated with the first body frame;

code for obtaining one or more images from an image capture device associated with the first body frame in response to detecting a change in alignment between the first body frame and the second body frame responsive to distance exceeding a distance threshold value, wherein the one or more images include an image of a fixed object associated with the second body frame and wherein the first body frame is associated with a mobile device and the second body frame is associated with a vehicle;

code for determining a compensation information, representative of an estimate of the detected change in alignment between the first body frame and the second body frame, based on an analysis of the one or more images; and

code for determining a position based on one or more inertial sensors and the compensation information representative of the estimate of the detected change in alignment between the first body frame and the second body frame.

19. The non-transitory machine-readable medium of claim 18, wherein the compensation information includes a displacement change and a pose change.

20. The non-transitory machine-readable medium of claim 18, wherein the code for determining the compensation information based on the analysis of the one or more images includes:

code for identifying common features in the one or more images;

code for calculating a rotation matrix based on the identified common features; and

code for generating a pose change estimate based on the rotation matrix.

21. The non-transitory machine-readable medium of claim 20, wherein the code for generating the pose change estimate based on the rotation matrix includes code for generating an uncertainty value.

22. The non-transitory machine-readable medium of claim 18, wherein detecting the change in alignment between the first body frame and the second body frame includes code for receiving information from the one or more inertial sensors.

23. The non-transitory machine-readable medium of claim 22, wherein the instructions include code for synchronizing a detection of the change in alignment and the determining of the compensation information.

24. The non-transitory machine-readable medium of claim 18, wherein the instructions include:

code for determining a first orientation between the first body frame and the second body frame;

code for obtaining an initial first image with the image capture device, wherein the initial first image includes the image of the fixed object associated with the second body frame and is associated with the first orientation; and

code for determining the compensation information based the analysis of the one or more images and the initial first image.

25. The non-transitory machine-readable medium of claim 18, wherein the instructions include code for outputting the compensation information to a navigation unit.

26. An apparatus for determining alignment changes between a first body frame and a second body frame, comprising:

means for determining a distance between a first position of the apparatus computed based on global navigation satellite system (GNSS) signals received by a GNSS receiver of the apparatus and a second position of the apparatus computed based on measurements of the one or more inertial sensors of the apparatus;

means for obtaining one or more images from an image capture device associated with the first body frame in response to detecting a change in alignment between the first body frame and the second body frame, wherein the one or more images include an image of a fixed object associated with the second body frame, and wherein the first body frame is associated with a mobile device and the second body frame is associated with a vehicle;

means for determining a compensation information, representative of an estimate of the detected change in alignment between the first body frame and the second body frame responsive to distance exceeding a distance threshold value, based on an analysis of the one or more images; and

means for determining a position based on one or more inertial sensors and the compensation information representative of the estimate of the detected change in alignment between the first body frame and the second body frame.

27. The apparatus of claim 26, wherein the means for determining the compensation information includes a means for determining a displacement change and a means for determining a pose change.

28. The apparatus of claim 26, wherein the analysis of the one or more images comprises:

means for identifying common features in the one or more images;

means for calculating a rotation matrix based on the identified common features; and

means for generating a pose change estimate based on the rotation matrix.

29. The apparatus of claim 26, further comprising:

means for determining a first orientation between the first body frame and the second body frame;

means for obtaining an initial first image with the image capture device, wherein the initial first image includes the image of the fixed object associated with the second body frame is associated with the first orientation; and

means for determining the compensation information based the analysis of the one or more images and the initial first image.

30. The apparatus of claim 26, wherein detecting the change in alignment between the first body frame and the second body frame includes means for receiving information from the one or more inertial sensors.

31. The apparatus of claim 30, wherein the means for outputting the compensation information include means for outputting the compensation information to an applications processor.