Fixed Map

Fixed the map class so it doesn't throw an error when the waypoint
finder method runs out of valid blocks to set waypoints to.