1 files changed, 140 insertions, 0 deletions

diff --git a/lib/usbhost/USB_Host_Shield_2.0/parsetools.h b/lib/usbhost/USB_Host_Shield_2.0/parsetools.h
new file mode 100644
index 000000000..66e9531c3
--- /dev/null
+++ b/lib/usbhost/USB_Host_Shield_2.0/parsetools.h
@@ -0,0 +1,140 @@
+/* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved.
+
+This software may be distributed and modified under the terms of the GNU
+General Public License version 2 (GPL2) as published by the Free Software
+Foundation and appearing in the file GPL2.TXT included in the packaging of
+this file. Please note that GPL2 Section 2[b] requires that all works based
+on this software must also be made publicly available under the terms of
+the GPL2 ("Copyleft").
+
+Contact information
+-------------------
+
+Circuits At Home, LTD
+Web      :  http://www.circuitsathome.com
+e-mail   :  support@circuitsathome.com
+ */
+
+#if !defined(_usb_h_) || defined(__PARSETOOLS_H__)
+#error "Never include parsetools.h directly; include Usb.h instead"
+#else
+#define __PARSETOOLS_H__
+
+struct MultiValueBuffer {
+        uint8_t valueSize;
+        void *pValue;
+} __attribute__((packed));
+
+class MultiByteValueParser {
+        uint8_t * pBuf;
+        uint8_t countDown;
+        uint8_t valueSize;
+
+public:
+
+        MultiByteValueParser() : pBuf(NULL), 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(NULL), 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(NULL),
+        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 = NULL);
+};
+
+#endif // __PARSETOOLS_H__