libs/rt-thread
libs
/
rt-thread
4
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
rt-thread/bsp/hc32/libraries/hc32_drivers/drv_usbd.c

905 lines
25 KiB
C
Raw Blame History

/*
* Copyright (C) 2022-2024, Xiaohua Semiconductor Co., Ltd.
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2023-02-14 CDT first version
*/
/*******************************************************************************
* Include files
******************************************************************************/
#include <rtthread.h>
#include <rtdevice.h>
#if defined(BSP_USING_USBD)
//#define DRV_DEBUG
#define LOG_TAG "drv.usbd"
#include <drv_log.h>
#include "board_config.h"
#include "irq_config.h"
#include "drv_usbd.h"
extern rt_err_t rt_hw_usb_board_init(void);
extern void rt_hw_us_delay(rt_uint32_t us);
static usb_core_instance _hc32_usbd;
static struct udcd _hc32_udc;
static struct ep_id _ep_pool[] =
{
{0x0, USB_EP_ATTR_CONTROL, USB_DIR_INOUT, 64, ID_ASSIGNED },
{0x1, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x1, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0x2, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x2, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0x3, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x3, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0x4, USB_EP_ATTR_INT, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x4, USB_EP_ATTR_INT, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0x5, USB_EP_ATTR_ISOC, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x5, USB_EP_ATTR_ISOC, USB_DIR_OUT, 64, ID_UNASSIGNED},
#if defined (HC32F4A0)
{0x6, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x6, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0x7, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x7, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0x8, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x8, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0x9, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0x9, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0xA, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
{0xA, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0xB, USB_EP_ATTR_INT, USB_DIR_IN, 64, ID_UNASSIGNED},
{0xB, USB_EP_ATTR_INT, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0xC, USB_EP_ATTR_INT, USB_DIR_IN, 64, ID_UNASSIGNED},
{0xC, USB_EP_ATTR_INT, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0xD, USB_EP_ATTR_INT, USB_DIR_IN, 64, ID_UNASSIGNED},
{0xD, USB_EP_ATTR_INT, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0xE, USB_EP_ATTR_ISOC, USB_DIR_IN, 64, ID_UNASSIGNED},
{0xE, USB_EP_ATTR_ISOC, USB_DIR_OUT, 64, ID_UNASSIGNED},
{0xF, USB_EP_ATTR_ISOC, USB_DIR_IN, 64, ID_UNASSIGNED},
{0xF, USB_EP_ATTR_ISOC, USB_DIR_OUT, 64, ID_UNASSIGNED},
#endif
{0xFF, USB_EP_ATTR_TYPE_MASK, USB_DIR_MASK, 0, ID_ASSIGNED },
};
void usb_udelay(const uint32_t usec)
{
rt_hw_us_delay(usec);
}
void usb_mdelay(const uint32_t msec)
{
rt_thread_mdelay(msec);
}
static void usb_opendevep(usb_core_instance *pdev, uint8_t ep_addr, uint16_t ep_mps, uint8_t ep_type)
{
USB_DEV_EP *ep;
__IO uint8_t tmp_1, tmp_2;
tmp_1 = ep_addr >> 7; /* EP type, it is IN(=1) or OUT(=0) */
tmp_2 = ep_addr & 0x7FU; /* EP number */
if (tmp_1 == 1U)
{
ep = &pdev->dev.in_ep[tmp_2];
}
else
{
ep = &pdev->dev.out_ep[tmp_2];
}
ep->epidx = tmp_2;
ep->ep_dir = tmp_1;
ep->maxpacket = ep_mps;
ep->trans_type = ep_type;
if (tmp_1 == 1U)
{
/* Assign a Tx FIFO */
ep->tx_fifo_num = tmp_2;
}
/* Set initial data PID. */
if (ep_type == EP_TYPE_BULK)
{
ep->data_pid_start = 0U;
}
usb_epactive(&pdev->regs, ep);
}
static void usb_shutdevep(usb_core_instance *pdev, uint8_t ep_addr)
{
USB_DEV_EP *ep;
__IO uint8_t tmp_1, tmp_2;
tmp_1 = ep_addr >> 7; /* EP type, it is IN(=1) or OUT(=0) */
tmp_2 = ep_addr & 0x7FU; /* EP number */
if (tmp_1 == 1U)
{
ep = &pdev->dev.in_ep[tmp_2];
}
else
{
ep = &pdev->dev.out_ep[tmp_2];
}
ep->epidx = tmp_2;
ep->ep_dir = tmp_1;
usb_epdeactive(&pdev->regs, ep);
}
static void usb_readytorx(usb_core_instance *pdev, uint8_t ep_addr, uint8_t *pbuf, uint16_t buf_len)
{
USB_DEV_EP *ep;
__IO uint8_t tmp_1;
tmp_1 = ep_addr & 0x7FU; /* EP number */
ep = &pdev->dev.out_ep[tmp_1];
/* setup and start the Xfer */
ep->xfer_buff = pbuf;
ep->xfer_len = (uint32_t)buf_len;
ep->xfer_count = 0UL;
ep->ep_dir = 0U;
ep->epidx = tmp_1;
if (pdev->basic_cfgs.dmaen == 1U)
{
ep->dma_addr = (uint32_t)pbuf;
}
if (tmp_1 == 0U)
{
usb_ep0transbegin(&pdev->regs, ep, pdev->basic_cfgs.dmaen);
}
else
{
usb_epntransbegin(&pdev->regs, ep, pdev->basic_cfgs.dmaen);
}
}
static void usb_deveptx(usb_core_instance *pdev, uint8_t ep_addr, uint8_t *pbuf, uint32_t buf_len)
{
USB_DEV_EP *ep;
__IO uint8_t tmp_1;
tmp_1 = ep_addr & 0x7FU; /* EP number */
ep = &pdev->dev.in_ep[tmp_1];
/* Setup and start the Transfer */
ep->ep_dir = 1U;
ep->epidx = tmp_1;
ep->xfer_buff = pbuf;
ep->dma_addr = (uint32_t)pbuf;
ep->xfer_count = 0UL;
ep->xfer_len = buf_len;
if (tmp_1 == 0U)
{
usb_ep0transbegin(&pdev->regs, ep, pdev->basic_cfgs.dmaen);
}
else
{
usb_epntransbegin(&pdev->regs, ep, pdev->basic_cfgs.dmaen);
}
}
static void usb_stalldevep(usb_core_instance *pdev, uint8_t epnum)
{
USB_DEV_EP *ep;
__IO uint8_t tmp_1, tmp_2;
tmp_1 = epnum >> 7; /* EP type, it is IN(=1) or OUT(=0) */
tmp_2 = epnum & 0x7FU; /* EP number */
if (tmp_1 != 0U)
{
ep = &pdev->dev.in_ep[tmp_2];
}
else
{
ep = &pdev->dev.out_ep[tmp_2];
}
ep->ep_stall = 1U;
ep->epidx = tmp_2;
if (tmp_1 != 0U)
{
ep->ep_dir = 1U;
}
else
{
ep->ep_dir = 0U;
}
usb_setepstall(&pdev->regs, ep);
}
static void usb_clrstall(usb_core_instance *pdev, uint8_t epnum)
{
USB_DEV_EP *ep;
__IO uint8_t tmp_1, tmp_2;
tmp_1 = epnum >> 7; /* EP type, it is IN(=1) or OUT(=0) */
tmp_2 = epnum & 0x7FU; /* EP number */
if (tmp_1 != 0U)
{
ep = &pdev->dev.in_ep[tmp_2];
}
else
{
ep = &pdev->dev.out_ep[tmp_2];
}
ep->ep_stall = 0U;
ep->epidx = tmp_2;
if (tmp_1 != 0U)
{
ep->ep_dir = 1U;
}
else
{
ep->ep_dir = 0U;
}
usb_clearepstall(&pdev->regs, ep);
}
static void usb_dev_rst(usb_core_instance *pdev)
{
usb_opendevep(pdev, 0x00U, USB_MAX_EP0_SIZE, EP_TYPE_CTRL);
usb_opendevep(pdev, 0x80U, USB_MAX_EP0_SIZE, EP_TYPE_CTRL);
rt_usbd_reset_handler(&_hc32_udc);
LOG_D("USB Reset");
}
static void usb_ctrlconn(usb_core_instance *pdev, uint8_t conn)
{
__IO uint8_t tmp_1;
tmp_1 = conn;
if (tmp_1 != 0U)
{
rt_usbd_connect_handler(&_hc32_udc);
LOG_D("USB Connect");
}
else
{
rt_usbd_disconnect_handler(&_hc32_udc);
LOG_D("USB Disconnect");
}
}
static void usb_dev_susp(usb_core_instance *pdev)
{
LOG_D("USB Suspend");
}
static void usb_dev_resume(usb_core_instance *pdev)
{
LOG_D("USB Resume");
}
static void usb_sof_process(usb_core_instance *pdev)
{
rt_usbd_sof_handler(&_hc32_udc);
}
static void usb_setup_process(usb_core_instance *pdev)
{
rt_usbd_ep0_setup_handler(&_hc32_udc, (struct urequest *)pdev->dev.setup_pkt_buf);
}
static void usb_dataout_process(usb_core_instance *pdev, uint8_t epnum)
{
if (epnum != 0)
{
rt_usbd_ep_out_handler(&_hc32_udc, epnum, pdev->dev.out_ep[epnum].xfer_count);
}
else
{
rt_usbd_ep0_out_handler(&_hc32_udc, pdev->dev.out_ep[0].xfer_count);
}
}
static void usb_datain_process(usb_core_instance *pdev, uint8_t epnum)
{
if (epnum == 0)
{
rt_usbd_ep0_in_handler(&_hc32_udc);
}
else
{
rt_usbd_ep_in_handler(&_hc32_udc, 0x80 | epnum, pdev->dev.in_ep[epnum].xfer_count);
}
}
static void usb_isoinincomplt_process(usb_core_instance *pdev)
{
/* reserved */
}
static void usb_isooutincomplt_process(usb_core_instance *pdev)
{
/* reserved */
}
static usb_dev_int_cbk_typedef dev_int_cbk =
{
&usb_dev_rst,
&usb_ctrlconn,
&usb_dev_susp,
&usb_dev_resume,
&usb_sof_process,
&usb_setup_process,
&usb_dataout_process,
&usb_datain_process,
&usb_isoinincomplt_process,
&usb_isooutincomplt_process
};
static usb_dev_int_cbk_typedef *dev_int_cbkpr = &dev_int_cbk;
static uint32_t usb_rddevinep(usb_core_instance *pdev, uint8_t epnum)
{
uint32_t u32diepmsk;
uint32_t u32diepempmsk;
u32diepmsk = READ_REG32(pdev->regs.DREGS->DIEPMSK);
u32diepempmsk = READ_REG32(pdev->regs.DREGS->DIEPEMPMSK);
u32diepmsk |= (((u32diepempmsk >> epnum) & 0x1UL) << 7U);
return (READ_REG32(pdev->regs.INEP_REGS[epnum]->DIEPINT) & u32diepmsk);
}
static void usb_wrblanktxfifo(usb_core_instance *pdev, uint32_t epnum)
{
USB_DEV_EP *ep;
uint32_t u32Len;
uint32_t u32Len32b;
uint16_t u16spclen;
uint32_t u32diepempmsk;
ep = &pdev->dev.in_ep[epnum];
u32Len = ep->xfer_len - ep->xfer_count;
if (u32Len > ep->maxpacket)
{
u32Len = ep->maxpacket;
}
u32Len32b = (u32Len + 3UL) >> 2;
u16spclen = usb_rdineptxfspcavail(pdev, epnum);
while ((u16spclen >= u32Len32b) && (ep->xfer_count < ep->xfer_len))
{
u32Len = ep->xfer_len - ep->xfer_count;
if (u32Len > ep->maxpacket)
{
u32Len = ep->maxpacket;
}
u32Len32b = (u32Len + 3UL) >> 2;
usb_wrpkt(&pdev->regs, ep->xfer_buff, (uint8_t)epnum, (uint16_t)u32Len, pdev->basic_cfgs.dmaen);
ep->xfer_buff += u32Len;
ep->xfer_count += u32Len;
u16spclen = usb_rdineptxfspcavail(pdev, epnum);
}
if (u32Len == 0UL)
{
u32diepempmsk = 0x01UL << epnum;
CLR_REG32_BIT(pdev->regs.DREGS->DIEPEMPMSK, u32diepempmsk);
}
}
#ifdef VBUS_SENSING_ENABLED
static void usb_sessionrequest_isr(usb_core_instance *pdev)
{
dev_int_cbkpr->devctrlconnect(pdev, 1U);
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_VBUSVINT);
if (0U != pdev->basic_cfgs.low_power)
{
CLR_REG32_BIT(*pdev->regs.GCCTL, USBFS_GCCTL_STPPCLK | USBFS_GCCTL_GATEHCLK);
}
}
#endif
static void usb_resume_isr(usb_core_instance *pdev)
{
if (0U != pdev->basic_cfgs.low_power)
{
CLR_REG32_BIT(*pdev->regs.GCCTL, USBFS_GCCTL_STPPCLK | USBFS_GCCTL_GATEHCLK);
}
CLR_REG32_BIT(pdev->regs.DREGS->DCTL, USBFS_DCTL_RWUSIG);
dev_int_cbkpr->Resume(pdev);
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_WKUINT);
}
static void usb_susp_isr(usb_core_instance *pdev)
{
uint32_t u32dsts;
u32dsts = READ_REG32(pdev->regs.DREGS->DSTS);
if ((u32dsts & 1UL) != 0UL)
{
dev_int_cbkpr->Suspend(pdev);
}
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_USBSUSP);
}
static void usb_inep_isr(usb_core_instance *pdev)
{
uint32_t u32diepint;
uint32_t u32EpIntr;
uint8_t u8epnum;
uint32_t u32diepempmsk;
u32EpIntr = usb_getalliepintr(&pdev->regs);
u8epnum = 0U;
while ((0U != u32EpIntr) && (u8epnum < USB_MAX_TX_FIFOS))
{
if ((u32EpIntr & 0x1UL) != 0UL)
{
u32diepint = usb_rddevinep(pdev, u8epnum);
if ((u32diepint & XFER_COMPL) != 0UL)
{
u32diepempmsk = 1UL << u8epnum;
CLR_REG32_BIT(pdev->regs.DREGS->DIEPEMPMSK, u32diepempmsk);
WRITE_REG32(pdev->regs.INEP_REGS[u8epnum]->DIEPINT, XFER_COMPL);
dev_int_cbkpr->DataInStage(pdev, u8epnum);
if (pdev->basic_cfgs.dmaen == 1U)
{
if ((pdev->dev.device_state == USB_EP0_STATUS_IN) && (u8epnum == 0U))
{
pdev->dev.out_ep[0].xfer_len = 64U;
pdev->dev.out_ep[0].rem_data_len = 64U;
pdev->dev.out_ep[0].total_data_len = 64U;
usb_ep0revcfg(&pdev->regs, pdev->basic_cfgs.dmaen, pdev->dev.setup_pkt_buf);
pdev->dev.device_state = USB_EP0_IDLE;
}
}
}
if ((u32diepint & EPDISABLED) != 0UL)
{
WRITE_REG32(pdev->regs.INEP_REGS[u8epnum]->DIEPINT, EPDISABLED);
}
if ((u32diepint & TIME_OUT) != 0UL)
{
WRITE_REG32(pdev->regs.INEP_REGS[u8epnum]->DIEPINT, TIME_OUT);
}
if ((u32diepint & INTKNTXFEMP) != 0UL)
{
WRITE_REG32(pdev->regs.INEP_REGS[u8epnum]->DIEPINT, INTKNTXFEMP);
}
if ((u32diepint & INEPNAKEFF) != 0UL)
{
WRITE_REG32(pdev->regs.INEP_REGS[u8epnum]->DIEPINT, INEPNAKEFF);
}
if ((u32diepint & TXFEMP) != 0UL)
{
usb_wrblanktxfifo(pdev, u8epnum);
WRITE_REG32(pdev->regs.INEP_REGS[u8epnum]->DIEPINT, TXFEMP);
}
}
u8epnum++;
u32EpIntr >>= 1U;
}
}
static void usb_outep_isr(usb_core_instance *pdev)
{
uint32_t u32EpIntr;
uint32_t u32doepint;
uint8_t u8epnum = 0U;
uint32_t u8Xfer;
uint32_t u32ReadEpSize;
u32EpIntr = usb_getalloepintr(&pdev->regs);
while ((u32EpIntr != 0UL) && (u8epnum < USB_MAX_TX_FIFOS))
{
if ((u32EpIntr & 0x1UL) != 0UL)
{
u32doepint = usb_getoepintbit(&pdev->regs, u8epnum);
if ((u32doepint & XFER_COMPL) != 0UL)
{
WRITE_REG32(pdev->regs.OUTEP_REGS[u8epnum]->DOEPINT, XFER_COMPL);
if (pdev->basic_cfgs.dmaen == 1U)
{
u32ReadEpSize = (READ_REG32(pdev->regs.OUTEP_REGS[u8epnum]->DOEPTSIZ) & USBFS_DOEPTSIZ_XFRSIZ);
u8Xfer = LL_MIN(pdev->dev.out_ep[u8epnum].maxpacket, pdev->dev.out_ep[u8epnum].xfer_len);
pdev->dev.out_ep[u8epnum].xfer_count = u8Xfer - u32ReadEpSize;
if (u8epnum != 0U)
{
pdev->dev.out_ep[u8epnum].xfer_count = pdev->dev.out_ep[u8epnum].xfer_len - u32ReadEpSize;
}
}
dev_int_cbkpr->DataOutStage(pdev, u8epnum);
if (pdev->basic_cfgs.dmaen == 1U)
{
if ((pdev->dev.device_state == USB_EP0_STATUS_OUT) && (u8epnum == 0U))
{
pdev->dev.out_ep[0].xfer_len = 64U;
pdev->dev.out_ep[0].rem_data_len = 64U;
pdev->dev.out_ep[0].total_data_len = 64U;
usb_ep0revcfg(&pdev->regs, pdev->basic_cfgs.dmaen, pdev->dev.setup_pkt_buf);
pdev->dev.device_state = USB_EP0_IDLE;
}
}
}
if ((u32doepint & EPDISABLED) != 0UL)
{
WRITE_REG32(pdev->regs.OUTEP_REGS[u8epnum]->DOEPINT, EPDISABLED);
}
if (u8epnum == 0U)
{
u32doepint = usb_getoepintbit(&pdev->regs, u8epnum);
if ((u32doepint & SETUP_BIT) != 0UL)
{
dev_int_cbkpr->SetupStage(pdev);
WRITE_REG32(pdev->regs.OUTEP_REGS[u8epnum]->DOEPINT, SETUP_BIT);
}
}
}
u8epnum++;
u32EpIntr >>= 1U;
}
}
static void usb_sof_isr(usb_core_instance *pdev)
{
dev_int_cbkpr->SOF(pdev);
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_SOF);
}
static void usb_rxstsqlvl_isr(usb_core_instance *pdev)
{
uint32_t u32grxsts;
USB_DEV_EP *ep;
uint8_t u8epnum;
uint8_t u8PktStatus;
uint16_t u16ByteCnt;
CLR_REG32_BIT(pdev->regs.GREGS->GINTMSK, USBFS_GINTMSK_RXFNEM);
u32grxsts = READ_REG32(pdev->regs.GREGS->GRXSTSP);
u8epnum = (uint8_t)(u32grxsts & USBFS_GRXSTSP_CHNUM_EPNUM);
u8PktStatus = (uint8_t)((u32grxsts & USBFS_GRXSTSP_PKTSTS) >> USBFS_GRXSTSP_PKTSTS_POS);
u16ByteCnt = (uint16_t)((u32grxsts & USBFS_GRXSTSP_BCNT) >> USBFS_GRXSTSP_BCNT_POS);
ep = &pdev->dev.out_ep[u8epnum];
switch (u8PktStatus)
{
case STS_DATA_UPDT:
if (0U != u16ByteCnt)
{
usb_rdpkt(&pdev->regs, ep->xfer_buff, u16ByteCnt);
ep->xfer_buff += u16ByteCnt;
ep->xfer_count += u16ByteCnt;
}
else
{
;
}
break;
case STS_SETUP_UPDT:
/* Copy the setup packet received in FIFO into the setup buffer in RAM */
usb_rdpkt(&pdev->regs, pdev->dev.setup_pkt_buf, 8U);
ep->xfer_count += u16ByteCnt;
break;
case STS_GOUT_NAK:
case STS_XFER_COMP:
case STS_SETUP_COMP:
break;
default:
break;
}
SET_REG32_BIT(pdev->regs.GREGS->GINTMSK, USBFS_GINTMSK_RXFNEM);
}
static void usb_reset_isr(usb_core_instance *pdev)
{
uint32_t i;
CLR_REG32_BIT(pdev->regs.DREGS->DCTL, USBFS_DCTL_RWUSIG);
usb_txfifoflush(&pdev->regs, 0UL);
for (i = 0UL; i < pdev->basic_cfgs.dev_epnum ; i++)
{
WRITE_REG32(pdev->regs.INEP_REGS[i]->DIEPINT, 0xFFUL);
WRITE_REG32(pdev->regs.OUTEP_REGS[i]->DOEPINT, 0xFFUL);
}
WRITE_REG32(pdev->regs.DREGS->DAINT, 0xFFFFFFFFUL);
WRITE_REG32(pdev->regs.DREGS->DAINTMSK, 1UL | (1UL << USBFS_DAINTMSK_OEPINTM_POS));
WRITE_REG32(pdev->regs.DREGS->DOEPMSK, USBFS_DOEPMSK_STUPM | USBFS_DOEPMSK_XFRCM | USBFS_DOEPMSK_EPDM);
#ifdef USB_OTG_HS_DEDICATED_EP1_ENABLED
WRITE_REG32(pdev->regs.DREGS->DOUTEP1MSK, USBFS_DOEPMSK_STUPM | USBFS_DOEPMSK_XFRCM | USBFS_DOEPMSK_EPDM);
#endif
WRITE_REG32(pdev->regs.DREGS->DIEPMSK, USBFS_DIEPMSK_XFRCM | USBFS_DIEPMSK_TOM | USBFS_DIEPMSK_EPDM);
#ifdef USB_OTG_HS_DEDICATED_EP1_ENABLED
WRITE_REG32(pdev->regs.DREGS->DINEP1MSK, USBFS_DIEPMSK_XFRCM | USBFS_DIEPMSK_TOM | USBFS_DIEPMSK_EPDM);
#endif
CLR_REG32_BIT(pdev->regs.DREGS->DCFG, USBFS_DCFG_DAD);
pdev->dev.out_ep[0].xfer_len = 64U;
pdev->dev.out_ep[0].rem_data_len = 64U;
pdev->dev.out_ep[0].total_data_len = 64U;
usb_ep0revcfg(&pdev->regs, pdev->basic_cfgs.dmaen, pdev->dev.setup_pkt_buf);
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_USBRST);
dev_int_cbkpr->Reset(pdev);
}
static void usb_enumfinish_isr(usb_core_instance *pdev)
{
usb_ep0activate(&pdev->regs);
usb_setaroundtim(pdev);
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_ENUMDNE);
}
static void usb_isoinincomplt_isr(usb_core_instance *pdev)
{
dev_int_cbkpr->IsoINIncomplete(pdev);
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_IISOIXFR);
}
static void usb_isooutincomplt_isr(usb_core_instance *pdev)
{
dev_int_cbkpr->IsoOUTIncomplete(pdev);
WRITE_REG32(pdev->regs.GREGS->GINTSTS, USBFS_GINTSTS_IPXFR_INCOMPISOOUT);
}
static void usb_isr_handler(usb_core_instance *pdev)
{
uint32_t u32gintsts;
if (0U == usb_getcurmod(&pdev->regs))
{
u32gintsts = usb_getcoreintr(&pdev->regs);
if (u32gintsts == 0UL)
{
return;
}
if ((u32gintsts & OUTEP_INT) != 0UL)
{
usb_outep_isr(pdev);
}
if ((u32gintsts & INEP_INT) != 0UL)
{
usb_inep_isr(pdev);
}
if ((u32gintsts & MODEMIS_INT) != 0UL)
{
WRITE_REG32(pdev->regs.GREGS->GINTSTS, MODEMIS_INT);
}
if ((u32gintsts & WAKEUP_INT) != 0UL)
{
usb_resume_isr(pdev);
}
if ((u32gintsts & USBSUSP_INT) != 0UL)
{
usb_susp_isr(pdev);
}
if ((u32gintsts & SOF_INT) != 0UL)
{
usb_sof_isr(pdev);
}
if ((u32gintsts & RXFLVL_INT) != 0UL)
{
usb_rxstsqlvl_isr(pdev);
}
if ((u32gintsts & USBRST_INT) != 0UL)
{
usb_reset_isr(pdev);
}
if ((u32gintsts & ENUMDONE_INT) != 0UL)
{
usb_enumfinish_isr(pdev);
}
if ((u32gintsts & INCOMPLSOIN) != 0UL)
{
usb_isoinincomplt_isr(pdev);
}
if ((u32gintsts & INCOMPLSOOUT) != 0UL)
{
usb_isooutincomplt_isr(pdev);
}
#ifdef VBUS_SENSING_ENABLED
if ((u32gintsts & VBUSV_INT) != 0UL)
{
usb_sessionrequest_isr(pdev);
}
#endif
}
}
static void usbd_irq_handler(void)
{
rt_interrupt_enter();
usb_isr_handler(&_hc32_usbd);
rt_interrupt_leave();
}
static rt_err_t _usbd_ep_set_stall(rt_uint8_t address)
{
usb_stalldevep(&_hc32_usbd, address);
return RT_EOK;
}
static rt_err_t _usbd_ep_clear_stall(rt_uint8_t address)
{
usb_clrstall(&_hc32_usbd, address);
return RT_EOK;
}
static rt_err_t _usbd_set_address(rt_uint8_t address)
{
usb_devaddrset(&_hc32_usbd.regs, address);
return RT_EOK;
}
static rt_err_t _usbd_set_config(rt_uint8_t address)
{
return RT_EOK;
}
static rt_err_t _usbd_ep_enable(uep_t ep)
{
RT_ASSERT(ep != RT_NULL);
RT_ASSERT(ep->ep_desc != RT_NULL);
usb_opendevep(&_hc32_usbd, ep->ep_desc->bEndpointAddress,
ep->ep_desc->wMaxPacketSize, ep->ep_desc->bmAttributes);
return RT_EOK;
}
static rt_err_t _usbd_ep_disable(uep_t ep)
{
RT_ASSERT(ep != RT_NULL);
RT_ASSERT(ep->ep_desc != RT_NULL);
usb_shutdevep(&_hc32_usbd, ep->ep_desc->bEndpointAddress);
return RT_EOK;
}
static rt_size_t _usbd_ep_read(rt_uint8_t address, void *buffer)
{
rt_size_t size = 0;
RT_ASSERT(buffer != RT_NULL);
return size;
}
static rt_size_t _usbd_ep_read_prepare(rt_uint8_t address, void *buffer, rt_size_t size)
{
usb_readytorx(&_hc32_usbd, address, buffer, size);
return size;
}
static rt_size_t _usbd_ep_write(rt_uint8_t address, void *buffer, rt_size_t size)
{
usb_deveptx(&_hc32_usbd, address, buffer, size);
return size;
}
static rt_err_t _usbd_ep0_send_status(void)
{
usb_deveptx(&_hc32_usbd, 0x00, NULL, 0);
return RT_EOK;
}
static rt_err_t _usbd_suspend(void)
{
return RT_EOK;
}
static rt_err_t _usbd_wakeup(void)
{
return RT_EOK;
}
static rt_err_t _usbd_init(rt_device_t device)
{
usb_core_instance *pdev;
stc_usb_port_identify stcPortIdentify;
struct hc32_irq_config irq_config;
pdev = (usb_core_instance *)device->user_data;
rt_hw_usb_board_init();
#if !defined(BSP_USING_USBHS)
FCG_Fcg1PeriphClockCmd(FCG1_PERIPH_USBFS, ENABLE);
#else
FCG_Fcg1PeriphClockCmd(FCG1_PERIPH_USBHS, ENABLE);
#endif
/* Parameters */
#if !defined(BSP_USING_USBHS)
stcPortIdentify.u8CoreID = USBFS_CORE_ID;
#else
stcPortIdentify.u8CoreID = USBHS_CORE_ID;
#endif
#if defined (HC32F4A0)
#if !defined(BSP_USING_USBHS_PHY_EXTERN)
stcPortIdentify.u8PhyType = USBHS_PHY_EMBED;
#else
stcPortIdentify.u8PhyType = USBHS_PHY_EXT;
#endif
#endif
usb_setregaddr(&pdev->regs, &stcPortIdentify, &pdev->basic_cfgs);
usb_gintdis(&pdev->regs);
/*Init the Core (common init.) */
usb_initusbcore(&pdev->regs, &pdev->basic_cfgs);
/* Force Device Mode*/
usb_modeset(&pdev->regs, DEVICE_MODE);
/* Init Device */
usb_devmodeinit(&pdev->regs, &pdev->basic_cfgs);
/* Enable USB Global interrupt */
usb_ginten(&pdev->regs);
/* NVIC Config */
irq_config.irq_num = BSP_USB_GLB_IRQ_NUM;
#if !defined(BSP_USING_USBHS)
irq_config.int_src = INT_SRC_USBFS_GLB;
#else
irq_config.int_src = INT_SRC_USBHS_GLB;
#endif
irq_config.irq_prio = BSP_USB_GLB_IRQ_PRIO;
/* register interrupt */
hc32_install_irq_handler(&irq_config,
usbd_irq_handler,
RT_TRUE);
return RT_EOK;
}
const static struct udcd_ops _udc_ops =
{
_usbd_set_address,
_usbd_set_config,
_usbd_ep_set_stall,
_usbd_ep_clear_stall,
_usbd_ep_enable,
_usbd_ep_disable,
_usbd_ep_read_prepare,
_usbd_ep_read,
_usbd_ep_write,
_usbd_ep0_send_status,
_usbd_suspend,
_usbd_wakeup,
};
#ifdef RT_USING_DEVICE_OPS
const static struct rt_device_ops _ops =
{
_usbd_init,
RT_NULL,
RT_NULL,
RT_NULL,
RT_NULL,
RT_NULL,
};
#endif
int rt_hw_usbd_init(void)
{
rt_memset((void *)&_hc32_udc, 0, sizeof(struct udcd));
_hc32_udc.parent.type = RT_Device_Class_USBDevice;
#ifdef RT_USING_DEVICE_OPS
_hc32_udc.parent.ops = &_ops;
#else
_hc32_udc.parent.init = _usbd_init;
#endif
_hc32_udc.parent.user_data = &_hc32_usbd;
_hc32_udc.ops = &_udc_ops;
/* Register endpoint infomation */
_hc32_udc.ep_pool = _ep_pool;
_hc32_udc.ep0.id = &_ep_pool[0];
#ifdef BSP_USBD_SPEED_HS
_hc32_udc.device_is_hs = RT_TRUE;
#endif
rt_device_register((rt_device_t)&_hc32_udc, "usbd", 0);
rt_usb_device_init();
return RT_EOK;
}
INIT_DEVICE_EXPORT(rt_hw_usbd_init);
#endif /* BSP_USING_USBD */
View Git Blame Copy Permalink