mirror of
https://github.com/DarkFlippers/unleashed-firmware
synced 2024-12-14 15:02:35 +00:00
556 lines
22 KiB
C
556 lines
22 KiB
C
|
#include "furi-hal-version.h"
|
||
|
|
#include "furi-hal-usb_i.h"
|
||
|
|
#include "furi-hal-vcp_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 0x82
|
||
|
|
#define CDC0_NTF_EP 0x83
|
||
|
|
|
||
|
|
#define CDC1_RXD_EP 0x04
|
||
|
|
#define CDC1_TXD_EP 0x85
|
||
|
|
#define CDC1_NTF_EP 0x86
|
||
|
|
|
||
|
|
#define CDC_NTF_SZ 0x08
|
||
|
|
|
||
|
|
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_line = {
|
||
|
|
.dwDTERate = 38400,
|
||
|
|
.bCharFormat = USB_CDC_1_STOP_BITS,
|
||
|
|
.bParityType = USB_CDC_NO_PARITY,
|
||
|
|
.bDataBits = 8,
|
||
|
|
};
|
||
|
|
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;
|
||
|
|
|
||
|
|
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_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) {
|
||
|
|
furi_hal_vcp_on_usb_resume();
|
||
|
|
}
|
||
|
|
|
||
|
|
static void cdc_on_suspend(usbd_device *dev) {
|
||
|
|
furi_hal_vcp_on_usb_suspend();
|
||
|
|
}
|
||
|
|
|
||
|
|
static void cdc_rx_ep_callback (usbd_device *dev, uint8_t event, uint8_t ep) {
|
||
|
|
if (ep == CDC0_RXD_EP)
|
||
|
|
furi_hal_vcp_on_cdc_rx(0);
|
||
|
|
else
|
||
|
|
furi_hal_vcp_on_cdc_rx(1);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void cdc_tx_ep_callback (usbd_device *dev, uint8_t event, uint8_t ep) {
|
||
|
|
if (ep == CDC0_TXD_EP)
|
||
|
|
furi_hal_vcp_on_cdc_tx_complete(0);
|
||
|
|
else
|
||
|
|
furi_hal_vcp_on_cdc_tx_complete(1);
|
||
|
|
}
|
||
|
|
|
||
|
|
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)) {
|
||
|
|
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 {
|
||
|
|
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 */
|
||
|
|
if (((USB_REQ_RECIPIENT | USB_REQ_TYPE) & req->bmRequestType) == (USB_REQ_INTERFACE | USB_REQ_CLASS)
|
||
|
|
&& req->wIndex == 0 ) {
|
||
|
|
switch (req->bRequest) {
|
||
|
|
case USB_CDC_SET_CONTROL_LINE_STATE:
|
||
|
|
furi_hal_vcp_on_cdc_control_line(req->wValue);
|
||
|
|
return usbd_ack;
|
||
|
|
case USB_CDC_SET_LINE_CODING:
|
||
|
|
memcpy(&cdc_line, req->data, sizeof(cdc_line));
|
||
|
|
return usbd_ack;
|
||
|
|
case USB_CDC_GET_LINE_CODING:
|
||
|
|
dev->status.data_ptr = &cdc_line;
|
||
|
|
dev->status.data_count = sizeof(cdc_line);
|
||
|
|
return usbd_ack;
|
||
|
|
default:
|
||
|
|
return usbd_fail;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return usbd_fail;
|
||
|
|
}
|