Added a simple flightplan for full autonomous flight end to end