navigator: use bearing to home for RTL
Merge branch 'beta' into rtl_heading
navigator: "reached" flags reset fixed
navigator: check if yaw reached only when position reached
Merge branch 'inav_fs' into rtl_heading
Merge pull request #660 from PX4/rtl_heading

navigator: use bearing to home for RTL