Add M42 M, improve M43 (#17173)

2020-03-18 17:12:51 -04:00
parent de45ac41ad
commit 84dec5da10
2 changed files with 22 additions and 5 deletions
--- a/Marlin/src/gcode/config/M43.cpp
+++ b/Marlin/src/gcode/config/M43.cpp
@ -67,6 +67,7 @@ inline void toggle_pins() {
    else {
      watchdog_refresh();
      report_pin_state_extended(pin, ignore_protection, true, PSTR("Pulsing   "));
+      const bool prior_mode = GET_PINMODE(pin);
      #if AVR_AT90USB1286_FAMILY // Teensy IDEs don't know about these pins so must use FASTIO
        if (pin == TEENSY_E2) {
          SET_OUTPUT(TEENSY_E2);
@ -95,6 +96,7 @@ inline void toggle_pins() {
          watchdog_refresh();
        }
      }
+      pinMode(pin, prior_mode);
    }
    SERIAL_EOL();
  }