155 lines
4.4 KiB
C
155 lines
4.4 KiB
C
/*
|
|
* Copyright (c) 2025, sakumisu
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
#include "usbotg_core.h"
|
|
|
|
#ifdef CONFIG_USB_OTG_ENABLE
|
|
#undef USB_DBG_TAG
|
|
#define USB_DBG_TAG "usbotg_core"
|
|
#include "usb_log.h"
|
|
|
|
#define CONFIG_USB_OTG_MAX_BUS CONFIG_USBHOST_MAX_BUS
|
|
|
|
struct usbotg_core_priv {
|
|
uint8_t busid;
|
|
uint32_t reg_base;
|
|
bool usbh_initialized;
|
|
bool usbd_initialized;
|
|
void *device_event_callback;
|
|
void *host_event_callback;
|
|
uint8_t current_mode;
|
|
usb_osal_sem_t change_sem;
|
|
usb_osal_thread_t change_thread;
|
|
} g_usbotg_core[CONFIG_USB_OTG_MAX_BUS];
|
|
|
|
static void usbotg_host_initialize(uint8_t busid)
|
|
{
|
|
if (g_usbotg_core[busid].usbh_initialized) {
|
|
return;
|
|
}
|
|
|
|
if (g_usbotg_core[busid].usbd_initialized) {
|
|
g_usbotg_core[busid].usbd_initialized = false;
|
|
usbd_deinitialize(busid);
|
|
}
|
|
|
|
USB_LOG_INFO("Switch to HOST mode\r\n");
|
|
|
|
usbh_initialize(busid, g_usbotg_core[busid].reg_base);
|
|
g_usbotg_core[busid].usbh_initialized = true;
|
|
}
|
|
|
|
static void usbotg_device_initialize(uint8_t busid)
|
|
{
|
|
if (g_usbotg_core[busid].usbd_initialized) {
|
|
return;
|
|
}
|
|
|
|
if (g_usbotg_core[busid].usbh_initialized) {
|
|
g_usbotg_core[busid].usbh_initialized = false;
|
|
usbh_deinitialize(busid);
|
|
}
|
|
|
|
USB_LOG_INFO("Switch to DEVICE mode\r\n");
|
|
|
|
usbd_initialize(g_usbotg_core[busid].busid, g_usbotg_core[busid].reg_base, g_usbotg_core[busid].device_event_callback);
|
|
g_usbotg_core[busid].usbd_initialized = true;
|
|
}
|
|
|
|
static void usbotg_rolechange_thread(void *argument)
|
|
{
|
|
uint8_t busid = (uint8_t)(uintptr_t)argument;
|
|
|
|
usb_otg_init(busid);
|
|
|
|
while (1) {
|
|
if (usb_osal_sem_take(g_usbotg_core[busid].change_sem, USB_OSAL_WAITING_FOREVER) == 0) {
|
|
if (g_usbotg_core[busid].current_mode == USBOTG_MODE_HOST) {
|
|
usbotg_host_initialize(busid);
|
|
} else if (g_usbotg_core[busid].current_mode == USBOTG_MODE_DEVICE) {
|
|
usbotg_device_initialize(busid);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
int usbotg_initialize(uint8_t busid, uint32_t reg_base, void *device_event_callback, void *host_event_callback, uint8_t default_role)
|
|
{
|
|
char thread_name[32] = { 0 };
|
|
|
|
USB_ASSERT_MSG(busid < CONFIG_USB_OTG_MAX_BUS, "bus overflow\r\n");
|
|
|
|
g_usbotg_core[busid].busid = busid;
|
|
g_usbotg_core[busid].reg_base = reg_base;
|
|
g_usbotg_core[busid].device_event_callback = device_event_callback;
|
|
g_usbotg_core[busid].host_event_callback = host_event_callback;
|
|
|
|
g_usbotg_core[busid].change_sem = usb_osal_sem_create(0);
|
|
if (g_usbotg_core[busid].change_sem == NULL) {
|
|
USB_LOG_ERR("Failed to create change_sem\r\n");
|
|
while (1) {
|
|
}
|
|
}
|
|
|
|
snprintf(thread_name, 32, "usbotg%u", busid);
|
|
g_usbotg_core[busid].change_thread = usb_osal_thread_create(thread_name, 2048, 10, usbotg_rolechange_thread, (void *)(uintptr_t)busid);
|
|
if (g_usbotg_core[busid].change_thread == NULL) {
|
|
USB_LOG_ERR("Failed to create usbotg thread\r\n");
|
|
while (1) {
|
|
}
|
|
}
|
|
|
|
usbotg_trigger_role_change(busid, default_role);
|
|
return 0;
|
|
}
|
|
|
|
int usbotg_deinitialize(uint8_t busid)
|
|
{
|
|
USB_ASSERT_MSG(busid < CONFIG_USB_OTG_MAX_BUS, "bus overflow\r\n");
|
|
|
|
if (g_usbotg_core[busid].usbd_initialized) {
|
|
g_usbotg_core[busid].usbd_initialized = false;
|
|
usbd_deinitialize(busid);
|
|
}
|
|
|
|
if (g_usbotg_core[busid].usbh_initialized) {
|
|
g_usbotg_core[busid].usbh_initialized = false;
|
|
usbh_deinitialize(busid);
|
|
}
|
|
|
|
if (g_usbotg_core[busid].change_thread) {
|
|
usb_osal_thread_delete(g_usbotg_core[busid].change_thread);
|
|
}
|
|
|
|
if (g_usbotg_core[busid].change_sem) {
|
|
usb_otg_deinit(busid);
|
|
usb_osal_sem_delete(g_usbotg_core[busid].change_sem);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void usbotg_trigger_role_change(uint8_t busid, uint8_t mode)
|
|
{
|
|
USB_ASSERT_MSG(busid < CONFIG_USB_OTG_MAX_BUS, "bus overflow\r\n");
|
|
|
|
g_usbotg_core[busid].current_mode = mode;
|
|
|
|
if (g_usbotg_core[busid].change_sem) {
|
|
usb_osal_sem_give(g_usbotg_core[busid].change_sem);
|
|
}
|
|
}
|
|
|
|
void USBOTG_IRQHandler(uint8_t busid)
|
|
{
|
|
USB_ASSERT_MSG(busid < CONFIG_USB_OTG_MAX_BUS, "bus overflow\r\n");
|
|
|
|
if (g_usbotg_core[busid].current_mode == USBOTG_MODE_HOST && g_usbotg_core[busid].usbh_initialized) {
|
|
USBH_IRQHandler(busid);
|
|
} else if (g_usbotg_core[busid].current_mode == USBOTG_MODE_DEVICE && g_usbotg_core[busid].usbd_initialized) {
|
|
USBD_IRQHandler(busid);
|
|
}
|
|
}
|
|
#endif /* CONFIG_USB_OTG_ENABLE */ |