A Quaternion-Based Unscented Kalman Filter for Robust Optical/Inertial Motion Tracking in Computer-Assisted Surgery

This paper presents a sensor fusion algorithm based on an unscented Kalman filter (UKF) designed for robust estimation of position and orientation of a freely moving target in surgical applications. The UKF is not subject to the nontrivial disadvantages of the more popular extended Kalman filter that can affect the accuracy or even lead to divergence of the algorithm. Orientation is represented by quaternion, which avoids singularities and is computationally more effective. The fusion algorithm has been designed to incorporate an optical tracking system and an inertial sensor unit containing triaxial angular rate sensors and accelerometers. The proposed tracking system does not suffer from environmental distortion, is robust to brief line-of-sight losses and has a high sampling rate. Experimental results validate the filter design, and show the feasibility of using optical/inertial sensor fusion for robust motion tracking meeting the requirements of surgical computer-assisted procedures.

[1]  F. Raab,et al.  Magnetic Position and Orientation Tracking System , 1979, IEEE Transactions on Aerospace and Electronic Systems.

[2]  Eric Robert Bachmann,et al.  Inertial and Magnetic Tracking of Limb Segment Orientation for Inserting Humans into Synthetic Environments , 2000 .

[3]  Gerd Hirzinger,et al.  Robust multi sensor pose estimation for medical applications , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Xiaoping Yun,et al.  Design, Implementation, and Experimental Results of a Quaternion-Based Kalman Filter for Human Body Motion Tracking , 2006, IEEE Trans. Robotics.

[5]  A. Pinz,et al.  Calibration of Hybrid Vision / Inertial Tracking Systems * , 2005 .

[6]  N. Parnian,et al.  Position sensing using integration of a vision system and inertial sensors , 2008, 2008 34th Annual Conference of IEEE Industrial Electronics.

[7]  Guang-Zhong Yang,et al.  Freehand Cocalibration of Optical and Electromagnetic Trackers for Navigated Bronchoscopy , 2004, MIAR.

[8]  Giancarlo Ferrigno,et al.  Unscented Kalman Filter Based Sensor Fusion for Robust Optical and Electromagnetic Tracking in Surgical Navigation , 2013, IEEE Transactions on Instrumentation and Measurement.

[9]  Simon J. Julier,et al.  The scaled unscented transformation , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[10]  Ronald Azuma,et al.  Hybrid inertial and vision tracking for augmented reality registration , 1999, Proceedings IEEE Virtual Reality (Cat. No. 99CB36316).

[11]  Norbert Link,et al.  Indoor 3D position estimation using low-cost inertial sensors and marker-based video-tracking , 2010, IEEE/ION Position, Location and Navigation Symposium.

[12]  Luca Fanucci,et al.  A Double-Stage Kalman Filter for Orientation Tracking With an Integrated Processor in 9-D IMU , 2013, IEEE Transactions on Instrumentation and Measurement.

[13]  Giancarlo Ferrigno,et al.  Intraoperative forces and moments analysis on patient head clamp during awake brain surgery , 2012, Medical & Biological Engineering & Computing.

[14]  Peter Kazanzides,et al.  Fusion of Inertial Sensing to Compensate for Partial Occlusions in Optical Tracking Systems , 2014, AE-CAI.

[15]  Suya You,et al.  Fusion of vision and gyro tracking for robust augmented reality registration , 2001, Proceedings IEEE Virtual Reality 2001.

[16]  Erik B. Dam,et al.  Quaternions, Interpolation and Animation , 2000 .

[17]  Jihong Lee,et al.  Sensor fusion and calibration for motion captures using accelerometers , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[18]  Philippe Martin,et al.  Optical-Inertial Tracking System with High Bandwidth and Low Latency , 2013, ICARA.

[19]  Young Soo Suh.  Orientation Estimation Using a Quaternion-Based Indirect Kalman Filter With Adaptive Estimation of External Acceleration , 2010, IEEE Transactions on Instrumentation and Measurement.

[20]  Michael Harrington,et al.  Constellation: a wide-range wireless motion-tracking system for augmented reality and virtual set applications , 1998, SIGGRAPH.

[21]  Garnette R. Sutherland,et al.  Robotics in neurosurgery. , 2004 .

[22]  Giancarlo Ferrigno,et al.  Convergence Analysis of an Iterative Targeting Method for Keyhole Robotic Surgery , 2014 .

[23]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[24]  Robert B. McGhee,et al.  A Simplified Quaternion-Based Algorithm for Orientation Estimation From Earth Gravity and Magnetic Field Measurements , 2008, IEEE Transactions on Instrumentation and Measurement.

[25]  Greg Welch,et al.  Motion Tracking: No Silver Bullet, but a Respectable Arsenal , 2002, IEEE Computer Graphics and Applications.

[26]  Rudolph van der Merwe,et al.  Sigma-Point Kalman Filters for Integrated Navigation , 2004 .

[27]  Gerd Hirzinger,et al.  An approach to ulta-tightly coupled data fusion for handheld input devices in robotic surgery , 2011, 2011 IEEE International Conference on Robotics and Automation.

[28]  Ronald Azuma,et al.  Improving static and dynamic registration in an optical see-through HMD , 1994, SIGGRAPH.

[29]  X. Pennec.  Computing the Mean of Geometric Features Application to the Mean Rotation , 1998 .

[30]  Peter Kazanzides,et al.  Investigation of Attitude Tracking Using an Integrated Inertial and Magnetic Navigation System for Hand-Held Surgical Instruments , 2012, IEEE/ASME Transactions on Mechatronics.

[31]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[32]  Eric Foxlin,et al.  Inertial head-tracker sensor fusion by a complementary separate-bias Kalman filter , 1996, Proceedings of the IEEE 1996 Virtual Reality Annual International Symposium.

[33]  E. Kraft,et al.  A quaternion-based unscented Kalman filter for orientation tracking , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.