mirror of
https://github.com/dougg3/mac-rom-simm-programmer.git
synced 2024-12-01 19:50:18 +00:00
795 lines
23 KiB
C
795 lines
23 KiB
C
/**************************************************************************//**
|
|
* @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 <string.h>
|
|
#include "NuMicro.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 */
|
|
|
|
VENDOR_REQ g_USBD_pfnVendorRequest = NULL; /*!< USB Vendor Request Functional Pointer */
|
|
CLASS_REQ g_USBD_pfnClassRequest = NULL; /*!< USB Class Request Functional Pointer */
|
|
SET_INTERFACE_REQ g_USBD_pfnSetInterface = NULL; /*!< USB Set Interface Functional Pointer */
|
|
SET_CONFIG_CB g_USBD_pfnSetConfigCallback = NULL; /*!< USB Set configuration callback function 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.
|
|
* @param[in] pfnSetInterface USB Set Interface 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, SET_INTERFACE_REQ pfnSetInterface)
|
|
{
|
|
g_USBD_sINFO = param;
|
|
g_USBD_pfnClassRequest = pfnClassReq;
|
|
g_USBD_pfnSetInterface = pfnSetInterface;
|
|
|
|
/* 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_INT_FLDET | USBD_INT_WAKEUP);
|
|
|
|
/* Enable USB-related interrupts. */
|
|
USBD_ENABLE_INT(USBD_INT_BUS | USBD_INT_USB | USBD_INT_FLDET | USBD_INT_WAKEUP);
|
|
}
|
|
|
|
/**
|
|
* @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;
|
|
}
|
|
|
|
case REQ_VENDOR: /* Vendor */
|
|
{
|
|
if (g_USBD_pfnVendorRequest != NULL)
|
|
{
|
|
g_USBD_pfnVendorRequest();
|
|
}
|
|
|
|
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 BOS Descriptor */
|
|
case DESC_BOS:
|
|
{
|
|
if (g_USBD_sINFO->gu8BosDesc)
|
|
{
|
|
u32Len = USBD_Minimum(u32Len, LEN_BOS + LEN_DEVCAP);
|
|
USBD_PrepareCtrlIn((uint8_t *)g_USBD_sINFO->gu8BosDesc, u32Len);
|
|
}
|
|
else
|
|
{
|
|
USBD_SET_EP_STALL(EP0);
|
|
USBD_SET_EP_STALL(EP1);
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
/* Get HID Descriptor */
|
|
case DESC_HID:
|
|
{
|
|
/* CV3.0 HID Class Descriptor Test,
|
|
Need to indicate index of the HID Descriptor within gu8ConfigDescriptor, specifically HID Composite device. */
|
|
uint32_t u32ConfigDescOffset; /* u32ConfigDescOffset is configuration descriptor offset (HID descriptor start index) */
|
|
u32Len = USBD_Minimum(u32Len, LEN_HID);
|
|
DBG_PRINTF("Get HID desc, %d\n", u32Len);
|
|
|
|
u32ConfigDescOffset = g_USBD_sINFO->gu32ConfigHidDescIdx[g_USBD_au8SetupPacket[4]];
|
|
USBD_PrepareCtrlIn((uint8_t *)&g_USBD_sINFO->gu8ConfigDesc[u32ConfigDescOffset], u32Len);
|
|
|
|
break;
|
|
}
|
|
|
|
/* Get Report Descriptor */
|
|
case DESC_HID_RPT:
|
|
{
|
|
DBG_PRINTF("Get HID report, %d\n", u32Len);
|
|
|
|
if (u32Len > g_USBD_sINFO->gu32HidReportSize[g_USBD_au8SetupPacket[4]])
|
|
{
|
|
u32Len = g_USBD_sINFO->gu32HidReportSize[g_USBD_au8SetupPacket[4]];
|
|
|
|
if ((u32Len % s_USBD_u32CtrlMaxPktSize) == 0ul)
|
|
{
|
|
s_USBD_u8CtrlInZeroFlag = (uint8_t)1ul;
|
|
}
|
|
}
|
|
|
|
USBD_PrepareCtrlIn((uint8_t *)g_USBD_sINFO->gu8HidReportDesc[g_USBD_au8SetupPacket[4]], 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];
|
|
|
|
if (g_USBD_pfnSetConfigCallback)
|
|
g_USBD_pfnSetConfigCallback();
|
|
|
|
/* 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];
|
|
|
|
if (g_USBD_pfnSetInterface != NULL)
|
|
{
|
|
g_USBD_pfnSetInterface(s_USBD_u32UsbAltInterface);
|
|
}
|
|
|
|
/* 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 USBD Set Vendor Request
|
|
*
|
|
* @param[in] pfnVendorReq Vendor Request Callback Function
|
|
*
|
|
*
|
|
* @details This function is used to set USBD vendor request callback function
|
|
*/
|
|
void USBD_SetVendorRequest(VENDOR_REQ pfnVendorReq)
|
|
{
|
|
g_USBD_pfnVendorRequest = pfnVendorReq;
|
|
}
|
|
|
|
/**
|
|
* @brief The callback function which called when get SET CONFIGURATION request
|
|
*
|
|
* @param[in] pfnSetConfigCallback Callback function pointer for SET CONFIGURATION request
|
|
*
|
|
*
|
|
* @details This function is used to set the callback function which will be called at SET CONFIGURATION request.
|
|
*/
|
|
void USBD_SetConfigCallback(SET_CONFIG_CB pfnSetConfigCallback)
|
|
{
|
|
g_USBD_pfnSetConfigCallback = pfnSetConfigCallback;
|
|
}
|
|
|
|
|
|
/**
|
|
* @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. ***/
|