fixed bug in collision detection for goal pose queries
renamed collision check function to be clearer
Merge pull request #364 from ros-planning/fix-collision-display-benchmark-gui

Fix collision display benchmark gui