HelenOS sources
This source file includes following definitions.
- usb_hub_polling_error_callback
- usb_hub_device_add
- usb_hub_cleanup
- usb_hub_device_remove
- usb_hub_device_gone
- usb_hub_polling_init
- hub_port_changes_callback
- usb_hub_power_ports
- usb_hub_process_hub_specific_info
- usb_set_first_configuration
- usb_hub_over_current
- usb_hub_set_depth
- usb_hub_set_port_feature
- usb_hub_clear_port_feature
- usb_hub_get_port_status
- usb_hub_global_interrupt
- usb_hub_reserve_default_address
- usb_hub_release_default_address
#include <ddf/driver.h>
#include <stdbool.h>
#include <errno.h>
#include <str_error.h>
#include <inttypes.h>
#include <stdio.h>
#include <usb/usb.h>
#include <usb/debug.h>
#include <usb/dev/pipes.h>
#include <usb/classes/classes.h>
#include <usb/descriptor.h>
#include <usb/dev/recognise.h>
#include <usb/dev/request.h>
#include <usb/classes/hub.h>
#include <usb/dev/poll.h>
#include <usbhc_iface.h>
#include "usbhub.h"
#include "status.h"
#define HUB_FNC_NAME "hub"
#define HUB_STATUS_CHANGE_EP(protocol) { \
.transfer_type = USB_TRANSFER_INTERRUPT, \
.direction = USB_DIRECTION_IN, \
.interface_class = USB_CLASS_HUB, \
.interface_subclass = 0, \
.interface_protocol = (protocol), \
.flags = 0 \
}
static const usb_endpoint_description_t
status_change_single_tt_only = HUB_STATUS_CHANGE_EP(0),
status_change_mtt_available = HUB_STATUS_CHANGE_EP(1);
const usb_endpoint_description_t *usb_hub_endpoints [] = {
&status_change_single_tt_only,
&status_change_mtt_available,
};
static const usb_device_request_setup_packet_t get_hub_status_request = {
.request_type = USB_HUB_REQ_TYPE_GET_HUB_STATUS,
.request = USB_HUB_REQUEST_GET_STATUS,
.index = 0,
.value = 0,
.length = sizeof(usb_hub_status_t),
};
static errno_t usb_set_first_configuration(usb_device_t *);
static errno_t usb_hub_process_hub_specific_info(usb_hub_dev_t *);
static void usb_hub_over_current(const usb_hub_dev_t *, usb_hub_status_t);
static errno_t usb_hub_polling_init(usb_hub_dev_t *, usb_endpoint_mapping_t *);
static void usb_hub_global_interrupt(const usb_hub_dev_t *);
static bool usb_hub_polling_error_callback(usb_device_t *dev,
errno_t err_code, void *arg)
{
assert(dev);
assert(arg);
usb_log_error("Device %s polling error: %s",
usb_device_get_name(dev), str_error(err_code));
return true;
}
errno_t usb_hub_device_add(usb_device_t *usb_dev)
{
errno_t err;
assert(usb_dev);
usb_hub_dev_t *hub_dev =
usb_device_data_alloc(usb_dev, sizeof(usb_hub_dev_t));
if (hub_dev == NULL) {
usb_log_error("Failed to create hub driver structure.");
return ENOMEM;
}
hub_dev->usb_device = usb_dev;
hub_dev->speed = usb_device_get_speed(usb_dev);
if ((err = usb_set_first_configuration(usb_dev))) {
usb_log_error("Could not set hub configuration: %s", str_error(err));
return err;
}
if ((err = usb_hub_process_hub_specific_info(hub_dev))) {
usb_log_error("Could process hub specific info, %s", str_error(err));
return err;
}
const usb_endpoint_description_t *status_change = hub_dev->mtt_available ?
&status_change_mtt_available :
&status_change_single_tt_only;
usb_endpoint_mapping_t *status_change_mapping =
usb_device_get_mapped_ep_desc(hub_dev->usb_device, status_change);
if (!status_change_mapping) {
usb_log_error("Failed to map the Status Change Endpoint of a hub.");
return EIO;
}
usb_log_debug("Creating DDF function '" HUB_FNC_NAME "'.");
hub_dev->hub_fun = usb_device_ddf_fun_create(hub_dev->usb_device,
fun_exposed, HUB_FNC_NAME);
if (hub_dev->hub_fun == NULL) {
usb_log_error("Failed to create hub function.");
return ENOMEM;
}
if ((err = ddf_fun_bind(hub_dev->hub_fun))) {
usb_log_error("Failed to bind hub function: %s.", str_error(err));
goto err_ddf_fun;
}
if ((err = usb_hub_polling_init(hub_dev, status_change_mapping))) {
usb_log_error("Failed to start polling: %s.", str_error(err));
goto err_bound;
}
usb_log_info("Controlling %s-speed hub '%s' (%p: %zu ports).",
usb_str_speed(hub_dev->speed),
usb_device_get_name(hub_dev->usb_device), hub_dev,
hub_dev->port_count);
return EOK;
err_bound:
ddf_fun_unbind(hub_dev->hub_fun);
err_ddf_fun:
ddf_fun_destroy(hub_dev->hub_fun);
return err;
}
static errno_t usb_hub_cleanup(usb_hub_dev_t *hub)
{
free(hub->polling.buffer);
usb_polling_fini(&hub->polling);
for (size_t port = 0; port < hub->port_count; ++port) {
usb_port_fini(&hub->ports[port].base);
}
free(hub->ports);
const errno_t ret = ddf_fun_unbind(hub->hub_fun);
if (ret != EOK) {
usb_log_error("(%p) Failed to unbind '%s' function: %s.",
hub, HUB_FNC_NAME, str_error(ret));
return ret;
}
ddf_fun_destroy(hub->hub_fun);
usb_log_info("(%p) USB hub driver stopped and cleaned.", hub);
return EOK;
}
errno_t usb_hub_device_remove(usb_device_t *usb_dev)
{
assert(usb_dev);
usb_hub_dev_t *hub = usb_device_data_get(usb_dev);
assert(hub);
usb_log_info("(%p) USB hub removed, joining polling fibril.", hub);
usb_polling_join(&hub->polling);
usb_log_info("(%p) USB hub polling stopped, freeing memory.", hub);
return usb_hub_cleanup(hub);
}
errno_t usb_hub_device_gone(usb_device_t *usb_dev)
{
assert(usb_dev);
usb_hub_dev_t *hub = usb_device_data_get(usb_dev);
assert(hub);
usb_log_info("(%p) USB hub gone, joining polling fibril.", hub);
usb_polling_join(&hub->polling);
usb_log_info("(%p) USB hub polling stopped, freeing memory.", hub);
return usb_hub_cleanup(hub);
}
static errno_t usb_hub_polling_init(usb_hub_dev_t *hub_dev,
usb_endpoint_mapping_t *mapping)
{
errno_t err;
usb_polling_t *polling = &hub_dev->polling;
if ((err = usb_polling_init(polling)))
return err;
polling->device = hub_dev->usb_device;
polling->ep_mapping = mapping;
polling->request_size = ((hub_dev->port_count + 1 + 7) / 8);
polling->buffer = malloc(polling->request_size);
polling->on_data = hub_port_changes_callback;
polling->on_error = usb_hub_polling_error_callback;
polling->arg = hub_dev;
if ((err = usb_polling_start(polling))) {
free(polling->buffer);
usb_polling_fini(polling);
return err;
}
return EOK;
}
bool hub_port_changes_callback(usb_device_t *dev,
uint8_t *change_bitmap, size_t change_bitmap_size, void *arg)
{
usb_hub_dev_t *hub = arg;
assert(hub);
if (change_bitmap_size == 0) {
return false;
}
const bool change = change_bitmap[0] & 1;
if (change) {
usb_hub_global_interrupt(hub);
}
for (size_t port = 0; port < hub->port_count; ++port) {
const size_t bit = port + 1;
const bool change = (change_bitmap[bit / 8] >> (bit % 8)) & 1;
if (change) {
usb_hub_port_process_interrupt(&hub->ports[port]);
}
}
return true;
}
static void usb_hub_power_ports(usb_hub_dev_t *hub_dev)
{
if (!hub_dev->power_switched) {
usb_log_info("(%p): Power switching not supported, "
"ports always powered.", hub_dev);
return;
}
usb_log_info("(%p): Hub port power switching enabled (%s).", hub_dev,
hub_dev->per_port_power ? "per port" : "ganged");
for (unsigned int port = 0; port < hub_dev->port_count; ++port) {
usb_log_debug("(%p): Powering port %u.", hub_dev, port + 1);
const errno_t ret = usb_hub_set_port_feature(hub_dev, port + 1,
USB_HUB_FEATURE_PORT_POWER);
if (ret != EOK) {
usb_log_error("(%p-%u): Cannot power on port: %s.",
hub_dev, hub_dev->ports[port].port_number,
str_error(ret));
}
}
}
static errno_t usb_hub_process_hub_specific_info(usb_hub_dev_t *hub_dev)
{
assert(hub_dev);
usb_log_debug("(%p): Retrieving descriptor.", hub_dev);
usb_pipe_t *control_pipe = usb_device_get_default_pipe(hub_dev->usb_device);
usb_descriptor_type_t desc_type = hub_dev->speed >= USB_SPEED_SUPER ?
USB_DESCTYPE_SSPEED_HUB : USB_DESCTYPE_HUB;
usb_hub_descriptor_header_t descriptor;
size_t received_size;
errno_t opResult = usb_request_get_descriptor(control_pipe,
USB_REQUEST_TYPE_CLASS, USB_REQUEST_RECIPIENT_DEVICE,
desc_type, 0, 0, &descriptor,
sizeof(usb_hub_descriptor_header_t), &received_size);
if (opResult != EOK) {
usb_log_error("(%p): Failed to receive hub descriptor: %s.",
hub_dev, str_error(opResult));
return opResult;
}
usb_log_debug("(%p): Setting port count to %d.", hub_dev,
descriptor.port_count);
hub_dev->port_count = descriptor.port_count;
hub_dev->control_pipe = control_pipe;
usb_log_debug("(%p): Setting hub depth to %u.", hub_dev,
usb_device_get_depth(hub_dev->usb_device));
if ((opResult = usb_hub_set_depth(hub_dev))) {
usb_log_error("(%p): Failed to set hub depth: %s.",
hub_dev, str_error(opResult));
return opResult;
}
hub_dev->ports = calloc(hub_dev->port_count, sizeof(usb_hub_port_t));
if (!hub_dev->ports) {
return ENOMEM;
}
for (size_t port = 0; port < hub_dev->port_count; ++port) {
usb_hub_port_init(&hub_dev->ports[port], hub_dev, port + 1);
}
hub_dev->power_switched =
!(descriptor.characteristics & HUB_CHAR_NO_POWER_SWITCH_FLAG);
hub_dev->per_port_power =
descriptor.characteristics & HUB_CHAR_POWER_PER_PORT_FLAG;
const uint8_t protocol = usb_device_descriptors(hub_dev->usb_device)->device.device_protocol;
hub_dev->mtt_available = (protocol == 2);
usb_hub_power_ports(hub_dev);
return EOK;
}
static errno_t usb_set_first_configuration(usb_device_t *usb_device)
{
assert(usb_device);
const size_t configuration_count =
usb_device_descriptors(usb_device)->device.configuration_count;
usb_log_debug("Hub has %zu configurations.", configuration_count);
if (configuration_count < 1) {
usb_log_error("There are no configurations available");
return EINVAL;
}
const size_t config_size =
usb_device_descriptors(usb_device)->full_config_size;
const usb_standard_configuration_descriptor_t *config_descriptor =
usb_device_descriptors(usb_device)->full_config;
if (config_size < sizeof(usb_standard_configuration_descriptor_t)) {
usb_log_error("Configuration descriptor is not big enough"
" to fit standard configuration descriptor.\n");
return EOVERFLOW;
}
errno_t opResult = usb_request_set_configuration(
usb_device_get_default_pipe(usb_device),
config_descriptor->configuration_number);
if (opResult != EOK) {
usb_log_error("Failed to set hub configuration: %s.",
str_error(opResult));
} else {
usb_log_debug("\tUsed configuration %d",
config_descriptor->configuration_number);
}
return opResult;
}
static void usb_hub_over_current(const usb_hub_dev_t *hub_dev,
usb_hub_status_t status)
{
if (status & USB_HUB_STATUS_OVER_CURRENT) {
usb_log_warning("(%p) Detected hub over-current condition, "
"all ports should be powered off.", hub_dev);
return;
}
if (!hub_dev->power_switched)
return;
for (size_t port = 0; port < hub_dev->port_count; ++port) {
const errno_t ret = usb_hub_set_port_feature(hub_dev, port,
USB_HUB_FEATURE_PORT_POWER);
if (ret != EOK) {
usb_log_warning("(%p-%u): HUB OVER-CURRENT GONE: Cannot"
" power on port: %s\n", hub_dev,
hub_dev->ports[port].port_number, str_error(ret));
} else {
if (!hub_dev->per_port_power)
return;
}
}
}
errno_t usb_hub_set_depth(const usb_hub_dev_t *hub)
{
assert(hub);
if (hub->speed < USB_SPEED_SUPER)
return EOK;
const usb_device_request_setup_packet_t set_request = {
.request_type = USB_HUB_REQ_TYPE_SET_HUB_DEPTH,
.request = USB_HUB_REQUEST_SET_HUB_DEPTH,
.value = uint16_host2usb(usb_device_get_depth(hub->usb_device) - 1),
.index = 0,
.length = 0,
};
return usb_pipe_control_write(hub->control_pipe, &set_request,
sizeof(set_request), NULL, 0);
}
errno_t usb_hub_set_port_feature(const usb_hub_dev_t *hub, size_t port_number,
usb_hub_class_feature_t feature)
{
assert(hub);
const usb_device_request_setup_packet_t clear_request = {
.request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE,
.request = USB_DEVREQ_SET_FEATURE,
.index = uint16_host2usb(port_number),
.value = feature,
.length = 0,
};
return usb_pipe_control_write(hub->control_pipe, &clear_request,
sizeof(clear_request), NULL, 0);
}
errno_t usb_hub_clear_port_feature(const usb_hub_dev_t *hub, size_t port_number,
usb_hub_class_feature_t feature)
{
assert(hub);
const usb_device_request_setup_packet_t clear_request = {
.request_type = USB_HUB_REQ_TYPE_CLEAR_PORT_FEATURE,
.request = USB_DEVREQ_CLEAR_FEATURE,
.value = feature,
.index = uint16_host2usb(port_number),
.length = 0,
};
return usb_pipe_control_write(hub->control_pipe,
&clear_request, sizeof(clear_request), NULL, 0);
}
errno_t usb_hub_get_port_status(const usb_hub_dev_t *hub, size_t port_number,
usb_port_status_t *status)
{
assert(hub);
assert(status);
const usb_device_request_setup_packet_t request = {
.request_type = USB_HUB_REQ_TYPE_GET_PORT_STATUS,
.request = USB_HUB_REQUEST_GET_STATUS,
.value = 0,
.index = uint16_host2usb(port_number),
.length = sizeof(usb_port_status_t),
};
size_t recv_size;
uint32_t buffer;
const errno_t rc = usb_pipe_control_read(hub->control_pipe,
&request, sizeof(usb_device_request_setup_packet_t),
&buffer, sizeof(buffer), &recv_size);
if (rc != EOK)
return rc;
if (recv_size != sizeof(*status))
return ELIMIT;
*status = uint32_usb2host(buffer);
return EOK;
}
static void usb_hub_global_interrupt(const usb_hub_dev_t *hub_dev)
{
assert(hub_dev);
assert(hub_dev->usb_device);
usb_log_debug("(%p): Global interrupt on th hub.", hub_dev);
usb_pipe_t *control_pipe =
usb_device_get_default_pipe(hub_dev->usb_device);
usb_hub_status_t status;
size_t rcvd_size;
const errno_t opResult = usb_pipe_control_read(control_pipe,
&get_hub_status_request, sizeof(get_hub_status_request),
&status, sizeof(usb_hub_status_t), &rcvd_size);
if (opResult != EOK) {
usb_log_error("(%p): Could not get hub status: %s.", hub_dev,
str_error(opResult));
return;
}
if (rcvd_size != sizeof(usb_hub_status_t)) {
usb_log_error("(%p): Received status has incorrect size: "
"%zu != %zu", hub_dev, rcvd_size, sizeof(usb_hub_status_t));
return;
}
if (status & USB_HUB_STATUS_C_OVER_CURRENT) {
usb_hub_over_current(hub_dev, status);
const errno_t ret = usb_request_clear_feature(
control_pipe, USB_REQUEST_TYPE_CLASS,
USB_REQUEST_RECIPIENT_DEVICE,
USB_HUB_FEATURE_C_HUB_OVER_CURRENT, 0);
if (ret != EOK) {
usb_log_error("(%p): Failed to clear hub over-current "
"change flag: %s.\n", hub_dev, str_error(opResult));
}
}
if (status & USB_HUB_STATUS_C_LOCAL_POWER) {
const errno_t ret = usb_request_clear_feature(
control_pipe, USB_REQUEST_TYPE_CLASS,
USB_REQUEST_RECIPIENT_DEVICE,
USB_HUB_FEATURE_C_HUB_LOCAL_POWER, 0);
if (opResult != EOK) {
usb_log_error("(%p): Failed to clear hub power change "
"flag: %s.\n", hub_dev, str_error(ret));
}
}
}
static FIBRIL_CONDVAR_INITIALIZE(global_hub_default_address_cv);
static FIBRIL_MUTEX_INITIALIZE(global_hub_default_address_guard);
errno_t usb_hub_reserve_default_address(usb_hub_dev_t *hub, async_exch_t *exch,
usb_port_t *port)
{
assert(hub);
assert(exch);
assert(port);
assert(fibril_mutex_is_locked(&port->guard));
errno_t err = usbhc_reserve_default_address(exch);
while (err == EAGAIN || err == EINVAL) {
fibril_mutex_unlock(&port->guard);
fibril_mutex_lock(&global_hub_default_address_guard);
fibril_condvar_wait_timeout(&global_hub_default_address_cv,
&global_hub_default_address_guard, 2000000);
fibril_mutex_unlock(&global_hub_default_address_guard);
fibril_mutex_lock(&port->guard);
err = usbhc_reserve_default_address(exch);
}
if (err)
return err;
if (port->state != PORT_CONNECTING) {
err = usb_hub_release_default_address(hub, exch);
return err ? err : EINTR;
}
return EOK;
}
errno_t usb_hub_release_default_address(usb_hub_dev_t *hub, async_exch_t *exch)
{
const errno_t ret = usbhc_release_default_address(exch);
fibril_condvar_signal(&global_hub_default_address_cv);
return ret;
}
HelenOS homepage, sources at GitHub