Added waypoint handling and seperated persistance from vehicle.json
Moved reset of waypoint action on mission ack