diff --git a/ArduSub/Sub.cpp b/ArduSub/Sub.cpp index 877f3bf8c1..6f74102ef0 100644 --- a/ArduSub/Sub.cpp +++ b/ArduSub/Sub.cpp @@ -27,8 +27,6 @@ Sub::Sub() : control_mode(Mode::Number::MANUAL), motors(MAIN_LOOP_RATE), - auto_mode(Auto_WP), - guided_mode(Guided_WP), auto_yaw_mode(AUTO_YAW_LOOK_AT_NEXT_WP), inertial_nav(ahrs), ahrs_view(ahrs, ROTATION_NONE), @@ -38,7 +36,9 @@ Sub::Sub() loiter_nav(inertial_nav, ahrs_view, pos_control, attitude_control), circle_nav(inertial_nav, ahrs_view, pos_control), param_loader(var_info), - flightmode(&mode_manual) + flightmode(&mode_manual), + auto_mode(Auto_WP), + guided_mode(Guided_WP) { #if CONFIG_HAL_BOARD != HAL_BOARD_SITL failsafe.pilot_input = true;