flightplan_nav_fixes

Fixes on pulling auto_nav function in every ap mode and 'approaching time'