Removes checks on accelerations/velocities that do not currently serve a purpose
Refactors the isValid function to hopefully work with a wider range of MoveIt robots (e.g. those that have passive joints or extra joints not in the move-group being planned for).
Adds a setState function to the two moveit robot models that allows a user to set the initial state for the planner. This enables a user to plan with robots that have additional joints before the desired planning group. You could, for example, set the position of a rail, get the proper transforms, and then plan for the 6 DOF robot ontop.
No performance regressions (in fact a small improvement), and the basic tests and robot models I have work.
Related to #161, #130.
This PR:
isValid
function to hopefully work with a wider range of MoveIt robots (e.g. those that have passive joints or extra joints not in the move-group being planned for).setState
function to the two moveit robot models that allows a user to set the initial state for the planner. This enables a user to plan with robots that have additional joints before the desired planning group. You could, for example, set the position of a rail, get the proper transforms, and then plan for the 6 DOF robot ontop.No performance regressions (in fact a small improvement), and the basic tests and robot models I have work.
I'll come up with some extras to test.