Closes #39. Collision detection with waypoints and exit waypoint now
defined by sizes in the Config file.