dump.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 <adt/list.h>
#include <fibril_synch.h>
#include <errno.h>
#include <stdlib.h>
#include <stdio.h>
#include <usb/debug.h>
#include <usb/descriptor.h>
#include <usb/classes/classes.h>

typedef struct {
        int id;
        void (*dump)(FILE *, const char *, const char *,
            const uint8_t *, size_t);
} descriptor_dump_t;

static void usb_dump_descriptor_device(FILE *, const char *, const char *,
    const uint8_t *, size_t);
static void usb_dump_descriptor_configuration(FILE *, const char *, const char *,
    const uint8_t *, size_t);
static void usb_dump_descriptor_interface(FILE *, const char *, const char *,
    const uint8_t *, size_t);
static void usb_dump_descriptor_string(FILE *, const char *, const char *,
    const uint8_t *, size_t);
static void usb_dump_descriptor_endpoint(FILE *, const char *, const char *,
    const uint8_t *, size_t);
static void usb_dump_descriptor_hid(FILE *, const char *, const char *,
    const uint8_t *, size_t);
static void usb_dump_descriptor_hub(FILE *, const char *, const char *,
    const uint8_t *, size_t);
static void usb_dump_descriptor_generic(FILE *, const char *, const char *,
    const uint8_t *, size_t);

static descriptor_dump_t descriptor_dumpers[] = {
        { USB_DESCTYPE_DEVICE, usb_dump_descriptor_device },
        { USB_DESCTYPE_CONFIGURATION, usb_dump_descriptor_configuration },
        { USB_DESCTYPE_STRING, usb_dump_descriptor_string },
        { USB_DESCTYPE_INTERFACE, usb_dump_descriptor_interface },
        { USB_DESCTYPE_ENDPOINT, usb_dump_descriptor_endpoint },
        { USB_DESCTYPE_HID, usb_dump_descriptor_hid },
        { USB_DESCTYPE_HUB, usb_dump_descriptor_hub },
        { -1, usb_dump_descriptor_generic },
        { -1, NULL }
};

void usb_dump_standard_descriptor(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        if (descriptor_length < 2) {
                return;
        }
        int type = descriptor[1];

        descriptor_dump_t *dumper = descriptor_dumpers;
        while (dumper->dump != NULL) {
                if ((dumper->id == type) || (dumper->id < 0)) {
                        dumper->dump(output, line_prefix, line_suffix,
                            descriptor, descriptor_length);
                        return;
                }
                dumper++;
        }
}

#define PRINTLINE(fmt, ...) \
        fprintf(output, "%s" fmt "%s", \
            line_prefix ? line_prefix : " - ", \
            __VA_ARGS__, \
            line_suffix ? line_suffix : "\n")

#define BCD_INT(a) (((unsigned int)(a)) / 256)
#define BCD_FRAC(a) (((unsigned int)(a)) % 256)

#define BCD_FMT "%x.%x"
#define BCD_ARGS(a) BCD_INT((a)), BCD_FRAC((a))

static void usb_dump_descriptor_device(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        usb_standard_device_descriptor_t *d
            = (usb_standard_device_descriptor_t *) descriptor;
        if (descriptor_length < sizeof(*d)) {
                return;
        }

        PRINTLINE("bLength = %d", d->length);
        PRINTLINE("bDescriptorType = 0x%02x", d->descriptor_type);
        PRINTLINE("bcdUSB = %d (" BCD_FMT ")", d->usb_spec_version,
            BCD_ARGS(d->usb_spec_version));
        PRINTLINE("bDeviceClass = 0x%02x", d->device_class);
        PRINTLINE("bDeviceSubClass = 0x%02x", d->device_subclass);
        PRINTLINE("bDeviceProtocol = 0x%02x", d->device_protocol);
        PRINTLINE("bMaxPacketSize0 = %d", d->max_packet_size);
        PRINTLINE("idVendor = 0x%04x", d->vendor_id);
        PRINTLINE("idProduct = 0x%04x", d->product_id);
        PRINTLINE("bcdDevice = %d", d->device_version);
        PRINTLINE("iManufacturer = %d", d->str_manufacturer);
        PRINTLINE("iProduct = %d", d->str_product);
        PRINTLINE("iSerialNumber = %d", d->str_serial_number);
        PRINTLINE("bNumConfigurations = %d", d->configuration_count);
}

static void usb_dump_descriptor_configuration(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        usb_standard_configuration_descriptor_t *d
            = (usb_standard_configuration_descriptor_t *) descriptor;
        if (descriptor_length < sizeof(*d)) {
                return;
        }

        bool self_powered = d->attributes & 64;
        bool remote_wakeup = d->attributes & 32;

        PRINTLINE("bLength = %d", d->length);
        PRINTLINE("bDescriptorType = 0x%02x", d->descriptor_type);
        PRINTLINE("wTotalLength = %d", d->total_length);
        PRINTLINE("bNumInterfaces = %d", d->interface_count);
        PRINTLINE("bConfigurationValue = %d", d->configuration_number);
        PRINTLINE("iConfiguration = %d", d->str_configuration);
        PRINTLINE("bmAttributes = %d [%s%s%s]", d->attributes,
            self_powered ? "self-powered" : "",
            (self_powered & remote_wakeup) ? ", " : "",
            remote_wakeup ? "remote-wakeup" : "");
        PRINTLINE("MaxPower = %d (%dmA)", d->max_power,
            2 * d->max_power);
}

static void usb_dump_descriptor_interface(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        usb_standard_interface_descriptor_t *d
            = (usb_standard_interface_descriptor_t *) descriptor;
        if (descriptor_length < sizeof(*d)) {
                return;
        }

        PRINTLINE("bLength = %d", d->length);
        PRINTLINE("bDescriptorType = 0x%02x", d->descriptor_type);
        PRINTLINE("bInterfaceNumber = %d", d->interface_number);
        PRINTLINE("bAlternateSetting = %d", d->alternate_setting);
        PRINTLINE("bNumEndpoints = %d", d->endpoint_count);
        PRINTLINE("bInterfaceClass = %s", d->interface_class == 0
            ? "reserved (0)" : usb_str_class(d->interface_class));
        PRINTLINE("bInterfaceSubClass = %d", d->interface_subclass);
        PRINTLINE("bInterfaceProtocol = %d", d->interface_protocol);
        PRINTLINE("iInterface = %d", d->str_interface);
}

static void usb_dump_descriptor_string(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
}

static void usb_dump_descriptor_endpoint(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        usb_standard_endpoint_descriptor_t *d
           = (usb_standard_endpoint_descriptor_t *) descriptor;
        if (descriptor_length < sizeof(*d)) {
                return;
        }

        int endpoint = d->endpoint_address & 15;
        usb_direction_t direction = d->endpoint_address & 128
            ? USB_DIRECTION_IN : USB_DIRECTION_OUT;
        usb_transfer_type_t transfer_type = d->attributes & 3;

        PRINTLINE("bLength = %d", d->length);
        PRINTLINE("bDescriptorType = 0x%02X", d->descriptor_type);
        PRINTLINE("bEndpointAddress = 0x%02X [%d, %s]",
            d->endpoint_address, endpoint,
            direction == USB_DIRECTION_IN ? "in" : "out");
        PRINTLINE("bmAttributes = %d [%s]", d->attributes,
            usb_str_transfer_type(transfer_type));
        PRINTLINE("wMaxPacketSize = %d", d->max_packet_size);
        PRINTLINE("bInterval = %dms", d->poll_interval);
}

static void usb_dump_descriptor_hid(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        usb_standard_hid_descriptor_t *d
            = (usb_standard_hid_descriptor_t *) descriptor;
        if (descriptor_length < sizeof(*d)) {
                return;
        }

        PRINTLINE("bLength = %d", d->length);
        PRINTLINE("bDescriptorType = 0x%02x", d->descriptor_type);
        PRINTLINE("bcdHID = %d (" BCD_FMT ")", d->spec_release,
            BCD_ARGS(d->spec_release));
        PRINTLINE("bCountryCode = %d", d->country_code);
        PRINTLINE("bNumDescriptors = %d", d->class_desc_count);
        PRINTLINE("bDescriptorType = %d", d->report_desc_info.type);
        PRINTLINE("wDescriptorLength = %d", d->report_desc_info.length);

        /* Print info about report descriptors. */
        size_t i;
        size_t count = (descriptor_length - sizeof(*d))
            / sizeof(usb_standard_hid_class_descriptor_info_t);
        usb_standard_hid_class_descriptor_info_t *d2
            = (usb_standard_hid_class_descriptor_info_t *)
            (descriptor + sizeof(*d));
        for (i = 0; i < count; i++, d2++) {
                PRINTLINE("bDescriptorType = %d", d2->type);
                PRINTLINE("wDescriptorLength = %d", d2->length);
        }
}

static void usb_dump_descriptor_hub(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        /* TODO */
}

static void usb_dump_descriptor_generic(FILE *output,
    const char *line_prefix, const char *line_suffix,
    const uint8_t *descriptor, size_t descriptor_length)
{
        /* TODO */
}

---