C++ implementation of coherent point drift, from https://sites.google.com/site/myronenko/research/cpd