mirror of
https://github.com/DarkFlippers/unleashed-firmware.git
synced 2024-12-15 00:33:05 +03:00
d075e00ae1
* badusb: vid/pid/strings change * demo script update * removed vid/pid values Co-authored-by: あく <alleteam@gmail.com>
665 lines
26 KiB
C
665 lines
26 KiB
C
#include "furi_hal_version.h"
|
|
#include "furi_hal_usb_i.h"
|
|
#include "furi_hal_usb.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
|
|
|
|
#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 uint8_t cdc_ctrl_line_state[IF_NUM_MAX];
|
|
|
|
static void cdc_init(usbd_device* dev, FuriHalUsbInterface* intf, void* ctx);
|
|
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 FuriHalUsbInterface* cdc_if_cur = NULL;
|
|
static bool connected = false;
|
|
static CdcCallbacks* callbacks[IF_NUM_MAX] = {NULL};
|
|
static void* cb_ctx[IF_NUM_MAX];
|
|
|
|
FuriHalUsbInterface 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,
|
|
};
|
|
|
|
FuriHalUsbInterface 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, FuriHalUsbInterface* intf, void* ctx) {
|
|
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 = malloc(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 = malloc((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, void* context) {
|
|
furi_assert(if_num < IF_NUM_MAX);
|
|
|
|
if(callbacks[if_num] != NULL) {
|
|
if(callbacks[if_num]->state_callback != NULL) {
|
|
if(connected == true) callbacks[if_num]->state_callback(cb_ctx[if_num], 0);
|
|
}
|
|
}
|
|
|
|
callbacks[if_num] = cb;
|
|
cb_ctx[if_num] = context;
|
|
|
|
if(callbacks[if_num] != NULL) {
|
|
if(callbacks[if_num]->state_callback != NULL) {
|
|
if(connected == true) callbacks[if_num]->state_callback(cb_ctx[if_num], 1);
|
|
}
|
|
}
|
|
}
|
|
|
|
struct usb_cdc_line_coding* furi_hal_cdc_get_port_settings(uint8_t if_num) {
|
|
furi_assert(if_num < IF_NUM_MAX);
|
|
return &cdc_config[if_num];
|
|
}
|
|
|
|
uint8_t furi_hal_cdc_get_ctrl_line_state(uint8_t if_num) {
|
|
furi_assert(if_num < IF_NUM_MAX);
|
|
return cdc_ctrl_line_state[if_num];
|
|
}
|
|
|
|
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) {
|
|
int32_t len = 0;
|
|
if(if_num == 0)
|
|
len = usbd_ep_read(usb_dev, CDC0_RXD_EP, buf, max_len);
|
|
else
|
|
len = usbd_ep_read(usb_dev, CDC1_RXD_EP, buf, max_len);
|
|
return ((len < 0) ? 0 : len);
|
|
}
|
|
|
|
static void cdc_on_wakeup(usbd_device* dev) {
|
|
connected = true;
|
|
for(uint8_t i = 0; i < IF_NUM_MAX; i++) {
|
|
if(callbacks[i] != NULL) {
|
|
if(callbacks[i]->state_callback != NULL) callbacks[i]->state_callback(cb_ctx[i], 1);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void cdc_on_suspend(usbd_device* dev) {
|
|
connected = false;
|
|
for(uint8_t i = 0; i < IF_NUM_MAX; i++) {
|
|
cdc_ctrl_line_state[i] = 0;
|
|
if(callbacks[i] != NULL) {
|
|
if(callbacks[i]->state_callback != NULL) callbacks[i]->state_callback(cb_ctx[i], 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(cb_ctx[if_num]);
|
|
}
|
|
}
|
|
|
|
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(cb_ctx[if_num]);
|
|
}
|
|
}
|
|
|
|
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 */
|
|
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);
|
|
}
|
|
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);
|
|
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) {
|
|
cdc_ctrl_line_state[if_num] = req->wValue;
|
|
if(callbacks[if_num]->ctrl_line_callback != NULL)
|
|
callbacks[if_num]->ctrl_line_callback(
|
|
cb_ctx[if_num], cdc_ctrl_line_state[if_num]);
|
|
}
|
|
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(cb_ctx[if_num], &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;
|
|
}
|