Normal Iterative Closest Point (NICP)