add tuh_address_set() API

minor rename and move code around
This commit is contained in:
hathach
2025-04-24 10:41:00 +07:00
parent 8b3c558881
commit 89f8d0cffb
2 changed files with 83 additions and 81 deletions

View File

@@ -105,13 +105,11 @@ typedef struct {
// Device Descriptor // Device Descriptor
uint8_t ep0_size; uint8_t ep0_size;
uint16_t idVendor;
uint16_t vid; uint16_t idProduct;
uint16_t pid; uint8_t iManufacturer;
uint8_t iProduct;
uint8_t i_manufacturer; uint8_t iSerialNumber;
uint8_t i_product;
uint8_t i_serial;
uint8_t bNumConfigurations; uint8_t bNumConfigurations;
// Configuration Descriptor // Configuration Descriptor
@@ -331,10 +329,10 @@ bool tuh_vid_pid_get(uint8_t dev_addr, uint16_t *vid, uint16_t *pid) {
*vid = *pid = 0; *vid = *pid = 0;
usbh_device_t const *dev = get_device(dev_addr); usbh_device_t const *dev = get_device(dev_addr);
TU_VERIFY(dev && dev->addressed && dev->vid != 0); TU_VERIFY(dev && dev->addressed && dev->idVendor != 0);
*vid = dev->vid; *vid = dev->idVendor;
*pid = dev->pid; *pid = dev->idProduct;
return true; return true;
} }
@@ -1094,24 +1092,24 @@ bool tuh_descriptor_get_manufacturer_string(uint8_t daddr, uint16_t language_id,
tuh_xfer_cb_t complete_cb, uintptr_t user_data) tuh_xfer_cb_t complete_cb, uintptr_t user_data)
{ {
usbh_device_t const* dev = get_device(daddr); usbh_device_t const* dev = get_device(daddr);
TU_VERIFY(dev && dev->i_manufacturer); TU_VERIFY(dev && dev->iManufacturer);
return tuh_descriptor_get_string(daddr, dev->i_manufacturer, language_id, buffer, len, complete_cb, user_data); return tuh_descriptor_get_string(daddr, dev->iManufacturer, language_id, buffer, len, complete_cb, user_data);
} }
// Get product string descriptor // Get product string descriptor
bool tuh_descriptor_get_product_string(uint8_t daddr, uint16_t language_id, void* buffer, uint16_t len, bool tuh_descriptor_get_product_string(uint8_t daddr, uint16_t language_id, void* buffer, uint16_t len,
tuh_xfer_cb_t complete_cb, uintptr_t user_data) { tuh_xfer_cb_t complete_cb, uintptr_t user_data) {
usbh_device_t const* dev = get_device(daddr); usbh_device_t const* dev = get_device(daddr);
TU_VERIFY(dev && dev->i_product); TU_VERIFY(dev && dev->iProduct);
return tuh_descriptor_get_string(daddr, dev->i_product, language_id, buffer, len, complete_cb, user_data); return tuh_descriptor_get_string(daddr, dev->iProduct, language_id, buffer, len, complete_cb, user_data);
} }
// Get serial string descriptor // Get serial string descriptor
bool tuh_descriptor_get_serial_string(uint8_t daddr, uint16_t language_id, void* buffer, uint16_t len, bool tuh_descriptor_get_serial_string(uint8_t daddr, uint16_t language_id, void* buffer, uint16_t len,
tuh_xfer_cb_t complete_cb, uintptr_t user_data) { tuh_xfer_cb_t complete_cb, uintptr_t user_data) {
usbh_device_t const* dev = get_device(daddr); usbh_device_t const* dev = get_device(daddr);
TU_VERIFY(dev && dev->i_serial); TU_VERIFY(dev && dev->iSerialNumber);
return tuh_descriptor_get_string(daddr, dev->i_serial, language_id, buffer, len, complete_cb, user_data); return tuh_descriptor_get_string(daddr, dev->iSerialNumber, language_id, buffer, len, complete_cb, user_data);
} }
// Get HID report descriptor // Get HID report descriptor
@@ -1142,6 +1140,33 @@ bool tuh_descriptor_get_hid_report(uint8_t daddr, uint8_t itf_num, uint8_t desc_
return tuh_control_xfer(&xfer); return tuh_control_xfer(&xfer);
} }
bool tuh_address_set(uint8_t daddr, uint8_t new_addr,
tuh_xfer_cb_t complete_cb, uintptr_t user_data) {
TU_LOG_USBH("Set Address = %d\r\n", new_addr);
const tusb_control_request_t request = {
.bmRequestType_bit = {
.recipient = TUSB_REQ_RCPT_DEVICE,
.type = TUSB_REQ_TYPE_STANDARD,
.direction = TUSB_DIR_OUT
},
.bRequest = TUSB_REQ_SET_ADDRESS,
.wValue = tu_htole16(new_addr),
.wIndex = 0,
.wLength = 0
};
tuh_xfer_t xfer = {
.daddr = daddr,
.ep_addr = 0,
.setup = &request,
.buffer = NULL,
.complete_cb = complete_cb,
.user_data = user_data
};
TU_ASSERT(tuh_control_xfer(&xfer));
return true;
}
bool tuh_configuration_set(uint8_t daddr, uint8_t config_num, bool tuh_configuration_set(uint8_t daddr, uint8_t config_num,
tuh_xfer_cb_t complete_cb, uintptr_t user_data) { tuh_xfer_cb_t complete_cb, uintptr_t user_data) {
TU_LOG_USBH("Set Configuration = %d\r\n", config_num); TU_LOG_USBH("Set Configuration = %d\r\n", config_num);
@@ -1373,7 +1398,7 @@ enum {
ENUM_CONFIG_DRIVER ENUM_CONFIG_DRIVER
}; };
static bool enum_request_set_addr(tusb_desc_device_t const* desc_device); static uint8_t enum_get_new_address(bool is_hub);
static bool enum_parse_configuration_desc (uint8_t dev_addr, tusb_desc_configuration_t const* desc_cfg); static bool enum_parse_configuration_desc (uint8_t dev_addr, tusb_desc_configuration_t const* desc_cfg);
static void enum_full_complete(void); static void enum_full_complete(void);
@@ -1466,9 +1491,19 @@ static void process_enumeration(tuh_xfer_t* xfer) {
break; break;
} }
case ENUM_SET_ADDR: case ENUM_SET_ADDR: {
enum_request_set_addr((tusb_desc_device_t*) _usbh_epbuf.ctrl); const tusb_desc_device_t *desc_device = (const tusb_desc_device_t *) _usbh_epbuf.ctrl;
const uint8_t new_addr = enum_get_new_address(desc_device->bDeviceClass == TUSB_CLASS_HUB);
TU_ASSERT(new_addr != 0,);
usbh_device_t* new_dev = get_device(new_addr);
new_dev->bus_info = _usbh_data.dev0_bus;
new_dev->connected = 1;
new_dev->ep0_size = desc_device->bMaxPacketSize0;
TU_ASSERT(tuh_address_set(0, new_addr, process_enumeration, ENUM_GET_DEVICE_DESC),);
break; break;
}
case ENUM_GET_DEVICE_DESC: { case ENUM_GET_DEVICE_DESC: {
// Allow 2ms for address recovery time, Ref USB Spec 9.2.6.3 // Allow 2ms for address recovery time, Ref USB Spec 9.2.6.3
@@ -1495,11 +1530,11 @@ static void process_enumeration(tuh_xfer_t* xfer) {
case ENUM_GET_STRING_LANGUAGE_ID_LEN: { case ENUM_GET_STRING_LANGUAGE_ID_LEN: {
// save the received device descriptor // save the received device descriptor
tusb_desc_device_t const *desc_device = (tusb_desc_device_t const *) _usbh_epbuf.ctrl; tusb_desc_device_t const *desc_device = (tusb_desc_device_t const *) _usbh_epbuf.ctrl;
dev->vid = desc_device->idVendor; dev->idVendor = desc_device->idVendor;
dev->pid = desc_device->idProduct; dev->idProduct = desc_device->idProduct;
dev->i_manufacturer = desc_device->iManufacturer; dev->iManufacturer = desc_device->iManufacturer;
dev->i_product = desc_device->iProduct; dev->iProduct = desc_device->iProduct;
dev->i_serial = desc_device->iSerialNumber; dev->iSerialNumber = desc_device->iSerialNumber;
dev->bNumConfigurations = desc_device->bNumConfigurations; dev->bNumConfigurations = desc_device->bNumConfigurations;
tuh_enum_descriptor_device_cb(daddr, desc_device); // callback tuh_enum_descriptor_device_cb(daddr, desc_device); // callback
@@ -1520,8 +1555,8 @@ static void process_enumeration(tuh_xfer_t* xfer) {
if (desc_langid->bLength >= 4) { if (desc_langid->bLength >= 4) {
langid = tu_le16toh(desc_langid->utf16le[0]); // previous request is langid langid = tu_le16toh(desc_langid->utf16le[0]); // previous request is langid
} }
if (dev->i_manufacturer != 0) { if (dev->iManufacturer != 0) {
tuh_descriptor_get_string(daddr, dev->i_manufacturer, langid, _usbh_epbuf.ctrl, 2, tuh_descriptor_get_string(daddr, dev->iManufacturer, langid, _usbh_epbuf.ctrl, 2,
process_enumeration, ENUM_GET_STRING_MANUFACTURER); process_enumeration, ENUM_GET_STRING_MANUFACTURER);
break; break;
}else { }else {
@@ -1530,10 +1565,10 @@ static void process_enumeration(tuh_xfer_t* xfer) {
} }
case ENUM_GET_STRING_MANUFACTURER: { case ENUM_GET_STRING_MANUFACTURER: {
if (dev->i_manufacturer != 0) { if (dev->iManufacturer != 0) {
langid = tu_le16toh(xfer->setup->wIndex); // langid from length's request langid = tu_le16toh(xfer->setup->wIndex); // langid from length's request
const uint8_t str_len = xfer->buffer[0]; const uint8_t str_len = xfer->buffer[0];
tuh_descriptor_get_string(daddr, dev->i_manufacturer, langid, _usbh_epbuf.ctrl, str_len, tuh_descriptor_get_string(daddr, dev->iManufacturer, langid, _usbh_epbuf.ctrl, str_len,
process_enumeration, ENUM_GET_STRING_PRODUCT_LEN); process_enumeration, ENUM_GET_STRING_PRODUCT_LEN);
break; break;
} else { } else {
@@ -1542,11 +1577,11 @@ static void process_enumeration(tuh_xfer_t* xfer) {
} }
case ENUM_GET_STRING_PRODUCT_LEN: case ENUM_GET_STRING_PRODUCT_LEN:
if (dev->i_product != 0) { if (dev->iProduct != 0) {
if (state == ENUM_GET_STRING_PRODUCT_LEN) { if (state == ENUM_GET_STRING_PRODUCT_LEN) {
langid = tu_le16toh(xfer->setup->wIndex); // get langid from previous setup packet if not fall through langid = tu_le16toh(xfer->setup->wIndex); // get langid from previous setup packet if not fall through
} }
tuh_descriptor_get_string(daddr, dev->i_product, langid, _usbh_epbuf.ctrl, 2, tuh_descriptor_get_string(daddr, dev->iProduct, langid, _usbh_epbuf.ctrl, 2,
process_enumeration, ENUM_GET_STRING_PRODUCT); process_enumeration, ENUM_GET_STRING_PRODUCT);
break; break;
} else { } else {
@@ -1554,10 +1589,10 @@ static void process_enumeration(tuh_xfer_t* xfer) {
} }
case ENUM_GET_STRING_PRODUCT: { case ENUM_GET_STRING_PRODUCT: {
if (dev->i_product != 0) { if (dev->iProduct != 0) {
langid = tu_le16toh(xfer->setup->wIndex); // langid from length's request langid = tu_le16toh(xfer->setup->wIndex); // langid from length's request
const uint8_t str_len = xfer->buffer[0]; const uint8_t str_len = xfer->buffer[0];
tuh_descriptor_get_string(daddr, dev->i_product, langid, _usbh_epbuf.ctrl, str_len, tuh_descriptor_get_string(daddr, dev->iProduct, langid, _usbh_epbuf.ctrl, str_len,
process_enumeration, ENUM_GET_STRING_SERIAL_LEN); process_enumeration, ENUM_GET_STRING_SERIAL_LEN);
break; break;
} else { } else {
@@ -1566,11 +1601,11 @@ static void process_enumeration(tuh_xfer_t* xfer) {
} }
case ENUM_GET_STRING_SERIAL_LEN: case ENUM_GET_STRING_SERIAL_LEN:
if (dev->i_serial != 0) { if (dev->iSerialNumber != 0) {
if (state == ENUM_GET_STRING_SERIAL_LEN) { if (state == ENUM_GET_STRING_SERIAL_LEN) {
langid = tu_le16toh(xfer->setup->wIndex); // get langid from previous setup packet if not fall through langid = tu_le16toh(xfer->setup->wIndex); // get langid from previous setup packet if not fall through
} }
tuh_descriptor_get_string(daddr, dev->i_serial, langid, _usbh_epbuf.ctrl, 2, tuh_descriptor_get_string(daddr, dev->iSerialNumber, langid, _usbh_epbuf.ctrl, 2,
process_enumeration, ENUM_GET_STRING_SERIAL); process_enumeration, ENUM_GET_STRING_SERIAL);
break; break;
} else { } else {
@@ -1578,10 +1613,10 @@ static void process_enumeration(tuh_xfer_t* xfer) {
} }
case ENUM_GET_STRING_SERIAL: { case ENUM_GET_STRING_SERIAL: {
if (dev->i_serial != 0) { if (dev->iSerialNumber != 0) {
langid = tu_le16toh(xfer->setup->wIndex); // langid from length's request langid = tu_le16toh(xfer->setup->wIndex); // langid from length's request
const uint8_t str_len = xfer->buffer[0]; const uint8_t str_len = xfer->buffer[0];
tuh_descriptor_get_string(daddr, dev->i_serial, langid, _usbh_epbuf.ctrl, str_len, tuh_descriptor_get_string(daddr, dev->iSerialNumber, langid, _usbh_epbuf.ctrl, str_len,
process_enumeration, ENUM_GET_9BYTE_CONFIG_DESC); process_enumeration, ENUM_GET_9BYTE_CONFIG_DESC);
break; break;
} else { } else {
@@ -1657,12 +1692,12 @@ static bool enum_new_device(hcd_event_t* event) {
dev0_bus->hub_addr = event->connection.hub_addr; dev0_bus->hub_addr = event->connection.hub_addr;
dev0_bus->hub_port = event->connection.hub_port; dev0_bus->hub_port = event->connection.hub_port;
if (dev0_bus->hub_addr == 0) {
// connected directly to roothub
// wait until device connection is stable TODO non blocking // wait until device connection is stable TODO non blocking
tusb_time_delay_ms_api(ENUM_DEBOUNCING_DELAY_MS); tusb_time_delay_ms_api(ENUM_DEBOUNCING_DELAY_MS);
if (dev0_bus->hub_addr == 0) {
// connected directly to roothub
if (!hcd_port_connect_status(dev0_bus->rhport)) { if (!hcd_port_connect_status(dev0_bus->rhport)) {
TU_LOG_USBH("Device unplugged while debouncing\r\n"); TU_LOG_USBH("Device unplugged while debouncing\r\n");
enum_full_complete(); enum_full_complete();
@@ -1696,10 +1731,6 @@ static bool enum_new_device(hcd_event_t* event) {
#if CFG_TUH_HUB #if CFG_TUH_HUB
else { else {
// connected via external hub // connected via external hub
// wait until device connection is stable TODO non blocking
tusb_time_delay_ms_api(ENUM_DEBOUNCING_DELAY_MS);
// ENUM_HUB_GET_STATUS
TU_ASSERT(hub_port_get_status(dev0_bus->hub_addr, dev0_bus->hub_port, _usbh_epbuf.ctrl, TU_ASSERT(hub_port_get_status(dev0_bus->hub_addr, dev0_bus->hub_port, _usbh_epbuf.ctrl,
process_enumeration, ENUM_HUB_CLEAR_RESET_1)); process_enumeration, ENUM_HUB_CLEAR_RESET_1));
} }
@@ -1708,7 +1739,7 @@ static bool enum_new_device(hcd_event_t* event) {
return true; return true;
} }
static uint8_t get_new_address(bool is_hub) { static uint8_t enum_get_new_address(bool is_hub) {
uint8_t start; uint8_t start;
uint8_t end; uint8_t end;
@@ -1721,47 +1752,14 @@ static uint8_t get_new_address(bool is_hub) {
} }
for (uint8_t idx = start; idx < end; idx++) { for (uint8_t idx = start; idx < end; idx++) {
if (!_usbh_devices[idx].connected) return (idx+1); if (!_usbh_devices[idx].connected) {
return (idx + 1);
}
} }
return 0; // invalid address return 0; // invalid address
} }
static bool enum_request_set_addr(tusb_desc_device_t const* desc_device) {
// Get new address
uint8_t const new_addr = get_new_address(desc_device->bDeviceClass == TUSB_CLASS_HUB);
TU_ASSERT(new_addr != 0);
TU_LOG_USBH("Set Address = %d\r\n", new_addr);
usbh_device_t* new_dev = get_device(new_addr);
new_dev->bus_info = _usbh_data.dev0_bus;
new_dev->connected = 1;
new_dev->ep0_size = desc_device->bMaxPacketSize0;
tusb_control_request_t const request = {
.bmRequestType_bit = {
.recipient = TUSB_REQ_RCPT_DEVICE,
.type = TUSB_REQ_TYPE_STANDARD,
.direction = TUSB_DIR_OUT
},
.bRequest = TUSB_REQ_SET_ADDRESS,
.wValue = tu_htole16(new_addr),
.wIndex = 0,
.wLength = 0
};
tuh_xfer_t xfer = {
.daddr = 0,
.ep_addr = 0,
.setup = &request,
.buffer = NULL,
.complete_cb = process_enumeration,
.user_data = ENUM_GET_DEVICE_DESC
};
TU_ASSERT(tuh_control_xfer(&xfer));
return true;
}
static bool enum_parse_configuration_desc(uint8_t dev_addr, tusb_desc_configuration_t const* desc_cfg) { static bool enum_parse_configuration_desc(uint8_t dev_addr, tusb_desc_configuration_t const* desc_cfg) {
usbh_device_t* dev = get_device(dev_addr); usbh_device_t* dev = get_device(dev_addr);
uint16_t const total_len = tu_le16toh(desc_cfg->wTotalLength); uint16_t const total_len = tu_le16toh(desc_cfg->wTotalLength);

View File

@@ -250,6 +250,10 @@ bool tuh_edpt_close(uint8_t daddr, uint8_t ep_addr);
// Return true if a queued transfer is aborted, false if there is no transfer to abort // Return true if a queued transfer is aborted, false if there is no transfer to abort
bool tuh_edpt_abort_xfer(uint8_t daddr, uint8_t ep_addr); bool tuh_edpt_abort_xfer(uint8_t daddr, uint8_t ep_addr);
// Set Address (control transfer)
bool tuh_address_set(uint8_t daddr, uint8_t new_addr,
tuh_xfer_cb_t complete_cb, uintptr_t user_data);
// Set Configuration (control transfer) // Set Configuration (control transfer)
// config_num = 0 will un-configure device. Note: config_num = config_descriptor_index + 1 // config_num = 0 will un-configure device. Note: config_num = config_descriptor_index + 1
// true on success, false if there is on-going control transfer or incorrect parameters // true on success, false if there is on-going control transfer or incorrect parameters