3 files changed, 17 insertions, 8 deletions

diff --git a/drivers/usb/early/ehci-dbgp.c b/drivers/usb/early/ehci-dbgp.c
index 89dcf155d57e..e426ad626d74 100644
--- a/drivers/usb/early/ehci-dbgp.c
+++ b/drivers/usb/early/ehci-dbgp.c
@@ -491,7 +491,7 @@ static int ehci_wait_for_port(int port);
  * Return -ENODEV for any general failure
  * Return -EIO if wait for port fails
  */
-int dbgp_external_startup(void)
+static int _dbgp_external_startup(void)
 {
         int devnum;
         struct usb_debug_descriptor dbgp_desc;
@@ -613,6 +613,11 @@ err:
                 goto try_again;
         return -ENODEV;
 }
+
+int dbgp_external_startup(struct usb_hcd *hcd)
+{
+        return xen_dbgp_external_startup(hcd) ?: _dbgp_external_startup();
+}
 EXPORT_SYMBOL_GPL(dbgp_external_startup);
 
 static int ehci_reset_port(int port)
@@ -804,7 +809,7 @@ try_next_port:
                 dbgp_ehci_status("ehci skip - already configured");
         }
 
-        ret = dbgp_external_startup();
+        ret = _dbgp_external_startup();
         if (ret == -EIO)
                 goto next_debug_port;
 
@@ -934,7 +939,7 @@ static void early_dbgp_write(struct console *con, const char *str, u32 n)
                 ctrl = readl(&ehci_debug->control);
                 if (!(ctrl & DBGP_ENABLED)) {
                         dbgp_not_safe = 1;
-                        dbgp_external_startup();
+                        _dbgp_external_startup();
                 } else {
                         cmd |= CMD_RUN;
                         writel(cmd, &ehci_regs->command);
@@ -974,10 +979,14 @@ struct console early_dbgp_console = {
         .index =        -1,
 };
 
-int dbgp_reset_prep(void)
+int dbgp_reset_prep(struct usb_hcd *hcd)
 {
+        int ret = xen_dbgp_reset_prep(hcd);
         u32 ctrl;
 
+        if (ret)
+                return ret;
+
         dbgp_not_safe = 1;
         if (!ehci_debug)
                 return 0;
diff --git a/drivers/usb/host/ehci-hcd.c b/drivers/usb/host/ehci-hcd.c
index b05c6865b610..6bf6c42481e8 100644
--- a/drivers/usb/host/ehci-hcd.c
+++ b/drivers/usb/host/ehci-hcd.c
@@ -228,7 +228,7 @@ static int ehci_reset (struct ehci_hcd *ehci)
 
         /* If the EHCI debug controller is active, special care must be
          * taken before and after a host controller reset */
-        if (ehci->debug && !dbgp_reset_prep())
+        if (ehci->debug && !dbgp_reset_prep(ehci_to_hcd(ehci)))
                 ehci->debug = NULL;
 
         command |= CMD_RESET;
@@ -251,7 +251,7 @@ static int ehci_reset (struct ehci_hcd *ehci)
                 tdi_reset (ehci);
 
         if (ehci->debug)
-                dbgp_external_startup();
+                dbgp_external_startup(ehci_to_hcd(ehci));
 
         ehci->port_c_suspend = ehci->suspended_ports =
                         ehci->resuming_ports = 0;
diff --git a/drivers/usb/host/ehci-hub.c b/drivers/usb/host/ehci-hub.c
index c7880223738a..914ce9370e70 100644
--- a/drivers/usb/host/ehci-hub.c
+++ b/drivers/usb/host/ehci-hub.c
@@ -353,10 +353,10 @@ static int ehci_bus_resume (struct usb_hcd *hcd)
                 goto shutdown;
 
         if (unlikely(ehci->debug)) {
-                if (!dbgp_reset_prep())
+                if (!dbgp_reset_prep(hcd))
                         ehci->debug = NULL;
                 else
-                        dbgp_external_startup();
+                        dbgp_external_startup(hcd);
         }
 
         /* Ideally and we've got a real resume here, and no port's power