-
Notifications
You must be signed in to change notification settings - Fork 1.4k
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
Add EstimateGeneralizedAbsolutePose #2174
Conversation
72a3369
to
ff0502e
Compare
ff0502e
to
827ed22
Compare
PTAL. |
std::vector<size_t> point3D_ids; | ||
point3D_ids.reserve(points3D.size()); | ||
for (const auto& p3D : points3D) { | ||
point3D_ids.push_back(std::lower_bound(unique_points3D.begin(), |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Since we use isApprox above to prune redundant points, but here we use the exact LowerVector3d, I suspect that you may end up with unique_points3D.end() as a return value, if the last point was pruned. In this case, you will end up with a point3D_id that is out of bounds?
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Yes this is quite error-prone. I've replaced it with the argmin of the distance to all distinct points.
PTAL. |
All tests now pass - PTAL. |
Thanks, looks great. |
estimators/generalized_pose
asestimators/pose
is getting too crowded