|
|
@@ -0,0 +1,555 @@
|
|
|
+#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;
|
|
|
+}
|