--- /dev/null
+/*----------------------------------------------------------------------------\r
+ * U S B - K e r n e l\r
+ *----------------------------------------------------------------------------\r
+ * Name: usbhw.c\r
+ * Purpose: USB Hardware Layer Module for NXP's LPC17xx MCU\r
+ * Version: V1.20\r
+ *----------------------------------------------------------------------------\r
+ * This software is supplied "AS IS" without any warranties, express,\r
+ * implied or statutory, including but not limited to the implied\r
+ * warranties of fitness for purpose, satisfactory quality and\r
+ * noninfringement. Keil extends you a royalty-free right to reproduce\r
+ * and distribute executable files created using this software for use\r
+ * on NXP Semiconductors LPC family microcontroller devices only. Nothing \r
+ * else gives you the right to use this software.\r
+ *\r
+ * Copyright (c) 2009 Keil - An ARM Company. All rights reserved.\r
+ *----------------------------------------------------------------------------\r
+ * History:\r
+ * V1.20 Added USB_ClearEPBuf\r
+ * V1.00 Initial Version\r
+ *----------------------------------------------------------------------------*/\r
+#include "../LPC17xx.h" /* LPC17xx definitions */\r
+#include "usb.h"\r
+#include "usbcfg.h"\r
+#include "usbreg.h"\r
+#include "usbhw.h"\r
+#include "usbcore.h"\r
+#include "usbuser.h"\r
+\r
+#if defined ( __CC_ARM__ )\r
+#pragma diag_suppress 1441\r
+#endif\r
+\r
+\r
+#define EP_MSK_CTRL 0x0001 /* Control Endpoint Logical Address Mask */\r
+#define EP_MSK_BULK 0xC924 /* Bulk Endpoint Logical Address Mask */\r
+#define EP_MSK_INT 0x4492 /* Interrupt Endpoint Logical Address Mask */\r
+#define EP_MSK_ISO 0x1248 /* Isochronous Endpoint Logical Address Mask */\r
+\r
+\r
+#if USB_DMA\r
+\r
+#pragma arm section zidata = "USB_RAM"\r
+uint32_t UDCA[USB_EP_NUM]; /* UDCA in USB RAM */\r
+uint32_t DD_NISO_Mem[4*DD_NISO_CNT]; /* Non-Iso DMA Descriptor Memory */\r
+uint32_t DD_ISO_Mem [5*DD_ISO_CNT]; /* Iso DMA Descriptor Memory */\r
+#pragma arm section zidata\r
+uint32_t udca[USB_EP_NUM]; /* UDCA saved values */\r
+\r
+uint32_t DDMemMap[2]; /* DMA Descriptor Memory Usage */\r
+\r
+#endif\r
+\r
+\r
+/*\r
+ * Get Endpoint Physical Address\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: Endpoint Physical Address\r
+ */\r
+\r
+uint32_t EPAdr (uint32_t EPNum) {\r
+ uint32_t val;\r
+\r
+ val = (EPNum & 0x0F) << 1;\r
+ if (EPNum & 0x80) {\r
+ val += 1;\r
+ }\r
+ return (val);\r
+}\r
+\r
+\r
+/*\r
+ * Write Command\r
+ * Parameters: cmd: Command\r
+ * Return Value: None\r
+ */\r
+\r
+void WrCmd (uint32_t cmd) {\r
+\r
+ USB->USBDevIntClr = CCEMTY_INT;\r
+ USB->USBCmdCode = cmd;\r
+ while ((USB->USBDevIntSt & CCEMTY_INT) == 0);\r
+}\r
+\r
+\r
+/*\r
+ * Write Command Data\r
+ * Parameters: cmd: Command\r
+ * val: Data\r
+ * Return Value: None\r
+ */\r
+\r
+void WrCmdDat (uint32_t cmd, uint32_t val) {\r
+\r
+ USB->USBDevIntClr = CCEMTY_INT;\r
+ USB->USBCmdCode = cmd;\r
+ while ((USB->USBDevIntSt & CCEMTY_INT) == 0);\r
+ USB->USBDevIntClr = CCEMTY_INT;\r
+ USB->USBCmdCode = val;\r
+ while ((USB->USBDevIntSt & CCEMTY_INT) == 0);\r
+}\r
+\r
+\r
+/*\r
+ * Write Command to Endpoint\r
+ * Parameters: cmd: Command\r
+ * val: Data\r
+ * Return Value: None\r
+ */\r
+\r
+void WrCmdEP (uint32_t EPNum, uint32_t cmd){\r
+\r
+ USB->USBDevIntClr = CCEMTY_INT;\r
+ USB->USBCmdCode = CMD_SEL_EP(EPAdr(EPNum));\r
+ while ((USB->USBDevIntSt & CCEMTY_INT) == 0);\r
+ USB->USBDevIntClr = CCEMTY_INT;\r
+ USB->USBCmdCode = cmd;\r
+ while ((USB->USBDevIntSt & CCEMTY_INT) == 0);\r
+}\r
+\r
+\r
+/*\r
+ * Read Command Data\r
+ * Parameters: cmd: Command\r
+ * Return Value: Data Value\r
+ */\r
+\r
+uint32_t RdCmdDat (uint32_t cmd) {\r
+\r
+ USB->USBDevIntClr = CCEMTY_INT | CDFULL_INT;\r
+ USB->USBCmdCode = cmd;\r
+ while ((USB->USBDevIntSt & CDFULL_INT) == 0);\r
+ return (USB->USBCmdData);\r
+}\r
+\r
+\r
+/*\r
+ * USB Initialize Function\r
+ * Called by the User to initialize USB\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_Init (void) {\r
+\r
+ PINCON->PINSEL1 &= ~((3<<26)|(3<<28)); /* P0.29 D+, P0.30 D- */\r
+ PINCON->PINSEL1 |= ((1<<26)|(1<<28)); /* PINSEL1 26.27, 28.29 = 01 */\r
+\r
+ PINCON->PINSEL3 &= ~((3<< 4)|(3<<28)); /* P1.18 GoodLink, P1.30 VBUS */\r
+ PINCON->PINSEL3 |= ((1<< 4)|(2<<28)); /* PINSEL3 4.5 = 01, 28.29 = 10 */\r
+\r
+ PINCON->PINSEL4 &= ~((3<<18) ); /* P2.9 SoftConnect */\r
+ PINCON->PINSEL4 |= ((1<<18) ); /* PINSEL4 18.19 = 01 */\r
+\r
+ SC->PCONP |= (1UL<<31); /* USB PCLK -> enable USB Per. */\r
+\r
+ USB->USBClkCtrl = 0x1A; /* Dev, PortSel, AHB clock enable */\r
+ while ((USB->USBClkSt & 0x1A) != 0x1A); \r
+\r
+ NVIC_EnableIRQ(USB_IRQn); /* enable USB interrupt */\r
+\r
+ USB_Reset();\r
+ USB_SetAddress(0);\r
+}\r
+\r
+\r
+/*\r
+ * USB Connect Function\r
+ * Called by the User to Connect/Disconnect USB\r
+ * Parameters: con: Connect/Disconnect\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_Connect (uint32_t con) {\r
+ WrCmdDat(CMD_SET_DEV_STAT, DAT_WR_BYTE(con ? DEV_CON : 0));\r
+}\r
+\r
+\r
+/*\r
+ * USB Reset Function\r
+ * Called automatically on USB Reset\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_Reset (void) {\r
+#if USB_DMA\r
+ uint32_t n;\r
+#endif\r
+\r
+ USB->USBEpInd = 0;\r
+ USB->USBMaxPSize = USB_MAX_PACKET0;\r
+ USB->USBEpInd = 1;\r
+ USB->USBMaxPSize = USB_MAX_PACKET0;\r
+ while ((USB->USBDevIntSt & EP_RLZED_INT) == 0);\r
+\r
+ USB->USBEpIntClr = 0xFFFFFFFF;\r
+ USB->USBEpIntEn = 0xFFFFFFFF ^ USB_DMA_EP;\r
+ USB->USBDevIntClr = 0xFFFFFFFF;\r
+ USB->USBDevIntEn = DEV_STAT_INT | EP_SLOW_INT |\r
+ (USB_SOF_EVENT ? FRAME_INT : 0) |\r
+ (USB_ERROR_EVENT ? ERR_INT : 0);\r
+\r
+#if USB_DMA\r
+ USB->USBUDCAH = USB_RAM_ADR;\r
+ USB->USBDMARClr = 0xFFFFFFFF;\r
+ USB->USBEpDMADis = 0xFFFFFFFF;\r
+ USB->USBEpDMAEn = USB_DMA_EP;\r
+ USB->USBEoTIntClr = 0xFFFFFFFF;\r
+ USB->USBNDDRIntClr = 0xFFFFFFFF;\r
+ USB->USBSysErrIntClr = 0xFFFFFFFF;\r
+ USB->USBDMAIntEn = 0x00000007;\r
+ DDMemMap[0] = 0x00000000;\r
+ DDMemMap[1] = 0x00000000;\r
+ for (n = 0; n < USB_EP_NUM; n++) {\r
+ udca[n] = 0;\r
+ UDCA[n] = 0;\r
+ }\r
+#endif\r
+}\r
+\r
+\r
+/*\r
+ * USB Suspend Function\r
+ * Called automatically on USB Suspend\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_Suspend (void) {\r
+ /* Performed by Hardware */\r
+}\r
+\r
+\r
+/*\r
+ * USB Resume Function\r
+ * Called automatically on USB Resume\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_Resume (void) {\r
+ /* Performed by Hardware */\r
+}\r
+\r
+\r
+/*\r
+ * USB Remote Wakeup Function\r
+ * Called automatically on USB Remote Wakeup\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_WakeUp (void) {\r
+\r
+ if (USB_DeviceStatus & USB_GETSTATUS_REMOTE_WAKEUP) {\r
+ WrCmdDat(CMD_SET_DEV_STAT, DAT_WR_BYTE(DEV_CON));\r
+ }\r
+}\r
+\r
+\r
+/*\r
+ * USB Remote Wakeup Configuration Function\r
+ * Parameters: cfg: Enable/Disable\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_WakeUpCfg (uint32_t cfg) {\r
+ /* Not needed */\r
+}\r
+\r
+\r
+/*\r
+ * USB Set Address Function\r
+ * Parameters: adr: USB Address\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_SetAddress (uint32_t adr) {\r
+ WrCmdDat(CMD_SET_ADDR, DAT_WR_BYTE(DEV_EN | adr)); /* Don't wait for next */\r
+ WrCmdDat(CMD_SET_ADDR, DAT_WR_BYTE(DEV_EN | adr)); /* Setup Status Phase */\r
+}\r
+\r
+\r
+/*\r
+ * USB Configure Function\r
+ * Parameters: cfg: Configure/Deconfigure\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_Configure (uint32_t cfg) {\r
+\r
+ WrCmdDat(CMD_CFG_DEV, DAT_WR_BYTE(cfg ? CONF_DVICE : 0));\r
+\r
+ USB->USBReEp = 0x00000003;\r
+ while ((USB->USBDevIntSt & EP_RLZED_INT) == 0);\r
+ USB->USBDevIntClr = EP_RLZED_INT;\r
+}\r
+\r
+\r
+/*\r
+ * Configure USB Endpoint according to Descriptor\r
+ * Parameters: pEPD: Pointer to Endpoint Descriptor\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_ConfigEP (USB_ENDPOINT_DESCRIPTOR *pEPD) {\r
+ uint32_t num;\r
+\r
+ num = EPAdr(pEPD->bEndpointAddress);\r
+ USB->USBReEp |= (1 << num);\r
+ USB->USBEpInd = num;\r
+ USB->USBMaxPSize = pEPD->wMaxPacketSize;\r
+ while ((USB->USBDevIntSt & EP_RLZED_INT) == 0);\r
+ USB->USBDevIntClr = EP_RLZED_INT;\r
+}\r
+\r
+\r
+/*\r
+ * Set Direction for USB Control Endpoint\r
+ * Parameters: dir: Out (dir == 0), In (dir <> 0)\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_DirCtrlEP (uint32_t dir) {\r
+ /* Not needed */\r
+}\r
+\r
+\r
+/*\r
+ * Enable USB Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_EnableEP (uint32_t EPNum) {\r
+ WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(0));\r
+}\r
+\r
+\r
+/*\r
+ * Disable USB Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_DisableEP (uint32_t EPNum) {\r
+ WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(EP_STAT_DA));\r
+}\r
+\r
+\r
+/*\r
+ * Reset USB Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_ResetEP (uint32_t EPNum) {\r
+ WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(0));\r
+}\r
+\r
+\r
+/*\r
+ * Set Stall for USB Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_SetStallEP (uint32_t EPNum) {\r
+ WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(EP_STAT_ST));\r
+}\r
+\r
+\r
+/*\r
+ * Clear Stall for USB Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_ClrStallEP (uint32_t EPNum) {\r
+ WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(0));\r
+}\r
+\r
+\r
+/*\r
+ * Clear USB Endpoint Buffer\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_ClearEPBuf (uint32_t EPNum) {\r
+ WrCmdEP(EPNum, CMD_CLR_BUF);\r
+}\r
+\r
+\r
+/*\r
+ * Read USB Endpoint Data\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * pData: Pointer to Data Buffer\r
+ * Return Value: Number of bytes read\r
+ */\r
+\r
+uint32_t USB_ReadEP (uint32_t EPNum, uint8_t *pData) {\r
+ uint32_t cnt, n;\r
+\r
+ USB->USBCtrl = ((EPNum & 0x0F) << 2) | CTRL_RD_EN;\r
+\r
+ do {\r
+ cnt = USB->USBRxPLen;\r
+ } while ((cnt & PKT_RDY) == 0);\r
+ cnt &= PKT_LNGTH_MASK;\r
+\r
+ for (n = 0; n < (cnt + 3) / 4; n++) {\r
+ *((__packed uint32_t *)pData) = USB->USBRxData;\r
+ pData += 4;\r
+ }\r
+ USB->USBCtrl = 0;\r
+\r
+ if (((EP_MSK_ISO >> EPNum) & 1) == 0) { /* Non-Isochronous Endpoint */\r
+ WrCmdEP(EPNum, CMD_CLR_BUF);\r
+ }\r
+\r
+ return (cnt);\r
+}\r
+\r
+\r
+/*\r
+ * Write USB Endpoint Data\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * pData: Pointer to Data Buffer\r
+ * cnt: Number of bytes to write\r
+ * Return Value: Number of bytes written\r
+ */\r
+\r
+uint32_t USB_WriteEP (uint32_t EPNum, uint8_t *pData, uint32_t cnt) {\r
+ uint32_t n;\r
+\r
+ USB->USBCtrl = ((EPNum & 0x0F) << 2) | CTRL_WR_EN;\r
+\r
+ USB->USBTxPLen = cnt;\r
+\r
+ for (n = 0; n < (cnt + 3) / 4; n++) {\r
+ USB->USBTxData = *((__packed uint32_t *)pData);\r
+ pData += 4;\r
+ }\r
+ USB->USBCtrl = 0;\r
+ WrCmdEP(EPNum, CMD_VALID_BUF);\r
+ return (cnt);\r
+}\r
+\r
+#if USB_DMA\r
+\r
+/* DMA Descriptor Memory Layout */\r
+const uint32_t DDAdr[2] = { DD_NISO_ADR, DD_ISO_ADR };\r
+const uint32_t DDSz [2] = { 16, 20 };\r
+\r
+\r
+/*\r
+ * Setup USB DMA Transfer for selected Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * pDD: Pointer to DMA Descriptor\r
+ * Return Value: TRUE - Success, FALSE - Error\r
+ */\r
+\r
+uint32_t USB_DMA_Setup(uint32_t EPNum, USB_DMA_DESCRIPTOR *pDD) {\r
+ uint32_t num, ptr, nxt, iso, n;\r
+\r
+ iso = pDD->Cfg.Type.IsoEP; /* Iso or Non-Iso Descriptor */\r
+ num = EPAdr(EPNum); /* Endpoint's Physical Address */\r
+\r
+ ptr = 0; /* Current Descriptor */\r
+ nxt = udca[num]; /* Initial Descriptor */\r
+ while (nxt) { /* Go through Descriptor List */\r
+ ptr = nxt; /* Current Descriptor */\r
+ if (!pDD->Cfg.Type.Link) { /* Check for Linked Descriptors */\r
+ n = (ptr - DDAdr[iso]) / DDSz[iso]; /* Descriptor Index */\r
+ DDMemMap[iso] &= ~(1 << n); /* Unmark Memory Usage */\r
+ }\r
+ nxt = *((uint32_t *)ptr); /* Next Descriptor */\r
+ }\r
+\r
+ for (n = 0; n < 32; n++) { /* Search for available Memory */\r
+ if ((DDMemMap[iso] & (1 << n)) == 0) {\r
+ break; /* Memory found */\r
+ }\r
+ }\r
+ if (n == 32) return (FALSE); /* Memory not available */\r
+\r
+ DDMemMap[iso] |= 1 << n; /* Mark Memory Usage */\r
+ nxt = DDAdr[iso] + n * DDSz[iso]; /* Next Descriptor */\r
+\r
+ if (ptr && pDD->Cfg.Type.Link) {\r
+ *((uint32_t *)(ptr + 0)) = nxt; /* Link in new Descriptor */\r
+ *((uint32_t *)(ptr + 4)) |= 0x00000004; /* Next DD is Valid */\r
+ } else {\r
+ udca[num] = nxt; /* Save new Descriptor */\r
+ UDCA[num] = nxt; /* Update UDCA in USB */\r
+ }\r
+\r
+ /* Fill in DMA Descriptor */\r
+ *(((uint32_t *)nxt)++) = 0; /* Next DD Pointer */\r
+ *(((uint32_t *)nxt)++) = pDD->Cfg.Type.ATLE |\r
+ (pDD->Cfg.Type.IsoEP << 4) |\r
+ (pDD->MaxSize << 5) |\r
+ (pDD->BufLen << 16);\r
+ *(((uint32_t *)nxt)++) = pDD->BufAdr;\r
+ *(((uint32_t *)nxt)++) = pDD->Cfg.Type.LenPos << 8;\r
+ if (iso) {\r
+ *((uint32_t *)nxt) = pDD->InfoAdr;\r
+ }\r
+\r
+ return (TRUE); /* Success */\r
+}\r
+\r
+\r
+/*\r
+ * Enable USB DMA Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_DMA_Enable (uint32_t EPNum) {\r
+ USB->USBEpDMAEn = 1 << EPAdr(EPNum);\r
+}\r
+\r
+\r
+/*\r
+ * Disable USB DMA Endpoint\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: None\r
+ */\r
+\r
+void USB_DMA_Disable (uint32_t EPNum) {\r
+ USB->USBEpDMADis = 1 << EPAdr(EPNum);\r
+}\r
+\r
+\r
+/*\r
+ * Get USB DMA Endpoint Status\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: DMA Status\r
+ */\r
+\r
+uint32_t USB_DMA_Status (uint32_t EPNum) {\r
+ uint32_t ptr, val;\r
+ \r
+ ptr = UDCA[EPAdr(EPNum)]; /* Current Descriptor */\r
+ if (ptr == 0) \r
+ return (USB_DMA_INVALID);\r
+\r
+ val = *((uint32_t *)(ptr + 3*4)); /* Status Information */\r
+ switch ((val >> 1) & 0x0F) {\r
+ case 0x00: /* Not serviced */\r
+ return (USB_DMA_IDLE);\r
+ case 0x01: /* Being serviced */\r
+ return (USB_DMA_BUSY);\r
+ case 0x02: /* Normal Completition */\r
+ return (USB_DMA_DONE);\r
+ case 0x03: /* Data Under Run */\r
+ return (USB_DMA_UNDER_RUN);\r
+ case 0x08: /* Data Over Run */\r
+ return (USB_DMA_OVER_RUN);\r
+ case 0x09: /* System Error */\r
+ return (USB_DMA_ERROR);\r
+ }\r
+\r
+ return (USB_DMA_UNKNOWN);\r
+}\r
+\r
+\r
+/*\r
+ * Get USB DMA Endpoint Current Buffer Address\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: DMA Address (or -1 when DMA is Invalid)\r
+ */\r
+\r
+uint32_t USB_DMA_BufAdr (uint32_t EPNum) {\r
+ uint32_t ptr, val;\r
+\r
+ ptr = UDCA[EPAdr(EPNum)]; /* Current Descriptor */\r
+ if (ptr == 0)\r
+ {\r
+ return ((uint32_t)(-1)); /* DMA Invalid */\r
+ }\r
+\r
+ val = *((uint32_t *)(ptr + 2*4)); /* Buffer Address */\r
+ return (val); /* Current Address */\r
+}\r
+\r
+\r
+/*\r
+ * Get USB DMA Endpoint Current Buffer Count\r
+ * Number of transfered Bytes or Iso Packets\r
+ * Parameters: EPNum: Endpoint Number\r
+ * EPNum.0..3: Address\r
+ * EPNum.7: Dir\r
+ * Return Value: DMA Count (or -1 when DMA is Invalid)\r
+ */\r
+\r
+uint32_t USB_DMA_BufCnt (uint32_t EPNum) {\r
+ uint32_t ptr, val;\r
+\r
+ ptr = UDCA[EPAdr(EPNum)]; /* Current Descriptor */\r
+ if (ptr == 0)\r
+ { \r
+ return ((uint32_t)(-1)); /* DMA Invalid */\r
+ }\r
+ val = *((uint32_t *)(ptr + 3*4)); /* Status Information */\r
+ return (val >> 16); /* Current Count */\r
+}\r
+\r
+\r
+#endif /* USB_DMA */\r
+\r
+\r
+/*\r
+ * Get USB Last Frame Number\r
+ * Parameters: None\r
+ * Return Value: Frame Number\r
+ */\r
+\r
+uint32_t USB_GetFrame (void) {\r
+ uint32_t val;\r
+\r
+ WrCmd(CMD_RD_FRAME);\r
+ val = RdCmdDat(DAT_RD_FRAME);\r
+ val = val | (RdCmdDat(DAT_RD_FRAME) << 8);\r
+\r
+ return (val);\r
+}\r
+\r
+\r
+/*\r
+ * USB Interrupt Service Routine\r
+ */\r
+\r
+void USB_IRQHandler (void) {\r
+ uint32_t disr, val, n, m;\r
+ uint32_t episr, episrCur;\r
+\r
+ disr = USB->USBDevIntSt; /* Device Interrupt Status */\r
+\r
+ /* Device Status Interrupt (Reset, Connect change, Suspend/Resume) */\r
+ if (disr & DEV_STAT_INT) {\r
+ USB->USBDevIntClr = DEV_STAT_INT;\r
+ WrCmd(CMD_GET_DEV_STAT);\r
+ val = RdCmdDat(DAT_GET_DEV_STAT); /* Device Status */\r
+ if (val & DEV_RST) { /* Reset */\r
+ USB_Reset();\r
+#if USB_RESET_EVENT\r
+ USB_Reset_Event();\r
+#endif\r
+ }\r
+ if (val & DEV_CON_CH) { /* Connect change */\r
+#if USB_POWER_EVENT\r
+ USB_Power_Event(val & DEV_CON);\r
+#endif\r
+ }\r
+ if (val & DEV_SUS_CH) { /* Suspend/Resume */\r
+ if (val & DEV_SUS) { /* Suspend */\r
+ USB_Suspend();\r
+#if USB_SUSPEND_EVENT\r
+ USB_Suspend_Event();\r
+#endif\r
+ } else { /* Resume */\r
+ USB_Resume();\r
+#if USB_RESUME_EVENT\r
+ USB_Resume_Event();\r
+#endif\r
+ }\r
+ }\r
+ goto isr_end;\r
+ }\r
+\r
+#if USB_SOF_EVENT\r
+ /* Start of Frame Interrupt */\r
+ if (disr & FRAME_INT) {\r
+ USB_SOF_Event();\r
+ }\r
+#endif\r
+\r
+#if USB_ERROR_EVENT\r
+ /* Error Interrupt */\r
+ if (disr & ERR_INT) {\r
+ WrCmd(CMD_RD_ERR_STAT);\r
+ val = RdCmdDat(DAT_RD_ERR_STAT);\r
+ USB_Error_Event(val);\r
+ }\r
+#endif\r
+\r
+ /* Endpoint's Slow Interrupt */\r
+ if (disr & EP_SLOW_INT) {\r
+ episrCur = 0;\r
+ episr = USB->USBEpIntSt;\r
+ for (n = 0; n < USB_EP_NUM; n++) { /* Check All Endpoints */\r
+ if (episr == episrCur) break; /* break if all EP interrupts handled */\r
+ if (episr & (1 << n)) {\r
+ episrCur |= (1 << n);\r
+ m = n >> 1;\r
+ \r
+ USB->USBEpIntClr = (1 << n);\r
+ while ((USB->USBDevIntSt & CDFULL_INT) == 0);\r
+ val = USB->USBCmdData;\r
+ \r
+ if ((n & 1) == 0) { /* OUT Endpoint */\r
+ if (n == 0) { /* Control OUT Endpoint */\r
+ if (val & EP_SEL_STP) { /* Setup Packet */\r
+ if (USB_P_EP[0]) {\r
+ USB_P_EP[0](USB_EVT_SETUP);\r
+ continue;\r
+ }\r
+ }\r
+ }\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_OUT);\r
+ }\r
+ } else { /* IN Endpoint */\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_IN);\r
+ }\r
+ }\r
+ }\r
+ }\r
+ USB->USBDevIntClr = EP_SLOW_INT;\r
+ }\r
+\r
+#if USB_DMA\r
+\r
+ if (USB->USBDMAIntSt & 0x00000001) { /* End of Transfer Interrupt */\r
+ val = USB->USBEoTIntSt;\r
+ for (n = 2; n < USB_EP_NUM; n++) { /* Check All Endpoints */\r
+ if (val & (1 << n)) {\r
+ m = n >> 1;\r
+ if ((n & 1) == 0) { /* OUT Endpoint */\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_OUT_DMA_EOT);\r
+ }\r
+ } else { /* IN Endpoint */\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_IN_DMA_EOT);\r
+ }\r
+ }\r
+ }\r
+ }\r
+ USB->USBEoTIntClr = val;\r
+ }\r
+\r
+ if (USB->USBDMAIntSt & 0x00000002) { /* New DD Request Interrupt */\r
+ val = USB->USBNDDRIntSt;\r
+ for (n = 2; n < USB_EP_NUM; n++) { /* Check All Endpoints */\r
+ if (val & (1 << n)) {\r
+ m = n >> 1;\r
+ if ((n & 1) == 0) { /* OUT Endpoint */\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_OUT_DMA_NDR);\r
+ }\r
+ } else { /* IN Endpoint */\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_IN_DMA_NDR);\r
+ }\r
+ }\r
+ }\r
+ }\r
+ USB->USBNDDRIntClr = val;\r
+ }\r
+\r
+ if (USB->USBDMAIntSt & 0x00000004) { /* System Error Interrupt */\r
+ val = USB->USBSysErrIntSt;\r
+ for (n = 2; n < USB_EP_NUM; n++) { /* Check All Endpoints */\r
+ if (val & (1 << n)) {\r
+ m = n >> 1;\r
+ if ((n & 1) == 0) { /* OUT Endpoint */\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_OUT_DMA_ERR);\r
+ }\r
+ } else { /* IN Endpoint */\r
+ if (USB_P_EP[m]) {\r
+ USB_P_EP[m](USB_EVT_IN_DMA_ERR);\r
+ }\r
+ }\r
+ }\r
+ }\r
+ USB->USBSysErrIntClr = val;\r
+ }\r
+\r
+#endif /* USB_DMA */\r
+\r
+isr_end:\r
+ return;\r
+}\r
git.asbjorn.biz / rapper.git / blobdiff