OvmfPkg/XenBusDxe: Add TestAndClearBit.

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

/** @file\r
  This driver produces XenBus Protocol instances for each Xen PV devices.\r
\r
  This XenBus bus driver will first initialize differente services in order to\r
  enumerate the ParaVirtualized devices available.\r
\r
  Those services are:\r
    - HyperCall\r
    - Event Channel\r
    - Grant Table\r
    - XenStore\r
    - XenBus\r
\r
  Copyright (C) 2014, Citrix Ltd.\r
\r
  This program and the accompanying materials\r
  are licensed and made available under the terms and conditions of the BSD License\r
  which accompanies this distribution.  The full text of the license may be found at\r
  http://opensource.org/licenses/bsd-license.php\r
\r
  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
\r
**/\r
\r
#include <IndustryStandard/Pci.h>\r
#include <IndustryStandard/Acpi.h>\r
#include <Library/DebugLib.h>\r
\r
#include "XenBusDxe.h"\r
\r
#include "XenHypercall.h"\r
#include "GrantTable.h"\r
\r
\r
///\r
/// Driver Binding Protocol instance\r
///\r
EFI_DRIVER_BINDING_PROTOCOL gXenBusDxeDriverBinding = {\r
  XenBusDxeDriverBindingSupported,\r
  XenBusDxeDriverBindingStart,\r
  XenBusDxeDriverBindingStop,\r
  XENBUS_DXE_VERSION,\r
  NULL,\r
  NULL\r
};\r
\r
\r
STATIC EFI_LOCK       mMyDeviceLock = EFI_INITIALIZE_LOCK_VARIABLE (TPL_CALLBACK);\r
STATIC XENBUS_DEVICE *mMyDevice = NULL;\r
\r
/**\r
  Unloads an image.\r
\r
  @param  ImageHandle           Handle that identifies the image to be unloaded.\r
\r
  @retval EFI_SUCCESS           The image has been unloaded.\r
  @retval EFI_INVALID_PARAMETER ImageHandle is not a valid image handle.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
XenBusDxeUnload (\r
  IN EFI_HANDLE  ImageHandle\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  EFI_HANDLE  *HandleBuffer;\r
  UINTN       HandleCount;\r
  UINTN       Index;\r
\r
  //\r
  // Retrieve array of all handles in the handle database\r
  //\r
  Status = gBS->LocateHandleBuffer (\r
                  AllHandles,\r
                  NULL,\r
                  NULL,\r
                  &HandleCount,\r
                  &HandleBuffer\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Disconnect the current driver from handles in the handle database\r
  //\r
  for (Index = 0; Index < HandleCount; Index++) {\r
    gBS->DisconnectController (HandleBuffer[Index], gImageHandle, NULL);\r
  }\r
\r
  //\r
  // Free the array of handles\r
  //\r
  FreePool (HandleBuffer);\r
\r
\r
  //\r
  // Uninstall protocols installed in the driver entry point\r
  //\r
  Status = gBS->UninstallMultipleProtocolInterfaces (\r
                  ImageHandle,\r
                  &gEfiDriverBindingProtocolGuid, &gXenBusDxeDriverBinding,\r
                  &gEfiComponentNameProtocolGuid,  &gXenBusDxeComponentName,\r
                  &gEfiComponentName2ProtocolGuid, &gXenBusDxeComponentName2,\r
                  NULL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  This is the declaration of an EFI image entry point. This entry point is\r
  the same for UEFI Applications, UEFI OS Loaders, and UEFI Drivers including\r
  both device drivers and bus drivers.\r
\r
  @param  ImageHandle           The firmware allocated handle for the UEFI image.\r
  @param  SystemTable           A pointer to the EFI System Table.\r
\r
  @retval EFI_SUCCESS           The operation completed successfully.\r
  @retval Others                An unexpected error occurred.\r
**/\r
EFI_STATUS\r
EFIAPI\r
XenBusDxeDriverEntryPoint (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  //\r
  // Install UEFI Driver Model protocol(s).\r
  //\r
  Status = EfiLibInstallDriverBindingComponentName2 (\r
             ImageHandle,\r
             SystemTable,\r
             &gXenBusDxeDriverBinding,\r
             ImageHandle,\r
             &gXenBusDxeComponentName,\r
             &gXenBusDxeComponentName2\r
             );\r
  ASSERT_EFI_ERROR (Status);\r
\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Tests to see if this driver supports a given controller. If a child device is provided,\r
  it further tests to see if this driver supports creating a handle for the specified child device.\r
\r
  @param[in]  This                 A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance.\r
  @param[in]  ControllerHandle     The handle of the controller to test. This handle\r
                                   must support a protocol interface that supplies\r
                                   an I/O abstraction to the driver.\r
  @param[in]  RemainingDevicePath  A pointer to the remaining portion of a device path.  This\r
                                   parameter is ignored by device drivers, and is optional for bus\r
                                   drivers. For bus drivers, if this parameter is not NULL, then\r
                                   the bus driver must determine if the bus controller specified\r
                                   by ControllerHandle and the child controller specified\r
                                   by RemainingDevicePath are both supported by this\r
                                   bus driver.\r
\r
  @retval EFI_SUCCESS              The device specified by ControllerHandle and\r
                                   RemainingDevicePath is supported by the driver specified by This.\r
  @retval EFI_ALREADY_STARTED      The device specified by ControllerHandle and\r
                                   RemainingDevicePath is already being managed by the driver\r
                                   specified by This.\r
  @retval EFI_ACCESS_DENIED        The device specified by ControllerHandle and\r
                                   RemainingDevicePath is already being managed by a different\r
                                   driver or an application that requires exclusive access.\r
                                   Currently not implemented.\r
  @retval EFI_UNSUPPORTED          The device specified by ControllerHandle and\r
                                   RemainingDevicePath is not supported by the driver specified by This.\r
**/\r
EFI_STATUS\r
EFIAPI\r
XenBusDxeDriverBindingSupported (\r
  IN EFI_DRIVER_BINDING_PROTOCOL  *This,\r
  IN EFI_HANDLE                   ControllerHandle,\r
  IN EFI_DEVICE_PATH_PROTOCOL     *RemainingDevicePath OPTIONAL\r
  )\r
{\r
  EFI_STATUS          Status;\r
  EFI_PCI_IO_PROTOCOL *PciIo;\r
  PCI_TYPE00          Pci;\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 = 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
         This->DriverBindingHandle, ControllerHandle);\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
  The Start() function is designed to be invoked from the EFI boot service ConnectController().\r
  As a result, much of the error checking on the parameters to Start() has been moved into this\r
  common boot service. It is legal to call Start() from other locations,\r
  but the following calling restrictions must be followed, or the system behavior will not be deterministic.\r
  1. ControllerHandle must be a valid EFI_HANDLE.\r
  2. If RemainingDevicePath is not NULL, then it must be a pointer to a naturally aligned\r
     EFI_DEVICE_PATH_PROTOCOL.\r
  3. Prior to calling Start(), the Supported() function for the driver specified by This must\r
     have been called with the same calling parameters, and Supported() must have returned EFI_SUCCESS.\r
\r
  @param[in]  This                 A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance.\r
  @param[in]  ControllerHandle     The handle of the controller to start. This handle\r
                                   must support a protocol interface that supplies\r
                                   an I/O abstraction to the driver.\r
  @param[in]  RemainingDevicePath  A pointer to the remaining portion of a device path.  This\r
                                   parameter is ignored by device drivers, and is optional for bus\r
                                   drivers. For a bus driver, if this parameter is NULL, then handles\r
                                   for all the children of Controller are created by this driver.\r
                                   If this parameter is not NULL and the first Device Path Node is\r
                                   not the End of Device Path Node, then only the handle for the\r
                                   child device specified by the first Device Path Node of\r
                                   RemainingDevicePath is created by this driver.\r
                                   If the first Device Path Node of RemainingDevicePath is\r
                                   the End of Device Path Node, no child handle is created by this\r
                                   driver.\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
EFI_STATUS\r
EFIAPI\r
XenBusDxeDriverBindingStart (\r
  IN EFI_DRIVER_BINDING_PROTOCOL  *This,\r
  IN EFI_HANDLE                   ControllerHandle,\r
  IN EFI_DEVICE_PATH_PROTOCOL     *RemainingDevicePath OPTIONAL\r
  )\r
{\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
\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
  Dev = AllocateZeroPool (sizeof (*Dev));\r
  Dev->Signature = XENBUS_DEVICE_SIGNATURE;\r
  Dev->This = This;\r
  Dev->ControllerHandle = ControllerHandle;\r
  Dev->PciIo = PciIo;\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 = 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
    Status = EFI_UNSUPPORTED;\r
    goto ErrorAllocated;\r
  }\r
\r
  XenGrantTableInit (Dev, MmioAddr);\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, &gEfiPciIoProtocolGuid,\r
                      This->DriverBindingHandle, ControllerHandle);\r
  return Status;\r
}\r
\r
/**\r
  Stops a bus controller.\r
\r
  The Stop() function is designed to be invoked from the EFI boot service DisconnectController().\r
  As a result, much of the error checking on the parameters to Stop() has been moved\r
  into this common boot service. It is legal to call Stop() from other locations,\r
  but the following calling restrictions must be followed, or the system behavior will not be deterministic.\r
  1. ControllerHandle must be a valid EFI_HANDLE that was used on a previous call to this\r
     same driver's Start() function.\r
  2. The first NumberOfChildren handles of ChildHandleBuffer must all be a valid\r
     EFI_HANDLE. In addition, all of these handles must have been created in this driver's\r
     Start() function, and the Start() function must have called OpenProtocol() on\r
     ControllerHandle with an Attribute of EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER.\r
\r
  @param[in]  This              A pointer to the EFI_DRIVER_BINDING_PROTOCOL instance.\r
  @param[in]  ControllerHandle  A handle to the device being stopped. The handle must\r
                                support a bus specific I/O protocol for the driver\r
                                to use to stop the device.\r
  @param[in]  NumberOfChildren  The number of child device handles in ChildHandleBuffer.\r
  @param[in]  ChildHandleBuffer An array of child handles to be freed. May be NULL\r
                                if NumberOfChildren is 0.\r
\r
  @retval EFI_SUCCESS           The device was stopped.\r
  @retval EFI_DEVICE_ERROR      The device could not be stopped due to a device error.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
XenBusDxeDriverBindingStop (\r
  IN EFI_DRIVER_BINDING_PROTOCOL  *This,\r
  IN EFI_HANDLE                   ControllerHandle,\r
  IN UINTN                        NumberOfChildren,\r
  IN EFI_HANDLE                   *ChildHandleBuffer OPTIONAL\r
  )\r
{\r
  XENBUS_DEVICE *Dev = mMyDevice;\r
\r
  gBS->CloseEvent (Dev->ExitBootEvent);\r
  XenGrantTableDeinit (Dev);\r
\r
  gBS->CloseProtocol (ControllerHandle, &gEfiPciIoProtocolGuid,\r
         This->DriverBindingHandle, ControllerHandle);\r
\r
  mMyDevice = NULL;\r
  FreePool (Dev);\r
  return EFI_SUCCESS;\r
}\r