The planner planned in freespace for both the hdt and pr2 arms. Moving around stuff now.
Forgot to add header for sbpl_arm_planner_interface
Forgot to fix CMakelists