This software was developed as a coursework for one of my master modules. It is using the ICP Algorithm and many other parameters to benchmark how well it works.
Libigl - https://github.com/libigl/libigl
Nanoflann - https://github.com/jlblancoc/nanoflann