System for three dimensional positioning and tracking

• US 6,691,074 B1
• Filed: 02/08/2001
• Issued: 02/10/2004
• Est. Priority Date: 02/08/2001
• Status: Expired due to Fees

• Current Assignee: Mineral Lassen LLC (Intellectual Ventures LLC)
• Original Assignee: Netmore Limited
• Inventors: Moriya, Netzer, Primak, Harel, Itzkovich, Moti
• Primary Examiner(s): Barlow, John
• Assistant Examiner(s): LAU, TUNG S
• Application Number:
  US09/778,718
• Time in Patent Office: 1,097 Days
• Field of Search: 702/190, 342/457, 607/30, 340/573, 600/543, 360/78.07, 356/141.1, 701/207
• US Class Current: 702/190
• CPC Class Codes: G06T 7/277 involving stochastic approaches, e.g. using Kalman filters
• CPC Class Codes: G06V 40/23 Recognition of whole body movements, e.g. for sport training

Abstract

A system for tracking and positioning a moving object, the system including a plurality of transmitters operative to transmit alternating electromagnetic fields within a three-dimensional space and at least one sensor arranged to be fixed to at least one corresponding portion of a moving object whose position it is sought to monitor. Each of said at least one sensors includes an electromagnetic field receiver having at least one active axis and operative to receive at least one component, lying along the at least one active axis respectively, of the alternating electromagnetic fields, an accelerometer to independently measure at least one component of the acceleration of the moving object; and a digital signal processor. The digital signal processor is adapted to store at least one characteristic of the electromagnetic fields as received by the electromagnetic field receiver, and at least one characteristic of the acceleration as measured by the accelerometer, and to transmit the stored characteristics to a Kalman filter, and to compute therefrom an estimate of at least one component of the position and orientation of the moving object.

Claims

1. A system for indicating a disturbance in an electromagnetic field, the system comprising:

a plurality of transmitters operative to transmit a corresponding plurality of alternating electromagnetic fields within a three-dimensional space; and

at least one sensor arranged to be fixed to at least one corresponding portion of a moving object whose position it is sought to monitor, each of said at least one sensors comprising;

an electromagnetic field receiver having at least one active axis and operative to receive at least one component, lying along the at least one active axis respectively, of each of the plurality of alternating electromagnetic fields;

an accelerometer operative to independently measure at least one component of the acceleration of the moving object; and

a digital signal processor for storing at least one characteristic of each of the plurality of electromagnetic fields as received by the electromagnetic field receiver, and at least one characteristic of the acceleration as measured by the accelerometer,

wherein said digital signal processor is adapted to

transmit the at least one stored characteristic of each of the plurality of electromagnetic fields to a Kalman filter and calculate therefrom a first estimate of at least one component of the position and orientation of the moving object;

transmit the at least one stored characteristics of each of the plurality of electromagnetic fields and the at least one characteristic of the acceleration as measured by the accelerometer to the Kalman filter, and calculate therefrom a second estimate of at least one component of the position and orientation of the moving object; and

compare said first and second estimates for a discrepancy indicating a disturbance in the electromagnetic field,

wherein a discrepancy indicating a disturbance in the electromagnetic field comprises a discrepancy of greater than the expected absolute accuracy of the measurement of the position and orientation of the moving object.

2. A system according to claim 1 wherein said digital signal processor compares said first and second estimates for a discrepancy indicating a disturbance in the electromagnetic field on a periodic basis.

3. A system according to claim 1 wherein said at least one component of the position of the moving object comprises at least two components.

4. A system according to claim 3 wherein said at least two components of the position of the moving object comprise three components.

5. A system according to claim 1 wherein said at least one component of the position of the moving object is selected from the group consisting of the x, y, and z coordinates of the moving object.

6. A system according to claim 1 wherein said at least one component of the acceleration of the moving object comprises at least two components.

7. A system according to claim 6 wherein said at least two components of the acceleration of the moving object comprise three components.

8. A system according to claim 1 wherein said at least one component of the acceleration of the moving object is selected from the group consisting of the a_x, a_y, and a_z acceleration components of the moving object.

9. A system according to claim 1 wherein the Kalman filter calculating the second estimate of at least one component of the position and orientation of the moving object employs at least one estimate of an acceleration value'"'"'s components in order to compute an estimate of said at least one component of the moving object'"'"'s position and orientation, and wherein the Kalman filter employs said at least one independently measured component of the acceleration of the moving object as said at least one estimated acceleration value'"'"'s components, rather than deriving said at least one estimated acceleration value'"'"'s components from the electromagnetic field information.

10. A system according to claim 9 wherein employing said at least one independently measured component of the acceleration of the moving object as said at least one estimated acceleration value'"'"'s components improves the accuracy of the estimate of the at least one component of the position and orientation of the moving object.

11. A system according to claim 9 wherein the electromagnetic field receiver comprises a single axis electromagnetic field receiver, and wherein the accelerometer is attached thereto, such that employing said at least one independently measured component of the acceleration of the moving object as said at least one estimated acceleration value'"'"'s components provides information about the axial rotation of the moving object.

24. A system according to claim 1 wherein an electromagnetic interaction occurs between each of the plurality of transmitters, and at least one sensor, and wherein the digital signal processor is also operative to extract the strength of the electromagnetic interaction between each of the plurality of transmitters and at least one sensor, from the electromagnetic signal received by the at least one sensor.

25. A system according to claim 1 wherein said digital signal processor comprises an envelope detector module operative to determine received signed envelope amplitude values for each of a plurality of electromagnetic signals received from the plurality of transmitters;

and

a position determination unit operative, based on the signed amplitude values determined by the envelope detector module, to provide an output indication of the positions of each electromagnetic field receiver.

26. A system according to claim 25 wherein said envelope detector module comprises a plurality of envelope detectors each including a phase locked loop, (PLL).

12. A method for indicating a disturbance in an electromagnetic field, the method comprising:

positioning a plurality of transmitters operative to transmit alternating electromagnetic fields within a three-dimensional space; and

affixing at least one sensor to at least one corresponding portion of a moving object whose position it is sought to monitor, each of said at least one sensor comprising;

an electromagnetic field receiver having at least one active axis and operative to receive at least one component, lying along the at least one active axis respectively, of the alternating electromagnetic fields; and

an accelerometer operative to independently measure at least one component of the acceleration of the moving object;

storing at least one characteristic of the electromagnetic fields as received by the electromagnetic field receiver, and at least one characteristic of the acceleration as measured by the accelerometer,

transmitting the at least one stored characteristic of the electromagnetic fields to a Kalman filter and calculating therefrom a first estimate of at least one component of the position and orientation of the moving object;

transmitting the at least one stored characteristic of the electromagnetic field and the at least one characteristic of the acceleration as measured by the accelerometer to the Kalman filter, and calculating therefrom a second estimate of at least one component of the position and orientation of the moving object; and

comparing said first and second estimates for a discrepancy indicating a disturbance in the electromagnetic field,

wherein a discrepancy indicating a disturbance in the electromagnetic field comprises a discrepancy of greater than the expected absolute accuracy of the measurement of the position and orientation of the moving object.

13. A method according to claim 12 wherein said comparing said first and second estimates for a discrepancy indicating a disturbance in the electromagnetic field occurs on a periodic basis.

14. A method according to claim 12 wherein said at least one component of the position of the moving object comprises at least two components.

15. A method according to claim 14 wherein said at least two components of the position of the moving object comprise three components.

16. A method according to claim 12 wherein said at least one component of the position of the moving object is selected from the group consisting of the x, y, and z coordinates of the moving object.

17. A method according to claim 12 wherein said at least one component of the acceleration of the moving object comprises at least two components.

18. A method according to claim 17 wherein said at least two components of the acceleration of the moving object comprise three components.

19. A method according to claim 12 wherein said at least one component of the acceleration of the moving object is selected from the group consisting of the a_x, a_y, and a_z acceleration components of the moving object.

20. A method according claim 12 wherein calculating the second estimate of at least one component of the position and orientation of the moving object comprises employing at least one estimate of an acceleration value'"'"'s components in order to compute an estimate of said at least one component of the moving object'"'"'s position and orientation, and employing said at least one independently measured component of the acceleration of the moving object as said at least one estimated acceleration value'"'"'s components, rather than deriving said at least one estimated acceleration value'"'"'s components from the electromagnetic field information.

21. A method according to claim 20 wherein employing said at least one independently measured component of the acceleration of the moving object as said at least one estimated acceleration value'"'"'s components improves the accuracy of the estimate of the at least one component of the position and orientation of the moving object.

22. A method according to claim 20 wherein the electromagnetic field receiver comprises a single axis electromagnetic field receiver, and wherein the accelerometer is attached thereto, such that employing said at least one independently measured component of the acceleration of the moving object as said at least one estimated acceleration value'"'"'s components provides information about the axial rotation of the moving object.

23. A method according to claim 12 wherein said plurality of transmitters are operative to transmit a corresponding plurality of alternating electromagnetic fields within a three-dimensional space,

said electromagnetic field receiver is operative to receive at least one component, lying along the at least one active axis respectively, of each of the plurality of alternating electromagnetic fields; and

said storing step comprising storing at least one characteristic of each of the plurality of electromagnetic fields as received by the electromagnetic field receiver.