🚸 M401 H - Report BLTouch HS State (MarlinFirmware#23724)

mh-dm · May 15, 2022 · 4f53cc1 · 4f53cc1
1 parent 3c23493
commit 4f53cc1
Showing 1 changed file with 8 additions and 2 deletions.
diff --git a/Marlin/src/gcode/probe/M401_M402.cpp b/Marlin/src/gcode/probe/M401_M402.cpp
@@ -36,12 +36,18 @@
  * M401: Deploy and activate the Z probe
  *
  * With BLTOUCH_HS_MODE:
+ *  H       Report the current BLTouch HS mode state and exit
  *  S<bool> Set High Speed (HS) Mode and exit without deploy
  */
 void GcodeSuite::M401() {
-  if (parser.seen('S')) {
+  const bool seenH = parser.seen_test('H'),
+             seenS = parser.seen('S');
+  if (seenH || seenS) {
     #ifdef BLTOUCH_HS_MODE
-      bltouch.high_speed_mode = parser.value_bool();
+      if (seenS) bltouch.high_speed_mode = parser.value_bool();
+      SERIAL_ECHO_START();
+      SERIAL_ECHOPGM("BLTouch HS mode ");
+      serialprintln_onoff(bltouch.high_speed_mode);
     #endif
   }
   else {