From 8e0c5b4e7ef7e9a83a33e537e789f6c8e7e89557 Mon Sep 17 00:00:00 2001
From: sakumisu <1203593632@qq.com>
Date: Fri, 24 Nov 2023 21:09:37 +0800
Subject: find roothub port to check if device is connecting

---
 port/ehci/usb_hc_ehci.c | 14 ++++++++++++--
 1 file changed, 12 insertions(+), 2 deletions(-)

diff --git a/port/ehci/usb_hc_ehci.c b/port/ehci/usb_hc_ehci.c
index 4d9b588b..bf7395b1 100644
--- a/port/ehci/usb_hc_ehci.c
+++ b/port/ehci/usb_hc_ehci.c
@@ -1081,12 +1081,22 @@ int usbh_submit_urb(struct usbh_urb *urb)
     struct ehci_qh_hw *qh = NULL;
     size_t flags;
     int ret = 0;
+    struct usbh_hub *hub;
+    struct usbh_hubport *hport;
 
     if (!urb || !urb->hport || !urb->ep) {
         return -EINVAL;
     }
 
-    if (!urb->hport->connected) {
+    /* find active hubport in roothub */
+    hport = urb->hport;
+    hub = urb->hport->parent;
+    while (!hub->is_roothub) {
+        hport = hub->parent;
+        hub = hub->parent->parent;
+    }
+
+    if (!urb->hport->connected || !(EHCI_HCOR->portsc[hport->port -1] & EHCI_PORTSC_CCS)) {
         return -ENODEV;
     }
 
@@ -1141,7 +1151,7 @@ int usbh_submit_urb(struct usbh_urb *urb)
         }
         urb->timeout = 0;
         ret = urb->errorcode;
-        /* we should free qh when waitsem is done */
+        /* we can free qh when waitsem is done */
         ehci_qh_free(qh);
     }
     return ret;
-- 
cgit v1.3.1