1 files changed, 145 insertions, 0 deletions
diff --git a/Marlin/src/sd/usb_flashdrive/lib-uhs2/parsetools.h b/Marlin/src/sd/usb_flashdrive/lib-uhs2/parsetools.h
new file mode 100644
index 0000000..403766d
--- /dev/null
+++ b/Marlin/src/sd/usb_flashdrive/lib-uhs2/parsetools.h
@@ -0,0 +1,145 @@
+/**
+ * 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
+ */
+#pragma once
+
+#ifndef _usb_h_
+  #error "Never include parsetools.h directly; include Usb.h instead"
+#endif
+
+struct MultiValueBuffer {
+  uint8_t valueSize;
+  void *pValue;
+} __attribute__((packed));
+
+class MultiByteValueParser {
+  uint8_t * pBuf;
+  uint8_t countDown;
+  uint8_t valueSize;
+
+public:
+
+  MultiByteValueParser() : pBuf(nullptr), countDown(0), valueSize(0) {
+  };
+
+  const uint8_t* GetBuffer() { return pBuf; }
+
+  void Initialize(MultiValueBuffer * const pbuf) {
+    pBuf = (uint8_t*)pbuf->pValue;
+    countDown = valueSize = pbuf->valueSize;
+  }
+
+  bool Parse(uint8_t **pp, uint16_t *pcntdn);
+};
+
+class ByteSkipper {
+  uint8_t *pBuf;
+  uint8_t nStage;
+  uint16_t countDown;
+
+public:
+
+  ByteSkipper() : pBuf(nullptr), nStage(0), countDown(0) {
+  }
+
+  void Initialize(MultiValueBuffer *pbuf) {
+    pBuf = (uint8_t*)pbuf->pValue;
+    countDown = 0;
+  }
+
+  bool Skip(uint8_t **pp, uint16_t *pcntdn, uint16_t bytes_to_skip) {
+    switch (nStage) {
+      case 0:
+        countDown = bytes_to_skip;
+        nStage++;
+      case 1:
+        for (; countDown && (*pcntdn); countDown--, (*pp)++, (*pcntdn)--);
+
+        if (!countDown)
+          nStage = 0;
+    }
+    return (!countDown);
+  }
+};
+
+// Pointer to a callback function triggered for each element of PTP array when used with PTPArrayParser
+typedef void (*PTP_ARRAY_EL_FUNC)(const MultiValueBuffer * const p, uint32_t count, const void *me);
+
+class PTPListParser {
+public:
+
+  enum ParseMode {
+    modeArray, modeRange/*, modeEnum*/
+  };
+
+private:
+  uint8_t nStage;
+  uint8_t enStage;
+
+  uint32_t arLen;
+  uint32_t arLenCntdn;
+
+  uint8_t lenSize; // size of the array length field in bytes
+  uint8_t valSize; // size of the array element in bytes
+
+  MultiValueBuffer *pBuf;
+
+  // The only parser for both size and array element parsing
+  MultiByteValueParser theParser;
+
+  uint8_t /*ParseMode*/ prsMode;
+
+public:
+
+  PTPListParser() :
+    nStage(0),
+    enStage(0),
+    arLen(0),
+    arLenCntdn(0),
+    lenSize(0),
+    valSize(0),
+    pBuf(nullptr),
+    prsMode(modeArray) {}
+  ;
+
+  void Initialize(const uint8_t len_size, const uint8_t val_size, MultiValueBuffer * const p, const uint8_t mode = modeArray) {
+    pBuf = p;
+    lenSize = len_size;
+    valSize = val_size;
+    prsMode = mode;
+
+    if (prsMode == modeRange) {
+      arLenCntdn = arLen = 3;
+      nStage = 2;
+    }
+    else {
+      arLenCntdn = arLen = 0;
+      nStage = 0;
+    }
+    enStage = 0;
+    theParser.Initialize(p);
+  }
+
+  bool Parse(uint8_t **pp, uint16_t *pcntdn, PTP_ARRAY_EL_FUNC pf, const void *me = nullptr);
+};