small_gicp 0.1.2 Efficient and parallelized algorithms for point cloud registration Kenji Koide MIT cmake eigen libomp-dev cmake