Adds rudimentary collision detection.

Does not take into account the size of the robot.