Accurate and efficient fiber optical shape sensor for MRI compatible minimally invasive instruments