Method and apparatus for reducing magnetic tracking error

Patent metadata

Field	Value
Publication number	US-11486958-B2
Application number	US-201916368543-A
Country	US
Kind code	B2
Filing date	Mar 28, 2019
Priority date	May 17, 2018
Publication date	Nov 1, 2022
Grant date	Nov 1, 2022

Abstract

A method and apparatus for reducing magnetic tracking error in the position and orientation determined in an electromagnetic tracking system is disclosed. In some embodiments, a corrected position and orientation is blended with an uncorrected position and orientation based upon the calculated probability of each. To determine a corrected position and orientation, data from an IMU in the receiver is used to obtain a constraint on the orientation. In other embodiments, the amount of detected error due to electromagnetic distortion is measured. Any error is first assumed to be from “floor distortion,” and a correction is applied. If the error is still deemed too great, a constraint is again obtained from IMU data. Using this constraint, another correction for the distortion is made. The solution from this correction may be blended with a standard solution and the solution from the floor distortion to arrive at a final solution.

First claim

What is claimed is:

1. A system for reducing magnetic tracking error in a determined position and orientation of a receiver in an electromagnetic tracking system, comprising:
a transmitter having a plurality of source magnetic coils configured to generate a magnetic field, and an inertial measurement unit;
a receiver having a plurality of sensor magnetic coils configured to sense the magnetic field and generate magnetic sensor data, and an inertial measurement unit; and
a processor configured to:
determine that there is error in the determined position and orientation of the receiver relative to the transmitter as represented by a first signal matrix created using the magnetic sensor data from the sensor magnetic coils;
determine that the error in the position and orientation of the receiver represented by the first signal matrix exceeds a predetermined threshold;
determine a first correction factor to compensate for the error in the position and orientation of the receiver represented by the first signal matrix, and compute a second signal matrix by applying the first correction factor to the first signal matrix;
determine that error in the position and orientation of the receiver represented by the second signal matrix exceeds the predetermined threshold;
determine a second correction factor to compensate for the error in the position and orientation of the receiver represented by the second signal matrix, and compute a third signal matrix by applying the second correction to the second signal matrix; and
determine an error-corrected position and orientation of the receiver by blending positions and orientations derived from the first, second and third signal matrices.

2. The system of claim 1 wherein the processor is configured to determine the first correction factor by:
determining a gravity vector from data obtained from the inertial measurement units in the transmitter and receiver; and
selecting the first correction factor to compensate for eddy currents in a floor and/or ceiling.

3. The system of claim 1 wherein the processor is configured to blend positions and orientations derived from the first, second and third signal matrices by:
determining a probability for each of the first, second and third signal matrices; and
combining the positions and orientations derived from the first, second and third signal matrices according to the determined probabilities.

4. The system of claim 1 wherein the processor configured to determine the error-corrected position and orientation of the receiver by blending positions and orientations derived from the first, second and third signal matrices is further configured to use information from a camera, optical, or ultrasonic system.

5. A method of reducing magnetic tracking error in a determined position and orientation of a receiver in an electromagnetic tracking system, comprising:
generating a magnetic field from a plurality of source magnetic coils in a transmitter;
generating magnetic sensor data by sensing the magnetic field using a plurality of sensor magnetic coils in a receiver;
generating inertial measurement data from first and second inertial measurement units, one inertial measurement unit in the transmitter and the other inertial measurement unit in the receiver;
determining by a processor that there is error in a determined position and orientation of the receiver relative to the transmitter as represented by a first signal matrix computed using the magnetic sensor data from the sensor magnetic coils;
determining by the processor that the error in the position and orientation of the receiver represented by the first signal matrix exceeds a predetermined threshold;
determining by the processor a first correction factor to compensate for the error in the position and orientation of the receiver relative to the transmitter as represented by the first signal matrix, and computing by the processor a second signal matrix by applying the first correction factor to the first signal matrix;
determining by the processor that error in the position and orientation of the receiver represented by the second signal matrix exceeds the predetermined threshold;
determining by the processor a second correction factor to compensate for the error in the position and orientation of the receiver relative to the transmitter as represented by the second signal matrix, and computing by the processor a third signal matrix by applying the second correction to the second signal matrix; and
determining by the processor an error-corrected position and orientation of the receiver by blending positions and orientations derived from the first, second and third signal matrices.

6. The method of claim 5 wherein determining the first correction factor further comprises:
determining a gravity vector from data obtained from the inertial measurement units in the transmitter and receiver; and
selecting the first correction factor to compensate for eddy currents in a floor and/or ceiling.

7. The method of claim 5 wherein blending positions and orientations derived from the first, second and third signal matrices further comprises:
determining a probability for each of the first, second and third signal matrices; and
combining the positions and orientations derived from the first, second and third signal matrices according to the determined probabilities.

8. The method of claim 5 wherein determining by the processor an error-corrected position and orientation of the receiver by blending positions and orientations derived from the first, second and third signal matrices also uses information from a camera, optical, or ultrasonic system.

9. A non-transitory computer readable storage medium having embodied thereon instructions for causing a computing device to execute a method for reducing magnetic tracking error in the position and orientation of a receiver in an electromagnetic tracking system, the method comprising:
determining by a processor that there is error in a determined position and orientation of the receiver relative to the transmitter as represented by a first signal matrix created using the magnetic sensor data from the sensor magnetic coils;
determining by the processor that the error in the position and orientation of the receiver represented by the first signal matrix exceeds a predetermined threshold;
determining by the processor a first correction factor to compensate for the error in the position and orientation of the receiver represented by the first signal matrix, and computing by the processor a second signal matrix by applying the first correction factor to the first signal matrix;
determining by the processor that error in the position and orientation of the receiver represented by the second signal matrix exceeds the predetermined threshold;
determining by the processor a second correction factor to compensate for the error in the position and orientation of the receiver represented by the second signal matrix, and computing by the processor a third signal matrix by applying the second correction to the second signal matrix; and
determining by the processor an error-corrected position and orientation of the receiver by blending positions and orientations derived from the first, second and third signal matrices.

10. A system for reducing magnetic tracking error in a determined position and orientation of a receiver in an electromagnetic tracking system, comprising:
a transmitter having a plurality of source magnetic coils configured to generate a magnetic field, and an inertial measurement unit;
a receiver having a plurality of sensor magnetic coils configured to sense the magnetic field and generate magnetic sensor data, and an iner

Assignees

• Penumbra Inc

Inventors

• Zur Oded Y
• Diaz Alejandro Santiago
• Collins Michael D
• Bar-On Ran
• Barak Ron
• Rubin Amir

Classifications

• G06N7/01

  Probabilistic graphical models, e.g. probabilistic networks · CPC title

• G01C21/1656

  with passive imaging devices, e.g. cameras · CPC title

• G01S5/021 Primary

  Calibration, monitoring or correction (G01S5/0252 takes precedence) · CPC title

• G01S3/325

  Automatic tracking systems · CPC title

• G01C21/1654 Primary

  with electromagnetic compass · CPC title