diff --git a/ArduCopterMega/control_modes.pde b/ArduCopterMega/control_modes.pde index 68e2ddcc88..d0240c2fb0 100644 --- a/ArduCopterMega/control_modes.pde +++ b/ArduCopterMega/control_modes.pde @@ -6,12 +6,14 @@ void read_control_switch() //motor_armed = (switchPosition < 5); if (oldSwitchPosition != switchPosition){ - set_mode(g.flight_modes[switchPosition]); oldSwitchPosition = switchPosition; prev_WP = current_loc; + Serial.print("Changed to flight mode: "); + Serial.println(flight_mode_strings[g.flight_modes[switchPosition]]); + // reset navigation integrators // ------------------------- reset_I();