Multi sensor position and orientation measurement system

• US 9,024,772 B2
• Filed: 09/28/2011
• Issued: 05/05/2015
• 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): Swarthout, Brent
• Application Number:
  US13/248,022
• Publication Number:
  US 20120075109A1
• Time in Patent Office: 1,315 Days
• Field of Search: 340/686.1, 33319-321, 731/49, 73/13.8, 367/118, 702/104, 702/150, 702/151, 463/37
• US Class Current: 340/686.1
• 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 is invented to combine different signals from various sensors together so that an object (such as a car, an airplane etc.)'"'"'s position and/or orientation can be measured.

Claims

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

a first set of sensors comprising one or more sensors providing output signals each representative of a measurement of motion relative to the object'"'"'s body frame, wherein one or more of the sensors measure at least one vector in the object'"'"'s body frame, such sensors including one or more rotation sensors; and

a signal combiner combining the output signals of the first set of sensors over multiple time points, and processing the result of the combination to provide a measurement of velocity, position or orientation.

2. A system as in claim 1, wherein output signals from the sensors that measure at least one vector in the object'"'"'s body frame are combined together.

3. A system as in claim 2, wherein the output signals from the sensors that measure at least one vector in the object'"'"'s body frame are combined together after being aligned to a predetermined reference frame.

4. A system as in claim 3, wherein the output signals from the sensors that measure at least one vector in the object'"'"'s body frame are combined together after aligning the measured vectors at the multiple time points to the object'"'"'s body frame at a predetermined time.

5. A system as in claim 4, wherein the combined output signals are processed in the signal combiner to determine the orientation.

6. A system as in claim 5, wherein the position is also obtained.

7. A system as in claim 6, further comprising a second set of sensors comprising one or more sensors providing output signals representative of measurements of the velocity, the position or the orientation relative to a global reference frame, wherein the position is obtained by combining a position obtained from the output signals from sensors in the first set of sensors and one or more positions obtained from the output signals of sensors in the second set of sensors.

8. A system as in claim 6, wherein the position is obtained by combining a position obtained from the output signals from sensors in the first set of sensors rotated to align with the global reference frame and a position obtained from the sensors in the second set of sensors in the global reference frame.

9. A system as in claim 7, wherein the position combination is performed using a recursive update filter.

10. A system as in claim 9, wherein the recursive update filter comprises a Kalman filter.

11. A system as in claim 9, wherein the recursive update filter uses at least one combined aligned vector as a state variable.

12. A system as in claim 3, wherein the sensors that measure at least one vector in the object'"'"'s body frame comprise accelerometers.

13. A system as in claim 4, wherein the sensors that measure at least one vector in the object'"'"'s body frame comprise accelerometers.

14. A system as in claim 1, wherein the measurement of motion comprises a measurement of acceleration.

15. A system as in claim 1, wherein the rotation sensors comprise one or more gyroscopes.