618 lines
		
	
	
	
		
			20 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			618 lines
		
	
	
	
		
			20 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
| /* 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(__HIDBOOT_H__)
 | |
| #define __HIDBOOT_H__
 | |
| 
 | |
| #include "hid.h"
 | |
| 
 | |
| #define UHS_HID_BOOT_KEY_ZERO           0x27
 | |
| #define UHS_HID_BOOT_KEY_ENTER          0x28
 | |
| #define UHS_HID_BOOT_KEY_SPACE          0x2c
 | |
| #define UHS_HID_BOOT_KEY_CAPS_LOCK      0x39
 | |
| #define UHS_HID_BOOT_KEY_SCROLL_LOCK    0x47
 | |
| #define UHS_HID_BOOT_KEY_NUM_LOCK       0x53
 | |
| #define UHS_HID_BOOT_KEY_ZERO2          0x62
 | |
| #define UHS_HID_BOOT_KEY_PERIOD         0x63
 | |
| 
 | |
| // Don't worry, GCC will optimize the result to a final value.
 | |
| #define bitsEndpoints(p) ((((p) & HID_PROTOCOL_KEYBOARD)? 2 : 0) | (((p) & HID_PROTOCOL_MOUSE)? 1 : 0))
 | |
| #define totalEndpoints(p) ((bitsEndpoints(p) == 3) ? 3 : 2)
 | |
| #define epMUL(p) ((((p) & HID_PROTOCOL_KEYBOARD)? 1 : 0) + (((p) & HID_PROTOCOL_MOUSE)? 1 : 0))
 | |
| 
 | |
| // Already defined in hid.h
 | |
| // #define HID_MAX_HID_CLASS_DESCRIPTORS 5
 | |
| 
 | |
| struct MOUSEINFO {
 | |
| 
 | |
|         struct {
 | |
|                 uint8_t bmLeftButton : 1;
 | |
|                 uint8_t bmRightButton : 1;
 | |
|                 uint8_t bmMiddleButton : 1;
 | |
|                 uint8_t bmDummy : 5;
 | |
|         };
 | |
|         int8_t dX;
 | |
|         int8_t dY;
 | |
| };
 | |
| 
 | |
| class MouseReportParser : public HIDReportParser {
 | |
| 
 | |
|         union {
 | |
|                 MOUSEINFO mouseInfo;
 | |
|                 uint8_t bInfo[sizeof (MOUSEINFO)];
 | |
|         } prevState;
 | |
| 
 | |
| public:
 | |
|         void Parse(HID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf);
 | |
| 
 | |
| protected:
 | |
| 
 | |
|         virtual void OnMouseMove(MOUSEINFO *mi) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnLeftButtonUp(MOUSEINFO *mi) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnLeftButtonDown(MOUSEINFO *mi) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnRightButtonUp(MOUSEINFO *mi) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnRightButtonDown(MOUSEINFO *mi) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnMiddleButtonUp(MOUSEINFO *mi) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnMiddleButtonDown(MOUSEINFO *mi) {
 | |
|         };
 | |
| };
 | |
| 
 | |
| struct MODIFIERKEYS {
 | |
|         uint8_t bmLeftCtrl : 1;
 | |
|         uint8_t bmLeftShift : 1;
 | |
|         uint8_t bmLeftAlt : 1;
 | |
|         uint8_t bmLeftGUI : 1;
 | |
|         uint8_t bmRightCtrl : 1;
 | |
|         uint8_t bmRightShift : 1;
 | |
|         uint8_t bmRightAlt : 1;
 | |
|         uint8_t bmRightGUI : 1;
 | |
| };
 | |
| 
 | |
| struct KBDINFO {
 | |
| 
 | |
|         struct {
 | |
|                 uint8_t bmLeftCtrl : 1;
 | |
|                 uint8_t bmLeftShift : 1;
 | |
|                 uint8_t bmLeftAlt : 1;
 | |
|                 uint8_t bmLeftGUI : 1;
 | |
|                 uint8_t bmRightCtrl : 1;
 | |
|                 uint8_t bmRightShift : 1;
 | |
|                 uint8_t bmRightAlt : 1;
 | |
|                 uint8_t bmRightGUI : 1;
 | |
|         };
 | |
|         uint8_t bReserved;
 | |
|         uint8_t Keys[6];
 | |
| };
 | |
| 
 | |
| struct KBDLEDS {
 | |
|         uint8_t bmNumLock : 1;
 | |
|         uint8_t bmCapsLock : 1;
 | |
|         uint8_t bmScrollLock : 1;
 | |
|         uint8_t bmCompose : 1;
 | |
|         uint8_t bmKana : 1;
 | |
|         uint8_t bmReserved : 3;
 | |
| };
 | |
| 
 | |
| class KeyboardReportParser : public HIDReportParser {
 | |
|         static const uint8_t numKeys[10];
 | |
|         static const uint8_t symKeysUp[12];
 | |
|         static const uint8_t symKeysLo[12];
 | |
|         static const uint8_t padKeys[5];
 | |
| 
 | |
| protected:
 | |
| 
 | |
|         union {
 | |
|                 KBDINFO kbdInfo;
 | |
|                 uint8_t bInfo[sizeof (KBDINFO)];
 | |
|         } prevState;
 | |
| 
 | |
|         union {
 | |
|                 KBDLEDS kbdLeds;
 | |
|                 uint8_t bLeds;
 | |
|         } kbdLockingKeys;
 | |
| 
 | |
|         uint8_t OemToAscii(uint8_t mod, uint8_t key);
 | |
| 
 | |
| public:
 | |
| 
 | |
|         KeyboardReportParser() {
 | |
|                 kbdLockingKeys.bLeds = 0;
 | |
|         };
 | |
| 
 | |
|         void Parse(HID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf);
 | |
| 
 | |
| protected:
 | |
| 
 | |
|         virtual uint8_t HandleLockingKeys(HID* hid, uint8_t key) {
 | |
|                 uint8_t old_keys = kbdLockingKeys.bLeds;
 | |
| 
 | |
|                 switch(key) {
 | |
|                         case UHS_HID_BOOT_KEY_NUM_LOCK:
 | |
|                                 kbdLockingKeys.kbdLeds.bmNumLock = ~kbdLockingKeys.kbdLeds.bmNumLock;
 | |
|                                 break;
 | |
|                         case UHS_HID_BOOT_KEY_CAPS_LOCK:
 | |
|                                 kbdLockingKeys.kbdLeds.bmCapsLock = ~kbdLockingKeys.kbdLeds.bmCapsLock;
 | |
|                                 break;
 | |
|                         case UHS_HID_BOOT_KEY_SCROLL_LOCK:
 | |
|                                 kbdLockingKeys.kbdLeds.bmScrollLock = ~kbdLockingKeys.kbdLeds.bmScrollLock;
 | |
|                                 break;
 | |
|                 }
 | |
| 
 | |
|                 if(old_keys != kbdLockingKeys.bLeds && hid)
 | |
|                         return (hid->SetReport(0, 0/*hid->GetIface()*/, 2, 0, 1, &kbdLockingKeys.bLeds));
 | |
| 
 | |
|                 return 0;
 | |
|         };
 | |
| 
 | |
|         virtual void OnControlKeysChanged(uint8_t before, uint8_t after) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnKeyDown(uint8_t mod, uint8_t key) {
 | |
|         };
 | |
| 
 | |
|         virtual void OnKeyUp(uint8_t mod, uint8_t key) {
 | |
|         };
 | |
| 
 | |
|         virtual const uint8_t *getNumKeys() {
 | |
|                 return numKeys;
 | |
|         };
 | |
| 
 | |
|         virtual const uint8_t *getSymKeysUp() {
 | |
|                 return symKeysUp;
 | |
|         };
 | |
| 
 | |
|         virtual const uint8_t *getSymKeysLo() {
 | |
|                 return symKeysLo;
 | |
|         };
 | |
| 
 | |
|         virtual const uint8_t *getPadKeys() {
 | |
|                 return padKeys;
 | |
|         };
 | |
| };
 | |
| 
 | |
| template <const uint8_t BOOT_PROTOCOL>
 | |
| class HIDBoot : public HID //public USBDeviceConfig, public UsbConfigXtracter
 | |
| {
 | |
|         EpInfo epInfo[totalEndpoints(BOOT_PROTOCOL)];
 | |
|         HIDReportParser *pRptParser[epMUL(BOOT_PROTOCOL)];
 | |
| 
 | |
|         uint8_t bConfNum; // configuration number
 | |
|         uint8_t bIfaceNum; // Interface Number
 | |
|         uint8_t bNumIface; // number of interfaces in the configuration
 | |
|         uint8_t bNumEP; // total number of EP in the configuration
 | |
|         uint32_t qNextPollTime; // next poll time
 | |
|         bool bPollEnable; // poll enable flag
 | |
|         uint8_t bInterval; // largest interval
 | |
| 
 | |
|         void Initialize();
 | |
| 
 | |
|         virtual HIDReportParser* GetReportParser(uint8_t id) {
 | |
|                 return pRptParser[id];
 | |
|         };
 | |
| 
 | |
| public:
 | |
|         HIDBoot(USB *p);
 | |
| 
 | |
|         virtual bool SetReportParser(uint8_t id, HIDReportParser *prs) {
 | |
|                 pRptParser[id] = prs;
 | |
|                 return true;
 | |
|         };
 | |
| 
 | |
|         // USBDeviceConfig implementation
 | |
|         uint8_t Init(uint8_t parent, uint8_t port, bool lowspeed);
 | |
|         uint8_t Release();
 | |
|         uint8_t Poll();
 | |
| 
 | |
|         virtual uint8_t GetAddress() {
 | |
|                 return bAddress;
 | |
|         };
 | |
| 
 | |
|         virtual bool isReady() {
 | |
|                 return bPollEnable;
 | |
|         };
 | |
| 
 | |
|         // UsbConfigXtracter implementation
 | |
|         // Method should be defined here if virtual.
 | |
|         virtual void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep);
 | |
| 
 | |
|         virtual bool DEVCLASSOK(uint8_t klass) {
 | |
|                 return (klass == USB_CLASS_HID);
 | |
|         }
 | |
| 
 | |
|         virtual bool DEVSUBCLASSOK(uint8_t subklass) {
 | |
|                 return (subklass == BOOT_PROTOCOL);
 | |
|         }
 | |
| };
 | |
| 
 | |
| template <const uint8_t BOOT_PROTOCOL>
 | |
| HIDBoot<BOOT_PROTOCOL>::HIDBoot(USB *p) :
 | |
| HID(p),
 | |
| qNextPollTime(0),
 | |
| bPollEnable(false) {
 | |
|         Initialize();
 | |
| 
 | |
|         for(int i = 0; i < epMUL(BOOT_PROTOCOL); i++) {
 | |
|                 pRptParser[i] = NULL;
 | |
|         }
 | |
|         if(pUsb)
 | |
|                 pUsb->RegisterDeviceClass(this);
 | |
| }
 | |
| 
 | |
| template <const uint8_t BOOT_PROTOCOL>
 | |
| void HIDBoot<BOOT_PROTOCOL>::Initialize() {
 | |
|         for(int i = 0; i < totalEndpoints(BOOT_PROTOCOL); i++) {
 | |
|                 epInfo[i].epAddr = 0;
 | |
|                 epInfo[i].maxPktSize = (i) ? 0 : 8;
 | |
|                 epInfo[i].epAttribs = 0;
 | |
|                 epInfo[i].bmNakPower = (i) ? USB_NAK_NOWAIT : USB_NAK_MAX_POWER;
 | |
|         }
 | |
|         bNumEP = 1;
 | |
|         bNumIface = 0;
 | |
|         bConfNum = 0;
 | |
| }
 | |
| 
 | |
| template <const uint8_t BOOT_PROTOCOL>
 | |
| uint8_t HIDBoot<BOOT_PROTOCOL>::Init(uint8_t parent, uint8_t port, bool lowspeed) {
 | |
|         const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR);
 | |
| 
 | |
|         uint8_t buf[constBufSize];
 | |
|         uint8_t rcode;
 | |
|         UsbDevice *p = NULL;
 | |
|         EpInfo *oldep_ptr = NULL;
 | |
|         uint8_t len = 0;
 | |
|         //uint16_t cd_len = 0;
 | |
| 
 | |
|         uint8_t num_of_conf; // number of configurations
 | |
|         //uint8_t num_of_intf; // number of interfaces
 | |
| 
 | |
|         AddressPool &addrPool = pUsb->GetAddressPool();
 | |
| 
 | |
|         USBTRACE("BM Init\r\n");
 | |
|         //USBTRACE2("totalEndpoints:", (uint8_t) (totalEndpoints(BOOT_PROTOCOL)));
 | |
|         //USBTRACE2("epMUL:", epMUL(BOOT_PROTOCOL));
 | |
| 
 | |
|         if(bAddress)
 | |
|                 return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE;
 | |
| 
 | |
|         bInterval = 0;
 | |
|         // Get pointer to pseudo device with address 0 assigned
 | |
|         p = addrPool.GetUsbDevicePtr(0);
 | |
| 
 | |
|         if(!p)
 | |
|                 return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL;
 | |
| 
 | |
|         if(!p->epinfo) {
 | |
|                 USBTRACE("epinfo\r\n");
 | |
|                 return USB_ERROR_EPINFO_IS_NULL;
 | |
|         }
 | |
| 
 | |
|         // Save old pointer to EP_RECORD of address 0
 | |
|         oldep_ptr = p->epinfo;
 | |
| 
 | |
|         // Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence
 | |
|         p->epinfo = epInfo;
 | |
| 
 | |
|         p->lowspeed = lowspeed;
 | |
| 
 | |
|         // Get device descriptor
 | |
|         rcode = pUsb->getDevDescr(0, 0, 8, (uint8_t*)buf);
 | |
| 
 | |
|         if(!rcode)
 | |
|                 len = (buf[0] > constBufSize) ? constBufSize : buf[0];
 | |
| 
 | |
|         if(rcode) {
 | |
|                 // Restore p->epinfo
 | |
|                 p->epinfo = oldep_ptr;
 | |
| 
 | |
|                 goto FailGetDevDescr;
 | |
|         }
 | |
| 
 | |
|         // Restore p->epinfo
 | |
|         p->epinfo = oldep_ptr;
 | |
| 
 | |
|         // Allocate new address according to device class
 | |
|         bAddress = addrPool.AllocAddress(parent, false, port);
 | |
| 
 | |
|         if(!bAddress)
 | |
|                 return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL;
 | |
| 
 | |
|         // Extract Max Packet Size from the device descriptor
 | |
|         epInfo[0].maxPktSize = (uint8_t)((USB_DEVICE_DESCRIPTOR*)buf)->bMaxPacketSize0;
 | |
| 
 | |
|         // Assign new address to the device
 | |
|         rcode = pUsb->setAddr(0, 0, bAddress);
 | |
| 
 | |
|         if(rcode) {
 | |
|                 p->lowspeed = false;
 | |
|                 addrPool.FreeAddress(bAddress);
 | |
|                 bAddress = 0;
 | |
|                 USBTRACE2("setAddr:", rcode);
 | |
|                 return rcode;
 | |
|         }
 | |
|         //delay(2); //per USB 2.0 sect.9.2.6.3
 | |
| 
 | |
|         USBTRACE2("Addr:", bAddress);
 | |
| 
 | |
|         p->lowspeed = false;
 | |
| 
 | |
|         p = addrPool.GetUsbDevicePtr(bAddress);
 | |
| 
 | |
|         if(!p)
 | |
|                 return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL;
 | |
| 
 | |
|         p->lowspeed = lowspeed;
 | |
| 
 | |
|         if(len)
 | |
|                 rcode = pUsb->getDevDescr(bAddress, 0, len, (uint8_t*)buf);
 | |
| 
 | |
|         if(rcode)
 | |
|                 goto FailGetDevDescr;
 | |
| 
 | |
|         num_of_conf = ((USB_DEVICE_DESCRIPTOR*)buf)->bNumConfigurations;
 | |
| 
 | |
|         USBTRACE2("NC:", num_of_conf);
 | |
| 
 | |
|         // GCC will optimize unused stuff away.
 | |
|         if((BOOT_PROTOCOL & (HID_PROTOCOL_KEYBOARD | HID_PROTOCOL_MOUSE)) == (HID_PROTOCOL_KEYBOARD | HID_PROTOCOL_MOUSE)) {
 | |
|                 USBTRACE("HID_PROTOCOL_KEYBOARD AND MOUSE\r\n");
 | |
|                 ConfigDescParser<
 | |
|                         USB_CLASS_HID,
 | |
|                         HID_BOOT_INTF_SUBCLASS,
 | |
|                         HID_PROTOCOL_KEYBOARD | HID_PROTOCOL_MOUSE,
 | |
|                         CP_MASK_COMPARE_ALL > confDescrParser(this);
 | |
|                 confDescrParser.SetOR(); // Use the OR variant.
 | |
|                 for(uint8_t i = 0; i < num_of_conf; i++) {
 | |
|                         pUsb->getConfDescr(bAddress, 0, i, &confDescrParser);
 | |
|                         if(bNumEP == (uint8_t)(totalEndpoints(BOOT_PROTOCOL)))
 | |
|                                 break;
 | |
|                 }
 | |
|         } else {
 | |
|                 // GCC will optimize unused stuff away.
 | |
|                 if(BOOT_PROTOCOL & HID_PROTOCOL_KEYBOARD) {
 | |
|                         USBTRACE("HID_PROTOCOL_KEYBOARD\r\n");
 | |
|                         for(uint8_t i = 0; i < num_of_conf; i++) {
 | |
|                                 ConfigDescParser<
 | |
|                                         USB_CLASS_HID,
 | |
|                                         HID_BOOT_INTF_SUBCLASS,
 | |
|                                         HID_PROTOCOL_KEYBOARD,
 | |
|                                         CP_MASK_COMPARE_ALL> confDescrParserA(this);
 | |
| 
 | |
|                                 pUsb->getConfDescr(bAddress, 0, i, &confDescrParserA);
 | |
|                                 if(bNumEP == (uint8_t)(totalEndpoints(BOOT_PROTOCOL)))
 | |
|                                         break;
 | |
|                         }
 | |
|                 }
 | |
| 
 | |
|                 // GCC will optimize unused stuff away.
 | |
|                 if(BOOT_PROTOCOL & HID_PROTOCOL_MOUSE) {
 | |
|                         USBTRACE("HID_PROTOCOL_MOUSE\r\n");
 | |
|                         for(uint8_t i = 0; i < num_of_conf; i++) {
 | |
|                                 ConfigDescParser<
 | |
|                                         USB_CLASS_HID,
 | |
|                                         HID_BOOT_INTF_SUBCLASS,
 | |
|                                         HID_PROTOCOL_MOUSE,
 | |
|                                         CP_MASK_COMPARE_ALL> confDescrParserB(this);
 | |
| 
 | |
|                                 pUsb->getConfDescr(bAddress, 0, i, &confDescrParserB);
 | |
|                                 if(bNumEP == ((uint8_t)(totalEndpoints(BOOT_PROTOCOL))))
 | |
|                                         break;
 | |
| 
 | |
|                         }
 | |
|                 }
 | |
|         }
 | |
|         USBTRACE2("bNumEP:", bNumEP);
 | |
| 
 | |
|         if(bNumEP != (uint8_t)(totalEndpoints(BOOT_PROTOCOL))) {
 | |
|                 rcode = USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED;
 | |
|                 goto Fail;
 | |
|         }
 | |
| 
 | |
|         // Assign epInfo to epinfo pointer
 | |
|         rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo);
 | |
|         //USBTRACE2("setEpInfoEntry returned ", rcode);
 | |
|         USBTRACE2("Cnf:", bConfNum);
 | |
| 
 | |
|         delay(1000);
 | |
| 
 | |
|         // Set Configuration Value
 | |
|         rcode = pUsb->setConf(bAddress, 0, bConfNum);
 | |
| 
 | |
|         if(rcode)
 | |
|                 goto FailSetConfDescr;
 | |
| 
 | |
|         delay(1000);
 | |
| 
 | |
|         USBTRACE2("bIfaceNum:", bIfaceNum);
 | |
|         USBTRACE2("bNumIface:", bNumIface);
 | |
| 
 | |
|         // Yes, mouse wants SetProtocol and SetIdle too!
 | |
|         for(uint8_t i = 0; i < epMUL(BOOT_PROTOCOL); i++) {
 | |
|                 USBTRACE2("\r\nInterface:", i);
 | |
|                 rcode = SetProtocol(i, HID_BOOT_PROTOCOL);
 | |
|                 if(rcode) goto FailSetProtocol;
 | |
|                 USBTRACE2("PROTOCOL SET HID_BOOT rcode:", rcode);
 | |
|                 rcode = SetIdle(i, 0, 0);
 | |
|                 USBTRACE2("SET_IDLE rcode:", rcode);
 | |
|                 // if(rcode) goto FailSetIdle; This can fail.
 | |
|                 // Get the RPIPE and just throw it away.
 | |
|                 SinkParser<USBReadParser, uint16_t, uint16_t> sink;
 | |
|                 rcode = GetReportDescr(i, &sink);
 | |
|                 USBTRACE2("RPIPE rcode:", rcode);
 | |
|         }
 | |
| 
 | |
|         // Get RPIPE and throw it away.
 | |
| 
 | |
|         if(BOOT_PROTOCOL & HID_PROTOCOL_KEYBOARD) {
 | |
|                 // Wake keyboard interface by twinkling up to 5 LEDs that are in the spec.
 | |
|                 // kana, compose, scroll, caps, num
 | |
|                 rcode = 0x20; // Reuse rcode.
 | |
|                 while(rcode) {
 | |
|                         rcode >>= 1;
 | |
|                         // Ignore any error returned, we don't care if LED is not supported
 | |
|                         SetReport(0, 0, 2, 0, 1, &rcode); // Eventually becomes zero (All off)
 | |
|                         delay(25);
 | |
|                 }
 | |
|         }
 | |
|         USBTRACE("BM configured\r\n");
 | |
| 
 | |
|         bPollEnable = true;
 | |
|         return 0;
 | |
| 
 | |
| FailGetDevDescr:
 | |
| #ifdef DEBUG_USB_HOST
 | |
|         NotifyFailGetDevDescr();
 | |
|         goto Fail;
 | |
| #endif
 | |
| 
 | |
|         //FailSetDevTblEntry:
 | |
|         //#ifdef DEBUG_USB_HOST
 | |
|         //        NotifyFailSetDevTblEntry();
 | |
|         //        goto Fail;
 | |
|         //#endif
 | |
| 
 | |
|         //FailGetConfDescr:
 | |
|         //#ifdef DEBUG_USB_HOST
 | |
|         //        NotifyFailGetConfDescr();
 | |
|         //        goto Fail;
 | |
|         //#endif
 | |
| 
 | |
| FailSetConfDescr:
 | |
| #ifdef DEBUG_USB_HOST
 | |
|         NotifyFailSetConfDescr();
 | |
|         goto Fail;
 | |
| #endif
 | |
| 
 | |
| FailSetProtocol:
 | |
| #ifdef DEBUG_USB_HOST
 | |
|         USBTRACE("SetProto:");
 | |
|         goto Fail;
 | |
| #endif
 | |
| 
 | |
|         //FailSetIdle:
 | |
|         //#ifdef DEBUG_USB_HOST
 | |
|         //        USBTRACE("SetIdle:");
 | |
|         //#endif
 | |
| 
 | |
| Fail:
 | |
| #ifdef DEBUG_USB_HOST
 | |
|         NotifyFail(rcode);
 | |
| #endif
 | |
|         Release();
 | |
| 
 | |
|         return rcode;
 | |
| }
 | |
| 
 | |
| template <const uint8_t BOOT_PROTOCOL>
 | |
| void HIDBoot<BOOT_PROTOCOL>::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *pep) {
 | |
| 
 | |
|         // If the first configuration satisfies, the others are not considered.
 | |
|         //if(bNumEP > 1 && conf != bConfNum)
 | |
|         if(bNumEP == totalEndpoints(BOOT_PROTOCOL))
 | |
|                 return;
 | |
| 
 | |
|         bConfNum = conf;
 | |
|         bIfaceNum = iface;
 | |
| 
 | |
|         if((pep->bmAttributes & 0x03) == 3 && (pep->bEndpointAddress & 0x80) == 0x80) {
 | |
|                 if(pep->bInterval > bInterval) bInterval = pep->bInterval;
 | |
| 
 | |
|                 // Fill in the endpoint info structure
 | |
|                 epInfo[bNumEP].epAddr = (pep->bEndpointAddress & 0x0F);
 | |
|                 epInfo[bNumEP].maxPktSize = (uint8_t)pep->wMaxPacketSize;
 | |
|                 epInfo[bNumEP].epAttribs = 0;
 | |
|                 epInfo[bNumEP].bmNakPower = USB_NAK_NOWAIT;
 | |
|                 bNumEP++;
 | |
| 
 | |
|         }
 | |
| }
 | |
| 
 | |
| template <const uint8_t BOOT_PROTOCOL>
 | |
| uint8_t HIDBoot<BOOT_PROTOCOL>::Release() {
 | |
|         pUsb->GetAddressPool().FreeAddress(bAddress);
 | |
| 
 | |
|         bConfNum = 0;
 | |
|         bIfaceNum = 0;
 | |
|         bNumEP = 1;
 | |
|         bAddress = 0;
 | |
|         qNextPollTime = 0;
 | |
|         bPollEnable = false;
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| template <const uint8_t BOOT_PROTOCOL>
 | |
| uint8_t HIDBoot<BOOT_PROTOCOL>::Poll() {
 | |
|         uint8_t rcode = 0;
 | |
| 
 | |
|         if(bPollEnable && ((long)(millis() - qNextPollTime) >= 0L)) {
 | |
| 
 | |
|                 // To-do: optimize manually, using the for loop only if needed.
 | |
|                 for(int i = 0; i < epMUL(BOOT_PROTOCOL); i++) {
 | |
|                         const uint16_t const_buff_len = 16;
 | |
|                         uint8_t buf[const_buff_len];
 | |
| 
 | |
|                         USBTRACE3("(hidboot.h) i=", i, 0x81);
 | |
|                         USBTRACE3("(hidboot.h) epInfo[epInterruptInIndex + i].epAddr=", epInfo[epInterruptInIndex + i].epAddr, 0x81);
 | |
|                         USBTRACE3("(hidboot.h) epInfo[epInterruptInIndex + i].maxPktSize=", epInfo[epInterruptInIndex + i].maxPktSize, 0x81);
 | |
|                         uint16_t read = (uint16_t)epInfo[epInterruptInIndex + i].maxPktSize;
 | |
| 
 | |
|                         rcode = pUsb->inTransfer(bAddress, epInfo[epInterruptInIndex + i].epAddr, &read, buf);
 | |
|                         // SOME buggy dongles report extra keys (like sleep) using a 2 byte packet on the wrong endpoint.
 | |
|                         // Since keyboard and mice must report at least 3 bytes, we ignore the extra data.
 | |
|                         if(!rcode && read > 2) {
 | |
|                                 if(pRptParser[i])
 | |
|                                         pRptParser[i]->Parse((HID*)this, 0, (uint8_t)read, buf);
 | |
| #ifdef DEBUG_USB_HOST
 | |
|                                 // We really don't care about errors and anomalies unless we are debugging.
 | |
|                         } else {
 | |
|                                 if(rcode != hrNAK) {
 | |
|                                         USBTRACE3("(hidboot.h) Poll:", rcode, 0x81);
 | |
|                                 }
 | |
|                                 if(!rcode && read) {
 | |
|                                         USBTRACE3("(hidboot.h) Strange read count: ", read, 0x80);
 | |
|                                         USBTRACE3("(hidboot.h) Interface:", i, 0x80);
 | |
|                                 }
 | |
|                         }
 | |
| 
 | |
|                         if(!rcode && read && (UsbDEBUGlvl > 0x7f)) {
 | |
|                                 for(uint8_t i = 0; i < read; i++) {
 | |
|                                         PrintHex<uint8_t > (buf[i], 0x80);
 | |
|                                         USBTRACE1(" ", 0x80);
 | |
|                                 }
 | |
|                                 if(read)
 | |
|                                         USBTRACE1("\r\n", 0x80);
 | |
| #endif
 | |
|                         }
 | |
| 
 | |
|                 }
 | |
|                 qNextPollTime = millis() + bInterval;
 | |
|         }
 | |
|         return rcode;
 | |
| }
 | |
| 
 | |
| #endif // __HIDBOOTMOUSE_H__
 | 
