Multi primitive-to-primitive (MP2P) ICP algorithms in C++ - View it on GitHub