rt-thread/bsp/synwit/swm341/libraries/SWM341_StdPeriph_Driver/SWM341_usbd.c

515 lines
17 KiB
C
Raw Normal View History

/******************************************************************************************************************************************
* : SWM341_usbd.c
* : SWM341单片机的USB设备功能驱动库
* : http://www.synwit.com.cn/e/tool/gbook/?bid=1
* :
* : V1.1.0 2020113
* :
*
*
*******************************************************************************************************************************************
* @attention
*
* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS WITH CODING INFORMATION
* REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME. AS A RESULT, SYNWIT SHALL NOT BE HELD LIABLE
* FOR ANY DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE CONTENT
* OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING INFORMATION CONTAINED HEREIN IN CONN-
* -ECTION WITH THEIR PRODUCTS.
*
* COPYRIGHT 2012 Synwit Technology
*******************************************************************************************************************************************/
#include <string.h>
#include "SWM341.h"
#include "SWM341_usbd.h"
USBD_Info_t USBD_Info;
static uint8_t *CtrlIn_Ptr = 0;
static uint8_t *CtrlOut_Ptr = 0;
static volatile uint32_t CtrlIn_Size = 0;
static volatile uint32_t CtrlOut_Size = 0;
static volatile uint32_t CtrlOut_Limit = 0;
/******************************************************************************************************************************************
* : USBD_Init()
* : USB Device
* :
* :
* :
******************************************************************************************************************************************/
void USBD_Init(void)
{
uint8_t ep_reg = 0, ep_nbr, ep_dir, ep_type, cfg, intf, alt;
uint16_t ep_pksz;
uint8_t *pCfg = USBD_Info.DescConfig;
uint32_t total_len = pCfg[2] + (pCfg[3] << 8);
uint32_t epie = 0x00010001;
SYS->USBCR = 0;
for(int i = 0; i < CyclesPerUs; i++) __NOP();
SYS->USBCR |= (1 << SYS_USBCR_RST48M_Pos); __DSB();
SYS->USBCR |= (1 << SYS_USBCR_RST12M_Pos); __DSB();
SYS->USBCR |= (1 << SYS_USBCR_RSTPLL_Pos); __DSB();
SYS->USBCR &= ~SYS_USBCR_ROLE_Msk;
SYS->USBCR |= (USBD_Info.Mode << SYS_USBCR_ROLE_Pos);
SYS->USBCR |= (1 << SYS_USBCR_VBUS_Pos);
SYS->CLKEN0 |= (0x01 << SYS_CLKEN0_USB_Pos);
USBD_EPConfig(ep_reg++, 0, USB_EP_IN, USB_EP_CTRL, USBD_Info.CtrlPkSiz, 0, 0, 0); // Control In
USBD_EPConfig(ep_reg++, 0, USB_EP_OUT, USB_EP_CTRL, USBD_Info.CtrlPkSiz, 0, 0, 0); // Control Out
while(pCfg < (USBD_Info.DescConfig + total_len))
{
switch(pCfg[1])
{
case USB_DESC_CONFIG:
cfg = pCfg[5];
break;
case USB_DESC_INTERFACE:
intf = pCfg[2];
alt = pCfg[3];
break;
case USB_DESC_ENDPOINT:
ep_nbr = pCfg[2] & 0x0F;
ep_dir = pCfg[2] & USB_EP_IN;
ep_type = pCfg[3] & 0x03;
ep_pksz = pCfg[4] + (pCfg[5] << 8);
USBD_EPConfig(ep_reg++, ep_nbr, ep_dir, ep_type, ep_pksz, cfg, intf, alt);
epie |= (1 << ep_nbr) << (ep_dir ? 0 : 16);
break;
}
pCfg += pCfg[0];
}
USBD->FFTHR = (0xFFF << 16) | (0x000 << 0); // 无用
USBD->DEVCR = (USBD_Info.Speed << USBD_DEVCR_SPEED_Pos) |
(1 << USBD_DEVCR_DEVICE_Pos) |
(1 << USBD_DEVCR_CSRDONE_Pos);
USBD->DEVIE = (1 << USBD_DEVIE_RST_Pos) |
(1 << USBD_DEVIE_SETUP_Pos) |
(1 << USBD_DEVIE_SETCFG_Pos);
USBD->EPIE = epie;
SYS->USBPHYCR &= ~SYS_USBPHYCR_OPMODE_Msk;
SYS->USBPHYCR |= (0 << SYS_USBPHYCR_OPMODE_Pos); //Normal Operation
}
/******************************************************************************************************************************************
* : USBD_EPConfig()
* : USB Device Endpoint Configure
* : uint8_t ep_reg Endpoint Register
* uint8_t ep_nbr Endpoint Number used by host
* uint8_t ep_dir Endpoint Direction, 0 Out 1 In
* uint8_t ep_type Endpoint Type, 0 Control 1 Isochronous 2 Bulk 3 Interrupt
* uint16_t ep_pksz Maximum packet size in byte
* uint8_t cfg Configuration number to which this endpoint belongs
* uint8_t intf Interface number to which this endpoint belongs
* uint8_t alt Alternate setting to which this endpoint belongs
* :
* :
******************************************************************************************************************************************/
void USBD_EPConfig(uint8_t ep_reg, uint8_t ep_nbr, uint8_t ep_dir, uint8_t ep_type, uint16_t ep_pksz, uint8_t cfg, uint8_t intf, uint8_t alt)
{
ep_dir = ep_dir ? 1 : 0; // for USB_EP_IN、USB_EP_OUT
USBD->EPCFG[ep_reg] = (ep_nbr << USBD_EPCFG_EPNR_Pos) |
(ep_dir << USBD_EPCFG_DIR_Pos) |
(ep_type << USBD_EPCFG_TYPE_Pos) |
(cfg << USBD_EPCFG_CFG_Pos) |
(intf << USBD_EPCFG_INTF_Pos) |
(alt << USBD_EPCFG_ALT_Pos) |
(ep_pksz << USBD_EPCFG_PKSZ_Pos);
if(ep_dir == USB_EP_OUT)
{
USBD->OUTEP[ep_nbr].RXCR = 0;
USBD->OUTEP[ep_nbr].RXCR = USBD_RXCR_FLUSHFF_Msk;
}
else
{
USBD->INEP[ep_nbr].TXCR = 0;
USBD->INEP[ep_nbr].TXCR = USBD_TXCR_FLUSHFF_Msk;
}
}
/******************************************************************************************************************************************
* : USBD_Open()
* : USB Device
* :
* :
* :
******************************************************************************************************************************************/
void USBD_Open(void)
{
NVIC_EnableIRQ(USB_IRQn);
}
/******************************************************************************************************************************************
* : USBD_Close()
* : USB Device
* :
* :
* :
******************************************************************************************************************************************/
void USBD_Close(void)
{
NVIC_DisableIRQ(USB_IRQn);
}
void USBD_StandardRequest(USB_Setup_Packet_t * pSetup);
void USBD_GetDescriptor(USB_Setup_Packet_t * pSetup);
static USB_Setup_Packet_t Setup_Packet;
USB_Setup_Packet_t * pUSB_Setup = &Setup_Packet;
/******************************************************************************************************************************************
* : USBD_ProcessSetupPacket()
* : Setup包
* :
* :
* :
******************************************************************************************************************************************/
void USBD_ProcessSetupPacket(void)
{
((volatile uint32_t *)pUSB_Setup)[0] = USBD->SETUPD1;
((volatile uint32_t *)pUSB_Setup)[1] = USBD->SETUPD2;
switch(pUSB_Setup->bRequestType & 0x60)
{
case USB_REQ_STANDARD:
USBD_StandardRequest(pUSB_Setup);
break;
case USB_REQ_CLASS:
if(USBD_Info.pClassRequest_Callback != NULL)
{
USBD_Info.pClassRequest_Callback(pUSB_Setup);
}
break;
case USB_REQ_VENDOR:
if(USBD_Info.pVendorRequest_Callback != NULL)
{
USBD_Info.pVendorRequest_Callback(pUSB_Setup);
}
break;
default:
/* Setup error, stall the device */
USBD_Stall0();
break;
}
}
/******************************************************************************************************************************************
* : USBD_StandardRequest()
* :
* :
* :
* : GetDescriptorSetDescriptorSyncFrame之外的标准命令USB模块自动处理
******************************************************************************************************************************************/
void USBD_StandardRequest(USB_Setup_Packet_t * pSetup)
{
if(pSetup->bRequestType & 0x80) // Device to host
{
switch(pSetup->bRequest)
{
case USB_GET_DESCRIPTOR:
USBD_GetDescriptor(pSetup);
/* Status stage */
USBD_RxReady(0);
break;
default:
/* Setup error, stall the device */
USBD_Stall0();
break;
}
}
else // Host to device
{
switch(pSetup->bRequest)
{
default:
/* Setup error, stall the device */
USBD_Stall0();
break;
}
}
}
/******************************************************************************************************************************************
* : USBD_GetDescriptor()
* : GetDescriptor
* :
* :
* :
******************************************************************************************************************************************/
void USBD_GetDescriptor(USB_Setup_Packet_t * pSetup)
{
#define min(a, b) ((a)<(b) ? (a) : (b))
switch(pSetup->wValue >> 8)
{
case USB_DESC_DEVICE:
USBD_PrepareCtrlIn(USBD_Info.DescDevice, min(pSetup->wLength, USBD_Info.DescDevice[0]));
break;
case USB_DESC_CONFIG:
{
uint16_t total_len = USBD_Info.DescConfig[2] + (USBD_Info.DescConfig[3] << 8);
USBD_PrepareCtrlIn(USBD_Info.DescConfig, min(pSetup->wLength, total_len));
break;
}
case USB_DESC_STRING:
{
uint8_t index = pSetup->wValue & 0xFF;
if(index < 6)
{
USBD_PrepareCtrlIn(USBD_Info.DescString[index], min(pSetup->wLength, USBD_Info.DescString[index][0]));
}
else if((index == 0xEE) && USBD_Info.DescOSString)
{
USBD_PrepareCtrlIn(USBD_Info.DescOSString, min(pSetup->wLength, USBD_Info.DescOSString[0]));
}
else
{
/* Not support. Reply STALL. */
USBD_Stall0();
}
break;
}
case USB_DESC_BOS:
{
uint16_t total_len = USBD_Info.DescBOS[2] + (USBD_Info.DescBOS[3] << 8);
USBD_PrepareCtrlIn(USBD_Info.DescBOS, min(pSetup->wLength, total_len));
break;
}
case USB_DESC_HID:
{
uint8_t index = pSetup->wIndex & 0xFF;
uint16_t offset = USBD_Info.DescHIDOffset[index];
uint8_t *descHID = &USBD_Info.DescConfig[offset];
USBD_PrepareCtrlIn(descHID, min(pSetup->wLength, descHID[0]));
break;
}
case USB_DESC_HID_RPT:
{
uint8_t index = pSetup->wIndex & 0xFF;
uint16_t offset = USBD_Info.DescHIDOffset[index];
uint8_t *descHID = &USBD_Info.DescConfig[offset];
uint16_t report_len = descHID[7] + (descHID[8] << 8);
USBD_PrepareCtrlIn(USBD_Info.DescHIDReport[index], min(pSetup->wLength, report_len));
break;
}
default:
/* Not support. Reply STALL.*/
USBD_Stall0();
break;
}
}
/******************************************************************************************************************************************
* : USBD_PrepareCtrlIn()
* : Prepare the first Control IN pipe
* :
* :
* :
******************************************************************************************************************************************/
void USBD_PrepareCtrlIn(uint8_t buf[], uint32_t size)
{
CtrlIn_Ptr = buf;
CtrlIn_Size = size;
USBD_CtrlIn();
}
/******************************************************************************************************************************************
* : USBD_CtrlIn()
* : Repeat Control IN pipe. This function processes the remained data of Control IN transfer
* :
* :
* :
******************************************************************************************************************************************/
void USBD_CtrlIn(void)
{
static uint8_t ZeroLenPk = 0;
if(CtrlIn_Size)
{
/* Process remained data */
if(CtrlIn_Size > USBD_Info.CtrlPkSiz)
{
USBD_TxWrite(0, CtrlIn_Ptr, USBD_Info.CtrlPkSiz);
CtrlIn_Ptr += USBD_Info.CtrlPkSiz;
CtrlIn_Size -= USBD_Info.CtrlPkSiz;
}
else
{
USBD_TxWrite(0, CtrlIn_Ptr, CtrlIn_Size);
if(CtrlIn_Size == USBD_Info.CtrlPkSiz)
{
ZeroLenPk = 1;
}
CtrlIn_Ptr = 0;
CtrlIn_Size = 0;
}
}
else
{
/* For the case of data size is integral times maximum packet size */
if(ZeroLenPk)
{
ZeroLenPk = 0;
USBD_TxWrite(0, 0, 0);
}
}
}
/******************************************************************************************************************************************
* : USBD_PrepareCtrlOut()
* : Prepare the first Control OUT pipe
* :
* :
* :
******************************************************************************************************************************************/
void USBD_PrepareCtrlOut(uint8_t *buf, uint32_t size)
{
CtrlOut_Ptr = buf;
CtrlOut_Size = 0u;
CtrlOut_Limit = size;
USBD_RxReady(0);
}
/******************************************************************************************************************************************
* : USBD_CtrlOut()
* : Repeat Control OUT pipe. This function processes the successive Control OUT transfer
* :
* :
* :
******************************************************************************************************************************************/
void USBD_CtrlOut(void)
{
if(CtrlOut_Size < CtrlOut_Limit)
{
uint16_t size = USBD_RxRead(CtrlOut_Ptr, CtrlOut_Limit - CtrlOut_Size);
CtrlOut_Ptr += size;
CtrlOut_Size += size;
if(CtrlOut_Size < CtrlOut_Limit)
{
USBD_RxReady(0);
}
}
}
/******************************************************************************************************************************************
* : USBD_TxWrite()
* : FIFO
* : uint8_t epnr endpoint number
* uint8_t *data FIFO的数据
* uint16_t size
* :
* :
******************************************************************************************************************************************/
void USBD_TxWrite(uint8_t epnr, uint8_t *data, uint16_t size)
{
__disable_irq();
USBD->INEP[epnr].TXCR = (1 << USBD_TXCR_FLUSHFF_Pos);
USBD->INEP[epnr].TXTRSZ = size;
if(size) USBD_memcpy((uint8_t *)USBD->TXBUF[epnr], data, size);
USBD->INEP[epnr].TXCR = (1 << USBD_TXCR_FFRDY_Pos);
__enable_irq();
}
/******************************************************************************************************************************************
* : USBD_RxRead()
* :
* : uint8_t *buff buff
* uint16_t size buff大小
* : uint16_t
* :
******************************************************************************************************************************************/
uint16_t USBD_RxRead(uint8_t *buff, uint16_t size)
{
__disable_irq();
uint16_t real_size = (USBD->RXSR & USBD_RXSR_TRSZ_Msk) >> USBD_RXSR_TRSZ_Pos;
if(size > real_size)
size = real_size;
USBD_memcpy(buff, (uint8_t *)USBD->RXBUF, size);
__enable_irq();
return size;
}
/******************************************************************************************************************************************
* : USBD_memcpy()
* : 访 USB Buffer memcpy
* : void *destin
* void *source
* uint32_t nByte
* :
* : 访 USB Buffer 使 USBD_memcpy使 memcpy
******************************************************************************************************************************************/
void USBD_memcpy(uint8_t *destin, uint8_t *source, uint32_t nByte)
{
while(nByte > 3)
{
*((uint32_t *)destin) = *((uint32_t *)source);
destin += 4;
source += 4;
nByte -= 4;
}
while(nByte > 1)
{
*((uint16_t *)destin) = *((uint16_t *)source);
destin += 2;
source += 2;
nByte -= 2;
}
while(nByte > 0)
{
*destin = *source;
destin += 1;
source += 1;
nByte -= 1;
}
}