make M911.x more robust in advanced motor driver

diff --git a/src/modules/utils/motordrivercontrol/MotorDriverControl.cpp b/src/modules/utils/motordrivercontrol/MotorDriverControl.cpp
index 7eea4ad..69461b1 100644 (file)
--- a/src/modules/utils/motordrivercontrol/MotorDriverControl.cpp
+++ b/src/modules/utils/motordrivercontrol/MotorDriverControl.cpp
@@ -310,7 +310,7 @@ void MotorDriverControl::on_gcode_received(void *argument)
                 gcode->stream->printf("Motor %d (%c)...\n", id, axis);
                 dump_status(gcode->stream, true);
 
-            }else if(gcode->get_value('P') == id || gcode->has_letter(axis)) {
+            }else if( (gcode->has_letter('P') && gcode->get_value('P') == id) || gcode->has_letter(axis)) {
                 if(gcode->subcode == 1) {
                     dump_status(gcode->stream, !gcode->has_letter('R'));