Minimal implementation of the ICP algorithm with SE3 / SO3 * R3 optimization only using Eigen, for quickly comparing and verifying various rotation parameterization methods, degeneracy analysis methods, and covariance estimation methods. - View it on GitHub