Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Implement point cloud alignment for SE3 #346

Open
wants to merge 1 commit into
base: main
Choose a base branch
from

Conversation

Hs293Go
Copy link
Contributor

@Hs293Go Hs293Go commented Apr 4, 2022

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)

This is equivalent to `Eigen::umeyama` but faster and stores the results
more compactly.
@coveralls
Copy link

Coverage Status

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

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants