Closed psigen closed 8 years ago
This is not a bug. Active DOFs and the active manipulator are independent:
It's perfectly reasonable to set the active DOFs to a subset of the active manipulator's GetArmIndices()
if you only want to plan for those DOFs. It's also valid, although not useful, to set the active DOFs to joints that do not affect the end effector.
If the planner does not work when these are not equal, which is very possible, then that is a bug. We should not work around the bug by setting the active DOFs to those of the active manipulator.
@psigen What was our conclusion on this?
I need to refactor this to do a check instead of setting the DOFs.
This PR is being used for reference, but should not be merged.
This fixes an ongoing issue with VectorFieldPlanner immediately failing in certain cases (which turned out to be cases where the Active DOFs set on the robot did not match the Active Manipulator).
I also removed some unused imports.