Generalized Iterative Closest Point