mirror of https://github.com/rusefi/pcan_pro_x.git
421 lines
11 KiB
C
421 lines
11 KiB
C
#include <stm32f4xx_hal.h>
|
|
#include <usbd_def.h>
|
|
#include <usbd_core.h>
|
|
|
|
#define USB_WITHOUT_ISR 1
|
|
PCD_HandleTypeDef hpcd_USB_OTG_HS;
|
|
void Error_Handler(void);
|
|
|
|
USBD_StatusTypeDef USBD_Get_USB_Status(HAL_StatusTypeDef hal_status);
|
|
|
|
#if ( USB_WITHOUT_ISR == 0 )
|
|
void OTG_HS_IRQHandler(void)
|
|
{
|
|
HAL_PCD_IRQHandler( &hpcd_USB_OTG_HS );
|
|
}
|
|
#endif
|
|
|
|
/* MSP Init */
|
|
void HAL_PCD_MspInit(PCD_HandleTypeDef* pcdHandle)
|
|
{
|
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
if(pcdHandle->Instance==USB_OTG_HS)
|
|
{
|
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
/**USB_OTG_HS GPIO Configuration
|
|
PB14 ------> USB_OTG_HS_DM
|
|
PB15 ------> USB_OTG_HS_DP
|
|
*/
|
|
GPIO_InitStruct.Pin = GPIO_PIN_14|GPIO_PIN_15;
|
|
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
GPIO_InitStruct.Alternate = GPIO_AF12_OTG_HS_FS;
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
|
|
/* Peripheral clock enable */
|
|
__HAL_RCC_USB_OTG_HS_CLK_ENABLE();
|
|
|
|
/* Peripheral interrupt init */
|
|
#if ( USB_WITHOUT_ISR == 0 )
|
|
HAL_NVIC_SetPriority(OTG_HS_IRQn, 0, 0);
|
|
HAL_NVIC_EnableIRQ(OTG_HS_IRQn);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
void HAL_PCD_MspDeInit(PCD_HandleTypeDef* pcdHandle)
|
|
{
|
|
if(pcdHandle->Instance==USB_OTG_HS)
|
|
{
|
|
/* Peripheral clock disable */
|
|
__HAL_RCC_USB_OTG_HS_CLK_DISABLE();
|
|
|
|
/**USB_OTG_HS GPIO Configuration
|
|
PB14 ------> USB_OTG_HS_DM
|
|
PB15 ------> USB_OTG_HS_DP
|
|
*/
|
|
HAL_GPIO_DeInit(GPIOB, GPIO_PIN_14|GPIO_PIN_15);
|
|
|
|
/* Peripheral interrupt Deinit*/
|
|
HAL_NVIC_DisableIRQ(OTG_HS_IRQn);
|
|
}
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_SetupStageCallback(PCD_HandleTypeDef *hpcd)
|
|
#else
|
|
void HAL_PCD_SetupStageCallback(PCD_HandleTypeDef *hpcd)
|
|
#endif
|
|
{
|
|
USBD_LL_SetupStage((USBD_HandleTypeDef*)hpcd->pData, (uint8_t *)hpcd->Setup);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_DataOutStageCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#else
|
|
void HAL_PCD_DataOutStageCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#endif
|
|
{
|
|
USBD_LL_DataOutStage((USBD_HandleTypeDef*)hpcd->pData, epnum, hpcd->OUT_ep[epnum].xfer_buff);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_DataInStageCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#else
|
|
void HAL_PCD_DataInStageCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#endif
|
|
{
|
|
USBD_LL_DataInStage((USBD_HandleTypeDef*)hpcd->pData, epnum, hpcd->IN_ep[epnum].xfer_buff);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_SOFCallback(PCD_HandleTypeDef *hpcd)
|
|
#else
|
|
void HAL_PCD_SOFCallback(PCD_HandleTypeDef *hpcd)
|
|
#endif
|
|
{
|
|
USBD_LL_SOF((USBD_HandleTypeDef*)hpcd->pData);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_ResetCallback(PCD_HandleTypeDef *hpcd)
|
|
#else
|
|
void HAL_PCD_ResetCallback(PCD_HandleTypeDef *hpcd)
|
|
#endif
|
|
{
|
|
USBD_SpeedTypeDef speed = USBD_SPEED_FULL;
|
|
|
|
if ( hpcd->Init.speed == PCD_SPEED_HIGH)
|
|
{
|
|
speed = USBD_SPEED_HIGH;
|
|
}
|
|
else if ( hpcd->Init.speed == PCD_SPEED_FULL)
|
|
{
|
|
speed = USBD_SPEED_FULL;
|
|
}
|
|
else
|
|
{
|
|
Error_Handler();
|
|
}
|
|
|
|
USBD_LL_SetSpeed((USBD_HandleTypeDef*)hpcd->pData, speed);
|
|
|
|
USBD_LL_Reset((USBD_HandleTypeDef*)hpcd->pData);
|
|
}
|
|
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_SuspendCallback(PCD_HandleTypeDef *hpcd)
|
|
#else
|
|
void HAL_PCD_SuspendCallback(PCD_HandleTypeDef *hpcd)
|
|
#endif
|
|
{
|
|
/* Inform USB library that core enters in suspend Mode. */
|
|
USBD_LL_Suspend((USBD_HandleTypeDef*)hpcd->pData);
|
|
__HAL_PCD_GATE_PHYCLOCK(hpcd);
|
|
/* Enter in STOP mode. */
|
|
if (hpcd->Init.low_power_enable)
|
|
{
|
|
/* Set SLEEPDEEP bit and SleepOnExit of Cortex System Control Register. */
|
|
SCB->SCR |= (uint32_t)((uint32_t)(SCB_SCR_SLEEPDEEP_Msk | SCB_SCR_SLEEPONEXIT_Msk));
|
|
}
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_ResumeCallback(PCD_HandleTypeDef *hpcd)
|
|
#else
|
|
void HAL_PCD_ResumeCallback(PCD_HandleTypeDef *hpcd)
|
|
#endif
|
|
{
|
|
USBD_LL_Resume((USBD_HandleTypeDef*)hpcd->pData);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_ISOOUTIncompleteCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#else
|
|
void HAL_PCD_ISOOUTIncompleteCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#endif
|
|
{
|
|
USBD_LL_IsoOUTIncomplete((USBD_HandleTypeDef*)hpcd->pData, epnum);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_ISOINIncompleteCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#else
|
|
void HAL_PCD_ISOINIncompleteCallback(PCD_HandleTypeDef *hpcd, uint8_t epnum)
|
|
#endif
|
|
{
|
|
USBD_LL_IsoINIncomplete((USBD_HandleTypeDef*)hpcd->pData, epnum);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_ConnectCallback(PCD_HandleTypeDef *hpcd)
|
|
#else
|
|
void HAL_PCD_ConnectCallback(PCD_HandleTypeDef *hpcd)
|
|
#endif
|
|
{
|
|
USBD_LL_DevConnected((USBD_HandleTypeDef*)hpcd->pData);
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
static void PCD_DisconnectCallback(PCD_HandleTypeDef *hpcd)
|
|
#else
|
|
void HAL_PCD_DisconnectCallback(PCD_HandleTypeDef *hpcd)
|
|
#endif
|
|
{
|
|
USBD_LL_DevDisconnected((USBD_HandleTypeDef*)hpcd->pData);
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_Init(USBD_HandleTypeDef *pdev)
|
|
{
|
|
/* Init USB Ip. */
|
|
if (pdev->id == DEVICE_HS)
|
|
{
|
|
hpcd_USB_OTG_HS.pData = pdev;
|
|
pdev->pData = &hpcd_USB_OTG_HS;
|
|
|
|
hpcd_USB_OTG_HS.Instance = USB_OTG_HS;
|
|
hpcd_USB_OTG_HS.Init.dev_endpoints = 6;
|
|
hpcd_USB_OTG_HS.Init.speed = PCD_SPEED_FULL;
|
|
hpcd_USB_OTG_HS.Init.dma_enable = DISABLE;
|
|
hpcd_USB_OTG_HS.Init.phy_itface = USB_OTG_EMBEDDED_PHY;
|
|
hpcd_USB_OTG_HS.Init.Sof_enable = DISABLE;
|
|
hpcd_USB_OTG_HS.Init.low_power_enable = DISABLE;
|
|
hpcd_USB_OTG_HS.Init.lpm_enable = DISABLE;
|
|
hpcd_USB_OTG_HS.Init.vbus_sensing_enable = DISABLE;
|
|
hpcd_USB_OTG_HS.Init.use_dedicated_ep1 = DISABLE;
|
|
hpcd_USB_OTG_HS.Init.use_external_vbus = DISABLE;
|
|
|
|
if( HAL_PCD_Init( &hpcd_USB_OTG_HS ) != HAL_OK )
|
|
{
|
|
Error_Handler( );
|
|
}
|
|
|
|
#if (USE_HAL_PCD_REGISTER_CALLBACKS == 1U)
|
|
HAL_PCD_RegisterCallback(&hpcd_USB_OTG_HS, HAL_PCD_SOF_CB_ID, PCD_SOFCallback);
|
|
HAL_PCD_RegisterCallback(&hpcd_USB_OTG_HS, HAL_PCD_SETUPSTAGE_CB_ID, PCD_SetupStageCallback);
|
|
HAL_PCD_RegisterCallback(&hpcd_USB_OTG_HS, HAL_PCD_RESET_CB_ID, PCD_ResetCallback);
|
|
HAL_PCD_RegisterCallback(&hpcd_USB_OTG_HS, HAL_PCD_SUSPEND_CB_ID, PCD_SuspendCallback);
|
|
HAL_PCD_RegisterCallback(&hpcd_USB_OTG_HS, HAL_PCD_RESUME_CB_ID, PCD_ResumeCallback);
|
|
HAL_PCD_RegisterCallback(&hpcd_USB_OTG_HS, HAL_PCD_CONNECT_CB_ID, PCD_ConnectCallback);
|
|
HAL_PCD_RegisterCallback(&hpcd_USB_OTG_HS, HAL_PCD_DISCONNECT_CB_ID, PCD_DisconnectCallback);
|
|
|
|
HAL_PCD_RegisterDataOutStageCallback(&hpcd_USB_OTG_HS, PCD_DataOutStageCallback);
|
|
HAL_PCD_RegisterDataInStageCallback(&hpcd_USB_OTG_HS, PCD_DataInStageCallback);
|
|
HAL_PCD_RegisterIsoOutIncpltCallback(&hpcd_USB_OTG_HS, PCD_ISOOUTIncompleteCallback);
|
|
HAL_PCD_RegisterIsoInIncpltCallback(&hpcd_USB_OTG_HS, PCD_ISOINIncompleteCallback);
|
|
#endif
|
|
|
|
HAL_PCDEx_SetRxFiFo( &hpcd_USB_OTG_HS, ((1024)/4)+1 );
|
|
|
|
HAL_PCDEx_SetTxFiFo( &hpcd_USB_OTG_HS, 0, (512/4)+1 );
|
|
HAL_PCDEx_SetTxFiFo( &hpcd_USB_OTG_HS, 1, (512/4)+1 );
|
|
HAL_PCDEx_SetTxFiFo( &hpcd_USB_OTG_HS, 2, (512/4)+1 );
|
|
HAL_PCDEx_SetTxFiFo( &hpcd_USB_OTG_HS, 3, (512/4)+1 );
|
|
}
|
|
return USBD_OK;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_DeInit(USBD_HandleTypeDef *pdev)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_DeInit(pdev->pData);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_Start(USBD_HandleTypeDef *pdev)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_Start(pdev->pData);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_Stop(USBD_HandleTypeDef *pdev)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_Stop(pdev->pData);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_OpenEP(USBD_HandleTypeDef *pdev, uint8_t ep_addr, uint8_t ep_type, uint16_t ep_mps)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_EP_Open(pdev->pData, ep_addr, ep_mps, ep_type);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
|
|
USBD_StatusTypeDef USBD_LL_CloseEP(USBD_HandleTypeDef *pdev, uint8_t ep_addr)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_EP_Close(pdev->pData, ep_addr);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_FlushEP(USBD_HandleTypeDef *pdev, uint8_t ep_addr)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_EP_Flush(pdev->pData, ep_addr);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_StallEP(USBD_HandleTypeDef *pdev, uint8_t ep_addr)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_EP_SetStall(pdev->pData, ep_addr);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_ClearStallEP(USBD_HandleTypeDef *pdev, uint8_t ep_addr)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_EP_ClrStall(pdev->pData, ep_addr);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
uint8_t USBD_LL_IsStallEP(USBD_HandleTypeDef *pdev, uint8_t ep_addr)
|
|
{
|
|
PCD_HandleTypeDef *hpcd = (PCD_HandleTypeDef*) pdev->pData;
|
|
|
|
if((ep_addr & 0x80) == 0x80)
|
|
{
|
|
return hpcd->IN_ep[ep_addr & 0x7F].is_stall;
|
|
}
|
|
else
|
|
{
|
|
return hpcd->OUT_ep[ep_addr & 0x7F].is_stall;
|
|
}
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_SetUSBAddress(USBD_HandleTypeDef *pdev, uint8_t dev_addr)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_SetAddress(pdev->pData, dev_addr);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_Transmit(USBD_HandleTypeDef *pdev, uint8_t ep_addr, uint8_t *pbuf, uint32_t size)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_EP_Transmit(pdev->pData, ep_addr, pbuf, size);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_LL_PrepareReceive(USBD_HandleTypeDef *pdev, uint8_t ep_addr, uint8_t *pbuf, uint32_t size)
|
|
{
|
|
HAL_StatusTypeDef hal_status = HAL_OK;
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
hal_status = HAL_PCD_EP_Receive(pdev->pData, ep_addr, pbuf, size);
|
|
|
|
usb_status = USBD_Get_USB_Status(hal_status);
|
|
|
|
return usb_status;
|
|
}
|
|
|
|
uint32_t USBD_LL_GetRxDataSize(USBD_HandleTypeDef *pdev, uint8_t ep_addr)
|
|
{
|
|
return HAL_PCD_EP_GetRxCount((PCD_HandleTypeDef*) pdev->pData, ep_addr);
|
|
}
|
|
|
|
void USBD_LL_Delay(uint32_t Delay)
|
|
{
|
|
HAL_Delay(Delay);
|
|
}
|
|
|
|
USBD_StatusTypeDef USBD_Get_USB_Status(HAL_StatusTypeDef hal_status)
|
|
{
|
|
USBD_StatusTypeDef usb_status = USBD_OK;
|
|
|
|
switch (hal_status)
|
|
{
|
|
case HAL_OK :
|
|
usb_status = USBD_OK;
|
|
break;
|
|
case HAL_ERROR :
|
|
usb_status = USBD_FAIL;
|
|
break;
|
|
case HAL_BUSY :
|
|
usb_status = USBD_BUSY;
|
|
break;
|
|
case HAL_TIMEOUT :
|
|
usb_status = USBD_FAIL;
|
|
break;
|
|
default :
|
|
usb_status = USBD_FAIL;
|
|
break;
|
|
}
|
|
return usb_status;
|
|
}
|