Robust multi sensor pose estimation for medical applications

In this paper a sensor fusion for pose estimation using optical and inertial data is presented. The proposed algorithm is based on extended Kalman filtering and fuses data from an optical tracking system and an inertial measurement unit. These two redundant sensor systems complement each other well, with the tracking system providing absolute positions and the inertial measurements giving low latency information of derivatives. Models for both sensors are given respecting the different sampling times and latencies. Another key issue is to use information about every landmark, i.e. marker ball, visible for the tracking system, by coupling the two sensor systems tightly together. The algorithm is evaluated in simulation and tested with an experimental hardware platform. The combined sensor system is robust with respect to short time marker occlusions and effectively compensates for latencies in the pose measurements.

[1]  Hugh F. Durrant-Whyte,et al.  Achieving integrity in an INS/GPS navigation loop for autonomous land vehicle applications , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[2]  Robert B. McGhee,et al.  An extended Kalman filter for quaternion-based orientation estimation using MARG sensors , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

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

[4]  Ravindra Babu,et al.  Ultra-Tight GPS/INS/PL Integration: Kalman Filter Performance Analysis , 2005 .

[5]  J. L. Roux An Introduction to the Kalman Filter , 2003 .

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

[7]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[8]  S. F. Schmidt APPLICATION OF STATISTICAL FILTER THEORY TO THE OPTIMAL ESTIMATION OF POSITION AND VELOCITY ON BOARD A CIRCUMLUNAR VEHICLE , 2022 .

[9]  Salah Sukkarieh,et al.  Tightly Coupled INS/GPS with Bias Estimation for UAV Applications , 2004 .

[10]  J. Farrell,et al.  The global positioning system and inertial navigation , 1999 .

[11]  Eric M. Foxlin Head tracking relative to a moving vehicle or simulator platform using differential inertial sensors , 2000, Defense, Security, and Sensing.

[12]  Greg Welch,et al.  SCAAT: incremental tracking with incomplete information , 1997, SIGGRAPH.

[13]  Jinling Wang,et al.  Kalman Filter Design Strategies for Code Tracking Loop in Ultra-Tight GPS/INS/PL Integration , 2006 .

[14]  Tobias Ortmaier,et al.  A hands-on-robot for accurate placement of pedicle screws , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..