added waypoint forward mover
added untested autonomous flight plan
improved now semi tested autonomous flight plan