Pose estimation of surgical instrument using sensor data fusion with optical tracker and IMU based on Kalman filter

Tracking system is essential for Image Guided Surgery(IGS). The Optical Tracking Sensor(OTS) has been widely used as tracking system for IGS due to its high accuracy and easy usage. However, OTS has a limit that tracking fails when occlusion of marker occurs. In this paper, sensor fusion with OTS and Inertial Measurement Unit(IMU) is proposed to solve this problem. The proposed algorithm improves the accuracy of tracking system by eliminating scattering error of the sensor and supplements the disadvantages of OTS and IMU through sensor fusion based on Kalman filter. Also, coordinate axis calibration method that improves the accuracy is introduced. The performed experiment verifies the effectualness of the proposed algorithm.