285 lines
8.4 KiB
C
285 lines
8.4 KiB
C
/*
|
|
* Copyright (c) 2022, sakumisu
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
#include "usbh_core.h"
|
|
#include "usbh_cdc_acm.h"
|
|
|
|
#undef USB_DBG_TAG
|
|
#define USB_DBG_TAG "usbh_cdc_acm"
|
|
#include "usb_log.h"
|
|
|
|
#define DEV_FORMAT "/dev/ttyACM%d"
|
|
|
|
USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_cdc_acm_buf[CONFIG_USBHOST_MAX_CDC_ACM_CLASS][USB_ALIGN_UP(64, CONFIG_USB_ALIGN_SIZE)];
|
|
|
|
static struct usbh_cdc_acm g_cdc_acm_class[CONFIG_USBHOST_MAX_CDC_ACM_CLASS];
|
|
static uint32_t g_devinuse = 0;
|
|
|
|
static struct usbh_cdc_acm *usbh_cdc_acm_class_alloc(void)
|
|
{
|
|
uint8_t devno;
|
|
|
|
for (devno = 0; devno < CONFIG_USBHOST_MAX_CDC_ACM_CLASS; devno++) {
|
|
if ((g_devinuse & (1U << devno)) == 0) {
|
|
g_devinuse |= (1U << devno);
|
|
memset(&g_cdc_acm_class[devno], 0, sizeof(struct usbh_cdc_acm));
|
|
g_cdc_acm_class[devno].minor = devno;
|
|
return &g_cdc_acm_class[devno];
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static void usbh_cdc_acm_class_free(struct usbh_cdc_acm *cdc_acm_class)
|
|
{
|
|
uint8_t devno = cdc_acm_class->minor;
|
|
|
|
if (devno < 32) {
|
|
g_devinuse &= ~(1U << devno);
|
|
}
|
|
memset(cdc_acm_class, 0, sizeof(struct usbh_cdc_acm));
|
|
}
|
|
|
|
int usbh_cdc_acm_set_line_coding(struct usbh_cdc_acm *cdc_acm_class, struct cdc_line_coding *line_coding)
|
|
{
|
|
struct usb_setup_packet *setup;
|
|
|
|
if (!cdc_acm_class || !cdc_acm_class->hport) {
|
|
return -USB_ERR_INVAL;
|
|
}
|
|
setup = cdc_acm_class->hport->setup;
|
|
|
|
setup->bmRequestType = USB_REQUEST_DIR_OUT | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
|
|
setup->bRequest = CDC_REQUEST_SET_LINE_CODING;
|
|
setup->wValue = 0;
|
|
setup->wIndex = cdc_acm_class->intf;
|
|
setup->wLength = 7;
|
|
|
|
memcpy(g_cdc_acm_buf[cdc_acm_class->minor], line_coding, sizeof(struct cdc_line_coding));
|
|
|
|
return usbh_control_transfer(cdc_acm_class->hport, setup, g_cdc_acm_buf[cdc_acm_class->minor]);
|
|
}
|
|
|
|
int usbh_cdc_acm_get_line_coding(struct usbh_cdc_acm *cdc_acm_class, struct cdc_line_coding *line_coding)
|
|
{
|
|
struct usb_setup_packet *setup;
|
|
int ret;
|
|
|
|
if (!cdc_acm_class || !cdc_acm_class->hport) {
|
|
return -USB_ERR_INVAL;
|
|
}
|
|
setup = cdc_acm_class->hport->setup;
|
|
|
|
setup->bmRequestType = USB_REQUEST_DIR_IN | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
|
|
setup->bRequest = CDC_REQUEST_GET_LINE_CODING;
|
|
setup->wValue = 0;
|
|
setup->wIndex = cdc_acm_class->intf;
|
|
setup->wLength = 7;
|
|
|
|
ret = usbh_control_transfer(cdc_acm_class->hport, setup, g_cdc_acm_buf[cdc_acm_class->minor]);
|
|
if (ret < 0) {
|
|
return ret;
|
|
}
|
|
memcpy(line_coding, g_cdc_acm_buf[cdc_acm_class->minor], sizeof(struct cdc_line_coding));
|
|
return ret;
|
|
}
|
|
|
|
int usbh_cdc_acm_set_line_state(struct usbh_cdc_acm *cdc_acm_class, bool dtr, bool rts)
|
|
{
|
|
struct usb_setup_packet *setup;
|
|
|
|
if (!cdc_acm_class || !cdc_acm_class->hport) {
|
|
return -USB_ERR_INVAL;
|
|
}
|
|
setup = cdc_acm_class->hport->setup;
|
|
|
|
setup->bmRequestType = USB_REQUEST_DIR_OUT | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
|
|
setup->bRequest = CDC_REQUEST_SET_CONTROL_LINE_STATE;
|
|
setup->wValue = (dtr << 0) | (rts << 1);
|
|
setup->wIndex = cdc_acm_class->intf;
|
|
setup->wLength = 0;
|
|
|
|
return usbh_control_transfer(cdc_acm_class->hport, setup, NULL);
|
|
}
|
|
|
|
static int usbh_cdc_acm_connect(struct usbh_hubport *hport, uint8_t intf)
|
|
{
|
|
struct usb_endpoint_descriptor *ep_desc;
|
|
int ret = 0;
|
|
|
|
struct usbh_cdc_acm *cdc_acm_class = usbh_cdc_acm_class_alloc();
|
|
if (cdc_acm_class == NULL) {
|
|
USB_LOG_ERR("Fail to alloc cdc_acm_class\r\n");
|
|
return -USB_ERR_NOMEM;
|
|
}
|
|
|
|
cdc_acm_class->hport = hport;
|
|
cdc_acm_class->intf = intf;
|
|
|
|
hport->config.intf[intf].priv = cdc_acm_class;
|
|
hport->config.intf[intf + 1].priv = NULL;
|
|
|
|
#ifdef CONFIG_USBHOST_CDC_ACM_NOTIFY
|
|
ep_desc = &hport->config.intf[intf].altsetting[0].ep[0].ep_desc;
|
|
USBH_EP_INIT(cdc_acm_class->intin, ep_desc);
|
|
#endif
|
|
for (uint8_t i = 0; i < hport->config.intf[intf + 1].altsetting[0].intf_desc.bNumEndpoints; i++) {
|
|
ep_desc = &hport->config.intf[intf + 1].altsetting[0].ep[i].ep_desc;
|
|
|
|
if (ep_desc->bEndpointAddress & 0x80) {
|
|
USBH_EP_INIT(cdc_acm_class->bulkin, ep_desc);
|
|
} else {
|
|
USBH_EP_INIT(cdc_acm_class->bulkout, ep_desc);
|
|
}
|
|
}
|
|
|
|
snprintf(hport->config.intf[intf].devname, CONFIG_USBHOST_DEV_NAMELEN, DEV_FORMAT, cdc_acm_class->minor);
|
|
|
|
USB_LOG_INFO("Register CDC ACM Class:%s\r\n", hport->config.intf[intf].devname);
|
|
|
|
#if 0
|
|
USB_LOG_INFO("Test cdc acm rx and tx and rx for 5 times, baudrate is 115200\r\n");
|
|
|
|
struct cdc_line_coding linecoding;
|
|
uint8_t count = 5;
|
|
|
|
linecoding.dwDTERate = 115200;
|
|
linecoding.bDataBits = 8;
|
|
linecoding.bParityType = 0;
|
|
linecoding.bCharFormat = 0;
|
|
usbh_cdc_acm_set_line_coding(cdc_acm_class, &linecoding);
|
|
usbh_cdc_acm_set_line_state(cdc_acm_class, true, false);
|
|
|
|
memset(g_cdc_acm_buf, 'a', sizeof(g_cdc_acm_buf));
|
|
ret = usbh_cdc_acm_bulk_out_transfer(cdc_acm_class, g_cdc_acm_buf, sizeof(g_cdc_acm_buf), 0xfffffff);
|
|
USB_LOG_RAW("out ret:%d\r\n", ret);
|
|
while (count--) {
|
|
ret = usbh_cdc_acm_bulk_in_transfer(cdc_acm_class, g_cdc_acm_buf, sizeof(g_cdc_acm_buf), 0xfffffff);
|
|
USB_LOG_RAW("in ret:%d\r\n", ret);
|
|
if (ret > 0) {
|
|
for (uint32_t i = 0; i < ret; i++) {
|
|
USB_LOG_RAW("%02x ", g_cdc_acm_buf[i]);
|
|
}
|
|
}
|
|
USB_LOG_RAW("\r\n");
|
|
}
|
|
#endif
|
|
|
|
usbh_cdc_acm_run(cdc_acm_class);
|
|
return ret;
|
|
}
|
|
|
|
static int usbh_cdc_acm_disconnect(struct usbh_hubport *hport, uint8_t intf)
|
|
{
|
|
int ret = 0;
|
|
|
|
struct usbh_cdc_acm *cdc_acm_class = (struct usbh_cdc_acm *)hport->config.intf[intf].priv;
|
|
|
|
if (cdc_acm_class) {
|
|
if (cdc_acm_class->bulkin) {
|
|
usbh_kill_urb(&cdc_acm_class->bulkin_urb);
|
|
}
|
|
|
|
if (cdc_acm_class->bulkout) {
|
|
usbh_kill_urb(&cdc_acm_class->bulkout_urb);
|
|
}
|
|
|
|
#ifdef CONFIG_USBHOST_CDC_ACM_NOTIFY
|
|
if (cdc_acm_class->intin) {
|
|
usbh_kill_urb(&cdc_acm_class->intin_urb);
|
|
}
|
|
#endif
|
|
|
|
if (hport->config.intf[intf].devname[0] != '\0') {
|
|
USB_LOG_INFO("Unregister CDC ACM Class:%s\r\n", hport->config.intf[intf].devname);
|
|
usbh_cdc_acm_stop(cdc_acm_class);
|
|
}
|
|
|
|
usbh_cdc_acm_class_free(cdc_acm_class);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
int usbh_cdc_acm_bulk_in_transfer(struct usbh_cdc_acm *cdc_acm_class, uint8_t *buffer, uint32_t buflen, uint32_t timeout)
|
|
{
|
|
int ret;
|
|
struct usbh_urb *urb = &cdc_acm_class->bulkin_urb;
|
|
|
|
usbh_bulk_urb_fill(urb, cdc_acm_class->hport, cdc_acm_class->bulkin, buffer, buflen, timeout, NULL, NULL);
|
|
ret = usbh_submit_urb(urb);
|
|
if (ret == 0) {
|
|
ret = urb->actual_length;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int usbh_cdc_acm_bulk_out_transfer(struct usbh_cdc_acm *cdc_acm_class, uint8_t *buffer, uint32_t buflen, uint32_t timeout)
|
|
{
|
|
int ret;
|
|
struct usbh_urb *urb = &cdc_acm_class->bulkout_urb;
|
|
|
|
usbh_bulk_urb_fill(urb, cdc_acm_class->hport, cdc_acm_class->bulkout, buffer, buflen, timeout, NULL, NULL);
|
|
ret = usbh_submit_urb(urb);
|
|
if (ret == 0) {
|
|
ret = urb->actual_length;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static int usbh_cdc_data_connect(struct usbh_hubport *hport, uint8_t intf)
|
|
{
|
|
(void)hport;
|
|
(void)intf;
|
|
return 0;
|
|
}
|
|
|
|
static int usbh_cdc_data_disconnect(struct usbh_hubport *hport, uint8_t intf)
|
|
{
|
|
(void)hport;
|
|
(void)intf;
|
|
return 0;
|
|
}
|
|
|
|
__WEAK void usbh_cdc_acm_run(struct usbh_cdc_acm *cdc_acm_class)
|
|
{
|
|
(void)cdc_acm_class;
|
|
}
|
|
|
|
__WEAK void usbh_cdc_acm_stop(struct usbh_cdc_acm *cdc_acm_class)
|
|
{
|
|
(void)cdc_acm_class;
|
|
}
|
|
|
|
const struct usbh_class_driver cdc_acm_class_driver = {
|
|
.driver_name = "cdc_acm",
|
|
.connect = usbh_cdc_acm_connect,
|
|
.disconnect = usbh_cdc_acm_disconnect
|
|
};
|
|
|
|
const struct usbh_class_driver cdc_data_class_driver = {
|
|
.driver_name = "cdc_data",
|
|
.connect = usbh_cdc_data_connect,
|
|
.disconnect = usbh_cdc_data_disconnect
|
|
};
|
|
|
|
CLASS_INFO_DEFINE const struct usbh_class_info cdc_acm_class_info = {
|
|
.match_flags = USB_CLASS_MATCH_INTF_CLASS | USB_CLASS_MATCH_INTF_SUBCLASS,
|
|
.class = USB_DEVICE_CLASS_CDC,
|
|
.subclass = CDC_ABSTRACT_CONTROL_MODEL,
|
|
.protocol = 0x00,
|
|
.id_table = NULL,
|
|
.class_driver = &cdc_acm_class_driver
|
|
};
|
|
|
|
CLASS_INFO_DEFINE const struct usbh_class_info cdc_data_class_info = {
|
|
.match_flags = USB_CLASS_MATCH_INTF_CLASS,
|
|
.class = USB_DEVICE_CLASS_CDC_DATA,
|
|
.subclass = 0x00,
|
|
.protocol = 0x00,
|
|
.id_table = NULL,
|
|
.class_driver = &cdc_data_class_driver
|
|
};
|