This invention relates generally to AC magnetic tracking systems and, in particular, to methods and apparatus for eddy current compensation in such systems.
Position and orientation tracking systems (“trackers”) are well known in the art. For example, U.S. Pat. Nos. 4,287,809 and 4,394,831 to Egli et al.; U.S. Pat. No. 4,737,794 to Jones; U.S. Pat. No. 4,314,251 to Raab; and U.S. Pat. No. 5,453,686 to Anderson, are directed to AC electromagnetic trackers. U.S. Pat. No. 5,645,077 to Foxlin discloses an inertial system, and combination systems, consisting or two different trackers, such as optical and magnetic, are described in U.S. Pat. No. 5,831,260 to Hansen and U.S. Pat. No. 6,288,785 B1 to Frantz et al. Other pertinent references include U.S. Pat. No. 5,752,513 to Acker et al. and U.S. Pat. No. 5,640,170 to Anderson.
AC electromagnetic trackers have definite advantages over other types of systems. For one, AC trackers provide the highest solution/update rate with the greatest accuracy, not affected by obstructed field of view, in contrast to optical solutions. AC trackers do not require reference sensor/unit and drift stable apparatus of the type required by inertial units, and they are not affected by the Earth's magnetic field and the magnetization of ferrous materials, in contrast to DC magnetic systems.
The main disadvantage of AC trackers is that they are quite susceptible to distortion due to eddy currents in conductive materials in or near the motion box where precise tracking is desired. Eddy currents are a major cause of magnetic tracker inaccuracy. Methods of dealing with the problem are various. One method is to create a map of measured transmitter-receiver coordinates versus known coordinates. This method works very well in terms of accuracy achieved, but special fixturing is required and once performed the environment cannot be altered.
A pulsed DC tracker uses a method of sequencing DC current pulses to the transmitter then waiting during each pulse for eddy current effects to decay before recording field measurements. This method offers only slow update capability and suffers from earth's magnetic field interference and noise associated with low frequency powered appliances and equipment.
Yet another tracker method uses very low AC frequencies where eddy current interference is a small part of the tracker fields, but like the pulsed DC method, suffers from slow update capability and susceptibility to low frequency noise. Still another tracker method models eddy current conductors to compensate for measured fields enabling the use of tracker frequencies well above equipment and appliance noise band. This tracker method works well in the sense that it avoids the low frequency noise band, but it does not work well in the sense that it requires two tracker modes—a normal tracker operation mode and an environment testing mode complete with additional hardware. The testing mode suspends normal tracker operation while measurements of extended conductor characteristics are made using geophysics techniques.
A widely used technique for dealing with magnetic field distortion is to map the operating area of the tracker. In this approach, the system is set up with a fixed transmitter location that produces a known area of operation for the tracker. The operating area is then broken into a three-dimensional grid, and magnetic field data are gathered for each point in the grid. The gathered data provides a direct relationship between field data and position that is then used to compensate for the distorted environment using a variety of well known computational methods. This approach works well for moderately distorted environments but requires special equipment and extensive on-site preparation to generate the map. Changes of the operating area that significantly affects accuracy may require remapping.
U.S. Pat. No. 6,172,499 is directed to an AC magnetic position measurement system that compensates for eddy current distortion by taking advantage of the fact that the quadrature term of the sensor response is determined solely by the secondary field. The system measures the in-phase (I) and quadrature (Q) components for two different frequencies and uses them to select a compensation coefficient from a look up table. The compensation coefficient is used to scale the quadrature term (Q) before it is subtracted from the in-phase (I) term. The in-phase term (I) is then used for the position calculation. This algorithm is repeated for each axis of the system, requiring six separate frequencies for the highest resolution system. A second three frequency system is also proposed which reduces the system complexity but at the cost of reduced accuracy of the compensation coefficient. This method does not address the induced magnetization of ferrous materials and requires two separate frequencies for each axis unless reduced accuracy is acceptable.
U.S. Pat. No. 6,528,989 compensates for conductive distortion by computing a correction term based on the inductive limit and phase delay of the environment. The inductive limit and phase delay are calculated using either DC pulse measurements or multiple AC frequencies. Relevant theory can be found in Grant, F. S., and West, G. F., 1965 Interpretation Theory in Applied Geophysics (McGraw-Hill Book Company). The use of DC pulse measurements severely limits the throughput rate of the tracker due to the extended period of time required for eddy currents to decay (˜5 ms according to the author). The multiple frequency technique uses a wide range of frequencies in the magnetic field, requiring the use of a non-resonant transmitter which effectively limits the output power of the system which in turn limits useful range.
Despite these advances, the need remains for apparatus and methods of compensation for spurious, eddy-current-induced fields in AC electromagnetic tracking systems.
This invention resides in techniques for compensating for magnetic field distortion causes inaccuracy in the data in an AC magnetic tracker. Broadly, a characteristic frequency in the distortion environment is utilized to extract distortion components from the tracker receiver signals so that the corrected position and orientation can be calculated. A multiplicity of alternative techniques for determining this characteristic frequency are disclosed, several of which can be done during operation without interrupting system operation while others can be done off-line. The invention also allows the use of a tuned tracker transmitter since it does not need to operate at multiple frequencies.
While the disclosed method also incorporates eddy current models, it differs from the prior art by treating an extended conductor characteristic as just another unknown. The position and orientation algorithm solves the 6 unknown coordinates of position and orientation plus the one more unknown—the extended conductor characteristic frequency. This enables the tracker to operate full time in one mode of operation without ever suspending normal operation and without additional hardware capabilities.
While methods for solving fp using only normal tracker field data are disclosed, alternative algorithms exist not only for the approximately collocated antenna sets discussed but for other antenna configurations as well. Those skilled in the art will appreciate the application of these teachings to other antenna configurations.
Magnetic trackers operate by transmitting low frequency magnetic fields with one antenna and receiving said fields on a second antenna. The position and orientation (P&O) coordinates of one antenna relative to the other are calculated from these measurements based on equations modeling the unique tracker field structure. But eddy currents in nearby extended conductors give rise to magnetic fields that distort the modeled field structure and reduce P&O accuracy.
This invention relates to the compensation of eddy current field distortion in AC magnetic trackers. By broadening the field model to incorporate the extended conductor field and increasing the number of variables in the P&O calculations, eddy current distortion compensation is realized. The new method avoids special operating modes and hardware that suspend normal tracker operation.
A typical tracker system (
Received voltages divided by current are processed and, with a somewhat involved mathematical algorithm running in processor (3), are solved for the 6 coordinates of transmitter-receiver position and orientation. The receiver signal conditioning circuit (6) may use discrete Fourier transform or other technology known to those skilled in the art to produce in-phase and quadrature frequency components. AC tracker antennas often consist of a triad of wire coils wound about orthogonal axes and are generally collocated, or they may be separated and coplanar. Many other configurations are possible. Flux gate, Hall-effect, or magneto-resistive components to sense the fields may be used in some applications. Other means of winding coils such as printed circuit board trace may serve well in limited applications. For the present, the triad of collocated orthogonal coils will be used to describe the invention, but this should not be considered as a limitation of the invention.
In addition to inducing voltages in the receiver, the transmitter magnetic fields (9) (see
The equivalent lumped parameter circuit of the extended conductor considered here includes resistance and inductance in series. The corner or characteristic frequency, a point in the frequency domain where resistance is equal to inductive reactance, is by convenience labeled fp. As we will show, fp completely characterizes the interference of diamagnetic and paramagnetic extended conductors. Generally fp is unknown, but it can be solved along with the 6 coordinates of position and orientation in a single concurrent algorithm. Once known, fp determines a compensation factor which, used in conjunction with the imaginary part of the signal, corrects for eddy current effects and improves P&O accuracy.
There are 9 coupling terms for a three-element transmitter and a three-element receiver. The coupling terms or mutual inductances are measured by dividing each of the received voltages by the time derivative of each transmitter current. Frequency-division multiplexed trackers require Fourier transform technology to separate the frequency components in the three received voltages. Algorithms for solving the P&O coordinates are taught in U.S. Pat. Nos. 4,737,794 and 5,307,072, the entire content of both being incorporated herein by reference. What follows is an analysis of extended conductor interference to one of these mutual inductances.
Let index “1” designate an arbitrary transmitter element—coil or loop. The element is driven with harmonically varying current i1 ejωt. Let index “2” denote an arbitrary receiver element—oil or loop. The receiver loop is modeled as an open loop since in practice receiver elements are often fed to high input impedance preamplifiers. Thus its current, i2, is zero. Let index 1 “3” designate a loop for the modeling of a non-ferrous extended conductor. R1, R2, and R3 are the resistances of loops 1, 2, and 3, respectively, and L11, L22, and L33 are their self-inductances. L12, L13, and L23 are the mutual inductances that account for the magnetic coupling between loops. The object is to accurately measure L12 the mutual inductance between transmitter loop 1 and receiver loop 2 (and ultimately the L12's of all nine terms); however, interference from eddy current loop 3 complicates the problem.
The following system of equations is a steady state expression for three inductively coupled loops. Loop terminal voltages are designated with v's and explicit harmonic dependency terms are omitted.
By design or measurement i1 (transmitter current) is known, v2 (receiver voltage) is measured, ω=2πf is known, i2 (receiver current) is zero (open loop), and V3 is zero (closed loop, Kirchhoff's voltage equation). Solving for v2 divided by jωi1 (the time derivative of driver current), yields
In the absence of an extended conductor L13 and L23 are zero, and L12 is accurately revealed; but, in its presence L13 and L33 may not be zero, and L12 is not isolated. Substituting s12=v2/jωi1 then separating the above into its real and imaginary parts yields,
Substituting fp=R3/2πL33, we note that the second term of the real part can be expressed as a simple factor times the imaginary part. Rearranging yields
This equation states that L12 can be recovered in the presence of a non-ferrous extended conductor by simply subtracting from the real part f/fp times the imaginary part.
The eddy current interference real and imaginary parts are rearranged, normalized, and plotted here.
The plot in
We note that processed noise of the compensation term increases by the factor f/fp, and that quality eddy current detection (indicated by the imaginary part) depends on the ability of tracker electronics to accurately discern in-phase and quadrature signals. Phase shift in current generation and signal reception electronics could be misinterpreted as eddy current distortion.
The above analysis applies to each of the 9 L12 terms of a tracker {tilde over (S)} matrix (we use a tilde to denote 3×3 matrices). Since all 9 terms are affected by the same extended conductor, the entire matrix is compensated in an identical manner.
{tilde over (S)}cmp=Re({tilde over (S)}msd)−f/fpIm({tilde over (S)}msd)
The msd subscript indicates a tracker measured signal matrix, while cmp represents a compensated signal matrix. The above equation applies to time-division multiplexed trackers. For frequency-division multiplexed trackers, where columns of {tilde over (S)}msd are collected at different frequencies, e.g. fx, fy, and fz, compensation takes on the form
Except for the very high frequencies mentioned above, it matters not where we choose to operate on the frequency curve. The three frequencies fx, fy, and fz may all be to the left of the peak (f/fp=1), all to the right, or grouped about the peak in any manner.
To understand how fp can be discovered using only tracker field structures, we briefly review the mutual inductance model of three element transmitters and receivers. Unit loop areas are assumed for both antennas for the sake of brevity. The model is
All matrices and scalar terms in this expression are real (no “j” terms). “Ô is receiver attitude, “{tilde over (P)}” is the position matrix, “r” is the distance between transmitter and receiver, μ0 is the permeability of free space, and “T” designates matrix transpose (see Jones '794 C4 L42-L59). Terms arising from loop aperture and non-concentricity are not shown. The details of how they are extracted from the measured signal matrix are explained in '794 and '072. Matrix “{tilde over (H)}” (see '794 C8 L5) has the form
The model is expanded to include eddy current distortion
Fp can be solved in a number of ways; we show 8 methods in the following paragraphs.
Method 1
The equation immediately above has seven variables (unknowns)—“Ô, attitude, represents three; “r”, range, represents one, “{tilde over (P)}”, position matrix, two; and fp, eddy current characteristic frequency, one more. Let matrix {tilde over (D)} represent the difference between measured and modeled.
{tilde over (D)}=Re({tilde over (S)}msd)−{tilde over (S)}mod
The problem statement is, given the 9 constraints Re({tilde over (S)}msd), solve the model's 7 unknowns that minimize the “l2-norm” of the difference between constraint and model, δ, in a least squares sense.
The non-linear problem can be solved by a great many minimization methods, one being the Levenberg-Marquardt method or LMM. For reference on its theory and application see Press et al. 1992, Numerical Recipes in C (Cambridge University Press) Chapter 15, or Moré et al. 1980, User Guide for MINPACK-1, Argonne National Laboratory Report ANL-80-74.
Method 2
A reduction in complexity is possible by constructing {tilde over (S)}cmpT{tilde over (S)}cmp. This matrix product, a function of fp, is independent of attitude Ã.
{tilde over (S)}cmpT{tilde over (S)}cmp=[Re({tilde over (S)}msd)−f/fpIm({tilde over (S)}msd)]T[Re({tilde over (S)}msd)−f/fpIm({tilde over (S)}msd)]
The matrix product is solved for position ({tilde over (P)} and r) as taught in '794 and '072.
Rearranging and accounting with {tilde over (D)} for the mismatch of the model due to an inexact fp yields
This effectively reduces the minimization algorithm to one dimension (one unknown) which can be solved by LMM or any number of simpler algorithms such as quadratic search. To start a quadratic search, guess three fp values, f0−Δf, f0, f0+Δf, for example 1500, 2000, 2500 Hz. Perform three trial compensations of the {tilde over (S)}msd matrix. Solve each for position according to the algorithms taught in Jones '072 and '794, reconstruct the {tilde over (P)} matrix, compute the expression immediately above subtracting {tilde over (H)}2, and solve for the three residual {tilde over (D)} matrices. Finally, find the “l2-norm” squared for each of the guessed fp's.
The object is to find the fp that minimizes δ. A reasonable approach is to use a Quadratic-Convergent Search without Derivatives [see Pierre, D. A.,1986 Optimization Theory with Applications (Dover Publications, Inc., New York), section 6-3]. Given δ1, δ2, δ3 corresponding to the three trial frequencies, respectively, an estimate of fp that minimizes δ is given by,
Care must be taken that the denominator is not zero or even small since the compensation factor may become too large. Care must also be taken to check that the denominator is positive else fp would evaluate a maximum δ and not a minimum. Much of this is avoided by bracketing fp—a low value of 200 Hz and a high value of 50,000 Hz is suggested.
All the above can be accomplished in the 1st tracker system update frame. On the 2nd tracker frame, choose three new trial frequencies based on the fp just calculated—fp−Δf, fp, fp+Δf. The process continues ad infinitum. By the 2nd or 3rd tracker frame (about 25 milliseconds for 120 Hz frame or update rates) fp should be exact. Since fp is not expected to change by more than 1 to 2 Hz from frame to frame even with fast transmitter-receiver motion, tracker solutions for the center frequency fp are always accurate and tracker operation is unaffected by a changing environment.
Method 3
In the event tracker throughput is insufficient to solve three positions in a single frame the workload per frame can be reduced to two solutions per frame. On even frame numbers solve only δ1 and δ2; on odd frames solve δ2 and δ3. Re-compute fp every other frame.
Method 4
In the event tracker throughput is insufficient to solve fp at all without degrading frame update rates, the following solution may be applied. In a special mapping mode the tracker update rate is reduced to permit sufficient time for fp and P&O solutions. The operation is as follows:
This method is identical to Method 4 except that no table or polynomial is downloaded. Instead just an averaged fp is determined and downloaded. The tracker uses the average regardless of what the actual fp may be. This is useful for limited tracker throughput in environments where fp changes but very little. Residual tracker errors could be mapped by traditional means with special fixtures. The benefit is high update rates with improved accuracy.
Method 6
Still another method uses two or more receivers. This method requires a special wand, paddle, or small fixture that has two or more receivers (transmitters) mounted such that their locations and/or orientations relative to one another are precisely known. Their coordinates relative to the transmitter (receiver) or anything else need not be known.
For example, suppose two receivers are mounted on the ends of a 6 inch wand. Let Ã1 and Ã2 be their orientation (attitude) matrices, and ÃK=Ã2TÃ1 be their known relative orientation. The wand is waved about as in Method 5. The absolute orientations are unknown at first because fp is unknown, but their relative orientations are known by construction. In a region of no distortion, the product Ã2TÃ1ÃKT would evaluate to the identity matrix regardless of how the wand is positioned or oriented; but, in a region of eddy current distortion, the product will be something other than the identity. Let the matrix {tilde over (α)} represent this error
{tilde over (α)}=Ã2 TÃ1ÃKT−Ĩ
Fp can be discovered by a method similar to Method 2. First compute the orientations of the two receivers with three trial fp, then find the fp that minimizes the norm of {tilde over (α)}. Quaternions may be used to represent attitude. The use of Euler angles is not recommended.
Method 7
A variation on Method 6 is to develop an error term of position or as a combination of position and orientation. The latter is discussed here. A rigid fixture is required with two or more receivers (transmitters) mounted at known positions and orientations relative to the fixture's reference frame. Find the point p0 that is the approximate center of “gravity” of the N receivers. This will ensure equal weighting of receiver P&O data. The position of the COG relative to the ith receiver (transmitter) is designated by vector {right arrow over (d)}i. In the transmitter's (receiver's) frame of reference the fixture's COG requires the additional information of ith receiver position and orientation. The relation {right arrow over (r)}0i={right arrow over (r)}i+Ãi{right arrow over (d)}i expresses this. In a perfect environment the {right arrow over (r)}0i for all N receivers (transmitters) will be equal. In a distorted magnetic field environment, they will differ. One possibility of forming an error term is to calculate a mean COG position vector.
Then form N difference vectors Δ{right arrow over (r)}i={right arrow over (r)}0i−{right arrow over (r)}mean, and sum their norms.
By a process like that of Method 2, minimize Δr in a least RMS sense.
Method 8
A final method is discussed. A single receiver (transmitter) is used in this method. Its orientation relative to the transmitter (receiver) must be known. Let ÃK be the known orientation. Distortion will make the measured orientation inaccurate. Its change can be quantified by the expression {tilde over (α)}=ÃKTÃ−Ĩ. Again, by a method such as described in Method 2, minimize|{tilde over (α)}|, the norm of the difference between attitude error and the identity matrix.
This application claims priority to U.S. Provisional Patent Application Ser. No. 60/567,385, filed Apr. 30, 2004, the entire content of which is incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
60567385 | Apr 2004 | US |