Added new file format goal for the hdt arm, updated the launch file. It calls the planner but fails immediatly.
Need to make sure the sbpl_manipulation_components_pr2 is fully up to date. Removed param for now.
Turned back on the IK amp!
Removed the two lowest spheres in link1
Merge remote-tracking branch 'upstream/groovy' into groovy