Non-concentricity compensation in position and orientation measurement systems
First Claim
1. An apparatus for determining the position and orientation of a remote object relative to a reference coordinate frame comprising:
- a source having a plurality of field-generating elements for generating electromagnetic fields, said generating elements having spatially independent components defining a source reference coordinate frame;
a driver for applying to said plurality of field-generating elements signals which generate a plurality of electromagnetic fields, said electromagnetic fields being distinguishable from one another;
a remote sensor having a plurality of field-sensing elements for sensing said generated electromagnetic fields, said sensor being disposed on a remote object and said field-sensing elements having spatially independent components for detecting each of said generated electromagnetic fields and defining a sensor reference coordinate frame; and
a processor for processing the outputs of said field-sensing elements into remote object position and orientation relative to said source reference coordinate frame, wherein said processor compensates said position and orientation as a function of displacement of said spatially independent components of said field-generating elements from said source reference coordinate frame or of said spatially independent components of said field-sensing elements from said sensor reference coordinate frame.
2 Assignments
0 Petitions
Accused Products
Abstract
A method and apparatus for determining the position and orientation of a remote object relative to a reference coordinate frame includes a source having a plurality of field-generating elements for generating electromagnetic fields, a drive for applying, to the generator element, signals that generate a plurality of electromagnetic fields that are distinguishable from one another, a remote sensor having a plurality of field-sensing elements for sensing the fields generated by the source, and a processor for processing the outputs of the sensing elements into remote object position and orientation relative to the source reference coordinate frame. The processor compensates the position and orientation values as a function of displacement of either the field-generating elements from a common center, or the field-sensing elements from a common center, or both. Techniques are disclosed for compensating for small-scale non-concentricity in order to overcome imperfections in the orthogonal coil sets wound on a common core, each set defining the source or the sensor. Techniques are also disclosed for compensating for large-scale non-concentricity to allow physical separation of the coil set defining the source or the sensor to dispersed locations that may be more desirable for a particular application.
378 Citations
21 Claims
-
1. An apparatus for determining the position and orientation of a remote object relative to a reference coordinate frame comprising:
-
a source having a plurality of field-generating elements for generating electromagnetic fields, said generating elements having spatially independent components defining a source reference coordinate frame; a driver for applying to said plurality of field-generating elements signals which generate a plurality of electromagnetic fields, said electromagnetic fields being distinguishable from one another; a remote sensor having a plurality of field-sensing elements for sensing said generated electromagnetic fields, said sensor being disposed on a remote object and said field-sensing elements having spatially independent components for detecting each of said generated electromagnetic fields and defining a sensor reference coordinate frame; and a processor for processing the outputs of said field-sensing elements into remote object position and orientation relative to said source reference coordinate frame, wherein said processor compensates said position and orientation as a function of displacement of said spatially independent components of said field-generating elements from said source reference coordinate frame or of said spatially independent components of said field-sensing elements from said sensor reference coordinate frame. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. An apparatus for determining the position and orientation of a remote object relative to a reference coordinate frame comprising:
-
a source for generating electromagnetic fields, said source having spatially independent components defining a source reference coordinate frame; a driver for applying to said source signals which generate a plurality of electromagnetic fields, said electromagnetic fields being distinguishable from one another; a remote sensor having a plurality of field-sensing antennas displaced from a sensor common center for sensing said generated electromagnetic fields, said remote sensor being disposed on a remote object and said field-sensing antennas having spatially independent components defining a sensor reference coordinate frame; and a processor for processing outputs of said field-sensing antenna into remote object position and orientation of said remote sensor relative to said source reference coordinate frame, wherein said processor compensates said position and orientation as a function of non-concentricity of said field-sensing antennas with respect to said sensor common center. - View Dependent Claims (9, 10, 11, 12, 13)
-
-
14. A method of determining the position and orientation of a remote object relative to a reference coordinate frame comprising:
-
providing a source including a plurality of field-generating elements for generating electromagnetic fields, said field-generating elements having spatially independent components defining a source reference coordinate frame; applying multiplexed electrical signals to said field-generating elements and thus generating a set of distinguishable electromagnetic fields; providing a remote sensor including a plurality of field-sensing elements disposed on a remote object and having spatially independent components defining a sensor reference coordinate frame, sensing said electromagnetic fields and generating a set of signals that is representative of the sensed components of said electromagnetic fields; and processing said set of signals into remote object position and orientation in said reference coordinate frame including compensating for one of (a) displacement of at least one of said components of said field-generating elements from said source reference coordinate frame and (b) displacement of at least one of said field-sensing elements from said sensor reference coordinate frame. - View Dependent Claims (15, 16, 17, 18, 19)
-
-
20. A method for determining the position and orientation of a remote object relative to a reference coordinate frame comprising:
-
providing a source including a plurality of field-generating antennas for generating electromagnetic fields, said field-generating antennas having spatially independent components defining a source reference coordinate frame; applying multiplexed electrical signals to said field-generating antennas and thus generating a set of distinguishable electromagnetic fields; providing a remote sensor including a plurality of field-sensing antennas disposed on a remote object and having spatially independent components for defining a sensor reference coordinate frame, sensing said electromagnetic fields and generating a set of signals that is representative of the sensed components of said electromagnetic fields; processing said set of signals into remote object position and orientation in said reference coordinate frame including compensating as a function of non-concentricity of said components of said field-generating antennas with respect to a common center thereof or of non-concentricity of said components of said field-receiving antennas with respect to a common center thereof by; establishing a signal matrix S representative of the received components of said electromagnetic fields; calculating ##EQU21## where k is a scalar constant; ai is a vector pointing along the sensor'"'"'s ith receiving axis;
##EQU22## rij is a vector representative of the position of the sensor'"'"'s ith coil relative to the source'"'"'s jth coil;rij is the magnitude of the vector rij ; r is a vector representative of the position of the sensor; r is the magnitude of the vector r; I is the identity matrix; mj is a vector pointing along the source'"'"'s magnetic moment axis; adjusting said signal matrix as a function of
-
-
21. A method for determining the position and orientation of a remote object relative to a reference coordinate frame comprising:
-
providing a source including a plurality of field-generating antennas for generating electromagnetic fields, said field-generating antennas having spatially independent components defining a source reference coordinate frame; applying multiplexed electrical signals to said field-generating antennas and thus generating a set of distinguishable electromagnetic fields; providing a remote sensor including a plurality of field-sensing antennas disposed on a remote object and having spatially independent components for defining a sensor reference coordinate frame, sensing said electromagnetic fields and generating a set of signals that is representative of the sensed components of said electromagnetic fields; processing said set of signals into remote object position and orientation in said reference coordinate frame including compensating as a function of non-concentricity of said components of said field-generating antennas with respect to a common magnetic center thereof or of non-concentricity of said components of said field-receiving antennas with respect to a common magnetic center thereof by; establishing a signal matrix S representative of the received components of said electromagnetic fields; calculating ##EQU23## where k is a scalar constant; ai is a vector pointing along the sensor'"'"'s ith receiving axis;
##EQU24## rij is a vector representative of the position of the sensor'"'"'s ith coil relative to the source'"'"'s jth coil;rij is the magnitude of the vector rij ; r is a vector representative of the position of the sensor; r is the magnitude of the vector r; I is the identity matrix; mj is a vector pointing along the source'"'"'s magnetic moment axis; adjusting said signal matrix as a function of Δ
sij.
-
Specification