C++ implementation of the Coherent Point Drift point set registration algorithm