-
Notifications
You must be signed in to change notification settings - Fork 10
Support multiple end effectors #4
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
base: master
Are you sure you want to change the base?
Conversation
src/fkcc_gen.cc
Outdated
| { | ||
| trace_frame(info.end_effector_index, ad_data, data, n_spheres_data + n_bounding_spheres_data); | ||
| for(size_t i = 0; i < info.end_effector_indexes.size(); i++) | ||
| trace_frame(info.end_effector_indexes[i], ad_data, data, n_spheres_data + n_bounding_spheres_data + 12 *i); |
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.
important callout, we now return all eef fks as a 12*N array
zkingston
left a comment
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.
Minor nits
src/fkcc_gen.cc
Outdated
| extract_spheres(); | ||
|
|
||
| if (not end_effector) | ||
| for (const auto end_effector : end_effectors) |
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.
const auto &
src/fkcc_gen.cc
Outdated
| } | ||
| else | ||
| { | ||
| end_effector_names.push_back(end_effector); |
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.
emplace_back
src/fkcc_gen.cc
Outdated
| } | ||
| } | ||
| else if (not model.existFrame(*end_effector)) | ||
| if (end_effector_names.size() == 0) |
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.
empty()
src/fkcc_gen.cc
Outdated
| } | ||
| else | ||
|
|
||
| for (const auto end_effector_name : end_effector_names) |
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.
const auto &
src/fkcc_gen.cc
Outdated
| for (const auto end_effector_name : end_effector_names) | ||
| { | ||
| end_effector_name = *end_effector; | ||
| end_effector_indexes.push_back(model.getFrameId(end_effector_name)); |
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.
emplace_back
Support multiple end effectors. The interface is made more generic to support 1+ eefs. Also added a bimanual panda arm.
To reproduce
TODO