diff --git a/ArduSub/config.h b/ArduSub/config.h
index 2cfaf32f00..79d5b1642b 100644
--- a/ArduSub/config.h
+++ b/ArduSub/config.h
@@ -320,13 +320,13 @@
 //
 
 #ifndef FLIGHT_MODE_1
- # define FLIGHT_MODE_1                  STABILIZE
+ # define FLIGHT_MODE_1                  MANUAL
 #endif
 #ifndef FLIGHT_MODE_2
  # define FLIGHT_MODE_2                  STABILIZE
 #endif
 #ifndef FLIGHT_MODE_3
- # define FLIGHT_MODE_3                  STABILIZE
+ # define FLIGHT_MODE_3                  ALT_HOLD
 #endif
 #ifndef FLIGHT_MODE_4
  # define FLIGHT_MODE_4                  STABILIZE