3D Tracking for Robotic Endoscopic Surgery