Iterative Closest Point Algorithm Example