#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 "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
};\r
\r
\r
+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
return Status;\r
}\r
\r
+VOID\r
+EFIAPI\r
+NotifyExitBoot (\r
+ IN EFI_EVENT Event,\r
+ IN VOID *Context\r
+ )\r
+{\r
+ XENBUS_DEVICE *Dev = Context;\r
+\r
+ gBS->DisconnectController(Dev->ControllerHandle,\r
+ Dev->This->DriverBindingHandle, NULL);\r
+}\r
+\r
/**\r
Starts a bus controller.\r
\r
@retval EFI_SUCCESS The device was started.\r
@retval EFI_DEVICE_ERROR The device could not be started due to a device error.Currently not implemented.\r
@retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources.\r
+ @retval EFI_UNSUPPORTED Something is missing on the system that\r
+ prevent to start the edvice.\r
@retval Others The driver failded to start the device.\r
\r
**/\r
IN EFI_DEVICE_PATH_PROTOCOL *RemainingDevicePath OPTIONAL\r
)\r
{\r
- return EFI_UNSUPPORTED;\r
+ EFI_STATUS Status;\r
+ XENBUS_DEVICE *Dev;\r
+ 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
+ &gEfiPciIoProtocolGuid,\r
+ (VOID **) &PciIo,\r
+ This->DriverBindingHandle,\r
+ ControllerHandle,\r
+ EFI_OPEN_PROTOCOL_BY_DRIVER\r
+ );\r
+ if (EFI_ERROR (Status)) {\r
+ 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
+ EfiReleaseLock (&mMyDeviceLock);\r
+ //\r
+ // There is already a XenBus running, only one can be used at a time.\r
+ //\r
+ Status = EFI_ALREADY_STARTED;\r
+ goto ErrorAllocated;\r
+ }\r
+ mMyDevice = Dev;\r
+ EfiReleaseLock (&mMyDeviceLock);\r
+\r
+ //\r
+ // The BAR1 of this PCI device is used for shared memory and is supposed to\r
+ // look like MMIO. The address space of the BAR1 will be used to map the\r
+ // Grant Table.\r
+ //\r
+ Status = PciIo->GetBarAttributes (PciIo, PCI_BAR_IDX1, NULL, (VOID**) &BarDesc);\r
+ ASSERT_EFI_ERROR (Status);\r
+ ASSERT (BarDesc->ResType == ACPI_ADDRESS_SPACE_TYPE_MEM);\r
+\r
+ /* Get a Memory address for mapping the Grant Table. */\r
+ DEBUG ((EFI_D_INFO, "XenBus: BAR at %LX\n", BarDesc->AddrRangeMin));\r
+ MmioAddr = BarDesc->AddrRangeMin;\r
+ FreePool (BarDesc);\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
+ Status = EFI_UNSUPPORTED;\r
+ goto ErrorAllocated;\r
+ }\r
+\r
+ XenGrantTableInit (Dev, MmioAddr);\r
+\r
+ 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
+ &Dev->ExitBootEvent);\r
+ ASSERT_EFI_ERROR (Status);\r
+\r
+ return EFI_SUCCESS;\r
+\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
}\r
\r
/**\r
IN EFI_HANDLE *ChildHandleBuffer OPTIONAL\r
)\r
{\r
- return EFI_UNSUPPORTED;\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
+ mMyDevice = NULL;\r
+ FreePool (Dev);\r
+ return EFI_SUCCESS;\r
}\r
projects / mirror_edk2.git / blobdiff