Change mode -> ALT_HOLD, LOITER, GUIDED and MISION