Sophus
Sophus copied to clipboard
Implement point cloud alignment for SE3
Point cloud alignment is an application common enough that Eigen provides Eigen::umeyama
to this end. Sophus can do better by exploiting a closed form solution for the optimum rotation quaternion. Another benefit is being able to store the result naturally in a SE3 object.
Method | Solver method | Result storage |
---|---|---|
Eigen::umeyama |
SVD | Eigen::Matrix4d (16 parameters) |
SE3::setFromPointClouds |
Eigenproblem | Sophus::SE3 (7 parameters) |