clean up commander
add some demo code for what the planning scene interface will look like
should not have removed this
0.3.3
remove unneeded dep
add set_planner_id