refactor usb device intf and ep register
This commit is contained in:
@@ -51,7 +51,7 @@ USB_NOCACHE_RAM_SECTION struct usbd_core_cfg_priv {
|
||||
#endif
|
||||
} usbd_core_cfg;
|
||||
|
||||
static usb_slist_t usbd_intf_head = USB_SLIST_OBJECT_INIT(usbd_intf_head);
|
||||
usb_slist_t usbd_intf_head = USB_SLIST_OBJECT_INIT(usbd_intf_head);
|
||||
|
||||
static struct usb_msosv1_descriptor *msosv1_desc;
|
||||
static struct usb_msosv2_descriptor *msosv2_desc;
|
||||
@@ -585,7 +585,7 @@ static int usbd_class_request_handler(struct usb_setup_packet *setup, uint8_t **
|
||||
if ((setup->bmRequestType & USB_REQUEST_RECIPIENT_MASK) == USB_REQUEST_RECIPIENT_INTERFACE) {
|
||||
usb_slist_for_each(i, &usbd_intf_head)
|
||||
{
|
||||
usbd_interface_t *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
struct usbd_interface *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
|
||||
if (intf->class_handler && (intf->intf_num == (setup->wIndex & 0xFF))) {
|
||||
return intf->class_handler(setup, data, len);
|
||||
@@ -594,7 +594,7 @@ static int usbd_class_request_handler(struct usb_setup_packet *setup, uint8_t **
|
||||
} else if ((setup->bmRequestType & USB_REQUEST_RECIPIENT_MASK) == USB_REQUEST_RECIPIENT_ENDPOINT) {
|
||||
usb_slist_for_each(i, &usbd_intf_head)
|
||||
{
|
||||
usbd_interface_t *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
struct usbd_interface *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
|
||||
if (intf->custom_handler && (intf->intf_num == ((setup->wIndex >> 8) & 0xFF))) {
|
||||
return intf->custom_handler(setup, data, len);
|
||||
@@ -656,7 +656,7 @@ static int usbd_vendor_request_handler(struct usb_setup_packet *setup, uint8_t *
|
||||
|
||||
usb_slist_for_each(i, &usbd_intf_head)
|
||||
{
|
||||
usbd_interface_t *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
struct usbd_interface *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
|
||||
if (intf->vendor_handler && !intf->vendor_handler(setup, data, len)) {
|
||||
return 0;
|
||||
@@ -684,7 +684,7 @@ static int usbd_custom_request_handler(struct usb_setup_packet *setup, uint8_t *
|
||||
usb_slist_t *i;
|
||||
usb_slist_for_each(i, &usbd_intf_head)
|
||||
{
|
||||
usbd_interface_t *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
struct usbd_interface *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
|
||||
if (intf->custom_handler && (intf->intf_num == (setup->wIndex & 0xFF))) {
|
||||
return intf->custom_handler(setup, data, len);
|
||||
@@ -741,7 +741,7 @@ static void usbd_class_event_notify_handler(uint8_t event, void *arg)
|
||||
usb_slist_t *i;
|
||||
usb_slist_for_each(i, &usbd_intf_head)
|
||||
{
|
||||
usbd_interface_t *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
struct usbd_interface *intf = usb_slist_entry(i, struct usbd_interface, list);
|
||||
|
||||
if (intf->notify_handler) {
|
||||
intf->notify_handler(event, arg);
|
||||
@@ -952,25 +952,17 @@ void usbd_bos_desc_register(struct usb_bos_descriptor *desc)
|
||||
bos_desc = desc;
|
||||
}
|
||||
|
||||
void usbd_class_register(usbd_class_t *devclass)
|
||||
{
|
||||
// usb_slist_add_tail(&usbd_class_head, &devclass->list);
|
||||
// usb_slist_init(&devclass->intf_list);
|
||||
}
|
||||
|
||||
void usbd_class_add_interface(usbd_class_t *devclass, usbd_interface_t *intf)
|
||||
void usbd_add_interface(struct usbd_interface *intf)
|
||||
{
|
||||
static uint8_t intf_offset = 0;
|
||||
|
||||
intf->intf_num = intf_offset;
|
||||
usb_slist_add_tail(&usbd_intf_head, &intf->list);
|
||||
usb_slist_init(&intf->ep_list);
|
||||
intf_offset++;
|
||||
}
|
||||
|
||||
void usbd_interface_add_endpoint(usbd_interface_t *intf, usbd_endpoint_t *ep)
|
||||
void usbd_add_endpoint(struct usbd_endpoint *ep)
|
||||
{
|
||||
usb_slist_add_tail(&intf->ep_list, &ep->list);
|
||||
if (ep->ep_addr & 0x80) {
|
||||
usbd_core_cfg.in_ep_cb[ep->ep_addr & 0x7f] = ep->ep_cb;
|
||||
} else {
|
||||
|
||||
Reference in New Issue
Block a user