Change mode - STABILIZE, ALT_HOLD, LOITER and RTL