Momentum-Apps/firmware/targets/f7/furi-hal/furi-hal-usb-cdc.c

#include "furi-hal-version.h"
#include "furi-hal-usb_i.h"
#include "furi-hal-usb-cdc_i.h"
#include <furi.h>

#include "usb.h"
#include "usb_cdc.h"

#define CDC0_RXD_EP      0x01
#define CDC0_TXD_EP      0x81
#define CDC0_NTF_EP      0x82

#define CDC1_RXD_EP      0x03
#define CDC1_TXD_EP      0x83
#define CDC1_NTF_EP      0x84

#define CDC_NTF_SZ      0x08

#define IF_NUM_MAX 2

struct CdcIadDescriptor {
    struct usb_iad_descriptor           comm_iad;
    struct usb_interface_descriptor     comm;
    struct usb_cdc_header_desc          cdc_hdr;
    struct usb_cdc_call_mgmt_desc       cdc_mgmt;
    struct usb_cdc_acm_desc             cdc_acm;
    struct usb_cdc_union_desc           cdc_union;
    struct usb_endpoint_descriptor      comm_ep;
    struct usb_interface_descriptor     data;
    struct usb_endpoint_descriptor      data_eprx;
    struct usb_endpoint_descriptor      data_eptx;
};

struct CdcConfigDescriptorSingle {
    struct usb_config_descriptor        config;
    struct CdcIadDescriptor             iad_0;
} __attribute__((packed));

struct CdcConfigDescriptorDual {
    struct usb_config_descriptor        config;
    struct CdcIadDescriptor             iad_0;
    struct CdcIadDescriptor             iad_1;
} __attribute__((packed));

static const struct usb_string_descriptor dev_manuf_desc = USB_STRING_DESC("Flipper Devices Inc.");

/* Device descriptor */
static const struct usb_device_descriptor cdc_device_desc = {
    .bLength            = sizeof(struct usb_device_descriptor),
    .bDescriptorType    = USB_DTYPE_DEVICE,
    .bcdUSB             = VERSION_BCD(2,0,0),
    .bDeviceClass       = USB_CLASS_IAD,
    .bDeviceSubClass    = USB_SUBCLASS_IAD,
    .bDeviceProtocol    = USB_PROTO_IAD,
    .bMaxPacketSize0    = USB_EP0_SIZE,
    .idVendor           = 0x0483,
    .idProduct          = 0x5740,
    .bcdDevice          = VERSION_BCD(1,0,0),
    .iManufacturer      = UsbDevManuf,
    .iProduct           = UsbDevProduct,
    .iSerialNumber      = UsbDevSerial,
    .bNumConfigurations = 1,
};

/* Device configuration descriptor - single mode*/
static const struct CdcConfigDescriptorSingle cdc_cfg_desc_single = {
    .config = {
        .bLength                = sizeof(struct usb_config_descriptor),
        .bDescriptorType        = USB_DTYPE_CONFIGURATION,
        .wTotalLength           = sizeof(struct CdcConfigDescriptorSingle),
        .bNumInterfaces         = 2,

        .bConfigurationValue    = 1,
        .iConfiguration         = NO_DESCRIPTOR,
        .bmAttributes           = USB_CFG_ATTR_RESERVED | USB_CFG_ATTR_SELFPOWERED,
        .bMaxPower              = USB_CFG_POWER_MA(100),
    },
    .iad_0 = {
        .comm_iad = {
            .bLength                = sizeof(struct usb_iad_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFASEASSOC,
            .bFirstInterface        = 0,
            .bInterfaceCount        = 2,
            .bFunctionClass         = USB_CLASS_CDC,
            .bFunctionSubClass      = USB_CDC_SUBCLASS_ACM,
            .bFunctionProtocol      = USB_PROTO_NONE,
            .iFunction              = NO_DESCRIPTOR,
        },
        .comm = {
            .bLength                = sizeof(struct usb_interface_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFACE,
            .bInterfaceNumber       = 0,
            .bAlternateSetting      = 0,
            .bNumEndpoints          = 1,
            .bInterfaceClass        = USB_CLASS_CDC,
            .bInterfaceSubClass     = USB_CDC_SUBCLASS_ACM,
            .bInterfaceProtocol     = USB_PROTO_NONE,
            .iInterface             = NO_DESCRIPTOR,
        },
        .cdc_hdr = {
            .bFunctionLength        = sizeof(struct usb_cdc_header_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_HEADER,
            .bcdCDC                 = VERSION_BCD(1,1,0),
        },
        .cdc_mgmt = {
            .bFunctionLength        = sizeof(struct usb_cdc_call_mgmt_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_CALL_MANAGEMENT,
            .bmCapabilities         = 0,
            .bDataInterface         = 1,
        },
        .cdc_acm = {
            .bFunctionLength        = sizeof(struct usb_cdc_acm_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_ACM,
            .bmCapabilities         = 0,
        },
        .cdc_union = {
            .bFunctionLength        = sizeof(struct usb_cdc_union_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_UNION,
            .bMasterInterface0      = 0,
            .bSlaveInterface0       = 1,
        },
        .comm_ep = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC0_NTF_EP,
            .bmAttributes           = USB_EPTYPE_INTERRUPT,
            .wMaxPacketSize         = CDC_NTF_SZ,
            .bInterval              = 0xFF,
        },
        .data = {
            .bLength                = sizeof(struct usb_interface_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFACE,
            .bInterfaceNumber       = 1,
            .bAlternateSetting      = 0,
            .bNumEndpoints          = 2,
            .bInterfaceClass        = USB_CLASS_CDC_DATA,
            .bInterfaceSubClass     = USB_SUBCLASS_NONE,
            .bInterfaceProtocol     = USB_PROTO_NONE,
            .iInterface             = NO_DESCRIPTOR,
        },
        .data_eprx = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC0_RXD_EP,
            .bmAttributes           = USB_EPTYPE_BULK,
            .wMaxPacketSize         = CDC_DATA_SZ,
            .bInterval              = 0x01,
        },
        .data_eptx = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC0_TXD_EP,
            .bmAttributes           = USB_EPTYPE_BULK,
            .wMaxPacketSize         = CDC_DATA_SZ,
            .bInterval              = 0x01,
        },
    },
};

/* Device configuration descriptor - dual mode*/
static const struct CdcConfigDescriptorDual cdc_cfg_desc_dual = {
    .config = {
        .bLength                = sizeof(struct usb_config_descriptor),
        .bDescriptorType        = USB_DTYPE_CONFIGURATION,
        .wTotalLength           = sizeof(struct CdcConfigDescriptorDual),
        .bNumInterfaces         = 4,

        .bConfigurationValue    = 1,
        .iConfiguration         = NO_DESCRIPTOR,
        .bmAttributes           = USB_CFG_ATTR_RESERVED | USB_CFG_ATTR_SELFPOWERED,
        .bMaxPower              = USB_CFG_POWER_MA(100),
    },
    .iad_0 = {
        .comm_iad = {
            .bLength                = sizeof(struct usb_iad_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFASEASSOC,
            .bFirstInterface        = 0,
            .bInterfaceCount        = 2,
            .bFunctionClass         = USB_CLASS_CDC,
            .bFunctionSubClass      = USB_CDC_SUBCLASS_ACM,
            .bFunctionProtocol      = USB_PROTO_NONE,
            .iFunction              = NO_DESCRIPTOR,
        },
        .comm = {
            .bLength                = sizeof(struct usb_interface_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFACE,
            .bInterfaceNumber       = 0,
            .bAlternateSetting      = 0,
            .bNumEndpoints          = 1,
            .bInterfaceClass        = USB_CLASS_CDC,
            .bInterfaceSubClass     = USB_CDC_SUBCLASS_ACM,
            .bInterfaceProtocol     = USB_PROTO_NONE,
            .iInterface             = NO_DESCRIPTOR,
        },
        .cdc_hdr = {
            .bFunctionLength        = sizeof(struct usb_cdc_header_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_HEADER,
            .bcdCDC                 = VERSION_BCD(1,1,0),
        },
        .cdc_mgmt = {
            .bFunctionLength        = sizeof(struct usb_cdc_call_mgmt_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_CALL_MANAGEMENT,
            .bmCapabilities         = 0,
            .bDataInterface         = 1,
        },
        .cdc_acm = {
            .bFunctionLength        = sizeof(struct usb_cdc_acm_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_ACM,
            .bmCapabilities         = 0,
        },
        .cdc_union = {
            .bFunctionLength        = sizeof(struct usb_cdc_union_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_UNION,
            .bMasterInterface0      = 0,
            .bSlaveInterface0       = 1,
        },
        .comm_ep = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC0_NTF_EP,
            .bmAttributes           = USB_EPTYPE_INTERRUPT,
            .wMaxPacketSize         = CDC_NTF_SZ,
            .bInterval              = 0xFF,
        },
        .data = {
            .bLength                = sizeof(struct usb_interface_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFACE,
            .bInterfaceNumber       = 1,
            .bAlternateSetting      = 0,
            .bNumEndpoints          = 2,
            .bInterfaceClass        = USB_CLASS_CDC_DATA,
            .bInterfaceSubClass     = USB_SUBCLASS_NONE,
            .bInterfaceProtocol     = USB_PROTO_NONE,
            .iInterface             = NO_DESCRIPTOR,
        },
        .data_eprx = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC0_RXD_EP,
            .bmAttributes           = USB_EPTYPE_BULK,
            .wMaxPacketSize         = CDC_DATA_SZ,
            .bInterval              = 0x01,
        },
        .data_eptx = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC0_TXD_EP,
            .bmAttributes           = USB_EPTYPE_BULK,
            .wMaxPacketSize         = CDC_DATA_SZ,
            .bInterval              = 0x01,
        },
    },
    .iad_1 = {
        .comm_iad = {
            .bLength                = sizeof(struct usb_iad_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFASEASSOC,
            .bFirstInterface        = 2,
            .bInterfaceCount        = 2,
            .bFunctionClass         = USB_CLASS_CDC,
            .bFunctionSubClass      = USB_CDC_SUBCLASS_ACM,
            .bFunctionProtocol      = USB_PROTO_NONE,
            .iFunction              = NO_DESCRIPTOR,
        },
        .comm = {
            .bLength                = sizeof(struct usb_interface_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFACE,
            .bInterfaceNumber       = 2+0,
            .bAlternateSetting      = 0,
            .bNumEndpoints          = 1,
            .bInterfaceClass        = USB_CLASS_CDC,
            .bInterfaceSubClass     = USB_CDC_SUBCLASS_ACM,
            .bInterfaceProtocol     = USB_PROTO_NONE,
            .iInterface             = NO_DESCRIPTOR,
        },
        .cdc_hdr = {
            .bFunctionLength        = sizeof(struct usb_cdc_header_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_HEADER,
            .bcdCDC                 = VERSION_BCD(1,1,0),
        },
        .cdc_mgmt = {
            .bFunctionLength        = sizeof(struct usb_cdc_call_mgmt_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_CALL_MANAGEMENT,
            .bmCapabilities         = 0,
            .bDataInterface         = 2+1,
        },
        .cdc_acm = {
            .bFunctionLength        = sizeof(struct usb_cdc_acm_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_ACM,
            .bmCapabilities         = 0,
        },
        .cdc_union = {
            .bFunctionLength        = sizeof(struct usb_cdc_union_desc),
            .bDescriptorType        = USB_DTYPE_CS_INTERFACE,
            .bDescriptorSubType     = USB_DTYPE_CDC_UNION,
            .bMasterInterface0      = 2+0,
            .bSlaveInterface0       = 2+1,
        },
        .comm_ep = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC1_NTF_EP,
            .bmAttributes           = USB_EPTYPE_INTERRUPT,
            .wMaxPacketSize         = CDC_NTF_SZ,
            .bInterval              = 0xFF,
        },
        .data = {
            .bLength                = sizeof(struct usb_interface_descriptor),
            .bDescriptorType        = USB_DTYPE_INTERFACE,
            .bInterfaceNumber       = 2+1,
            .bAlternateSetting      = 0,
            .bNumEndpoints          = 2,
            .bInterfaceClass        = USB_CLASS_CDC_DATA,
            .bInterfaceSubClass     = USB_SUBCLASS_NONE,
            .bInterfaceProtocol     = USB_PROTO_NONE,
            .iInterface             = NO_DESCRIPTOR,
        },
        .data_eprx = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC1_RXD_EP,
            .bmAttributes           = USB_EPTYPE_BULK,
            .wMaxPacketSize         = CDC_DATA_SZ,
            .bInterval              = 0x01,
        },
        .data_eptx = {
            .bLength                = sizeof(struct usb_endpoint_descriptor),
            .bDescriptorType        = USB_DTYPE_ENDPOINT,
            .bEndpointAddress       = CDC1_TXD_EP,
            .bmAttributes           = USB_EPTYPE_BULK,
            .wMaxPacketSize         = CDC_DATA_SZ,
            .bInterval              = 0x01,
        },
    },
};

static struct usb_cdc_line_coding cdc_config[IF_NUM_MAX] = {};

static void cdc_init(usbd_device* dev, struct UsbInterface* intf);
static void cdc_deinit(usbd_device *dev);
static void cdc_on_wakeup(usbd_device *dev);
static void cdc_on_suspend(usbd_device *dev);

static usbd_respond cdc_ep_config (usbd_device *dev, uint8_t cfg);
static usbd_respond cdc_control (usbd_device *dev, usbd_ctlreq *req, usbd_rqc_callback *callback);
static usbd_device* usb_dev;
static struct UsbInterface* cdc_if_cur = NULL;
static CdcCallbacks* callbacks[IF_NUM_MAX] = {NULL};

struct UsbInterface usb_cdc_single = {
    .init = cdc_init,
    .deinit = cdc_deinit,
    .wakeup = cdc_on_wakeup,
    .suspend = cdc_on_suspend,

    .dev_descr = (struct usb_device_descriptor*)&cdc_device_desc,    

    .str_manuf_descr = (void*)&dev_manuf_desc,
    .str_prod_descr = NULL,
    .str_serial_descr = NULL,

    .cfg_descr = (void*)&cdc_cfg_desc_single,
};

struct UsbInterface usb_cdc_dual = {
    .init = cdc_init,
    .deinit = cdc_deinit,
    .wakeup = cdc_on_wakeup,
    .suspend = cdc_on_suspend,

    .dev_descr = (struct usb_device_descriptor*)&cdc_device_desc,    

    .str_manuf_descr = (void*)&dev_manuf_desc,
    .str_prod_descr = NULL,
    .str_serial_descr = NULL,

    .cfg_descr = (void*)&cdc_cfg_desc_dual,
};

static void cdc_init(usbd_device* dev, struct UsbInterface* intf) {
    usb_dev = dev;
    cdc_if_cur = intf;
    
    char* name = (char*)furi_hal_version_get_device_name_ptr();
    uint8_t len = (name == NULL) ? (0) : (strlen(name));
    struct usb_string_descriptor* dev_prod_desc = furi_alloc(len * 2 + 2);
    dev_prod_desc->bLength = len * 2 + 2;
    dev_prod_desc->bDescriptorType = USB_DTYPE_STRING;
    for (uint8_t i = 0; i < len; i++)
        dev_prod_desc->wString[i] = name[i];

    name = (char*)furi_hal_version_get_name_ptr();
    len = (name == NULL) ? (0) : (strlen(name));
    struct usb_string_descriptor* dev_serial_desc = furi_alloc((len + 5) * 2 + 2);
    dev_serial_desc->bLength = (len + 5) * 2 + 2;
    dev_serial_desc->bDescriptorType = USB_DTYPE_STRING;
    memcpy(dev_serial_desc->wString, "f\0l\0i\0p\0_\0", 5*2);
    for (uint8_t i = 0; i < len; i++)
        dev_serial_desc->wString[i+5] = name[i];

    cdc_if_cur->str_prod_descr = dev_prod_desc;
    cdc_if_cur->str_serial_descr = dev_serial_desc;

    usbd_reg_config(dev, cdc_ep_config);
    usbd_reg_control(dev, cdc_control);    

    usbd_connect(dev, true);
}

static void cdc_deinit(usbd_device *dev) {
    usbd_reg_config(dev, NULL);
    usbd_reg_control(dev, NULL);

    free(cdc_if_cur->str_prod_descr);
    free(cdc_if_cur->str_serial_descr);

    cdc_if_cur = NULL;
}

void furi_hal_cdc_set_callbacks(uint8_t if_num, CdcCallbacks* cb) {
    if (if_num < 2)
        callbacks[if_num] = cb;
}

struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num) {
    if (if_num < 2)
        return &cdc_config[if_num];
    return NULL;
}

void furi_hal_cdc_send(uint8_t if_num, uint8_t* buf, uint16_t len) {
    if (if_num == 0)
        usbd_ep_write(usb_dev, CDC0_TXD_EP, buf, len);
    else
        usbd_ep_write(usb_dev, CDC1_TXD_EP, buf, len);
}

int32_t furi_hal_cdc_receive(uint8_t if_num, uint8_t* buf, uint16_t max_len) {
    if (if_num == 0)
        return usbd_ep_read(usb_dev, CDC0_RXD_EP, buf, max_len);
    else
        return usbd_ep_read(usb_dev, CDC1_RXD_EP, buf, max_len);
}

static void cdc_on_wakeup(usbd_device *dev) {
    for (uint8_t i = 0; i < IF_NUM_MAX; i++) {
        if (callbacks[i] != NULL) {
            if (callbacks[i]->state_callback != NULL)
                callbacks[i]->state_callback(1);
        }
    }
}

static void cdc_on_suspend(usbd_device *dev) {
    for (uint8_t i = 0; i < IF_NUM_MAX; i++) {
        if (callbacks[i] != NULL) {
            if (callbacks[i]->state_callback != NULL)
                callbacks[i]->state_callback(0);
        }
    }
}

static void cdc_rx_ep_callback (usbd_device *dev, uint8_t event, uint8_t ep) {
    uint8_t if_num = 0;
    if (ep == CDC0_RXD_EP)
        if_num = 0;
    else
        if_num = 1;
    
    if (callbacks[if_num] != NULL) {
        if (callbacks[if_num]->rx_ep_callback != NULL)
            callbacks[if_num]->rx_ep_callback();
    }
}

static void cdc_tx_ep_callback (usbd_device *dev, uint8_t event, uint8_t ep) {
    uint8_t if_num = 0;
    if (ep == CDC0_TXD_EP)
        if_num = 0;
    else
        if_num = 1;
    
    if (callbacks[if_num] != NULL) {
        if (callbacks[if_num]->tx_ep_callback != NULL)
            callbacks[if_num]->tx_ep_callback();
    }
}

static void cdc_txrx_ep_callback (usbd_device *dev, uint8_t event, uint8_t ep) {
    if (event == usbd_evt_eptx) {
        cdc_tx_ep_callback(dev, event, ep);
    } else {
        cdc_rx_ep_callback(dev, event, ep);
    }
}

/* Configure endpoints */
static usbd_respond cdc_ep_config (usbd_device *dev, uint8_t cfg) {
    uint8_t if_cnt = ((struct usb_config_descriptor*)(cdc_if_cur->cfg_descr))->bNumInterfaces;
    switch (cfg) {
    case 0:
        /* deconfiguring device */
        usbd_ep_deconfig(dev, CDC0_NTF_EP);
        usbd_ep_deconfig(dev, CDC0_TXD_EP);
        usbd_ep_deconfig(dev, CDC0_RXD_EP);
        usbd_reg_endpoint(dev, CDC0_RXD_EP, 0);
        usbd_reg_endpoint(dev, CDC0_TXD_EP, 0);
        if (if_cnt == 4) {
            usbd_ep_deconfig(dev, CDC1_NTF_EP);
            usbd_ep_deconfig(dev, CDC1_TXD_EP);
            usbd_ep_deconfig(dev, CDC1_RXD_EP);
            usbd_reg_endpoint(dev, CDC1_RXD_EP, 0);
            usbd_reg_endpoint(dev, CDC1_TXD_EP, 0);
        }
        return usbd_ack;
    case 1:
        /* configuring device */
        if ((CDC0_TXD_EP & 0x7F) != (CDC0_RXD_EP & 0x7F)) { 
            // 2x unidirectional endpoint mode with dualbuf
            usbd_ep_config(dev, CDC0_RXD_EP, USB_EPTYPE_BULK | USB_EPTYPE_DBLBUF, CDC_DATA_SZ);
            usbd_ep_config(dev, CDC0_TXD_EP, USB_EPTYPE_BULK | USB_EPTYPE_DBLBUF, CDC_DATA_SZ);
            usbd_ep_config(dev, CDC0_NTF_EP, USB_EPTYPE_INTERRUPT, CDC_NTF_SZ);
            usbd_reg_endpoint(dev, CDC0_RXD_EP, cdc_rx_ep_callback);
            usbd_reg_endpoint(dev, CDC0_TXD_EP, cdc_tx_ep_callback);
        } else { 
            // 1x bidirectional endpoint mode
            usbd_ep_config(dev, CDC0_RXD_EP, USB_EPTYPE_BULK, CDC_DATA_SZ);
            usbd_ep_config(dev, CDC0_TXD_EP, USB_EPTYPE_BULK, CDC_DATA_SZ);
            usbd_ep_config(dev, CDC0_NTF_EP, USB_EPTYPE_INTERRUPT, CDC_NTF_SZ);
            usbd_reg_endpoint(dev, CDC0_RXD_EP, cdc_txrx_ep_callback);
            usbd_reg_endpoint(dev, CDC0_TXD_EP, cdc_txrx_ep_callback);
        }
        usbd_ep_write(dev, CDC0_TXD_EP, 0, 0);

        if (if_cnt == 4) {
            if ((CDC1_TXD_EP & 0x7F) != (CDC1_RXD_EP & 0x7F)) {
                usbd_ep_config(dev, CDC1_RXD_EP, USB_EPTYPE_BULK | USB_EPTYPE_DBLBUF, CDC_DATA_SZ);
                usbd_ep_config(dev, CDC1_TXD_EP, USB_EPTYPE_BULK | USB_EPTYPE_DBLBUF, CDC_DATA_SZ);
                usbd_ep_config(dev, CDC1_NTF_EP, USB_EPTYPE_INTERRUPT, CDC_NTF_SZ);
                usbd_reg_endpoint(dev, CDC1_RXD_EP, cdc_rx_ep_callback);
                usbd_reg_endpoint(dev, CDC1_TXD_EP, cdc_tx_ep_callback);
            } else {
                usbd_ep_config(dev, CDC1_RXD_EP, USB_EPTYPE_BULK, CDC_DATA_SZ);
                usbd_ep_config(dev, CDC1_TXD_EP, USB_EPTYPE_BULK, CDC_DATA_SZ);
                usbd_ep_config(dev, CDC1_NTF_EP, USB_EPTYPE_INTERRUPT, CDC_NTF_SZ);
                usbd_reg_endpoint(dev, CDC1_RXD_EP, cdc_txrx_ep_callback);
                usbd_reg_endpoint(dev, CDC1_TXD_EP, cdc_txrx_ep_callback);
            }
            usbd_ep_write(dev, CDC1_TXD_EP, 0, 0);
        }
        return usbd_ack;
    default:
        return usbd_fail;
    }
}

/* Control requests handler */
static usbd_respond cdc_control(usbd_device* dev, usbd_ctlreq* req, usbd_rqc_callback* callback) {
    /* CDC control requests */
    uint8_t if_num = 0;
    if(((USB_REQ_RECIPIENT | USB_REQ_TYPE) & req->bmRequestType) == (USB_REQ_INTERFACE | USB_REQ_CLASS) 
        && (req->wIndex == 0 || req->wIndex == 2)) {
        if (req->wIndex == 0)
            if_num = 0;
        else
            if_num = 1;

        switch(req->bRequest) {
        case USB_CDC_SET_CONTROL_LINE_STATE:
            if (callbacks[if_num] != NULL) {
                if (callbacks[if_num]->ctrl_line_callback != NULL)
                    callbacks[if_num]->ctrl_line_callback(req->wValue);
            }
            return usbd_ack;
        case USB_CDC_SET_LINE_CODING:
            memcpy(&cdc_config[if_num], req->data, sizeof(cdc_config[0]));
            if (callbacks[if_num] != NULL) {
                if (callbacks[if_num]->config_callback != NULL)
                    callbacks[if_num]->config_callback(&cdc_config[if_num]);
            }
            return usbd_ack;
        case USB_CDC_GET_LINE_CODING:
            dev->status.data_ptr = &cdc_config[if_num];
            dev->status.data_count = sizeof(cdc_config[0]);
            return usbd_ack;
        default:
            return usbd_fail;
        }
    }
    return usbd_fail;
}