pipesinit.c

Go to the documentation of this file.

/*
 * Copyright (c) 2011 Vojtech Horky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

#include <usb/usb.h>
#include <usb/dev/pipes.h>
#include <usb/dev/dp.h>
#include <usb/dev/request.h>
#include <usbhc_iface.h>
#include <errno.h>
#include <assert.h>

#define CTRL_PIPE_MIN_PACKET_SIZE 8
#define DEV_DESCR_MAX_PACKET_SIZE_OFFSET 7


#define NESTING(parentname, childname) \
        { \
                .child = USB_DESCTYPE_##childname, \
                .parent = USB_DESCTYPE_##parentname, \
        }
#define LAST_NESTING { -1, -1 }

static usb_dp_descriptor_nesting_t descriptor_nesting[] = {
        NESTING(CONFIGURATION, INTERFACE),
        NESTING(INTERFACE, ENDPOINT),
        NESTING(INTERFACE, HUB),
        NESTING(INTERFACE, HID),
        NESTING(HID, HID_REPORT),
        LAST_NESTING
};

static inline bool is_endpoint_descriptor(uint8_t *descriptor)
{
        return descriptor[1] == USB_DESCTYPE_ENDPOINT;
}

static bool endpoint_fits_description(const usb_endpoint_description_t *wanted,
    usb_endpoint_description_t *found)
{
#define _SAME(fieldname) ((wanted->fieldname) == (found->fieldname))

        if (!_SAME(direction)) {
                return false;
        }

        if (!_SAME(transfer_type)) {
                return false;
        }

        if ((wanted->interface_class >= 0) && !_SAME(interface_class)) {
                return false;
        }

        if ((wanted->interface_subclass >= 0) && !_SAME(interface_subclass)) {
                return false;
        }

        if ((wanted->interface_protocol >= 0) && !_SAME(interface_protocol)) {
                return false;
        }

#undef _SAME

        return true;
}

static usb_endpoint_mapping_t *find_endpoint_mapping(
    usb_endpoint_mapping_t *mapping, size_t mapping_count,
    usb_endpoint_description_t *found_endpoint,
    int interface_number, int interface_setting)
{
        while (mapping_count > 0) {
                bool interface_number_fits = (mapping->interface_no < 0)
                    || (mapping->interface_no == interface_number);

                bool interface_setting_fits = (mapping->interface_setting < 0)
                    || (mapping->interface_setting == interface_setting);

                bool endpoint_descriptions_fits = endpoint_fits_description(
                    mapping->description, found_endpoint);

                if (interface_number_fits
                    && interface_setting_fits
                    && endpoint_descriptions_fits) {
                        return mapping;
                }

                mapping++;
                mapping_count--;
        }
        return NULL;
}

static int process_endpoint(
    usb_endpoint_mapping_t *mapping, size_t mapping_count,
    usb_standard_interface_descriptor_t *interface,
    usb_standard_endpoint_descriptor_t *endpoint,
    usb_device_connection_t *wire)
{
        usb_endpoint_description_t description;

        /*
         * Get endpoint characteristics.
         */

        /* Actual endpoint number is in bits 0..3 */
        usb_endpoint_t ep_no = endpoint->endpoint_address & 0x0F;

        /* Endpoint direction is set by bit 7 */
        description.direction = (endpoint->endpoint_address & 128)
            ? USB_DIRECTION_IN : USB_DIRECTION_OUT;
        /* Transfer type is in bits 0..2 and the enum values corresponds 1:1 */
        description.transfer_type = endpoint->attributes & 3;

        /*
         * Get interface characteristics.
         */
        description.interface_class = interface->interface_class;
        description.interface_subclass = interface->interface_subclass;
        description.interface_protocol = interface->interface_protocol;

        /*
         * Find the most fitting mapping and initialize the pipe.
         */
        usb_endpoint_mapping_t *ep_mapping = find_endpoint_mapping(mapping,
            mapping_count, &description,
            interface->interface_number, interface->alternate_setting);
        if (ep_mapping == NULL) {
                return ENOENT;
        }

        if (ep_mapping->pipe == NULL) {
                return EBADMEM;
        }
        if (ep_mapping->present) {
                return EEXISTS;
        }

        int rc = usb_pipe_initialize(ep_mapping->pipe, wire,
            ep_no, description.transfer_type, endpoint->max_packet_size,
            description.direction);
        if (rc != EOK) {
                return rc;
        }

        ep_mapping->present = true;
        ep_mapping->descriptor = endpoint;
        ep_mapping->interface = interface;

        return EOK;
}

static int process_interface(
    usb_endpoint_mapping_t *mapping, size_t mapping_count,
    usb_dp_parser_t *parser, usb_dp_parser_data_t *parser_data,
    uint8_t *interface_descriptor)
{
        uint8_t *descriptor = usb_dp_get_nested_descriptor(parser,
            parser_data, interface_descriptor);

        if (descriptor == NULL) {
                return ENOENT;
        }

        do {
                if (is_endpoint_descriptor(descriptor)) {
                        (void) process_endpoint(mapping, mapping_count,
                            (usb_standard_interface_descriptor_t *)
                                interface_descriptor,
                            (usb_standard_endpoint_descriptor_t *)
                                descriptor,
                            (usb_device_connection_t *) parser_data->arg);
                }

                descriptor = usb_dp_get_sibling_descriptor(parser, parser_data,
                    interface_descriptor, descriptor);
        } while (descriptor != NULL);

        return EOK;
}

int usb_pipe_initialize_from_configuration(
    usb_endpoint_mapping_t *mapping, size_t mapping_count,
    uint8_t *configuration_descriptor, size_t configuration_descriptor_size,
    usb_device_connection_t *connection)
{
        assert(connection);

        if (configuration_descriptor == NULL) {
                return EBADMEM;
        }
        if (configuration_descriptor_size
            < sizeof(usb_standard_configuration_descriptor_t)) {
                return ERANGE;
        }

        /*
         * Go through the mapping and set all endpoints to not present.
         */
        size_t i;
        for (i = 0; i < mapping_count; i++) {
                mapping[i].present = false;
                mapping[i].descriptor = NULL;
                mapping[i].interface = NULL;
        }

        /*
         * Prepare the descriptor parser.
         */
        usb_dp_parser_t dp_parser = {
                .nesting = descriptor_nesting
        };
        usb_dp_parser_data_t dp_data = {
                .data = configuration_descriptor,
                .size = configuration_descriptor_size,
                .arg = connection
        };

        /*
         * Iterate through all interfaces.
         */
        uint8_t *interface = usb_dp_get_nested_descriptor(&dp_parser,
            &dp_data, configuration_descriptor);
        if (interface == NULL) {
                return ENOENT;
        }
        do {
                (void) process_interface(mapping, mapping_count,
                    &dp_parser, &dp_data,
                    interface);
                interface = usb_dp_get_sibling_descriptor(&dp_parser, &dp_data,
                    configuration_descriptor, interface);
        } while (interface != NULL);

        return EOK;
}

int usb_pipe_initialize(usb_pipe_t *pipe,
    usb_device_connection_t *connection, usb_endpoint_t endpoint_no,
    usb_transfer_type_t transfer_type, size_t max_packet_size,
    usb_direction_t direction)
{
        assert(pipe);
        assert(connection);

        fibril_mutex_initialize(&pipe->guard);
        pipe->wire = connection;
        pipe->hc_phone = -1;
        fibril_mutex_initialize(&pipe->hc_phone_mutex);
        pipe->endpoint_no = endpoint_no;
        pipe->transfer_type = transfer_type;
        pipe->max_packet_size = max_packet_size;
        pipe->direction = direction;
        pipe->refcount = 0;
        pipe->refcount_soft = 0;
        pipe->auto_reset_halt = false;

        return EOK;
}


int usb_pipe_initialize_default_control(usb_pipe_t *pipe,
    usb_device_connection_t *connection)
{
        assert(pipe);
        assert(connection);

        int rc = usb_pipe_initialize(pipe, connection,
            0, USB_TRANSFER_CONTROL, CTRL_PIPE_MIN_PACKET_SIZE,
            USB_DIRECTION_BOTH);

        pipe->auto_reset_halt = true;

        return rc;
}

int usb_pipe_probe_default_control(usb_pipe_t *pipe)
{
        assert(pipe);
        assert(DEV_DESCR_MAX_PACKET_SIZE_OFFSET < CTRL_PIPE_MIN_PACKET_SIZE);

        if ((pipe->direction != USB_DIRECTION_BOTH) ||
            (pipe->transfer_type != USB_TRANSFER_CONTROL) ||
            (pipe->endpoint_no != 0)) {
                return EINVAL;
        }

#define TRY_LOOP(attempt_var) \
        for (attempt_var = 0; attempt_var < 3; attempt_var++)

        size_t failed_attempts;
        int rc;

        usb_pipe_start_long_transfer(pipe);

        uint8_t dev_descr_start[CTRL_PIPE_MIN_PACKET_SIZE];
        size_t transferred_size;
        TRY_LOOP(failed_attempts) {
                rc = usb_request_get_descriptor(pipe, USB_REQUEST_TYPE_STANDARD,
                    USB_REQUEST_RECIPIENT_DEVICE, USB_DESCTYPE_DEVICE,
                    0, 0, dev_descr_start, CTRL_PIPE_MIN_PACKET_SIZE,
                    &transferred_size);
                if (rc == EOK) {
                        if (transferred_size != CTRL_PIPE_MIN_PACKET_SIZE) {
                                rc = ELIMIT;
                                continue;
                        }
                        break;
                }
        }
        usb_pipe_end_long_transfer(pipe);
        if (rc != EOK) {
                return rc;
        }

        pipe->max_packet_size
            = dev_descr_start[DEV_DESCR_MAX_PACKET_SIZE_OFFSET];

        return EOK;
}

int usb_pipe_register(usb_pipe_t *pipe,
    unsigned int interval,
    usb_hc_connection_t *hc_connection)
{
        return usb_pipe_register_with_speed(pipe, USB_SPEED_MAX + 1,
            interval, hc_connection);
}

int usb_pipe_register_with_speed(usb_pipe_t *pipe, usb_speed_t speed,
    unsigned int interval,
    usb_hc_connection_t *hc_connection)
{
        assert(pipe);
        assert(hc_connection);

        if (!usb_hc_connection_is_opened(hc_connection)) {
                return EBADF;
        }

#define _PACK2(high, low) (((high) << 16) + (low))
#define _PACK3(high, middle, low) (((((high) << 8) + (middle)) << 8) + (low))

        return async_req_4_0(hc_connection->hc_phone,
            DEV_IFACE_ID(USBHC_DEV_IFACE), IPC_M_USBHC_REGISTER_ENDPOINT,
            _PACK2(pipe->wire->address, pipe->endpoint_no),
            _PACK3(speed, pipe->transfer_type, pipe->direction),
            _PACK2(pipe->max_packet_size, interval));

#undef _PACK2
#undef _PACK3
}

int usb_pipe_unregister(usb_pipe_t *pipe,
    usb_hc_connection_t *hc_connection)
{
        assert(pipe);
        assert(hc_connection);

        if (!usb_hc_connection_is_opened(hc_connection)) {
                return EBADF;
        }

        return async_req_4_0(hc_connection->hc_phone,
            DEV_IFACE_ID(USBHC_DEV_IFACE), IPC_M_USBHC_UNREGISTER_ENDPOINT,
            pipe->wire->address, pipe->endpoint_no, pipe->direction);
}

---