Difference between revisions of "6DOF Electromagnetic Tracker Construction HOWTO"
From NAMIC Wiki
m (Added patent reference and improved equation formatting) |
|||
(79 intermediate revisions by the same user not shown) | |||
Line 1: | Line 1: | ||
− | A basic 6DOF (six degrees of freedom) electromagnetic tracker | + | A basic 6DOF (six degrees of freedom: three of position and three of orientation) electromagnetic tracker can contain the parts shown in this block diagram, though there are many variations. [[File:6DOF_tracker_block_diagram.png]] |
− | * | + | * https://web.archive.org/web/20151002101401/http://home.comcast.net/~traneus/dry_emtrackertricoil.htm is an example of a breadboard 6DOF tracker. |
− | * | + | * Transmitter contains three colocated orthogonal coils. The coils are approximated as magnetic dipoles. |
− | * | + | * Receiver contains three colocated orthogonal coils. the coils are approximated as dipoles. |
+ | |||
+ | * [[Media:EM_tracker_classic_coil_trio.jpg]] Photo of classic coil trio used as transmitter or receiver. The three coils are wound on a black plastic cube about one centimeter on a side. | ||
+ | |||
+ | * [[http://rose.eu.org/2014/tag/plume Scroll down to see photo of hand-building a transmitter coil trio.]] | ||
+ | |||
+ | * [[Media:Dry_elphel_model_1_rcvr_coils.jpg]] Photo of crude handmade receiver coil trio using [[http://www.sonion.com Sonion]] T 20 AG telecoils. Each coil is ten millimeters long. | ||
+ | |||
+ | * Three transmitter coils times three receiver coils gives nine coil-coupling measurements, expressable as a 3x3 signal matrix, HFluxPerIMeasured. | ||
+ | |||
+ | * Each component of HFLuxPerIMeasured is the magnetic flux through one receiver coil (due to magnetic field H from transmitter coil), divided by the current I in one transmitter coil. HFLuxPerIMeasured has units of meters, and is a geometrical property of the coils' sizes, shapes, number of turns, ferromagnetic core (if any), positions, and orientations. [[EM_Tracker_HFluxPerI_Derivation | HFluxPerI coupling between two dipole coils]]. | ||
+ | |||
+ | * Algorithm software converts HFluxPerIMeasured to estimated receiver position and orientation, using direct-solution algorithm in Raab's 1981 paper or iterative solution in Raab etal's 1979 paper. | ||
+ | |||
+ | * Frederick H. Raab, "Quasi-Static Magnetic-Field Technique for Determining Position and Orientation", IEEE Transactions on Geoscience and Remote Sensing, Vol. GE-19, No. 4, October 1981, pages 235-243, describes closed-form algorithm for concentric-dipole coil trios. Position is calculated first, directly in cartesian coordinates. Orientation is then calculated. | ||
+ | |||
+ | * Frederick H. Raab, "Remote Object Position Locater", expired U.S. Patent 4,054,881. Describes frequency-multiplexed hardware. | ||
+ | |||
+ | * Frederick H. Raab, Ernest B. Blood, Terry O. Steiner, Herbert R. Jones, "Magnetic Position and Orientation Tracking System", IEEE Transactions on Aerospace and Electronic Systems, Vol. AES-15, No. 5, September 1979, pages 709-718, describes iterative algorithm for concentric-dipole coil trios, using small-angle approximation for changes in position and in orientation. Includes sensitivity matrix of magnetic couplings partial derivatives with respect to changes in position and orientation. | ||
+ | |||
+ | * Berthold K. P. Horn, "Closed-form solution of absolute orientation using unit quaternions", Journal of the Optical Society of America A, volume 4, April, 1987, pages 629-642, has algorithm for converting from orthonormal rotation matrices to quaternions. Note error: r[2][1] on page 641 is incorrect, while r[2][1] on page 643 is correct. | ||
+ | |||
+ | * [[File:Dry0097.c]] is a simulator program containing an implementation of Raab's algorithm. | ||
+ | |||
+ | * The software which calculates position and orientation from HFluxPerI measurements, is an example of realtime embedded computational electromagnetics. | ||
+ | |||
+ | * Needed HFluxPerI measurement accuracy can be calculated by a sensitivity analysis. As in Raab, Blood, Steiner, Jones, treating position in spherical coordinates gives one distance (called range, the distance between transmitter and receiver) and five angles. | ||
+ | |||
+ | * The electromagnetics results in the signal-to-noise ratio in the five angles being 3.4 times worse than the HFluxPerIMeasured signal-to-noise ratio, due to interactions between position errors and orientation errors. | ||
+ | |||
+ | * The electromagnetics results in the signal-to-noise ratio in range being 3 times better than the HFluxPerIMeasured signal-to-noise ratio, due to the inverse-cube law of dipole-dipole field coupling. | ||
+ | |||
+ | * [[6DOF_Electromagnetic_Tracker_Signal_to_Noise_Requirements_Calculation]] details calculating signal-to-noise ratio (SNR) from accuracy requirements. | ||
+ | |||
+ | * There is an inherent hemisphere ambiguity, since receiver at position = (Xo,Yo,Zo) and receiver at position = (-Xo,-Yo,-Zo) show identical HFluxPerIMeasured for identical orientations. This ambiguity can be resolved by using additional transmitter or receiver coils spaced away from the colocated transmitter or receiver coils. | ||
+ | |||
+ | * The receiver is normally kept on one side of the transmitter, to avoid the hemisphere ambiguity. | ||
+ | |||
+ | * The transmitter field on the unused side of the transmitter, can be eliminated by using a magnetic mirror: Reference expired U.S. patent 5,640,170, which references many older expired EM-tracker patents. | ||
+ | |||
+ | * Accuracy is poor for lined-up pose: receiver positioned on a transmitter-coil axis, with receiver oriented to make receiver-coil axes parallel with transmitter-coil axes. Some of the first-order partial derivatives go to zero in these cases, causing the position-and-orientation solution to separate into four separate partial solutions. | ||
+ | |||
+ | * Poses with poor tracking accuracy, should be good for coil characterization. Coil-characterization poses should be chosen based on electromagnetic theory, rather than on mechanical measurements. Use receiver positions close to transmitter, based on boundary-condition principles of EM theory. Receiver positions on both sides of transmitter (even if only one side is used in operation), are necessary to distinguish transmitter gain from transmitter nonconcentricity. [[EM_Tracker_Coil_Characterization]] has further discussion. | ||
+ | |||
+ | * The poor-accuracy poses can be reduced, by replacing the three-orthogonal-coil receiver with a receiver comprising four colocated coils (the transmitter remains three orthogonal coils). The four receiver coils point in the directions of the vertices of a regular tetrahedron. When the four-coil receiver is positioned on a transmitter-coil axis, with one receiver coil oriented parallel to a transmitter-coil axis, the remaining three receiver coils' axes cannot be parallel to transmitter-coil axes. | ||
+ | |||
+ | * Three transmitter coils times three receiver coils, gives nine coil-coupling measurements. These can be performed sequentially, partially sequentially and partially simultaneously, or all simultaneously. Sequential measurements simplify the electronics, but impair dynamic accuracy: When the receiver is moving, sequential measurements result in inconsistent datasets, leading to position and orientation dynamic errors. | ||
+ | |||
+ | * Receiver coil signals can be measured simultaneously or sequentially. Simultaneous measurements improve signal-to-noise ratio. | ||
+ | |||
+ | * Many designs used one operating frequency, driving the transmitter coils sequentially. Use of one frequency simplifies handling frequency-dependent effects. | ||
+ | |||
+ | * Multiple-frequency designs drive the three transmitter coils simultaneously, with sinewaves at three distinct frequencies. This improves signal-to-noise ratio by lengthening measurement time. | ||
* Operating frequencies are typically 30 Hz to 15000 Hz. 1000 Hz, 1300 Hz, and 1600 Hz are a good starting point. Higher frequencies give higher induced voltages, lower frequencies reduce error-causing eddy-current effects. | * Operating frequencies are typically 30 Hz to 15000 Hz. 1000 Hz, 1300 Hz, and 1600 Hz are a good starting point. Higher frequencies give higher induced voltages, lower frequencies reduce error-causing eddy-current effects. | ||
− | * Data-acquisition electronics measures the currents in the three transmitter coils, and measures the voltages induced in the three receiver coils. | + | * The transmitter coils are usually series tuned with capacitors. |
+ | |||
+ | * The transmitter-coil currents must be measured. The currents vary slowly due to coil heating, so currents can be measured periodically. | ||
+ | |||
+ | * Some designs use DC pulses to drive the transmitter coils, instead of AC frequencies. This simplifies driver design, but makes receiver signal recovery more difficult. Pulse-driven transmitter coils must be driven sequentially. | ||
+ | |||
+ | * Data-acquisition electronics measures the currents in the three transmitter coils, and measures the voltages induced in the three receiver coils. | ||
+ | |||
+ | * 24-bit audio ADCs have enough dynamic range to avoid the need for gain-switching. | ||
+ | |||
+ | * Avoid gain-switching, as the ratios of the gain states are not precisely-enough known. | ||
+ | |||
+ | * A six-ADC electronics can measure three transmitter-coil currents and three receiver-coil voltages continually and simultaneously. | ||
+ | |||
+ | * Add three more ADCs for each additional receiver coil trio. | ||
− | * A | + | * A four-ADC electronics can use one channel to measure the currents periodically over time (The currents change slowly as the transmitter coils warm up.), and three channels to measure the three voltages continually and simultaneously. |
− | * A | + | * A two-ADC system can measure currents sequentially with one ADC and voltages sequentially with the other ADC. |
− | * A single-ADC electronics can measure the currents and voltages sequentially | + | * A single-ADC electronics can measure the currents and voltages sequentially. |
− | * | + | * C. L. Dolph, "A current distribution for broadside arrays which optimizes the relationship between beam width and sidelobe level," Proc. IRE, Vol. 35, pp. 335-348, June, 1946. The original Dolph-Chebyshev window article. This window is capable of 140 dB rejection of out-of-band signals. |
− | * | + | * Albert H. Nuttall, "Some Windows with Very Good Sidelobe Behavior", IEEE Transactions on Acoustics, Speech, and Signal Processing 29 (1) 84-91, February 1981, doi:10.1109/TASSP.1981.1163506, "U.S. Government work not subject to U.S. copyright". The window in Figure 10 of this paper exhibits sidelobe peak, four DFT bins from the central peak, 91 dB down from the central peak (The window and its first through fifth derivatives are all continuous for all t, giving 42 dB/octave rolloff of the sidelobes) and is (for symmetrical limits |t|<=L/2, and zero for all t outside the limits): |
− | + | <tt> | |
+ | w(t) = (1/L)(10/32 + 15/32 cos(2pi t/L) + 6/32 cos(4pi t/L) + 1/32 cos(6pi t/L)) | ||
+ | </tt> | ||
+ | <br> | ||
− | * | + | * Expired U.S. Patent 4,109,199 describes the use of a calibration coil in the receiver to calibrate the gains of the electronics. |
+ | * More elaborate algorithms provide higher accuracy at the expense of much more computation. by modeling the non-dipole and/or non-concentric parts of the coils. Expired U.S. Patent 5,307,072 is an early example. | ||
+ | * C.A. Nafis, V. Jensen, L. Beauregard, P.T. Anderson, "Method for estimating dynamic EM tracking accuracy of Surgical Navigation tools", SPIE Medical Imaging Proceedings, 2006, reports low-cost accuracy-testing methods using a known-flat nonmagnetic surface (such as a granite surface plate). | ||
− | + | * A 6DOF tracker using four-coil printed-circuit transmitter and receiver (optimized for academic originality) is discussed in: Peter Traneus Anderson, "A Source of Accurately Calculable Quasi-Static Magnetic Fields", dissertation presented to the Faculty of the Graduate College of the University of Vermont, October 2001, stored here as three files: [[Media:AndersonPeterDissertation.pdf]] is the main body. [[Media:AndersonPeterDissertationReadme.pdf]] contains copyright license, additional comments, and four figures that are blank in the main body. [[Media:AndersonPeterDissertationFig14r1.jpg]] is the color original photo of two of the figures. Expired U.S. Patent 1,172,017 discloses a direct-conversion radio receiver. Peter intended to include this reference as reference 16 in his dissertation, but was unable to find the patent number before Google Patents existed, so made do with existing indirect reference 16. | |
− | + | * A 6DOF tracker using two transmitter coils (instead of three) can be built; Frederick Raab calls this [[6DOF_Two_State_Electromagnetic_Trackers|two-state excitation]] in his 1981 paper referenced above. Two-state trackers are severely limited, as they cannot track near the axis of the missing transmitter coil and cannot track near the plane of the two existing transmitter coils. | |
− |
Latest revision as of 22:27, 12 November 2017
Home < 6DOF Electromagnetic Tracker Construction HOWTOA basic 6DOF (six degrees of freedom: three of position and three of orientation) electromagnetic tracker can contain the parts shown in this block diagram, though there are many variations.
- https://web.archive.org/web/20151002101401/http://home.comcast.net/~traneus/dry_emtrackertricoil.htm is an example of a breadboard 6DOF tracker.
- Transmitter contains three colocated orthogonal coils. The coils are approximated as magnetic dipoles.
- Receiver contains three colocated orthogonal coils. the coils are approximated as dipoles.
- Media:EM_tracker_classic_coil_trio.jpg Photo of classic coil trio used as transmitter or receiver. The three coils are wound on a black plastic cube about one centimeter on a side.
- Media:Dry_elphel_model_1_rcvr_coils.jpg Photo of crude handmade receiver coil trio using [Sonion] T 20 AG telecoils. Each coil is ten millimeters long.
- Three transmitter coils times three receiver coils gives nine coil-coupling measurements, expressable as a 3x3 signal matrix, HFluxPerIMeasured.
- Each component of HFLuxPerIMeasured is the magnetic flux through one receiver coil (due to magnetic field H from transmitter coil), divided by the current I in one transmitter coil. HFLuxPerIMeasured has units of meters, and is a geometrical property of the coils' sizes, shapes, number of turns, ferromagnetic core (if any), positions, and orientations. HFluxPerI coupling between two dipole coils.
- Algorithm software converts HFluxPerIMeasured to estimated receiver position and orientation, using direct-solution algorithm in Raab's 1981 paper or iterative solution in Raab etal's 1979 paper.
- Frederick H. Raab, "Quasi-Static Magnetic-Field Technique for Determining Position and Orientation", IEEE Transactions on Geoscience and Remote Sensing, Vol. GE-19, No. 4, October 1981, pages 235-243, describes closed-form algorithm for concentric-dipole coil trios. Position is calculated first, directly in cartesian coordinates. Orientation is then calculated.
- Frederick H. Raab, "Remote Object Position Locater", expired U.S. Patent 4,054,881. Describes frequency-multiplexed hardware.
- Frederick H. Raab, Ernest B. Blood, Terry O. Steiner, Herbert R. Jones, "Magnetic Position and Orientation Tracking System", IEEE Transactions on Aerospace and Electronic Systems, Vol. AES-15, No. 5, September 1979, pages 709-718, describes iterative algorithm for concentric-dipole coil trios, using small-angle approximation for changes in position and in orientation. Includes sensitivity matrix of magnetic couplings partial derivatives with respect to changes in position and orientation.
- Berthold K. P. Horn, "Closed-form solution of absolute orientation using unit quaternions", Journal of the Optical Society of America A, volume 4, April, 1987, pages 629-642, has algorithm for converting from orthonormal rotation matrices to quaternions. Note error: r[2][1] on page 641 is incorrect, while r[2][1] on page 643 is correct.
- File:Dry0097.c is a simulator program containing an implementation of Raab's algorithm.
- The software which calculates position and orientation from HFluxPerI measurements, is an example of realtime embedded computational electromagnetics.
- Needed HFluxPerI measurement accuracy can be calculated by a sensitivity analysis. As in Raab, Blood, Steiner, Jones, treating position in spherical coordinates gives one distance (called range, the distance between transmitter and receiver) and five angles.
- The electromagnetics results in the signal-to-noise ratio in the five angles being 3.4 times worse than the HFluxPerIMeasured signal-to-noise ratio, due to interactions between position errors and orientation errors.
- The electromagnetics results in the signal-to-noise ratio in range being 3 times better than the HFluxPerIMeasured signal-to-noise ratio, due to the inverse-cube law of dipole-dipole field coupling.
- 6DOF_Electromagnetic_Tracker_Signal_to_Noise_Requirements_Calculation details calculating signal-to-noise ratio (SNR) from accuracy requirements.
- There is an inherent hemisphere ambiguity, since receiver at position = (Xo,Yo,Zo) and receiver at position = (-Xo,-Yo,-Zo) show identical HFluxPerIMeasured for identical orientations. This ambiguity can be resolved by using additional transmitter or receiver coils spaced away from the colocated transmitter or receiver coils.
- The receiver is normally kept on one side of the transmitter, to avoid the hemisphere ambiguity.
- The transmitter field on the unused side of the transmitter, can be eliminated by using a magnetic mirror: Reference expired U.S. patent 5,640,170, which references many older expired EM-tracker patents.
- Accuracy is poor for lined-up pose: receiver positioned on a transmitter-coil axis, with receiver oriented to make receiver-coil axes parallel with transmitter-coil axes. Some of the first-order partial derivatives go to zero in these cases, causing the position-and-orientation solution to separate into four separate partial solutions.
- Poses with poor tracking accuracy, should be good for coil characterization. Coil-characterization poses should be chosen based on electromagnetic theory, rather than on mechanical measurements. Use receiver positions close to transmitter, based on boundary-condition principles of EM theory. Receiver positions on both sides of transmitter (even if only one side is used in operation), are necessary to distinguish transmitter gain from transmitter nonconcentricity. EM_Tracker_Coil_Characterization has further discussion.
- The poor-accuracy poses can be reduced, by replacing the three-orthogonal-coil receiver with a receiver comprising four colocated coils (the transmitter remains three orthogonal coils). The four receiver coils point in the directions of the vertices of a regular tetrahedron. When the four-coil receiver is positioned on a transmitter-coil axis, with one receiver coil oriented parallel to a transmitter-coil axis, the remaining three receiver coils' axes cannot be parallel to transmitter-coil axes.
- Three transmitter coils times three receiver coils, gives nine coil-coupling measurements. These can be performed sequentially, partially sequentially and partially simultaneously, or all simultaneously. Sequential measurements simplify the electronics, but impair dynamic accuracy: When the receiver is moving, sequential measurements result in inconsistent datasets, leading to position and orientation dynamic errors.
- Receiver coil signals can be measured simultaneously or sequentially. Simultaneous measurements improve signal-to-noise ratio.
- Many designs used one operating frequency, driving the transmitter coils sequentially. Use of one frequency simplifies handling frequency-dependent effects.
- Multiple-frequency designs drive the three transmitter coils simultaneously, with sinewaves at three distinct frequencies. This improves signal-to-noise ratio by lengthening measurement time.
- Operating frequencies are typically 30 Hz to 15000 Hz. 1000 Hz, 1300 Hz, and 1600 Hz are a good starting point. Higher frequencies give higher induced voltages, lower frequencies reduce error-causing eddy-current effects.
- The transmitter coils are usually series tuned with capacitors.
- The transmitter-coil currents must be measured. The currents vary slowly due to coil heating, so currents can be measured periodically.
- Some designs use DC pulses to drive the transmitter coils, instead of AC frequencies. This simplifies driver design, but makes receiver signal recovery more difficult. Pulse-driven transmitter coils must be driven sequentially.
- Data-acquisition electronics measures the currents in the three transmitter coils, and measures the voltages induced in the three receiver coils.
- 24-bit audio ADCs have enough dynamic range to avoid the need for gain-switching.
- Avoid gain-switching, as the ratios of the gain states are not precisely-enough known.
- A six-ADC electronics can measure three transmitter-coil currents and three receiver-coil voltages continually and simultaneously.
- Add three more ADCs for each additional receiver coil trio.
- A four-ADC electronics can use one channel to measure the currents periodically over time (The currents change slowly as the transmitter coils warm up.), and three channels to measure the three voltages continually and simultaneously.
- A two-ADC system can measure currents sequentially with one ADC and voltages sequentially with the other ADC.
- A single-ADC electronics can measure the currents and voltages sequentially.
- C. L. Dolph, "A current distribution for broadside arrays which optimizes the relationship between beam width and sidelobe level," Proc. IRE, Vol. 35, pp. 335-348, June, 1946. The original Dolph-Chebyshev window article. This window is capable of 140 dB rejection of out-of-band signals.
- Albert H. Nuttall, "Some Windows with Very Good Sidelobe Behavior", IEEE Transactions on Acoustics, Speech, and Signal Processing 29 (1) 84-91, February 1981, doi:10.1109/TASSP.1981.1163506, "U.S. Government work not subject to U.S. copyright". The window in Figure 10 of this paper exhibits sidelobe peak, four DFT bins from the central peak, 91 dB down from the central peak (The window and its first through fifth derivatives are all continuous for all t, giving 42 dB/octave rolloff of the sidelobes) and is (for symmetrical limits |t|<=L/2, and zero for all t outside the limits):
w(t) = (1/L)(10/32 + 15/32 cos(2pi t/L) + 6/32 cos(4pi t/L) + 1/32 cos(6pi t/L))
- Expired U.S. Patent 4,109,199 describes the use of a calibration coil in the receiver to calibrate the gains of the electronics.
- More elaborate algorithms provide higher accuracy at the expense of much more computation. by modeling the non-dipole and/or non-concentric parts of the coils. Expired U.S. Patent 5,307,072 is an early example.
- C.A. Nafis, V. Jensen, L. Beauregard, P.T. Anderson, "Method for estimating dynamic EM tracking accuracy of Surgical Navigation tools", SPIE Medical Imaging Proceedings, 2006, reports low-cost accuracy-testing methods using a known-flat nonmagnetic surface (such as a granite surface plate).
- A 6DOF tracker using four-coil printed-circuit transmitter and receiver (optimized for academic originality) is discussed in: Peter Traneus Anderson, "A Source of Accurately Calculable Quasi-Static Magnetic Fields", dissertation presented to the Faculty of the Graduate College of the University of Vermont, October 2001, stored here as three files: Media:AndersonPeterDissertation.pdf is the main body. Media:AndersonPeterDissertationReadme.pdf contains copyright license, additional comments, and four figures that are blank in the main body. Media:AndersonPeterDissertationFig14r1.jpg is the color original photo of two of the figures. Expired U.S. Patent 1,172,017 discloses a direct-conversion radio receiver. Peter intended to include this reference as reference 16 in his dissertation, but was unable to find the patent number before Google Patents existed, so made do with existing indirect reference 16.
- A 6DOF tracker using two transmitter coils (instead of three) can be built; Frederick Raab calls this two-state excitation in his 1981 paper referenced above. Two-state trackers are severely limited, as they cannot track near the axis of the missing transmitter coil and cannot track near the plane of the two existing transmitter coils.