M401 enhance

MarlinFirmware · Feb 12, 2022 · de670b6 · de670b6
1 parent cda4682
commit de670b6
Showing 1 changed file with 6 additions and 1 deletion.
diff --git a/Marlin/src/gcode/probe/M401_M402.cpp b/Marlin/src/gcode/probe/M401_M402.cpp
@@ -41,7 +41,12 @@
 void GcodeSuite::M401() {
   if (parser.seen('S')) {
     #ifdef BLTOUCH_HS_MODE
-      bltouch.high_speed_mode = parser.value_bool();
+      if (parser.has_value()) {  // if no value after "S" than just query
+        bltouch.high_speed_mode = parser.value_bool();
+      }
+      SERIAL_ECHO_START();
+      SERIAL_ECHOPGM("BLTouch HS mode ");
+      serialprintln_onoff(bltouch.high_speed_mode);
     #endif
   }
   else {