System and method for measuring position and orientation using distortion-compensated magnetic fields
View Patent ↗An electromagnetic tracking system and a distortion compensation method that utilize a lead-lag network model to compensate for position and orientation distortion caused by eddy currents formed in one more conductive distorters located within a tracking environment during electromagnetic tracking of one or more objects. The method is adaptive relative to the amount of distortion cause by the conductive distorters.
1. A computer readable storage medium containing computer-executable instructions for determining the location of an object using a tracking system having a distortion threshold, said computer-executable instructions comprising:
a first set of computer-executable instruction for collecting magnetic field data from at least one sensor, said magnetic field data containing frequency data for at least one frequency;
a second set of computer-executable instructions for processing said frequency data so as to obtain a real response component and an imaginary response component for said at least one frequency; and
a third set of computer-executable instructions for determining whether to compensate for magnetic field distortion as a function of said real response component, said imaginary response component and the distortion threshold;
wherein the distortion threshold is a function of a norm of residuals and said third set of computer-executable instructions includes instructions for comparing to the distortion threshold a ratio of said imaginary component to said real component.
2. A computer readable storage medium according to claim 1 , further comprising a fourth set of computer-executable instructions for compensating, when said ratio is no less than said distortion threshold, for magnetic field distortion based on a representation of said frequency data comprising at least one lead-lag network having a plurality of parameters.
3. A computer readable storage medium according to claim 2 , further comprising:
a) a fifth set of computer-executable instructions for calculating, when said ratio is no less than said distortion threshold, said plurality of parameters and a norm that is a function of said parameter; and
b) a sixth set of computer-executable instructions for comparing said norm to said distortion threshold.
4. A computer readable storage medium according to claim 3 , further comprising a seventh set of computer-executable instructions for calculating an adjusted B-field when said norm is less than said distortion threshold.
5. A computer readable storage medium according to claim 3 , further comprising an eighth set of computer-executable instructions for compensating for magnetic field distortion based on a representation of said frequency data comprising at least two lead-lag networks when said norm is not less than said distortion threshold.