RIOT-OS/RIOT
RIOT-OS/RIOT
1
0
Fork 0
mirror of https://github.com/RIOT-OS/RIOT.git synced 2024-12-29 04:50:03 +01:00
Code Releases Activity

synopsys_dwc2: implement USBOPT_ENUMERATED_SPEED

Browse Source
This commit is contained in:
Koen Zandberg 2023-03-31 14:27:32 +02:00
parent 86e2953470
commit aa67c98a4a
No known key found for this signature in database
GPG Key ID: BA1718B37D79F51C
1 changed files with 33 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

35
drivers/usbdev_synopsys_dwc2/usbdev_synopsys_dwc2.c
View File

@ -1021,10 +1021,36 @@ static void _usbdev_init(usbdev_t *dev)
#endif #endif
} }
static usb_speed_t _get_max_speed(const usbdev_t *dev)
{
dwc2_usb_otg_fshs_t *usbdev = (dwc2_usb_otg_fshs_t *)dev;
const dwc2_usb_otg_fshs_config_t *conf = usbdev->config;
if (IS_USED(DWC2_USB_OTG_HS_ENABLED) && (conf->type == DWC2_USB_OTG_HS)) {
return USB_SPEED_HIGH;
}
return USB_SPEED_FULL;
}
static usb_speed_t _get_enumeration_speed(const usbdev_t *dev)
{
dwc2_usb_otg_fshs_t *usbdev = (dwc2_usb_otg_fshs_t *)dev;
const dwc2_usb_otg_fshs_config_t *conf = usbdev->config;
unsigned speed = (_device_regs(conf)->DSTS & USB_OTG_DSTS_ENUMSPD_Msk) >>
USB_OTG_DSTS_ENUMSPD_Pos;
switch (speed) {
case 0x00:
return USB_SPEED_HIGH;
case 0x03:
return USB_SPEED_FULL;
default:
assert(false); /* reserved values by peripheral */
}
return USB_SPEED_FULL; /* Should not be reached */
}
static int _usbdev_get(usbdev_t *dev, usbopt_t opt, static int _usbdev_get(usbdev_t *dev, usbopt_t opt,
void *value, size_t max_len) void *value, size_t max_len)
{ {
(void)dev;
(void)max_len; (void)max_len;
int res = -ENOTSUP; int res = -ENOTSUP;
switch (opt) { switch (opt) {
@ -1035,7 +1061,12 @@ static int _usbdev_get(usbdev_t *dev, usbopt_t opt,
break; break;
case USBOPT_MAX_SPEED: case USBOPT_MAX_SPEED:
assert(max_len == sizeof(usb_speed_t)); assert(max_len == sizeof(usb_speed_t));
*(usb_speed_t *)value = USB_SPEED_FULL; *(usb_speed_t *)value = _get_max_speed(dev);
res = sizeof(usb_speed_t);
break;
case USBOPT_ENUMERATED_SPEED:
assert(max_len == sizeof(usb_speed_t));
*(usb_speed_t *)value = _get_enumeration_speed(dev);
res = sizeof(usb_speed_t); res = sizeof(usb_speed_t);
break; break;
default: default: