yemai/CherryUSB
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

support ehci suspend & resume

Browse Source
This commit is contained in:
sakumisu
2023-11-21 22:20:57 +08:00
parent e3c9fdbb86
commit af1484882d
1 changed files with 23 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

23
port/ehci/usb_hc_ehci.c
View File

@@ -961,6 +961,19 @@ int usbh_roothub_control(struct usb_setup_packet *setup, uint8_t *buf)
EHCI_HCOR->portsc[port - 1] &= ~EHCI_PORTSC_PE;
break;
case HUB_PORT_FEATURE_SUSPEND:
EHCI_HCOR->portsc[port - 1] |= EHCI_PORTSC_RESUME;
usb_osal_msleep(20);
EHCI_HCOR->portsc[port - 1] &= ~EHCI_PORTSC_RESUME;
while(EHCI_HCOR->portsc[port - 1] & EHCI_PORTSC_RESUME){}
temp = EHCI_HCOR->usbcmd;
temp |= EHCI_USBCMD_ASEN;
temp |= EHCI_USBCMD_PSEN;
temp |= EHCI_USBCMD_RUN;
EHCI_HCOR->usbcmd = temp;
while((EHCI_HCOR->usbcmd & EHCI_USBCMD_RUN) == 0){}
case HUB_PORT_FEATURE_C_SUSPEND:
break;
case HUB_PORT_FEATURE_POWER:
@@ -990,6 +1003,16 @@ int usbh_roothub_control(struct usb_setup_packet *setup, uint8_t *buf)
switch (setup->wValue) {
case HUB_PORT_FEATURE_SUSPEND:
temp = EHCI_HCOR->usbcmd;
temp &= ~EHCI_USBCMD_ASEN;
temp &= ~EHCI_USBCMD_PSEN;
temp &= ~EHCI_USBCMD_RUN;
EHCI_HCOR->usbcmd = temp;
while(EHCI_HCOR->usbcmd & EHCI_USBCMD_RUN){}
EHCI_HCOR->portsc[port - 1] |= EHCI_PORTSC_SUSPEND;
while((EHCI_HCOR->portsc[port - 1] & EHCI_PORTSC_SUSPEND) == 0){}
break;
case HUB_PORT_FEATURE_POWER:
#ifdef CONFIG_USB_EHCI_PORT_POWER