Multi sensor position and orientation measurement system

• US 10,168,352 B2
• Filed: 04/01/2015
• Issued: 01/01/2019
• Est. Priority Date: 09/28/2010
• Status: Active Grant

• Current Assignee: Wensheng Hua, Xianghui Wang
• Original Assignee: Wensheng Hua, Xianghui Wang
• Inventors: Wang, Xianghui, Hua, Wensheng
• Primary Examiner(s): Rivera Vargas, Manuel A
• Application Number:
  US14/676,643
• Publication Number:
  US 20150204900A1
• Time in Patent Office: 1,371 Days
• CPC Class Codes: G01C 19/00 Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01P 15/14 by making use of gyroscopes gyroscopes per se G01C19/00

Abstract

A system combines contributions from various sensors to obtain an object'"'"'s position, velocity, or orientation.

Claims

1. A system for measuring a position or an orientation of an object, comprising:

a first set of sensors, including a rotation sensor, providing output signals each representative of a measurement of a vector in the object'"'"'s body frame; and

one or more filters which combine the output signals over multiple time points to provide a system output signal representative of a vector related to one or more of velocity, position, and orientation of the object relative to a predetermined reference frame, wherein the filters combine the sensors'"'"' output signals at each time point in the object'"'"'s body frame.

2. The system of claim 1, further comprising a sensor which derives a vector in the predetermined reference frame, wherein one or more of the vectors represented by the output signals of the first set of sensors are each compared with the vector in the predetermined reference frame to determine the object'"'"'s orientation.

3. The system of claim 2, wherein the one or more of the vectors represented by the output signals of the first set of sensors and the vector in the predetermined reference frame refer to a common physical vector.

4. The system as in claim 3, wherein the vector in the predetermined reference frame is constructed by the filters.

5. The system of claim 1, wherein one or more of the vectors represented by the output signals of the first set of sensors is compared with a derived gravity vector in the global reference frame to determine the object'"'"'s orientation.

6. The system of claim 5, wherein during the multiple points over which the output signals are combined, the object'"'"'s velocity varies over a predetermined range.

7. The system of claim 1, wherein the filters also provide a system output signal representative of changes in velocity of the object in the object'"'"'s body frame.

8. The system of claim 7, wherein the changes in velocity are used to provide an estimate of the object'"'"'s orientation.

9. The system of claim 5, wherein during the multiple points over which the output signals are combined, the object'"'"'s position varies over a predetermined range.

10. The system of claim 9, wherein the filters also provide a system output signal representative of changes in position of the object in the object'"'"'s body frame.

11. The system as in claim 9, wherein the changes in position is used to estimate the orientation of the object.

12. The system of claim 1, further comprising a second set of sensors, including a sensor which derives a position of the object in the predetermined reference frame, wherein at least one of the output signals of the first set of sensors represents measurements of the position of the object in the object'"'"'s body frame, and wherein one or more of the positions of the object measured in the object'"'"'s body frame and one or more of the derived positions of the object in the predetermined reference frame are used to determine the object'"'"'s orientation.

13. The system of claim 5, wherein the filters track and maintain substantially equal changes of error in the derived gravity vector and changes of error in a sensed rotation.

14. The system of claim 5, wherein one or more of the output signals represent measurements of acceleration and wherein the filters maintain a ratio between a magnitude of the derived gravity vector and a magnitude of the measured acceleration a given time point to less than a predetermined value.

15. The system of claim 14, wherein the filters reduce the predetermined value over time.

16. The system of claim 1, wherein the filters have coefficients that are determined by simulation.

17. The system of claim 1, wherein the filters have coefficients that are determined empirically.

18. The system of claim 1, wherein the filters comprise FIR filters.

19. The system of claim 18, wherein the filters have states that are updated between iterations.

20. The system of claim 18, wherein the filters minimize an error in the orientation of the object.

21. The system of claim 1, further comprising a sensor which derives the Earth'"'"'s magnetic vector in the predetermined reference frame, wherein at least one of the vectors represented by the output signals of the first set of sensors is compared with the derived magnetic vector in the predetermined reference frame to determine the object'"'"'s orientation.

22. The system of claim 1, wherein the output signals of the first set of sensors are first aligned in the object'"'"'s body frame at one of the multiple time points before being combined in the filters to provide the system output signal.

23. The system of claim 1, wherein the first set of sensors include at least one accelerometer.

24. The system of claim 1, wherein the rotation sensor comprises one or more gyroscopes.