Catadioptric Stereo Tracking for Three Dimensional Shape Measurement of MRI Guided Catheters