Index: uspace/drv/bus/usb/ohci/hc.c =================================================================== --- uspace/drv/bus/usb/ohci/hc.c (revision e2718e1b78508a9325b6029d6febbdd49eb373cb) +++ uspace/drv/bus/usb/ohci/hc.c (revision 7e1b13017debb7e2e2e1a385490bf064a2b1397d) @@ -137,6 +137,4 @@ return ret; } - usb_device_manager_bind_address(&instance->generic.dev_manager, - instance->rh.address, hub_fun->handle); #define CHECK_RET_UNREG_RETURN(ret, message...) \ @@ -150,4 +148,5 @@ return ret; \ } else (void)0 + ret = usb_endpoint_manager_add_ep( &instance->generic.ep_manager, instance->rh.address, 0, @@ -165,4 +164,10 @@ CHECK_RET_UNREG_RETURN(ret, "Failed to bind root hub function: %s.\n", str_error(ret)); + + ret = usb_device_manager_bind_address(&instance->generic.dev_manager, + instance->rh.address, hub_fun->handle); + if (ret != EOK) + usb_log_warning("Failed to bind root hub address: %s.\n", + str_error(ret)); return EOK; Index: uspace/drv/bus/usb/ohci/ohci.c =================================================================== --- uspace/drv/bus/usb/ohci/ohci.c (revision e2718e1b78508a9325b6029d6febbdd49eb373cb) +++ uspace/drv/bus/usb/ohci/ohci.c (revision 7e1b13017debb7e2e2e1a385490bf064a2b1397d) @@ -140,23 +140,23 @@ int device_setup_ohci(ddf_dev_t *device) { - assert(device); - - ohci_t *instance = malloc(sizeof(ohci_t)); + if (device == NULL) + return EBADMEM; + + ohci_t *instance = ddf_dev_data_alloc(device,sizeof(ohci_t)); if (instance == NULL) { usb_log_error("Failed to allocate OHCI driver.\n"); return ENOMEM; } - instance->rh_fun = NULL; - instance->hc_fun = NULL; #define CHECK_RET_DEST_FREE_RETURN(ret, message...) \ if (ret != EOK) { \ if (instance->hc_fun) { \ + instance->hc_fun->driver_data = NULL; \ ddf_fun_destroy(instance->hc_fun); \ } \ if (instance->rh_fun) { \ + instance->rh_fun->driver_data = NULL; \ ddf_fun_destroy(instance->rh_fun); \ } \ - free(instance); \ usb_log_error(message); \ return ret; \ @@ -219,6 +219,4 @@ "Failed to init ohci_hcd: %s.\n", str_error(ret)); - device->driver_data = instance; - #define CHECK_RET_FINI_RETURN(ret, message...) \ if (ret != EOK) { \ Index: uspace/drv/bus/usb/ohci/ohci_batch.c =================================================================== --- uspace/drv/bus/usb/ohci/ohci_batch.c (revision e2718e1b78508a9325b6029d6febbdd49eb373cb) +++ uspace/drv/bus/usb/ohci/ohci_batch.c (revision 7e1b13017debb7e2e2e1a385490bf064a2b1397d) @@ -34,4 +34,5 @@ #include #include +#include #include @@ -53,6 +54,9 @@ return; if (ohci_batch->tds) { + const ohci_endpoint_t *ohci_ep = + ohci_endpoint_get(ohci_batch->usb_batch->ep); + assert(ohci_ep); for (unsigned i = 0; i < ohci_batch->td_count; ++i) { - if (i != ohci_batch->leave_td) + if (ohci_batch->tds[i] != ohci_ep->td) free32(ohci_batch->tds[i]); } @@ -64,4 +68,8 @@ } /*----------------------------------------------------------------------------*/ +/** Finishes usb_transfer_batch and destroys the structure. + * + * @param[in] uhci_batch Instance to finish and destroy. + */ void ohci_transfer_batch_finish_dispose(ohci_transfer_batch_t *ohci_batch) { @@ -69,9 +77,18 @@ assert(ohci_batch->usb_batch); usb_transfer_batch_finish(ohci_batch->usb_batch, - ohci_batch->device_buffer + ohci_batch->usb_batch->setup_size, - ohci_batch->usb_batch->buffer_size); + ohci_batch->device_buffer + ohci_batch->usb_batch->setup_size); ohci_transfer_batch_dispose(ohci_batch); } /*----------------------------------------------------------------------------*/ +/** Allocate memory and initialize internal data structure. + * + * @param[in] usb_batch Pointer to generic USB batch structure. + * @return Valid pointer if all structures were successfully created, + * NULL otherwise. + * + * Determines the number of needed transfer descriptors (TDs). + * Prepares a transport buffer (that is accessible by the hardware). + * Initializes parameters needed for the transfer and callback. + */ ohci_transfer_batch_t * ohci_transfer_batch_get(usb_transfer_batch_t *usb_batch) { @@ -105,5 +122,4 @@ ohci_batch->ed = ohci_endpoint_get(usb_batch->ep)->ed; ohci_batch->tds[0] = ohci_endpoint_get(usb_batch->ep)->td; - ohci_batch->leave_td = 0; for (unsigned i = 1; i <= ohci_batch->td_count; ++i) { @@ -152,5 +168,5 @@ * completes with the last TD. */ -bool ohci_transfer_batch_is_complete(ohci_transfer_batch_t *ohci_batch) +bool ohci_transfer_batch_is_complete(const ohci_transfer_batch_t *ohci_batch) { assert(ohci_batch); @@ -174,5 +190,5 @@ /* Assume we will leave the last(unused) TD behind */ - ohci_batch->leave_td = ohci_batch->td_count; + unsigned leave_td = ohci_batch->td_count; /* Check all TDs */ @@ -212,14 +228,14 @@ * It will be the one TD we leave behind. */ - ohci_batch->leave_td = i + 1; + leave_td = i + 1; /* Check TD assumption */ - const uint32_t pa = addr_to_phys( - ohci_batch->tds[ohci_batch->leave_td]); - assert((ohci_batch->ed->td_head & ED_TDTAIL_PTR_MASK) + const uint32_t pa = + addr_to_phys(ohci_batch->tds[leave_td]); + assert((ohci_batch->ed->td_head & ED_TDHEAD_PTR_MASK) == pa); ed_set_tail_td(ohci_batch->ed, - ohci_batch->tds[ohci_batch->leave_td]); + ohci_batch->tds[leave_td]); /* Clear possible ED HALT */ @@ -234,5 +250,5 @@ ohci_endpoint_t *ohci_ep = ohci_endpoint_get(ohci_batch->usb_batch->ep); assert(ohci_ep); - ohci_ep->td = ohci_batch->tds[ohci_batch->leave_td]; + ohci_ep->td = ohci_batch->tds[leave_td]; /* Make sure that we are leaving the right TD behind */ @@ -248,5 +264,5 @@ * @param[in] ohci_batch Batch structure to use */ -void ohci_transfer_batch_commit(ohci_transfer_batch_t *ohci_batch) +void ohci_transfer_batch_commit(const ohci_transfer_batch_t *ohci_batch) { assert(ohci_batch); @@ -295,6 +311,5 @@ while (remain_size > 0) { const size_t transfer_size = - remain_size > OHCI_TD_MAX_TRANSFER ? - OHCI_TD_MAX_TRANSFER : remain_size; + min(remain_size, OHCI_TD_MAX_TRANSFER); toggle = 1 - toggle; @@ -378,4 +393,5 @@ } /*----------------------------------------------------------------------------*/ +/** Transfer setup table. */ static void (*const batch_setup[])(ohci_transfer_batch_t*, usb_direction_t) = { Index: uspace/drv/bus/usb/ohci/ohci_batch.h =================================================================== --- uspace/drv/bus/usb/ohci/ohci_batch.h (revision e2718e1b78508a9325b6029d6febbdd49eb373cb) +++ uspace/drv/bus/usb/ohci/ohci_batch.h (revision 7e1b13017debb7e2e2e1a385490bf064a2b1397d) @@ -53,6 +53,4 @@ /** Number of TDs used by the transfer */ size_t td_count; - /** Dummy TD to be left at the ED and used by the next transfer */ - size_t leave_td; /** Data buffer, must be accessible by the OHCI hw. */ char *device_buffer; @@ -62,6 +60,6 @@ ohci_transfer_batch_t * ohci_transfer_batch_get(usb_transfer_batch_t *batch); -bool ohci_transfer_batch_is_complete(ohci_transfer_batch_t *batch); -void ohci_transfer_batch_commit(ohci_transfer_batch_t *batch); +bool ohci_transfer_batch_is_complete(const ohci_transfer_batch_t *batch); +void ohci_transfer_batch_commit(const ohci_transfer_batch_t *batch); void ohci_transfer_batch_finish_dispose(ohci_transfer_batch_t *batch); /*----------------------------------------------------------------------------*/ Index: uspace/drv/bus/usb/ohci/pci.c =================================================================== --- uspace/drv/bus/usb/ohci/pci.c (revision e2718e1b78508a9325b6029d6febbdd49eb373cb) +++ uspace/drv/bus/usb/ohci/pci.c (revision 7e1b13017debb7e2e2e1a385490bf064a2b1397d) @@ -42,5 +42,5 @@ #include #include -#include +#include #include @@ -61,7 +61,4 @@ { assert(dev); - assert(mem_reg_address); - assert(mem_reg_size); - assert(irq_no); async_sess_t *parent_sess = @@ -71,48 +68,27 @@ return ENOMEM; - hw_resource_list_t hw_resources; - int rc = hw_res_get_resource_list(parent_sess, &hw_resources); + hw_res_list_parsed_t hw_res; + hw_res_list_parsed_init(&hw_res); + const int ret = hw_res_get_list_parsed(parent_sess, &hw_res, 0); async_hangup(parent_sess); - if (rc != EOK) { - return rc; + if (ret != EOK) { + return ret; } - uintptr_t mem_address = 0; - size_t mem_size = 0; - bool mem_found = false; + /* We want one irq and one mem range. */ + if (hw_res.irqs.count != 1 || hw_res.mem_ranges.count != 1) { + hw_res_list_parsed_clean(&hw_res); + return EINVAL; + } - int irq = 0; - bool irq_found = false; + if (mem_reg_address) + *mem_reg_address = hw_res.mem_ranges.ranges[0].address; + if (mem_reg_size) + *mem_reg_size = hw_res.mem_ranges.ranges[0].size; + if (irq_no) + *irq_no = hw_res.irqs.irqs[0]; - for (size_t i = 0; i < hw_resources.count; i++) { - hw_resource_t *res = &hw_resources.resources[i]; - switch (res->type) { - case INTERRUPT: - irq = res->res.interrupt.irq; - irq_found = true; - usb_log_debug2("Found interrupt: %d.\n", irq); - break; - case MEM_RANGE: - if (res->res.mem_range.address != 0 - && res->res.mem_range.size != 0 ) { - mem_address = res->res.mem_range.address; - mem_size = res->res.mem_range.size; - usb_log_debug2("Found mem: %p %zu.\n", - (void *) mem_address, mem_size); - mem_found = true; - } - default: - break; - } - } - free(hw_resources.resources); - - if (mem_found && irq_found) { - *mem_reg_address = mem_address; - *mem_reg_size = mem_size; - *irq_no = irq; - return EOK; - } - return ENOENT; + hw_res_list_parsed_clean(&hw_res); + return EOK; } Index: uspace/drv/bus/usb/ohci/root_hub.c =================================================================== --- uspace/drv/bus/usb/ohci/root_hub.c (revision e2718e1b78508a9325b6029d6febbdd49eb373cb) +++ uspace/drv/bus/usb/ohci/root_hub.c (revision 7e1b13017debb7e2e2e1a385490bf064a2b1397d) @@ -100,5 +100,5 @@ .attributes = USB_TRANSFER_INTERRUPT, .descriptor_type = USB_DESCTYPE_ENDPOINT, - .endpoint_address = 1 + (1 << 7), + .endpoint_address = 1 | (1 << 7), .length = sizeof(usb_standard_endpoint_descriptor_t), .max_packet_size = 2, @@ -109,26 +109,33 @@ static void rh_init_descriptors(rh_t *instance); static uint16_t create_interrupt_mask(const rh_t *instance); -static int get_status(const rh_t *instance, usb_transfer_batch_t *request); -static int get_descriptor(const rh_t *instance, usb_transfer_batch_t *request); -static int set_feature(const rh_t *instance, usb_transfer_batch_t *request); -static int clear_feature(const rh_t *instance, usb_transfer_batch_t *request); +static void get_status(const rh_t *instance, usb_transfer_batch_t *request); +static void get_descriptor(const rh_t *instance, usb_transfer_batch_t *request); +static void set_feature(const rh_t *instance, usb_transfer_batch_t *request); +static void clear_feature(const rh_t *instance, usb_transfer_batch_t *request); static int set_feature_port( const rh_t *instance, uint16_t feature, uint16_t port); static int clear_feature_port( const rh_t *instance, uint16_t feature, uint16_t port); -static int control_request(rh_t *instance, usb_transfer_batch_t *request); +static void control_request(rh_t *instance, usb_transfer_batch_t *request); static inline void interrupt_request( usb_transfer_batch_t *request, uint16_t mask, size_t size) { assert(request); - - request->transfered_size = size; usb_transfer_batch_finish_error(request, &mask, size, EOK); -} - -#define TRANSFER_OK(bytes) \ + usb_transfer_batch_destroy(request); +} + +#define TRANSFER_END_DATA(request, data, bytes) \ do { \ - request->transfered_size = bytes; \ - return EOK; \ + usb_transfer_batch_finish_error(request, data, bytes, EOK); \ + usb_transfer_batch_destroy(request); \ + return; \ +} while (0) + +#define TRANSFER_END(request, error) \ +do { \ + usb_transfer_batch_finish_error(request, NULL, 0, error); \ + usb_transfer_batch_destroy(request); \ + return; \ } while (0) @@ -212,7 +219,7 @@ case USB_TRANSFER_CONTROL: usb_log_debug("Root hub got CONTROL packet\n"); - const int ret = control_request(instance, request); - usb_transfer_batch_finish_error(request, NULL, 0, ret); + control_request(instance, request); break; + case USB_TRANSFER_INTERRUPT: usb_log_debug("Root hub got INTERRUPT packet\n"); @@ -221,11 +228,11 @@ const uint16_t mask = create_interrupt_mask(instance); if (mask == 0) { - usb_log_debug("No changes..\n"); + usb_log_debug("No changes...\n"); instance->unfinished_interrupt_transfer = request; - fibril_mutex_unlock(&instance->guard); - return; + } else { + usb_log_debug("Processing changes...\n"); + interrupt_request( + request, mask, instance->interrupt_mask_size); } - usb_log_debug("Processing changes...\n"); - interrupt_request(request, mask, instance->interrupt_mask_size); fibril_mutex_unlock(&instance->guard); break; @@ -233,7 +240,6 @@ default: usb_log_error("Root hub got unsupported request.\n"); - usb_transfer_batch_finish_error(request, NULL, 0, EINVAL); - } - usb_transfer_batch_destroy(request); + TRANSFER_END(request, ENOTSUP); + } } /*----------------------------------------------------------------------------*/ @@ -254,6 +260,4 @@ interrupt_request(instance->unfinished_interrupt_transfer, mask, instance->interrupt_mask_size); - usb_transfer_batch_destroy( - instance->unfinished_interrupt_transfer); instance->unfinished_interrupt_transfer = NULL; } @@ -384,39 +388,80 @@ * @return error code */ -int get_status(const rh_t *instance, usb_transfer_batch_t *request) +void get_status(const rh_t *instance, usb_transfer_batch_t *request) { assert(instance); assert(request); + const usb_device_request_setup_packet_t *request_packet = (usb_device_request_setup_packet_t*)request->setup_buffer; - if (request->buffer_size < 4) { - usb_log_error("Buffer too small for get status request.\n"); - return EOVERFLOW; - } - + switch (request_packet->request_type) + { + case USB_HUB_REQ_TYPE_GET_HUB_STATUS: /* Hub status: just filter relevant info from rh_status reg */ - if (request_packet->request_type == USB_HUB_REQ_TYPE_GET_HUB_STATUS) { - const uint32_t data = instance->registers->rh_status & - (RHS_LPS_FLAG | RHS_LPSC_FLAG | RHS_OCI_FLAG | RHS_OCIC_FLAG); - memcpy(request->buffer, &data, sizeof(data)); - TRANSFER_OK(sizeof(data)); - } + if (request->buffer_size < 4) { + usb_log_error("Buffer(%zu) too small for hub get " + "status request.\n", request->buffer_size); + TRANSFER_END(request, EOVERFLOW); + } else { + const uint32_t data = instance->registers->rh_status & + (RHS_LPS_FLAG | RHS_LPSC_FLAG + | RHS_OCI_FLAG | RHS_OCIC_FLAG); + TRANSFER_END_DATA(request, &data, sizeof(data)); + } /* Copy appropriate rh_port_status register, OHCI designers were * kind enough to make those bit values match USB specification */ - if (request_packet->request_type == USB_HUB_REQ_TYPE_GET_PORT_STATUS) { - const unsigned port = request_packet->index; - if (port < 1 || port > instance->port_count) - return EINVAL; - - const uint32_t data = - instance->registers->rh_port_status[port - 1]; - memcpy(request->buffer, &data, sizeof(data)); - TRANSFER_OK(sizeof(data)); - } - - return ENOTSUP; + case USB_HUB_REQ_TYPE_GET_PORT_STATUS: + if (request->buffer_size < 4) { + usb_log_error("Buffer(%zu) too small for hub get " + "status request.\n", request->buffer_size); + TRANSFER_END(request, EOVERFLOW); + } else { + const unsigned port = request_packet->index; + if (port < 1 || port > instance->port_count) + TRANSFER_END(request, EINVAL); + + const uint32_t data = + instance->registers->rh_port_status[port - 1]; + TRANSFER_END_DATA(request, &data, sizeof(data)); + } + case SETUP_REQUEST_TO_HOST(USB_REQUEST_TYPE_STANDARD, USB_REQUEST_RECIPIENT_DEVICE): + if (request->buffer_size < 2) { + usb_log_error("Buffer(%zu) too small for hub generic " + "get status request.\n", request->buffer_size); + TRANSFER_END(request, EOVERFLOW); + } else { + static const uint16_t data = + uint16_host2usb(USB_DEVICE_STATUS_SELF_POWERED); + TRANSFER_END_DATA(request, &data, sizeof(data)); + } + + case SETUP_REQUEST_TO_HOST(USB_REQUEST_TYPE_STANDARD, USB_REQUEST_RECIPIENT_INTERFACE): + /* Hubs are allowed to have only one interface */ + if (request_packet->index != 0) + TRANSFER_END(request, EINVAL); + /* Fall through, as the answer will be the same: 0x0000 */ + case SETUP_REQUEST_TO_HOST(USB_REQUEST_TYPE_STANDARD, USB_REQUEST_RECIPIENT_ENDPOINT): + /* Endpoint 0 (default control) and 1 (interrupt) */ + if (request_packet->index >= 2) + TRANSFER_END(request, EINVAL); + + if (request->buffer_size < 2) { + usb_log_error("Buffer(%zu) too small for hub generic " + "get status request.\n", request->buffer_size); + TRANSFER_END(request, EOVERFLOW); + } else { + /* Endpoints are OK. (We don't halt) */ + static const uint16_t data = 0; + TRANSFER_END_DATA(request, &data, sizeof(data)); + } + + default: + usb_log_error("Unsupported GET_STATUS request.\n"); + TRANSFER_END(request, ENOTSUP); + } + } /*----------------------------------------------------------------------------*/ @@ -430,5 +475,5 @@ * @return Error code */ -int get_descriptor(const rh_t *instance, usb_transfer_batch_t *request) +void get_descriptor(const rh_t *instance, usb_transfer_batch_t *request) { assert(instance); @@ -437,47 +482,45 @@ const usb_device_request_setup_packet_t *setup_request = (usb_device_request_setup_packet_t *) request->setup_buffer; - size_t size; - const void *descriptor = NULL; const uint16_t setup_request_value = setup_request->value_high; - //(setup_request->value_low << 8); switch (setup_request_value) { case USB_DESCTYPE_HUB: usb_log_debug2("USB_DESCTYPE_HUB\n"); - /* Hub descriptor was generated locally */ - descriptor = instance->descriptors.hub; - size = instance->hub_descriptor_size; - break; + /* Hub descriptor was generated locally. + * Class specific request. */ + TRANSFER_END_DATA(request, instance->descriptors.hub, + instance->hub_descriptor_size); case USB_DESCTYPE_DEVICE: usb_log_debug2("USB_DESCTYPE_DEVICE\n"); - /* Device descriptor is shared (No one should ask for it)*/ - descriptor = &ohci_rh_device_descriptor; - size = sizeof(ohci_rh_device_descriptor); - break; + /* Device descriptor is shared + * (No one should ask for it, as the device is already setup) + * Standard USB device request. */ + TRANSFER_END_DATA(request, &ohci_rh_device_descriptor, + sizeof(ohci_rh_device_descriptor)); case USB_DESCTYPE_CONFIGURATION: usb_log_debug2("USB_DESCTYPE_CONFIGURATION\n"); /* Start with configuration and add others depending on - * request size */ - descriptor = &instance->descriptors; - size = instance->descriptors.configuration.total_length; - break; + * request size. Standard USB request. */ + TRANSFER_END_DATA(request, &instance->descriptors, + instance->descriptors.configuration.total_length); case USB_DESCTYPE_INTERFACE: usb_log_debug2("USB_DESCTYPE_INTERFACE\n"); /* Use local interface descriptor. There is one and it - * might be modified */ - descriptor = &instance->descriptors.interface; - size = sizeof(instance->descriptors.interface); - break; + * might be modified. Hub driver should not ask or this + * descriptor as it is not part of standard requests set. */ + TRANSFER_END_DATA(request, &instance->descriptors.interface, + sizeof(instance->descriptors.interface)); case USB_DESCTYPE_ENDPOINT: /* Use local endpoint descriptor. There is one - * it might have max_packet_size field modified*/ + * it might have max_packet_size field modified. Hub driver + * should not ask for this descriptor as it is not part + * of standard requests set. */ usb_log_debug2("USB_DESCTYPE_ENDPOINT\n"); - descriptor = &instance->descriptors.endpoint; - size = sizeof(instance->descriptors.endpoint); - break; + TRANSFER_END_DATA(request, &instance->descriptors.endpoint, + sizeof(instance->descriptors.endpoint)); default: @@ -489,12 +532,8 @@ setup_request_value, setup_request->index, setup_request->length); - return EINVAL; - } - if (request->buffer_size < size) { - size = request->buffer_size; - } - - memcpy(request->buffer, descriptor, size); - TRANSFER_OK(size); + TRANSFER_END(request, EINVAL); + } + + TRANSFER_END(request, ENOTSUP); } /*----------------------------------------------------------------------------*/ @@ -604,5 +643,5 @@ * @return error code */ -int set_feature(const rh_t *instance, usb_transfer_batch_t *request) +void set_feature(const rh_t *instance, usb_transfer_batch_t *request) { assert(instance); @@ -615,6 +654,7 @@ case USB_HUB_REQ_TYPE_SET_PORT_FEATURE: usb_log_debug("USB_HUB_REQ_TYPE_SET_PORT_FEATURE\n"); - return set_feature_port(instance, + const int ret = set_feature_port(instance, setup_request->value, setup_request->index); + TRANSFER_END(request, ret); case USB_HUB_REQ_TYPE_SET_HUB_FEATURE: @@ -623,9 +663,10 @@ * features. It makes no sense to SET either. */ usb_log_error("Invalid HUB set feature request.\n"); - return ENOTSUP; + TRANSFER_END(request, ENOTSUP); + //TODO: Consider standard USB requests: REMOTE WAKEUP, ENDPOINT STALL default: usb_log_error("Invalid set feature request type: %d\n", setup_request->request_type); - return EINVAL; + TRANSFER_END(request, ENOTSUP); } } @@ -640,5 +681,5 @@ * @return error code */ -int clear_feature(const rh_t *instance, usb_transfer_batch_t *request) +void clear_feature(const rh_t *instance, usb_transfer_batch_t *request) { assert(instance); @@ -647,6 +688,4 @@ const usb_device_request_setup_packet_t *setup_request = (usb_device_request_setup_packet_t *) request->setup_buffer; - - request->transfered_size = 0; switch (setup_request->request_type) @@ -654,6 +693,7 @@ case USB_HUB_REQ_TYPE_CLEAR_PORT_FEATURE: usb_log_debug("USB_HUB_REQ_TYPE_CLEAR_PORT_FEATURE\n"); - return clear_feature_port(instance, + const int ret = clear_feature_port(instance, setup_request->value, setup_request->index); + TRANSFER_END(request, ret); case USB_HUB_REQ_TYPE_CLEAR_HUB_FEATURE: @@ -668,10 +708,11 @@ if (setup_request->value == USB_HUB_FEATURE_C_HUB_OVER_CURRENT) { instance->registers->rh_status = RHS_OCIC_FLAG; - TRANSFER_OK(0); + TRANSFER_END(request, EOK); } + //TODO: Consider standard USB requests: REMOTE WAKEUP, ENDPOINT STALL default: usb_log_error("Invalid clear feature request type: %d\n", setup_request->request_type); - return EINVAL; + TRANSFER_END(request, ENOTSUP); } } @@ -695,5 +736,5 @@ * @return error code */ -int control_request(rh_t *instance, usb_transfer_batch_t *request) +void control_request(rh_t *instance, usb_transfer_batch_t *request) { assert(instance); @@ -702,10 +743,10 @@ if (!request->setup_buffer) { usb_log_error("Root hub received empty transaction!"); - return EINVAL; + TRANSFER_END(request, EBADMEM); } if (sizeof(usb_device_request_setup_packet_t) > request->setup_size) { usb_log_error("Setup packet too small\n"); - return EOVERFLOW; + TRANSFER_END(request, EOVERFLOW); } @@ -718,45 +759,58 @@ case USB_DEVREQ_GET_STATUS: usb_log_debug("USB_DEVREQ_GET_STATUS\n"); - return get_status(instance, request); + get_status(instance, request); + break; case USB_DEVREQ_GET_DESCRIPTOR: usb_log_debug("USB_DEVREQ_GET_DESCRIPTOR\n"); - return get_descriptor(instance, request); + get_descriptor(instance, request); + break; case USB_DEVREQ_GET_CONFIGURATION: usb_log_debug("USB_DEVREQ_GET_CONFIGURATION\n"); - if (request->buffer_size != 1) - return EINVAL; - request->buffer[0] = 1; - TRANSFER_OK(1); + if (request->buffer_size == 0) + TRANSFER_END(request, EOVERFLOW); + static const uint8_t config = 1; + TRANSFER_END_DATA(request, &config, sizeof(config)); case USB_DEVREQ_CLEAR_FEATURE: - usb_log_debug2("Processing request without " - "additional data\n"); - return clear_feature(instance, request); + usb_log_debug2("USB_DEVREQ_CLEAR_FEATURE\n"); + clear_feature(instance, request); + break; case USB_DEVREQ_SET_FEATURE: - usb_log_debug2("Processing request without " - "additional data\n"); - return set_feature(instance, request); + usb_log_debug2("USB_DEVREQ_SET_FEATURE\n"); + set_feature(instance, request); + break; case USB_DEVREQ_SET_ADDRESS: - usb_log_debug("USB_DEVREQ_SET_ADDRESS\n"); + usb_log_debug("USB_DEVREQ_SET_ADDRESS: %u\n", + setup_request->value); + if (uint16_usb2host(setup_request->value) > 127) + TRANSFER_END(request, EINVAL); + instance->address = setup_request->value; - TRANSFER_OK(0); + TRANSFER_END(request, EOK); case USB_DEVREQ_SET_CONFIGURATION: - usb_log_debug("USB_DEVREQ_SET_CONFIGURATION\n"); - /* We don't need to do anything */ - TRANSFER_OK(0); - - case USB_DEVREQ_SET_DESCRIPTOR: /* Not supported by OHCI RH */ + usb_log_debug("USB_DEVREQ_SET_CONFIGURATION: %u\n", + setup_request->value); + /* We have only one configuration, it's number is 1 */ + if (uint16_usb2host(setup_request->value) != 1) + TRANSFER_END(request, EINVAL); + TRANSFER_END(request, EOK); + + /* Both class specific and std is optional for hubs */ + case USB_DEVREQ_SET_DESCRIPTOR: + /* Hubs have only one interface GET/SET is not supported */ + case USB_DEVREQ_GET_INTERFACE: + case USB_DEVREQ_SET_INTERFACE: default: + /* Hub class GET_STATE(2) falls in here too. */ usb_log_error("Received unsupported request: %d.\n", setup_request->request); - return ENOTSUP; - } -} - + TRANSFER_END(request, ENOTSUP); + } +} /** * @}