Update navigation_fixedwing.c