Removed the sbpl_collision_interface...it's not needed anymore. Still need to move test files to own package
Lots of small changes - the arm planner interface uses the same params as the environment now.