esp-idf/components/usb/enum.c

1377 lines
54 KiB
C

/*
* SPDX-FileCopyrightText: 2023-2024 Espressif Systems (Shanghai) CO LTD
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <string.h>
#include <stdint.h>
#include "esp_err.h"
#include "esp_log.h"
#include "esp_heap_caps.h"
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "usb_private.h"
#include "usbh.h"
#include "enum.h"
#include "usb/usb_helpers.h"
#define SET_ADDR_RECOVERY_INTERVAL_MS CONFIG_USB_HOST_SET_ADDR_RECOVERY_MS
#define ENUM_CTRL_TRANSFER_MAX_DATA_LEN CONFIG_USB_HOST_CONTROL_TRANSFER_MAX_SIZE
#define ENUM_INIT_VALUE_DEV_ADDR 1 // Init value for device address
#define ENUM_DEFAULT_CONFIGURATION_VALUE 1 // Default configuration value for SetConfiguration() request
#define ENUM_SHORT_DESC_REQ_LEN 8 // Number of bytes to request when getting a short descriptor (just enough to get bMaxPacketSize0 or wTotalLength)
#define ENUM_WORST_CASE_MPS_LS 8 // The worst case MPS of EP0 for a LS device
#define ENUM_WORST_CASE_MPS_FS_HS 64 // The worst case MPS of EP0 for a FS/HS device
#define ENUM_LANGID 0x409 // Current enumeration only supports English (United States) string descriptors
#define ENUM_MAX_ADDRESS (127) // Maximal device address value
/**
* @brief Stages of device enumeration listed in their order of execution
*
* Entry:
* - These stages MUST BE LISTED IN THE ORDER OF THEIR EXECUTION as the enumeration will simply increment the current stage
* - If an error occurs at any stage, ENUM_STAGE_CANCEL acts as a common exit stage on failure
* - Must start with 0 as enum is also used as an index
* - The short descriptor stages are used to fetch the start particular descriptors that don't have a fixed length in order to determine the full descriptors length
* - Any state of Get String Descriptor could be STALLed by the device. In that case we just don't fetch them and treat enumeration as successful
*/
typedef enum {
ENUM_STAGE_IDLE = 0, /**< There is no device awaiting enumeration */
// Basic Device enumeration
ENUM_STAGE_GET_SHORT_DEV_DESC, /**< Getting short dev desc (wLength is ENUM_SHORT_DESC_REQ_LEN) */
ENUM_STAGE_CHECK_SHORT_DEV_DESC, /**< Save bMaxPacketSize0 from the short dev desc. Update the MPS of the enum pipe */
ENUM_STAGE_SECOND_RESET, /**< Reset the device again (Workaround for old USB devices that get confused by the previous short dev desc request). */
ENUM_STAGE_SET_ADDR, /**< Send SET_ADDRESS request */
ENUM_STAGE_CHECK_ADDR, /**< Update the enum pipe's target address */
ENUM_STAGE_SET_ADDR_RECOVERY, /**< Wait SET ADDRESS recovery interval at least for 2ms due to usb_20, chapter 9.2.6.3 */
ENUM_STAGE_GET_FULL_DEV_DESC, /**< Get the full dev desc */
ENUM_STAGE_CHECK_FULL_DEV_DESC, /**< Check the full dev desc, fill it into the device object in USBH. Save the string descriptor indexes*/
ENUM_STAGE_SELECT_CONFIG, /**< Select configuration: select default ENUM_DEFAULT_CONFIGURATION_VALUE value or use callback if ENABLE_ENUM_FILTER_CALLBACK enabled */
ENUM_STAGE_GET_SHORT_CONFIG_DESC, /**< Getting a short config desc (wLength is ENUM_SHORT_DESC_REQ_LEN) */
ENUM_STAGE_CHECK_SHORT_CONFIG_DESC, /**< Save wTotalLength of the short config desc */
ENUM_STAGE_GET_FULL_CONFIG_DESC, /**< Get the full config desc (wLength is the saved wTotalLength) */
ENUM_STAGE_CHECK_FULL_CONFIG_DESC, /**< Check the full config desc, fill it into the device object in USBH */
// Get String Descriptors
ENUM_STAGE_GET_SHORT_LANGID_TABLE, /**< Get the header of the LANGID table string descriptor */
ENUM_STAGE_CHECK_SHORT_LANGID_TABLE, /**< Save the bLength of the LANGID table string descriptor */
ENUM_STAGE_GET_FULL_LANGID_TABLE, /**< Get the full LANGID table string descriptor */
ENUM_STAGE_CHECK_FULL_LANGID_TABLE, /**< Check whether ENUM_LANGID is in the LANGID table */
ENUM_STAGE_GET_SHORT_MANU_STR_DESC, /**< Get the header of the iManufacturer string descriptor */
ENUM_STAGE_CHECK_SHORT_MANU_STR_DESC, /**< Save the bLength of the iManufacturer string descriptor */
ENUM_STAGE_GET_FULL_MANU_STR_DESC, /**< Get the full iManufacturer string descriptor */
ENUM_STAGE_CHECK_FULL_MANU_STR_DESC, /**< Check and fill the full iManufacturer string descriptor */
ENUM_STAGE_GET_SHORT_PROD_STR_DESC, /**< Get the header of the string descriptor at index iProduct */
ENUM_STAGE_CHECK_SHORT_PROD_STR_DESC, /**< Save the bLength of the iProduct string descriptor */
ENUM_STAGE_GET_FULL_PROD_STR_DESC, /**< Get the full iProduct string descriptor */
ENUM_STAGE_CHECK_FULL_PROD_STR_DESC, /**< Check and fill the full iProduct string descriptor */
ENUM_STAGE_GET_SHORT_SER_STR_DESC, /**< Get the header of the string descriptor at index iSerialNumber */
ENUM_STAGE_CHECK_SHORT_SER_STR_DESC, /**< Save the bLength of the iSerialNumber string descriptor */
ENUM_STAGE_GET_FULL_SER_STR_DESC, /**< Get the full iSerialNumber string descriptor */
ENUM_STAGE_CHECK_FULL_SER_STR_DESC, /**< Check and fill the full iSerialNumber string descriptor */
// Set Configuration
ENUM_STAGE_SET_CONFIG, /**< Send SET_CONFIGURATION request */
ENUM_STAGE_CHECK_CONFIG, /**< Check that SET_CONFIGURATION request was successful */
// Terminal stages
ENUM_STAGE_COMPLETE, /**< Successful enumeration complete. */
ENUM_STAGE_CANCEL, /**< Cancel enumeration. Free device resources */
} enum_stage_t;
const char *const enum_stage_strings[] = {
"NONE",
"GET_SHORT_DEV_DESC",
"CHECK_SHORT_DEV_DESC",
"SECOND_RESET",
"SET_ADDR",
"CHECK_ADDR",
"SET_ADDR_RECOVERY",
"GET_FULL_DEV_DESC",
"CHECK_FULL_DEV_DESC",
"SELECT_CONFIG",
"GET_SHORT_CONFIG_DESC",
"CHECK_SHORT_CONFIG_DESC",
"GET_FULL_CONFIG_DESC",
"CHECK_FULL_CONFIG_DESC",
"GET_SHORT_LANGID_TABLE",
"CHECK_SHORT_LANGID_TABLE",
"GET_FULL_LANGID_TABLE",
"CHECK_FULL_LANGID_TABLE",
"GET_SHORT_MANU_STR_DESC",
"CHECK_SHORT_MANU_STR_DESC",
"GET_FULL_MANU_STR_DESC",
"CHECK_FULL_MANU_STR_DESC",
"GET_SHORT_PROD_STR_DESC",
"CHECK_SHORT_PROD_STR_DESC",
"GET_FULL_PROD_STR_DESC",
"CHECK_FULL_PROD_STR_DESC",
"GET_SHORT_SER_STR_DESC",
"CHECK_SHORT_SER_STR_DESC",
"GET_FULL_SER_STR_DESC",
"CHECK_FULL_SER_STR_DESC",
"SET_CONFIG",
"CHECK_CONFIG",
"COMPLETE",
"CANCEL",
};
typedef struct {
// Constant
uint8_t new_dev_addr; /**< Device address that should be assigned during enumeration */
uint8_t bMaxPacketSize0; /**< Max packet size of the device's EP0. Read from bMaxPacketSize0 field of device descriptor */
uint16_t wTotalLength; /**< Total length of device's configuration descriptor. Read from wTotalLength field of config descriptor */
uint8_t iManufacturer; /**< Index of the Manufacturer string descriptor */
uint8_t iProduct; /**< Index of the Product string descriptor */
uint8_t iSerialNumber; /**< Index of the Serial Number string descriptor */
uint8_t str_desc_bLength; /**< Saved bLength from getting a short string descriptor */
uint8_t bConfigurationValue; /**< Device's current configuration number */
} enum_device_params_t;
typedef struct {
struct {
union {
struct {
uint32_t processing: 1; /**< Enumeration process is active */
uint32_t reserved31: 31; /**< Reserved */
};
uint32_t val;
} flags;
enum_stage_t stage; /**< Current enumeration stage */
uint8_t next_dev_addr; /**< Device address for device under enumeration */
} dynamic; /**< Dynamic members. Require a critical section */
struct {
// Device related objects, initialized at start of a particular enumeration
unsigned int dev_uid; /**< Unique device ID being enumerated */
usb_device_handle_t dev_hdl; /**< Handle of device being enumerated */
// Parent info for optimization and more clean debug output
usb_device_handle_t parent_dev_hdl; /**< Device's parent handle */
uint8_t parent_dev_addr; /**< Device's parent address */
uint8_t parent_port_num; /**< Device's parent port number */
// Parameters, updated during enumeration
enum_device_params_t dev_params; /**< Parameters of device under enumeration */
int expect_num_bytes; /**< Expected number of bytes for IN transfers stages. Set to 0 for OUT transfer */
} single_thread; /**< Single thread members don't require a critical section so long as they are never accessed from multiple threads */
struct {
// Internal objects
urb_t *urb; /**< URB used for enumeration control transfers. Max data length of ENUM_CTRL_TRANSFER_MAX_DATA_LEN */
// Callbacks
usb_proc_req_cb_t proc_req_cb; /**< USB Host process request callback. Refer to proc_req_callback() in usb_host.c */
void *proc_req_cb_arg; /**< USB Host process request callback argument */
enum_event_cb_t enum_event_cb; /**< Enumeration driver event callback */
void *enum_event_cb_arg; /**< Enumeration driver event callback argument */
#if ENABLE_ENUM_FILTER_CALLBACK
usb_host_enum_filter_cb_t enum_filter_cb; /**< Set device configuration callback */
void *enum_filter_cb_arg; /**< Set device configuration callback argument */
#endif // ENABLE_ENUM_FILTER_CALLBACK
} constant; /**< Constant members. Do not change after installation thus do not require a critical section or mutex */
} enum_driver_t;
static enum_driver_t *p_enum_driver = NULL;
static portMUX_TYPE enum_driver_lock = portMUX_INITIALIZER_UNLOCKED;
const char *ENUM_TAG = "ENUM";
// -----------------------------------------------------------------------------
// ---------------------------- Helpers ----------------------------------------
// -----------------------------------------------------------------------------
#define ENUM_ENTER_CRITICAL() portENTER_CRITICAL(&enum_driver_lock)
#define ENUM_EXIT_CRITICAL() portEXIT_CRITICAL(&enum_driver_lock)
#define ENUM_CHECK(cond, ret_val) ({ \
if (!(cond)) { \
return (ret_val); \
} \
})
#define ENUM_CHECK_FROM_CRIT(cond, ret_val) ({ \
if (!(cond)) { \
ENUM_EXIT_CRITICAL(); \
return ret_val; \
} \
})
// -----------------------------------------------------------------------------
// ------------------------ Private functions ----------------------------------
// -----------------------------------------------------------------------------
static inline uint8_t get_next_dev_addr(void)
{
uint8_t ret = 0;
ENUM_ENTER_CRITICAL();
p_enum_driver->dynamic.next_dev_addr++;
if (p_enum_driver->dynamic.next_dev_addr > ENUM_MAX_ADDRESS) {
p_enum_driver->dynamic.next_dev_addr = ENUM_INIT_VALUE_DEV_ADDR;
}
ret = p_enum_driver->dynamic.next_dev_addr;
ENUM_EXIT_CRITICAL();
return ret;
}
static uint8_t get_next_free_dev_addr(void)
{
usb_device_handle_t dev_hdl;
uint8_t new_dev_addr = p_enum_driver->dynamic.next_dev_addr;
while (1) {
if (usbh_devs_open(new_dev_addr, &dev_hdl) == ESP_ERR_NOT_FOUND) {
break;
}
// We have a device with the same address on a bus, close device and request new addr
usbh_dev_close(dev_hdl);
new_dev_addr = get_next_dev_addr();
}
// Sanity check
assert(new_dev_addr != 0);
return new_dev_addr;
}
/**
* @brief Get Configuration descriptor index
*
* For Configuration descriptor bConfigurationValue and index are not the same and
* should be different for SetConfiguration() and GetDescriptor() requests.
* GetDescriptor(): index from 0 to one less than the bNumConfigurations (refer to section 9.4.3 Get Descriptor)
* SetConfiguration(): bConfigurationValue field used as a parameter to the SetConfiguration() request. (refer to section 9.6.3 Configuration)
*
* @return uint8_t
*/
static inline uint8_t get_configuration_descriptor_index(uint8_t bConfigurationValue)
{
return (bConfigurationValue == 0) ? bConfigurationValue : (bConfigurationValue - 1);
}
/**
* @brief Select active configuration
*
* During enumeration process, device objects could have several configuration that can be activated
* To be able to select configuration this call should be used
* This will call the enumeration filter callback (if enabled) and set the bConfigurationValue for the upcoming SetConfiguration() command
*
* @return esp_err_t
*/
static esp_err_t select_active_configuration(void)
{
// This configuration value must be zero or match a configuration value from a configuration descriptor.
// If the configuration value is zero, the device is placed in its Address state.
// But some devices STALLed get configuration descriptor with bConfigurationValue = 1, even they have one configuration with bValue = 1.
uint8_t bConfigurationValue = ENUM_DEFAULT_CONFIGURATION_VALUE;
#if ENABLE_ENUM_FILTER_CALLBACK
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
const usb_device_desc_t *dev_desc;
ESP_ERROR_CHECK(usbh_dev_get_desc(dev_hdl, &dev_desc));
bool enum_proceed = false;
// Sanity check
assert(dev_desc);
if (p_enum_driver->constant.enum_filter_cb) {
enum_proceed = p_enum_driver->constant.enum_filter_cb(dev_desc, &bConfigurationValue);
}
// User's request NOT to enumerate the USB device
if (!enum_proceed) {
ESP_LOGW(ENUM_TAG, "[%d:%d] Abort request of enumeration process (%#x:%#x)",
p_enum_driver->single_thread.parent_dev_addr,
p_enum_driver->single_thread.parent_port_num,
dev_desc->idProduct,
dev_desc->idVendor);
enum_cancel(p_enum_driver->single_thread.dev_uid);
return ESP_OK;
}
// Set configuration descriptor
if ((bConfigurationValue == 0) || (bConfigurationValue > dev_desc->bNumConfigurations)) {
ESP_LOGE(ENUM_TAG, "Invalid bConfigurationValue (%d) provided by user, using default", bConfigurationValue);
bConfigurationValue = ENUM_DEFAULT_CONFIGURATION_VALUE;
}
#endif // ENABLE_ENUM_FILTER_CALLBACK
ESP_LOGD(ENUM_TAG, "Selected bConfigurationValue=%d", bConfigurationValue);
p_enum_driver->single_thread.dev_params.bConfigurationValue = bConfigurationValue;
return ESP_OK;
}
static esp_err_t second_reset(void)
{
// Notify USB Host
enum_event_data_t event_data = {
.event = ENUM_EVENT_RESET_REQUIRED,
.reset_req = {
.parent_dev_hdl = p_enum_driver->single_thread.parent_dev_hdl,
.parent_port_num = p_enum_driver->single_thread.parent_port_num,
},
};
p_enum_driver->constant.enum_event_cb(&event_data, p_enum_driver->constant.enum_event_cb_arg);
return ESP_OK;
}
/**
* @brief Get index and langid
*
* Returns index and langid, based on enumerator stage.
*
* @param[in] stage Stage
* @param[out] index String index
* @param[out] langid String langid
*/
static inline void get_index_langid_for_stage(enum_stage_t stage, uint8_t *index, uint16_t *langid)
{
switch (stage) {
case ENUM_STAGE_GET_SHORT_LANGID_TABLE:
case ENUM_STAGE_GET_FULL_LANGID_TABLE:
*index = 0; // The LANGID table uses an index of 0
*langid = 0; // Getting the LANGID table itself should use a LANGID of 0
break;
case ENUM_STAGE_GET_SHORT_MANU_STR_DESC:
case ENUM_STAGE_GET_FULL_MANU_STR_DESC:
*index = p_enum_driver->single_thread.dev_params.iManufacturer;
*langid = ENUM_LANGID; // Use the default LANGID
break;
case ENUM_STAGE_GET_SHORT_PROD_STR_DESC:
case ENUM_STAGE_GET_FULL_PROD_STR_DESC:
*index = p_enum_driver->single_thread.dev_params.iProduct;
*langid = ENUM_LANGID; // Use the default LANGID
break;
case ENUM_STAGE_GET_SHORT_SER_STR_DESC:
case ENUM_STAGE_GET_FULL_SER_STR_DESC:
*index = p_enum_driver->single_thread.dev_params.iSerialNumber;
*langid = ENUM_LANGID; // Use the default LANGID
break;
default:
// Should not occur
abort();
break;
}
}
/**
* @brief Control request: General
*
* Prepares the Control request byte-data transfer for current stage of the enumerator
*/
static void control_request_general(void)
{
usb_transfer_t *transfer = &p_enum_driver->constant.urb->transfer;
uint8_t ctrl_ep_mps = p_enum_driver->single_thread.dev_params.bMaxPacketSize0;
uint16_t wTotalLength = p_enum_driver->single_thread.dev_params.wTotalLength;
uint8_t bConfigurationValue = p_enum_driver->single_thread.dev_params.bConfigurationValue;
uint8_t desc_index = get_configuration_descriptor_index(bConfigurationValue);
switch (p_enum_driver->dynamic.stage) {
case ENUM_STAGE_GET_SHORT_DEV_DESC: {
// Initialize a short device descriptor request
USB_SETUP_PACKET_INIT_GET_DEVICE_DESC((usb_setup_packet_t *)transfer->data_buffer);
((usb_setup_packet_t *)transfer->data_buffer)->wLength = ENUM_SHORT_DESC_REQ_LEN;
transfer->num_bytes = sizeof(usb_setup_packet_t) + usb_round_up_to_mps(ENUM_SHORT_DESC_REQ_LEN, ctrl_ep_mps);
// IN data stage should return exactly ENUM_SHORT_DESC_REQ_LEN bytes
p_enum_driver->single_thread.expect_num_bytes = sizeof(usb_setup_packet_t) + ENUM_SHORT_DESC_REQ_LEN;
break;
}
case ENUM_STAGE_SET_ADDR: {
p_enum_driver->single_thread.dev_params.new_dev_addr = get_next_free_dev_addr();
USB_SETUP_PACKET_INIT_SET_ADDR((usb_setup_packet_t *)transfer->data_buffer, p_enum_driver->single_thread.dev_params.new_dev_addr);
transfer->num_bytes = sizeof(usb_setup_packet_t); // No data stage
p_enum_driver->single_thread.expect_num_bytes = 0; // OUT transfer. No need to check number of bytes returned
break;
}
case ENUM_STAGE_GET_FULL_DEV_DESC: {
USB_SETUP_PACKET_INIT_GET_DEVICE_DESC((usb_setup_packet_t *)transfer->data_buffer);
transfer->num_bytes = sizeof(usb_setup_packet_t) + usb_round_up_to_mps(sizeof(usb_device_desc_t), ctrl_ep_mps);
// IN data stage should return exactly sizeof(usb_device_desc_t) bytes
p_enum_driver->single_thread.expect_num_bytes = sizeof(usb_setup_packet_t) + sizeof(usb_device_desc_t);
break;
}
case ENUM_STAGE_GET_SHORT_CONFIG_DESC: {
// Get a short config descriptor at descriptor index
USB_SETUP_PACKET_INIT_GET_CONFIG_DESC((usb_setup_packet_t *)transfer->data_buffer, desc_index, ENUM_SHORT_DESC_REQ_LEN);
transfer->num_bytes = sizeof(usb_setup_packet_t) + usb_round_up_to_mps(ENUM_SHORT_DESC_REQ_LEN, ctrl_ep_mps);
// IN data stage should return exactly ENUM_SHORT_DESC_REQ_LEN bytes
p_enum_driver->single_thread.expect_num_bytes = sizeof(usb_setup_packet_t) + ENUM_SHORT_DESC_REQ_LEN;
break;
}
case ENUM_STAGE_GET_FULL_CONFIG_DESC: {
// Get the full configuration descriptor at descriptor index, requesting its exact length.
USB_SETUP_PACKET_INIT_GET_CONFIG_DESC((usb_setup_packet_t *)transfer->data_buffer, desc_index, wTotalLength);
transfer->num_bytes = sizeof(usb_setup_packet_t) + usb_round_up_to_mps(wTotalLength, ctrl_ep_mps);
// IN data stage should return exactly wTotalLength bytes
p_enum_driver->single_thread.expect_num_bytes = sizeof(usb_setup_packet_t) + wTotalLength;
break;
}
case ENUM_STAGE_SET_CONFIG: {
USB_SETUP_PACKET_INIT_SET_CONFIG((usb_setup_packet_t *)transfer->data_buffer, bConfigurationValue);
transfer->num_bytes = sizeof(usb_setup_packet_t); // No data stage
p_enum_driver->single_thread.expect_num_bytes = 0; // OUT transfer. No need to check number of bytes returned
break;
}
default:
// Should never occur
p_enum_driver->single_thread.expect_num_bytes = 0;
abort();
break;
}
}
/**
* @brief Control request: String
*
* Prepares the Control request string-data transfer for current stage of the enumerator
*/
static void control_request_string(void)
{
usb_transfer_t *transfer = &p_enum_driver->constant.urb->transfer;
enum_stage_t stage = p_enum_driver->dynamic.stage;
uint8_t ctrl_ep_mps = p_enum_driver->single_thread.dev_params.bMaxPacketSize0;
uint8_t bLength = p_enum_driver->single_thread.dev_params.str_desc_bLength;
uint8_t index = 0;
uint16_t langid = 0;
get_index_langid_for_stage(stage, &index, &langid);
switch (stage) {
case ENUM_STAGE_GET_SHORT_LANGID_TABLE:
case ENUM_STAGE_GET_SHORT_MANU_STR_DESC:
case ENUM_STAGE_GET_SHORT_PROD_STR_DESC:
case ENUM_STAGE_GET_SHORT_SER_STR_DESC: {
// Get only the header of the string descriptor
USB_SETUP_PACKET_INIT_GET_STR_DESC((usb_setup_packet_t *)transfer->data_buffer, index, langid, sizeof(usb_str_desc_t));
transfer->num_bytes = sizeof(usb_setup_packet_t) + usb_round_up_to_mps(sizeof(usb_str_desc_t), ctrl_ep_mps);
// IN data stage should return exactly sizeof(usb_str_desc_t) bytes
p_enum_driver->single_thread.expect_num_bytes = sizeof(usb_setup_packet_t) + sizeof(usb_str_desc_t);
break;
}
case ENUM_STAGE_GET_FULL_LANGID_TABLE:
case ENUM_STAGE_GET_FULL_MANU_STR_DESC:
case ENUM_STAGE_GET_FULL_PROD_STR_DESC:
case ENUM_STAGE_GET_FULL_SER_STR_DESC: {
// Get the full string descriptor at a particular index, requesting the descriptors exact length
USB_SETUP_PACKET_INIT_GET_STR_DESC((usb_setup_packet_t *)transfer->data_buffer, index, langid, bLength);
transfer->num_bytes = sizeof(usb_setup_packet_t) + usb_round_up_to_mps(bLength, ctrl_ep_mps);
// IN data stage should return exactly str_desc_bLength bytes
p_enum_driver->single_thread.expect_num_bytes = sizeof(usb_setup_packet_t) + bLength;
break;
}
default:
// Should never occur
p_enum_driver->single_thread.expect_num_bytes = 0;
abort();
break;
}
}
/**
* @brief Parse short Device descriptor
*
* Parses short device descriptor response
* Configures the EP0 MPS for device object under enumeration
*/
static esp_err_t parse_short_dev_desc(void)
{
esp_err_t ret = ESP_OK;
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
usb_transfer_t *ctrl_xfer = &p_enum_driver->constant.urb->transfer;
const usb_device_desc_t *dev_desc = (usb_device_desc_t *)(ctrl_xfer->data_buffer + sizeof(usb_setup_packet_t));
// Check if the returned descriptor has correct type
if (dev_desc->bDescriptorType != USB_B_DESCRIPTOR_TYPE_DEVICE) {
ESP_LOGE(ENUM_TAG, "Short dev desc has wrong bDescriptorType");
ret = ESP_ERR_INVALID_RESPONSE;
goto exit;
}
// Update and save actual MPS of the default pipe
ret = usbh_dev_set_ep0_mps(dev_hdl, dev_desc->bMaxPacketSize0);
if (ret != ESP_OK) {
ESP_LOGE(ENUM_TAG, "Failed to update MPS");
goto exit;
}
// Save the actual MPS of EP0 in enum driver context
p_enum_driver->single_thread.dev_params.bMaxPacketSize0 = dev_desc->bMaxPacketSize0;
exit:
return ret;
}
static esp_err_t check_addr(void)
{
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
uint8_t assign_addr = p_enum_driver->single_thread.dev_params.new_dev_addr;
ESP_LOGD(ENUM_TAG, "Assign address (dev_addr=%d)", assign_addr);
esp_err_t ret = usbh_dev_set_addr(dev_hdl, assign_addr);
if (ret != ESP_OK) {
ESP_LOGE(ENUM_TAG, "Error during assign device address");
}
return ret;
}
/**
* @brief Parse full Device descriptor response
*
* Parses full device descriptor response
* Set device descriptor for device object under enumeration
*/
static esp_err_t parse_full_dev_desc(void)
{
esp_err_t ret = ESP_OK;
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
usb_transfer_t *ctrl_xfer = &p_enum_driver->constant.urb->transfer;
const usb_device_desc_t *dev_desc = (usb_device_desc_t *)(ctrl_xfer->data_buffer + sizeof(usb_setup_packet_t));
// Check if the returned descriptor has correct type
if (dev_desc->bDescriptorType != USB_B_DESCRIPTOR_TYPE_DEVICE) {
ESP_LOGE(ENUM_TAG, "Full dev desc has wrong bDescriptorType");
ret = ESP_ERR_INVALID_RESPONSE;
goto exit;
}
// Save string parameters
p_enum_driver->single_thread.dev_params.iManufacturer = dev_desc->iManufacturer;
p_enum_driver->single_thread.dev_params.iProduct = dev_desc->iProduct;
p_enum_driver->single_thread.dev_params.iSerialNumber = dev_desc->iSerialNumber;
// Device has more than one configuration
if (dev_desc->bNumConfigurations > 1) {
ESP_LOGW(ENUM_TAG, "Device has more than 1 configuration");
}
// Allocate Device descriptor and set it's value to device object
ret = usbh_dev_set_desc(dev_hdl, dev_desc);
exit:
return ret;
}
/**
* @brief Parse short Configuration descriptor
*
* Parses short Configuration descriptor response
* Set the length to request full Configuration descriptor
*/
static esp_err_t parse_short_config_desc(void)
{
esp_err_t ret;
usb_transfer_t *ctrl_xfer = &p_enum_driver->constant.urb->transfer;
const usb_config_desc_t *config_desc = (usb_config_desc_t *)(ctrl_xfer->data_buffer + sizeof(usb_setup_packet_t));
// Check if the returned descriptor is corrupted
if (config_desc->bDescriptorType != USB_B_DESCRIPTOR_TYPE_CONFIGURATION) {
ESP_LOGE(ENUM_TAG, "Short config desc has wrong bDescriptorType");
ret = ESP_ERR_INVALID_RESPONSE;
goto exit;
}
#if (ENUM_CTRL_TRANSFER_MAX_DATA_LEN < UINT16_MAX) // Suppress -Wtype-limits warning due to uint16_t wTotalLength
// Check if the descriptor is too long to be supported
if (config_desc->wTotalLength > ENUM_CTRL_TRANSFER_MAX_DATA_LEN) {
ESP_LOGE(ENUM_TAG, "Configuration descriptor larger than control transfer max length");
ret = ESP_ERR_INVALID_SIZE;
goto exit;
}
#endif
// Set the configuration descriptor's full length
p_enum_driver->single_thread.dev_params.wTotalLength = config_desc->wTotalLength;
ret = ESP_OK;
exit:
return ret;
}
/**
* @brief Parse full Configuration descriptor
*
* Parses full Configuration descriptor response
* Set the Configuration descriptor to device object under enumeration
*/
static esp_err_t parse_full_config_desc(void)
{
esp_err_t ret;
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
usb_transfer_t *ctrl_xfer = &p_enum_driver->constant.urb->transfer;
const usb_config_desc_t *config_desc = (usb_config_desc_t *)(ctrl_xfer->data_buffer + sizeof(usb_setup_packet_t));
// Check if the returned descriptor is corrupted
if (config_desc->bDescriptorType != USB_B_DESCRIPTOR_TYPE_CONFIGURATION) {
ESP_LOGE(ENUM_TAG, "Full config desc has wrong bDescriptorType");
ret = ESP_ERR_INVALID_RESPONSE;
goto exit;
}
// Allocate Configuration descriptor and set it's value to device object
ret = usbh_dev_set_config_desc(dev_hdl, config_desc);
exit:
return ret;
}
/**
* @brief Parse short String descriptor
*
* Parses short String descriptor response
* Set the length to request full String descriptor
*/
static esp_err_t parse_short_str_desc(void)
{
esp_err_t ret;
usb_transfer_t *transfer = &p_enum_driver->constant.urb->transfer;
const usb_str_desc_t *str_desc = (usb_str_desc_t *)(transfer->data_buffer + sizeof(usb_setup_packet_t));
//Check if the returned descriptor is supported or corrupted
if (str_desc->bDescriptorType == 0) {
ESP_LOGE(ENUM_TAG, "String desc not supported");
ret = ESP_ERR_NOT_SUPPORTED;
goto exit;
} else if (str_desc->bDescriptorType != USB_B_DESCRIPTOR_TYPE_STRING) {
ESP_LOGE(ENUM_TAG, "Short string desc corrupt");
ret = ESP_ERR_INVALID_RESPONSE;
goto exit;
}
#if (ENUM_CTRL_TRANSFER_MAX_DATA_LEN < UINT8_MAX) //Suppress -Wtype-limits warning due to uint8_t bLength
//Check if the descriptor is too long to be supported
if (str_desc->bLength > (uint32_t)ENUM_CTRL_TRANSFER_MAX_DATA_LEN) {
ESP_LOGE(ENUM_TAG, "String descriptor larger than control transfer max length");
ret = ESP_ERR_INVALID_SIZE;
goto exit;
}
#endif
// Set the descriptor's full length
p_enum_driver->single_thread.dev_params.str_desc_bLength = str_desc->bLength;
ret = ESP_OK;
exit:
return ret;
}
/**
* @brief Parse Language ID table
*
* Parses Language ID table response
* Searches Language ID table for LangID = 0x0409
*/
static esp_err_t parse_langid_table(void)
{
esp_err_t ret;
usb_transfer_t *transfer = &p_enum_driver->constant.urb->transfer;
const usb_str_desc_t *str_desc = (usb_str_desc_t *)(transfer->data_buffer + sizeof(usb_setup_packet_t));
//Scan the LANGID table for our target LANGID
ret = ESP_ERR_NOT_FOUND;
int langid_table_num_entries = (str_desc->bLength - sizeof(usb_str_desc_t)) / 2; // Each LANGID is 2 bytes
for (int i = 0; i < langid_table_num_entries; i++) { // Each LANGID is 2 bytes
if (str_desc->wData[i] == ENUM_LANGID) {
ret = ESP_OK;
break;
}
}
if (ret != ESP_OK) {
ESP_LOGE(ENUM_TAG, "LANGID %#x not found", ENUM_LANGID);
}
return ret;
}
/**
* @brief Get String index number
*
* Returns string number index (0, 1 or 2) based on stage
*/
static inline int get_str_index(enum_stage_t stage)
{
switch (stage) {
case ENUM_STAGE_CHECK_FULL_MANU_STR_DESC:
return 0;
case ENUM_STAGE_CHECK_FULL_PROD_STR_DESC:
return 1;
case ENUM_STAGE_CHECK_FULL_SER_STR_DESC:
return 2;
default:
break;
}
// Should never occurred
abort();
return -1;
}
/**
* @brief Parse full String descriptor
*
* Set String descriptor to the device object under enumeration
*/
static esp_err_t parse_full_str_desc(void)
{
usb_transfer_t *transfer = &p_enum_driver->constant.urb->transfer;
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
const usb_str_desc_t *str_desc = (usb_str_desc_t *)(transfer->data_buffer + sizeof(usb_setup_packet_t));
ENUM_ENTER_CRITICAL();
enum_stage_t stage = p_enum_driver->dynamic.stage;
ENUM_EXIT_CRITICAL();
return usbh_dev_set_str_desc(dev_hdl, str_desc, get_str_index(stage));
}
static esp_err_t check_config(void)
{
// Nothing to parse after a SET_CONFIG request
return ESP_OK;
}
// -----------------------------------------------------------------------------
// ---------------------- Stage handle functions -------------------------------
// -----------------------------------------------------------------------------
/**
* @brief Control request stage
*
* Based on the stage, does prepare General or String Control request
*/
static esp_err_t control_request(void)
{
esp_err_t ret;
switch (p_enum_driver->dynamic.stage) {
case ENUM_STAGE_GET_SHORT_DEV_DESC:
case ENUM_STAGE_SET_ADDR:
case ENUM_STAGE_GET_FULL_DEV_DESC:
case ENUM_STAGE_GET_SHORT_CONFIG_DESC:
case ENUM_STAGE_GET_FULL_CONFIG_DESC:
case ENUM_STAGE_SET_CONFIG:
control_request_general();
break;
case ENUM_STAGE_GET_SHORT_LANGID_TABLE:
case ENUM_STAGE_GET_FULL_LANGID_TABLE:
case ENUM_STAGE_GET_SHORT_MANU_STR_DESC:
case ENUM_STAGE_GET_FULL_MANU_STR_DESC:
case ENUM_STAGE_GET_SHORT_PROD_STR_DESC:
case ENUM_STAGE_GET_FULL_PROD_STR_DESC:
case ENUM_STAGE_GET_SHORT_SER_STR_DESC:
case ENUM_STAGE_GET_FULL_SER_STR_DESC:
control_request_string();
break;
default: // Should never occur
ret = ESP_ERR_INVALID_STATE;
abort();
break;
}
ret = usbh_dev_submit_ctrl_urb(p_enum_driver->single_thread.dev_hdl, p_enum_driver->constant.urb);
if (ret != ESP_OK) {
ESP_LOGE(ENUM_TAG, "[%d:%d] Control transfer submit error (%#x), stage '%s'",
p_enum_driver->single_thread.parent_dev_addr,
p_enum_driver->single_thread.parent_port_num,
ret,
enum_stage_strings[p_enum_driver->dynamic.stage]);
}
return ret;
}
/**
* @brief Control request response handling stage
*
* Based on the stage, does parse the response data
*/
static esp_err_t control_response_handling(void)
{
esp_err_t ret = ESP_FAIL;
// Check transfer status
int expected_num_bytes = p_enum_driver->single_thread.expect_num_bytes;
usb_transfer_t *ctrl_xfer = &p_enum_driver->constant.urb->transfer;
if (ctrl_xfer->status != USB_TRANSFER_STATUS_COMPLETED) {
ESP_LOGE(ENUM_TAG, "Bad transfer status %d: %s",
ctrl_xfer->status,
enum_stage_strings[p_enum_driver->dynamic.stage]);
return ret;
}
// Check Control IN transfer returned the expected correct number of bytes
if (expected_num_bytes != 0 && expected_num_bytes != ctrl_xfer->actual_num_bytes) {
ESP_LOGW(ENUM_TAG, "[%d:%d] Unexpected (%d) device response length (expected %d)",
p_enum_driver->single_thread.parent_dev_addr,
p_enum_driver->single_thread.parent_port_num,
ctrl_xfer->actual_num_bytes,
expected_num_bytes);
if (ctrl_xfer->actual_num_bytes < expected_num_bytes) {
// The device returned less bytes than requested. We cannot continue.
ESP_LOGE(ENUM_TAG, "Device returned less bytes than requested");
ret = ESP_ERR_INVALID_SIZE;
goto exit;
}
// The device returned more bytes than requested.
// This violates the USB specs chapter 9.3.5, but we can continue
}
switch (p_enum_driver->dynamic.stage) {
case ENUM_STAGE_CHECK_SHORT_DEV_DESC:
ret = parse_short_dev_desc();
break;
case ENUM_STAGE_CHECK_ADDR:
ret = check_addr();
break;
case ENUM_STAGE_CHECK_FULL_DEV_DESC:
ret = parse_full_dev_desc();
break;
case ENUM_STAGE_CHECK_SHORT_CONFIG_DESC:
ret = parse_short_config_desc();
break;
case ENUM_STAGE_CHECK_FULL_CONFIG_DESC:
ret = parse_full_config_desc();
break;
case ENUM_STAGE_CHECK_CONFIG:
ret = check_config();
break;
case ENUM_STAGE_CHECK_SHORT_LANGID_TABLE:
case ENUM_STAGE_CHECK_SHORT_MANU_STR_DESC:
case ENUM_STAGE_CHECK_SHORT_PROD_STR_DESC:
case ENUM_STAGE_CHECK_SHORT_SER_STR_DESC:
ret = parse_short_str_desc();
break;
case ENUM_STAGE_CHECK_FULL_LANGID_TABLE:
ret = parse_langid_table();
break;
case ENUM_STAGE_CHECK_FULL_MANU_STR_DESC:
case ENUM_STAGE_CHECK_FULL_PROD_STR_DESC:
case ENUM_STAGE_CHECK_FULL_SER_STR_DESC:
ret = parse_full_str_desc();
break;
default:
// Should never occurred
ret = ESP_ERR_INVALID_STATE;
abort();
break;
}
exit:
return ret;
}
/**
* @brief Cancel stage
*
* Force shutdown device object under enumeration
*/
static esp_err_t stage_cancel(void)
{
// There should be device under enumeration
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
usb_device_handle_t parent_dev_hdl = p_enum_driver->single_thread.parent_dev_hdl;
uint8_t parent_port_num = p_enum_driver->single_thread.parent_port_num;
// Close the device
ESP_ERROR_CHECK(usbh_dev_enum_unlock(dev_hdl));
ESP_ERROR_CHECK(usbh_dev_close(dev_hdl));
// Release device from enumerator
p_enum_driver->single_thread.dev_uid = 0;
p_enum_driver->single_thread.dev_hdl = NULL;
p_enum_driver->single_thread.parent_dev_hdl = NULL;
p_enum_driver->single_thread.parent_dev_addr = 0;
p_enum_driver->single_thread.parent_port_num = 0;
p_enum_driver->constant.urb->transfer.context = NULL;
ENUM_ENTER_CRITICAL();
p_enum_driver->dynamic.flags.processing = 0;
ENUM_EXIT_CRITICAL();
enum_event_data_t event_data = {
.event = ENUM_EVENT_CANCELED,
.canceled = {
.parent_dev_hdl = parent_dev_hdl,
.parent_port_num = parent_port_num,
},
};
p_enum_driver->constant.enum_event_cb(&event_data, p_enum_driver->constant.enum_event_cb_arg);
return ESP_OK;
}
/**
* @brief Complete stage
*
* Closes device object under enumeration
*/
static esp_err_t stage_complete(void)
{
usb_device_handle_t dev_hdl = p_enum_driver->single_thread.dev_hdl;
usb_device_handle_t parent_dev_hdl = p_enum_driver->single_thread.parent_dev_hdl;
uint8_t parent_dev_addr = p_enum_driver->single_thread.parent_dev_addr;
uint8_t parent_port_num = p_enum_driver->single_thread.parent_port_num;
uint8_t dev_addr = 0;
ESP_ERROR_CHECK(usbh_dev_get_addr(dev_hdl, &dev_addr));
// Close device
ESP_ERROR_CHECK(usbh_dev_enum_unlock(dev_hdl));
ESP_ERROR_CHECK(usbh_dev_close(dev_hdl));
// Release device from enumerator
p_enum_driver->single_thread.dev_uid = 0;
p_enum_driver->single_thread.dev_hdl = NULL;
p_enum_driver->single_thread.parent_dev_hdl = NULL;
p_enum_driver->single_thread.parent_dev_addr = 0;
p_enum_driver->single_thread.parent_port_num = 0;
// Release device from enumerator
p_enum_driver->constant.urb->transfer.context = NULL;
// Flush device params
memset(&p_enum_driver->single_thread.dev_params, 0, sizeof(enum_device_params_t));
p_enum_driver->single_thread.expect_num_bytes = 0;
// Increase device address to use new value during the next enumeration process
get_next_dev_addr();
ENUM_ENTER_CRITICAL();
p_enum_driver->dynamic.flags.processing = 0;
ENUM_EXIT_CRITICAL();
ESP_LOGD(ENUM_TAG, "[%d:%d] Processing complete, new device address %d",
parent_dev_addr,
parent_port_num,
dev_addr);
enum_event_data_t event_data = {
.event = ENUM_EVENT_COMPLETED,
.complete = {
.dev_hdl = dev_hdl,
.dev_addr = dev_addr,
.parent_dev_hdl = parent_dev_hdl,
.parent_port_num = parent_port_num,
},
};
p_enum_driver->constant.enum_event_cb(&event_data, p_enum_driver->constant.enum_event_cb_arg);
return ESP_OK;
}
// -----------------------------------------------------------------------------
// -------------------------- State Machine ------------------------------------
// -----------------------------------------------------------------------------
/**
* @brief Set next stage
*
* Does set next stage, based on the successful completion of last stage
* Some stages (i.e., string descriptors) are skipped if the device doesn't support them
* Some stages (i.e. string descriptors) are allowed to fail
*
* @param[in] last_stage_pass Flag of successful completion last stage
*/
static void set_next_stage(bool last_stage_pass)
{
enum_stage_t last_stage = p_enum_driver->dynamic.stage;
enum_stage_t next_stage;
while (1) {
bool stage_skip = false;
// Find the next stage
if (last_stage_pass) {
// Last stage was successful
ESP_LOGD(ENUM_TAG, "[%d:%d] %s OK",
p_enum_driver->single_thread.parent_dev_addr,
p_enum_driver->single_thread.parent_port_num,
enum_stage_strings[last_stage]);
// Get next stage
if (last_stage == ENUM_STAGE_COMPLETE) {
// Complete stage are terminal, move state machine to IDLE
next_stage = ENUM_STAGE_IDLE;
} else if (last_stage == ENUM_STAGE_CANCEL) {
// CANCEL can be called anytime, keep the state and handle in the next process callback
next_stage = last_stage;
} else {
// Simply increment to get the next stage
next_stage = last_stage + 1;
}
} else {
ESP_LOGE(ENUM_TAG, "[%d:%d] %s FAILED",
p_enum_driver->single_thread.parent_dev_addr,
p_enum_driver->single_thread.parent_port_num,
enum_stage_strings[last_stage]);
// These stages cannot fail
assert(last_stage != ENUM_STAGE_SET_ADDR_RECOVERY &&
last_stage != ENUM_STAGE_SELECT_CONFIG &&
last_stage != ENUM_STAGE_COMPLETE &&
last_stage != ENUM_STAGE_CANCEL);
// Last stage failed
switch (last_stage) {
// Stages that are allowed to fail skip to the next appropriate stage
case ENUM_STAGE_CHECK_SHORT_LANGID_TABLE:
case ENUM_STAGE_CHECK_FULL_LANGID_TABLE:
// Couldn't get LANGID, skip the rest of the string descriptors
case ENUM_STAGE_CHECK_SHORT_SER_STR_DESC:
case ENUM_STAGE_CHECK_FULL_SER_STR_DESC:
// iSerialNumber string failed. Jump to Set Configuration and complete enumeration process.
next_stage = ENUM_STAGE_SET_CONFIG;
break;
case ENUM_STAGE_CHECK_SHORT_MANU_STR_DESC:
case ENUM_STAGE_CHECK_FULL_MANU_STR_DESC:
// iManufacturer string failed. Get iProduct string next
next_stage = ENUM_STAGE_GET_SHORT_PROD_STR_DESC;
break;
case ENUM_STAGE_CHECK_SHORT_PROD_STR_DESC:
case ENUM_STAGE_CHECK_FULL_PROD_STR_DESC:
// iProduct string failed. Get iSerialNumber string next
next_stage = ENUM_STAGE_GET_SHORT_SER_STR_DESC;
break;
case ENUM_STAGE_COMPLETE:
case ENUM_STAGE_CANCEL:
// These stages should never fail
abort();
break;
default:
// Stage is not allowed to failed. Cancel enumeration.
next_stage = ENUM_STAGE_CANCEL;
break;
}
}
// Check if the next stage should be skipped
switch (next_stage) {
case ENUM_STAGE_GET_SHORT_MANU_STR_DESC:
case ENUM_STAGE_CHECK_SHORT_MANU_STR_DESC:
case ENUM_STAGE_GET_FULL_MANU_STR_DESC:
case ENUM_STAGE_CHECK_FULL_MANU_STR_DESC:
// Device doesn't support iManufacturer string
if (p_enum_driver->single_thread.dev_params.iManufacturer == 0) {
ESP_LOGD(ENUM_TAG, "String iManufacturer not set, skip");
stage_skip = true;
}
break;
case ENUM_STAGE_GET_SHORT_PROD_STR_DESC:
case ENUM_STAGE_CHECK_SHORT_PROD_STR_DESC:
case ENUM_STAGE_GET_FULL_PROD_STR_DESC:
case ENUM_STAGE_CHECK_FULL_PROD_STR_DESC:
// Device doesn't support iProduct string
if (p_enum_driver->single_thread.dev_params.iProduct == 0) {
ESP_LOGD(ENUM_TAG, "String iProduct not set, skip");
stage_skip = true;
}
break;
case ENUM_STAGE_GET_SHORT_SER_STR_DESC:
case ENUM_STAGE_CHECK_SHORT_SER_STR_DESC:
case ENUM_STAGE_GET_FULL_SER_STR_DESC:
case ENUM_STAGE_CHECK_FULL_SER_STR_DESC:
// Device doesn't support iSerialNumber string
if (p_enum_driver->single_thread.dev_params.iSerialNumber == 0) {
ESP_LOGD(ENUM_TAG, "String iSerialNumber not set, skip");
stage_skip = true;
}
break;
default:
break;
}
if (stage_skip) {
// Loop back around to get the next stage again
last_stage = next_stage;
} else {
break;
}
}
ENUM_ENTER_CRITICAL();
p_enum_driver->dynamic.stage = next_stage;
ENUM_EXIT_CRITICAL();
}
/**
* @brief Control transfer completion callback
*
* Is called by lower logic when transfer is completed with or without error
*
* @param[in] ctrl_xfer Pointer to a transfer buffer
*/
static void enum_control_transfer_complete(usb_transfer_t *ctrl_xfer)
{
// Sanity checks
assert(ctrl_xfer);
assert(ctrl_xfer->context);
assert(p_enum_driver->single_thread.dev_hdl == ctrl_xfer->context);
switch (ctrl_xfer->status) {
case USB_TRANSFER_STATUS_COMPLETED:
ESP_LOG_BUFFER_HEXDUMP(ENUM_TAG, ctrl_xfer->data_buffer, ctrl_xfer->actual_num_bytes, ESP_LOG_VERBOSE);
goto process;
break;
case USB_TRANSFER_STATUS_STALL:
// Device can STALL some requests if it doesn't have the requested descriptors
goto process;
break;
default:
ESP_LOGE(ENUM_TAG, "[%d:%d] Control transfer failed, status=%d",
p_enum_driver->single_thread.parent_dev_addr,
p_enum_driver->single_thread.parent_port_num,
ctrl_xfer->status);
break;
}
// Cancel enumeration process
enum_cancel(p_enum_driver->single_thread.dev_uid);
process:
// Request processing
p_enum_driver->constant.proc_req_cb(USB_PROC_REQ_SOURCE_ENUM, false, p_enum_driver->constant.proc_req_cb_arg);
}
// -----------------------------------------------------------------------------
// -------------------------- Public API ---------------------------------------
// -----------------------------------------------------------------------------
esp_err_t enum_install(enum_config_t *config, void **client_ret)
{
ENUM_ENTER_CRITICAL();
ENUM_CHECK_FROM_CRIT(p_enum_driver == NULL, ESP_ERR_INVALID_STATE);
ENUM_EXIT_CRITICAL();
ENUM_CHECK(config != NULL, ESP_ERR_INVALID_ARG);
esp_err_t ret;
enum_driver_t *enum_drv = heap_caps_calloc(1, sizeof(enum_driver_t), MALLOC_CAP_DEFAULT);
ENUM_CHECK(enum_drv, ESP_ERR_NO_MEM);
// Initialize ENUM objects
urb_t *urb = urb_alloc(sizeof(usb_setup_packet_t) + ENUM_CTRL_TRANSFER_MAX_DATA_LEN, 0);
if (urb == NULL) {
ret = ESP_ERR_NOT_FINISHED;
goto alloc_err;
}
// Setup urb
urb->usb_host_client = (void *) enum_drv; // Client is an address of the enum driver object
urb->transfer.callback = enum_control_transfer_complete;
enum_drv->constant.urb = urb;
// Save callbacks
enum_drv->constant.proc_req_cb = config->proc_req_cb;
enum_drv->constant.proc_req_cb_arg = config->proc_req_cb_arg;
enum_drv->constant.enum_event_cb = config->enum_event_cb;
enum_drv->constant.enum_event_cb_arg = config->enum_event_cb_arg;
#if ENABLE_ENUM_FILTER_CALLBACK
enum_drv->constant.enum_filter_cb = config->enum_filter_cb;
enum_drv->constant.enum_filter_cb_arg = config->enum_filter_cb_arg;
#endif // ENABLE_ENUM_FILTER_CALLBACK
enum_drv->dynamic.flags.val = 0;
enum_drv->dynamic.stage = ENUM_STAGE_IDLE;
enum_drv->dynamic.next_dev_addr = ENUM_INIT_VALUE_DEV_ADDR;
ENUM_ENTER_CRITICAL();
if (p_enum_driver != NULL) {
ENUM_EXIT_CRITICAL();
ret = ESP_ERR_NOT_FINISHED;
goto err;
}
p_enum_driver = enum_drv;
ENUM_EXIT_CRITICAL();
// Write-back client_ret pointer
*client_ret = (void *)enum_drv;
return ESP_OK;
err:
urb_free(urb);
alloc_err:
heap_caps_free(enum_drv);
return ret;
}
esp_err_t enum_uninstall(void)
{
ENUM_ENTER_CRITICAL();
ENUM_CHECK_FROM_CRIT(p_enum_driver != NULL, ESP_ERR_INVALID_STATE);
ENUM_EXIT_CRITICAL();
ENUM_ENTER_CRITICAL();
enum_driver_t *enum_drv = p_enum_driver;
p_enum_driver = NULL;
ENUM_EXIT_CRITICAL();
// Free resources
urb_free(enum_drv->constant.urb);
heap_caps_free(enum_drv);
return ESP_OK;
}
esp_err_t enum_start(unsigned int uid)
{
ENUM_ENTER_CRITICAL();
ENUM_CHECK_FROM_CRIT(p_enum_driver != NULL, ESP_ERR_INVALID_STATE);
ENUM_CHECK_FROM_CRIT(p_enum_driver->dynamic.flags.processing == 0, ESP_ERR_INVALID_STATE);
ENUM_EXIT_CRITICAL();
esp_err_t ret = ESP_FAIL;
// Open device and lock it for enumeration process
usb_device_handle_t dev_hdl;
ret = usbh_devs_open(0, &dev_hdl);
if (ret != ESP_OK) {
return ret;
}
ESP_ERROR_CHECK(usbh_dev_enum_lock(dev_hdl));
// Get device info
usb_device_info_t dev_info;
uint8_t parent_dev_addr = 0;
ESP_ERROR_CHECK(usbh_dev_get_info(dev_hdl, &dev_info));
if (dev_info.parent.dev_hdl) {
ESP_ERROR_CHECK(usbh_dev_get_addr(dev_info.parent.dev_hdl, &parent_dev_addr));
}
// Stage ENUM_STAGE_GET_SHORT_DEV_DESC
ESP_LOGD(ENUM_TAG, "[%d:%d] Start processing, device address %d",
parent_dev_addr,
dev_info.parent.port_num,
0);
ENUM_ENTER_CRITICAL();
p_enum_driver->dynamic.flags.processing = 1;
p_enum_driver->dynamic.stage = ENUM_STAGE_GET_SHORT_DEV_DESC;
ENUM_EXIT_CRITICAL();
p_enum_driver->single_thread.dev_uid = uid;
p_enum_driver->single_thread.dev_hdl = dev_hdl;
p_enum_driver->single_thread.parent_dev_hdl = dev_info.parent.dev_hdl;
p_enum_driver->single_thread.parent_dev_addr = parent_dev_addr;
p_enum_driver->single_thread.parent_port_num = dev_info.parent.port_num;
// Save device handle to the URB transfer context
p_enum_driver->constant.urb->transfer.context = (void *) dev_hdl;
// Device params
memset(&p_enum_driver->single_thread.dev_params, 0, sizeof(enum_device_params_t));
p_enum_driver->single_thread.dev_params.bMaxPacketSize0 = (dev_info.speed == USB_SPEED_LOW)
? ENUM_WORST_CASE_MPS_LS
: ENUM_WORST_CASE_MPS_FS_HS;
// Notify USB Host about starting enumeration process
enum_event_data_t event_data = {
.event = ENUM_EVENT_STARTED,
.started = {
.uid = uid,
.parent_dev_hdl = dev_info.parent.dev_hdl,
.parent_port_num = dev_info.parent.port_num,
},
};
p_enum_driver->constant.enum_event_cb(&event_data, p_enum_driver->constant.enum_event_cb_arg);
// Request processing
p_enum_driver->constant.proc_req_cb(USB_PROC_REQ_SOURCE_ENUM, false, p_enum_driver->constant.proc_req_cb_arg);
return ret;
}
esp_err_t enum_proceed(unsigned int uid)
{
ENUM_ENTER_CRITICAL();
ENUM_CHECK_FROM_CRIT(p_enum_driver != NULL, ESP_ERR_INVALID_STATE);
ENUM_CHECK_FROM_CRIT(p_enum_driver->dynamic.flags.processing != 0, ESP_ERR_INVALID_STATE);
ENUM_EXIT_CRITICAL();
// Request processing
p_enum_driver->constant.proc_req_cb(USB_PROC_REQ_SOURCE_ENUM, false, p_enum_driver->constant.proc_req_cb_arg);
return ESP_OK;
}
esp_err_t enum_cancel(unsigned int uid)
{
enum_stage_t stage = ENUM_STAGE_CANCEL;
ENUM_ENTER_CRITICAL();
ENUM_CHECK_FROM_CRIT(p_enum_driver != NULL, ESP_ERR_INVALID_STATE);
ENUM_CHECK_FROM_CRIT(p_enum_driver->dynamic.flags.processing != 0, ESP_ERR_INVALID_STATE);
stage = p_enum_driver->dynamic.stage;
p_enum_driver->dynamic.stage = ENUM_STAGE_CANCEL;
ENUM_EXIT_CRITICAL();
ESP_LOGV(ENUM_TAG, "[%d:%d] Cancel at %s",
p_enum_driver->single_thread.parent_dev_addr,
p_enum_driver->single_thread.parent_port_num,
enum_stage_strings[stage]);
// Nothing to do more here, will deal with that the very next enum_process()
return ESP_OK;
}
esp_err_t enum_process(void)
{
ENUM_ENTER_CRITICAL();
ENUM_CHECK_FROM_CRIT(p_enum_driver != NULL, ESP_ERR_INVALID_STATE);
ENUM_CHECK_FROM_CRIT(p_enum_driver->dynamic.flags.processing != 0, ESP_ERR_INVALID_STATE);
ENUM_EXIT_CRITICAL();
esp_err_t res = ESP_FAIL;
bool need_process_cb = true;
enum_stage_t stage = p_enum_driver->dynamic.stage;
switch (stage) {
// Transfer submission stages
case ENUM_STAGE_GET_SHORT_DEV_DESC:
case ENUM_STAGE_SET_ADDR:
case ENUM_STAGE_GET_FULL_DEV_DESC:
case ENUM_STAGE_GET_SHORT_CONFIG_DESC:
case ENUM_STAGE_GET_FULL_CONFIG_DESC:
case ENUM_STAGE_SET_CONFIG:
case ENUM_STAGE_GET_SHORT_LANGID_TABLE:
case ENUM_STAGE_GET_FULL_LANGID_TABLE:
case ENUM_STAGE_GET_SHORT_MANU_STR_DESC:
case ENUM_STAGE_GET_FULL_MANU_STR_DESC:
case ENUM_STAGE_GET_SHORT_PROD_STR_DESC:
case ENUM_STAGE_GET_FULL_PROD_STR_DESC:
case ENUM_STAGE_GET_SHORT_SER_STR_DESC:
case ENUM_STAGE_GET_FULL_SER_STR_DESC:
need_process_cb = false; // Do not need to request process callback, as we need to wait transfer completion
res = control_request();
break;
// Recovery interval
case ENUM_STAGE_SET_ADDR_RECOVERY:
// Need a short delay before device is ready. Todo: IDF-7007
vTaskDelay(pdMS_TO_TICKS(SET_ADDR_RECOVERY_INTERVAL_MS));
res = ESP_OK;
break;
// Transfer check stages
case ENUM_STAGE_CHECK_SHORT_DEV_DESC:
case ENUM_STAGE_CHECK_ADDR:
case ENUM_STAGE_CHECK_FULL_DEV_DESC:
case ENUM_STAGE_CHECK_SHORT_CONFIG_DESC:
case ENUM_STAGE_CHECK_FULL_CONFIG_DESC:
case ENUM_STAGE_CHECK_CONFIG:
case ENUM_STAGE_CHECK_SHORT_LANGID_TABLE:
case ENUM_STAGE_CHECK_FULL_LANGID_TABLE:
case ENUM_STAGE_CHECK_SHORT_MANU_STR_DESC:
case ENUM_STAGE_CHECK_FULL_MANU_STR_DESC:
case ENUM_STAGE_CHECK_SHORT_PROD_STR_DESC:
case ENUM_STAGE_CHECK_FULL_PROD_STR_DESC:
case ENUM_STAGE_CHECK_SHORT_SER_STR_DESC:
case ENUM_STAGE_CHECK_FULL_SER_STR_DESC:
res = control_response_handling();
break;
case ENUM_STAGE_SELECT_CONFIG:
res = select_active_configuration();
break;
case ENUM_STAGE_SECOND_RESET:
need_process_cb = false; // We need to wait Hub driver to finish port reset
res = second_reset();
break;
case ENUM_STAGE_CANCEL:
need_process_cb = false; // Terminal state
res = stage_cancel();
break;
case ENUM_STAGE_COMPLETE:
need_process_cb = false; // Terminal state
res = stage_complete();
break;
default:
// Should never occur
abort();
break;
}
// Set nest stage of enumeration process, based on the stage result
set_next_stage(res == ESP_OK);
// Request process callback is necessary
if (need_process_cb) {
p_enum_driver->constant.proc_req_cb(USB_PROC_REQ_SOURCE_ENUM, false, p_enum_driver->constant.proc_req_cb_arg);
}
return ESP_OK;
}