\r
**/\r
\r
-#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
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
@param SystemTable A pointer to the EFI System Table.\r
\r
@retval EFI_SUCCESS The operation completed successfully.\r
+ @retval EFI_ABORTED Xen hypercalls are not available.\r
@retval Others An unexpected error occurred.\r
**/\r
EFI_STATUS\r
{\r
EFI_STATUS Status;\r
\r
+ if (! XenHypercallIsAvailable ()) {\r
+ return EFI_ABORTED;\r
+ }\r
+\r
//\r
// Install UEFI Driver Model protocol(s).\r
//\r
)\r
{\r
EFI_STATUS Status;\r
- EFI_PCI_IO_PROTOCOL *PciIo;\r
- PCI_TYPE00 Pci;\r
+ XENIO_PROTOCOL *XenIo;\r
\r
Status = gBS->OpenProtocol (\r
ControllerHandle,\r
- &gEfiPciIoProtocolGuid,\r
- (VOID **)&PciIo,\r
+ &gXenIoProtocolGuid,\r
+ (VOID **)&XenIo,\r
This->DriverBindingHandle,\r
ControllerHandle,\r
EFI_OPEN_PROTOCOL_BY_DRIVER\r
);\r
+\r
if (EFI_ERROR (Status)) {\r
return Status;\r
}\r
\r
- Status = PciIo->Pci.Read (PciIo, EfiPciIoWidthUint32, 0,\r
- sizeof Pci / sizeof (UINT32), &Pci);\r
-\r
- if (Status == EFI_SUCCESS) {\r
- if (Pci.Hdr.VendorId == PCI_VENDOR_ID_XEN &&\r
- Pci.Hdr.DeviceId == PCI_DEVICE_ID_XEN_PLATFORM) {\r
- Status = EFI_SUCCESS;\r
- } else {\r
- Status = EFI_UNSUPPORTED;\r
- }\r
- }\r
-\r
- gBS->CloseProtocol (ControllerHandle, &gEfiPciIoProtocolGuid,\r
+ gBS->CloseProtocol (ControllerHandle, &gXenIoProtocolGuid,\r
This->DriverBindingHandle, ControllerHandle);\r
\r
return Status;\r
{\r
EFI_STATUS Status;\r
XENBUS_DEVICE *Dev;\r
+ XENIO_PROTOCOL *XenIo;\r
+ EFI_DEVICE_PATH_PROTOCOL *DevicePath;\r
+\r
+ Status = gBS->OpenProtocol (\r
+ ControllerHandle,\r
+ &gXenIoProtocolGuid,\r
+ (VOID**)&XenIo,\r
+ This->DriverBindingHandle,\r
+ ControllerHandle,\r
+ EFI_OPEN_PROTOCOL_BY_DRIVER\r
+ );\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->XenIo = XenIo;\r
+ Dev->DevicePath = DevicePath;\r
+ InitializeListHead (&Dev->ChildList);\r
\r
EfiAcquireLock (&mMyDeviceLock);\r
if (mMyDevice != NULL) {\r
mMyDevice = Dev;\r
EfiReleaseLock (&mMyDeviceLock);\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
goto ErrorAllocated;\r
}\r
\r
+ XenGrantTableInit (Dev);\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
\r
ErrorAllocated:\r
FreePool (Dev);\r
+ gBS->CloseProtocol (ControllerHandle, &gEfiDevicePathProtocolGuid,\r
+ This->DriverBindingHandle, ControllerHandle);\r
+ErrorOpenningProtocol:\r
+ gBS->CloseProtocol (ControllerHandle, &gXenIoProtocolGuid,\r
+ This->DriverBindingHandle, ControllerHandle);\r
return Status;\r
}\r
\r
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, &gXenIoProtocolGuid,\r
+ This->DriverBindingHandle, ControllerHandle);\r
\r
mMyDevice = NULL;\r
FreePool (Dev);\r