circuitpython/supervisor/shared/usb/usb_desc.c

/*
 * This file is part of the MicroPython project, http://micropython.org/
 *
 * The MIT License (MIT)
 *
 * Copyright (c) 2018 hathach for Adafruit Industries
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

#include "lib/tinyusb/src/tusb.h"

#include "py/objstr.h"
#include "py/runtime.h"
#include "supervisor/memory.h"
#include "supervisor/shared/safe_mode.h"
#include "supervisor/usb.h"

#if CIRCUITPY_USB_CDC
#include "shared-bindings/usb_cdc/__init__.h"
#endif

#if CIRCUITPY_USB_HID
#include "shared-bindings/usb_hid/__init__.h"
#endif

#if CIRCUITPY_USB_MIDI
#include "shared-bindings/usb_midi/__init__.h"
#endif

#if CIRCUITPY_USB_MSC && CIRCUITPY_STORAGE
#include "shared-bindings/storage/__init__.h"
#endif

#include "shared-bindings/microcontroller/Processor.h"


// Table for collecting interface strings (interface names) as descriptor is built.
// We reuse the same table after collection, replacing the char string pointers with le16 string pointers.
#define MAX_INTERFACE_STRINGS 16
// slot 0 is always the Language ID
typedef union {
    const char *char_str;
    const uint16_t *descriptor;
} interface_string_t;
static interface_string_t collected_interface_strings[MAX_INTERFACE_STRINGS];

static size_t collected_interface_strings_length;
static uint8_t current_interface_string;

static supervisor_allocation *device_descriptor_allocation;
static supervisor_allocation *configuration_descriptor_allocation;
static supervisor_allocation *string_descriptors_allocation;

static const char manufacturer_name[] = USB_MANUFACTURER;
static const char product_name[] = USB_PRODUCT;

// Serial number string is UID length * 2 (2 nibbles per byte) + 1 byte for null termination.
static char serial_number_hex_string[COMMON_HAL_MCU_PROCESSOR_UID_LENGTH * 2 + 1];


static const uint8_t device_descriptor_template[] = {
    0x12,        //  0 bLength
    0x01,        //  1 bDescriptorType (Device)
    0x00, 0x02,  //  2,3 bcdUSB 2.00
    0x00,        //  4 bDeviceClass (Use class information in the Interface Descriptors)
    0x00,        //  5 bDeviceSubClass
    0x00,        //  6 bDeviceProtocol
    0x40,        //  7 bMaxPacketSize0 64
    0xFF, 0xFF,  //  8,9 idVendor [SET AT RUNTIME: lo,hi]
#define DEVICE_VID_LO_INDEX (8)
#define DEVICE_VID_HI_INDEX (9)
    0xFF, 0xFF,  // 10,11 idProduct [SET AT RUNTIME: lo,hi]
#define DEVICE_PID_LO_INDEX (10)
#define DEVICE_PID_HI_INDEX (11)
    0x00, 0x01,  // 12,13 bcdDevice 2.00
    0xFF,        // 14 iManufacturer (String Index) [SET AT RUNTIME]
#define DEVICE_MANUFACTURER_STRING_INDEX (14)
    0xFF,        // 15 iProduct (String Index) [SET AT RUNTIME]
#define DEVICE_PRODUCT_STRING_INDEX (15)
    0xFF,        // 16 iSerialNumber (String Index)  [SET AT RUNTIME]
#define DEVICE_SERIAL_NUMBER_STRING_INDEX (16)
    0x01,        // 17 bNumConfigurations 1
};

static const uint8_t configuration_descriptor_template[] = {
    0x09,        // 0 bLength
    0x02,        // 1 bDescriptorType (Configuration)
    0xFF, 0xFF,  // 2,3 wTotalLength  [SET AT RUNTIME: lo, hi]
#define CONFIG_TOTAL_LENGTH_LO_INDEX (2)
#define CONFIG_TOTAL_LENGTH_HI_INDEX (3)
    0xFF,        // 4 bNumInterfaces  [SET AT RUNTIME]
#define CONFIG_NUM_INTERFACES_INDEX (4)
    0x01,        // 5 bConfigurationValue
    0x00,        // 6 iConfiguration (String Index)
    0x80,        // 7 bmAttributes
    0x32,        // 8 bMaxPower 100mA
};

static void usb_build_device_descriptor(uint16_t vid, uint16_t pid) {
    device_descriptor_allocation =
        allocate_memory(align32_size(sizeof(device_descriptor_template)),
            /*high_address*/ false, /*movable*/ false);
    uint8_t *device_descriptor = (uint8_t *)device_descriptor_allocation->ptr;
    memcpy(device_descriptor, device_descriptor_template, sizeof(device_descriptor_template));

    device_descriptor[DEVICE_VID_LO_INDEX] = vid & 0xFF;
    device_descriptor[DEVICE_VID_HI_INDEX] = vid >> 8;
    device_descriptor[DEVICE_PID_LO_INDEX] = pid & 0xFF;
    device_descriptor[DEVICE_PID_HI_INDEX] = pid >> 8;

    usb_add_interface_string(current_interface_string, manufacturer_name);
    device_descriptor[DEVICE_MANUFACTURER_STRING_INDEX] = current_interface_string;
    current_interface_string++;

    usb_add_interface_string(current_interface_string, product_name);
    device_descriptor[DEVICE_PRODUCT_STRING_INDEX] = current_interface_string;
    current_interface_string++;

    usb_add_interface_string(current_interface_string, serial_number_hex_string);
    device_descriptor[DEVICE_SERIAL_NUMBER_STRING_INDEX] = current_interface_string;
    current_interface_string++;
}

static void usb_build_configuration_descriptor(void) {
    size_t total_descriptor_length = sizeof(configuration_descriptor_template);

    // CDC should be first, for compatibility with Adafruit Windows 7 drivers.
    // In the past, the order has been CDC, MSC, MIDI, HID, so preserve that order.
    #if CIRCUITPY_USB_CDC
    if (usb_cdc_console_enabled()) {
        total_descriptor_length += usb_cdc_descriptor_length();
    }
    if (usb_cdc_data_enabled()) {
        total_descriptor_length += usb_cdc_descriptor_length();
    }
    #endif

    #if CIRCUITPY_USB_MSC
    if (storage_usb_enabled()) {
        total_descriptor_length += storage_usb_descriptor_length();
    }
    #endif

    #if CIRCUITPY_USB_HID
    if (usb_hid_enabled()) {
        total_descriptor_length += usb_hid_descriptor_length();
    }
    #endif

    #if CIRCUITPY_USB_MIDI
    if (usb_midi_enabled()) {
        total_descriptor_length += usb_midi_descriptor_length();
    }
    #endif

    #if CIRCUITPY_USB_VENDOR
    if (usb_vendor_enabled()) {
        total_descriptor_length += usb_vendor_descriptor_length();
    }
    #endif


    // Now we now how big the configuration descriptor will be, so we can allocate space for it.
    configuration_descriptor_allocation =
        allocate_memory(align32_size(total_descriptor_length),
            /*high_address*/ false, /*movable*/ false);
    uint8_t *configuration_descriptor = (uint8_t *)configuration_descriptor_allocation->ptr;

    // Copy the template, which is the first part of the descriptor, and fix up its length.

    memcpy(configuration_descriptor, configuration_descriptor_template, sizeof(configuration_descriptor_template));

    configuration_descriptor[CONFIG_TOTAL_LENGTH_LO_INDEX] = total_descriptor_length & 0xFF;
    configuration_descriptor[CONFIG_TOTAL_LENGTH_HI_INDEX] = (total_descriptor_length >> 8) & 0xFF;

    // Number interfaces and endpoints.
    // Endpoint 0 is already used for USB control,
    // so start with 1 for the current endpoint and for the number of in and out endpoints
    // already in use.

    descriptor_counts_t descriptor_counts = {
        .current_interface = 0,
        .current_endpoint = 1,
        .num_in_endpoints = 1,
        .num_out_endpoints = 1,
    };

    uint8_t *descriptor_buf_remaining = configuration_descriptor + sizeof(configuration_descriptor_template);

    #if CIRCUITPY_USB_CDC
    if (usb_cdc_console_enabled()) {
        // Concatenate and fix up the CDC REPL descriptor.
        descriptor_buf_remaining += usb_cdc_add_descriptor(
            descriptor_buf_remaining, &descriptor_counts, &current_interface_string, true /*console*/);

    }
    if (usb_cdc_data_enabled()) {
        // Concatenate and fix up the CDC data descriptor.
        descriptor_buf_remaining += usb_cdc_add_descriptor(
            descriptor_buf_remaining, &descriptor_counts, &current_interface_string, false /*console*/);
    }
    #endif

    #if CIRCUITPY_USB_MSC
    if (storage_usb_enabled()) {
        // Concatenate and fix up the MSC descriptor.
        descriptor_buf_remaining += storage_usb_add_descriptor(
            descriptor_buf_remaining, &descriptor_counts, &current_interface_string);
    }
    #endif

    #if CIRCUITPY_USB_HID
    if (usb_hid_enabled()) {
        if (usb_hid_boot_device() > 0 && descriptor_counts.current_interface > 0) {
            // Hosts using boot devices generally to expect them to be at interface zero,
            // and will not work properly otherwise.
            reset_into_safe_mode(USB_BOOT_DEVICE_NOT_INTERFACE_ZERO);
        }
        descriptor_buf_remaining += usb_hid_add_descriptor(
            descriptor_buf_remaining, &descriptor_counts, &current_interface_string,
            usb_hid_report_descriptor_length(), usb_hid_boot_device());
    }
    #endif

    #if CIRCUITPY_USB_MIDI
    if (usb_midi_enabled()) {
        // Concatenate and fix up the MIDI descriptor.
        descriptor_buf_remaining += usb_midi_add_descriptor(
            descriptor_buf_remaining, &descriptor_counts, &current_interface_string);
    }
    #endif

    #if CIRCUITPY_USB_VENDOR
    if (usb_vendor_enabled()) {
        descriptor_buf_remaining += usb_vendor_add_descriptor(
            descriptor_buf_remaining, &descriptor_counts, &current_interface_string);
    }
    #endif

    // Now we know how many interfaces have been used.
    configuration_descriptor[CONFIG_NUM_INTERFACES_INDEX] = descriptor_counts.current_interface;

    // Did we run out of endpoints?
    if (descriptor_counts.current_endpoint > USB_NUM_ENDPOINT_PAIRS ||
        descriptor_counts.num_in_endpoints > USB_NUM_IN_ENDPOINTS ||
        descriptor_counts.num_out_endpoints > USB_NUM_OUT_ENDPOINTS) {
        reset_into_safe_mode(USB_TOO_MANY_ENDPOINTS);
    }
}

// str must not be on the heap.
void usb_add_interface_string(uint8_t interface_string_index, const char str[]) {
    if (interface_string_index > MAX_INTERFACE_STRINGS) {
        reset_into_safe_mode(USB_TOO_MANY_INTERFACE_NAMES);
    }

    collected_interface_strings[interface_string_index].char_str = str;
    collected_interface_strings_length += strlen(str);
}

static const uint16_t language_id[] = {
    0x0304,
    0x0409,
};

static void usb_build_interface_string_table(void) {
    // Allocate space for the le16 String descriptors.
    // Space needed is 2 bytes for String Descriptor header, then 2 bytes for each character
    string_descriptors_allocation =
        allocate_memory(align32_size(current_interface_string * 2 + collected_interface_strings_length * 2),
            /*high_address*/ false, /*movable*/ false);
    uint16_t *string_descriptors = (uint16_t *)string_descriptors_allocation->ptr;


    uint16_t *string_descriptor = string_descriptors;

    // Language ID is always the 0th string descriptor.
    collected_interface_strings[0].descriptor = language_id;

    // Build the le16 versions of all the descriptor strings.
    // Start at 1 to skip the Language ID.
    for (uint8_t string_index = 1; string_index < current_interface_string; string_index++) {
        const char *str = collected_interface_strings[string_index].char_str;
        const size_t str_len = strlen(str);
        // 1 word for descriptor type and length, 1 word for each character.
        const uint8_t descriptor_size_words = 1 + str_len;
        const uint8_t descriptor_size_bytes = descriptor_size_words * 2;
        string_descriptor[0] = 0x0300 | descriptor_size_bytes;

        // Convert to le16.
        for (size_t i = 0; i < str_len; i++) {
            string_descriptor[i + 1] = str[i];
        }

        // Save ptr to string descriptor with le16 str.
        collected_interface_strings[string_index].descriptor = string_descriptor;

        // Move to next descriptor slot.
        string_descriptor += descriptor_size_words;
    }
}

// After boot.py runs, the USB devices to be used have been chosen, and the descriptors can be set up.
// This is called after the VM is finished, because it uses storage_allocations.
void usb_build_descriptors(void) {
    uint8_t raw_id[COMMON_HAL_MCU_PROCESSOR_UID_LENGTH];
    common_hal_mcu_processor_get_uid(raw_id);

    for (int i = 0; i < COMMON_HAL_MCU_PROCESSOR_UID_LENGTH; i++) {
        for (int j = 0; j < 2; j++) {
            uint8_t nibble = (raw_id[i] >> (j * 4)) & 0xf;
            serial_number_hex_string[i * 2 + (1 - j)] = nibble_to_hex_upper[nibble];
        }
    }

    // Null-terminate the string.
    serial_number_hex_string[sizeof(serial_number_hex_string) - 1] = '\0';

    current_interface_string = 1;
    collected_interface_strings_length = 0;

    usb_build_device_descriptor(USB_VID, USB_PID);
    usb_build_configuration_descriptor();
    usb_build_interface_string_table();
}

// Invoked when GET DEVICE DESCRIPTOR is received.
// Application return pointer to descriptor
uint8_t const *tud_descriptor_device_cb(void) {
    return (uint8_t *)device_descriptor_allocation->ptr;
}

// Invoked when GET CONFIGURATION DESCRIPTOR is received.
// Application return pointer to descriptor
// Descriptor contents must exist long enough for transfer to complete
uint8_t const *tud_descriptor_configuration_cb(uint8_t index) {
    (void)index;  // for multiple configurations
    return (uint8_t *)configuration_descriptor_allocation->ptr;
}

// Invoked when GET STRING DESCRIPTOR request is received.
// Application return pointer to descriptor, whose contents must exist long enough for transfer to complete
uint16_t const *tud_descriptor_string_cb(uint8_t index, uint16_t langid) {
    if (index > MAX_INTERFACE_STRINGS) {
        return NULL;
    }
    return collected_interface_strings[index].descriptor;
}