WO2006054295A1 - Electromagnetic tracker - Google Patents

Electromagnetic tracker Download PDF

Info

Publication number
WO2006054295A1
WO2006054295A1 PCT/IL2005/001214 IL2005001214W WO2006054295A1 WO 2006054295 A1 WO2006054295 A1 WO 2006054295A1 IL 2005001214 W IL2005001214 W IL 2005001214W WO 2006054295 A1 WO2006054295 A1 WO 2006054295A1
Authority
WO
WIPO (PCT)
Prior art keywords
mathematical
model
field
electromagnetic field
sensors
Prior art date
Application number
PCT/IL2005/001214
Other languages
French (fr)
Inventor
Mark Gandelsman
Giora Kornblau
Original Assignee
Elbit Systems Ltd.
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Elbit Systems Ltd. filed Critical Elbit Systems Ltd.
Priority to EP05804718.4A priority Critical patent/EP1817606B1/en
Priority to US11/791,295 priority patent/US7542869B2/en
Publication of WO2006054295A1 publication Critical patent/WO2006054295A1/en

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F3/00Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
    • G06F3/01Input arrangements or combined input and output arrangements for interaction between user and computer
    • G06F3/03Arrangements for converting the position or the displacement of a member into a coded form
    • G06F3/033Pointing devices displaced or positioned by the user, e.g. mice, trackballs, pens or joysticks; Accessories therefor
    • G06F3/0346Pointing devices displaced or positioned by the user, e.g. mice, trackballs, pens or joysticks; Accessories therefor with detection of the device orientation or free movement in a 3D space, e.g. 3D mice, 6-DOF [six degrees of freedom] pointers using gyroscopes, accelerometers or tilt-sensors
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/12Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
    • G01D5/14Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage
    • G01D5/20Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying inductance, e.g. by a movable armature
    • G01D5/22Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage by varying inductance, e.g. by a movable armature differentially influencing two coils

Definitions

  • the disclosed technique relates to electromagnetic trackers in general, and to methods and systems for modeling an electromagnetic field and calibrating sensing coils adaptively in an electromagnetic tracker, in particular.
  • Electromagnetic trackers find use in a wide range of applications, ranging from video game systems and computer graphics to medical technologies and military uses.
  • the main purpose of a tracker in general, is to continuously determine the position of a moving object in real-time. Determining the position may include determining the physical location of the object, and the orientation of the object with respect to a coordinate system. For example, the continuously determined position may be used to control an object, like a medical probe, or to estimate the line of sight to a target.
  • electromagnetic trackers function by generating an electromagnetic field in the physical space in which an object is to be tracked.
  • This physical space is referred to as a motion box in the art.
  • the electromagnetic field is generated by one or more transmitters located on the electromagnetic tracker.
  • a sensor is generally attached to the tracked object, which can determine a characteristic property of the electromagnetic field as a function of the physical location of the tracked object. It is common practice to determine a characteristic property of the electromagnetic field which involves the principle of electromagnetic induction. The measure of the characteristic property can be used to determine the position of the tracked object.
  • the sensor attached to the tracked object, commonly measures the magnetic field strength at a single point in the motion box of the electromagnetic tracker, either as a vector or as the components of a vector.
  • This single point is by and large related to the geometric center of the sensor.
  • This measure is generally to a high degree of precision and is achieved by using sensors with a high degree of symmetry. For example, if the sensor is coil based, the coils should be concentric to a high degree of precision.
  • Such sensors generally require a sophisticated calibration process, which is normally executed using a specially designed calibration setup. Over time, with general use and wear-and-tear, the geometric properties of a sensor change, and the calibration parameters of the sensor drift from their original values.
  • the magnetic field strength, measured by the sensor, is related to the position of the tracked object by a mathematical model describing the electromagnetic field generated by the electromagnetic tracker.
  • the electromagnetic field generated by the electromagnetic tracker results from electric currents flowing in the transmitter, as well as from induced electric currents arising in metallic objects, which are located in the vicinity of the motion box of the electromagnetic tracker.
  • the electromagnetic field generated is therefore dependent on the particular environment in which the electromagnetic tracker is used in. Any change in the position of metallic objects, in the vicinity of the motion box, requires updating the mathematical relations found between magnetic field strength measurements of the sensor and the position of the sensor. It is common practice to account for induced electric currents, which contribute to the electromagnetic field, in the mathematical model, by mapping the magnetic field strength for each position in the motion box, in a particular environment.
  • the mathematical model parameters are then estimated to best fit the position and magnetic field strength measurements of the sensor to the mapping.
  • the parameters are stored in the memory of the electromagnetic tracker and are used to estimate the position of the sensor in real-time.
  • mappings of the electromagnetic field need to be executed in a variety of environments.
  • metallic objects in the vicinity of the motion box of the electromagnetic tracker may change their position, or new metallic objects may be present in the vicinity of the motion box. Both of these situations necessitate a remapping of the motion box.
  • These mappings can be very time consuming.
  • the maintenance of an electromagnetic tracker can be cumbersome.
  • the analog hardware used in electromagnetic trackers needs to be of high precision and stability, which enables the analog hardware to be replaced when needed without changing the calibration parameters of the sensor or the estimated parameters of the mathematical model. Otherwise, replacement of the analog hardware may necessitate a recalibration of the sensor and a remapping of the electromagnetic field in the motion box of the electromagnetic tracker.
  • US Patent No. 6,534,982 issued to Jakab, entitled “Magnetic resonance scanner with electromagnetic position and orientation tracking device” is directed to a system and method for determining the position and orientation of an object in a magnetic resonance scanner.
  • the magnetic resonance scanner is used in conjunction with an electromagnetic position and orientation tracking device to calculate the position and orientation of an object within the magnetic resonance scanner.
  • the electromagnetic tracker may be used to track the object and a target, relative to a reference coordinate frame. Magnetic fields are used for location tracking of the object.
  • the magnetic field is generated by applying an electric current to a conductive wire loop.
  • the generated magnetic field is sensed by a magnetic field sensor attached to the object.
  • an electric signal is measured which is proportional to the magnetic field.
  • the electric signal is used to calculate the magnetic field by a magnetic field sensing model.
  • the magnetic field sensing model used is Faraday's Law of Induction. Models for other types of magnetic field sensors can be used, where the magnetic field sensing model is derived based upon the physical laws that dictate the operation of that sensor.
  • an estimated magnetic field can be calculated.
  • the magnetic field generation model includes a line segment approximation of the shape of the magnetic field source and additional line segments accounting for components that distort the magnetic field.
  • the model compensates for distortions in the estimated magnetic field at the sensor, by accounting for the magnetic field generated by the gradient coils in the magnetic resonance scanner and for the magnetic fields generated by any surrounding conductive and ferromagnetic materials.
  • the location and direction of the line segments is determined through test measurements of the currents in the gradient coils and the resulting magnetic fields.
  • the Biot-Savart Law is used in the magnetic field generation model to calculate the magnetic field generated by each line segment.
  • an error is computed.
  • the estimated location of the magnetic field sensor is then changed and the steps repeated until the error between the estimated magnetic field and the measured magnetic field falls below an acceptable level.
  • the location of the sensor based on its estimated location, provides a representation of the actual location of the sensor.
  • US Patent No. 6,400,139 issued to Khalfin et al., entitled “Methods and apparatus for electromagnetic position and orientation tracking with distortion compensation” is directed to distortion compensation in electromagnetic position and orientation tracking systems.
  • the method of Khalfin is applicable specifically to electromagnetic tracking systems where the components of an AC electromagnetic field are sensed within a bounded volume.
  • One or more probe sensors are placed on an object being tracked within the bounded volume.
  • Each probe measures the magnetic induction vector components of the field generated by an electromagnetic radiation source, to determine the position, orientation and movement of the object within the bounded volume.
  • the method of Khalfin employs at least one stationary sensor, termed a witness sensor, in addition to the probe sensor(s) disposed on the object.
  • Each witness sensor is supported at a known, fixed position and orientation relative to a reference frame of interest, at a point near or within the bounded volume, and close to the sensors on the object being tracked.
  • each probe sensor and each witness sensor, are provided to a processing unit operative to compute the position and orientation of the object in the presence of electromagnetic field distortions.
  • the processor uses data from each witness sensor to compute parameters, such as the position, orientation and strength, of an effective electromagnetic source or sources.
  • the effective source(s) which may be treated for the sake of simplicity as a point source or a dipole, produce the same electromagnetic field as a superposition of the real electromagnetic field, in addition to the field distortion in the proximity of the witness sensors.
  • the effective source(s) will be identical to the real source. This equality allows the computed parameters of the effective source(s) to be used as inputs to the computation of the position and orientation, as measured by each probe sensor, as if the object is in the non- distorted electromagnetic field produced by the effective source(s).
  • US Patent No. 6,201 ,987 issued to Dumoulin, entitled “Error compensation for device tracking systems employing electromagnetic fields” is directed to a system for the real-time localization of a device using electromagnetic (or Radio Frequency) fields, which compensates for eddy currents in the presence of eddy current inducing structures.
  • the system is augmented with hardware and/or software which compensates for the eddy currents and is capable of more accurately tracking an invasive device in the body of a subject.
  • current patterns applied to transmit coils of the tracking system are modified to compensate for the effect of the eddy currents. Eddy currents are compensated for by modifying the waveforms which are applied to the transmitter coils.
  • the current and the resulting applied field are uniform in time.
  • eddy currents are created, which oppose the field created by the transmit coil. These currents, and the field created by them, decay over time.
  • the modified waveform of the current supplied to the coils is a linear combination of the current needed to create the desired electromagnetic field in the region of interest, and one or more error terms.
  • the error terms are determined experimentally during system calibration and are mathematically modeled as a series of exponential functions having a given amplitude and time constant.
  • the error terms, in the current applied to the transmit coils effectively cancel the magnetic fields created by eddy currents within the tracking region and result in an actual electromagnetic field which is close to the desired ideal electromagnetic field.
  • the fidelity of the electromagnetic field is further increased by reducing eddy currents within the eddy current inducing structures. This is done by constructing shield coils which are placed between the transmit coil and the eddy current inducing structures. Magnetic fields are created by these shield coils which cancel the magnetic fields created within the eddy current inducing structures without substantially altering the electromagnetic fields in the region over which the invasive device is tracked.
  • US Patent No. 5,646,525 issued to Gilboa, entitled "Three dimensional tracking system employing a rotating field” is directed to a system for determining the position and orientation of a helmet worn by a crew member in a vehicle.
  • the vehicle includes a generator, which produces a rotating magnetic and electric dipole field of fixed strength, orientation and frequency within a portion of the vehicle.
  • the system includes a plurality of sensors which each generate a signal proportional to the electric or magnetic fields detected at a point associated with the helmet.
  • the sensors each comprise three orthogonal coils or three orthogonal detectors, such as Hall detectors.
  • the system also includes calculation circuitry responsive to the generated signal for ascertaining the coordinates of the point with respect to the generator, using a simple mathematical model, and for determining the position and orientation of the helmet.
  • the generated signal is proportional to the time derivative of the magnetic field flux along the axis of a particular coil, or detector, in the sensor. Since the generator produces a rotating magnetic dipole field, the magnetic field strength, and hence the magnitude of the generated signal, at a specific point in space, will oscillate in time between a maximum and a minimum value. According to the simple mathematical model, the maximum and minimum values will depend only on the elevation angle of the point from the generator and the distance of the point from the generator. By determining the maximum and minimum of the square of the electric and magnetic field strengths, the calculation circuitry can determine the position and orientation of the helmet.
  • an apparatus for adaptively tracking the position of an object in a volume of interest includes at least one transmitter, at least one sensor assembly, and a tracking processor.
  • the sensor assembly includes at least three sensors. The three sensors are arranged in a fixed configuration at different predetermined locations and orientations.
  • the transmitter is coupled with the volume of interest.
  • the sensor assembly is coupled with the object.
  • the tracking processor is coupled with the transmitter and the sensor assembly.
  • the transmitter transmits a multiple axis, time variant, electromagnetic field through the volume of interest.
  • the tracking processor produces and adapts a mathematical field model describing the electromagnetic field.
  • the mathematical field model is at least based on the multiple axis, time variant, electromagnetic field, the fixed configuration of the three sensors, and on the measured respective components of the electromagnetic field.
  • the tracking processor further produces and adapts a mathematical sensing model, for compensating the effect of the translational and rotational velocity of each of the three sensors.
  • the tracking processor estimates the position of the object from the measured respective components of the electromagnetic field, the field model and from the sensing model.
  • the tracking processor stores calibration parameters associated with the sensor assembly.
  • the position of the object includes the physical location of the object and the orientation of the object.
  • a method for adaptively tracking the position of an object in a volume of interest includes the procedures of transmitting a multiple axis, time variant, electromagnetic field through the volume of interest, and measuring a respective component of the electromagnetic field, in at least one sensor assembly.
  • the method further includes the procedures of producing a mathematical field model describing the electromagnetic field, and producing a mathematical sensing model for compensating the effect of the translational and rotational velocity of each of the three sensors.
  • the method further includes the procedure of determining the position of the object from the measured respective components of the electromagnetic field, the field model and from the sensing model.
  • the sensor assembly includes at least three sensors.
  • the three sensors are arranged in a fixed configuration at different predetermined locations and orientations.
  • the field model is based on the multiple axis, time variant, electromagnetic field, the fixed configuration of the three sensors and on the measured respective components of the electromagnetic field.
  • the position of the object includes the physical location of the object and the orientation of the object.
  • Figure 1A is a graph, in accordance with an embodiment of the disclosed technique, depicting a known function with analytical solutions and an unknown function connecting data points;
  • Figure 1 B is a graph, in accordance with an embodiment of the disclosed technique, depicting the known function of Figure 1A minimized to the data points of Figure 1A;
  • Figure 2 is a schematic illustration of a system, constructed and operative in accordance with an embodiment of the disclosed technique
  • FIG. 3 is a detailed schematic illustration of the sensor assembly of Figure 2;
  • FIG 4 is a detailed schematic illustration of the tracking processor of Figure 2.
  • Figures 5A and 5B are a schematic illustration of a method, operative in accordance with an embodiment of the disclosed technique.
  • the disclosed technique overcomes the disadvantages of the prior art by providing an adaptive electromagnetic (herein abbreviated EM) tracker system and method.
  • the adaptive tracker generates an EM field by providing an electric current through transmitting coils, located on the tracker.
  • the adaptive tracker constructs and continuously adapts a mathematical model to describe the EM field a tracked object is located in.
  • the adaptive tracker calibrates sensing coils located on the tracked object, and determines the position of the tracked object in real-time.
  • the adaptive tracker calibrates the sensing coils by constructing and continuously adapting a mathematical sensing model to describe the measurements determined thereto.
  • the adaptive tracker obviates the need to perform a preliminary mapping of the EM field generated by the sensing coils located on the tracker.
  • the adaptive tracker also obviates the need to perform a preliminary calibration of the sensing coils located on the tracked object.
  • the adaptive tracker can be constructed using sensing coils which have no symmetry in their shape. Furthermore, the adaptive tracker does not place a limit on the rotational and translational velocity of the tracked object.
  • Mathematical functions herein referred to as functions, equations or expressions, are mathematical relations that associate each element from a set of elements (i.e., the dependent elements), with at least one element from another set of elements (i.e., the independent elements).
  • Functions refer to the relations in general, whereas equations refer to the actual mathematical form of the relations described by the functions. Functions are used, in general, to describe physical phenomena observed in nature, for example the effect of gravity on the velocity of objects falling from the sky, or the strength of an electric field near a power line, as is known in the art.
  • Dependent elements are associated to independent elements, in equations, by variable quantities and constants, both of which are known as parameters in the art.
  • the x and y coordinates are also considered parameters, as they are variable quantities that determine the form of the equation described in Equation
  • Constant parameters of a known equation which best fits the data points of a measured phenomenon, may be determined by using a mathematical method known as optimization or minimization. Optimization, or minimization, refers to a technique where parameters are determined such that the difference between the data points of a known equation, and the corresponding data points of an unknown equation, are brought to a minimum.
  • FIG. 1A is a graph, generally referenced 100, in accordance with an embodiment of the disclosed technique, graphically depicting a known expression with analytical solutions and an unknown expression, which can only be approximated by a known expression, with numerical solutions.
  • Graph 100 includes a plurality of data points 102, an unknown graphed expression 104 and a known graphed expression 106.
  • Data points 102 are measured values of a physical phenomenon in nature.
  • Unknown graphed expression 104 is an expression, which when graphed, connects data points 102 to each other in a sequential manner.
  • the form of unknown graphed expression 104 is not known.
  • Known graphed expression 106 is an expression which describes a straight line.
  • known graphed expression 106 can be used to approximately describe unknown graphed expression 104.
  • the constant parameters of the expression that describes a straight line are: m, the slope of the line, and b, the y-intercept of the line.
  • the constant parameters of known graphed expression 106 can be minimized to data points 102.
  • Figure 1 B is a graph, generally referenced 126, constructed and operative in accordance with an embodiment of the disclosed technique, depicting the known expression of Figure 1A minimized to the data points of Figure 1A.
  • Graph 126 includes a plurality of data points 102, an unknown graphed expression 104 and a minimized known graphed expression 128.
  • Data points 102 and unknown graphed expression 104 are the same as in Figure 1A.
  • Minimized known graphed expression 128 is an expression that describes a straight line whose constant parameters, m and b, have been determined to best fit data points 102.
  • Minimized known graphed expression 128 is minimized because the difference between data points 102 and corresponding data points on minimized known graphed expression 128 are at a minimum. This is equivalent to stating that minimized known graphed expression 128 best fits data points 102.
  • System 140 includes a tracking processor 150, a transmitter interface 152, a plurality of digital to analog converters (DACs) 154 ⁇ 154 2 and 154 3 , an amplifier 156, a transmitter assembly 158, a plurality of sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N , which each include a plurality of sensing coils (not shown), a plurality of analog to digital converter (ADC) assemblies 164 ⁇ 164 2 , 164 3 and 164 N and a sensor interface 166.
  • DACs digital to analog converters
  • ADC analog to digital converter
  • ADC assemblies 164i, 164 2 , 164 3 and 164 N each include a multiplexer (not shown) and a plurality of ADCs (not shown).
  • Transmitter assembly 158 includes three transmitting coils (not shown). In another embodiment of the disclosed technique, transmitter assembly 158 includes at least one transmitting coil.
  • Sensor assemblies 162- ⁇ , 162 2 , 162 3 and 162 N each include six sensing coils. In another embodiment of the disclosed technique, sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N each include at least three sensing coils.
  • ADC assemblies 164 ⁇ 164 2 , 164 3 and 164 N each include six ADCs.
  • ADC assemblies 164 1 a 164 2 , 164 3 and 164 N each include at least three ADCs. It is noted that each sensing coil in sensor assemblies 162 ! , 162 2 , 162 3 and 162 N has a respective single ADC in ADC assemblies 164i, 164 2 , 164 3 and 164 N corresponding to it. It is noted that the plurality of digital to analog converters (DACs) 154i, 154 2 and 154 3 , can include more than three DACs, each respective of a signal to be transmitted.
  • DACs digital to analog converters
  • Tracking processor 150 includes a plurality of sub-processor units (described in Figure 4) for the following purposes: estimating the position of the sensing coils included in each sensor assembly and any objects associated with such sensing coils, for example a tracked object, adaptively calibrating the sensing coils included in each of sensor assemblies 162- ⁇ , 162 2 , 162 3 and 162 N , by constructing and continuously adapting a mathematical sensing model to describe the measurements estimated thereto, and constructing and continuously adapting a mathematical model to describe the EM field the tracked object is located in.
  • the position of a sensing coil can include the physical location of the sensing coil, for example in a coordinate system, or the orientation of the sensing coil with respect to a coordinate system, or both.
  • Transmitter interface 152 is coupled with DAC units 154 ⁇ 154 2 and 154 3 , with tracking processor 150 and with transmitter assembly 158.
  • DAC units 154 1 ; 154 2 and 154 3 are further coupled with amplifier 156.
  • Amplifier 156 is further coupled with transmitter assembly 158.
  • Sensor assemblies 162- ⁇ , 162 2 , 162 3 and 162 N are further marked S 1 , S 2 , S 3 and S N , respectively.
  • Analog to digital converter (ADC) assemblies 164 1 ; 164 2 , 164 3 and 164 N are respectively coupled with each of sensor assemblies 162i, 162 2 , 162 3 and 162 N and with sensor interface 166.
  • ADC analog to digital converter
  • each ADC assembly is coupled with the multiplexer (not shown) located thereto.
  • Each of the ADCs in ADC assemblies 164 1 ; 164 2 , 164 3 and 164 N are therefore coupled with a respective single sensing coil in each of sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N at a given moment in time by the use of the respective multiplexer in each ADC assembly.
  • Sensor interface 166 is further coupled with tracking processor 150. It is noted that each of sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N can be firmly attached to an object, thereby providing information relating to the position of that object.
  • Transmitter interface 152 produces a sequence of numbers.
  • Transmitter interface 152 can also produce a digital representation of a signal.
  • the sequence of numbers includes measurements of the current flowing in each transmission coil in transmitter assembly 158. These measurements are sampled at equal time intervals, at a sampling frequency which is at least two times higher than the highest transmitted frequency of transmitter assembly 158. A higher ratio between the sampling frequency and the highest transmitted frequency will produce measurements with less noise.
  • the sequence of numbers is provided to DAC units 154 1 ; 154 2 and 154 3 , which each, in turn, converts it to a respective analog signal. Each of the analog signals is respective of a different spatial axis. In Figure 2, DAC unit 154 !
  • DAC unit 154 2 produces a signal for the y-axis
  • DAC unit 154 3 produces a signal for the z-axis.
  • DAC units 154- ⁇ , 154 2 and 154 3 provide their respective analog signals to amplifier 156, which amplifies the respective analog signals and provides the amplified signals to transmitter assembly 158.
  • Transmitter assembly 158 uses the amplified signals to generate respective amplified frequencies.
  • Each transmitting coil, included in transmitter assembly 158 transmits a different amplified frequency for a different spatial axis.
  • each transmitted amplified frequency, for each specific spatial axis generally includes the transmitted frequencies for the other spatial axes, with the amplified frequency for that specific spatial axis being much stronger than the other frequencies. The other frequencies arise due to mutual inductance.
  • each transmitting coil, included in transmitter assembly 158 transmits a different amplified frequency combination for a different spatial axis. Each frequency combination may include a plurality of different frequencies.
  • EM field 160 is the superposition of the individual EM fields generated by each transmission coil, each at different frequencies, in transmitter assembly 158.
  • Transmitter assembly 158 uses the generated respective amplified frequencies to provide a multiple axis EM field 160 to an area, which is defined by a detectable minimum EM field strength of EM field 160 and the boundaries of the physical space a tracked object can move about in.
  • This virtually confined area is known in the art, in general, as a motion box.
  • a magnetic motion box is defined as the volume in which the sensing coils of an EM tracker can detect the presence of an EM field.
  • a physical motion box is defined as the boundaries of the physical space a tracked object can move about in. In general, in EM trackers, the volume defined by the physical motion box is included in the volume defined by the magnetic motion box. Therefore motion boxes mentioned herein refer to physical motion boxes unless otherwise stated.
  • a motion box can be located within the cockpit of a fighter jet, the inside of a tank, or the room in which a user using a 3D virtual reality console is located in.
  • the EM field generated by transmitter assembly 158 is unique in the sense that each point in the motion box has unique measurable quantities, for example the magnetic field strength, as a vector quantity, of each point.
  • transmitter assembly 158 provides frequencies on the order of tens of kilohertz.
  • EM field 160 causes a voltage difference in the sensing coils (not shown) of sensor assemblies 162 15 162 2 , 162 3 and 162 N , a phenomenon known as EM induction. The voltage difference is measured by each of sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N .
  • the measuring of the voltage differences is synchronized with the measurements of the current flowing in each transmission coil in transmitter assembly 158.
  • the voltage difference allows each of sensor assemblies 162 1 ; 162 2) 162 3 and 162 N to correspondingly estimate the respective magnetic flux of EM field 160 passing through each of its respective sensing coils.
  • Sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N thereby indirectly measure the magnetic flux of EM field 160 passing through each of its respective sensing coils. This indirect measurement is herein referred to as a measurement.
  • Each of sensor assemblies 162 1 t 162 2 , 162 3 and 162 N produces a respective electrical analog signal corresponding to the magnetic flux measured by the respective sensing coils in that sensor assembly and provides it to the respective ADC assemblies 164 1 ; 164 2 , 164 3 and 164 N coupled therewith.
  • Each of the ADCs in ADC assemblies 164 ⁇ 164 2 , 164 3 and 164 N digitizes the analog signal fed thereto, converts it to a sequence of numbers and provides it to sensor interface 166, which in turn provides it to tracking processor 150.
  • Tracking processor 150 analyzes the received sequences of numbers, thereby estimating the position of each of the sensing coils of sensor assemblies 162 1 ; 162 2 , 162 3 and 162 N , and providing the position data to a user. Accordingly, the analysis of tracking processor 150, in estimating the position of a tracked object, consists of estimating the position in the motion box corresponding to a particular magnetic flux measurement of the sensing coils of sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N . The magnetic flux measurement of each of the sensing coils is related to the position of that sensing coil according to a mathematical model of the EM field generated by transmitter assembly 158.
  • system 140 can use a single sensor assembly, which includes a single sensing coil, to determine the position of a tracked object.
  • Tracking processor 150 uses the updated magnetic flux measurements of sensor assemblies 162i, 162 2 , 162 3 and 162 N to continuously update a user of the position of the tracked object (not shown). Tracking processor 150 continuously uses the updated magnetic flux measurements of sensor assemblies 162i, 162 2 , 162 3 and 162 N to adaptively calibrate the sensing coils, within each of those sensor assemblies, with respect to one another.
  • Tracking processor 150 also continuously uses the updated magnetic flux measurements of sensor assemblies 162- ⁇ , 162 2 , 162 3 and 162 N to adaptively improve the accuracy to which system 140 can estimate the position of the tracked object.
  • the accuracy of system 140 is improved by modifying the mathematical models, used to describe the EM field, generated by transmitter assembly 158, and the measurements estimated by the sensing coils of sensor assemblies 162 ⁇ 162 2 , 162 3 and 162 N , as shall be described further below.
  • a sensor assembly 162 includes a plurality of sensing coils 17O 1 , 17O 2 and 17O 3 .
  • Each of sensing coils 17O 1 , 17O 2 and 17O 3 measures the voltage difference thereto, thereby indirectly measuring the quantity of magnetic flux passing there through.
  • sensing coil 17O 1 measures the magnetic flux passing through it for the x-axis
  • sensing coil 17O 2 measures the magnetic flux passing through it for the y-axis
  • sensing coil 17O 3 measures the magnetic flux passing through it for the z-axis.
  • Sensing coils 17O 1 , 17O 2 and 17O 3 are not necessarily orientated, with respect to one another, in an orthogonal manner. It is noted that a sensor assembly, according to the disclosed technique, can include more than three sensing coils, which may increase the accuracy and enhance the performance of system 140.
  • Tracking processor 150 includes a magnetic field model generator 190, a storage unit 194, a sensor motion effect compensator 196, a magnetic flux to magnetic field converter 198, a position processor 200, a grade assignment module 202, a model accuracy evaluator 206, a parameters adaptation module 208, an adaptation accuracy evaluator 210, and a model comparer module 212.
  • Storage unit 194 is coupled with sensor motion effect compensator 196.
  • Magnetic field model generator 190 is coupled with magnetic flux to magnetic field converter 198.
  • Sensor motion effect compensator 196 is coupled with magnetic flux to magnetic field converter 198.
  • Storage unit 194 is further coupled with magnetic flux to magnetic field converter 198.
  • Sensor motion effect compensator 196 is further coupled with position processor 200.
  • Magnetic flux to magnetic field converter 198 is further coupled with position processor 200.
  • Position processor 200 is coupled with grade assignment module 202.
  • Position processor 200 is further coupled with magnetic field model generator 190.
  • Grade assignment module 202 is coupled with storage unit 194.
  • Grade assignment module 202 is further coupled with model accuracy evaluator 206.
  • Model accuracy evaluator 206 is coupled with parameters adaptation module 208.
  • Model accuracy evaluator 206 is further coupled with position processor 200.
  • Parameters adaptation module 208 is coupled with adaptation accuracy evaluator 210. Parameters adaptation module 208 is further coupled with model comparer module 212, magnetic field model generator 190, storage unit 194, magnetic flux to magnetic field converter 198 and position processor 200. Adaptation accuracy evaluator 210 is coupled with model comparer module 212. Model comparer module 212 is coupled with magnetic field model generator 190. Model comparer module 212 is further coupled with storage unit 194 and position processor 200.
  • Magnetic field model generator 190 generates and stores thereto, an approximated mathematical model of the EM field generated by transmitter assembly 158 ( Figure 2), herein referred to as the model.
  • the model does not include all the variable and constant parameters needed to describe the EM field generated by transmitter assembly 158.
  • the effect of currents induced in metallic elements in the motion box of system 140 by EM field 160 ( Figure 2) may not be compensated for by the model when system 140 starts tracking. Therefore, the model stored by magnetic field model generator 190 is initially incomplete. As a tracked object moves about in the motion box, the model is built up until it is complete and the accuracy to which system 140 can track an object is high.
  • the model generated by magnetic field model generator 190 may include either a harmonic expansion function, for example a spherical function describing the EM field, or an analytic relation describing the EM field, for example a relation based on the Biot-Savart Law, or a combination of the two.
  • the model includes at least one set of parameters describing EM field 160, where each element of each set of parameters is a vector of real numbers.
  • Parameters describing EM field 160 can include the coordinate relationships between transmitter assembly 158, EM field 160 and the sensing coils of each of sensor assemblies 162i, 162 2 , 162 3 and 162 N ( Figure 2), as well as expansion centers and expansion coefficients of the model generated by magnetic field model generator 190.
  • the first index, p enumerates the sets of parameters, from the first set (l) to the last set (s).
  • the second index m enumerates the transmission frequencies of transmitter assembly 158, from the first frequency used (l) to the last frequency used (N f ).
  • N f is the total number of frequencies used by transmitter assembly 158.
  • Magnetic field model generator 190 needs to be provided with only the number of frequencies provided by transmitter assembly 158 and not the number of transmission coils included in transmitter assembly 158.
  • the model is constructed by defining a reference frame, herein referred to as the model reference frame, in the motion box of system 140 defined by EM field 160.
  • the model reference frame locally establishes a coordinate system for relating the position of a tracked object in the motion box to a user.
  • the model reference frame is a fixed reference frame.
  • the model substantially includes a matrix function, designated ⁇ , for estimating the EM field amplitudes of EM field 160 from a fixed observation point within each sensing coil of each of sensor assemblies 162 1 ? 162 2 , 162 3 and 162 N , at each transmission frequency of transmitter assembly 158.
  • the fixed observation point can be the magnetic center within each sensing coil of each of the sensor assemblies.
  • the magnetic center is defined as the center of mass of the inner volume of each sensing coil.
  • EM field 160 can be completely characterized by the EM field amplitude at a particular transmission frequency at a particular point, because the amplitude, for a particular transmission frequency, is unique for each point in the EM field in the motion box.
  • the first index, m enumerates the transmission frequencies of transmitter assembly 158, from the first frequency used to the last frequency used.
  • the second index, k enumerates the sensing coils in all of sensor assemblies 162- ⁇ , 162 2 , 162 3 and 162 N .
  • the index k ranges from 1 toN c , where N c is the combined total number of sensing coils in all the sensor assemblies.
  • B m x k , Bl k and Bl k are respectively, the x-component, y-component and z-component of the EM field amplitude of the m"' transmission frequency in the k"' sensing coil.
  • the model provides an analytical expression for the unique EM field amplitude at each particular frequency at the magnetic center of each sensing coil in a coordinate system relative to the sensor assemblies. This coordinate system moves as the sensor assemblies move, and is herein referred to as the sensor reference frame.
  • the sensor reference frame can be related to the model reference frame by designating a vector, f , as the location of the origin of the sensor reference frame relative to the model reference frame, a rotation matrix, R , as the orientation of the sensor reference frame relative to the model reference frame and vectors J ⁇ ,...,r N, as the radius vectors from the origin of the sensor reference frame to the magnetic center of each sensing coil.
  • EM field 160 can be defined as a matrix quantity B , where
  • B m. N r and B mi ,...,B mNe are the vector amplitudes of EM field 160 estimated in all the sensing coils, for all the transmission frequencies provided by transmitter assembly 158. Therefore, the matrix quantity B is a function of the model parameters ⁇ pm , the position of the sensor reference frame relative to the model reference frame and the radius vectors from the origin of the sensor reference frame to the center of each sensing coil magnetic center. This function can be written as
  • Matrix function ⁇ may be either a linear or non-linear function with respect to the model parameters ⁇ pm .
  • EM field 160 is represented in the form of a harmonic expansion function
  • the EM field amplitude of the m th transmission frequency at the magnetic center of the k' h sensing coil can be written as
  • B mk (r + r L ) represents the vector amplitude of EM field 160 estimated at the m' h transmission frequency at the magnetic center of the k"' sensing coil
  • the matrix function ⁇ includes the EM field amplitudes B mk (r+r k ) estimated for each transmission frequency in each sensing coil by Equation (4).
  • each set of model parameters ⁇ pm , in Equation (4) estimates an independent contribution to B at each transmission frequency, m , of transmitter assembly 158.
  • the model has an efficient analytical or numerical method, for determining the mathematical gradients of the EM field model.
  • Storage unit 194 stores a set of calibration parameters of sensor assemblies 162 1 ; 162 2 , 162 3 and 162 N .
  • Calibration parameters include the orientation of the sensing coils of each sensor assembly with respect to the sensor reference frame in system 140, the set of radius vectors 7 k , from the origin of the sensor reference frame of system 140 to the magnetic center of each sensing coil, the gain in each sensor assembly, the parameters defining the amplifiers in each sensor assembly, other parameters relating to the electronic components of the sensor assemblies, other sensing coil calibration data, and the respective error to which each of these quantities is known.
  • the relative rotation angles of the sensing coils with respect to one another are known with an error of several degrees.
  • the relative rotation angles and their respective errors are stored in storage unit 194.
  • internal calibration parameters of the sensing coils are known with an error of a few percent, and stored in storage unit 194.
  • Storage unit 194 also stores a Taylor series expansion function for each coordinate component ( ⁇ ,y,z) of the EM field amplitude of EM field 160 as a function of the vector location of a point, q , in EM field 160, designated by the vector 7.
  • 7 is a vector measured from the origin of the sensor reference frame to point g .
  • the coordinate components of the EM field amplitude at a vector point 7 within a sensing coil, in the vicinity of 7 k , the radius vector from the origin of the sensor reference frame to the magnetic center of the k"' sensing coil can be expanded as:
  • 162 1 a 162 2 , 162 3 and 162 N All other terms are as they were defined above.
  • Storage unit 194 also stores the magnetic flux estimated by the measurements of the sensing coils.
  • the stored magnetic flux measurements are used by storage unit 194 to estimate the amplitude and phase of the magnetic flux estimated by the sensing coils.
  • the signal measured by a steady state sensing coil is expected to follow a mathematical model, where the signal measured is defined mathematically as a periodic function of time
  • Equation (8) I where F(t) is the magnetic flux at time instant t , F 1n is the amplitude of the magnetic flux at transmission frequency number m (f m ) and p m is the phase of the magnetic flux at / resort, .
  • the definition of Equation (8) is stored in storage unit 194.
  • the measurements are fit to Equation (8) in sensor motion effect compensator 196, using mathematical fitting techniques known in the art, from which an estimated value for F 1n and p m can be obtained.
  • Time period T is commonly referred to in the art as a sampling window. Estimating F 1n and p m using multiple measurements in a sampling window is accurate in the case that the sensing coils located inside each sensor assembly are stationary.
  • the tracked object, onto which the sensing coils are attached may be moving. This movement may occur during a sampling window and introduces an error in the amplitude and phase approximation of the magnetic flux as a function of time. This error is due to the translation and rotational velocity of the sensing coils in each of the respective sensor assemblies, and is manifest in the form of a non-periodic variation of magnetic flux as a function of time.
  • Sensor motion effect compensator 196 compensates the effect of the translational and rotational velocity of the sensing coils, on the estimated magnetic flux amplitudes and phases.
  • Sensor motion effect compensator 196 executes the compensation by continuously generating a mathematical sensing model (herein referred to as the sensing model) of each measurement estimated by the sensing coils.
  • the sensing model defines F 111 and p m as time functions rather than as constant parameters.
  • F 1n and p m are defined, in general, in sensor motion effect compensator 196, as Taylor series expansion functions of At n , where ⁇ t H is an amount of time within the n th sampling window measured from the center of the sampling window.
  • the Taylor series expansion functions of F 1n and p m can be expressed mathematically as and
  • P 1n (At n ) p m + P 1n At n + Pm A ⁇ + p m " A ⁇ +... (10)
  • F 1n and p m , F m and p m " , and Fj and p m " are respectively the first, second and third derivatives of F 1n and p m .
  • the number of a derivative (first, second, third, etc..) is also referred to as the order, with the zero order term referring to the term with no derivatives, for example F 1n and
  • Equation (9) and (10) are estimated by minimizing the deviation between the magnetic flux estimated by the measurements of the sensing coils, and the magnetic flux, F(t), estimated by Equation (8) in sensor motion effect compensator 196, using the estimated magnetic flux amplitude and phase.
  • minimization is achieved by using a least mean square cost function, as is known in the art.
  • the number of expansion parameters needed, in Equations (9) and (10), to compensate the effect of the translational and rotational velocity of the sensing coils is known.
  • the minimization is used to estimate the zero order terms, F 111 and p m , for each transmission frequency of transmitter assembly 158 in each sensing coil.
  • minimizations are repeatedly executed to estimate the higher order derivative terms until the number of terms retained in Equations (9) and (10) (i.e. the sensing model equations) are sufficient to compensate for the translational and rotational velocity of the sensing coils.
  • Equations (9) and (10) can be truncated by retaining the terms up to the zero, first, second or any other higher order. In the case that only the zero order terms are retained, F 1n and p m , Equations (9) and (10) can be truncated by retaining the terms up to the zero, first, second or any other higher order. In the case that only the zero order terms are retained, F 1n and p m , Equations (9) and
  • Equation (8) (10) define F 1n and p m in Equation (8) as constant parameters.
  • Equation (8) therefore approximates the magnetic flux measured by the sensing coils, as measured by steady state sensing coils.
  • the number of terms sensor motion effect compensator 196 retains and uses from Equations (9) and (10) to compensate for the effect of moving sensing coils depends on various factors. The factors may either include the width of the sampling window, the typical velocity and acceleration of the tracked object, the mathematical EM field gradients of the model, or a combination of the above.
  • the highest order term retained by sensor motion effect compensator 196 can either be chosen a priori based on the above factors, and stored thereto, or it can be treated as an adjustable parameter thereto, based on the normalized residual error between the EM field amplitudes estimated by magnetic flux to magnetic field converter 198 and magnetic field model generator 190.
  • the normalized residual error is estimated by position processor 200, the result of which can be used to decide on the highest order term Equations (9) and (10) retain in sensor motion effect compensator 196.
  • a residual error of two to three ⁇ may indicate that the highest order term retained in Equations (9) and (10) is increased by one.
  • Magnetic flux to magnetic field converter 198 transforms the compensated matrix of magnetic fluxes (for each transmission frequency of transmitter assembly 158 and for each sensing coil) estimated by sensor motion effect compensator 196, into a corresponding matrix of EM field amplitudes at the magnetic center of each sensing coil, for each transmission frequency of transmitter assembly 158.
  • the transformation is executed using the sensing coil calibration parameters stored in storage unit 194, including Equations (5), (6) and (7), and the EM field model generated by magnetic field model generator 190.
  • the magnetic flux matrix estimated by sensor motion effect compensator 196 is transformed into an EM field amplitude matrix by p _ V r a T* a O U V r mk ⁇ Z J C mk0 D mk Vk ) + ZJ • • V ' ' ) ae ⁇ x,y,z ⁇ a, ⁇ e ⁇ x,y,z ⁇ where F mk is the zero order term of Equation (9), indicating the measured and compensated magnetic flux at transmission frequency m in sensing coil k, estimated by sensor motion effect compensator 196.
  • c n , ⁇ o > c m u > c mk i r are tensor coefficients that result from the term by term integration of Equations (5), (6) and (7) for the EM field model, over the surface area bounded by each sensing coil winding, summing over all the windings of each sensing coil.
  • c" ⁇ 0 is the tensor coefficient resulting from integrating the zero order gradient term from Equations (5), (6) and (7)
  • c" is the tensor coefficient resulting from integrating the zero order gradient term from Equations (5), (6) and (7)
  • L ⁇ ⁇ is the tensor coefficient resulting from integrating the first order gradient term from Equations (5), (6) and (7)
  • c"f/ is the tensor coefficient resulting from integrating the second order gradient term from Equations (5), (6) and (7). All other terms and quantities are as they were defined above.
  • Tensor coefficients c" ⁇ 0 , , c"f 2 ' r relate the measured magnetic flux to the EM field model and the mathematical gradients of the EM field model.
  • Tensor coefficients c" lk0 , c"; k ⁇ , c"f/ are stored in magnetic flux to magnetic field converter 198 as sensing coil parameters and are modified and refined adaptively as a tracked object is tracked in time.
  • Magnetic flux to magnetic field converter 198 solves for B m " k (r k ), the first term on the right hand side of Equation (11), using techniques known in the art.
  • the other terms of Equation (11) are estimated by magnetic flux to magnetic field converter 198 or position processor 200, as described below.
  • Equation (11) can be truncated by retaining the terms up to the zero, first, second or any other higher order of mathematical gradient. In the case that only the zero order term is retained, indicating that all the mathematical field gradient terms are discarded, Equation (11) is equivalent to the assumption that the EM field within each sensing coil can be approximated as a uniform field.
  • the highest order term magnetic flux to magnetic field converter 198 retains and uses from Equation (11) to convert the magnetic flux to a measure of the amplitude of EM field 160 depends on various factors. The factors may either include an estimation of the EM field model mathematical gradients, the approximate size of the sensing coils, or a combination of the above.
  • the highest order term retained by magnetic flux to magnetic field converter 198 can either be chosen a priori based on the above factors, or it can be treated as an adjustable parameter based on the normalized residual error between the EM field amplitudes estimated by magnetic flux to magnetic field converter 198 and magnetic field model generator 190.
  • the normalized residual error is determined by position processor 200, the result of which can be used to determine the highest order of terms in Equation (11) retained by magnetic flux to magnetic field converter 198. For example, a residual error of one ⁇ (i.e. one standard deviation) may indicate that the highest order of terms retained in Equation (11 ) is increased by one.
  • the highest order of terms retained in Equation (11) is adaptively refined as system 140 tracks an object, until a sufficient accuracy in estimating the position of the object is achieved.
  • the magnetic flux matrix estimated by sensor motion effect compensator 196 can be transformed into a matrix of EM field amplitudes by expanding B m x k (r), B ⁇ r), B m * k (r), F 1n (At n ) and Pm (At n ) in terms of spherical functions, or other basic harmonic functions.
  • the mathematical representation of the measured magnetic flux (for example, Equation (8)) will be a linear function of the expansion coefficients of the spherical expansion function.
  • the parameters involved in the definition of this linear function represent the geometry of the sensing coils. Therefore, these parameters are analogous to tensor coefficients c" nk0 , c"; k ⁇ x , cj a ⁇ r of
  • Equation (11) any mathematical model relating the EM field amplitudes measured within a sensing coil to the measured magnetic flux in a sensing coil, can be used in place of Equation (11) in magnetic flux to magnetic field converter 198.
  • Equation (11) the Taylor series expansions of B m x k (r), B m y k (r), B m z k (r), F 1n (At n ), P 1n (At 1 ) and F mk (Equations
  • Position processor 200 estimates the position of each sensing coil, based on the unique EM field amplitude components B* nk (r), B m y k ⁇ f) and B* lk (r) estimated by magnetic field model generator 190 and magnetic flux to magnetic field converter 198.
  • magnetic flux to magnetic field converter 198 estimates the EM field amplitude components by solving for all the K L (A) terms in Equation (11).
  • magnetic flux to magnetic field converter 198 estimates the EM field amplitude components iteratively with position processor 200 by solving for all the B" lk (r k ) terms in Equation (11).
  • position processor 200 estimates the EM field amplitude components by solving for all the B" lk (r k ) terms in Equation (11).
  • Equation (11) represents a simple linear relation between the measured magnetic flux in the sensing coils, and the EM field amplitude components B x ,, B-',., and B m z k , in the case that the sensing coils are considered as point-like sensing coils. Since the sensing coils are not considered as point-like sensing coils in the disclosed technique, the gradient terms of Equation dB a (r ) d 2 B a (r )
  • Equation (11) for example — — — and — f ⁇ - , and their respective terms, dr dr dr r represent a correction for this simple linear relation.
  • dr dr dr r represent a correction for this simple linear relation.
  • an extrapolation technique is used in magnetic flux to magnetic field converter 198, to estimate the position of the sensing coils, which can be used to estimate the gradient terms of Equation (11).
  • the estimated gradients terms allow tracking processor 150 to more accurately estimate the position of the sensing coils.
  • the estimated position of the sensing coils is calculated based on the previous position of the sensing coils. The previous position of the sensing coils is obtained from the center of the previous sampling window to the center of the current sampling window. The estimated position of the sensing coils is extrapolated from the center of the current sampling window to the center of the next sampling window.
  • an iterative technique using the principles of perturbation theory, is used with magnetic flux to magnetic field converter 198 and position processor 200, to estimate the position of the sensing coils.
  • the EM field amplitude components are first estimated in magnetic flux to magnetic field converter 198, based on a simplified sensing coil model of point-like sensing coils. This is equivalent to magnetic flux to magnetic field converter 198 using Equation (11) with only the first term of the right hand side.
  • Position processor 200 uses the estimated EM field amplitude components to approximate the position of each sensing coil. The position of each sensing coil is then used by magnetic flux to magnetic field converter 198 to estimate the gradient terms of Equation (11).
  • the estimated gradients terms can then be used again by magnetic flux to magnetic field converter 198 to estimate the EM field amplitude components.
  • the EM field amplitude components can then be used again by position processor 200 to approximate the position of each sensing coil.
  • the position of each sensing coil can then be used again by magnetic flux to magnetic field converter 198 to estimate the gradient terms of Equation (11). This technique is repeated, in an iterative manner, using the principles of perturbation theory, until a sufficient accuracy, in estimating both the position of the sensing coils and the EM field amplitude components, is achieved.
  • the EM field amplitude components as well as the position of the sensing coils are estimated simultaneously by position processor 200.
  • the position of the sensing coils is estimated by minimizing the deviation between the EM field amplitude components estimated by magnetic field model generator 190, and the EM field amplitude components estimated by magnetic flux to magnetic field converter 198.
  • the minimization adapts the parameters in the EM field model to better fit the EM field estimated by magnetic flux to magnetic field converter 198.
  • position processor 200 uses the EM field model stored in magnetic field model generator 190 to estimate the position of the sensing coils. The deviation is minimized by
  • B (the EM field model defined by Equation (2)) contains the vector amplitudes of EM field 160 estimated in all the sensing coils using Equation (11), and ⁇ (the EM field model defined by Equation (3)) is the mathematical model of EM field 160 estimated by magnetic field model generator 190.
  • each element of B (indicating each component of B , such as B n x ⁇ , BJ nl and B m z X ) is treated as a minimized parameter.
  • the parameters defining the sensing coils and the EM field model are assumed to be fixed constants.
  • the EM field amplitude components indicating the B" lk (r k ) terms of Equation (11), are estimated by minimizing the deviation between the flux estimated by sensor motion effect compensator 196 and the flux calculated from the EM field model.
  • Position processor 200 calculates the flux from the EM field model by replacing B in Equation (11) with B , the EM field model of Equation (2). The deviation is minimized by
  • Equation (13) L ml2 (13) dr ⁇ dr ⁇
  • F mk is the flux estimated by sensor motion effect compensator 196.
  • Equation (13) come from Equation (11) using B (the EM field model of Equation (2)). All other terms and quantities are as they were defined before.
  • Equations (12) and (13) are solved by using a non-linear, least mean square optimization technique, for example, Newton's method, as is known in the art.
  • Position processor 200 also estimates the normalized residual error in the calculation of the position of the sensing coils.
  • the error is a measurement of the minimized deviation of Equation (12).
  • the normalized residual error is referred to as the figure of merit (herein abbreviated FOM) of a position calculation.
  • the FOM is defined as
  • Position processor 200 provides the position of the tracked object, as well as the FOM of the current position calculation, to a user.
  • Grade assignment module 202 groups together F mk , the measured and compensated magnetic flux in each sensing coil, and the position of each sensing coil calculated using Equation (12), into an element referred to as a point.
  • Each point is assigned a grade, by grade assignment module 202. Depending on the grade, a point is either abandoned, or selected for storage. If a point is selected for storage, it is stored in storage unit 194.
  • the grade is a positive parameter based on various factors. The factors may either include the FOM of the point, the geometrical location of the point in the motion box, the grades assigned to previous points stored in storage unit 194 or a combination of the above. The factors each have relative weights in determining the grade. For example, a large FOM of a current point, compared to the FOM of points stored in storage unit 194, is an aspect which increases the grade, because such points help tracking processor 150 improve the EM field model. In addition, if the geometrical location of the point in the motion box is far enough from all the points already stored in storage unit 194, it may also be a reason for increasing the grade of the current point.
  • Position measurements with large FOMs are indicative of locations in the motion box not yet explored by the tracked object. Since these new locations help tracking processor 150 improve and expand the EM field model, such measurements may receive high grades.
  • the grades of points already stored in storage unit 194 may also be varied with time. For example, the grades of points already stored may gradually decrease over time, introducing a fading memory effect to points stored in storage unit 194.
  • a point is stored in storage unit 194 if its grade is above a certain minimum and there is still room in storage unit 194 to store more points. If storage unit 194 is full, and a point possesses a high enough grade for storage in storage unit 194, the point is stored by replacing a point in storage unit 194 with a lower grade.
  • Storage unit 194 has a capacity to store a few hundred points, and in general, the size of storage unit 194 is determined by the number of unknowns that need to be estimated in Equation (3) to properly generate an accurate EM field model of the EM field in the motion box.
  • Points with high enough grades are stored to assist parameters adaptation module 208 in refining the EM field model stored in magnetic field model generator 190. These points also assist parameters adaptation module 208 in calibrating the sensing coils, by refining the calibration parameters of the sensing coils stored in storage unit 194 and the sensing model stored in sensor motion effect compensator 196.
  • Model accuracy evaluator 206 determines the accuracy to which sensing coil calibration parameters are known, and the accuracy to which the EM field model estimated by magnetic field model generator 190 estimates the EM field amplitude components measured by the sensor assemblies. The determination of the accuracy is based on various factors. The factors may either include the FOM of the accumulated points, the accuracy of system 140 achieved so far, the desired accuracy of system 140 in a particular field of usage (for example military use or 3D gaming use), the mathematical observability of the parameters defining the EM field model and the sensing coil calibration parameters, or a combination of the above. Mathematical observability is essentially a measure of how well unknown parameters can be estimated from known parameters in a system. If the error in estimating the unknown parameters is too high, the unknown parameters are non-observable. Otherwise, the unknown parameters are observable.
  • model accuracy evaluator 206 directs position processor 200 to continue collecting points, estimating each of their positions, and each of their FOMs. The determined accuracy is generally above the required level when a majority of the points within a part of the motion box have been collected and have had grades assigned to them. If the determined accuracy is below the required level, model accuracy evaluator 206 directs parameters adaptation module 208 to adapt the parameters defining the EM field model, the sensing model and the calibration parameters of the sensing coils.
  • Parameters adaptation module 208 adapts and refines the parameters defining the EM field model, the sensing model and the calibration parameters of the sensing coils by executing two minimizations, either subsequently, or simultaneously.
  • the first minimization is a minimization of the deviation between the EM field amplitude components estimated by magnetic field model generator 190 and the EM field amplitude components estimated by magnetic flux to magnetic field converter 198.
  • the second minimization is a minimization of the deviation between the magnetic flux estimated by sensor motion effect compensator 196 and the magnetic flux estimated from the EM field model, using Equation (11), in position processor 200.
  • Parameters adaptation module 208 performs a minimization similar to the minimization performed by position processor 200. The difference in the minimizations is that parameters adaptation module 208 performs a minimization calculation involving all the points stored in storage unit 194, whereas position processor 200 performs a minimization involving only a single point.
  • parameters defining the EM field model and the calibration parameters of the sensor assemblies may be mathematically non-observable when parameters adaptation module 208 executes a minimization. This is typical when the tracked object is in a new environment, the FOM of accumulated points is high, storage unit 194 is not full of points, or an area in the physical motion box, with a low probability of being explored, for example, a corner of the physical motion box, has not yet been explored by the tracked object.
  • a model simplification technique is used to execute the minimizations of Equations (15) and (16) (or Equations (17) and (18)).
  • non-observable parameters are either excluded from the EM field model and the minimization calculations, or they are considered as constants in the minimization calculations.
  • Non-observable parameters can be selected using standard methods in estimation theory, for example, using Cramer-Rao bounds analysis, as is known in the art.
  • the model simplification technique becomes a preferred technique to use when an entire set of EM field model parameters ⁇ mk are non-observable, indicating that the EM field model structure and the sensing model structure are not yet established.
  • the EM field model structure is not yet established when the EM field model, describing EM field 160, cannot estimate the position of sensing coils, attached to a tracked object, to a high degree of accuracy.
  • the sensing model structure is not yet established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object, has not yet been determined.
  • a constraint technique is used to execute the minimization of Equations (15) and (16) (or Equations (17) and (18)).
  • all parameters, including non-observable ones, are considered in the minimization calculations, except the minimization calculations are performed under specific constraints.
  • One such constraint could be that the EM field amplitude components, estimated by the EM field model (generated by magnetic field model generator 190) before and after the minimization calculations, be close to one another within a defined tolerance level.
  • the constraint technique becomes a preferred technique to use when the EM field model structure and the sensing model structure have been established.
  • the EM field model structure is established when the EM field model, describing EM field 160, can estimate the position of sensing coils to a high degree of accuracy.
  • the sensing model structure is established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object has been determined, but some parameters of those equations are non-observable.
  • the model simplification technique and the constraint technique allow tracking processor 150 to select the points with the highest grades to perform the minimization calculations. These techniques allow parameters adaptation module 208 to start minimizing with very few points stored in storage unit 194.
  • the rapid onset of minimization calculations allow for an accelerated rate in minimizing parameters and a quick determination of an accurate EM field model and sensing model.
  • the rapid onset of minimization calculations also allows for an accelerated rate in calibrating the sensing coils.
  • the tracked object does not need to explore the entire motion box before an accurate EM field model and sensing model can be generated and the sensing coils calibrated.
  • the disclosed technique allows the EM field model and sensing model accuracy to be increased in restricted areas of the motion box, where points have already been collected in storage unit 194.
  • Adaptation accuracy evaluator 210 evaluates the result of the minimization executed by parameters adaptation module 208, and determines the increase or decrease in the accuracy value in the EM field model and the sensing coil calibration parameters using the results of the minimization.
  • the evaluation is executed by computing the FOM values for each point involved in the adaptation performed by parameters adaptation module 208, using the updated EM field model parameters and sensing coil calibration parameters minimized by parameters adaptation module 208.
  • the obtained distribution of FOM values for each point may be characterized by a single value, or a few values, such as the root mean square of the FOM distribution, the maximum FOM obtained, or any other distribution property.
  • adaptation accuracy evaluator 210 uses this value to determine the increase or decrease in the accuracy value of system 140, as compared with the previous accuracy value of system 140.
  • the previous accuracy value of system 140 can be determined by the obtained distribution of FOM values obtained for points using the non-minimized EM field model parameters and sensing coil calibration parameters (indicating the parameter values before parameters adaptation module 208 minimizes them). If a small increase in accuracy is observed, such that changing the EM field model stored in magnetic field model generator 190 is not warranted, adaptation accuracy evaluator 210 directs parameters adaptation module 208 to perform another minimization of the EM field model parameters and the sensing coil calibration parameters.
  • adaptation accuracy evaluator 210 directs parameters adaptation module 208 to expand Equation (11) by estimating the contribution of the next additional, higher order, mathematical gradient term in Equation (11 ) not currently used by magnetic flux to magnetic field converter 198. For example, if F mk was solved for, by magnetic flux to magnetic field converter 198, using only the first two terms on the right hand side of Equation (11), then, when parameters adaptation module 208 expands Equation (11), F mk is solved for, by magnetic flux to magnetic field converter 198, using the first three terms on the right hand side of Equation (11).
  • Equation (11) The contribution of the additional term in Equation (11) can be estimated by using an approximation about the sensing coil form, and the EM field distribution within each sensing coil. If that contribution is not negligible, the expanded form of Equation (11) is used by parameters adaptation module 208 in another round of minimization calculations. The sensing coil calibration parameters may still yield distorted position estimates of the sensing coils. In this case, parameters adaptation module 208 repeatedly expands Equation (11), by estimating the contribution of the next additional, higher order, mathematical gradient term in Equation (11) not currently used by magnetic flux to magnetic field converter 198. If that contribution is negligible, or the expanded form of Equation (11) still does not yield the desired EM field model accuracy and sensing coil calibration accuracy, a trial and error technique is used by parameters adaptation module 208, to improve the accuracy of system 140.
  • the trial and error technique involves expanding the various expansion functions used by tracking processor 150, for example, the EM field model, or any of Equations (5), (6), (7), (9), (10), (11), by increasing the number of retained terms in these equations.
  • the expansion can also involve adding a new mathematical expansion center to the expansion functions used by tracking processor 150.
  • Parameters adaptation module 208 adds a new mathematical expansion center by determining the direction of the sharpest increase in the deviations minimized in Equations (15) and (16) (or Equations (17) and (18)).
  • the direction of the sharpest increase indicates the direction of the singularity of EM field 160.
  • the region near the singularity of the EM field is then determined by parameters adaptation module 208 and divided into a plurality of segments.
  • each segment is chosen as the location of the new mathematical expansion center, and is used in the minimizations executed using Equations (15) and (16) (or Equations (17) and (18)).
  • the location of the segment which yields the lowest FOM is then added as the new mathematical expansion center.
  • the expanded equations are used in an additional minimization calculation. If the achieved accuracy value determined by adaptation accuracy evaluator 210 increases, the expanded equations are used for another minimization calculation. Minimization calculations are executed until the increase in accuracy value is sufficient to warrant replacing the current EM field model parameters stored in magnetic field model generator 190, by the updated, adapted EM field model parameters determined by parameters adaptation module 208. If the achieved accuracy value determined decreases, either the order of the retained expansion terms is increased, or a new mathematical expansion center is added. The trial and error technique is used by parameters adaptation module 208 until the desired system accuracy is achieved.
  • parameters adaptation module 208 iteratively performs minimization calculations, either with or without expanding the sets of parameters searched for, until a satisfactory FOM level is achieved.
  • parameters adaptation module 208 provides the adapted parameter sets of the EM field model parameters and the sensing coil calibration parameters to model comparer module 212.
  • model comparer module 212 provides position processor 200 with the adapted parameters determined by parameters adaptation module 208.
  • the control time can be a few seconds or a few minutes depending on the case of usage of system 140.
  • model comparer module 212 compares the FOM of points determined by the current EM field model parameters and sensing coil calibration parameters, and by the respective adapted parameters.
  • model comparer module 212 directs magnetic field model generator 190, and storage unit 194, to replace the current parameters stored thereto, by the updated, adapted parameters. If the FOM provided by the adapted parameters is higher than the FOM provided by the current parameters, for most of the predetermined control time, the adapted parameters are abandoned, and model comparer module 212 directs parameters adaptation module 208 to perform more minimization calculations.
  • FIGS 5A and 5B are a schematic illustration of a method, constructed and operative in accordance with an embodiment of the disclosed technique.
  • procedure 250 a multiple axis EM field is provided to a motion box, where a tracked object moves about.
  • the EM field is the superposition of the individual EM fields generated by transmission coils, each at different frequencies.
  • transmitter assembly 158 uses the generated respective amplified frequencies to provide a multiple axis EM field 160 to a motion box.
  • Equation (3) The model is used for estimating the amplitude of the EM field detected in sensing coils associated with, or attached to, the tracked object, for all the transmission frequencies used to generate the EM field. Equation (3) may be constructed as either a linear or non-linear function with respect to the model parameters ⁇ pm .
  • Equation (3) is chosen as a linear expansion, for example, in terms of a harmonic function, like Equation (4), each set of model parameters ⁇ pm estimates an independent contribution to B at each transmission frequency, m , used to generate the EM field.
  • the model has an efficient analytical or numerical method, for determining the mathematical gradients of the EM field model.
  • magnetic field model generator 190 generates and stores an approximate mathematical model of an EM field the tracked object is located in, substantially defined by Equation
  • calibration parameters of sensing coils, associated with, or attached to, the tracked object are stored.
  • a plurality of sensing coils may be grouped together in a sensor assembly.
  • the calibration parameters can include the orientation of the sensing coils with respect to one another, and with respect to the sensor reference frame.
  • the calibration parameters can further include a set of radius vectors r k , from the origin of the sensor reference frame to the magnetic center of each sensing coil.
  • the calibration parameters can also include parameters relating to the electronic components of the sensing coils and the sensor assemblies, for example, the gain in the sensor assemblies, and parameters defining amplifiers used in the sensor assemblies.
  • the relative rotation angles of the sensing coils with respect to one another, in each sensor assembly are known with an error of several degrees and are stored.
  • internal calibration parameters of the sensing coils, in each sensor assembly are known with an error of a few percent, and are stored.
  • a Taylor series expansion function describing the EM field amplitudes in sensing coils in general is also stored.
  • the Taylor series expansion functions are substantially defined by Equations (5), (6) and (7).
  • storage unit 194 stores calibration parameters related to sensor assemblies 162i, 162 2 , 162 3 and 162 N , as well as Taylor series expansion functions substantially defined by Equations (5), (6) and (7), describing the EM field amplitudes in the sensing coils in sensor assemblies 162-), 162 2 , 162 3 and 162 N .
  • sensing coils attached to a tracked object measure the voltage difference of the EM field passing through them.
  • the voltage difference allows each of the sensing coils to correspondingly estimate the respective magnetic flux of the EM field passing there through.
  • This indirect measurement of the magnetic flux is herein referred to as a measurement.
  • the measured magnetic flux in a steady state sensing coil, is assumed to follow a mathematical periodic function of time, defined by Equation (8).
  • Equation (8) In order to estimate the amplitude and phase of the measured magnetic flux, multiple measurements of the flux are made in a time period T, known as a sampling window in the art, at a known frequency. The measurements are fit to Equation (8), using techniques known in the art.
  • sensor assemblies 162i, 162 2 , 162 3 and 162 N which are associated with, or attached to, a tracked object, indirectly measure the magnetic flux passing through them multiple times, in a sampling window, at a known frequency, by measuring the voltage difference passing there through.
  • storage unit 194 stores the measured magnetic flux values of sensor assemblies 162 1 ; 162 2 , 162 3 and 162N, and estimates the amplitude and phase of the magnetic flux, by fitting the measured values to Equation (8) using techniques known in the art.
  • the amplitude and phase of the magnetic flux estimated in procedure 256 is compensated for, because Equation (8) is valid only in the case of steady state, non-moving, sensing coils.
  • sensing coils associated with, or attached to, a tracked object are in constant motion. This motion can be described as a translational and rotational velocity of the sensing coils, and is manifest in the form of a non-periodic variation of magnetic flux as a function of time. If the sensing coils are in motion within a sampling window, the amplitude and phase of the magnetic flux, estimated in procedure 256, are inaccurate. The amplitude and phase of the magnetic flux estimated in procedure 256 needs to be compensated for the translational and rotational velocity of the sensing coils.
  • the compensation is executed by defining the amplitude and phase of the measured magnetic flux as Taylor series expansion functions, defined, in general, by Equations (9) and (10).
  • the expansion terms (the right hand side terms) of Equations (9) and (10) are estimated by minimizing the deviation between the magnetic flux estimated in the sensor assemblies in procedure 256 and the magnetic flux determined by using Equation (8) with the estimated magnetic flux amplitude and phase.
  • the expansion terms of Equations (9) and (10) are estimated anew each time procedure 256 is executed.
  • the minimization is executed using a least mean square cost function, as is known in the art.
  • the number of expansion parameters needed, in Equations (9) and (10), to compensate for the effect of the translational and rotational velocity of the sensing coils is known.
  • the minimization is used to estimate the zero order terms, F 1n and p m , for each transmission frequency used to produce the EM field, in each sensing coil. As the object is tracked, minimizations are repeatedly executed to estimate the higher order derivative terms until the number of terms retained in Equations (9) and (10) are sufficient to compensate for the translational and rotational velocity of the sensing coils.
  • Equations (9) and (10) can be truncated by retaining the terms up to the zero, first, second or any other higher order.
  • the number of terms retained from Equations (9) and (10) depend on the following factors: the width of the sampling window, the typical velocity and acceleration of the tracked object, and the mathematical EM field gradients of the EM field model describing the EM field the tracked object is located in, or a combination of the above.
  • the highest order term retained can be decided upon a priori or it can be treated as an adjustable parameter based on the normalized residual error between the EM field amplitudes estimated by the EM field model in procedure 252 and the EM field amplitudes estimated in procedure 262. For example, a normalized residual error of two to three ⁇ (i.e.
  • sensor motion effect compensator 196 compensates for the error in the amplitude and phase of the magnetic flux estimated by storage unit 194 by using Equations (9) and (10) to continuously define the amplitude and phase of the magnetic flux as Taylor series expansion functions, each time a magnetic flux measurement is stored in storage unit 194.
  • Sensor motion effect compensator 196 determines the terms anew, on the right hand side of Equations (9) and (10), by using a least mean square cost function.
  • Procedures 256 and 258 are therefore executed constantly. It is further noted that procedures 252, 254 and 258 can be executed simultaneously.
  • Equation (11) the magnetic flux measurements, measured and compensated for in procedures 256 and 258, are transformed into a corresponding matrix of magnetic field amplitudes by Equation (11). Transforming the magnetic flux measurements into magnetic field amplitudes requires the use of the EM field model and the sensing coil calibration parameters, respectively generated and stored in procedures 252 and 254.
  • the magnetic field amplitude of the first term on the right hand side of Equation (11), B" ⁇ (r k ), can be solved for using techniques known in the art.
  • Equation (11 ) can be truncated by retaining the terms up to the zero, first, second or any other higher order of mathematical gradient.
  • the highest order mathematical gradient term retained in solving for Equation (11) depends on the following factors: an estimation of the EM field model mathematical gradients and the approximate size of the sensing coils used.
  • the highest order term retained may be chosen a priori based on the above factors or it can be treated as an adjustable parameter based on the normalized residual error between the EM field amplitudes estimated by the EM field model and the EM field amplitudes estimated in procedure 262.
  • a normalized residual error of one ⁇ i.e. one standard deviation
  • magnetic flux to magnetic field converter 198 transforms the magnetic flux measurements, estimated and compensated for in storage unit 194 and sensor motion effect compensator 196, using Equation (11), into a corresponding matrix of EM field amplitudes.
  • Equation (8) the mathematical representation of the measured magnetic flux (for example, Equation (8)) will be a linear function of the expansion coefficients of the spherical expansion function.
  • the parameters involved in the definition of this linear function represent the geometry of the sensing coils. Therefore, these parameters are analogous to the tensor coefficients of Equation (11).
  • Equation (11) any mathematical model relating the EM field amplitudes measured within a sensing coil to the measured magnetic flux in a sensing coil, can be used in place of Equation (11).
  • Equation (11) the Taylor series expansions of Equations (5), (6), (7), (9), (10) and (11 ) are used throughout the rest of the description of the disclosed technique.
  • a difficulty in solving for the higher order EM field amplitude terms in Equation (11) stems from not knowing the current position of the sensing coils.
  • the position of the sensing coils is determined and the higher order EM field amplitude terms in Equation (11) are solved for.
  • an extrapolation technique is used to estimate the position of the sensing coils, which can be used to estimate the higher order EM field amplitude terms in Equation (11).
  • the estimated position of the sensing coils is calculated, based on the previous position of the sensing coils. The previous position of the sensing coils is obtained from the center of the previous sampling window to the center of the current sampling window.
  • the estimated position of the sensing coils is extrapolated from the center of the current sampling window to the center of the next sampling window.
  • Equations (8), (9) and (10) all the measurements of the position of the sensing coils, at a particular time, are related to the center of the current respective sampling window.
  • the extrapolation can be based on the following assumptions, for example, a fixed translational and rotational velocity of the sensing coils in one sampling window, or a fixed translational and rotational velocity of the sensing coils within a time duration between the center of two successive sampling windows.
  • the extrapolated position of the sensing coils is used as the location where the gradients terms of Equation (11) are estimated.
  • an iterative technique using the principles of perturbation theory, is used to determine the position of the sensing coils.
  • the EM field amplitude components are first estimated based on a simplified sensing coil model of point-like sensor assemblies. This is equivalent to solving Equation (11) with only the first term of the right hand side, as in procedure 260.
  • the estimated EM field amplitude components are then used to approximate the position of each sensing coil.
  • the position of each sensing coil is then used to estimate the gradient terms of Equation (11).
  • the estimated gradients terms can then be used again to estimate the EM field amplitude components.
  • the EM field amplitude components can then be used again to approximate the position of each sensing coil.
  • each sensing coil can then be used again to estimate the gradient terms of Equation (11). This technique is repeated, in an iterative manner, using the principles of perturbation theory, until a sufficient accuracy, in estimating both the position of the sensing coils and the EM field amplitude components, is achieved.
  • the position of the sensing coils as well as the higher order gradient terms of Equation (11) are determined simultaneously.
  • the position of the sensing coils is estimated using Equation (12), which minimizes the deviation between the EM field amplitudes determined by the EM field model and the EM field amplitudes estimated by Equation (11).
  • the higher order gradient terms of Equation (11) are estimated using Equation (13), which minimizes the deviation between the magnetic flux estimated in procedure 258 and the magnetic flux estimated from the EM field model.
  • Equations (12) and (13) are solved by using a non-linear, least mean square optimization technique, for example, Newton's method, as is known in the art.
  • the normalized residual error in the calculation of the position of the sensing coils is determined.
  • the normalized residual error is referred to as the figure of merit (herein abbreviated FOM) of a position calculation.
  • the FOM is substantially defined by Equation (14).
  • position processor 200 determines the position of the sensing coils using either extrapolation, iteration, or simultaneous minimization techniques. Position processor 200 also determines the FOM for each position calculation executed.
  • each position calculation is grouped together with its corresponding compensated magnetic flux measurement in procedure 258, into an element referred to as a point.
  • each point is assigned a grade.
  • the grade is a positive parameter dependent on the following factors: the FOM of the point, the geometrical location of the point in the motion box, and the grades assigned to already stored points.
  • the factors each have relative weights in determining the grade. For example, a large FOM of a current point, compared to the FOM of already stored points, is an aspect which increases the grade, because such points help improve the EM field model.
  • the geometrical location of the point in the motion box is far enough from all the points already stored, it may also be a reason for increasing the grade of the current point.
  • Position measurements with large FOMs are indicative of locations in the motion box not yet explored by the tracked object. Since these new locations help improve and expand the EM field model, such measurements may receive high grades.
  • the grades of points already stored may also be varied with time. For example, the grades of points already stored may gradually decrease over time, introducing a fading memory effect to already stored points.
  • grade assignment module 202 assigns a grade to each point.
  • points with a high enough grade are stored.
  • a point is stored if its grade is above a certain minimal level and there is still room to store more points. If there is no room to store a point, and a point possesses a high enough grade for storage, the point is stored by replacing an already stored point with a lower grade.
  • the numbers of points stored is, in general, determined by the number of unknowns that need to be determined in Equation (3) to properly generate an accurate EM field model of the EM field in which the tracked object is located in.
  • Points with high enough grades are stored and used to refine the EM field model generated in procedure 252 and in calibrating the sensing coils by refining the calibration parameters of the sensing coils stored in procedure 254.
  • storage unit 194 stores points with a high enough grade.
  • the accuracy to which sensing coil calibration parameters are known, and the accuracy to which the EM field model, generated in procedure 252, estimates the EM field amplitude components measured by the sensing coils, is determined. The determination of the accuracy is based on the following factors: the FOM of the accumulated points, the accuracy achieved so far, the accuracy expected by a user, and the mathematical observability of the parameters defining the EM field model and the sensing coil calibration parameters. If the determined accuracy is above the required level, the method returns to procedure 260, where the updated position of sensing coils are continuously estimated, along with their FOMs.
  • model accuracy evaluator 206 determines the accuracy to which sensing coil calibration parameters are known, and the accuracy to which the EM field model estimates the EM field amplitude components measured and compensated, respectively, in storage unit 194 and sensor motion effect compensator 196.
  • procedure 272 the current EM field model parameters and the current sensing coil calibration parameters are modified adaptively by solving Equations (15) and (16). In the case that a sensing coil is replaced, certain parameters in Equations (15) and (16) will not be known immediately after the sensing coil is replaced. In order to perform the adaptation of those parameters, Equations (17) and (18) are solved.
  • the minimization executed in procedure 272 is similar to the minimization executed in procedure 262. The difference in the minimization between the two procedures is that in procedure 272, a minimization calculation involving all the points stored in procedure 268 is executed, whereas in procedure 262, a minimization is executed on only a single point.
  • Some of the parameters defining the EM field model and the calibration parameters of the sensing coils may be mathematically non-observable when the minimizations of Equations (15) and (16) (or Equations (17) and (18)) are executed. This is typical when a tracked object is in a new environment, the FOM of accumulated points is high, few points are stored, or an area of the physical motion box, with a low probability of being explored, for example, a comer of the physical motion box, has not yet been explored by the tracked object. In the case of few points being stored, a model simplification technique is used to execute the minimizations of Equations (15) and (16) (or Equations (17) and (18)).
  • non-observable parameters are either excluded from the EM field model and the minimization calculations, or they are considered as constants in the minimization calculations.
  • Non-observable parameters can be selected using standard methods in estimation theory, for example, using Cramer-Rao bounds analysis, as is known in the art.
  • the model simplification technique can also be used when an entire set of EM field model parameters ⁇ mk are non-observable, indicating that the EM field model structure and the sensing model structure have not yet been established.
  • the EM field model structure is not established when the EM field model generated in procedure 252 cannot estimate the position of sensing coils, attached to a tracked object, to a high degree of accuracy.
  • the sensing model structure is not established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object, has not yet been determined.
  • a constraint technique is used to execute the minimizations of Equations (15) and (16) (or Equations (17) and (18)).
  • all parameters, including non-observable ones, are considered in the minimization calculations, except the minimization calculations are performed under specific constraints.
  • One such constraint could be that the EM field amplitude components, estimated by the EM field model generated in procedure 252, before and after the minimization calculations, be close to one another within a defined tolerance level.
  • the constraint technique becomes a preferred technique to use when the EM field model structure and the sensing model structure have been established.
  • the EM field model is established when the EM field model generated in procedure 252 can estimate the position of sensing coils, attached to a tracked object, to a high degree of accuracy.
  • the sensing model structure is established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object, has been determined, but some parameters of those equations are non-observable.
  • the model simplification technique and the constraint technique allow the method to select the points with the highest grades to perform the minimization calculations. These techniques allow procedure 272 to start minimizing with very few points stored.
  • the rapid onset of minimization calculations allow for an accelerated rate in minimizing parameters and a quick determination of an accurate EM field model.
  • the rapid onset of minimization calculations also allows for an accelerated rate in calibrating the sensing coils and their respective sensor assemblies.
  • the tracked object does not need to explore the entire motion box before an accurate EM field model can be generated and the sensing coils, and their respective sensor assemblies, attached to the tracked object are calibrated.
  • the disclosed technique allows the EM field model accuracy to be increased in restricted areas of the motion box, where points have already been collected and stored.
  • parameters adaptation module 208 modifies and adapts the EM field model parameters and the sensing coil calibration parameters by executing the minimization equations substantially defined by Equations (15) and (16) (or Equations (17) and (18)). Parameters adaptation module 208 also utilizes the model simplification technique and the constraint technique to compensate for a lack of progress in adaptively modifying the EM field model parameters and the sensing coil calibration parameters.
  • procedure 274 the result of the minimizations executed in procedure 272 is evaluated and used to determine the increase or decrease in accuracy in the EM field model and the sensing coil calibration parameters.
  • the evaluation is executed by computing the FOM values for each point involved in the minimizations performed in procedure 272, using the updated EM field model parameters and sensing coil calibration parameters minimized in procedure 272.
  • the obtained distribution of FOM values for each point may be characterized by a single value, or a few values, such as the root mean square of the FOM distribution, the maximum FOM obtained, or any other distribution property. This value is used in procedure 274 to determine the increase or decrease in the accuracy in estimating the position of a tracked object, as executed in procedure 262, as compared with a previous estimation of the position of the tracked object.
  • the previous accuracy can be determined by the obtained distribution of FOM values obtained for points using the non-minimized EM field model parameters and sensing coil calibration parameters, indicating the parameter values before they are minimized in procedure 272. If a significant increase in accuracy is observed, such that changing the EM field model generated in procedure 252 is warranted, the method proceeds to procedure 276. If an increase in accuracy is observed, but the increase is insufficient to warrant changing the EM field model determined in procedure 252, the method returns to procedure 272. If no increase in accuracy is achieved, or a very insignificant increase in accuracy is achieved, the method proceeds to procedure 280.
  • adaptation accuracy evaluator 210 evaluates the result of the minimization executed by parameters adaptation module 208, and determines the increase or decrease in the accuracy value in the EM field model and the sensing coil calibration parameters using the results of the minimizations.
  • the evaluation is executed by computing the FOM values for each point involved in the adaptation performed by parameters adaptation module 208, using the updated EM field model parameters and sensing coil calibration parameters minimized by parameters adaptation module 208.
  • Equation (11) is expanded by estimating the contribution of the next additional, higher order, mathematical gradient term in Equation (11), which is not used in procedure 262. For example, if F mk is solved for, in procedure 262, using only the first two terms on the right hand side of Equation (11), then, in procedure 280, F mk is solved for using the first three terms on the right hand side of
  • Equation (11) The contribution of the additional term in Equation (11) can be estimated by using an approximation about the sensing coil form, and the EM field distribution within each sensing coil. If that contribution is not negligible, the method returns to procedure 272, where the expanded form of Equation (11) is used in procedure 272 in another round of minimization calculations.
  • the sensing coil calibration parameters may still yield distorted position estimates of the sensing coils.
  • Equation (11 ) may be expanded by repeating procedure 280. If that contribution is negligible, or the expanded form of Equation (11) still does not yield the desired EM field model accuracy and sensing coil calibration accuracy, the method goes to procedure 282.
  • Equation (11) is used by parameters adaptation module 208 in another round of minimization calculations. If that contribution is negligible, or the expanded form of Equation (11) still does not yield the desired EM field model accuracy and sensing coil calibration accuracy, a trial and error technique is used by parameters adaptation module 208, to improve the accuracy of system 140.
  • a trial and error technique is used to improve the accuracy in determining the position of a tracked object.
  • the trial and error technique involves expanding the various expansion functions used in procedures 252, 254, 258, 260, 262 and 272, for example, the EM field model, or any of Equations (5), (6), (7), (9), (10), (11).
  • the expansion can also involve adding a new mathematical expansion center to the immediately preceding list of expansion functions and equations.
  • a non-linear optimization technique is used to determine a relevant position for the new mathematical expansion center.
  • the new mathematical expansion center is added by determining the direction of the sharpest increase in the deviations minimized in Equations (15) and (16) (or Equations (17) and (18)). The direction of the sharpest increase indicates the direction of the singularity of the EM field.
  • the region near the singularity of the EM field is then determined and divided into a plurality of segments. Iteratively, the location of each segment is chosen as the location of the new mathematical expansion center, and is used in the minimizations executed using Equations (15) and (16) (or Equations ,(17) and (18)). The location of the segment which yields the lowest FOM is then added as the new mathematical expansion center. In either case of expansion, the expanded equations are used in an additional minimization calculation in procedure 282, similar to the minimization calculations executed in procedure 272. With reference to Figure 4, a trial and error technique is used by parameters adaptation module 208, to improve the accuracy of system 140.
  • procedure 284 the result of the minimizations executed in procedure 282 is evaluated and used to determine the increase or decrease in accuracy in the EM field model and the sensing coil calibration parameters. If the achieved accuracy determined in procedure 284 increases, the expanded equations are used for another minimization calculation, similar to the minimization calculations executed in procedure 272, until the increase in accuracy is enough for the current EM field model generated in procedure 252, to be replaced. Once the increase in accuracy is high enough for the current EM field model generated in procedure 252 to be replaced, the method proceeds to procedure 276. If the achieved accuracy determined decreases, the method returns to procedure 282, where either the order of the retained expansion terms is increased, or a new mathematical expansion center is chosen. The trial and error technique is used in procedure 282 until the desired accuracy is achieved.
  • minimization calculations are performed iteratively, either with, or without expanding the sets of parameters searched for, until a satisfactory FOM level is achieved.
  • adaptation accuracy evaluator 210 determines the increase or decrease in the accuracy of the EM field model and the sensing coil calibration parameters. If the achieved accuracy value determined by adaptation accuracy evaluator 210 increases, the expanded equations are used for another minimization calculation. Minimization calculations are executed until the increase in accuracy value is sufficient to warrant replacing the current EM field model parameters stored in magnetic field model generator 190, by the updated, adapted EM field model parameters determined by parameters adaptation module 208. If the achieved accuracy value determined decreases, either the order of the retained expansion terms is increased, or a new mathematical expansion center is added. The trial and error technique is used by parameters adaptation module 208 until the desired system accuracy is achieved.
  • procedure 276 the estimation of the position of a tracked object, as well as the sensing coil calibration parameters, from procedure 262, are compared with the respective estimation of the position of a tracked object, as well as the sensing coil calibration parameters, from procedures 272 or 282, for a fixed control time.
  • the control time can be a few seconds or a few minutes depending on the case of usage in which the method is used in.
  • the FOM of points determined by the current EM field model parameters and sensing coil calibration parameters, and the FOM of the points determined by the adapted parameters determined in procedures 272 and 282 are compared.
  • the method proceeds to procedure 278. If the FOM provided by the adapted parameters is higher than the FOM provided by the current parameters, for most of the control time, the adapted parameters are abandoned, and the method returns to either procedure 272 or procedure 282, depending on whether procedure 280 was executed or not. If procedure 280 was not executed, the method returns to procedure 272. If procedure 280 was executed, the method returns to procedure 282.
  • model comparer module 212 compares the FOM of points determined by the current EM field model parameters and sensor assembly calibration parameters, respectively stored in magnetic field model generator 190 and storage unit 194, and the FOM of points determined by the adapted parameters, determined by parameters adaptation module 208.
  • procedure 278 the current parameters describing the EM field model and the sensing coil calibration parameters, are replaced by the updated, adapted parameters determined in procedures 272 and 282, if the FOM provided by the adapted parameters is lower than the FOM provided by the current parameters, for most of the fixed control time.
  • model comparer module 212 directs magnetic field model generator 190, and storage unit 194, to replace the current parameters stored thereto, by the updated, adapted parameters.

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)

Abstract

Apparatus for adaptively tracking the position of an object in a volume of interest, the apparatus including at least one transmitter, at least one sensor assembly, and a tracking processor, the transmitter being coupled with the volume of interest, for transmitting a multiple axis, time variant, electromagnetic field through the volume of interest, the sensor assembly including at least three sensors, the sensor assembly being coupled with the object, each of the three sensors respectively measuring a respective component of the electromagnetic field, the tracking processor being coupled with the transmitter and the sensor assembly, wherein the tracking processor produces and adapts a mathematical field model describing the electromagnetic field, the tracking processor further produces and adapts a mathematical sensing model, for compensating the effect of the translational and rotational velocity of each of the sensors, wherein the tracking processor estimates the position of the object from the measured respective components of the electromagnetic field, the field model and from the sensing model.

Description

ELECTROMAGNETIC TRACKER
FIELD OF THE DISCLOSED TECHNIQUE
The disclosed technique relates to electromagnetic trackers in general, and to methods and systems for modeling an electromagnetic field and calibrating sensing coils adaptively in an electromagnetic tracker, in particular.
BACKGROUND OF THE DISCLOSED TECHNIQUE
Electromagnetic trackers find use in a wide range of applications, ranging from video game systems and computer graphics to medical technologies and military uses. The main purpose of a tracker, in general, is to continuously determine the position of a moving object in real-time. Determining the position may include determining the physical location of the object, and the orientation of the object with respect to a coordinate system. For example, the continuously determined position may be used to control an object, like a medical probe, or to estimate the line of sight to a target.
In particular, electromagnetic trackers function by generating an electromagnetic field in the physical space in which an object is to be tracked. This physical space is referred to as a motion box in the art. The electromagnetic field is generated by one or more transmitters located on the electromagnetic tracker. A sensor is generally attached to the tracked object, which can determine a characteristic property of the electromagnetic field as a function of the physical location of the tracked object. It is common practice to determine a characteristic property of the electromagnetic field which involves the principle of electromagnetic induction. The measure of the characteristic property can be used to determine the position of the tracked object.
The sensor, attached to the tracked object, commonly measures the magnetic field strength at a single point in the motion box of the electromagnetic tracker, either as a vector or as the components of a vector. This single point is by and large related to the geometric center of the sensor. This measure is generally to a high degree of precision and is achieved by using sensors with a high degree of symmetry. For example, if the sensor is coil based, the coils should be concentric to a high degree of precision. Such sensors generally require a sophisticated calibration process, which is normally executed using a specially designed calibration setup. Over time, with general use and wear-and-tear, the geometric properties of a sensor change, and the calibration parameters of the sensor drift from their original values. This change in values necessitates a periodic replacement of the sensor along with a recalibration of the sensor, a process which is both time consuming and not cost effective. Furthermore, when coil based sensors are used in the presence of a non-uniform electromagnetic field, the finite time required to measure the magnetic field strength causes a distortion in that measurement. The amount of distortion increases as the velocity of the sensors increases. If the translational and rotational velocity of the sensors is faster than velocities typical of hand movements, then electromagnetic trackers tend to exhibit a significant decrease in tracking accuracy.
The magnetic field strength, measured by the sensor, is related to the position of the tracked object by a mathematical model describing the electromagnetic field generated by the electromagnetic tracker. The electromagnetic field generated by the electromagnetic tracker results from electric currents flowing in the transmitter, as well as from induced electric currents arising in metallic objects, which are located in the vicinity of the motion box of the electromagnetic tracker. The electromagnetic field generated is therefore dependent on the particular environment in which the electromagnetic tracker is used in. Any change in the position of metallic objects, in the vicinity of the motion box, requires updating the mathematical relations found between magnetic field strength measurements of the sensor and the position of the sensor. It is common practice to account for induced electric currents, which contribute to the electromagnetic field, in the mathematical model, by mapping the magnetic field strength for each position in the motion box, in a particular environment. The mathematical model parameters are then estimated to best fit the position and magnetic field strength measurements of the sensor to the mapping. The parameters are stored in the memory of the electromagnetic tracker and are used to estimate the position of the sensor in real-time.
In order for the electromagnetic tracker to work in multiple environments, multiple mappings of the electromagnetic field need to be executed in a variety of environments. Furthermore, metallic objects in the vicinity of the motion box of the electromagnetic tracker may change their position, or new metallic objects may be present in the vicinity of the motion box. Both of these situations necessitate a remapping of the motion box. These mappings can be very time consuming. Taken in conjunction with the recalibration needs of the sensor, the maintenance of an electromagnetic tracker can be cumbersome. In general, the analog hardware used in electromagnetic trackers needs to be of high precision and stability, which enables the analog hardware to be replaced when needed without changing the calibration parameters of the sensor or the estimated parameters of the mathematical model. Otherwise, replacement of the analog hardware may necessitate a recalibration of the sensor and a remapping of the electromagnetic field in the motion box of the electromagnetic tracker.
US Patent No. 6,534,982 issued to Jakab, entitled "Magnetic resonance scanner with electromagnetic position and orientation tracking device" is directed to a system and method for determining the position and orientation of an object in a magnetic resonance scanner. In this reference, the magnetic resonance scanner is used in conjunction with an electromagnetic position and orientation tracking device to calculate the position and orientation of an object within the magnetic resonance scanner. The electromagnetic tracker may be used to track the object and a target, relative to a reference coordinate frame. Magnetic fields are used for location tracking of the object.
The magnetic field is generated by applying an electric current to a conductive wire loop. The generated magnetic field is sensed by a magnetic field sensor attached to the object. In the magnetic field sensor, an electric signal is measured which is proportional to the magnetic field. The electric signal is used to calculate the magnetic field by a magnetic field sensing model. For a solenoid type coil sensor, the magnetic field sensing model used is Faraday's Law of Induction. Models for other types of magnetic field sensors can be used, where the magnetic field sensing model is derived based upon the physical laws that dictate the operation of that sensor.
Using a model of the generated magnetic field, at an estimated location in the reference coordinate frame, an estimated magnetic field can be calculated. The magnetic field generation model includes a line segment approximation of the shape of the magnetic field source and additional line segments accounting for components that distort the magnetic field. The model compensates for distortions in the estimated magnetic field at the sensor, by accounting for the magnetic field generated by the gradient coils in the magnetic resonance scanner and for the magnetic fields generated by any surrounding conductive and ferromagnetic materials. The location and direction of the line segments is determined through test measurements of the currents in the gradient coils and the resulting magnetic fields. The Biot-Savart Law is used in the magnetic field generation model to calculate the magnetic field generated by each line segment.
Comparing the estimated magnetic field to the measured magnetic field, an error is computed. The estimated location of the magnetic field sensor is then changed and the steps repeated until the error between the estimated magnetic field and the measured magnetic field falls below an acceptable level. When the error falls below the acceptable level, the location of the sensor, based on its estimated location, provides a representation of the actual location of the sensor.
US Patent No. 6,400,139 issued to Khalfin et al., entitled "Methods and apparatus for electromagnetic position and orientation tracking with distortion compensation" is directed to distortion compensation in electromagnetic position and orientation tracking systems. The method of Khalfin is applicable specifically to electromagnetic tracking systems where the components of an AC electromagnetic field are sensed within a bounded volume. One or more probe sensors are placed on an object being tracked within the bounded volume. Each probe measures the magnetic induction vector components of the field generated by an electromagnetic radiation source, to determine the position, orientation and movement of the object within the bounded volume. To compensate for electromagnetic distortion, the method of Khalfin employs at least one stationary sensor, termed a witness sensor, in addition to the probe sensor(s) disposed on the object. Each witness sensor is supported at a known, fixed position and orientation relative to a reference frame of interest, at a point near or within the bounded volume, and close to the sensors on the object being tracked.
The measurements of each probe sensor, and each witness sensor, are provided to a processing unit operative to compute the position and orientation of the object in the presence of electromagnetic field distortions. The processor uses data from each witness sensor to compute parameters, such as the position, orientation and strength, of an effective electromagnetic source or sources. The effective source(s), which may be treated for the sake of simplicity as a point source or a dipole, produce the same electromagnetic field as a superposition of the real electromagnetic field, in addition to the field distortion in the proximity of the witness sensors. In the case of a non-distorted environment, the effective source(s) will be identical to the real source. This equality allows the computed parameters of the effective source(s) to be used as inputs to the computation of the position and orientation, as measured by each probe sensor, as if the object is in the non- distorted electromagnetic field produced by the effective source(s).
US Patent No. 6,201 ,987 issued to Dumoulin, entitled "Error compensation for device tracking systems employing electromagnetic fields" is directed to a system for the real-time localization of a device using electromagnetic (or Radio Frequency) fields, which compensates for eddy currents in the presence of eddy current inducing structures. The system is augmented with hardware and/or software which compensates for the eddy currents and is capable of more accurately tracking an invasive device in the body of a subject. In the system of Dumoulin, current patterns applied to transmit coils of the tracking system are modified to compensate for the effect of the eddy currents. Eddy currents are compensated for by modifying the waveforms which are applied to the transmitter coils. Ideally, in the absence of eddy currents, the current and the resulting applied field are uniform in time. In the presence of electrically conducting structures, however, eddy currents are created, which oppose the field created by the transmit coil. These currents, and the field created by them, decay over time.
The modified waveform of the current supplied to the coils is a linear combination of the current needed to create the desired electromagnetic field in the region of interest, and one or more error terms. The error terms are determined experimentally during system calibration and are mathematically modeled as a series of exponential functions having a given amplitude and time constant. The error terms, in the current applied to the transmit coils, effectively cancel the magnetic fields created by eddy currents within the tracking region and result in an actual electromagnetic field which is close to the desired ideal electromagnetic field. The fidelity of the electromagnetic field is further increased by reducing eddy currents within the eddy current inducing structures. This is done by constructing shield coils which are placed between the transmit coil and the eddy current inducing structures. Magnetic fields are created by these shield coils which cancel the magnetic fields created within the eddy current inducing structures without substantially altering the electromagnetic fields in the region over which the invasive device is tracked.
US Patent No. 5,646,525 issued to Gilboa, entitled "Three dimensional tracking system employing a rotating field" is directed to a system for determining the position and orientation of a helmet worn by a crew member in a vehicle. The vehicle includes a generator, which produces a rotating magnetic and electric dipole field of fixed strength, orientation and frequency within a portion of the vehicle. The system includes a plurality of sensors which each generate a signal proportional to the electric or magnetic fields detected at a point associated with the helmet. The sensors each comprise three orthogonal coils or three orthogonal detectors, such as Hall detectors. The system also includes calculation circuitry responsive to the generated signal for ascertaining the coordinates of the point with respect to the generator, using a simple mathematical model, and for determining the position and orientation of the helmet.
The generated signal is proportional to the time derivative of the magnetic field flux along the axis of a particular coil, or detector, in the sensor. Since the generator produces a rotating magnetic dipole field, the magnetic field strength, and hence the magnitude of the generated signal, at a specific point in space, will oscillate in time between a maximum and a minimum value. According to the simple mathematical model, the maximum and minimum values will depend only on the elevation angle of the point from the generator and the distance of the point from the generator. By determining the maximum and minimum of the square of the electric and magnetic field strengths, the calculation circuitry can determine the position and orientation of the helmet.
SUMMARY OF THE DISCLOSED TECHNIQUE
It is an object of the disclosed technique to provide a novel method and system for tracking an object, which overcomes the disadvantages of the prior art.
In accordance with the disclosed technique, there is thus provided an apparatus for adaptively tracking the position of an object in a volume of interest. The apparatus includes at least one transmitter, at least one sensor assembly, and a tracking processor. The sensor assembly includes at least three sensors. The three sensors are arranged in a fixed configuration at different predetermined locations and orientations. The transmitter is coupled with the volume of interest. The sensor assembly is coupled with the object. The tracking processor is coupled with the transmitter and the sensor assembly. The transmitter transmits a multiple axis, time variant, electromagnetic field through the volume of interest.
Each of the three sensors respectively measures a respective component of the electromagnetic field. The tracking processor produces and adapts a mathematical field model describing the electromagnetic field. The mathematical field model is at least based on the multiple axis, time variant, electromagnetic field, the fixed configuration of the three sensors, and on the measured respective components of the electromagnetic field. The tracking processor further produces and adapts a mathematical sensing model, for compensating the effect of the translational and rotational velocity of each of the three sensors. The tracking processor estimates the position of the object from the measured respective components of the electromagnetic field, the field model and from the sensing model. The tracking processor stores calibration parameters associated with the sensor assembly. The position of the object includes the physical location of the object and the orientation of the object. According to another aspect of the disclosed technique, there is thus provided a method for adaptively tracking the position of an object in a volume of interest. The method includes the procedures of transmitting a multiple axis, time variant, electromagnetic field through the volume of interest, and measuring a respective component of the electromagnetic field, in at least one sensor assembly. The method further includes the procedures of producing a mathematical field model describing the electromagnetic field, and producing a mathematical sensing model for compensating the effect of the translational and rotational velocity of each of the three sensors. The method further includes the procedure of determining the position of the object from the measured respective components of the electromagnetic field, the field model and from the sensing model.
The sensor assembly includes at least three sensors. The three sensors are arranged in a fixed configuration at different predetermined locations and orientations. The field model is based on the multiple axis, time variant, electromagnetic field, the fixed configuration of the three sensors and on the measured respective components of the electromagnetic field. The position of the object includes the physical location of the object and the orientation of the object.
BRIEF DESCRIPTION OF THE DRAWINGS
The disclosed technique will be understood and appreciated more fully from the following detailed description taken in conjunction with the drawings in which:
Figure 1A is a graph, in accordance with an embodiment of the disclosed technique, depicting a known function with analytical solutions and an unknown function connecting data points;
Figure 1 B is a graph, in accordance with an embodiment of the disclosed technique, depicting the known function of Figure 1A minimized to the data points of Figure 1A;
Figure 2 is a schematic illustration of a system, constructed and operative in accordance with an embodiment of the disclosed technique;
Figure 3 is a detailed schematic illustration of the sensor assembly of Figure 2;
Figure 4 is a detailed schematic illustration of the tracking processor of Figure 2; and
Figures 5A and 5B are a schematic illustration of a method, operative in accordance with an embodiment of the disclosed technique.
DETAILED DESCRIPTION OF THE EMBODIMENTS
The disclosed technique overcomes the disadvantages of the prior art by providing an adaptive electromagnetic (herein abbreviated EM) tracker system and method. The adaptive tracker generates an EM field by providing an electric current through transmitting coils, located on the tracker. The adaptive tracker constructs and continuously adapts a mathematical model to describe the EM field a tracked object is located in. Simultaneously, the adaptive tracker calibrates sensing coils located on the tracked object, and determines the position of the tracked object in real-time. The adaptive tracker calibrates the sensing coils by constructing and continuously adapting a mathematical sensing model to describe the measurements determined thereto. The adaptive tracker obviates the need to perform a preliminary mapping of the EM field generated by the sensing coils located on the tracker. The adaptive tracker also obviates the need to perform a preliminary calibration of the sensing coils located on the tracked object. The adaptive tracker can be constructed using sensing coils which have no symmetry in their shape. Furthermore, the adaptive tracker does not place a limit on the rotational and translational velocity of the tracked object.
Mathematical functions, herein referred to as functions, equations or expressions, are mathematical relations that associate each element from a set of elements (i.e., the dependent elements), with at least one element from another set of elements (i.e., the independent elements). Functions refer to the relations in general, whereas equations refer to the actual mathematical form of the relations described by the functions. Functions are used, in general, to describe physical phenomena observed in nature, for example the effect of gravity on the velocity of objects falling from the sky, or the strength of an electric field near a power line, as is known in the art. Dependent elements are associated to independent elements, in equations, by variable quantities and constants, both of which are known as parameters in the art. For example, the equation that describes a straight line, f{x) = m-x + b (1 ) relates the x and y coordinates that describe a straight line, on a Cartesian plane, by 2 constant parameters, m, the slope of the line, and b, the y-intercept of the line, as is known in the art. The x and y coordinates are also considered parameters, as they are variable quantities that determine the form of the equation described in Equation
O)-
Theoretical situations of physical phenomena observed in nature, for example a point charge with no charges around it, even at an infinite point from the point charge, can generally be described by equations with analytical solutions that allow the relevant parameters of the equation to be known exactly. Most situations of physical phenomena observed in nature however, cannot generally be described by equations with analytical solutions, but can rather be approximated, most of the time, by known equations, with numerical solutions. Numerical solutions of known equations are values of the constant parameters of equations that cannot be solved for analytically, and must therefore be approximated, generally by methods executed using a computer.
In general, when a function describing a physical phenomenon observed in nature is sought after, the phenomenon is measured through appropriate units, and the data points measured are plotted on a graph. An equation, or expression, which appears to resemble the shape of the data points is then chosen. Since the chosen equation will not go through all the data points, the constant parameters of the equation need to be altered to best fit the chosen equation with the data points. Alternatively, variable quantities can be added to the chosen equation and altered to best fit the data points. Constant parameters of a known equation, which best fits the data points of a measured phenomenon, may be determined by using a mathematical method known as optimization or minimization. Optimization, or minimization, refers to a technique where parameters are determined such that the difference between the data points of a known equation, and the corresponding data points of an unknown equation, are brought to a minimum.
Reference is now made to Figure 1A, which is a graph, generally referenced 100, in accordance with an embodiment of the disclosed technique, graphically depicting a known expression with analytical solutions and an unknown expression, which can only be approximated by a known expression, with numerical solutions. Graph 100 includes a plurality of data points 102, an unknown graphed expression 104 and a known graphed expression 106. Data points 102 are measured values of a physical phenomenon in nature. Unknown graphed expression 104 is an expression, which when graphed, connects data points 102 to each other in a sequential manner. The form of unknown graphed expression 104 is not known. Known graphed expression 106 is an expression which describes a straight line. Since data points 102 roughly resemble a straight line, known graphed expression 106 can be used to approximately describe unknown graphed expression 104. Referring to Equation (1), the constant parameters of the expression that describes a straight line are: m, the slope of the line, and b, the y-intercept of the line. In order to best fit known graphed expression 106 to data points 102, the constant parameters of known graphed expression 106 can be minimized to data points 102.
Reference is now made to Figure 1 B, which is a graph, generally referenced 126, constructed and operative in accordance with an embodiment of the disclosed technique, depicting the known expression of Figure 1A minimized to the data points of Figure 1A. Graph 126 includes a plurality of data points 102, an unknown graphed expression 104 and a minimized known graphed expression 128. Data points 102 and unknown graphed expression 104 are the same as in Figure 1A. Minimized known graphed expression 128 is an expression that describes a straight line whose constant parameters, m and b, have been determined to best fit data points 102. Minimized known graphed expression 128 is minimized because the difference between data points 102 and corresponding data points on minimized known graphed expression 128 are at a minimum. This is equivalent to stating that minimized known graphed expression 128 best fits data points 102.
Reference is now made to Figure 2, which is a schematic illustration of a system, generally referenced 140, constructed and operative in accordance with an embodiment of the disclosed technique. System 140 includes a tracking processor 150, a transmitter interface 152, a plurality of digital to analog converters (DACs) 154^ 1542 and 1543, an amplifier 156, a transmitter assembly 158, a plurality of sensor assemblies 162^ 1622, 1623 and 162N, which each include a plurality of sensing coils (not shown), a plurality of analog to digital converter (ADC) assemblies 164^ 1642, 1643 and 164N and a sensor interface 166. In an embodiment of the disclosed technique, ADC assemblies 164i, 1642, 1643 and 164N each include a multiplexer (not shown) and a plurality of ADCs (not shown). Transmitter assembly 158 includes three transmitting coils (not shown). In another embodiment of the disclosed technique, transmitter assembly 158 includes at least one transmitting coil. Sensor assemblies 162-ι, 1622, 1623 and 162N each include six sensing coils. In another embodiment of the disclosed technique, sensor assemblies 162^ 1622, 1623 and 162N each include at least three sensing coils. ADC assemblies 164^ 1642, 1643 and 164N each include six ADCs. In another embodiment of the disclosed technique, ADC assemblies 1641 a 1642, 1643 and 164N each include at least three ADCs. It is noted that each sensing coil in sensor assemblies 162!, 1622, 1623 and 162N has a respective single ADC in ADC assemblies 164i, 1642, 1643 and 164N corresponding to it. It is noted that the plurality of digital to analog converters (DACs) 154i, 1542 and 1543, can include more than three DACs, each respective of a signal to be transmitted.
Tracking processor 150 includes a plurality of sub-processor units (described in Figure 4) for the following purposes: estimating the position of the sensing coils included in each sensor assembly and any objects associated with such sensing coils, for example a tracked object, adaptively calibrating the sensing coils included in each of sensor assemblies 162-ι, 1622, 1623 and 162N, by constructing and continuously adapting a mathematical sensing model to describe the measurements estimated thereto, and constructing and continuously adapting a mathematical model to describe the EM field the tracked object is located in. The position of a sensing coil can include the physical location of the sensing coil, for example in a coordinate system, or the orientation of the sensing coil with respect to a coordinate system, or both.
Transmitter interface 152 is coupled with DAC units 154^ 1542 and 1543, with tracking processor 150 and with transmitter assembly 158. DAC units 1541 ; 1542 and 1543 are further coupled with amplifier 156. Amplifier 156 is further coupled with transmitter assembly 158. Sensor assemblies 162-ι, 1622, 1623 and 162N are further marked S1, S2, S3 and SN, respectively. Analog to digital converter (ADC) assemblies 1641 ; 1642, 1643 and 164N are respectively coupled with each of sensor assemblies 162i, 1622, 1623 and 162N and with sensor interface 166. The ADCs (not shown) in each ADC assembly are coupled with the multiplexer (not shown) located thereto. Each of the ADCs in ADC assemblies 1641 ; 1642, 1643 and 164N are therefore coupled with a respective single sensing coil in each of sensor assemblies 162^ 1622, 1623 and 162N at a given moment in time by the use of the respective multiplexer in each ADC assembly. Sensor interface 166 is further coupled with tracking processor 150. It is noted that each of sensor assemblies 162^ 1622, 1623 and 162N can be firmly attached to an object, thereby providing information relating to the position of that object.
Transmitter interface 152 produces a sequence of numbers. Transmitter interface 152 can also produce a digital representation of a signal. The sequence of numbers includes measurements of the current flowing in each transmission coil in transmitter assembly 158. These measurements are sampled at equal time intervals, at a sampling frequency which is at least two times higher than the highest transmitted frequency of transmitter assembly 158. A higher ratio between the sampling frequency and the highest transmitted frequency will produce measurements with less noise. The sequence of numbers is provided to DAC units 1541 ; 1542 and 1543, which each, in turn, converts it to a respective analog signal. Each of the analog signals is respective of a different spatial axis. In Figure 2, DAC unit 154! produces a signal for the x-axis, DAC unit 1542 produces a signal for the y-axis and DAC unit 1543 produces a signal for the z-axis. DAC units 154-ι, 1542 and 1543 provide their respective analog signals to amplifier 156, which amplifies the respective analog signals and provides the amplified signals to transmitter assembly 158.
Transmitter assembly 158 uses the amplified signals to generate respective amplified frequencies. Each transmitting coil, included in transmitter assembly 158, transmits a different amplified frequency for a different spatial axis. In practice, each transmitted amplified frequency, for each specific spatial axis, generally includes the transmitted frequencies for the other spatial axes, with the amplified frequency for that specific spatial axis being much stronger than the other frequencies. The other frequencies arise due to mutual inductance. In another embodiment of the disclosed technique, each transmitting coil, included in transmitter assembly 158, transmits a different amplified frequency combination for a different spatial axis. Each frequency combination may include a plurality of different frequencies. In general, more than six frequencies may be used by transmitter assembly 158, in order to achieve sufficient mathematical observability of the parameters of the EM field model (described in Figure 4) and the sensing coil calibration parameters (described in Figure 4), to accurately track an object. EM field 160 is the superposition of the individual EM fields generated by each transmission coil, each at different frequencies, in transmitter assembly 158.
Transmitter assembly 158 uses the generated respective amplified frequencies to provide a multiple axis EM field 160 to an area, which is defined by a detectable minimum EM field strength of EM field 160 and the boundaries of the physical space a tracked object can move about in. This virtually confined area is known in the art, in general, as a motion box. A magnetic motion box is defined as the volume in which the sensing coils of an EM tracker can detect the presence of an EM field. A physical motion box is defined as the boundaries of the physical space a tracked object can move about in. In general, in EM trackers, the volume defined by the physical motion box is included in the volume defined by the magnetic motion box. Therefore motion boxes mentioned herein refer to physical motion boxes unless otherwise stated. For example, a motion box can be located within the cockpit of a fighter jet, the inside of a tank, or the room in which a user using a 3D virtual reality console is located in. The EM field generated by transmitter assembly 158 is unique in the sense that each point in the motion box has unique measurable quantities, for example the magnetic field strength, as a vector quantity, of each point. Typically, transmitter assembly 158 provides frequencies on the order of tens of kilohertz. EM field 160 causes a voltage difference in the sensing coils (not shown) of sensor assemblies 16215 1622, 1623 and 162N, a phenomenon known as EM induction. The voltage difference is measured by each of sensor assemblies 162^ 1622, 1623 and 162N. The measuring of the voltage differences is synchronized with the measurements of the current flowing in each transmission coil in transmitter assembly 158. The voltage difference allows each of sensor assemblies 1621 ; 1622) 1623 and 162N to correspondingly estimate the respective magnetic flux of EM field 160 passing through each of its respective sensing coils. Sensor assemblies 162^ 1622, 1623 and 162N thereby indirectly measure the magnetic flux of EM field 160 passing through each of its respective sensing coils. This indirect measurement is herein referred to as a measurement. Each of sensor assemblies 1621 t 1622, 1623 and 162N produces a respective electrical analog signal corresponding to the magnetic flux measured by the respective sensing coils in that sensor assembly and provides it to the respective ADC assemblies 1641 ; 1642, 1643 and 164N coupled therewith. Each of the ADCs in ADC assemblies 164^ 1642, 1643 and 164N digitizes the analog signal fed thereto, converts it to a sequence of numbers and provides it to sensor interface 166, which in turn provides it to tracking processor 150.
Tracking processor 150 analyzes the received sequences of numbers, thereby estimating the position of each of the sensing coils of sensor assemblies 1621 ; 1622, 1623 and 162N, and providing the position data to a user. Accordingly, the analysis of tracking processor 150, in estimating the position of a tracked object, consists of estimating the position in the motion box corresponding to a particular magnetic flux measurement of the sensing coils of sensor assemblies 162^ 1622, 1623 and 162N. The magnetic flux measurement of each of the sensing coils is related to the position of that sensing coil according to a mathematical model of the EM field generated by transmitter assembly 158. Theoretically, if the number of transmission frequencies is at least six, with each frequency corresponding to a unique spatial distribution and orientation of EM field 160 and if the model of the EM field is fully determined, then system 140 can use a single sensor assembly, which includes a single sensing coil, to determine the position of a tracked object.
As a tracked object (not shown) moves around the motion box in which EM field 160 is provided, sensor assemblies 162^ 1622, 1623 and 162N continuously measure the magnetic flux of EM field 160. Tracking processor 150 uses the updated magnetic flux measurements of sensor assemblies 162i, 1622, 1623 and 162N to continuously update a user of the position of the tracked object (not shown). Tracking processor 150 continuously uses the updated magnetic flux measurements of sensor assemblies 162i, 1622, 1623 and 162N to adaptively calibrate the sensing coils, within each of those sensor assemblies, with respect to one another. Tracking processor 150 also continuously uses the updated magnetic flux measurements of sensor assemblies 162-ι, 1622, 1623 and 162N to adaptively improve the accuracy to which system 140 can estimate the position of the tracked object. The accuracy of system 140 is improved by modifying the mathematical models, used to describe the EM field, generated by transmitter assembly 158, and the measurements estimated by the sensing coils of sensor assemblies 162^ 1622, 1623 and 162N, as shall be described further below.
Reference is now made to Figure 3, which is a detailed schematic illustration of sensor assemblies 1621 ; 1622, 1623 and 162N (Figure 2). A sensor assembly 162 includes a plurality of sensing coils 17O1, 17O2 and 17O3. Each of sensing coils 17O1, 17O2 and 17O3 measures the voltage difference thereto, thereby indirectly measuring the quantity of magnetic flux passing there through. Each sensing coil indirectly measures the magnetic flux passing through it for a respective axis in a coordinate system, for example sensing coil 17O1 measures the magnetic flux passing through it for the x-axis, sensing coil 17O2 measures the magnetic flux passing through it for the y-axis and sensing coil 17O3 measures the magnetic flux passing through it for the z-axis. Sensing coils 17O1, 17O2 and 17O3 are not necessarily orientated, with respect to one another, in an orthogonal manner. It is noted that a sensor assembly, according to the disclosed technique, can include more than three sensing coils, which may increase the accuracy and enhance the performance of system 140.
Reference is now made to Figure 4, which is a detailed schematic illustration of tracking processor 150 (Figure 2). Tracking processor 150 includes a magnetic field model generator 190, a storage unit 194, a sensor motion effect compensator 196, a magnetic flux to magnetic field converter 198, a position processor 200, a grade assignment module 202, a model accuracy evaluator 206, a parameters adaptation module 208, an adaptation accuracy evaluator 210, and a model comparer module 212.
Storage unit 194 is coupled with sensor motion effect compensator 196. Magnetic field model generator 190 is coupled with magnetic flux to magnetic field converter 198. Sensor motion effect compensator 196 is coupled with magnetic flux to magnetic field converter 198. Storage unit 194 is further coupled with magnetic flux to magnetic field converter 198. Sensor motion effect compensator 196 is further coupled with position processor 200. Magnetic flux to magnetic field converter 198 is further coupled with position processor 200. Position processor 200 is coupled with grade assignment module 202. Position processor 200 is further coupled with magnetic field model generator 190. Grade assignment module 202 is coupled with storage unit 194. Grade assignment module 202 is further coupled with model accuracy evaluator 206. Model accuracy evaluator 206 is coupled with parameters adaptation module 208. Model accuracy evaluator 206 is further coupled with position processor 200. Parameters adaptation module 208 is coupled with adaptation accuracy evaluator 210. Parameters adaptation module 208 is further coupled with model comparer module 212, magnetic field model generator 190, storage unit 194, magnetic flux to magnetic field converter 198 and position processor 200. Adaptation accuracy evaluator 210 is coupled with model comparer module 212. Model comparer module 212 is coupled with magnetic field model generator 190. Model comparer module 212 is further coupled with storage unit 194 and position processor 200.
Magnetic field model generator 190 generates and stores thereto, an approximated mathematical model of the EM field generated by transmitter assembly 158 (Figure 2), herein referred to as the model. When system 140 (Figure 2) initially starts tracking, the approximated model does not fully describe the EM field generated by transmitter assembly 158. The accuracy, at that point in time, to which system 140 can track an object is therefore low. Initially, the model does not include all the variable and constant parameters needed to describe the EM field generated by transmitter assembly 158. For example, the effect of currents induced in metallic elements in the motion box of system 140 by EM field 160 (Figure 2) may not be compensated for by the model when system 140 starts tracking. Therefore, the model stored by magnetic field model generator 190 is initially incomplete. As a tracked object moves about in the motion box, the model is built up until it is complete and the accuracy to which system 140 can track an object is high.
The model generated by magnetic field model generator 190 may include either a harmonic expansion function, for example a spherical function describing the EM field, or an analytic relation describing the EM field, for example a relation based on the Biot-Savart Law, or a combination of the two. The model includes at least one set of parameters describing EM field 160, where each element of each set of parameters is a vector of real numbers. Parameters describing EM field 160 can include the coordinate relationships between transmitter assembly 158, EM field 160 and the sensing coils of each of sensor assemblies 162i, 1622, 1623 and 162N (Figure 2), as well as expansion centers and expansion coefficients of the model generated by magnetic field model generator 190. The set of parameters is mathematically designated by θpm , where p = l,2,...,S , and m = l,2,...,Nf . The first index, p , enumerates the sets of parameters, from the first set (l) to the last set (s). The second index m , enumerates the transmission frequencies of transmitter assembly 158, from the first frequency used (l) to the last frequency used (Nf). Nf is the total number of frequencies used by transmitter assembly 158. Magnetic field model generator 190 needs to be provided with only the number of frequencies provided by transmitter assembly 158 and not the number of transmission coils included in transmitter assembly 158. The model is constructed by defining a reference frame, herein referred to as the model reference frame, in the motion box of system 140 defined by EM field 160. The model reference frame locally establishes a coordinate system for relating the position of a tracked object in the motion box to a user. The model reference frame is a fixed reference frame.
The model substantially includes a matrix function, designated Φ , for estimating the EM field amplitudes of EM field 160 from a fixed observation point within each sensing coil of each of sensor assemblies 1621 ? 1622, 1623 and 162N, at each transmission frequency of transmitter assembly 158. The fixed observation point can be the magnetic center within each sensing coil of each of the sensor assemblies. The magnetic center is defined as the center of mass of the inner volume of each sensing coil. EM field 160 can be completely characterized by the EM field amplitude at a particular transmission frequency at a particular point, because the amplitude, for a particular transmission frequency, is unique for each point in the EM field in the motion box.
The amplitude of the EM field is designated by the vector Bmk , where Bmk = [Bx,k,Bζk,B^nk]. The first index, m , enumerates the transmission frequencies of transmitter assembly 158, from the first frequency used to the last frequency used. The second index, k , enumerates the sensing coils in all of sensor assemblies 162-ι, 1622, 1623 and 162N. The index k ranges from 1 toNc , where Nc is the combined total number of sensing coils in all the sensor assemblies. Bm x k , Blk and Blk , are respectively, the x-component, y-component and z-component of the EM field amplitude of the m"' transmission frequency in the k"' sensing coil. The model provides an analytical expression for the unique EM field amplitude at each particular frequency at the magnetic center of each sensing coil in a coordinate system relative to the sensor assemblies. This coordinate system moves as the sensor assemblies move, and is herein referred to as the sensor reference frame. The sensor reference frame can be related to the model reference frame by designating a vector, f , as the location of the origin of the sensor reference frame relative to the model reference frame, a rotation matrix, R , as the orientation of the sensor reference frame relative to the model reference frame and vectors J\,...,rN, as the radius vectors from the origin of the sensor reference frame to the magnetic center of each sensing coil.
Overall, EM field 160 can be defined as a matrix quantity B , where
B m, \
B = (2)
B m. Nr and Bmi,...,BmNe , are the vector amplitudes of EM field 160 estimated in all the sensing coils, for all the transmission frequencies provided by transmitter assembly 158. Therefore, the matrix quantity B is a function of the model parameters θpm , the position of the sensor reference frame relative to the model reference frame and the radius vectors from the origin of the sensor reference frame to the center of each sensing coil magnetic center. This function can be written as
B = φ[θn,...,θSNf ,P,O,rv...,rNc ) (3) where θn,...,θSN are all the parameter sets of all the frequencies provided by transmitter assembly 158, P is defined as 7 , O is defined as R and all other quantities are as they were defined above. Matrix function Φ may be either a linear or non-linear function with respect to the model parameters θpm . For example, when EM field 160 is represented in the form of a harmonic expansion function, the EM field amplitude of the mth transmission frequency at the magnetic center of the k'h sensing coil can be written as
Figure imgf000026_0001
where Bmk(r + rL) represents the vector amplitude of EM field 160 estimated at the m'h transmission frequency at the magnetic center of the k"' sensing coil, /^(r + rj is a set of harmonic vector functions, where the index i represents the field component, with i = x,y,z , the index j represents the order of the harmonic expansion function, with 7 = 1,..., 5 , where the boundaries of j , namely l,...,S , correspond to the boundaries of the first index on θ, and all other quantities are as they were defined above. In this example, according to Equations (2) and
(3), the matrix function Φ includes the EM field amplitudes Bmk(r+rk) estimated for each transmission frequency in each sensing coil by Equation (4). In this example, when matrix function Φ is chosen as a linear expansion, in terms of a harmonic function, each set of model parameters θpm , in Equation (4), estimates an independent contribution to B at each transmission frequency, m , of transmitter assembly 158. In an embodiment of the disclosed technique, the model has an efficient analytical or numerical method, for determining the mathematical gradients of the EM field model.
Storage unit 194 stores a set of calibration parameters of sensor assemblies 1621 ; 1622, 1623 and 162N. Calibration parameters include the orientation of the sensing coils of each sensor assembly with respect to the sensor reference frame in system 140, the set of radius vectors 7k , from the origin of the sensor reference frame of system 140 to the magnetic center of each sensing coil, the gain in each sensor assembly, the parameters defining the amplifiers in each sensor assembly, other parameters relating to the electronic components of the sensor assemblies, other sensing coil calibration data, and the respective error to which each of these quantities is known. When system 140 commences tracking an object, the relative rotation angles of the sensing coils with respect to one another, are known with an error of several degrees. The relative rotation angles and their respective errors are stored in storage unit 194. In addition, internal calibration parameters of the sensing coils, are known with an error of a few percent, and stored in storage unit 194.
Storage unit 194 also stores a Taylor series expansion function for each coordinate component (χ,y,z) of the EM field amplitude of EM field 160 as a function of the vector location of a point, q , in EM field 160, designated by the vector 7. 7 is a vector measured from the origin of the sensor reference frame to point g . The coordinate components of the EM field amplitude at a vector point 7 within a sensing coil, in the vicinity of 7k , the radius vector from the origin of the sensor reference frame to the magnetic center of the k"' sensing coil (as is known in the art), can be expanded as:
Figure imgf000028_0001
as{x,y,z) Of ** a,βe{x,y,z} Ot k rk where m = l,2,...,Nf , k = \,2,...,Nc , and BJ1 j), BJy r) and BJ1 f), are respectively, the x-component, y-component and z-component of the EM field amplitude of the m"' transmission frequency in the k"' sensing coil as a function of radius vector fk to observation vector point F . The index m , enumerates the transmission frequencies of transmitter assembly 158, from the first frequency used 1 to the last frequency used Nf . The index k , enumerates the sensing coils in sensor assemblies
1621 a 1622, 1623 and 162N. All other terms are as they were defined above.
Storage unit 194 also stores the magnetic flux estimated by the measurements of the sensing coils. The stored magnetic flux measurements are used by storage unit 194 to estimate the amplitude and phase of the magnetic flux estimated by the sensing coils. Typically, the signal measured by a steady state sensing coil is expected to follow a mathematical model, where the signal measured is defined mathematically as a periodic function of time
F(ή= ∑Fm cos{2πfmt + Pm) (8)
IM=I where F(t) is the magnetic flux at time instant t , F1n is the amplitude of the magnetic flux at transmission frequency number m (fm) and pm is the phase of the magnetic flux at /„, . The definition of Equation (8) is stored in storage unit 194. In order to estimate the values of parameters Fm and pm in Equation (8), such that Fit) in Equation (8) substantially describes the magnetic flux measurements measured by the sensing coils, multiple measurements of the magnetic flux in a time period T are executed at a known frequency, /„, . The measurements are fit to Equation (8) in sensor motion effect compensator 196, using mathematical fitting techniques known in the art, from which an estimated value for F1n and pm can be obtained. Time period T is commonly referred to in the art as a sampling window. Estimating F1n and pm using multiple measurements in a sampling window is accurate in the case that the sensing coils located inside each sensor assembly are stationary.
In system 140, the tracked object, onto which the sensing coils are attached, may be moving. This movement may occur during a sampling window and introduces an error in the amplitude and phase approximation of the magnetic flux as a function of time. This error is due to the translation and rotational velocity of the sensing coils in each of the respective sensor assemblies, and is manifest in the form of a non-periodic variation of magnetic flux as a function of time.
Sensor motion effect compensator 196 compensates the effect of the translational and rotational velocity of the sensing coils, on the estimated magnetic flux amplitudes and phases. Sensor motion effect compensator 196 executes the compensation by continuously generating a mathematical sensing model (herein referred to as the sensing model) of each measurement estimated by the sensing coils. The sensing model defines F111 and pm as time functions rather than as constant parameters. F1n and pm are defined, in general, in sensor motion effect compensator 196, as Taylor series expansion functions of Atn , where ΔtH is an amount of time within the nth sampling window measured from the center of the sampling window. The Taylor series expansion functions of F1n and pm can be expressed mathematically as
Figure imgf000030_0001
and
P1n(Atn)= pm + P1nAtn + PmAξ + pm " Aξ +... (10) where F1n and pm , Fm and pm " , and Fj and pm " are respectively the first, second and third derivatives of F1n and pm . The number of a derivative (first, second, third, etc..) is also referred to as the order, with the zero order term referring to the term with no derivatives, for example F1n and
-
The expansion parameters of Equations (9) and (10), namely
F1n , Fn, , Fn] , ..., and pm , pm, Pm , ..., are estimated anew, by sensor motion effect compensator 196, each time a magnetic flux measurement is stored in storage unit 194. The expansion parameters of Equations (9) and (10) are estimated by minimizing the deviation between the magnetic flux estimated by the measurements of the sensing coils, and the magnetic flux, F(t), estimated by Equation (8) in sensor motion effect compensator 196, using the estimated magnetic flux amplitude and phase. The minimization calculation (herein referred to as minimization) is achieved by using a least mean square cost function, as is known in the art. In general, the number of expansion parameters needed, in Equations (9) and (10), to compensate the effect of the translational and rotational velocity of the sensing coils, is known. In an embodiment of the disclosed technique, if the number of expansion parameters needed is not known, then when system 140 starts tracking an object, the minimization is used to estimate the zero order terms, F111 and pm , for each transmission frequency of transmitter assembly 158 in each sensing coil. As system 140 tracks an object, minimizations are repeatedly executed to estimate the higher order derivative terms until the number of terms retained in Equations (9) and (10) (i.e. the sensing model equations) are sufficient to compensate for the translational and rotational velocity of the sensing coils.
Equations (9) and (10) can be truncated by retaining the terms up to the zero, first, second or any other higher order. In the case that only the zero order terms are retained, F1n and pm , Equations (9) and
(10) define F1n and pm in Equation (8) as constant parameters.
Equation (8) therefore approximates the magnetic flux measured by the sensing coils, as measured by steady state sensing coils. The number of terms sensor motion effect compensator 196 retains and uses from Equations (9) and (10) to compensate for the effect of moving sensing coils depends on various factors. The factors may either include the width of the sampling window, the typical velocity and acceleration of the tracked object, the mathematical EM field gradients of the model, or a combination of the above. The highest order term retained by sensor motion effect compensator 196 can either be chosen a priori based on the above factors, and stored thereto, or it can be treated as an adjustable parameter thereto, based on the normalized residual error between the EM field amplitudes estimated by magnetic flux to magnetic field converter 198 and magnetic field model generator 190. The normalized residual error is estimated by position processor 200, the result of which can be used to decide on the highest order term Equations (9) and (10) retain in sensor motion effect compensator 196. For example, a residual error of two to three σ (i.e. two to three standard deviations) may indicate that the highest order term retained in Equations (9) and (10) is increased by one.
Magnetic flux to magnetic field converter 198 transforms the compensated matrix of magnetic fluxes (for each transmission frequency of transmitter assembly 158 and for each sensing coil) estimated by sensor motion effect compensator 196, into a corresponding matrix of EM field amplitudes at the magnetic center of each sensing coil, for each transmission frequency of transmitter assembly 158. The transformation is executed using the sensing coil calibration parameters stored in storage unit 194, including Equations (5), (6) and (7), and the EM field model generated by magnetic field model generator 190. The magnetic flux matrix estimated by sensor motion effect compensator 196 is transformed into an EM field amplitude matrix by p _ V ra T*a O U V rmk ~ ZJ Cmk0Dmk Vk )+ ZJ • • V ' ' ) ae{x,y,z} a,βe{x,y,z}
Figure imgf000032_0001
where Fmk is the zero order term of Equation (9), indicating the measured and compensated magnetic flux at transmission frequency m in sensing coil k, estimated by sensor motion effect compensator 196. c n,ιo > c mu > c mki r are tensor coefficients that result from the term by term integration of Equations (5), (6) and (7) for the EM field model, over the surface area bounded by each sensing coil winding, summing over all the windings of each sensing coil. The third index on tensor coefficients c n,ιo > c mk\ > clii ' ■> namely, 0,1 ,2, labels the integrated gradient order term from Equations (5), (6) and (7). Therefore, c"ά0 is the tensor coefficient resulting from integrating the zero order gradient term from Equations (5), (6) and (7), c";L β { is the tensor coefficient resulting from integrating the first order gradient term from Equations (5), (6) and (7), and c"f/ is the tensor coefficient resulting from integrating the second order gradient term from Equations (5), (6) and (7). All other terms and quantities are as they were defined above.
Tensor coefficients c"ύ0 ,
Figure imgf000032_0002
, c"f2'r relate the measured magnetic flux to the EM field model and the mathematical gradients of the EM field model. Tensor coefficients c"lk0 , c";k β , c"f/ are stored in magnetic flux to magnetic field converter 198 as sensing coil parameters and are modified and refined adaptively as a tracked object is tracked in time. Magnetic flux to magnetic field converter 198 solves for Bm"k(rk), the first term on the right hand side of Equation (11), using techniques known in the art. The other terms of Equation (11) are estimated by magnetic flux to magnetic field converter 198 or position processor 200, as described below.
Equation (11) can be truncated by retaining the terms up to the zero, first, second or any other higher order of mathematical gradient. In the case that only the zero order term is retained, indicating that all the mathematical field gradient terms are discarded, Equation (11) is equivalent to the assumption that the EM field within each sensing coil can be approximated as a uniform field. The highest order term magnetic flux to magnetic field converter 198 retains and uses from Equation (11) to convert the magnetic flux to a measure of the amplitude of EM field 160 depends on various factors. The factors may either include an estimation of the EM field model mathematical gradients, the approximate size of the sensing coils, or a combination of the above. The highest order term retained by magnetic flux to magnetic field converter 198 can either be chosen a priori based on the above factors, or it can be treated as an adjustable parameter based on the normalized residual error between the EM field amplitudes estimated by magnetic flux to magnetic field converter 198 and magnetic field model generator 190. The normalized residual error is determined by position processor 200, the result of which can be used to determine the highest order of terms in Equation (11) retained by magnetic flux to magnetic field converter 198. For example, a residual error of one σ (i.e. one standard deviation) may indicate that the highest order of terms retained in Equation (11 ) is increased by one. The highest order of terms retained in Equation (11) is adaptively refined as system 140 tracks an object, until a sufficient accuracy in estimating the position of the object is achieved.
The magnetic flux matrix estimated by sensor motion effect compensator 196 can be transformed into a matrix of EM field amplitudes by expanding Bm x k(r), B^r), Bm*k(r), F1n(Atn) and Pm(Atn) in terms of spherical functions, or other basic harmonic functions. In the case that spherical functions are used, the mathematical representation of the measured magnetic flux (for example, Equation (8)) will be a linear function of the expansion coefficients of the spherical expansion function. The parameters involved in the definition of this linear function represent the geometry of the sensing coils. Therefore, these parameters are analogous to tensor coefficients c"nk0 , c";k β x , cja {r of
Equation (11). In general, any mathematical model relating the EM field amplitudes measured within a sensing coil to the measured magnetic flux in a sensing coil, can be used in place of Equation (11) in magnetic flux to magnetic field converter 198. For consistency, the Taylor series expansions of Bm x k(r), Bm y k(r), Bm z k(r), F1n(Atn), P1n(At1) and Fmk (Equations
(5), (6), (7), (9), (10) and (11)) are used throughout the rest of the description of the disclosed technique.
Position processor 200 estimates the position of each sensing coil, based on the unique EM field amplitude components B*nk(r), Bm y k{f) and B*lk(r) estimated by magnetic field model generator 190 and magnetic flux to magnetic field converter 198. In one embodiment of the disclosed technique, magnetic flux to magnetic field converter 198 estimates the EM field amplitude components by solving for all the KL(A) terms in Equation (11). In a second embodiment of the disclosed technique, magnetic flux to magnetic field converter 198 estimates the EM field amplitude components iteratively with position processor 200 by solving for all the B"lk(rk) terms in Equation (11). In a third embodiment of the disclosed technique, position processor 200 estimates the EM field amplitude components by solving for all the B"lk(rk) terms in Equation (11).
The first term, on the right hand side, of Equation (11), represents a simple linear relation between the measured magnetic flux in the sensing coils, and the EM field amplitude components Bx,, B-',., and Bm z k , in the case that the sensing coils are considered as point-like sensing coils. Since the sensing coils are not considered as point-like sensing coils in the disclosed technique, the gradient terms of Equation dBa (r ) d2Ba (r )
(11), for example — — — and — f^- , and their respective terms, dr dr drr represent a correction for this simple linear relation. There is a difficulty in estimating the gradient terms of Equation (11), because the position of the sensing coils has not yet been estimated by position processor 200. In fact, it is these gradients terms that are needed in order to accurately estimate the position of each sensing coil.
In one embodiment of the disclosed technique, an extrapolation technique is used in magnetic flux to magnetic field converter 198, to estimate the position of the sensing coils, which can be used to estimate the gradient terms of Equation (11). The estimated gradients terms allow tracking processor 150 to more accurately estimate the position of the sensing coils. In this technique, the estimated position of the sensing coils is calculated based on the previous position of the sensing coils. The previous position of the sensing coils is obtained from the center of the previous sampling window to the center of the current sampling window. The estimated position of the sensing coils is extrapolated from the center of the current sampling window to the center of the next sampling window. Using the sensing model and its corresponding equations (Equations (8), (9) and (10)), all measurements of the position of the sensing coils, at a particular time, are related to the center of the current respective sampling window. The extrapolation can be based on the following assumptions, for example, a fixed translational and rotational velocity of the sensing coils in one sampling window, or a fixed translational and rotational velocity of the sensing coils within a time duration between the center of two successive sampling windows. The extrapolated position of the sensing coils is used as the location where the gradients terms of Equation (11) are estimated.
In a second embodiment of the disclosed technique, an iterative technique, using the principles of perturbation theory, is used with magnetic flux to magnetic field converter 198 and position processor 200, to estimate the position of the sensing coils. In this technique, the EM field amplitude components are first estimated in magnetic flux to magnetic field converter 198, based on a simplified sensing coil model of point-like sensing coils. This is equivalent to magnetic flux to magnetic field converter 198 using Equation (11) with only the first term of the right hand side. Position processor 200 then uses the estimated EM field amplitude components to approximate the position of each sensing coil. The position of each sensing coil is then used by magnetic flux to magnetic field converter 198 to estimate the gradient terms of Equation (11). The estimated gradients terms can then be used again by magnetic flux to magnetic field converter 198 to estimate the EM field amplitude components. The EM field amplitude components can then be used again by position processor 200 to approximate the position of each sensing coil. The position of each sensing coil can then be used again by magnetic flux to magnetic field converter 198 to estimate the gradient terms of Equation (11). This technique is repeated, in an iterative manner, using the principles of perturbation theory, until a sufficient accuracy, in estimating both the position of the sensing coils and the EM field amplitude components, is achieved.
In a third embodiment of the disclosed technique, the EM field amplitude components as well as the position of the sensing coils are estimated simultaneously by position processor 200. The position of the sensing coils is estimated by minimizing the deviation between the EM field amplitude components estimated by magnetic field model generator 190, and the EM field amplitude components estimated by magnetic flux to magnetic field converter 198. The minimization adapts the parameters in the EM field model to better fit the EM field estimated by magnetic flux to magnetic field converter 198. Using these adapted parameters, position processor 200 uses the EM field model stored in magnetic field model generator 190 to estimate the position of the sensing coils. The deviation is minimized by
Figure imgf000037_0001
where B (the EM field model defined by Equation (2)) contains the vector amplitudes of EM field 160 estimated in all the sensing coils using Equation (11), and Φ (the EM field model defined by Equation (3)) is the mathematical model of EM field 160 estimated by magnetic field model generator 190. In this embodiment of the disclosed technique, each element of B (indicating each component of B , such as Bn x Λ , BJnl and Bm z X ) is treated as a minimized parameter. Furthermore, the parameters defining the sensing coils and the EM field model are assumed to be fixed constants.
The EM field amplitude components, indicating the B"lk(rk) terms of Equation (11), are estimated by minimizing the deviation between the flux estimated by sensor motion effect compensator 196 and the flux calculated from the EM field model. Position processor 200 calculates the flux from the EM field model by replacing B in Equation (11) with B , the EM field model of Equation (2). The deviation is minimized by
Lml2 (13)
Figure imgf000037_0002
drβdrγ where Fmk is the flux estimated by sensor motion effect compensator 196. The summations in Equation (13) come from Equation (11) using B (the EM field model of Equation (2)). All other terms and quantities are as they were defined before. Equations (12) and (13) are solved by using a non-linear, least mean square optimization technique, for example, Newton's method, as is known in the art.
Position processor 200 also estimates the normalized residual error in the calculation of the position of the sensing coils. The error is a measurement of the minimized deviation of Equation (12). The normalized residual error is referred to as the figure of merit (herein abbreviated FOM) of a position calculation. The FOM is defined as
Figure imgf000038_0001
where a = χ, y,z , Φ"nk represents the components of the matrix function, providing an EM field at the mth frequency, in the magnetic center of the kth sensing coil, and P* and O* are respectively the location and orientation of the tracked object estimated by Equation (12). All other terms and quantities are as they were defined before. The larger the FOM, the larger the error in the calculation of the position of the sensing coils. Position processor 200 provides the position of the tracked object, as well as the FOM of the current position calculation, to a user. Grade assignment module 202 groups together Fmk , the measured and compensated magnetic flux in each sensing coil, and the position of each sensing coil calculated using Equation (12), into an element referred to as a point. Each point is assigned a grade, by grade assignment module 202. Depending on the grade, a point is either abandoned, or selected for storage. If a point is selected for storage, it is stored in storage unit 194. The grade is a positive parameter based on various factors. The factors may either include the FOM of the point, the geometrical location of the point in the motion box, the grades assigned to previous points stored in storage unit 194 or a combination of the above. The factors each have relative weights in determining the grade. For example, a large FOM of a current point, compared to the FOM of points stored in storage unit 194, is an aspect which increases the grade, because such points help tracking processor 150 improve the EM field model. In addition, if the geometrical location of the point in the motion box is far enough from all the points already stored in storage unit 194, it may also be a reason for increasing the grade of the current point.
Position measurements with large FOMs are indicative of locations in the motion box not yet explored by the tracked object. Since these new locations help tracking processor 150 improve and expand the EM field model, such measurements may receive high grades. The grades of points already stored in storage unit 194 may also be varied with time. For example, the grades of points already stored may gradually decrease over time, introducing a fading memory effect to points stored in storage unit 194.
A point is stored in storage unit 194 if its grade is above a certain minimum and there is still room in storage unit 194 to store more points. If storage unit 194 is full, and a point possesses a high enough grade for storage in storage unit 194, the point is stored by replacing a point in storage unit 194 with a lower grade. Storage unit 194 has a capacity to store a few hundred points, and in general, the size of storage unit 194 is determined by the number of unknowns that need to be estimated in Equation (3) to properly generate an accurate EM field model of the EM field in the motion box. Points with high enough grades are stored to assist parameters adaptation module 208 in refining the EM field model stored in magnetic field model generator 190. These points also assist parameters adaptation module 208 in calibrating the sensing coils, by refining the calibration parameters of the sensing coils stored in storage unit 194 and the sensing model stored in sensor motion effect compensator 196.
Model accuracy evaluator 206 determines the accuracy to which sensing coil calibration parameters are known, and the accuracy to which the EM field model estimated by magnetic field model generator 190 estimates the EM field amplitude components measured by the sensor assemblies. The determination of the accuracy is based on various factors. The factors may either include the FOM of the accumulated points, the accuracy of system 140 achieved so far, the desired accuracy of system 140 in a particular field of usage (for example military use or 3D gaming use), the mathematical observability of the parameters defining the EM field model and the sensing coil calibration parameters, or a combination of the above. Mathematical observability is essentially a measure of how well unknown parameters can be estimated from known parameters in a system. If the error in estimating the unknown parameters is too high, the unknown parameters are non-observable. Otherwise, the unknown parameters are observable.
If the determined accuracy is above the required level, model accuracy evaluator 206 directs position processor 200 to continue collecting points, estimating each of their positions, and each of their FOMs. The determined accuracy is generally above the required level when a majority of the points within a part of the motion box have been collected and have had grades assigned to them. If the determined accuracy is below the required level, model accuracy evaluator 206 directs parameters adaptation module 208 to adapt the parameters defining the EM field model, the sensing model and the calibration parameters of the sensing coils.
Parameters adaptation module 208 adapts and refines the parameters defining the EM field model, the sensing model and the calibration parameters of the sensing coils by executing two minimizations, either subsequently, or simultaneously. The first minimization is a minimization of the deviation between the EM field amplitude components estimated by magnetic field model generator 190 and the EM field amplitude components estimated by magnetic flux to magnetic field converter 198. The second minimization is a minimization of the deviation between the magnetic flux estimated by sensor motion effect compensator 196 and the magnetic flux estimated from the EM field model, using Equation (11), in position processor 200. These two minimizations are executed by solving
^M*nΑ^.hψM*i--'-θ*,'P>0«>--->?s} (15)
and
Figure imgf000041_0001
where all terms and quantities are as they were previously defined. In the case that a sensing coil is replaced, the parameters defined by θ will not be known immediately after the sensing coil is replaced. In order to perform the adaptation of those parameters, the following equations are minimized:
Figure imgf000041_0002
]\ (17) and
MgMinp 0
Figure imgf000041_0003
where all terms and quantities are as they were previously defined. Parameters adaptation module 208 performs a minimization similar to the minimization performed by position processor 200. The difference in the minimizations is that parameters adaptation module 208 performs a minimization calculation involving all the points stored in storage unit 194, whereas position processor 200 performs a minimization involving only a single point.
Some of the parameters defining the EM field model and the calibration parameters of the sensor assemblies may be mathematically non-observable when parameters adaptation module 208 executes a minimization. This is typical when the tracked object is in a new environment, the FOM of accumulated points is high, storage unit 194 is not full of points, or an area in the physical motion box, with a low probability of being explored, for example, a corner of the physical motion box, has not yet been explored by the tracked object.
In the case of storage unit 194 not being full of points, a model simplification technique is used to execute the minimizations of Equations (15) and (16) (or Equations (17) and (18)). In the model simplification technique, non-observable parameters are either excluded from the EM field model and the minimization calculations, or they are considered as constants in the minimization calculations. Non-observable parameters can be selected using standard methods in estimation theory, for example, using Cramer-Rao bounds analysis, as is known in the art. The model simplification technique becomes a preferred technique to use when an entire set of EM field model parameters θmk are non-observable, indicating that the EM field model structure and the sensing model structure are not yet established. The EM field model structure is not yet established when the EM field model, describing EM field 160, cannot estimate the position of sensing coils, attached to a tracked object, to a high degree of accuracy. The sensing model structure is not yet established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object, has not yet been determined.
In the case that areas in the physical motion box, with a low probability of being explored, are being explored by the tracked object, a constraint technique is used to execute the minimization of Equations (15) and (16) (or Equations (17) and (18)). In the constraint technique, all parameters, including non-observable ones, are considered in the minimization calculations, except the minimization calculations are performed under specific constraints. One such constraint could be that the EM field amplitude components, estimated by the EM field model (generated by magnetic field model generator 190) before and after the minimization calculations, be close to one another within a defined tolerance level. The constraint technique becomes a preferred technique to use when the EM field model structure and the sensing model structure have been established. The EM field model structure is established when the EM field model, describing EM field 160, can estimate the position of sensing coils to a high degree of accuracy. The sensing model structure is established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object has been determined, but some parameters of those equations are non-observable.
The model simplification technique and the constraint technique allow tracking processor 150 to select the points with the highest grades to perform the minimization calculations. These techniques allow parameters adaptation module 208 to start minimizing with very few points stored in storage unit 194. The rapid onset of minimization calculations allow for an accelerated rate in minimizing parameters and a quick determination of an accurate EM field model and sensing model. The rapid onset of minimization calculations also allows for an accelerated rate in calibrating the sensing coils. The tracked object does not need to explore the entire motion box before an accurate EM field model and sensing model can be generated and the sensing coils calibrated. The disclosed technique allows the EM field model and sensing model accuracy to be increased in restricted areas of the motion box, where points have already been collected in storage unit 194.
Adaptation accuracy evaluator 210 evaluates the result of the minimization executed by parameters adaptation module 208, and determines the increase or decrease in the accuracy value in the EM field model and the sensing coil calibration parameters using the results of the minimization. The evaluation is executed by computing the FOM values for each point involved in the adaptation performed by parameters adaptation module 208, using the updated EM field model parameters and sensing coil calibration parameters minimized by parameters adaptation module 208. The obtained distribution of FOM values for each point may be characterized by a single value, or a few values, such as the root mean square of the FOM distribution, the maximum FOM obtained, or any other distribution property. This value is then used by adaptation accuracy evaluator 210 to determine the increase or decrease in the accuracy value of system 140, as compared with the previous accuracy value of system 140. The previous accuracy value of system 140 can be determined by the obtained distribution of FOM values obtained for points using the non-minimized EM field model parameters and sensing coil calibration parameters (indicating the parameter values before parameters adaptation module 208 minimizes them). If a small increase in accuracy is observed, such that changing the EM field model stored in magnetic field model generator 190 is not warranted, adaptation accuracy evaluator 210 directs parameters adaptation module 208 to perform another minimization of the EM field model parameters and the sensing coil calibration parameters.
If no increase in accuracy is achieved, or an insignificant increase in accuracy is achieved, adaptation accuracy evaluator 210 directs parameters adaptation module 208 to expand Equation (11) by estimating the contribution of the next additional, higher order, mathematical gradient term in Equation (11 ) not currently used by magnetic flux to magnetic field converter 198. For example, if Fmk was solved for, by magnetic flux to magnetic field converter 198, using only the first two terms on the right hand side of Equation (11), then, when parameters adaptation module 208 expands Equation (11), Fmk is solved for, by magnetic flux to magnetic field converter 198, using the first three terms on the right hand side of Equation (11). The contribution of the additional term in Equation (11) can be estimated by using an approximation about the sensing coil form, and the EM field distribution within each sensing coil. If that contribution is not negligible, the expanded form of Equation (11) is used by parameters adaptation module 208 in another round of minimization calculations. The sensing coil calibration parameters may still yield distorted position estimates of the sensing coils. In this case, parameters adaptation module 208 repeatedly expands Equation (11), by estimating the contribution of the next additional, higher order, mathematical gradient term in Equation (11) not currently used by magnetic flux to magnetic field converter 198. If that contribution is negligible, or the expanded form of Equation (11) still does not yield the desired EM field model accuracy and sensing coil calibration accuracy, a trial and error technique is used by parameters adaptation module 208, to improve the accuracy of system 140.
The trial and error technique involves expanding the various expansion functions used by tracking processor 150, for example, the EM field model, or any of Equations (5), (6), (7), (9), (10), (11), by increasing the number of retained terms in these equations. The expansion can also involve adding a new mathematical expansion center to the expansion functions used by tracking processor 150. Parameters adaptation module 208 adds a new mathematical expansion center by determining the direction of the sharpest increase in the deviations minimized in Equations (15) and (16) (or Equations (17) and (18)). The direction of the sharpest increase indicates the direction of the singularity of EM field 160. The region near the singularity of the EM field is then determined by parameters adaptation module 208 and divided into a plurality of segments. Iteratively, the location of each segment is chosen as the location of the new mathematical expansion center, and is used in the minimizations executed using Equations (15) and (16) (or Equations (17) and (18)). The location of the segment which yields the lowest FOM is then added as the new mathematical expansion center.
In either case of expansion, the expanded equations are used in an additional minimization calculation. If the achieved accuracy value determined by adaptation accuracy evaluator 210 increases, the expanded equations are used for another minimization calculation. Minimization calculations are executed until the increase in accuracy value is sufficient to warrant replacing the current EM field model parameters stored in magnetic field model generator 190, by the updated, adapted EM field model parameters determined by parameters adaptation module 208. If the achieved accuracy value determined decreases, either the order of the retained expansion terms is increased, or a new mathematical expansion center is added. The trial and error technique is used by parameters adaptation module 208 until the desired system accuracy is achieved.
In general, parameters adaptation module 208 iteratively performs minimization calculations, either with or without expanding the sets of parameters searched for, until a satisfactory FOM level is achieved. When a satisfactory level of accuracy is achieved, parameters adaptation module 208 provides the adapted parameter sets of the EM field model parameters and the sensing coil calibration parameters to model comparer module 212. For a predetermined control time, model comparer module 212 provides position processor 200 with the adapted parameters determined by parameters adaptation module 208. The control time can be a few seconds or a few minutes depending on the case of usage of system 140. During the predetermined control time, model comparer module 212 compares the FOM of points determined by the current EM field model parameters and sensing coil calibration parameters, and by the respective adapted parameters. If the FOM provided by the respective adapted parameters is lower than the FOM provided by the current parameters, for most of the predetermined control time, model comparer module 212 directs magnetic field model generator 190, and storage unit 194, to replace the current parameters stored thereto, by the updated, adapted parameters. If the FOM provided by the adapted parameters is higher than the FOM provided by the current parameters, for most of the predetermined control time, the adapted parameters are abandoned, and model comparer module 212 directs parameters adaptation module 208 to perform more minimization calculations.
Reference is now made to Figures 5A and 5B, which are a schematic illustration of a method, constructed and operative in accordance with an embodiment of the disclosed technique. In procedure 250, a multiple axis EM field is provided to a motion box, where a tracked object moves about. The EM field is the superposition of the individual EM fields generated by transmission coils, each at different frequencies. With reference to Figure 2, transmitter assembly 158 uses the generated respective amplified frequencies to provide a multiple axis EM field 160 to a motion box.
In procedure 252, an approximate mathematical model of an EM field, where a tracked object moves about, is generated. At this point in time, the model may not initially take into account all the relevant parameters required to accurately describe the EM field. The accuracy to which the model describes the EM field, at this point in time, is therefore initially low. The model can be substantially defined by Equation (3). The model is used for estimating the amplitude of the EM field detected in sensing coils associated with, or attached to, the tracked object, for all the transmission frequencies used to generate the EM field. Equation (3) may be constructed as either a linear or non-linear function with respect to the model parameters θpm . When
Equation (3) is chosen as a linear expansion, for example, in terms of a harmonic function, like Equation (4), each set of model parameters θpm estimates an independent contribution to B at each transmission frequency, m , used to generate the EM field. In an embodiment of the disclosed technique, the model has an efficient analytical or numerical method, for determining the mathematical gradients of the EM field model. With reference to Figure 4, magnetic field model generator 190 generates and stores an approximate mathematical model of an EM field the tracked object is located in, substantially defined by Equation
(3).
In procedure 254, calibration parameters of sensing coils, associated with, or attached to, the tracked object, are stored. A plurality of sensing coils may be grouped together in a sensor assembly. The calibration parameters can include the orientation of the sensing coils with respect to one another, and with respect to the sensor reference frame. The calibration parameters can further include a set of radius vectors rk , from the origin of the sensor reference frame to the magnetic center of each sensing coil. The calibration parameters can also include parameters relating to the electronic components of the sensing coils and the sensor assemblies, for example, the gain in the sensor assemblies, and parameters defining amplifiers used in the sensor assemblies. When an object is first tracked in an EM field, the relative rotation angles of the sensing coils with respect to one another, in each sensor assembly, are known with an error of several degrees and are stored. In addition, internal calibration parameters of the sensing coils, in each sensor assembly, are known with an error of a few percent, and are stored.
In procedure 254, a Taylor series expansion function describing the EM field amplitudes in sensing coils in general, is also stored. The Taylor series expansion functions are substantially defined by Equations (5), (6) and (7). With reference to Figure 4, storage unit 194 stores calibration parameters related to sensor assemblies 162i, 1622, 1623 and 162N, as well as Taylor series expansion functions substantially defined by Equations (5), (6) and (7), describing the EM field amplitudes in the sensing coils in sensor assemblies 162-), 1622, 1623 and 162N.
In procedure 256, sensing coils attached to a tracked object, measure the voltage difference of the EM field passing through them. The voltage difference allows each of the sensing coils to correspondingly estimate the respective magnetic flux of the EM field passing there through. This indirect measurement of the magnetic flux is herein referred to as a measurement. The measured magnetic flux, in a steady state sensing coil, is assumed to follow a mathematical periodic function of time, defined by Equation (8). In order to estimate the amplitude and phase of the measured magnetic flux, multiple measurements of the flux are made in a time period T, known as a sampling window in the art, at a known frequency. The measurements are fit to Equation (8), using techniques known in the art. With reference to Figure 2, sensor assemblies 162i, 1622, 1623 and 162N, which are associated with, or attached to, a tracked object, indirectly measure the magnetic flux passing through them multiple times, in a sampling window, at a known frequency, by measuring the voltage difference passing there through. With reference to Figure 4, storage unit 194 stores the measured magnetic flux values of sensor assemblies 1621 ; 1622, 1623 and 162N, and estimates the amplitude and phase of the magnetic flux, by fitting the measured values to Equation (8) using techniques known in the art.
In procedure 258, the amplitude and phase of the magnetic flux estimated in procedure 256 is compensated for, because Equation (8) is valid only in the case of steady state, non-moving, sensing coils. In general, sensing coils associated with, or attached to, a tracked object are in constant motion. This motion can be described as a translational and rotational velocity of the sensing coils, and is manifest in the form of a non-periodic variation of magnetic flux as a function of time. If the sensing coils are in motion within a sampling window, the amplitude and phase of the magnetic flux, estimated in procedure 256, are inaccurate. The amplitude and phase of the magnetic flux estimated in procedure 256 needs to be compensated for the translational and rotational velocity of the sensing coils. The compensation is executed by defining the amplitude and phase of the measured magnetic flux as Taylor series expansion functions, defined, in general, by Equations (9) and (10). The expansion terms (the right hand side terms) of Equations (9) and (10) are estimated by minimizing the deviation between the magnetic flux estimated in the sensor assemblies in procedure 256 and the magnetic flux determined by using Equation (8) with the estimated magnetic flux amplitude and phase. The expansion terms of Equations (9) and (10) are estimated anew each time procedure 256 is executed. The minimization is executed using a least mean square cost function, as is known in the art. In general, the number of expansion parameters needed, in Equations (9) and (10), to compensate for the effect of the translational and rotational velocity of the sensing coils, is known. In an embodiment of the disclosed technique, if the number of expansion parameters needed is not known, then when tracking of the object commences, the minimization is used to estimate the zero order terms, F1n and pm , for each transmission frequency used to produce the EM field, in each sensing coil. As the object is tracked, minimizations are repeatedly executed to estimate the higher order derivative terms until the number of terms retained in Equations (9) and (10) are sufficient to compensate for the translational and rotational velocity of the sensing coils.
Equations (9) and (10) can be truncated by retaining the terms up to the zero, first, second or any other higher order. The number of terms retained from Equations (9) and (10) depend on the following factors: the width of the sampling window, the typical velocity and acceleration of the tracked object, and the mathematical EM field gradients of the EM field model describing the EM field the tracked object is located in, or a combination of the above. The highest order term retained can be decided upon a priori or it can be treated as an adjustable parameter based on the normalized residual error between the EM field amplitudes estimated by the EM field model in procedure 252 and the EM field amplitudes estimated in procedure 262. For example, a normalized residual error of two to three σ (i.e. two to three standard deviations) may indicate that the highest order term retained in Equations (9) and (10) is increased by one. With reference to Figure 4, sensor motion effect compensator 196 compensates for the error in the amplitude and phase of the magnetic flux estimated by storage unit 194 by using Equations (9) and (10) to continuously define the amplitude and phase of the magnetic flux as Taylor series expansion functions, each time a magnetic flux measurement is stored in storage unit 194. Sensor motion effect compensator 196 determines the terms anew, on the right hand side of Equations (9) and (10), by using a least mean square cost function.
It is noted that as a tracked object moves around in an EM field, the magnetic flux passing through sensing coils associated with, or attached to, the tracked object constantly changes. Procedures 256 and 258 are therefore executed constantly. It is further noted that procedures 252, 254 and 258 can be executed simultaneously.
In procedure 260, the magnetic flux measurements, measured and compensated for in procedures 256 and 258, are transformed into a corresponding matrix of magnetic field amplitudes by Equation (11). Transforming the magnetic flux measurements into magnetic field amplitudes requires the use of the EM field model and the sensing coil calibration parameters, respectively generated and stored in procedures 252 and 254. The magnetic field amplitude of the first term on the right hand side of Equation (11), B"ά(rk), can be solved for using techniques known in the art.
Equation (11 ) can be truncated by retaining the terms up to the zero, first, second or any other higher order of mathematical gradient. The highest order mathematical gradient term retained in solving for Equation (11) depends on the following factors: an estimation of the EM field model mathematical gradients and the approximate size of the sensing coils used. The highest order term retained may be chosen a priori based on the above factors or it can be treated as an adjustable parameter based on the normalized residual error between the EM field amplitudes estimated by the EM field model and the EM field amplitudes estimated in procedure 262. For example, a normalized residual error of one σ (i.e. one standard deviation) may indicate that the highest order term retained in Equation (11) is increased by one. With reference to Figure 4, magnetic flux to magnetic field converter 198 transforms the magnetic flux measurements, estimated and compensated for in storage unit 194 and sensor motion effect compensator 196, using Equation (11), into a corresponding matrix of EM field amplitudes.
It is noted that the transformation of the compensated magnetic flux measurements, in procedure 258, into a corresponding matrix of EM field amplitudes, in procedure 260, can be executed by expanding Equations (5), (6), (7), (9) and (10) in terms of spherical functions, or other basic harmonic functions. In the case that spherical functions are used, the mathematical representation of the measured magnetic flux (for example, Equation (8)) will be a linear function of the expansion coefficients of the spherical expansion function. The parameters involved in the definition of this linear function represent the geometry of the sensing coils. Therefore, these parameters are analogous to the tensor coefficients of Equation (11). In general, any mathematical model relating the EM field amplitudes measured within a sensing coil to the measured magnetic flux in a sensing coil, can be used in place of Equation (11). For consistency, the Taylor series expansions of Equations (5), (6), (7), (9), (10) and (11 ) are used throughout the rest of the description of the disclosed technique.
A difficulty in solving for the higher order EM field amplitude terms in Equation (11) stems from not knowing the current position of the sensing coils. In procedure 262, the position of the sensing coils is determined and the higher order EM field amplitude terms in Equation (11) are solved for. In one embodiment of the disclosed technique, an extrapolation technique is used to estimate the position of the sensing coils, which can be used to estimate the higher order EM field amplitude terms in Equation (11). In this technique, the estimated position of the sensing coils is calculated, based on the previous position of the sensing coils. The previous position of the sensing coils is obtained from the center of the previous sampling window to the center of the current sampling window. The estimated position of the sensing coils is extrapolated from the center of the current sampling window to the center of the next sampling window. Using Equations (8), (9) and (10), all the measurements of the position of the sensing coils, at a particular time, are related to the center of the current respective sampling window. The extrapolation can be based on the following assumptions, for example, a fixed translational and rotational velocity of the sensing coils in one sampling window, or a fixed translational and rotational velocity of the sensing coils within a time duration between the center of two successive sampling windows. The extrapolated position of the sensing coils is used as the location where the gradients terms of Equation (11) are estimated.
In a second embodiment of the disclosed technique, an iterative technique, using the principles of perturbation theory, is used to determine the position of the sensing coils. In this technique, the EM field amplitude components are first estimated based on a simplified sensing coil model of point-like sensor assemblies. This is equivalent to solving Equation (11) with only the first term of the right hand side, as in procedure 260. The estimated EM field amplitude components are then used to approximate the position of each sensing coil. The position of each sensing coil is then used to estimate the gradient terms of Equation (11). The estimated gradients terms can then be used again to estimate the EM field amplitude components. The EM field amplitude components can then be used again to approximate the position of each sensing coil. The position of each sensing coil can then be used again to estimate the gradient terms of Equation (11). This technique is repeated, in an iterative manner, using the principles of perturbation theory, until a sufficient accuracy, in estimating both the position of the sensing coils and the EM field amplitude components, is achieved.
In a third embodiment of the disclosed technique, the position of the sensing coils as well as the higher order gradient terms of Equation (11) are determined simultaneously. The position of the sensing coils is estimated using Equation (12), which minimizes the deviation between the EM field amplitudes determined by the EM field model and the EM field amplitudes estimated by Equation (11). The higher order gradient terms of Equation (11) are estimated using Equation (13), which minimizes the deviation between the magnetic flux estimated in procedure 258 and the magnetic flux estimated from the EM field model. Equations (12) and (13) are solved by using a non-linear, least mean square optimization technique, for example, Newton's method, as is known in the art.
In procedure 264, the normalized residual error in the calculation of the position of the sensing coils is determined. The normalized residual error is referred to as the figure of merit (herein abbreviated FOM) of a position calculation. The FOM is substantially defined by Equation (14). With reference to Figure 4, position processor 200 determines the position of the sensing coils using either extrapolation, iteration, or simultaneous minimization techniques. Position processor 200 also determines the FOM for each position calculation executed.
In procedure 266, each position calculation is grouped together with its corresponding compensated magnetic flux measurement in procedure 258, into an element referred to as a point. In procedure 266, each point is assigned a grade. The grade is a positive parameter dependent on the following factors: the FOM of the point, the geometrical location of the point in the motion box, and the grades assigned to already stored points. The factors each have relative weights in determining the grade. For example, a large FOM of a current point, compared to the FOM of already stored points, is an aspect which increases the grade, because such points help improve the EM field model. In addition, if the geometrical location of the point in the motion box is far enough from all the points already stored, it may also be a reason for increasing the grade of the current point. Position measurements with large FOMs are indicative of locations in the motion box not yet explored by the tracked object. Since these new locations help improve and expand the EM field model, such measurements may receive high grades. The grades of points already stored may also be varied with time. For example, the grades of points already stored may gradually decrease over time, introducing a fading memory effect to already stored points. With reference to Figure 4, grade assignment module 202 assigns a grade to each point.
In procedure 268, points with a high enough grade are stored. A point is stored if its grade is above a certain minimal level and there is still room to store more points. If there is no room to store a point, and a point possesses a high enough grade for storage, the point is stored by replacing an already stored point with a lower grade. The numbers of points stored is, in general, determined by the number of unknowns that need to be determined in Equation (3) to properly generate an accurate EM field model of the EM field in which the tracked object is located in. Points with high enough grades are stored and used to refine the EM field model generated in procedure 252 and in calibrating the sensing coils by refining the calibration parameters of the sensing coils stored in procedure 254. With reference to Figure 4, storage unit 194 stores points with a high enough grade. In procedure 270, the accuracy to which sensing coil calibration parameters are known, and the accuracy to which the EM field model, generated in procedure 252, estimates the EM field amplitude components measured by the sensing coils, is determined. The determination of the accuracy is based on the following factors: the FOM of the accumulated points, the accuracy achieved so far, the accuracy expected by a user, and the mathematical observability of the parameters defining the EM field model and the sensing coil calibration parameters. If the determined accuracy is above the required level, the method returns to procedure 260, where the updated position of sensing coils are continuously estimated, along with their FOMs. The determined accuracy is generally above the required level when a majority of the points within a part of the motion box have been collected and have had grades assigned to them. If the determined accuracy is below the required level, the method proceeds to procedure 272. With reference to Figure 4, model accuracy evaluator 206 determines the accuracy to which sensing coil calibration parameters are known, and the accuracy to which the EM field model estimates the EM field amplitude components measured and compensated, respectively, in storage unit 194 and sensor motion effect compensator 196.
In procedure 272, the current EM field model parameters and the current sensing coil calibration parameters are modified adaptively by solving Equations (15) and (16). In the case that a sensing coil is replaced, certain parameters in Equations (15) and (16) will not be known immediately after the sensing coil is replaced. In order to perform the adaptation of those parameters, Equations (17) and (18) are solved. The minimization executed in procedure 272 is similar to the minimization executed in procedure 262. The difference in the minimization between the two procedures is that in procedure 272, a minimization calculation involving all the points stored in procedure 268 is executed, whereas in procedure 262, a minimization is executed on only a single point.
Some of the parameters defining the EM field model and the calibration parameters of the sensing coils may be mathematically non-observable when the minimizations of Equations (15) and (16) (or Equations (17) and (18)) are executed. This is typical when a tracked object is in a new environment, the FOM of accumulated points is high, few points are stored, or an area of the physical motion box, with a low probability of being explored, for example, a comer of the physical motion box, has not yet been explored by the tracked object. In the case of few points being stored, a model simplification technique is used to execute the minimizations of Equations (15) and (16) (or Equations (17) and (18)). In the model simplification technique, non-observable parameters are either excluded from the EM field model and the minimization calculations, or they are considered as constants in the minimization calculations. Non-observable parameters can be selected using standard methods in estimation theory, for example, using Cramer-Rao bounds analysis, as is known in the art. The model simplification technique can also be used when an entire set of EM field model parameters θmk are non-observable, indicating that the EM field model structure and the sensing model structure have not yet been established. The EM field model structure is not established when the EM field model generated in procedure 252 cannot estimate the position of sensing coils, attached to a tracked object, to a high degree of accuracy. The sensing model structure is not established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object, has not yet been determined.
In the case that areas in the physical motion box, with a low probability of being explored, are being explored by the tracked object, a constraint technique is used to execute the minimizations of Equations (15) and (16) (or Equations (17) and (18)). In the constraint technique, all parameters, including non-observable ones, are considered in the minimization calculations, except the minimization calculations are performed under specific constraints. One such constraint could be that the EM field amplitude components, estimated by the EM field model generated in procedure 252, before and after the minimization calculations, be close to one another within a defined tolerance level. The constraint technique becomes a preferred technique to use when the EM field model structure and the sensing model structure have been established. The EM field model is established when the EM field model generated in procedure 252 can estimate the position of sensing coils, attached to a tracked object, to a high degree of accuracy. The sensing model structure is established when the number of gradient terms in Equations (5), (6), (7) and (11), needed to properly estimate the position of the tracked object, has been determined, but some parameters of those equations are non-observable.
The model simplification technique and the constraint technique allow the method to select the points with the highest grades to perform the minimization calculations. These techniques allow procedure 272 to start minimizing with very few points stored. The rapid onset of minimization calculations allow for an accelerated rate in minimizing parameters and a quick determination of an accurate EM field model. The rapid onset of minimization calculations also allows for an accelerated rate in calibrating the sensing coils and their respective sensor assemblies. The tracked object does not need to explore the entire motion box before an accurate EM field model can be generated and the sensing coils, and their respective sensor assemblies, attached to the tracked object are calibrated. The disclosed technique allows the EM field model accuracy to be increased in restricted areas of the motion box, where points have already been collected and stored. With reference to Figure 4, parameters adaptation module 208 modifies and adapts the EM field model parameters and the sensing coil calibration parameters by executing the minimization equations substantially defined by Equations (15) and (16) (or Equations (17) and (18)). Parameters adaptation module 208 also utilizes the model simplification technique and the constraint technique to compensate for a lack of progress in adaptively modifying the EM field model parameters and the sensing coil calibration parameters.
In procedure 274, the result of the minimizations executed in procedure 272 is evaluated and used to determine the increase or decrease in accuracy in the EM field model and the sensing coil calibration parameters. The evaluation is executed by computing the FOM values for each point involved in the minimizations performed in procedure 272, using the updated EM field model parameters and sensing coil calibration parameters minimized in procedure 272. The obtained distribution of FOM values for each point may be characterized by a single value, or a few values, such as the root mean square of the FOM distribution, the maximum FOM obtained, or any other distribution property. This value is used in procedure 274 to determine the increase or decrease in the accuracy in estimating the position of a tracked object, as executed in procedure 262, as compared with a previous estimation of the position of the tracked object. The previous accuracy can be determined by the obtained distribution of FOM values obtained for points using the non-minimized EM field model parameters and sensing coil calibration parameters, indicating the parameter values before they are minimized in procedure 272. If a significant increase in accuracy is observed, such that changing the EM field model generated in procedure 252 is warranted, the method proceeds to procedure 276. If an increase in accuracy is observed, but the increase is insufficient to warrant changing the EM field model determined in procedure 252, the method returns to procedure 272. If no increase in accuracy is achieved, or a very insignificant increase in accuracy is achieved, the method proceeds to procedure 280. With reference to Figure 4, adaptation accuracy evaluator 210 evaluates the result of the minimization executed by parameters adaptation module 208, and determines the increase or decrease in the accuracy value in the EM field model and the sensing coil calibration parameters using the results of the minimizations. The evaluation is executed by computing the FOM values for each point involved in the adaptation performed by parameters adaptation module 208, using the updated EM field model parameters and sensing coil calibration parameters minimized by parameters adaptation module 208.
In procedure 280, Equation (11) is expanded by estimating the contribution of the next additional, higher order, mathematical gradient term in Equation (11), which is not used in procedure 262. For example, if Fmk is solved for, in procedure 262, using only the first two terms on the right hand side of Equation (11), then, in procedure 280, Fmk is solved for using the first three terms on the right hand side of
Equation (11). The contribution of the additional term in Equation (11) can be estimated by using an approximation about the sensing coil form, and the EM field distribution within each sensing coil. If that contribution is not negligible, the method returns to procedure 272, where the expanded form of Equation (11) is used in procedure 272 in another round of minimization calculations. The sensing coil calibration parameters may still yield distorted position estimates of the sensing coils. In this case, Equation (11 ) may be expanded by repeating procedure 280. If that contribution is negligible, or the expanded form of Equation (11) still does not yield the desired EM field model accuracy and sensing coil calibration accuracy, the method goes to procedure 282. With reference to Figure 4, if that contribution is not negligible, the expanded form of Equation (11) is used by parameters adaptation module 208 in another round of minimization calculations. If that contribution is negligible, or the expanded form of Equation (11) still does not yield the desired EM field model accuracy and sensing coil calibration accuracy, a trial and error technique is used by parameters adaptation module 208, to improve the accuracy of system 140.
In procedure 282, a trial and error technique is used to improve the accuracy in determining the position of a tracked object. The trial and error technique involves expanding the various expansion functions used in procedures 252, 254, 258, 260, 262 and 272, for example, the EM field model, or any of Equations (5), (6), (7), (9), (10), (11). The expansion can also involve adding a new mathematical expansion center to the immediately preceding list of expansion functions and equations. A non-linear optimization technique is used to determine a relevant position for the new mathematical expansion center. The new mathematical expansion center is added by determining the direction of the sharpest increase in the deviations minimized in Equations (15) and (16) (or Equations (17) and (18)). The direction of the sharpest increase indicates the direction of the singularity of the EM field. The region near the singularity of the EM field is then determined and divided into a plurality of segments. Iteratively, the location of each segment is chosen as the location of the new mathematical expansion center, and is used in the minimizations executed using Equations (15) and (16) (or Equations ,(17) and (18)). The location of the segment which yields the lowest FOM is then added as the new mathematical expansion center. In either case of expansion, the expanded equations are used in an additional minimization calculation in procedure 282, similar to the minimization calculations executed in procedure 272. With reference to Figure 4, a trial and error technique is used by parameters adaptation module 208, to improve the accuracy of system 140.
In procedure 284, the result of the minimizations executed in procedure 282 is evaluated and used to determine the increase or decrease in accuracy in the EM field model and the sensing coil calibration parameters. If the achieved accuracy determined in procedure 284 increases, the expanded equations are used for another minimization calculation, similar to the minimization calculations executed in procedure 272, until the increase in accuracy is enough for the current EM field model generated in procedure 252, to be replaced. Once the increase in accuracy is high enough for the current EM field model generated in procedure 252 to be replaced, the method proceeds to procedure 276. If the achieved accuracy determined decreases, the method returns to procedure 282, where either the order of the retained expansion terms is increased, or a new mathematical expansion center is chosen. The trial and error technique is used in procedure 282 until the desired accuracy is achieved. In general, minimization calculations, similar to the minimization calculations executed in procedure 272, are performed iteratively, either with, or without expanding the sets of parameters searched for, until a satisfactory FOM level is achieved. With reference to Figure 4, adaptation accuracy evaluator 210, determines the increase or decrease in the accuracy of the EM field model and the sensing coil calibration parameters. If the achieved accuracy value determined by adaptation accuracy evaluator 210 increases, the expanded equations are used for another minimization calculation. Minimization calculations are executed until the increase in accuracy value is sufficient to warrant replacing the current EM field model parameters stored in magnetic field model generator 190, by the updated, adapted EM field model parameters determined by parameters adaptation module 208. If the achieved accuracy value determined decreases, either the order of the retained expansion terms is increased, or a new mathematical expansion center is added. The trial and error technique is used by parameters adaptation module 208 until the desired system accuracy is achieved.
When a satisfactory level of accuracy is achieved in procedure 284, the method proceeds to procedure 276. In procedure 276, the estimation of the position of a tracked object, as well as the sensing coil calibration parameters, from procedure 262, are compared with the respective estimation of the position of a tracked object, as well as the sensing coil calibration parameters, from procedures 272 or 282, for a fixed control time. The control time can be a few seconds or a few minutes depending on the case of usage in which the method is used in. During the fixed control time, the FOM of points determined by the current EM field model parameters and sensing coil calibration parameters, and the FOM of the points determined by the adapted parameters determined in procedures 272 and 282, are compared. If the FOM provided by the adapted parameters is lower than the FOM provided by the current parameters, for most of the fixed control time, then the method proceeds to procedure 278. If the FOM provided by the adapted parameters is higher than the FOM provided by the current parameters, for most of the control time, the adapted parameters are abandoned, and the method returns to either procedure 272 or procedure 282, depending on whether procedure 280 was executed or not. If procedure 280 was not executed, the method returns to procedure 272. If procedure 280 was executed, the method returns to procedure 282. With reference to Figure 4, model comparer module 212 compares the FOM of points determined by the current EM field model parameters and sensor assembly calibration parameters, respectively stored in magnetic field model generator 190 and storage unit 194, and the FOM of points determined by the adapted parameters, determined by parameters adaptation module 208.
In procedure 278, the current parameters describing the EM field model and the sensing coil calibration parameters, are replaced by the updated, adapted parameters determined in procedures 272 and 282, if the FOM provided by the adapted parameters is lower than the FOM provided by the current parameters, for most of the fixed control time. With reference to Figure 4, model comparer module 212 directs magnetic field model generator 190, and storage unit 194, to replace the current parameters stored thereto, by the updated, adapted parameters. It will be appreciated by persons skilled in the art that the disclosed technique is not limited to what has been particularly shown and described hereinabove. Rather the scope of the disclosed technique is defined only by the claims, which follow.

Claims

1. Apparatus, for adaptively tracking the position of an object in a volume of interest, the apparatus comprising: at least one transmitter, coupled with said volume of interest, for transmitting a multiple axis, time variant, electromagnetic field through said volume of interest; at least one sensor assembly, said at least one sensor assembly including at least three sensors, said at least three sensors arranged in a fixed configuration at different predetermined locations and orientations, said at least one sensor assembly being coupled with said object, each of said at least three sensors respectively measuring a respective component of said electromagnetic field; and a tracking processor, coupled with said at least one transmitter and said at least one sensor assembly; wherein said tracking processor produces and adapts a mathematical field model describing said electromagnetic field, said mathematical field model is at least based on said multiple axis, time variant, electromagnetic field, said fixed configuration of said at least three sensors and said measured respective components of said electromagnetic field; wherein said tracking processor further produces and adapts a mathematical sensing model, for compensating the effect of the translational and rotational velocity of each of said at least three sensors; wherein said tracking processor estimates said position of said object from said measured respective components of said electromagnetic field, said field model and said sensing model; wherein said tracking processor stores calibration parameters associated with said at least one sensor assembly; and wherein said position of said object includes the physical location of said object and the orientation of said object.
2. The apparatus according to claim 1 , further comprising: a transmitter interface, coupled with said processor, for producing a first digital representation of a signal; at least one digital to analog converter, coupled with said transmitter interface, for converting said first digital representation of a signal into at least one analog signal; and an amplifier, coupled with said at least one transmitter and with said at least one digital to analog converter, for amplifying said at least one analog signal and providing each of the amplified at least one analog signal to a respective one of said at least one transmitter.
3. The apparatus according to claim 2, wherein said first digital representation of a signal includes measurements of current flowing in said at least one transmitter.
4. The apparatus according to claim 3, wherein said at least one transmitter synchronizes the measuring of said measurements of current flowing with the measuring of said respective components of said electromagnetic field.
5. The apparatus according to claim 2, wherein each said at least one analog signal is respective of at least one spatial axis.
6. The apparatus according to claim 1 , further comprising: at least three respective analog to digital converters, one for each of said at least three sensors, for converting each said measurement of a respective component of said electromagnetic field into a respective second digital representation of a signal; and a sensor interface, coupled with said at least three respective analog to digital converters and with said processor.
7. The apparatus according to claim 6, further comprising: at least one respective multiplexer, for each of said at least three respective analog to digital converters, for coupling said at least three respective analog to digital converters with said sensor interface.
8. The apparatus according to claim 1 , wherein said tracking processor comprises: a position processor, for determining the position of said at least three sensors; a magnetic field model generator, coupled with said position processor, for generating said mathematical field model; and a magnetic flux to magnetic field converter, coupled with said magnetic field model generator and with said position processor, for partially transforming said measured respective components of said electromagnetic field into a measure of the amplitude components of said electromagnetic field.
9. The apparatus according to claims 8, wherein said tracking processor further comprises a storage unit, coupled with said magnetic flux to magnetic field converter, for storing said calibration parameters associated with said at least one sensor assembly and said measured respective components of said electromagnetic field.
10. The apparatus according to claim 8, wherein said tracking processor further comprises a sensor motion effect compensator, coupled with said magnetic flux to magnetic field converter and with said position processor, for compensating the effect of the translational and rotational velocity of each of said at least three sensors.
11. The apparatus according to claim 10, wherein said tracking processor further comprises a grade assignment module, coupled with said position processor, for assigning grades to the estimated position of said at least three sensors.
12. The apparatus according to claim 8, wherein said tracking processor further comprises a model accuracy evaluator, coupled with said position processor, for evaluating the accuracy to which said calibration parameters are known and the accuracy to which said mathematical field model estimates said measure of the amplitude components of said electromagnetic field by said at least three sensors.
13. The apparatus according to claim 8, wherein said tracking processor further comprises a parameters adaptation module coupled with said position processor, for adapting said calibration parameters and the parameters defining said mathematical field model and said mathematical sensing model.
14. The apparatus according to claim 13, wherein said tracking processor further comprises an adaptation accuracy evaluator, coupled with said parameter adaptation module, for evaluating the accuracy of an adapted mathematical field model and an adapted mathematical sensing model.
15. The apparatus according to claim 8, wherein said tracking processor further comprises a model comparer module, coupled with said position processor, for comparing said mathematical field model and said mathematical sensing model with an adapted mathematical field model and an adapted mathematical sensing model.
16. The apparatus according to claim 1 , wherein said mathematical field model comprises at least one of: a harmonic expansion function describing said electromagnetic field; an analytic relation describing said electromagnetic field; at least one parameter set describing said electromagnetic field; a matrix function for estimating amplitude components of said electromagnetic field; a model reference frame coordinate system between said object and said volume of interest; a sensor reference frame coordinate system between said at least three sensors and said at least one sensor assembly; and a relationship between said model reference frame coordinate system and said sensor reference frame coordinate system.
17. The apparatus according to claim 16, wherein said at least one parameter set is selected from the list consisting of: a coordinate relationship between said at least one transmitter and said at least three sensors; at least one expansion center for each of said mathematical field model and said mathematical sensing model; at least one expansion coefficient for each of said mathematical field model and said mathematical sensing model.
18. The apparatus according to claim 1 , wherein said respective components of said electromagnetic field are related to the flux of said electromagnetic field.
19. The apparatus according to claim 16, wherein said matrix function for estimating comprises estimating said amplitude components from an observation point within each of said at least three sensors.
20. The apparatus according to claim 19, wherein said observation point is the magnetic center of each of said at least three sensors.
21. The apparatus according to claim 16, wherein said relationship comprises: at least three respective radius vectors, from the origin of said sensor reference frame to an observation point in each of said at least three sensors; at least one rotation matrix, for relating the orientation of said sensor reference frame to the orientation of said model reference frame; and at least one vector, for relating the location of the origin of said sensor reference frame relative to said model reference frame.
22. The apparatus according to claim 16, wherein said calibration parameters are selected from the list consisting of: the orientation of each of said at least three sensors with respect to said sensor reference frame; at least three respective radius vectors, from the origin of said sensor reference frame to an observation point in each of said at least three sensors; the gain characteristics of each of said at least one sensor assembly; parameters relating to the electronic components of said at least one sensor assembly; and the known error characteristics of said calibration parameters.
23. The apparatus according to claim 10, wherein said measured respective components of said electromagnetic field are expected to follow a mathematical periodic function of time, wherein said sensor motion effect compensator uses said measured respective components of said electromagnetic field to estimate an amplitude and a phase of said mathematical periodic function of time.
24. The apparatus according to claim 1 , wherein said measured respective components of said electromagnetic field are expected to follow a mathematical periodic function of time, wherein said mathematical sensing model comprises: a mathematical definition of at least one of an amplitude and a phase of said mathematical periodic function of time, as a function of time.
25. The apparatus according to claim 24, wherein said at least one function of time is expressed mathematically as at least one expansion function, wherein at least one expansion parameter of said at least one function of time is estimated each time said measured respective components of said electromagnetic field are acquired.
26. The apparatus according to claim 25, wherein said tracking processor estimates said at least one expansion parameter by minimizing the deviation between said measured respective components of said electromagnetic field and said mathematical periodic function of time.
27. The apparatus according to claim 24, wherein the number of expansion parameters of said at least one function of time depends on at least one of: a predetermined time period wherein said measured respective components of said electromagnetic field are measured; the typical velocity and acceleration of said object; and mathematical field gradients of said mathematical field model.
28. The apparatus according to claim 27, wherein said number of said expansion parameters is fixed.
29. The apparatus according to claim 27, wherein said tracking processor adapts said mathematical sensing model by varying said number of said expansion parameters.
30. The apparatus according to claim 29, wherein said varying by said tracking processor depends on a figure of merit.
31. The apparatus according to claim 8, wherein said tracking processor performs said partial transformation, by expanding an expansion function, for each respective component of said electromagnetic field, and by expanding at least one of an amplitude and a phase of a mathematical periodic function of time, as at least one function of time, in terms of a basic harmonic function.
32. The apparatus according to claim 31 , wherein said basic harmonic function comprises expansion coefficients, wherein said expansion coefficients relate said respective measured components of said electromagnetic field to said mathematical field model and to mathematical field gradients of said mathematical field model.
33. The apparatus according to claim 32, wherein said tracking processor modifies and adapts said expansion coefficients.
34. The apparatus according to claim 31 , wherein the number of expansion terms of said basic harmonic function depends on at least one of: the approximate size of said at least three sensors; and an estimation of the gradients of said mathematical field model.
35. The apparatus according to claim 34, wherein said number of expansion terms is fixed.
36. The apparatus according to claim 34, wherein said mathematical field model is adapted by said tracking processor by varying said number of expansion terms.
37. The apparatus according to claim 36, wherein said varying by said position processor and said magnetic flux to magnetic field converter depends on a figure of merit.
38. The apparatus according to claim 8, wherein said magnetic flux to magnetic field converter transforms the remaining portion of said transformation by extrapolating the position of said at least three sensors, and estimating the mathematical field gradients of said basic harmonic function at said extrapolated position.
39. The apparatus according to claim 38, wherein said extrapolation is based upon an assumption, wherein said assumption is selected from the list consisting of: a fixed translational and rotational velocity of said at least three sensors in a predetermined time period; and a fixed translational and rotational velocity of said at least three sensors between the center of two predetermined time periods.
40. The apparatus according to claim 8, wherein said magnetic flux to magnetic field converter and said position processor, transform the remaining portion of said transformation by iteratively estimating said amplitude components of said electromagnetic field, based on a model of said at least three sensors as volumeless point-like sensors, estimating the position of said at least three sensors, and estimating the mathematical gradient terms of said basic harmonic function.
41. The apparatus according to claim 8, wherein said position processor transforms the remaining portion of said transformation by minimizing the deviation between said respective measured components of said electromagnetic field compensated for by a sensor motion effect compensator, and respective components of said electromagnetic field estimated from said mathematical field model.
42. The apparatus according to claim 41 , wherein said position processor determines the position of said at least three sensors, thereby determining the position of said object, based on said mathematical field model, by minimizing the deviation between estimates of said amplitude components based on said mathematical field model and estimates of said amplitude components estimated from said remaining portion of said transformation.
43. The apparatus according to claim 8, wherein said position processor determines a figure of merit, wherein said figure of merit is defined as the normalized residual error of the minimization of the deviation between estimates of said amplitude components based on said mathematical field model and estimates of said amplitude components estimated from a remaining portion of said transformation, wherein said mathematical field model comprises: at least one parameter set describing said electromagnetic field; a matrix function for estimating said amplitude components of said electromagnetic field; and a relationship between a model reference frame coordinate system and a sensor reference frame coordinate system, wherein said relationship comprises: at least three respective radius vectors, from the origin of said sensor reference frame to an observation point within each of said at least three sensors; at least one rotation matrix, for relating the orientation of said sensor reference frame to the orientation of said model reference frame; and at least one vector, for relating the location of the origin of said sensor reference frame to said model reference frame. wherein said figure of merit is defined mathematically as
Figure imgf000076_0001
wherein N7 is defined as the total number of analog signals generated by said at least one transmitter, Nc is defined as the total number of said at least three sensors, B"nk is defined as the estimated amplitude components of said electromagnetic field at frequency m in sensor k , and Φlku,...,θSNf
Figure imgf000076_0002
is said matrix function, wherein θn,...,θSN is defined as said at least one parameter set, P* is defined as the estimated location of said object, O* is defined as the estimated orientation of said object, and rv...,7Nr is defined as said radius vectors.
44. The apparatus according to claim 8, wherein said tracking processor further comprises a grade assignment module, coupled with said position processor, wherein said grade assignment module groups together said respective measured components of said electromagnetic field compensated for by a sensor motion effect compensator and said estimated position of said object, based on said mathematical field model, into at least one point.
45. The apparatus according to claim 44, wherein said grade assignment module assigns said at least one point at least one grade, wherein said at least one grade depends on at least one factor selected from the list consisting of: a figure of merit of said at least one point; the position of said at least one point in said volume of interest; and grades assigned to previous points; wherein each of said at least one factor has a relative weight.
46. The apparatus according to claim 45, wherein said grade assignment module lowers the value of said at least one grade, over time.
47. The apparatus according to claim 8, wherein said tracking processor further comprises a model accuracy evaluator, coupled with said position processor, wherein said model accuracy evaluator evaluates the accuracy to which said calibration parameters are known and the accuracy to which said mathematical field model estimates said amplitude components of said electromagnetic field estimated by said at least three sensors.
48. The apparatus according to claim 47, wherein said determination of the accuracy depends on at least one of: a figure of merit for accumulated measurements of said measured respective components of said electromagnetic field; the accuracy of said apparatus achieved so far; the desired accuracy of said apparatus; the mathematical observability of at least one parameter set, said at least one parameter set describing said electromagnetic field; and said calibration parameters.
49. The apparatus according to claim 8, wherein said tracking processor further comprises a parameters adaptation module coupled with said position processor and with said magnetic field model generator, wherein said parameters adaptation module adapts at least one of: at least one parameter set describing said electromagnetic field; said calibration parameters; and the expansion parameters of at least one function of time expressed as an expansion function, wherein at least one of an amplitude and a phase of a mathematical periodic function of time is expressed as said at least one function of time, by minimizing at least one of: the deviation between estimates of said amplitude based on said mathematical field model and values of said amplitude estimated from a basic harmonic function; and the deviation between said measured, respective components of said electromagnetic field, compensated by said mathematical periodic function of time, and estimates of said respective components of said electromagnetic field based on said mathematical field model.
50. The apparatus according to claim 49, wherein said tracking processor further comprises an adaptation accuracy evaluator coupled with said position processor and with said parameters adaptation module, wherein said adaptation accuracy evaluator evaluates the accuracy to which said mathematical field model estimates the amplitude of said electromagnetic field estimated by said at least three sensors and the accuracy in said calibration parameters, after said minimizing.
51. The apparatus according to claim 50, wherein said adaptation accuracy evaluator evaluates said accuracy by computing a figure of merit for each said measured respective components, of said electromagnetic field, used in said minimizing.
52. Method, for adaptively tracking the position of an object in a volume of interest, comprising the procedures of: transmitting a multiple axis, time variant, electromagnetic field through said volume of interest; measuring a respective component of said electromagnetic field, in at least one sensor assembly, said at least one sensor assembly including at least three sensors, said at least three sensors arranged in a fixed configuration at different predetermined locations and orientations; producing a mathematical field model describing said electromagnetic field, said field model based on said multiple axis, time variant, electromagnetic field, said fixed configuration of said at least three sensors and said measured respective components of said electromagnetic field; producing a mathematical sensing model, for compensating the effect of the translational and rotational velocity of each of said at least three sensors; and determining said position of said object, from said measured respective components of said electromagnetic field, said field model and said sensing model, wherein said position of said object includes the physical location of said object and the orientation of said object.
53. The method according to claim 52, wherein said mathematical field model comprises at least one of: a harmonic expansion function describing said electromagnetic field; an analytic relation describing said electromagnetic field; at least one parameter set describing said electromagnetic field; a matrix function for estimating amplitude components of said electromagnetic field; a model reference frame coordinate system between said object and said volume of interest; a sensor reference frame coordinate system between said at least three sensors and said at least one sensor assembly; and a relationship between said model reference frame coordinate system and said sensor reference frame coordinate system.
54. The method according to claim 52, wherein said respective components of said electromagnetic field are related to the flux of said electromagnetic field.
55. The method according to claim 53, wherein said matrix function for estimating comprises estimating said amplitude components from an observation point within each of said at least three sensors.
56. The method according to claim 53, wherein said relationship comprises: at least three respective radius vectors, from the origin of said sensor reference frame to an observation point in each of said at least three sensors; at least one rotation matrix, for relating the orientation of said sensor reference frame to the orientation of said model reference frame; and at least one vector, for relating the location of the origin of said sensor reference frame relative to said model reference frame.
57. The method according to claim 52, further comprising the procedure of storing calibration parameters associated with said at least three sensors.
58. The method according to claim 57, wherein said calibration parameters are selected from the list consisting of: the orientation of each of said at least three sensors with respect to a sensor reference frame; at least three respective radius vectors, from the origin of said sensor reference frame to an observation point in each of said at least three sensors; the gain characteristics of each of said at least one sensor assembly; parameters relating to the electronic components of said at least one sensor assembly; and the known error characteristics of said calibration parameters.
59. The method according to claim 52, wherein said mathematical field model is constructed as a function selected from the list consisting of: a linear function; and a non-linear function.
60. The method according to claim 52, further comprising the procedure of storing an expansion function for each respective component of said electromagnetic field.
61. The method according to claim 52, further comprising the procedure of estimating an amplitude and a phase of a mathematical periodic function of time associated with said measured respective components of said electromagnetic field.
62. The method according to claim 52, wherein said measured respective components of said electromagnetic field are expected to follow a mathematical periodic function of time, wherein said mathematical sensing model comprises: a mathematical definition of at least one of said amplitude and said phase of said mathematical period function of time, as a function of time.
63. The method according to claim 62, wherein said at least one function of time is expressed mathematically as at least one expansion function, wherein at least one expansion parameter of said at least one function of time is estimated each time said measured respective components of said electromagnetic field are acquired.
64. The method according to claim 63, further comprising the procedure of estimating said at least one expansion parameter by minimizing the deviation between said measured respective components of said electromagnetic field and said mathematical periodic function of time.
65. The method according to claim 63, wherein the number of expansion parameters of said at least one function of time depends on at least one of: a predetermined time period wherein said measured respective components of said electromagnetic field are measured; the typical velocity and acceleration of said object; and mathematical field gradients of said mathematical field model.
66. The method according to claim 65, wherein said number of said expansion parameters is fixed.
67. The method according to claim 65, further comprising the procedure of adapting said mathematical sensing model by varying said number of said expansion parameters.
68. The method according to claim 67, wherein said procedure of varying depends on a figure of merit.
69. The method according to claim 52, further comprising the procedure of partially transformation said measured respective components of said electromagnetic field into a partial estimate of the amplitude components of said electromagnetic field, by expanding an expansion function, for each respective component of said electromagnetic field, and by expanding at least one of an amplitude and a phase of a mathematical periodic function of time, as at least one function of time, in terms of a basic harmonic function.
70. The method according to claim 69, wherein said basic harmonic function comprises at least one expansion coefficient, wherein said at least one expansion coefficient relates said respective measured components of said electromagnetic field to said mathematical field model and to mathematical field gradients of said mathematical field model.
71. The method according to claim 70, further comprising the procedure of adapting said expansion coefficients.
72. The method according to claim 69, wherein the number of expansion terms of said basic harmonic function depends on at least one of: the approximate size of said at least three sensors; and an estimation of the gradients of said mathematical field model.
73. The method according to claim 72, wherein said number of expansion terms is fixed.
74. The method according to claim 72, further comprising the procedure of adapting said mathematical field model by varying said number of expansion terms.
75. The method according to claim 74, wherein said procedure of varying depends on a figure of merit.
76. The method according to claim 69, further comprising the procedure of transforming said respective partial estimates of said amplitude components of said electromagnetic field into full respective estimates of said amplitude components of said electromagnetic field, by extrapolating the position of said at least three sensors, and estimating the mathematical field gradients of said basic harmonic function at said extrapolated position.
77. The method according to claim 76, wherein said extrapolation is based upon an assumption, wherein said assumption is selected from the list consisting of: a fixed translational and rotational velocity of said at least three sensors in a predetermined time period; and a fixed translational and rotational velocity of said at least three sensors between the center of two predetermined time periods.
78. The method according to claim 69, further comprising the procedure of transforming said respective partial estimates of said amplitude components of said electromagnetic field into full respective estimates of said amplitude components of said electromagnetic field, by iteratively estimating said amplitude components of said electromagnetic field, based on a model of said at least three sensors as volumeless point-like sensors, estimating the position of said at least three sensors, and estimating the mathematical gradient terms of said basic harmonic function.
79. The method according to claim 69, further comprising the procedure of transforming said respective partial estimates of said amplitude components of said electromagnetic field into full respective estimates of said amplitude components of said electromagnetic field, by minimizing the deviation between compensated respective measured components of said electromagnetic field, and respective components of said electromagnetic field estimated from said mathematical field model.
80. The method according to claim 79, further comprising the procedure of determining the position of said at least three sensors, thereby determining the position of said object, based on said mathematical field model, by minimizing the deviation between estimates of said amplitude components based on said mathematical field model and estimates of said amplitude components estimated from said procedure of transforming said respective partial estimates of said amplitude components.
81. The method according to claim 52, further comprising the procedure of assigning a grade to each said estimated position of said object.
82. The method according to claim 52, further comprising the procedure of grouping together said respective measured components of said electromagnetic field, compensated for by said mathematical sensing model, and said estimated position of said object, based on said mathematical field model, into at least one point.
83. The method according to claim 82, further comprising the procedure of assigning at least one grade to said at least one point, wherein said at least one grade depends on at least one factor selected from the list consisting of: a figure of merit of said at least one point; the position of said at least one point in said volume of interest; and grades assigned to previous points; wherein each of said at least one factor has a relative weight.
84. The method according to claim 83, further comprising the procedure of lowering the value of said at least one grade, over time.
85. The method according to claim 52, further comprising the procedure of evaluating the accuracy to which calibration parameters, associated with said at least three sensors, are known and the accuracy to which said mathematical field model estimates said amplitude components of said electromagnetic field estimated by said at least three sensors.
86. The method according to claim 85, wherein said procedure of evaluating the accuracy depends on at least one of: a figure of merit for accumulated measurements of said measured respective components of said electromagnetic field; the accuracy achieved so far; the desired accuracy; the mathematical observability of at least one parameter set, said at least one parameter set describing said electromagnetic field; and said calibration parameters.
87. The method according to claim 52, further comprising the procedure of determining a figure of merit for each said estimated position of said object.
88. The method according to claim 52, further comprising the procedure of adaptively modifying at least one of: said mathematical field model; and said mathematical sensing model.
89. The method according to claim 52, further comprising the procedure of adapting at least one of: at least one parameter set describing said electromagnetic field; at least one calibration parameter, associated with said at least three sensors; and the expansion parameters of at least one function of time expressed as an expansion function, wherein at least one of an amplitude and a phase of a mathematical periodic function of time is expressed as said at least one function of time, by minimizing at least one of: the deviation between estimates of amplitude components of said electromagnetic field based on said mathematical field model and values of said amplitude components estimated from a basic harmonic function; and the deviation between said measured respective components of said electromagnetic field, compensated by said mathematical periodic function of time, and estimates of said respective components of said electromagnetic field based on said mathematical field model.
90. The method according to claim 89, wherein said procedure of minimizing includes at least one sub-procedure selected from the list consisting of: minimizing said deviations by excluding non-observable parameters from said minimizations; minimizing said deviations by considering said non-observable parameters as constants; and minimizing said deviations under at least one mathematical constraint.
91. The method according to claim 89, further comprising the procedure of evaluating the accuracy to which said mathematical field model estimates the amplitude components of said electromagnetic field estimated by said at least three sensors and the accuracy in said calibration parameters, after said minimizing.
92. The method according to claim 91 , wherein said procedure of evaluating comprises computing a figure of merit for each said measured respective component, of said electromagnetic field, used in said minimizing.
93. The method according to claim 52, further comprising the procedure of determining an accuracy value for parameters defining said mathematical field model, said mathematical sensing model and calibration parameters associated with said at least three sensors.
94. The method according to claim 52, further comprising the procedure of determining an accuracy for at least one of: an adapted model of said mathematical field model; and an adapted model of said mathematical sensing model.
95. The method according to claim 52, further comprising the procedure of adding an expansion center to at least one of: said mathematical field model; and said mathematical sensing model.
96. The method according to claim 52, further comprising the procedure of comparing at least one of: an adapted model of said mathematical field model; and an adapted model of said mathematical sensing model, with at least a respective one of: said mathematical field model; and said mathematical sensing model, said procedure of comparing being performed on a competitive basis, for a predetermined amount of time.
97. The apparatus according to any of the claims 1-51 substantially as described hereinabove or as illustrated in any of the drawings.
98. The method according to any of the claims 52-96 substantially as described hereinabove or as illustrated in any of the drawings.
PCT/IL2005/001214 2004-11-21 2005-11-16 Electromagnetic tracker WO2006054295A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
EP05804718.4A EP1817606B1 (en) 2004-11-21 2005-11-16 Electromagnetic tracker
US11/791,295 US7542869B2 (en) 2004-11-21 2005-11-16 Electromagnetic tracker

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
IL165314 2004-11-21
IL165314A IL165314A (en) 2004-11-21 2004-11-21 Electromagnetic tracker

Publications (1)

Publication Number Publication Date
WO2006054295A1 true WO2006054295A1 (en) 2006-05-26

Family

ID=35677596

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/IL2005/001214 WO2006054295A1 (en) 2004-11-21 2005-11-16 Electromagnetic tracker

Country Status (4)

Country Link
US (1) US7542869B2 (en)
EP (1) EP1817606B1 (en)
IL (1) IL165314A (en)
WO (1) WO2006054295A1 (en)

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1887309A1 (en) * 2006-08-07 2008-02-13 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
WO2009033552A2 (en) * 2007-09-07 2009-03-19 Rheinisch-Westfälisch-Technische Hochschule Aachen Method and system for determining the position and/or orientation of an object
GB2459718A (en) * 2008-05-02 2009-11-04 In2Games Ltd Motion smoothing in 3D position sensing apparatus
FR2954522A1 (en) * 2009-12-22 2011-06-24 Commissariat Energie Atomique METHOD AND DEVICE FOR IDENTIFYING A SUBASSEMBLY OF MEASUREMENTS, METHOD AND SYSTEM FOR LOCATING AN OBJECT, RECORDING MEDIUM FOR THESE METHODS
US20110238399A1 (en) * 2008-11-19 2011-09-29 Elbit Systems Ltd. System and a method for mapping a magnetic field
AU2012216419B2 (en) * 2006-08-07 2013-08-15 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
US8529505B2 (en) 2008-09-09 2013-09-10 Biosense Webster, Inc. Deflectable catheter with bonded center strut and method of manufacture for same
WO2013104006A3 (en) * 2012-01-08 2013-11-07 Sensor Platforms, Inc. System and method for calibrating sensors for different operating environments
WO2014033247A1 (en) * 2012-09-01 2014-03-06 Volkswagen Aktiengesellschaft Method for determining a position of a receiver and positioning system for a receiver
US9152249B2 (en) 2008-10-20 2015-10-06 Sensor Platforms, Inc. System and method for determining an attitude of a device undergoing dynamic acceleration
US9228842B2 (en) 2012-03-25 2016-01-05 Sensor Platforms, Inc. System and method for determining a uniform external magnetic field
US9459276B2 (en) 2012-01-06 2016-10-04 Sensor Platforms, Inc. System and method for device self-calibration
US9726498B2 (en) 2012-11-29 2017-08-08 Sensor Platforms, Inc. Combining monitoring sensor measurements and system signals to determine device context
US10095815B2 (en) 2008-11-19 2018-10-09 Elbit Systems Ltd. System and a method for mapping a magnetic field
CN109633541A (en) * 2019-01-23 2019-04-16 中国科学院上海微系统与信息技术研究所 A kind of magnetic source positioning device and source localization method
US10488471B2 (en) 2007-10-11 2019-11-26 Elbit Systems Ltd System and a method for mapping a magnetic field
US11187823B2 (en) * 2019-04-02 2021-11-30 Ascension Technology Corporation Correcting distortions

Families Citing this family (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1998702A2 (en) * 2006-03-29 2008-12-10 Stryker Corporation Shielded surgical navigation system that determines the position and orientation of the tracked object with real and virtual dipoles
WO2007129653A1 (en) * 2006-05-09 2007-11-15 Alps Electric Co., Ltd. Calibration program and electronic compass
US8326402B2 (en) * 2006-08-21 2012-12-04 Biosense Webster, Inc. Distortion-immune position tracking using frequency extrapolation
US8450997B2 (en) * 2009-04-28 2013-05-28 Brown University Electromagnetic position and orientation sensing system
WO2011011898A1 (en) 2009-07-28 2011-02-03 Quasmo Ag Input system, and method
US8348831B2 (en) * 2009-12-15 2013-01-08 Zhejiang University Device and method for computer simulated marking targeting biopsy
US9151822B2 (en) * 2009-12-31 2015-10-06 Optimal Ranging, Inc. Precise positioning using a distributed sensor network
CN101858925A (en) * 2010-03-26 2010-10-13 鸿富锦精密工业(深圳)有限公司 Sensing device
US8432264B1 (en) * 2010-07-23 2013-04-30 Tivo Inc. Motion-activated remote control backlight
WO2013018038A1 (en) * 2011-08-01 2013-02-07 Soreq Nuclear Research Center Magnetic tracking system
US20130179128A1 (en) * 2012-01-05 2013-07-11 General Electric Company System And Method For Selecting A Representative Sensor Set Of A Power Plant
WO2014186606A1 (en) * 2013-05-15 2014-11-20 Zephyr Technology Corporation Physiological monitoring and alerting
EP3108266B1 (en) 2014-01-13 2020-03-18 Brainlab AG Estimation and compensation of tracking inaccuracies
IL232074A (en) * 2014-04-10 2015-03-31 Elbit Systems Ltd System and a method for mapping a magnetic field
US20160259404A1 (en) * 2015-03-05 2016-09-08 Magic Leap, Inc. Systems and methods for augmented reality
DE102015012368A1 (en) 2015-09-19 2017-03-23 Audi Ag Method for determining a position information and arrangement comprising a motor vehicle and a stationary charging device to be approached describing a relative position of a motor vehicle relative to a stationary charging device to be approached
CN118605029A (en) 2016-01-19 2024-09-06 奇跃公司 Augmented reality system and method using images
US10261162B2 (en) 2016-04-26 2019-04-16 Magic Leap, Inc. Electromagnetic tracking with augmented reality systems
CA3036709A1 (en) 2016-09-26 2018-03-29 Magic Leap, Inc. Calibration of magnetic and optical sensors in a virtual reality or augmented reality display system
US10241587B2 (en) 2016-12-22 2019-03-26 Microsoft Technology Licensing, Llc Magnetic tracker power duty cycling
US10908680B1 (en) 2017-07-12 2021-02-02 Magic Leap, Inc. Pose estimation using electromagnetic tracking
WO2020209871A1 (en) * 2019-04-12 2020-10-15 Hewlett-Packard Development Company, L.P. Resonator-based object pose determination
WO2020214272A1 (en) 2019-04-15 2020-10-22 Magic Leap, Inc. Sensor fusion for electromagnetic tracking
US11454810B2 (en) * 2019-12-30 2022-09-27 Northern Digital Inc. Reducing interference between Electromagnetic Tracking systems
CN116172540B (en) * 2023-04-28 2023-07-04 长春市鑫睿商贸有限公司 Method for detecting magnetic localizer in tissue focus and method for using detection device thereof

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5847976A (en) * 1995-06-01 1998-12-08 Sextant Avionique Method to determine the position and orientation of a mobile system, especially the line of sight in a helmet visor
US20020030483A1 (en) * 1997-02-13 2002-03-14 Pinhas Gilboa Six-degree-of-freedom tracking system having a passive transponder on the object being tracking
US6516213B1 (en) * 1999-09-03 2003-02-04 Robin Medical, Inc. Method and apparatus to estimate location and orientation of objects during magnetic resonance imaging
US20030139895A1 (en) * 2000-04-14 2003-07-24 Jean-Louis Lescourret Magnetic device, and method for determining orientation
US20040107070A1 (en) * 2002-03-27 2004-06-03 Anderson Peter T. Magnetic tracking system

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5646525A (en) * 1992-06-16 1997-07-08 Elbit Ltd. Three dimensional tracking system employing a rotating field
US6201987B1 (en) * 1998-05-26 2001-03-13 General Electric Company Error compensation for device tracking systems employing electromagnetic fields
CA2356322A1 (en) * 1998-12-23 2000-06-29 Peter D. Jakab Magnetic resonance scanner with electromagnetic position and orientation tracking device
US6400139B1 (en) * 1999-11-01 2002-06-04 Polhemus Inc. Methods and apparatus for electromagnetic position and orientation tracking with distortion compensation
CN2471696Y (en) * 2001-03-15 2002-01-16 广州摩托集团公司 Drive mechanism for chainless bicycle

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5847976A (en) * 1995-06-01 1998-12-08 Sextant Avionique Method to determine the position and orientation of a mobile system, especially the line of sight in a helmet visor
US20020030483A1 (en) * 1997-02-13 2002-03-14 Pinhas Gilboa Six-degree-of-freedom tracking system having a passive transponder on the object being tracking
US6516213B1 (en) * 1999-09-03 2003-02-04 Robin Medical, Inc. Method and apparatus to estimate location and orientation of objects during magnetic resonance imaging
US20030139895A1 (en) * 2000-04-14 2003-07-24 Jean-Louis Lescourret Magnetic device, and method for determining orientation
US20040107070A1 (en) * 2002-03-27 2004-06-03 Anderson Peter T. Magnetic tracking system

Cited By (33)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8280189B2 (en) 2006-08-07 2012-10-02 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
AU2007203658B2 (en) * 2006-08-07 2012-10-11 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
EP1887309A1 (en) * 2006-08-07 2008-02-13 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
US8536859B2 (en) 2006-08-07 2013-09-17 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
AU2012216419B2 (en) * 2006-08-07 2013-08-15 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
EP2256454A1 (en) * 2006-08-07 2010-12-01 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
EP2259008A1 (en) * 2006-08-07 2010-12-08 Biosense Webster, Inc. Distortion-immune position tracking using redundant measurements
JP2008062040A (en) * 2006-08-07 2008-03-21 Biosense Webster Inc Distortion-immune position tracking using redundant measurement
CN102210611A (en) * 2006-08-07 2011-10-12 韦伯斯特生物官能公司 Distortion-immune position tracking using redundant measurements
US8082020B2 (en) 2006-08-07 2011-12-20 Biosense Webster, Inc. Distortion-immune position tracking using redundant magnetic field measurements
WO2009033552A2 (en) * 2007-09-07 2009-03-19 Rheinisch-Westfälisch-Technische Hochschule Aachen Method and system for determining the position and/or orientation of an object
WO2009033552A3 (en) * 2007-09-07 2010-07-15 Rheinisch-Westfälisch-Technische Hochschule Aachen Method and system for determining the position and/or orientation of an object
US10488471B2 (en) 2007-10-11 2019-11-26 Elbit Systems Ltd System and a method for mapping a magnetic field
GB2459718A (en) * 2008-05-02 2009-11-04 In2Games Ltd Motion smoothing in 3D position sensing apparatus
US8529505B2 (en) 2008-09-09 2013-09-10 Biosense Webster, Inc. Deflectable catheter with bonded center strut and method of manufacture for same
US9152249B2 (en) 2008-10-20 2015-10-06 Sensor Platforms, Inc. System and method for determining an attitude of a device undergoing dynamic acceleration
US8700376B2 (en) * 2008-11-19 2014-04-15 Elbit Systems Ltd. System and a method for mapping a magnetic field
US10095815B2 (en) 2008-11-19 2018-10-09 Elbit Systems Ltd. System and a method for mapping a magnetic field
US20110238399A1 (en) * 2008-11-19 2011-09-29 Elbit Systems Ltd. System and a method for mapping a magnetic field
WO2011076767A1 (en) * 2009-12-22 2011-06-30 Commissariat à l'énergie atomique et aux énergies alternatives Method and device for identifying a subset of measurements, method and system for locating an object, recording medium for these methods
FR2954522A1 (en) * 2009-12-22 2011-06-24 Commissariat Energie Atomique METHOD AND DEVICE FOR IDENTIFYING A SUBASSEMBLY OF MEASUREMENTS, METHOD AND SYSTEM FOR LOCATING AN OBJECT, RECORDING MEDIUM FOR THESE METHODS
US8907660B2 (en) 2009-12-22 2014-12-09 Commissariat A L'energie Atomique Et Aux Energies Alternatives Method and device for identifying a subset of measurements, method and system for locating an object, recording medium for these methods
US9459276B2 (en) 2012-01-06 2016-10-04 Sensor Platforms, Inc. System and method for device self-calibration
US9316513B2 (en) 2012-01-08 2016-04-19 Sensor Platforms, Inc. System and method for calibrating sensors for different operating environments
WO2013104006A3 (en) * 2012-01-08 2013-11-07 Sensor Platforms, Inc. System and method for calibrating sensors for different operating environments
US9228842B2 (en) 2012-03-25 2016-01-05 Sensor Platforms, Inc. System and method for determining a uniform external magnetic field
CN104769453A (en) * 2012-09-01 2015-07-08 大众汽车有限公司 Method for determining a position of a receiver and positioning system for a receiver
WO2014033247A1 (en) * 2012-09-01 2014-03-06 Volkswagen Aktiengesellschaft Method for determining a position of a receiver and positioning system for a receiver
US9797998B2 (en) 2012-09-01 2017-10-24 Volkswagen Aktiengesellschaft Method for determining a position of a receiver and positioning system for a receiver
US9726498B2 (en) 2012-11-29 2017-08-08 Sensor Platforms, Inc. Combining monitoring sensor measurements and system signals to determine device context
CN109633541A (en) * 2019-01-23 2019-04-16 中国科学院上海微系统与信息技术研究所 A kind of magnetic source positioning device and source localization method
CN109633541B (en) * 2019-01-23 2023-08-11 中国科学院上海微系统与信息技术研究所 Magnetic source positioning device and magnetic source positioning method
US11187823B2 (en) * 2019-04-02 2021-11-30 Ascension Technology Corporation Correcting distortions

Also Published As

Publication number Publication date
EP1817606A1 (en) 2007-08-15
US20070299623A1 (en) 2007-12-27
EP1817606B1 (en) 2013-05-01
IL165314A (en) 2009-08-03
US7542869B2 (en) 2009-06-02
IL165314A0 (en) 2006-01-15

Similar Documents

Publication Publication Date Title
US7542869B2 (en) Electromagnetic tracker
US7640106B1 (en) Hybrid tracker
US6774624B2 (en) Magnetic tracking system
US7532997B2 (en) Electromagnetic tracking using a discretized numerical field model
AU2011253990B2 (en) Probe tracking using multiple tracking methods
JP6896180B2 (en) Wind flow detection system and method for finding the velocity field of wind flow
EP1228380A2 (en) Method and apparatus for electromagnetic position and orientation tracking with distortion compensation
WO2013016251A2 (en) Image guided surgery trackers using multiple asynchronous sensors
Sadjadi et al. Simultaneous electromagnetic tracking and calibration for dynamic field distortion compensation
IL195389A (en) System and method for mapping a magnetic field
Andria et al. Development and performance evaluation of an electromagnetic tracking system for surgery navigation
US20100056905A1 (en) System and method for tracking medical device
AU2013206492A1 (en) Position and orientation algorithm for a single axis sensor
AU2014277683A1 (en) Adaptive fluoroscope location for the application of field compensation
CN107132587A (en) The full tensor magnetic gradient measurements system mounting error calibration method of aviation superconduction and device
US20170115364A1 (en) System and a method for mapping a magnetic field
He et al. Simple 3-D point reconstruction methods with accuracy prediction for multiocular system
Fischer et al. Electromagnetic tracker measurement error simulation and tool design
Zierdt et al. Extracting tongues from moving heads
CN111721301A (en) Differential positioning method and device based on gravity vector and gradient thereof
Cavaliere et al. Magnetic Model Calibration and Distortion Compensation for Electromagnetic Tracking in a Clinical Environment
Lu et al. Accurate Construction Method of Sensor Measurement Network System for In-Situ Manufacturing of Large Aerospace Component
Şen et al. Bayesian filtering to improve the dynamic accuracy of electromagnetic tracking
CN112179343A (en) Magnet positioning system and method
US11504023B2 (en) Sparse calibration of magnetic field created by coils in metal-rich environment

Legal Events

Date Code Title Description
AK Designated states

Kind code of ref document: A1

Designated state(s): AE AG AL AM AT AU AZ BA BB BG BR BW BY BZ CA CH CN CO CR CU CZ DE DK DM DZ EC EE EG ES FI GB GD GE GH GM HR HU ID IL IN IS JP KE KG KM KN KP KR KZ LC LK LR LS LT LU LV LY MA MD MG MK MN MW MX MZ NA NG NI NO NZ OM PG PH PL PT RO RU SC SD SE SG SK SL SM SY TJ TM TN TR TT TZ UA UG US UZ VC VN YU ZA ZM ZW

AL Designated countries for regional patents

Kind code of ref document: A1

Designated state(s): BW GH GM KE LS MW MZ NA SD SL SZ TZ UG ZM ZW AM AZ BY KG KZ MD RU TJ TM AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LT LU LV MC NL PL PT RO SE SI SK TR BF BJ CF CG CI CM GA GN GQ GW ML MR NE SN TD TG

121 Ep: the epo has been informed by wipo that ep was designated in this application
WWE Wipo information: entry into national phase

Ref document number: 11791295

Country of ref document: US

Ref document number: 2005804718

Country of ref document: EP

NENP Non-entry into the national phase

Ref country code: DE

WWP Wipo information: published in national office

Ref document number: 2005804718

Country of ref document: EP

WWP Wipo information: published in national office

Ref document number: 11791295

Country of ref document: US