Transform point cloud in GICP align function #887
Merged
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Fixes #754 and #818
I also fixed a dead link in the GICP documentation.
The new changes can be tested using the following code; which is a modified copy of Interactive ICP tutorial code. Test project
I use a GICP object rather than an ICP object; here I use the
align
function with a guessed matrixicp.align (*cloud_icp, transformation_matrix.inverse ().cast<float> ());
Note that
transformation_matrix.inverse ()
is the exact transformation to align the point cloud. As a result the point cloud is perfeclty aligned after the first iteration.If you want to see GICP working just use
icp.align (*cloud_icp);
And press space in the viewer to iterate!