/**************************************************************************//** * @file usbd.c * @version V0.10 * @brief M251 series USBD driver source file * * SPDX-License-Identifier: Apache-2.0 * @copyright (C) 2019 Nuvoton Technology Corp. All rights reserved. *****************************************************************************/ #include #include "NuMicro.h" #include "usbd.h" #if 0 #define DBG_PRINTF printf #else #define DBG_PRINTF(...) #endif #ifdef __cplusplus extern "C" { #endif /** @addtogroup Standard_Driver Standard Driver @{ */ /** @addtogroup USBD_Driver USBD Driver @{ */ /** @addtogroup USBD_EXPORTED_FUNCTIONS USBD Exported Functions @{ */ /* Global variables for Control Pipe */ uint8_t g_USBD_au8SetupPacket[8] = {0u}; /*!< Setup packet buffer */ volatile uint8_t g_USBD_u8RemoteWakeupEn = 0u; /*!< Remote wake up function enable flag */ /** * @cond HIDDEN_SYMBOLS */ static volatile uint8_t *s_USBD_pu8CtrlInPointer = 0ul; static volatile uint8_t *s_USBD_pu8CtrlOutPointer = 0ul; static volatile uint32_t s_USBD_u32CtrlInSize = 0ul; static volatile uint32_t s_USBD_u32CtrlOutSize = 0ul; static volatile uint32_t s_USBD_u32CtrlOutSizeLimit = 0ul; static volatile uint32_t s_USBD_u32UsbAddr = 0ul; static volatile uint32_t s_USBD_u32UsbConfig = 0ul; static volatile uint32_t s_USBD_u32CtrlMaxPktSize = 8ul; static volatile uint32_t s_USBD_u32UsbAltInterface = 0ul; static volatile uint8_t s_USBD_u8CtrlInZeroFlag = 0ul; static volatile uint32_t s_USBD_u32CtrlOutToggle = 0ul; /** * @endcond */ const S_USBD_INFO_T *g_USBD_sINFO; /*!< A pointer for USB information structure */ CLASS_REQ g_USBD_pfnClassRequest = NULL; /*!< USB Class Request Functional Pointer */ uint32_t g_USBD_u32EpStallLock = 0ul; /*!< Bit map flag to lock specified EP when SET_FEATURE */ /** * @brief This function makes USBD module to be ready to use * * @param[in] param The structure of USBD information. * @param[in] pfnClassReq USB Class request callback function. * * * @details This function will enable USB controller, USB PHY transceiver and pull-up resistor of USB_D+ pin. USB PHY will drive SE0 to bus. */ void USBD_Open(const S_USBD_INFO_T *param, CLASS_REQ pfnClassReq) { g_USBD_sINFO = param; g_USBD_pfnClassRequest = pfnClassReq; /* get EP0 maximum packet size */ s_USBD_u32CtrlMaxPktSize = g_USBD_sINFO->gu8DevDesc[7]; /* Initial USB engine */ #ifdef SUPPORT_LPM USBD->ATTR = 0x7D0UL | USBD_LPMACK; #else USBD->ATTR = 0x7D0UL; #endif /* Force SE0 */ USBD_SET_SE0(); } /** * @brief This function makes USB host to recognize the device * * * * @details Enable WAKEUP, FLDET, USB and BUS interrupts. Disable software-disconnect function after 100ms delay with SysTick timer. */ void USBD_Start(void) { /* Disable software-disconnect function */ USBD_CLR_SE0(); /* Clear USB-related interrupts before enable interrupt */ USBD_CLR_INT_FLAG(USBD_INT_BUS | USBD_INT_USB | USBD_INTEN_WKEN_Msk); /* Enable USB-related interrupts. */ USBD_ENABLE_INT(USBD_INT_BUS | USBD_INT_USB | USBD_INTEN_WKEN_Msk); } /** * @brief To support byte access between USB SRAM and system SRAM * * @param[in] dest Destination pointer. * * @param[in] src Source pointer. * * @param[in] size Byte count. * * * @details This function will copy the number of data specified by size and src parameters to the address specified by dest parameter. * */ void USBD_MemCopy(uint8_t *dest, uint8_t *src, uint32_t size) { while (size--) *dest++ = *src++; } /** * @brief Get the received SETUP packet * * @param[in] buf A buffer pointer used to store 8-byte SETUP packet. * * * @details Store SETUP packet to a user-specified buffer. * */ void USBD_GetSetupPacket(uint8_t *buf) { USBD_MemCopy(buf, g_USBD_au8SetupPacket, 8ul); } /** * @brief Process SETUP packet * * * * @details Parse SETUP packet and perform the corresponding action. * */ void USBD_ProcessSetupPacket(void) { s_USBD_u32CtrlOutToggle = 0; /* Get SETUP packet from USB buffer */ USBD_MemCopy(g_USBD_au8SetupPacket, (uint8_t *)USBD_BUF_BASE, 8ul); /* Check the request type */ switch (g_USBD_au8SetupPacket[0] & 0x60ul) { case REQ_STANDARD: /* Standard */ { USBD_StandardRequest(); break; } case REQ_CLASS: /* Class */ { if (g_USBD_pfnClassRequest != NULL) { g_USBD_pfnClassRequest(); } break; } default: /* reserved */ { /* Setup error, stall the device */ USBD_SET_EP_STALL(EP0); USBD_SET_EP_STALL(EP1); break; } } } /** * @brief Process GetDescriptor request * * * * @details Parse GetDescriptor request and perform the corresponding action. * */ void USBD_GetDescriptor(void) { uint32_t u32Len; s_USBD_u8CtrlInZeroFlag = (uint8_t)0ul; u32Len = 0ul; u32Len = g_USBD_au8SetupPacket[7]; u32Len <<= 8ul; u32Len += g_USBD_au8SetupPacket[6]; switch (g_USBD_au8SetupPacket[3]) { /* Get Device Descriptor */ case DESC_DEVICE: { u32Len = USBD_Minimum(u32Len, LEN_DEVICE); DBG_PRINTF("Get device desc, %d\n", u32Len); USBD_PrepareCtrlIn((uint8_t *)g_USBD_sINFO->gu8DevDesc, u32Len); break; } /* Get Configuration Descriptor */ case DESC_CONFIG: { uint32_t u32TotalLen; DBG_PRINTF("Get config desc len %d, acture len %d\n", u32Len, u32TotalLen); u32TotalLen = g_USBD_sINFO->gu8ConfigDesc[3]; u32TotalLen = g_USBD_sINFO->gu8ConfigDesc[2] + (u32TotalLen << 8U); DBG_PRINTF("Get config desc len %d, acture len %d\n", u32Len, u32TotalLen); if (u32Len > u32TotalLen) { u32Len = u32TotalLen; if ((u32Len % s_USBD_u32CtrlMaxPktSize) == 0ul) { s_USBD_u8CtrlInZeroFlag = (uint8_t)1ul; } } DBG_PRINTF("Minimum len %d\n", u32Len); USBD_PrepareCtrlIn((uint8_t *)g_USBD_sINFO->gu8ConfigDesc, u32Len); break; } /* Get String Descriptor */ case DESC_STRING: { /* Get String Descriptor */ if (g_USBD_au8SetupPacket[2] < 4ul) { if (u32Len > g_USBD_sINFO->gu8StringDesc[g_USBD_au8SetupPacket[2]][0]) { u32Len = g_USBD_sINFO->gu8StringDesc[g_USBD_au8SetupPacket[2]][0]; if ((u32Len % s_USBD_u32CtrlMaxPktSize) == 0ul) { s_USBD_u8CtrlInZeroFlag = (uint8_t)1ul; } } DBG_PRINTF("Get string desc %d\n", u32Len); USBD_PrepareCtrlIn((uint8_t *)g_USBD_sINFO->gu8StringDesc[g_USBD_au8SetupPacket[2]], u32Len); break; } else { /* Not support. Reply STALL. */ USBD_SET_EP_STALL(EP0); USBD_SET_EP_STALL(EP1); DBG_PRINTF("Unsupported string desc (%d). Stall ctrl pipe.\n", g_USBD_au8SetupPacket[2]); break; } } default: /* Not support. Reply STALL. */ USBD_SET_EP_STALL(EP0); USBD_SET_EP_STALL(EP1); DBG_PRINTF("Unsupported get desc type. stall ctrl pipe\n"); break; } } /** * @brief Process standard request * * * * @details Parse standard request and perform the corresponding action. * */ void USBD_StandardRequest(void) { DBG_PRINTF("USBD_StandardRequest\n"); /* clear global variables for new request */ s_USBD_pu8CtrlInPointer = 0ul; s_USBD_u32CtrlInSize = 0ul; if (g_USBD_au8SetupPacket[0] & 0x80ul) /* request data transfer direction */ { /* Device to host */ switch (g_USBD_au8SetupPacket[1]) { case GET_CONFIGURATION: { /* Return current configuration setting */ /* Data stage */ M8(USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0)) = (uint8_t)s_USBD_u32UsbConfig; USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 1ul); /* Status stage */ USBD_PrepareCtrlOut(0, 0ul); DBG_PRINTF("Get configuration\n"); break; } case GET_DESCRIPTOR: { USBD_GetDescriptor(); USBD_PrepareCtrlOut(0, 0ul); /* For status stage */ break; } case GET_INTERFACE: { /* Return current interface setting */ /* Data stage */ M8(USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0)) = (uint8_t)s_USBD_u32UsbAltInterface; USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 1ul); /* Status stage */ USBD_PrepareCtrlOut(0, 0ul); DBG_PRINTF("Get interface\n"); break; } case GET_STATUS: { /* Device */ if (g_USBD_au8SetupPacket[0] == 0x80ul) { uint8_t u8Tmp; u8Tmp = (uint8_t)0ul; if (g_USBD_sINFO->gu8ConfigDesc[7] & 0x40ul) u8Tmp |= (uint8_t)1ul; /* Self-Powered/Bus-Powered. */ if (g_USBD_sINFO->gu8ConfigDesc[7] & 0x20) u8Tmp |= (uint8_t)(g_USBD_u8RemoteWakeupEn << 1ul); /* Remote wake up */ M8(USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0)) = u8Tmp; } /* Interface */ else if (g_USBD_au8SetupPacket[0] == 0x81ul) M8(USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0)) = (uint8_t)0ul; /* Endpoint */ else if (g_USBD_au8SetupPacket[0] == 0x82ul) { uint8_t ep = (uint8_t)g_USBD_au8SetupPacket[4] & 0xFul; M8(USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0)) = (uint8_t)(USBD_GetStall(ep) ? 1ul : 0ul); } M8(USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0) + 1) = (uint8_t)0ul; /* Data stage */ USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 2ul); /* Status stage */ USBD_PrepareCtrlOut(0, 0ul); DBG_PRINTF("Get status\n"); break; } default: { /* Setup error, stall the device */ USBD_SET_EP_STALL(EP0); USBD_SET_EP_STALL(EP1); DBG_PRINTF("Unknown request. stall ctrl pipe.\n"); break; } } } else { /* Host to device */ switch (g_USBD_au8SetupPacket[1]) { case CLEAR_FEATURE: { if (g_USBD_au8SetupPacket[2] == FEATURE_ENDPOINT_HALT) { uint32_t epNum, i; /* EP number stall is not allow to be clear in MSC class "Error Recovery Test". a flag: g_USBD_u32EpStallLock is added to support it */ epNum = (uint8_t)(g_USBD_au8SetupPacket[4] & 0xFul); for (i = 0ul; i < USBD_MAX_EP; i++) { if (((USBD->EP[i].CFG & 0xFul) == epNum) && ((g_USBD_u32EpStallLock & (1ul << i)) == 0ul)) { USBD->EP[i].CFGP &= ~USBD_CFGP_SSTALL_Msk; USBD->EP[i].CFG &= ~USBD_CFG_DSQSYNC_Msk; DBG_PRINTF("Clr stall ep%d %x\n", i, USBD->EP[i].CFGP); } } } else if (g_USBD_au8SetupPacket[2] == FEATURE_DEVICE_REMOTE_WAKEUP) g_USBD_u8RemoteWakeupEn = (uint8_t)0; /* Status stage */ USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 0ul); DBG_PRINTF("Clear feature op %d\n", g_USBD_au8SetupPacket[2]); break; } case SET_ADDRESS: { s_USBD_u32UsbAddr = g_USBD_au8SetupPacket[2]; DBG_PRINTF("Set addr to %d\n", s_USBD_u32UsbAddr); /* DATA IN for end of setup */ /* Status Stage */ USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 0ul); break; } case SET_CONFIGURATION: { s_USBD_u32UsbConfig = g_USBD_au8SetupPacket[2]; /* Status stage */ USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 0ul); DBG_PRINTF("Set config to %d\n", s_USBD_u32UsbConfig); break; } case SET_FEATURE: { if (g_USBD_au8SetupPacket[2] == FEATURE_ENDPOINT_HALT) { USBD_SetStall((uint8_t)(g_USBD_au8SetupPacket[4] & 0xFul)); DBG_PRINTF("Set feature. stall ep %d\n", g_USBD_au8SetupPacket[4] & 0xFul); } else if (g_USBD_au8SetupPacket[2] == FEATURE_DEVICE_REMOTE_WAKEUP) { g_USBD_u8RemoteWakeupEn = (uint8_t)1ul; DBG_PRINTF("Set feature. enable remote wakeup\n"); } /* Status stage */ USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 0ul); break; } case SET_INTERFACE: { s_USBD_u32UsbAltInterface = g_USBD_au8SetupPacket[2]; /* Status stage */ USBD_SET_DATA1(EP0); USBD_SET_PAYLOAD_LEN(EP0, 0ul); DBG_PRINTF("Set interface to %d\n", s_USBD_u32UsbAltInterface); break; } default: { /* Setup error, stall the device */ USBD_SET_EP_STALL(EP0); USBD_SET_EP_STALL(EP1); DBG_PRINTF("Unsupported request. stall ctrl pipe.\n"); break; } } } } /** * @brief Prepare the first Control IN pipe * * @param[in] pu8Buf The pointer of data sent to USB host. * @param[in] u32Size The IN transfer size. * * * @details Prepare data for Control IN transfer. * */ void USBD_PrepareCtrlIn(uint8_t pu8Buf[], uint32_t u32Size) { DBG_PRINTF("Prepare Ctrl In %d\n", u32Size); if (u32Size > s_USBD_u32CtrlMaxPktSize) { // Data size > MXPLD s_USBD_pu8CtrlInPointer = pu8Buf + s_USBD_u32CtrlMaxPktSize; s_USBD_u32CtrlInSize = u32Size - s_USBD_u32CtrlMaxPktSize; USBD_SET_DATA1(EP0); USBD_MemCopy((uint8_t *)USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0), pu8Buf, s_USBD_u32CtrlMaxPktSize); USBD_SET_PAYLOAD_LEN(EP0, s_USBD_u32CtrlMaxPktSize); } else { // Data size <= MXPLD s_USBD_pu8CtrlInPointer = 0ul; s_USBD_u32CtrlInSize = 0ul; USBD_SET_DATA1(EP0); USBD_MemCopy((uint8_t *)USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0), pu8Buf, u32Size); USBD_SET_PAYLOAD_LEN(EP0, u32Size); } } /** * @brief Repeat Control IN pipe * * * * @details This function processes the remained data of Control IN transfer. * */ void USBD_CtrlIn(void) { DBG_PRINTF("Ctrl In Ack. residue %d\n", s_USBD_u32CtrlInSize); if (s_USBD_u32CtrlInSize) { // Process remained data if (s_USBD_u32CtrlInSize > s_USBD_u32CtrlMaxPktSize) { // Data size > MXPLD USBD_MemCopy((uint8_t *)USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0), (uint8_t *)s_USBD_pu8CtrlInPointer, s_USBD_u32CtrlMaxPktSize); USBD_SET_PAYLOAD_LEN(EP0, s_USBD_u32CtrlMaxPktSize); s_USBD_pu8CtrlInPointer += s_USBD_u32CtrlMaxPktSize; s_USBD_u32CtrlInSize -= s_USBD_u32CtrlMaxPktSize; } else { // Data size <= MXPLD USBD_MemCopy((uint8_t *)USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP0), (uint8_t *)s_USBD_pu8CtrlInPointer, s_USBD_u32CtrlInSize); USBD_SET_PAYLOAD_LEN(EP0, s_USBD_u32CtrlInSize); s_USBD_pu8CtrlInPointer = 0ul; s_USBD_u32CtrlInSize = 0ul; } } else // No more data for IN token { // In ACK for Set address if ((g_USBD_au8SetupPacket[0] == REQ_STANDARD) && (g_USBD_au8SetupPacket[1] == SET_ADDRESS)) { if ((USBD_GET_ADDR() != s_USBD_u32UsbAddr) && (USBD_GET_ADDR() == 0ul)) { USBD_SET_ADDR(s_USBD_u32UsbAddr); } } /* For the case of data size is integral times maximum packet size */ if (s_USBD_u8CtrlInZeroFlag) { USBD_SET_PAYLOAD_LEN(EP0, 0ul); s_USBD_u8CtrlInZeroFlag = (uint8_t)0ul; } DBG_PRINTF("Ctrl In done.\n"); } } /** * @brief Prepare the first Control OUT pipe * * @param[in] pu8Buf The pointer of data received from USB host. * @param[in] u32Size The OUT transfer size. * * * @details This function is used to prepare the first Control OUT transfer. * */ void USBD_PrepareCtrlOut(uint8_t *pu8Buf, uint32_t u32Size) { s_USBD_pu8CtrlOutPointer = pu8Buf; s_USBD_u32CtrlOutSize = 0ul; s_USBD_u32CtrlOutSizeLimit = u32Size; USBD_SET_PAYLOAD_LEN(EP1, s_USBD_u32CtrlMaxPktSize); } /** * @brief Repeat Control OUT pipe * * * * @details This function processes the successive Control OUT transfer. * */ void USBD_CtrlOut(void) { if (s_USBD_u32CtrlOutToggle != (USBD->EPSTS0 & 0xf0)) { s_USBD_u32CtrlOutToggle = USBD->EPSTS0 & 0xf0; //keep H/W EP1 toggle status if (s_USBD_u32CtrlOutSize < s_USBD_u32CtrlOutSizeLimit) { uint32_t u32Size; uint32_t addr; u32Size = USBD_GET_PAYLOAD_LEN(EP1); addr = USBD_BUF_BASE + USBD_GET_EP_BUF_ADDR(EP1); USBD_MemCopy((uint8_t *)s_USBD_pu8CtrlOutPointer, (uint8_t *)addr, u32Size); s_USBD_pu8CtrlOutPointer += u32Size; s_USBD_u32CtrlOutSize += u32Size; if (s_USBD_u32CtrlOutSize < s_USBD_u32CtrlOutSizeLimit) { USBD_SET_PAYLOAD_LEN(EP1, s_USBD_u32CtrlMaxPktSize); } } } else { USBD_SET_PAYLOAD_LEN(EP1, s_USBD_u32CtrlMaxPktSize); } } /** * @brief Reset software flags * * * * @details This function resets all variables for protocol and resets USB device address to 0. * */ void USBD_SwReset(void) { uint32_t i; // Reset all variables for protocol s_USBD_pu8CtrlInPointer = 0ul; s_USBD_u32CtrlInSize = 0ul; s_USBD_pu8CtrlOutPointer = 0ul; s_USBD_u32CtrlOutSize = 0ul; s_USBD_u32CtrlOutSizeLimit = 0ul; g_USBD_u32EpStallLock = 0ul; memset(g_USBD_au8SetupPacket, 0, 8ul); /* Reset PID DATA0 */ for (i = 0ul; i < USBD_MAX_EP; i++) USBD->EP[i].CFG &= ~USBD_CFG_DSQSYNC_Msk; // Reset USB device address USBD_SET_ADDR(0ul); } /** * @brief EP stall lock function to avoid stall clear by USB SET FEATURE request. * * @param[in] u32EpBitmap Use bitmap to select which endpoints will be locked * * * @details This function is used to lock relative endpoint to avoid stall clear by SET FEATURE request. * If ep stall locked, user needs to reset USB device or re-configure device to clear it. */ void USBD_LockEpStall(uint32_t u32EpBitmap) { g_USBD_u32EpStallLock = u32EpBitmap; } /** @} end of group USBD_EXPORTED_FUNCTIONS */ /** @} end of group USBD_Driver */ /** @} end of group Standard_Driver */ #ifdef __cplusplus } #endif /*** (C) COPYRIGHT 2019 Nuvoton Technology Corp. ***/