Merge branch 'sangaboard-v5' into 'new_env_for_hw_serial'

# Conflicts:
#   src/modules/illumination/illumination.cpp

src/modules/stage/stage.cpp

@@ -223,6 +223,9 @@ void stage_mr(String command)
     parse_arguments(args, command, 3);
     EACH_MOTOR
     {
+        if (i>3)
+            continue;
+
         displacement[i] = atol(args[i]);
         free(args[i]);
     }