Normal Iterative Closest Point (NICP) Algorithm C++ Library