Pose Tracking Algorithm of an Endoscopic Surgery Robot Wrist

摘要

In recent two decades, more and more research on the endoscopic surgery has been carried out [2]. Most of the work focuses on the development of the robot in the field of robotics and the navigation of the surgery tools based on computer graphics. But the tracking and locating of the EndoWrist is also a very important aspect. This paper deals with the the tracking algorithm of the EndoWrist's pose (position and orientation). The linear tracking of the position is handled by the Kalman Filter. The quaternion-based nonlinear orientation tracking is implemented with the Extended Kalman Filter. The most innovative point of this paper is the parameterization of the motion model of the Extended Kalman Filter.