Rover: reuse set-mode-by-number method

Icatme · Sep 1, 2021 · 96be74b · 96be74b
1 parent 0a8e157
commit 96be74b
Showing 1 changed file with 2 additions and 4 deletions.
diff --git a/Rover/RC_Channel.cpp b/Rover/RC_Channel.cpp
@@ -21,10 +21,8 @@ void RC_Channel_Rover::mode_switch_changed(modeswitch_pos_t new_pos)
         // should not have been called
         return;
     }
-    Mode *new_mode = rover.mode_from_mode_num((Mode::Number)rover.modes[new_pos].get());
-    if (new_mode != nullptr) {
-        rover.set_mode(*new_mode, ModeReason::RC_COMMAND);
-    }
+
+    rover.set_mode((Mode::Number)rover.modes[new_pos].get(), ModeReason::RC_COMMAND);
 }
 
 // init_aux_switch_function - initialize aux functions