Initial merge of PatrikE's Fixed Wing RTH
Merge pull request #198 from readerror67/fw-nav

Initial merge of PatrikE's Fixed Wing RTH