2 files changed, 49 insertions, 1 deletions

diff --git a/drivers/xen/Makefile b/drivers/xen/Makefile
index d80bea5535a..a4a3cab2f45 100644
--- a/drivers/xen/Makefile
+++ b/drivers/xen/Makefile
@@ -18,7 +18,7 @@ obj-$(CONFIG_XEN_PVHVM)			+= platform-pci.o
 obj-$(CONFIG_XEN_TMEM)                  += tmem.o
 obj-$(CONFIG_SWIOTLB_XEN)               += swiotlb-xen.o
 obj-$(CONFIG_XEN_DOM0)                  += pcpu.o
-obj-$(CONFIG_XEN_DOM0)                  += pci.o acpi.o
+obj-$(CONFIG_XEN_DOM0)                  += pci.o dbgp.o acpi.o
 obj-$(CONFIG_XEN_MCE_LOG)               += mcelog.o
 obj-$(CONFIG_XEN_PCIDEV_BACKEND)        += xen-pciback/
 obj-$(CONFIG_XEN_PRIVCMD)               += xen-privcmd.o
diff --git a/drivers/xen/dbgp.c b/drivers/xen/dbgp.c
new file mode 100644
index 00000000000..42569c77ccc
--- /dev/null
+++ b/drivers/xen/dbgp.c
@@ -0,0 +1,48 @@
+#include <linux/pci.h>
+#include <linux/usb.h>
+#include <linux/usb/ehci_def.h>
+#include <linux/usb/hcd.h>
+#include <asm/xen/hypercall.h>
+#include <xen/interface/physdev.h>
+#include <xen/xen.h>
+
+static int xen_dbgp_op(struct usb_hcd *hcd, int op)
+{
+        const struct device *ctrlr = hcd_to_bus(hcd)->controller;
+        struct physdev_dbgp_op dbgp;
+
+        if (!xen_initial_domain())
+                return 0;
+
+        dbgp.op = op;
+
+#ifdef CONFIG_PCI
+        if (ctrlr->bus == &pci_bus_type) {
+                const struct pci_dev *pdev = to_pci_dev(ctrlr);
+
+                dbgp.u.pci.seg = pci_domain_nr(pdev->bus);
+                dbgp.u.pci.bus = pdev->bus->number;
+                dbgp.u.pci.devfn = pdev->devfn;
+                dbgp.bus = PHYSDEVOP_DBGP_BUS_PCI;
+        } else
+#endif
+                dbgp.bus = PHYSDEVOP_DBGP_BUS_UNKNOWN;
+
+        return HYPERVISOR_physdev_op(PHYSDEVOP_dbgp_op, &dbgp);
+}
+
+int xen_dbgp_reset_prep(struct usb_hcd *hcd)
+{
+        return xen_dbgp_op(hcd, PHYSDEVOP_DBGP_RESET_PREPARE);
+}
+
+int xen_dbgp_external_startup(struct usb_hcd *hcd)
+{
+        return xen_dbgp_op(hcd, PHYSDEVOP_DBGP_RESET_DONE);
+}
+
+#ifndef CONFIG_EARLY_PRINTK_DBGP
+#include <linux/export.h>
+EXPORT_SYMBOL_GPL(xen_dbgp_reset_prep);
+EXPORT_SYMBOL_GPL(xen_dbgp_external_startup);
+#endif