PatrikE's Fixed Wing RTH

still not fixed