Removed loss of Vicon control bug and set waypoints for flight out of arena