Fast and robust isotropic scaling probability iterative closest point algorithm