get linecoding by users
This commit is contained in:
@@ -9,54 +9,16 @@
|
||||
const char *stop_name[] = { "1", "1.5", "2" };
|
||||
const char *parity_name[] = { "N", "O", "E", "M", "S" };
|
||||
|
||||
struct usbd_cdc {
|
||||
struct cdc_line_coding line_coding;
|
||||
bool dtr;
|
||||
bool rts;
|
||||
uint8_t intf_num;
|
||||
usb_slist_t list;
|
||||
};
|
||||
|
||||
static usb_slist_t usbd_cdc_head = USB_SLIST_OBJECT_INIT(usbd_cdc_head);
|
||||
|
||||
#ifndef CONFIG_USBDEV_CDC_ACM_UART
|
||||
struct usbd_cdc g_usbd_cdc_acm_class;
|
||||
static void usbd_cdc_acm_reset(void)
|
||||
{
|
||||
memset(&g_usbd_cdc_acm_class, 0, sizeof(struct usbd_cdc));
|
||||
g_usbd_cdc_acm_class.line_coding.dwDTERate = 2000000;
|
||||
g_usbd_cdc_acm_class.line_coding.bDataBits = 8;
|
||||
g_usbd_cdc_acm_class.line_coding.bParityType = 0;
|
||||
g_usbd_cdc_acm_class.line_coding.bCharFormat = 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
static int cdc_acm_class_request_handler(struct usb_setup_packet *setup, uint8_t **data, uint32_t *len)
|
||||
{
|
||||
USB_LOG_DBG("CDC Class request: "
|
||||
"bRequest 0x%02x\r\n",
|
||||
setup->bRequest);
|
||||
|
||||
struct usbd_cdc *current_cdc_acm_class = NULL;
|
||||
struct cdc_line_coding line_coding;
|
||||
bool dtr, rts;
|
||||
uint8_t intf = LO_BYTE(setup->wIndex);
|
||||
#ifdef CONFIG_USBDEV_CDC_ACM_UART
|
||||
usb_slist_t *i;
|
||||
|
||||
usb_slist_for_each(i, &usbd_cdc_head)
|
||||
{
|
||||
struct usbd_cdc *cdc_acm_class = usb_slist_entry(i, struct usbd_cdc, list);
|
||||
if (cdc_acm_class->intf_num == intf) {
|
||||
current_cdc_acm_class = cdc_acm_class;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (current_cdc_acm_class == NULL) {
|
||||
return -2;
|
||||
}
|
||||
#else
|
||||
current_cdc_acm_class = &g_usbd_cdc_acm_class;
|
||||
#endif
|
||||
switch (setup->bRequest) {
|
||||
case CDC_REQUEST_SET_LINE_CODING:
|
||||
|
||||
@@ -77,37 +39,37 @@ static int cdc_acm_class_request_handler(struct usb_setup_packet *setup, uint8_t
|
||||
/* 4 - Space */
|
||||
/* 6 | bDataBits | 1 | Number Data bits (5, 6, 7, 8 or 16). */
|
||||
/*******************************************************************************/
|
||||
memcpy(¤t_cdc_acm_class->line_coding, *data, setup->wLength);
|
||||
memcpy(&line_coding, *data, setup->wLength);
|
||||
USB_LOG_DBG("Set intf:%d linecoding <%d %d %s %s>\r\n",
|
||||
intf,
|
||||
current_cdc_acm_class->line_coding.dwDTERate,
|
||||
current_cdc_acm_class->line_coding.bDataBits,
|
||||
parity_name[current_cdc_acm_class->line_coding.bParityType],
|
||||
stop_name[current_cdc_acm_class->line_coding.bCharFormat]);
|
||||
usbd_cdc_acm_set_line_coding(intf, current_cdc_acm_class->line_coding.dwDTERate, current_cdc_acm_class->line_coding.bDataBits,
|
||||
current_cdc_acm_class->line_coding.bParityType, current_cdc_acm_class->line_coding.bCharFormat);
|
||||
line_coding.dwDTERate,
|
||||
line_coding.bDataBits,
|
||||
parity_name[line_coding.bParityType],
|
||||
stop_name[line_coding.bCharFormat]);
|
||||
usbd_cdc_acm_set_line_coding(intf, &line_coding);
|
||||
break;
|
||||
|
||||
case CDC_REQUEST_SET_CONTROL_LINE_STATE: {
|
||||
current_cdc_acm_class->dtr = (setup->wValue & 0x0001);
|
||||
current_cdc_acm_class->rts = (setup->wValue & 0x0002);
|
||||
dtr = (setup->wValue & 0x0001);
|
||||
rts = (setup->wValue & 0x0002);
|
||||
USB_LOG_DBG("Set intf:%d DTR 0x%x,RTS 0x%x\r\n",
|
||||
intf,
|
||||
current_cdc_acm_class->dtr,
|
||||
current_cdc_acm_class->rts);
|
||||
usbd_cdc_acm_set_dtr(intf, current_cdc_acm_class->dtr);
|
||||
usbd_cdc_acm_set_rts(intf, current_cdc_acm_class->rts);
|
||||
dtr,
|
||||
rts);
|
||||
usbd_cdc_acm_set_dtr(intf, dtr);
|
||||
usbd_cdc_acm_set_rts(intf, rts);
|
||||
} break;
|
||||
|
||||
case CDC_REQUEST_GET_LINE_CODING:
|
||||
*data = (uint8_t *)(¤t_cdc_acm_class->line_coding);
|
||||
usbd_cdc_acm_get_line_coding(intf, &line_coding);
|
||||
memcpy(*data, &line_coding, 7);
|
||||
*len = 7;
|
||||
USB_LOG_DBG("Get intf:%d linecoding %d %d %d %d\r\n",
|
||||
intf,
|
||||
current_cdc_acm_class->line_coding.dwDTERate,
|
||||
current_cdc_acm_class->line_coding.bCharFormat,
|
||||
current_cdc_acm_class->line_coding.bParityType,
|
||||
current_cdc_acm_class->line_coding.bDataBits);
|
||||
line_coding.dwDTERate,
|
||||
line_coding.bCharFormat,
|
||||
line_coding.bParityType,
|
||||
line_coding.bDataBits);
|
||||
break;
|
||||
|
||||
default:
|
||||
@@ -122,34 +84,12 @@ static void cdc_notify_handler(uint8_t event, void *arg)
|
||||
{
|
||||
switch (event) {
|
||||
case USBD_EVENT_RESET:
|
||||
#ifndef CONFIG_USBDEV_CDC_ACM_UART
|
||||
usbd_cdc_acm_reset();
|
||||
#endif
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
int usbd_cdc_acm_alloc(uint8_t intf)
|
||||
{
|
||||
struct usbd_cdc *cdc_acm_class = usb_malloc(sizeof(struct usbd_cdc));
|
||||
|
||||
if (cdc_acm_class == NULL) {
|
||||
USB_LOG_ERR("no memory to alloc for cdc_acm_class\r\n");
|
||||
return -1;
|
||||
}
|
||||
memset(cdc_acm_class, 0, sizeof(struct usbd_cdc));
|
||||
cdc_acm_class->line_coding.dwDTERate = 2000000;
|
||||
cdc_acm_class->line_coding.bDataBits = 8;
|
||||
cdc_acm_class->line_coding.bParityType = 0;
|
||||
cdc_acm_class->line_coding.bCharFormat = 0;
|
||||
cdc_acm_class->intf_num = intf;
|
||||
|
||||
usb_slist_add_tail(&usbd_cdc_head, &cdc_acm_class->list);
|
||||
return 0;
|
||||
}
|
||||
|
||||
void usbd_cdc_add_acm_interface(usbd_class_t *devclass, usbd_interface_t *intf)
|
||||
{
|
||||
static usbd_class_t *last_class = NULL;
|
||||
@@ -164,15 +104,20 @@ void usbd_cdc_add_acm_interface(usbd_class_t *devclass, usbd_interface_t *intf)
|
||||
intf->vendor_handler = NULL;
|
||||
intf->notify_handler = cdc_notify_handler;
|
||||
usbd_class_add_interface(devclass, intf);
|
||||
#ifdef CONFIG_USBDEV_CDC_ACM_UART
|
||||
usbd_cdc_acm_alloc(intf->intf_num);
|
||||
#endif
|
||||
}
|
||||
|
||||
__WEAK void usbd_cdc_acm_set_line_coding(uint8_t intf, uint32_t baudrate, uint8_t databits, uint8_t parity, uint8_t stopbits)
|
||||
__WEAK void usbd_cdc_acm_set_line_coding(uint8_t intf, struct cdc_line_coding *line_coding)
|
||||
{
|
||||
}
|
||||
|
||||
__WEAK void usbd_cdc_acm_get_line_coding(uint8_t intf, struct cdc_line_coding *line_coding)
|
||||
{
|
||||
line_coding->dwDTERate = 2000000;
|
||||
line_coding->bDataBits = 8;
|
||||
line_coding->bParityType = 0;
|
||||
line_coding->bCharFormat = 0;
|
||||
}
|
||||
|
||||
__WEAK void usbd_cdc_acm_set_dtr(uint8_t intf, bool dtr)
|
||||
{
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user