An iterative closest point algorithm for marker-free 3D shape registration of continuum robots