sepearate CFG_TUH_DEVICE_MAX and CFG_TUH_HUB

separate dev0 from _usbh_devices pool to save sram
This commit is contained in:
hathach 2021-08-23 19:56:53 +07:00
parent 75cd593b60
commit 3309425211
7 changed files with 93 additions and 63 deletions

View File

@ -80,7 +80,8 @@
#define CFG_TUH_MSC 1 #define CFG_TUH_MSC 1
#define CFG_TUH_VENDOR 0 #define CFG_TUH_VENDOR 0
#define CFG_TUH_DEVICE_MAX (CFG_TUH_HUB ? 5 : 1) // normal hub has 4 ports // max device support (excluding hub device)
#define CFG_TUH_DEVICE_MAX (CFG_TUH_HUB ? 4 : 1) // hub typically has 4 ports
//------------- HID -------------// //------------- HID -------------//
#define CFG_TUH_HID_EPIN_BUFSIZE 64 #define CFG_TUH_HID_EPIN_BUFSIZE 64

View File

@ -240,6 +240,8 @@ bool cdch_xfer_cb(uint8_t dev_addr, uint8_t ep_addr, xfer_result_t event, uint32
void cdch_close(uint8_t dev_addr) void cdch_close(uint8_t dev_addr)
{ {
TU_VERIFY(dev_addr <= CFG_TUH_DEVICE_MAX, );
cdch_data_t * p_cdc = get_itf(dev_addr); cdch_data_t * p_cdc = get_itf(dev_addr);
tu_memclr(p_cdc, sizeof(cdch_data_t)); tu_memclr(p_cdc, sizeof(cdch_data_t));
} }

View File

@ -62,7 +62,7 @@ typedef struct
hidh_interface_t instances[CFG_TUH_HID]; hidh_interface_t instances[CFG_TUH_HID];
} hidh_device_t; } hidh_device_t;
static hidh_device_t _hidh_dev[CFG_TUH_DEVICE_MAX-1]; static hidh_device_t _hidh_dev[CFG_TUH_DEVICE_MAX];
//------------- Internal prototypes -------------// //------------- Internal prototypes -------------//
@ -240,6 +240,8 @@ bool hidh_xfer_cb(uint8_t dev_addr, uint8_t ep_addr, xfer_result_t result, uint3
void hidh_close(uint8_t dev_addr) void hidh_close(uint8_t dev_addr)
{ {
TU_VERIFY(dev_addr <= CFG_TUH_DEVICE_MAX, );
hidh_device_t* hid_dev = get_dev(dev_addr); hidh_device_t* hid_dev = get_dev(dev_addr);
if (tuh_hid_umount_cb) if (tuh_hid_umount_cb)
{ {

View File

@ -76,6 +76,7 @@ CFG_TUSB_MEM_SECTION static msch_interface_t _msch_itf[CFG_TUH_DEVICE_MAX];
CFG_TUSB_MEM_SECTION TU_ATTR_ALIGNED(4) CFG_TUSB_MEM_SECTION TU_ATTR_ALIGNED(4)
static uint8_t _msch_buffer[sizeof(scsi_inquiry_resp_t)]; static uint8_t _msch_buffer[sizeof(scsi_inquiry_resp_t)];
TU_ATTR_ALWAYS_INLINE
static inline msch_interface_t* get_itf(uint8_t dev_addr) static inline msch_interface_t* get_itf(uint8_t dev_addr)
{ {
return &_msch_itf[dev_addr-1]; return &_msch_itf[dev_addr-1];
@ -291,11 +292,13 @@ bool tuh_msc_reset(uint8_t dev_addr)
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
void msch_init(void) void msch_init(void)
{ {
tu_memclr(_msch_itf, sizeof(msch_interface_t)*CFG_TUH_DEVICE_MAX); tu_memclr(_msch_itf, sizeof(_msch_itf));
} }
void msch_close(uint8_t dev_addr) void msch_close(uint8_t dev_addr)
{ {
TU_VERIFY(dev_addr <= CFG_TUH_DEVICE_MAX, );
msch_interface_t* p_msc = get_itf(dev_addr); msch_interface_t* p_msc = get_itf(dev_addr);
// invoke Application Callback // invoke Application Callback

View File

@ -48,6 +48,12 @@ typedef struct
CFG_TUSB_MEM_SECTION static hub_interface_t hub_data[CFG_TUH_HUB]; CFG_TUSB_MEM_SECTION static hub_interface_t hub_data[CFG_TUH_HUB];
CFG_TUSB_MEM_SECTION TU_ATTR_ALIGNED(4) static uint8_t _hub_buffer[sizeof(descriptor_hub_desc_t)]; CFG_TUSB_MEM_SECTION TU_ATTR_ALIGNED(4) static uint8_t _hub_buffer[sizeof(descriptor_hub_desc_t)];
TU_ATTR_ALWAYS_INLINE
static inline hub_interface_t* get_itf(uint8_t dev_addr)
{
return &hub_data[dev_addr-1-CFG_TUH_DEVICE_MAX];
}
#if CFG_TUSB_DEBUG #if CFG_TUSB_DEBUG
static char const* const _hub_feature_str[] = static char const* const _hub_feature_str[] =
{ {
@ -167,21 +173,26 @@ bool hub_open(uint8_t rhport, uint8_t dev_addr, tusb_desc_interface_t const *itf
TU_ASSERT(usbh_edpt_open(rhport, dev_addr, desc_ep)); TU_ASSERT(usbh_edpt_open(rhport, dev_addr, desc_ep));
hub_data[dev_addr-1].itf_num = itf_desc->bInterfaceNumber; hub_interface_t* p_hub = get_itf(dev_addr);
hub_data[dev_addr-1].ep_in = desc_ep->bEndpointAddress;
p_hub->itf_num = itf_desc->bInterfaceNumber;
p_hub->ep_in = desc_ep->bEndpointAddress;
return true; return true;
} }
void hub_close(uint8_t dev_addr) void hub_close(uint8_t dev_addr)
{ {
tu_memclr(&hub_data[dev_addr-1], sizeof( hub_interface_t)); TU_VERIFY(dev_addr > CFG_TUH_DEVICE_MAX, );
hub_interface_t* p_hub = get_itf(dev_addr);
if (p_hub->ep_in) tu_memclr(p_hub, sizeof( hub_interface_t));
} }
bool hub_status_pipe_queue(uint8_t dev_addr) bool hub_status_pipe_queue(uint8_t dev_addr)
{ {
hub_interface_t * p_hub = &hub_data[dev_addr-1]; hub_interface_t* hub_itf = get_itf(dev_addr);
return usbh_edpt_xfer(dev_addr, p_hub->ep_in, &p_hub->status_change, 1); return usbh_edpt_xfer(dev_addr, hub_itf->ep_in, &hub_itf->status_change, 1);
} }
@ -194,7 +205,7 @@ static bool config_port_power_complete (uint8_t dev_addr, tusb_control_request_t
bool hub_set_config(uint8_t dev_addr, uint8_t itf_num) bool hub_set_config(uint8_t dev_addr, uint8_t itf_num)
{ {
hub_interface_t* p_hub = &hub_data[dev_addr-1]; hub_interface_t* p_hub = get_itf(dev_addr);
TU_ASSERT(itf_num == p_hub->itf_num); TU_ASSERT(itf_num == p_hub->itf_num);
// Get Hub Descriptor // Get Hub Descriptor
@ -222,7 +233,7 @@ static bool config_set_port_power (uint8_t dev_addr, tusb_control_request_t cons
(void) request; (void) request;
TU_ASSERT(XFER_RESULT_SUCCESS == result); TU_ASSERT(XFER_RESULT_SUCCESS == result);
hub_interface_t* p_hub = &hub_data[dev_addr-1]; hub_interface_t* p_hub = get_itf(dev_addr);
// only use number of ports in hub descriptor // only use number of ports in hub descriptor
descriptor_hub_desc_t const* desc_hub = (descriptor_hub_desc_t const*) _hub_buffer; descriptor_hub_desc_t const* desc_hub = (descriptor_hub_desc_t const*) _hub_buffer;
@ -238,7 +249,7 @@ static bool config_set_port_power (uint8_t dev_addr, tusb_control_request_t cons
static bool config_port_power_complete (uint8_t dev_addr, tusb_control_request_t const * request, xfer_result_t result) static bool config_port_power_complete (uint8_t dev_addr, tusb_control_request_t const * request, xfer_result_t result)
{ {
TU_ASSERT(XFER_RESULT_SUCCESS == result); TU_ASSERT(XFER_RESULT_SUCCESS == result);
hub_interface_t* p_hub = &hub_data[dev_addr-1]; hub_interface_t* p_hub = get_itf(dev_addr);
if (request->wIndex == p_hub->port_count) if (request->wIndex == p_hub->port_count)
{ {
@ -272,7 +283,7 @@ bool hub_xfer_cb(uint8_t dev_addr, uint8_t ep_addr, xfer_result_t result, uint32
(void) ep_addr; (void) ep_addr;
TU_ASSERT(result == XFER_RESULT_SUCCESS); TU_ASSERT(result == XFER_RESULT_SUCCESS);
hub_interface_t * p_hub = &hub_data[dev_addr-1]; hub_interface_t* p_hub = get_itf(dev_addr);
TU_LOG2(" Port Status Change = 0x%02X\r\n", p_hub->status_change); TU_LOG2(" Port Status Change = 0x%02X\r\n", p_hub->status_change);
@ -294,7 +305,8 @@ bool hub_xfer_cb(uint8_t dev_addr, uint8_t ep_addr, xfer_result_t result, uint32
static bool connection_get_status_complete (uint8_t dev_addr, tusb_control_request_t const * request, xfer_result_t result) static bool connection_get_status_complete (uint8_t dev_addr, tusb_control_request_t const * request, xfer_result_t result)
{ {
TU_ASSERT(result == XFER_RESULT_SUCCESS); TU_ASSERT(result == XFER_RESULT_SUCCESS);
hub_interface_t * p_hub = &hub_data[dev_addr-1];
hub_interface_t* p_hub = get_itf(dev_addr);
uint8_t const port_num = (uint8_t) request->wIndex; uint8_t const port_num = (uint8_t) request->wIndex;
// Connection change // Connection change
@ -322,7 +334,7 @@ static bool connection_clear_conn_change_complete (uint8_t dev_addr, tusb_contro
{ {
TU_ASSERT(result == XFER_RESULT_SUCCESS); TU_ASSERT(result == XFER_RESULT_SUCCESS);
hub_interface_t * p_hub = &hub_data[dev_addr-1]; hub_interface_t* p_hub = get_itf(dev_addr);
uint8_t const port_num = (uint8_t) request->wIndex; uint8_t const port_num = (uint8_t) request->wIndex;
if ( p_hub->port_status.status.connection ) if ( p_hub->port_status.status.connection )
@ -353,7 +365,7 @@ static bool connection_port_reset_complete (uint8_t dev_addr, tusb_control_reque
{ {
TU_ASSERT(result == XFER_RESULT_SUCCESS); TU_ASSERT(result == XFER_RESULT_SUCCESS);
// usbh_hub_t * p_hub = &hub_data[dev_addr-1]; // hub_interface_t* p_hub = get_itf(dev_addr);
uint8_t const port_num = (uint8_t) request->wIndex; uint8_t const port_num = (uint8_t) request->wIndex;
// submit attach event // submit attach event

View File

@ -99,6 +99,14 @@ typedef struct {
} usbh_device_t; } usbh_device_t;
typedef struct
{
uint8_t rhport;
uint8_t hub_addr;
uint8_t hub_port;
uint8_t speed;
} usbh_dev0_t;
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// MACRO CONSTANT TYPEDEF // MACRO CONSTANT TYPEDEF
@ -106,6 +114,7 @@ typedef struct {
// Invalid driver ID in itf2drv[] ep2drv[][] mapping // Invalid driver ID in itf2drv[] ep2drv[][] mapping
enum { DRVID_INVALID = 0xFFu }; enum { DRVID_INVALID = 0xFFu };
enum { ADDR_INVALID = 0xFFu };
#if CFG_TUSB_DEBUG >= 2 #if CFG_TUSB_DEBUG >= 2
#define DRIVER_NAME(_name) .name = _name, #define DRIVER_NAME(_name) .name = _name,
@ -183,9 +192,12 @@ enum { CONFIG_NUM = 1 }; // default to use configuration 1
static bool _usbh_initialized = false; static bool _usbh_initialized = false;
// Device with address = 0 for enumeration
static usbh_dev0_t _dev0;
// all devices including hub and zero-address TODO exclude device0 to save space // all devices including hub and zero-address TODO exclude device0 to save space
// hub address start from CFG_TUH_DEVICE_MAX // hub address start from CFG_TUH_DEVICE_MAX+1
CFG_TUSB_MEM_SECTION usbh_device_t _usbh_devices[1+CFG_TUH_DEVICE_MAX+CFG_TUH_HUB]; CFG_TUSB_MEM_SECTION usbh_device_t _usbh_devices[1 + CFG_TUH_DEVICE_MAX + CFG_TUH_HUB];
// Event queue // Event queue
// role device/host is used by OS NONE for mutex (disable usb isr) // role device/host is used by OS NONE for mutex (disable usb isr)
@ -214,13 +226,13 @@ extern bool usbh_control_xfer_cb (uint8_t dev_addr, uint8_t ep_addr, xfer_result
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
bool tuh_device_configured(uint8_t dev_addr) bool tuh_device_configured(uint8_t dev_addr)
{ {
return _usbh_devices[dev_addr].configured; return get_device(dev_addr)->configured;
} }
tusb_speed_t tuh_device_get_speed (uint8_t const dev_addr) tusb_speed_t tuh_device_get_speed (uint8_t const dev_addr)
{ {
TU_ASSERT( dev_addr <= CFG_TUH_DEVICE_MAX, TUSB_SPEED_INVALID); TU_ASSERT( dev_addr <= CFG_TUH_DEVICE_MAX + CFG_TUH_HUB, TUSB_SPEED_INVALID);
return (tusb_speed_t) _usbh_devices[dev_addr].speed; return (tusb_speed_t) get_device(dev_addr)->speed;
} }
#if CFG_TUSB_OS == OPT_OS_NONE #if CFG_TUSB_OS == OPT_OS_NONE
@ -250,15 +262,16 @@ bool tuh_init(uint8_t rhport)
TU_LOG2("USBH init\r\n"); TU_LOG2("USBH init\r\n");
tu_memclr(_usbh_devices, sizeof(_usbh_devices)); tu_memclr(_usbh_devices, sizeof(_usbh_devices));
tu_memclr(&_dev0, sizeof(_dev0));
//------------- Enumeration & Reporter Task init -------------// //------------- Enumeration & Reporter Task init -------------//
_usbh_q = osal_queue_create( &_usbh_qdef ); _usbh_q = osal_queue_create( &_usbh_qdef );
TU_ASSERT(_usbh_q != NULL); TU_ASSERT(_usbh_q != NULL);
//------------- Semaphore, Mutex for Control Pipe -------------// //------------- Semaphore, Mutex for Control Pipe -------------//
for(uint8_t i=0; i<CFG_TUH_DEVICE_MAX+1; i++) // including address zero for(uint8_t i=0; i<TU_ARRAY_SIZE(_usbh_devices); i++)
{ {
usbh_device_t * const dev = &_usbh_devices[i]; usbh_device_t * dev = &_usbh_devices[i];
#if CFG_TUSB_OS != OPT_OS_NONE #if CFG_TUSB_OS != OPT_OS_NONE
dev->mutex = osal_mutex_create(&dev->mutexdef); dev->mutex = osal_mutex_create(&dev->mutexdef);
@ -460,7 +473,7 @@ void hcd_event_device_remove(uint8_t hostid, bool in_isr)
void process_device_unplugged(uint8_t rhport, uint8_t hub_addr, uint8_t hub_port) void process_device_unplugged(uint8_t rhport, uint8_t hub_addr, uint8_t hub_port)
{ {
//------------- find the all devices (star-network) under port that is unplugged -------------// //------------- find the all devices (star-network) under port that is unplugged -------------//
for (uint8_t dev_addr = 0; dev_addr <= CFG_TUH_DEVICE_MAX; dev_addr ++) for (uint8_t dev_addr = 0; dev_addr < TU_ARRAY_SIZE(_usbh_devices); dev_addr ++)
{ {
usbh_device_t* dev = &_usbh_devices[dev_addr]; usbh_device_t* dev = &_usbh_devices[dev_addr];
@ -493,13 +506,17 @@ void process_device_unplugged(uint8_t rhport, uint8_t hub_addr, uint8_t hub_port
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// INTERNAL HELPER // INTERNAL HELPER
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
static uint8_t get_new_address(void) static uint8_t get_new_address(bool is_hub)
{ {
for (uint8_t addr=1; addr <= CFG_TUH_DEVICE_MAX; addr++) uint8_t const start = (is_hub ? CFG_TUH_DEVICE_MAX : 0) + 1;
uint8_t const count = (is_hub ? CFG_TUH_HUB : CFG_TUH_DEVICE_MAX);
for (uint8_t i=0; i < count; i++)
{ {
uint8_t const addr = start + i;
if (_usbh_devices[addr].state == TUSB_DEVICE_STATE_UNPLUG) return addr; if (_usbh_devices[addr].state == TUSB_DEVICE_STATE_UNPLUG) return addr;
} }
return CFG_TUH_DEVICE_MAX+1; return ADDR_INVALID;
} }
void usbh_driver_set_config_complete(uint8_t dev_addr, uint8_t itf_num) void usbh_driver_set_config_complete(uint8_t dev_addr, uint8_t itf_num)
@ -561,12 +578,11 @@ static bool enum_hub_clear_reset1_complete(uint8_t dev_addr, tusb_control_reques
{ {
(void) dev_addr; (void) request; (void) dev_addr; (void) request;
TU_ASSERT(XFER_RESULT_SUCCESS == result); TU_ASSERT(XFER_RESULT_SUCCESS == result);
usbh_device_t* dev0 = &_usbh_devices[0];
enum_request_set_addr(); enum_request_set_addr();
// done with hub, waiting for next data on status pipe // done with hub, waiting for next data on status pipe
(void) hub_status_pipe_queue( dev0->hub_addr ); (void) hub_status_pipe_queue( _dev0.hub_addr );
return true; return true;
} }
@ -575,7 +591,6 @@ static bool enum_hub_get_status1_complete(uint8_t dev_addr, tusb_control_request
{ {
(void) dev_addr; (void) request; (void) dev_addr; (void) request;
TU_ASSERT(XFER_RESULT_SUCCESS == result); TU_ASSERT(XFER_RESULT_SUCCESS == result);
usbh_device_t* dev0 = &_usbh_devices[0];
hub_port_status_response_t port_status; hub_port_status_response_t port_status;
memcpy(&port_status, _usbh_ctrl_buf, sizeof(hub_port_status_response_t)); memcpy(&port_status, _usbh_ctrl_buf, sizeof(hub_port_status_response_t));
@ -583,7 +598,7 @@ static bool enum_hub_get_status1_complete(uint8_t dev_addr, tusb_control_request
// Acknowledge Port Reset Change if Reset Successful // Acknowledge Port Reset Change if Reset Successful
if (port_status.change.reset) if (port_status.change.reset)
{ {
TU_ASSERT( hub_port_clear_feature(dev0->hub_addr, dev0->hub_port, HUB_FEATURE_PORT_RESET_CHANGE, enum_hub_clear_reset1_complete) ); TU_ASSERT( hub_port_clear_feature(_dev0.hub_addr, _dev0.hub_port, HUB_FEATURE_PORT_RESET_CHANGE, enum_hub_clear_reset1_complete) );
} }
return true; return true;
@ -593,7 +608,6 @@ static bool enum_hub_get_status0_complete(uint8_t dev_addr, tusb_control_request
{ {
(void) dev_addr; (void) request; (void) dev_addr; (void) request;
TU_ASSERT(XFER_RESULT_SUCCESS == result); TU_ASSERT(XFER_RESULT_SUCCESS == result);
usbh_device_t* dev0 = &_usbh_devices[0];
hub_port_status_response_t port_status; hub_port_status_response_t port_status;
memcpy(&port_status, _usbh_ctrl_buf, sizeof(hub_port_status_response_t)); memcpy(&port_status, _usbh_ctrl_buf, sizeof(hub_port_status_response_t));
@ -604,13 +618,13 @@ static bool enum_hub_get_status0_complete(uint8_t dev_addr, tusb_control_request
return hub_status_pipe_queue(dev_addr); return hub_status_pipe_queue(dev_addr);
} }
dev0->speed = (port_status.status.high_speed) ? TUSB_SPEED_HIGH : _dev0.speed = (port_status.status.high_speed) ? TUSB_SPEED_HIGH :
(port_status.status.low_speed ) ? TUSB_SPEED_LOW : TUSB_SPEED_FULL; (port_status.status.low_speed ) ? TUSB_SPEED_LOW : TUSB_SPEED_FULL;
// Acknowledge Port Reset Change // Acknowledge Port Reset Change
if (port_status.change.reset) if (port_status.change.reset)
{ {
hub_port_clear_feature(dev0->hub_addr, dev0->hub_port, HUB_FEATURE_PORT_RESET_CHANGE, enum_hub_clear_reset0_complete); hub_port_clear_feature(_dev0.hub_addr, _dev0.hub_port, HUB_FEATURE_PORT_RESET_CHANGE, enum_hub_clear_reset0_complete);
} }
return true; return true;
@ -619,21 +633,22 @@ static bool enum_hub_get_status0_complete(uint8_t dev_addr, tusb_control_request
static bool enum_request_set_addr(void) static bool enum_request_set_addr(void)
{ {
// Set Address tusb_desc_device_t const * desc_device = (tusb_desc_device_t const*) _usbh_ctrl_buf;
uint8_t const new_addr = get_new_address();
TU_ASSERT(new_addr <= CFG_TUH_DEVICE_MAX); // TODO notify application we reach max devices // Get new address
uint8_t const new_addr = get_new_address(desc_device->bDeviceClass == TUSB_CLASS_HUB);
TU_ASSERT(new_addr != ADDR_INVALID);
TU_LOG2("Set Address = %d\r\n", new_addr); TU_LOG2("Set Address = %d\r\n", new_addr);
usbh_device_t* dev0 = &_usbh_devices[0];
usbh_device_t* new_dev = &_usbh_devices[new_addr]; usbh_device_t* new_dev = &_usbh_devices[new_addr];
new_dev->rhport = dev0->rhport; new_dev->rhport = _dev0.rhport;
new_dev->hub_addr = dev0->hub_addr; new_dev->hub_addr = _dev0.hub_addr;
new_dev->hub_port = dev0->hub_port; new_dev->hub_port = _dev0.hub_port;
new_dev->speed = dev0->speed; new_dev->speed = _dev0.speed;
new_dev->connected = 1; new_dev->connected = 1;
new_dev->ep0_packet_size = ((tusb_desc_device_t*) _usbh_ctrl_buf)->bMaxPacketSize0; new_dev->ep0_packet_size = desc_device->bMaxPacketSize0;
tusb_control_request_t const new_request = tusb_control_request_t const new_request =
{ {
@ -656,22 +671,20 @@ static bool enum_request_set_addr(void)
static bool enum_new_device(hcd_event_t* event) static bool enum_new_device(hcd_event_t* event)
{ {
usbh_device_t* dev0 = &_usbh_devices[0]; _dev0.rhport = event->rhport; // TODO refractor integrate to device_pool
dev0->rhport = event->rhport; // TODO refractor integrate to device_pool _dev0.hub_addr = event->connection.hub_addr;
dev0->hub_addr = event->connection.hub_addr; _dev0.hub_port = event->connection.hub_port;
dev0->hub_port = event->connection.hub_port;
dev0->state = TUSB_DEVICE_STATE_UNPLUG;
//------------- connected/disconnected directly with roothub -------------// //------------- connected/disconnected directly with roothub -------------//
if (dev0->hub_addr == 0) if (_dev0.hub_addr == 0)
{ {
// wait until device is stable TODO non blocking // wait until device is stable TODO non blocking
osal_task_delay(RESET_DELAY); osal_task_delay(RESET_DELAY);
// device unplugged while delaying // device unplugged while delaying
if ( !hcd_port_connect_status(dev0->rhport) ) return true; if ( !hcd_port_connect_status(_dev0.rhport) ) return true;
dev0->speed = hcd_port_speed_get( dev0->rhport ); _dev0.speed = hcd_port_speed_get(_dev0.rhport );
enum_request_addr0_device_desc(); enum_request_addr0_device_desc();
} }
@ -681,7 +694,7 @@ static bool enum_new_device(hcd_event_t* event)
{ {
// wait until device is stable // wait until device is stable
osal_task_delay(RESET_DELAY); osal_task_delay(RESET_DELAY);
TU_ASSERT( hub_port_get_status(dev0->hub_addr, dev0->hub_port, _usbh_ctrl_buf, enum_hub_get_status0_complete) ); TU_ASSERT( hub_port_get_status(_dev0.hub_addr, _dev0.hub_port, _usbh_ctrl_buf, enum_hub_get_status0_complete) );
} }
#endif // CFG_TUH_HUB #endif // CFG_TUH_HUB
@ -719,27 +732,26 @@ static bool enum_get_addr0_device_desc_complete(uint8_t dev_addr, tusb_control_r
(void) request; (void) request;
TU_ASSERT(0 == dev_addr); TU_ASSERT(0 == dev_addr);
usbh_device_t* dev0 = &_usbh_devices[0];
if (XFER_RESULT_SUCCESS != result) if (XFER_RESULT_SUCCESS != result)
{ {
#if CFG_TUH_HUB #if CFG_TUH_HUB
// TODO remove, waiting for next data on status pipe // TODO remove, waiting for next data on status pipe
if (dev0->hub_addr != 0) hub_status_pipe_queue(dev0->hub_addr); if (_dev0.hub_addr != 0) hub_status_pipe_queue(_dev0.hub_addr);
#endif #endif
return false; return false;
} }
TU_ASSERT(tu_desc_type(_usbh_ctrl_buf) == TUSB_DESC_DEVICE); tusb_desc_device_t const * desc_device = (tusb_desc_device_t const*) _usbh_ctrl_buf;
TU_ASSERT( tu_desc_type(desc_device) == TUSB_DESC_DEVICE );
// Reset device again before Set Address // Reset device again before Set Address
TU_LOG2("Port reset \r\n"); TU_LOG2("Port reset \r\n");
if (dev0->hub_addr == 0) if (_dev0.hub_addr == 0)
{ {
// connected directly to roothub // connected directly to roothub
hcd_port_reset( dev0->rhport ); // reset port after 8 byte descriptor hcd_port_reset( _dev0.rhport ); // reset port after 8 byte descriptor
osal_task_delay(RESET_DELAY); osal_task_delay(RESET_DELAY);
enum_request_set_addr(); enum_request_set_addr();
@ -748,12 +760,12 @@ static bool enum_get_addr0_device_desc_complete(uint8_t dev_addr, tusb_control_r
else else
{ {
// after RESET_DELAY the hub_port_reset() already complete // after RESET_DELAY the hub_port_reset() already complete
TU_ASSERT( hub_port_reset(dev0->hub_addr, dev0->hub_port, NULL) ); TU_ASSERT( hub_port_reset(_dev0.hub_addr, _dev0.hub_port, NULL) );
osal_task_delay(RESET_DELAY); osal_task_delay(RESET_DELAY);
tuh_task(); // FIXME temporarily to clean up port_reset control transfer tuh_task(); // FIXME temporarily to clean up port_reset control transfer
TU_ASSERT( hub_port_get_status(dev0->hub_addr, dev0->hub_port, _usbh_ctrl_buf, enum_hub_get_status1_complete) ); TU_ASSERT( hub_port_get_status(_dev0.hub_addr, _dev0.hub_port, _usbh_ctrl_buf, enum_hub_get_status1_complete) );
} }
#endif #endif
@ -772,9 +784,7 @@ static bool enum_set_address_complete(uint8_t dev_addr, tusb_control_request_t c
new_dev->addressed = 1; new_dev->addressed = 1;
// TODO close device 0, may not be needed // TODO close device 0, may not be needed
usbh_device_t* dev0 = &_usbh_devices[0]; hcd_device_close(_dev0.rhport, 0);
hcd_device_close(dev0->rhport, 0);
dev0->state = TUSB_DEVICE_STATE_UNPLUG;
// open control pipe for new address // open control pipe for new address
TU_ASSERT( usbh_edpt_control_open(new_addr, new_dev->ep0_packet_size) ); TU_ASSERT( usbh_edpt_control_open(new_addr, new_dev->ep0_packet_size) );

View File

@ -71,7 +71,7 @@ typedef struct
struct { struct {
ehci_qhd_t qhd; ehci_qhd_t qhd;
ehci_qtd_t qtd; ehci_qtd_t qtd;
}control[CFG_TUH_DEVICE_MAX+1]; }control[CFG_TUH_DEVICE_MAX+CFG_TUH_HUB+1];
ehci_qhd_t qhd_pool[HCD_MAX_ENDPOINT]; ehci_qhd_t qhd_pool[HCD_MAX_ENDPOINT];
ehci_qtd_t qtd_pool[HCD_MAX_XFER] TU_ATTR_ALIGNED(32); ehci_qtd_t qtd_pool[HCD_MAX_XFER] TU_ATTR_ALIGNED(32);