diff --git a/src/modules/stage/stage.cpp b/src/modules/stage/stage.cpp index b7b8a51..329cf86 100644 --- a/src/modules/stage/stage.cpp +++ b/src/modules/stage/stage.cpp @@ -220,6 +220,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]); }