From e8701195e66f2d27ffe17fb514eae8173795aaf7 Mon Sep 17 00:00:00 2001
From: Georgiy Bondarenko <69736697+nehilo@users.noreply.github.com>
Date: Thu, 4 Mar 2021 22:54:23 +0500
Subject: Initial commit

---
 Marlin/src/sd/usb_flashdrive/lib-uhs2/message.cpp | 128 ++++++++++++++++++++++
 1 file changed, 128 insertions(+)
 create mode 100644 Marlin/src/sd/usb_flashdrive/lib-uhs2/message.cpp

(limited to 'Marlin/src/sd/usb_flashdrive/lib-uhs2/message.cpp')

diff --git a/Marlin/src/sd/usb_flashdrive/lib-uhs2/message.cpp b/Marlin/src/sd/usb_flashdrive/lib-uhs2/message.cpp
new file mode 100644
index 0000000..dcc3090
--- /dev/null
+++ b/Marlin/src/sd/usb_flashdrive/lib-uhs2/message.cpp
@@ -0,0 +1,128 @@
+/**
+ * Copyright (C) 2011 Circuits At Home, LTD. All rights reserved.
+ *
+ * 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 2 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, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ *
+ * Contact information
+ * -------------------
+ *
+ * Circuits At Home, LTD
+ * Web      :  https://www.circuitsathome.com
+ * e-mail   :  support@circuitsathome.com
+ */
+
+#include "../../../inc/MarlinConfigPre.h"
+
+#if ENABLED(USB_FLASH_DRIVE_SUPPORT) && DISABLED(USE_UHS3_USB)
+
+#include "Usb.h"
+
+// 0x80 is the default (i.e. trace) to turn off set this global to something lower.
+// this allows for 126 other debugging levels.
+// TO-DO: Allow assignment to a different serial port by software
+int UsbDEBUGlvl = 0x80;
+
+void E_Notifyc(char c, int lvl) {
+  if (UsbDEBUGlvl < lvl) return;
+  USB_HOST_SERIAL.print(c
+    #if !defined(ARDUINO) && !defined(ARDUINO_ARCH_LPC176X)
+      , BYTE
+    #endif
+  );
+  //USB_HOST_SERIAL.flush();
+}
+
+void E_Notify(char const * msg, int lvl) {
+  if (UsbDEBUGlvl < lvl) return;
+  if (!msg) return;
+  while (const char c = pgm_read_byte(msg++)) E_Notifyc(c, lvl);
+}
+
+void E_NotifyStr(char const * msg, int lvl) {
+  if (UsbDEBUGlvl < lvl) return;
+  if (!msg) return;
+  while (const char c = *msg++) E_Notifyc(c, lvl);
+}
+
+void E_Notify(uint8_t b, int lvl) {
+  if (UsbDEBUGlvl < lvl) return;
+  USB_HOST_SERIAL.print(b
+    #if !defined(ARDUINO) || ARDUINO < 100
+      , DEC
+    #endif
+  );
+  //USB_HOST_SERIAL.flush();
+}
+
+void E_Notify(double d, int lvl) {
+  if (UsbDEBUGlvl < lvl) return;
+  USB_HOST_SERIAL.print(d);
+  //USB_HOST_SERIAL.flush();
+}
+
+#ifdef DEBUG_USB_HOST
+
+  void NotifyFailGetDevDescr() {
+    Notify(PSTR("\r\ngetDevDescr "), 0x80);
+  }
+
+  void NotifyFailSetDevTblEntry() {
+    Notify(PSTR("\r\nsetDevTblEn "), 0x80);
+  }
+
+  void NotifyFailGetConfDescr() {
+    Notify(PSTR("\r\ngetConf "), 0x80);
+  }
+
+  void NotifyFailSetConfDescr() {
+    Notify(PSTR("\r\nsetConf "), 0x80);
+  }
+
+  void NotifyFailGetDevDescr(uint8_t reason) {
+    NotifyFailGetDevDescr();
+    NotifyFail(reason);
+  }
+
+  void NotifyFailSetDevTblEntry(uint8_t reason) {
+    NotifyFailSetDevTblEntry();
+    NotifyFail(reason);
+
+  }
+
+  void NotifyFailGetConfDescr(uint8_t reason) {
+    NotifyFailGetConfDescr();
+    NotifyFail(reason);
+  }
+
+  void NotifyFailSetConfDescr(uint8_t reason) {
+    NotifyFailSetConfDescr();
+    NotifyFail(reason);
+  }
+
+  void NotifyFailUnknownDevice(uint16_t VID, uint16_t PID) {
+    Notify(PSTR("\r\nUnknown Device Connected - VID: "), 0x80);
+    D_PrintHex<uint16_t > (VID, 0x80);
+    Notify(PSTR(" PID: "), 0x80);
+    D_PrintHex<uint16_t > (PID, 0x80);
+  }
+
+  void NotifyFail(uint8_t rcode) {
+    D_PrintHex<uint8_t > (rcode, 0x80);
+    Notify(PSTR("\r\n"), 0x80);
+  }
+
+#endif // DEBUG_USB_HOST
+
+#endif // USB_FLASH_DRIVE_SUPPORT
-- 
cgit v1.2.3