Update navigation_multicopter.c