Ovmf/Xen: move XenBusDxe hypercall code to separate library

[mirror_edk2.git] / OvmfPkg / XenBusDxe / XenBusDxe.c

diff --git a/OvmfPkg/XenBusDxe/XenBusDxe.c b/OvmfPkg/XenBusDxe/XenBusDxe.c
index 679fe3b592e5274d13d0a2aa2d954d50c3e4bf68..cc334c086c1f16983ddabe3e28b31c29ed2abfb9 100644 (file)
--- a/OvmfPkg/XenBusDxe/XenBusDxe.c
+++ b/OvmfPkg/XenBusDxe/XenBusDxe.c
@@ -26,13 +26,16 @@
 #include <IndustryStandard/Pci.h>\r
 #include <IndustryStandard/Acpi.h>\r
 #include <Library/DebugLib.h>\r
+#include <Library/XenHypercallLib.h>\r
 \r
 #include "XenBusDxe.h"\r
 \r
-#include "XenHypercall.h"\r
 #include "GrantTable.h"\r
 #include "XenStore.h"\r
+#include "XenBus.h"\r
 \r
+#include <IndustryStandard/Xen/hvm/params.h>\r
+#include <IndustryStandard/Xen/memory.h>\r
 \r
 ///\r
 /// Driver Binding Protocol instance\r
@@ -50,6 +53,46 @@ EFI_DRIVER_BINDING_PROTOCOL gXenBusDxeDriverBinding = {
 STATIC EFI_LOCK       mMyDeviceLock = EFI_INITIALIZE_LOCK_VARIABLE (TPL_CALLBACK);\r
 STATIC XENBUS_DEVICE *mMyDevice = NULL;\r
 \r
+/**\r
+  Map the shared_info_t page into memory.\r
+\r
+  @param Dev    A XENBUS_DEVICE instance.\r
+\r
+  @retval EFI_SUCCESS     Dev->SharedInfo whill contain a pointer to\r
+                          the shared info page\r
+  @retval EFI_LOAD_ERROR  The shared info page could not be mapped. The\r
+                          hypercall returned an error.\r
+**/\r
+STATIC\r
+EFI_STATUS\r
+XenGetSharedInfoPage (\r
+  IN OUT XENBUS_DEVICE *Dev\r
+  )\r
+{\r
+  xen_add_to_physmap_t Parameter;\r
+\r
+  ASSERT (Dev->SharedInfo == NULL);\r
+\r
+  Parameter.domid = DOMID_SELF;\r
+  Parameter.space = XENMAPSPACE_shared_info;\r
+  Parameter.idx = 0;\r
+\r
+  //\r
+  // using reserved page because the page is not released when Linux is\r
+  // starting because of the add_to_physmap. QEMU might try to access the\r
+  // page, and fail because it have no right to do so (segv).\r
+  //\r
+  Dev->SharedInfo = AllocateReservedPages (1);\r
+  Parameter.gpfn = (UINTN) Dev->SharedInfo >> EFI_PAGE_SHIFT;\r
+  if (XenHypercallMemoryOp (XENMEM_add_to_physmap, &Parameter) != 0) {\r
+    FreePages (Dev->SharedInfo, 1);\r
+    Dev->SharedInfo = NULL;\r
+    return EFI_LOAD_ERROR;\r
+  }\r
+\r
+  return EFI_SUCCESS;\r
+}\r
+\r
 /**\r
   Unloads an image.\r
 \r
@@ -286,6 +329,7 @@ XenBusDxeDriverBindingStart (
   EFI_PCI_IO_PROTOCOL *PciIo;\r
   EFI_ACPI_ADDRESS_SPACE_DESCRIPTOR *BarDesc;\r
   UINT64 MmioAddr;\r
+  EFI_DEVICE_PATH_PROTOCOL *DevicePath;\r
 \r
   Status = gBS->OpenProtocol (\r
                      ControllerHandle,\r
@@ -299,11 +343,26 @@ XenBusDxeDriverBindingStart (
     return Status;\r
   }\r
 \r
+  Status = gBS->OpenProtocol (\r
+                  ControllerHandle,\r
+                  &gEfiDevicePathProtocolGuid,\r
+                  (VOID **) &DevicePath,\r
+                  This->DriverBindingHandle,\r
+                  ControllerHandle,\r
+                  EFI_OPEN_PROTOCOL_BY_DRIVER\r
+                  );\r
+\r
+  if (EFI_ERROR (Status)) {\r
+    goto ErrorOpenningProtocol;\r
+  }\r
+\r
   Dev = AllocateZeroPool (sizeof (*Dev));\r
   Dev->Signature = XENBUS_DEVICE_SIGNATURE;\r
   Dev->This = This;\r
   Dev->ControllerHandle = ControllerHandle;\r
   Dev->PciIo = PciIo;\r
+  Dev->DevicePath = DevicePath;\r
+  InitializeListHead (&Dev->ChildList);\r
 \r
   EfiAcquireLock (&mMyDeviceLock);\r
   if (mMyDevice != NULL) {\r
@@ -331,13 +390,6 @@ XenBusDxeDriverBindingStart (
   MmioAddr = BarDesc->AddrRangeMin;\r
   FreePool (BarDesc);\r
 \r
-  Status = XenHyperpageInit (Dev);\r
-  if (EFI_ERROR (Status)) {\r
-    DEBUG ((EFI_D_ERROR, "XenBus: Unable to retrieve the hyperpage.\n"));\r
-    Status = EFI_UNSUPPORTED;\r
-    goto ErrorAllocated;\r
-  }\r
-\r
   Status = XenGetSharedInfoPage (Dev);\r
   if (EFI_ERROR (Status)) {\r
     DEBUG ((EFI_D_ERROR, "XenBus: Unable to get the shared info page.\n"));\r
@@ -350,6 +402,8 @@ XenBusDxeDriverBindingStart (
   Status = XenStoreInit (Dev);\r
   ASSERT_EFI_ERROR (Status);\r
 \r
+  XenBusEnumerateBus (Dev);\r
+\r
   Status = gBS->CreateEvent (EVT_SIGNAL_EXIT_BOOT_SERVICES, TPL_CALLBACK,\r
                              NotifyExitBoot,\r
                              (VOID*) Dev,\r
@@ -360,6 +414,9 @@ XenBusDxeDriverBindingStart (
 \r
 ErrorAllocated:\r
   FreePool (Dev);\r
+  gBS->CloseProtocol (ControllerHandle, &gEfiDevicePathProtocolGuid,\r
+                      This->DriverBindingHandle, ControllerHandle);\r
+ErrorOpenningProtocol:\r
   gBS->CloseProtocol (ControllerHandle, &gEfiPciIoProtocolGuid,\r
                       This->DriverBindingHandle, ControllerHandle);\r
   return Status;\r
@@ -400,12 +457,56 @@ XenBusDxeDriverBindingStop (
   IN EFI_HANDLE                   *ChildHandleBuffer OPTIONAL\r
   )\r
 {\r
+  UINTN Index;\r
+  XENBUS_PROTOCOL *XenBusIo;\r
+  XENBUS_PRIVATE_DATA *ChildData;\r
+  EFI_STATUS Status;\r
   XENBUS_DEVICE *Dev = mMyDevice;\r
 \r
+  for (Index = 0; Index < NumberOfChildren; Index++) {\r
+    Status = gBS->OpenProtocol (\r
+               ChildHandleBuffer[Index],\r
+               &gXenBusProtocolGuid,\r
+               (VOID **) &XenBusIo,\r
+               This->DriverBindingHandle,\r
+               ControllerHandle,\r
+               EFI_OPEN_PROTOCOL_GET_PROTOCOL);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "XenBusDxe: get children protocol failed: %r\n", Status));\r
+      continue;\r
+    }\r
+    ChildData = XENBUS_PRIVATE_DATA_FROM_THIS (XenBusIo);\r
+    Status = gBS->DisconnectController (ChildData->Handle, NULL, NULL);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "XenBusDxe: error disconnecting child: %r\n",\r
+              Status));\r
+      continue;\r
+    }\r
+\r
+    Status = gBS->UninstallMultipleProtocolInterfaces (\r
+               ChildData->Handle,\r
+               &gEfiDevicePathProtocolGuid, ChildData->DevicePath,\r
+               &gXenBusProtocolGuid, &ChildData->XenBusIo,\r
+               NULL);\r
+    ASSERT_EFI_ERROR (Status);\r
+\r
+    FreePool ((VOID*)ChildData->XenBusIo.Type);\r
+    FreePool ((VOID*)ChildData->XenBusIo.Node);\r
+    FreePool ((VOID*)ChildData->XenBusIo.Backend);\r
+    FreePool (ChildData->DevicePath);\r
+    RemoveEntryList (&ChildData->Link);\r
+    FreePool (ChildData);\r
+  }\r
+  if (NumberOfChildren > 0) {\r
+    return EFI_SUCCESS;\r
+  }\r
+\r
   gBS->CloseEvent (Dev->ExitBootEvent);\r
   XenStoreDeinit (Dev);\r
   XenGrantTableDeinit (Dev);\r
 \r
+  gBS->CloseProtocol (ControllerHandle, &gEfiDevicePathProtocolGuid,\r
+         This->DriverBindingHandle, ControllerHandle);\r
   gBS->CloseProtocol (ControllerHandle, &gEfiPciIoProtocolGuid,\r
          This->DriverBindingHandle, ControllerHandle);\r
 \r