1 files changed, 66 insertions, 0 deletions
diff --git a/Marlin/src/gcode/host/M118.cpp b/Marlin/src/gcode/host/M118.cpp
new file mode 100644
index 0000000..73115d5
--- /dev/null
+++ b/Marlin/src/gcode/host/M118.cpp
@@ -0,0 +1,66 @@
+/**
+ * Marlin 3D Printer Firmware
+ * Copyright (c) 2020 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
+ *
+ * Based on Sprinter and grbl.
+ * Copyright (c) 2011 Camiel Gubbels / Erik van der Zalm
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <https://www.gnu.org/licenses/>.
+ *
+ */
+
+#include "../gcode.h"
+#include "../../core/serial.h"
+
+/**
+ * M118: Display a message in the host console.
+ *
+ *  A1  Prepend '// ' for an action command, as in OctoPrint
+ *  E1  Have the host 'echo:' the text
+ *  Pn  Redirect to another serial port
+ *        0 : Announce to all ports
+ *      1-9 : Serial ports 1 to 9
+ */
+void GcodeSuite::M118() {
+  bool hasE = false, hasA = false;
+  #if HAS_MULTI_SERIAL
+    int8_t port = -1; // Assume no redirect
+  #endif
+  char *p = parser.string_arg;
+  for (uint8_t i = 3; i--;) {
+    // A1, E1, and Pn are always parsed out
+    if (!( ((p[0] == 'A' || p[0] == 'E') && p[1] == '1') || (p[0] == 'P' && NUMERIC(p[1])) )) break;
+    switch (p[0]) {
+      case 'A': hasA = true; break;
+      case 'E': hasE = true; break;
+      #if HAS_MULTI_SERIAL
+        case 'P': port = p[1] - '0'; break;
+      #endif
+    }
+    p += 2;
+    while (*p == ' ') ++p;
+  }
+
+  #if HAS_MULTI_SERIAL
+    const int8_t old_serial = multiSerial.portMask;
+    if (WITHIN(port, 0, NUM_SERIAL))
+      multiSerial.portMask = port ? _BV(port - 1) : SERIAL_ALL;
+  #endif
+
+  if (hasE) SERIAL_ECHO_START();
+  if (hasA) SERIAL_ECHOPGM("//");
+  SERIAL_ECHOLN(p);
+
+  TERN_(HAS_MULTI_SERIAL, multiSerial.portMask = old_serial);
+}