Added visualizations to show where collisions are between objects and robot, world