LIBICP: C++ Library for Iterative Closest Point Matching

http://www.cvlibs.net/software/libicp/