Novel Algorithms for Robust Registration of Fiducials in CT and MRI