Sophus icon indicating copy to clipboard operation
Sophus copied to clipboard

Implement point cloud alignment for SE3

Open Hs293Go opened this issue 2 years ago • 1 comments

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)

Hs293Go avatar Apr 04 '22 21:04 Hs293Go

Coverage Status

Coverage increased (+0.03%) to 99.044% when pulling ecd252a2708fa80a7e3dc02957434e6382f8ae37 on Hs293Go:develop into 0f7f95733d144a86e9797ae2ade344210a5939d5 on strasdat:master.

coveralls avatar Apr 04 '22 22:04 coveralls