UefiCpuPkg: Move AsmRelocateApLoopStart from Mpfuncs.nasm to AmdSev.nasm

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

/** @file\r
  XenBus Bus driver implementation.\r
\r
  This file implement the necessary to discover and enumerate Xen PV devices\r
  through XenStore.\r
\r
  Copyright (C) 2010 Spectra Logic Corporation\r
  Copyright (C) 2008 Doug Rabson\r
  Copyright (C) 2005 Rusty Russell, IBM Corporation\r
  Copyright (C) 2005 Mike Wray, Hewlett-Packard\r
  Copyright (C) 2005 XenSource Ltd\r
  Copyright (C) 2014, Citrix Ltd.\r
\r
  This file may be distributed separately from the Linux kernel, or\r
  incorporated into other software packages, subject to the following license:\r
\r
  SPDX-License-Identifier: MIT\r
**/\r
\r
#include <Library/PrintLib.h>\r
\r
#include "XenBus.h"\r
#include "GrantTable.h"\r
#include "XenStore.h"\r
#include "EventChannel.h"\r
\r
#include <IndustryStandard/Xen/io/xenbus.h>\r
\r
STATIC XENBUS_PRIVATE_DATA  gXenBusPrivateData;\r
\r
STATIC XENBUS_DEVICE_PATH  gXenBusDevicePathTemplate = {\r
  {                                                 // Vendor\r
    {                                               // Vendor.Header\r
      HARDWARE_DEVICE_PATH,                         // Vendor.Header.Type\r
      HW_VENDOR_DP,                                 // Vendor.Header.SubType\r
      {\r
        (UINT8)(sizeof (XENBUS_DEVICE_PATH)),       // Vendor.Header.Length[0]\r
        (UINT8)(sizeof (XENBUS_DEVICE_PATH) >> 8),  // Vendor.Header.Length[1]\r
      }\r
    },\r
    XENBUS_PROTOCOL_GUID,                           // Vendor.Guid\r
  },\r
  0,                                                // Type\r
  0                                                 // DeviceId\r
};\r
\r
/**\r
  Search our internal record of configured devices (not the XenStore) to\r
  determine if the XenBus device indicated by Node is known to the system.\r
\r
  @param Dev   The XENBUS_DEVICE instance to search for device children.\r
  @param Node  The XenStore node path for the device to find.\r
\r
  @return  The XENBUS_PRIVATE_DATA of the found device if any, or NULL.\r
 */\r
STATIC\r
XENBUS_PRIVATE_DATA *\r
XenBusDeviceInitialized (\r
  IN XENBUS_DEVICE  *Dev,\r
  IN CONST CHAR8    *Node\r
  )\r
{\r
  LIST_ENTRY           *Entry;\r
  XENBUS_PRIVATE_DATA  *Child;\r
  XENBUS_PRIVATE_DATA  *Result;\r
\r
  if (IsListEmpty (&Dev->ChildList)) {\r
    return NULL;\r
  }\r
\r
  Result = NULL;\r
  for (Entry = GetFirstNode (&Dev->ChildList);\r
       !IsNodeAtEnd (&Dev->ChildList, Entry);\r
       Entry = GetNextNode (&Dev->ChildList, Entry))\r
  {\r
    Child = XENBUS_PRIVATE_DATA_FROM_LINK (Entry);\r
    if (!AsciiStrCmp (Child->XenBusIo.Node, Node)) {\r
      Result = Child;\r
      break;\r
    }\r
  }\r
\r
  return (Result);\r
}\r
\r
STATIC\r
XenbusState\r
XenBusReadDriverState (\r
  IN CONST CHAR8  *Path\r
  )\r
{\r
  XenbusState      State;\r
  CHAR8            *Ptr = NULL;\r
  XENSTORE_STATUS  Status;\r
\r
  Status = XenStoreRead (XST_NIL, Path, "state", NULL, (VOID **)&Ptr);\r
  if (Status != XENSTORE_STATUS_SUCCESS) {\r
    State = XenbusStateClosed;\r
  } else {\r
    State = AsciiStrDecimalToUintn (Ptr);\r
  }\r
\r
  if (Ptr != NULL) {\r
    FreePool (Ptr);\r
  }\r
\r
  return State;\r
}\r
\r
//\r
// Callers should ensure that they are only one calling XenBusAddDevice.\r
//\r
STATIC\r
EFI_STATUS\r
XenBusAddDevice (\r
  XENBUS_DEVICE  *Dev,\r
  CONST CHAR8    *Type,\r
  CONST CHAR8    *Id\r
  )\r
{\r
  CHAR8                DevicePath[XENSTORE_ABS_PATH_MAX];\r
  XENSTORE_STATUS      StatusXenStore;\r
  XENBUS_PRIVATE_DATA  *Private;\r
  EFI_STATUS           Status;\r
  XENBUS_DEVICE_PATH   *TempXenBusPath;\r
  VOID                 *ChildXenIo;\r
\r
  AsciiSPrint (\r
    DevicePath,\r
    sizeof (DevicePath),\r
    "device/%a/%a",\r
    Type,\r
    Id\r
    );\r
\r
  if (XenStorePathExists (XST_NIL, DevicePath, "")) {\r
    XENBUS_PRIVATE_DATA  *Child;\r
    enum xenbus_state    State;\r
    CHAR8                *BackendPath;\r
\r
    Child = XenBusDeviceInitialized (Dev, DevicePath);\r
    if (Child != NULL) {\r
      /*\r
       * We are already tracking this node\r
       */\r
      Status = EFI_SUCCESS;\r
      goto out;\r
    }\r
\r
    State = XenBusReadDriverState (DevicePath);\r
    if (State != XenbusStateInitialising) {\r
      /*\r
       * Device is not new, so ignore it. This can\r
       * happen if a device is going away after\r
       * switching to Closed.\r
       */\r
      DEBUG ((\r
        DEBUG_INFO,\r
        "XenBus: Device %a ignored. "\r
        "State %d\n",\r
        DevicePath,\r
        State\r
        ));\r
      Status = EFI_SUCCESS;\r
      goto out;\r
    }\r
\r
    StatusXenStore = XenStoreRead (\r
                       XST_NIL,\r
                       DevicePath,\r
                       "backend",\r
                       NULL,\r
                       (VOID **)&BackendPath\r
                       );\r
    if (StatusXenStore != XENSTORE_STATUS_SUCCESS) {\r
      DEBUG ((DEBUG_ERROR, "xenbus: %a no backend path.\n", DevicePath));\r
      Status = EFI_NOT_FOUND;\r
      goto out;\r
    }\r
\r
    Private                    = AllocateCopyPool (sizeof (*Private), &gXenBusPrivateData);\r
    Private->XenBusIo.Type     = AsciiStrDup (Type);\r
    Private->XenBusIo.Node     = AsciiStrDup (DevicePath);\r
    Private->XenBusIo.Backend  = BackendPath;\r
    Private->XenBusIo.DeviceId = (UINT16)AsciiStrDecimalToUintn (Id);\r
    Private->Dev               = Dev;\r
\r
    TempXenBusPath = AllocateCopyPool (\r
                       sizeof (XENBUS_DEVICE_PATH),\r
                       &gXenBusDevicePathTemplate\r
                       );\r
    if (!AsciiStrCmp (Private->XenBusIo.Type, "vbd")) {\r
      TempXenBusPath->Type = XENBUS_DEVICE_PATH_TYPE_VBD;\r
    }\r
\r
    TempXenBusPath->DeviceId = Private->XenBusIo.DeviceId;\r
    Private->DevicePath      = (XENBUS_DEVICE_PATH *)AppendDevicePathNode (\r
                                                       Dev->DevicePath,\r
                                                       &TempXenBusPath->Vendor.Header\r
                                                       );\r
    FreePool (TempXenBusPath);\r
\r
    InsertTailList (&Dev->ChildList, &Private->Link);\r
\r
    Status = gBS->InstallMultipleProtocolInterfaces (\r
                    &Private->Handle,\r
                    &gEfiDevicePathProtocolGuid,\r
                    Private->DevicePath,\r
                    &gXenBusProtocolGuid,\r
                    &Private->XenBusIo,\r
                    NULL\r
                    );\r
    if (EFI_ERROR (Status)) {\r
      goto ErrorInstallProtocol;\r
    }\r
\r
    Status = gBS->OpenProtocol (\r
                    Dev->ControllerHandle,\r
                    &gXenIoProtocolGuid,\r
                    &ChildXenIo,\r
                    Dev->This->DriverBindingHandle,\r
                    Private->Handle,\r
                    EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r
                    );\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((\r
        DEBUG_ERROR,\r
        "open by child controller fail (%r)\n",\r
        Status\r
        ));\r
      goto ErrorOpenProtocolByChild;\r
    }\r
  } else {\r
    DEBUG ((DEBUG_ERROR, "XenBus: does not exist: %a\n", DevicePath));\r
    Status = EFI_NOT_FOUND;\r
  }\r
\r
  return Status;\r
\r
ErrorOpenProtocolByChild:\r
  gBS->UninstallMultipleProtocolInterfaces (\r
         Private->Handle,\r
         &gEfiDevicePathProtocolGuid,\r
         Private->DevicePath,\r
         &gXenBusProtocolGuid,\r
         &Private->XenBusIo,\r
         NULL\r
         );\r
ErrorInstallProtocol:\r
  RemoveEntryList (&Private->Link);\r
  FreePool (Private->DevicePath);\r
  FreePool ((VOID *)Private->XenBusIo.Backend);\r
  FreePool ((VOID *)Private->XenBusIo.Node);\r
  FreePool ((VOID *)Private->XenBusIo.Type);\r
  FreePool (Private);\r
out:\r
  return Status;\r
}\r
\r
/**\r
  Enumerate all devices of the given type on this bus.\r
\r
  @param Dev   A XENBUS_DEVICE instance.\r
  @param Type  String indicating the device sub-tree (e.g. "vfb", "vif")\r
               to enumerate.\r
\r
  Devices that are found are been initialize via XenBusAddDevice ().\r
  XenBusAddDevice () ignores duplicate detects and ignores duplicate devices,\r
  so it can be called unconditionally for any device found in the XenStore.\r
 */\r
STATIC\r
VOID\r
XenBusEnumerateDeviceType (\r
  XENBUS_DEVICE  *Dev,\r
  CONST CHAR8    *Type\r
  )\r
{\r
  CONST CHAR8      **Directory;\r
  UINTN            Index;\r
  UINT32           Count;\r
  XENSTORE_STATUS  Status;\r
\r
  Status = XenStoreListDirectory (\r
             XST_NIL,\r
             "device",\r
             Type,\r
             &Count,\r
             &Directory\r
             );\r
  if (Status != XENSTORE_STATUS_SUCCESS) {\r
    return;\r
  }\r
\r
  for (Index = 0; Index < Count; Index++) {\r
    XenBusAddDevice (Dev, Type, Directory[Index]);\r
  }\r
\r
  FreePool ((VOID *)Directory);\r
}\r
\r
/**\r
  Enumerate the devices on a XenBus bus and install a XenBus Protocol instance.\r
\r
  Caller should ensure that it is the only one to call this function. This\r
  function cannot be called concurrently.\r
\r
  @param Dev   A XENBUS_DEVICE instance.\r
\r
  @return  On success, XENSTORE_STATUS_SUCCESS. Otherwise an errno value\r
           indicating the type of failure.\r
 */\r
XENSTORE_STATUS\r
XenBusEnumerateBus (\r
  XENBUS_DEVICE  *Dev\r
  )\r
{\r
  CONST CHAR8      **Types;\r
  UINTN            Index;\r
  UINT32           Count;\r
  XENSTORE_STATUS  Status;\r
\r
  Status = XenStoreListDirectory (\r
             XST_NIL,\r
             "device",\r
             "",\r
             &Count,\r
             &Types\r
             );\r
  if (Status != XENSTORE_STATUS_SUCCESS) {\r
    return Status;\r
  }\r
\r
  for (Index = 0; Index < Count; Index++) {\r
    XenBusEnumerateDeviceType (Dev, Types[Index]);\r
  }\r
\r
  FreePool ((VOID *)Types);\r
\r
  return XENSTORE_STATUS_SUCCESS;\r
}\r
\r
STATIC\r
XENSTORE_STATUS\r
EFIAPI\r
XenBusSetState (\r
  IN XENBUS_PROTOCOL             *This,\r
  IN CONST XENSTORE_TRANSACTION  *Transaction,\r
  IN enum xenbus_state           NewState\r
  )\r
{\r
  enum xenbus_state  CurrentState;\r
  XENSTORE_STATUS    Status;\r
  CHAR8              *Temp;\r
\r
  DEBUG ((DEBUG_INFO, "XenBus: Set state to %d\n", NewState));\r
\r
  Status = XenStoreRead (Transaction, This->Node, "state", NULL, (VOID **)&Temp);\r
  if (Status != XENSTORE_STATUS_SUCCESS) {\r
    goto Out;\r
  }\r
\r
  CurrentState = AsciiStrDecimalToUintn (Temp);\r
  FreePool (Temp);\r
  if (CurrentState == NewState) {\r
    goto Out;\r
  }\r
\r
  do {\r
    Status = XenStoreSPrint (Transaction, This->Node, "state", "%d", NewState);\r
  } while (Status == XENSTORE_STATUS_EAGAIN);\r
\r
  if (Status != XENSTORE_STATUS_SUCCESS) {\r
    DEBUG ((DEBUG_ERROR, "XenBus: failed to write new state\n"));\r
    goto Out;\r
  }\r
\r
  DEBUG ((DEBUG_INFO, "XenBus: Set state to %d, done\n", NewState));\r
\r
Out:\r
  return Status;\r
}\r
\r
STATIC XENBUS_PRIVATE_DATA  gXenBusPrivateData = {\r
  XENBUS_PRIVATE_DATA_SIGNATURE,    // Signature\r
  { NULL, NULL },                   // Link\r
  NULL,                             // Handle\r
  {                                 // XenBusIo\r
    XenBusXenStoreRead,             // XenBusIo.XsRead\r
    XenBusXenStoreBackendRead,      // XenBusIo.XsBackendRead\r
    XenBusXenStoreSPrint,           // XenBusIo.XsPrintf\r
    XenBusXenStoreRemove,           // XenBusIo.XsRemove\r
    XenBusXenStoreTransactionStart, // XenBusIo.XsTransactionStart\r
    XenBusXenStoreTransactionEnd,   // XenBusIo.XsTransactionEnd\r
    XenBusSetState,                 // XenBusIo.SetState\r
    XenBusGrantAccess,              // XenBusIo.GrantAccess\r
    XenBusGrantEndAccess,           // XenBusIo.GrantEndAccess\r
    XenBusEventChannelAllocate,     // XenBusIo.EventChannelAllocate\r
    XenBusEventChannelNotify,       // XenBusIo.EventChannelNotify\r
    XenBusEventChannelClose,        // XenBusIo.EventChannelClose\r
    XenBusRegisterWatch,            // XenBusIo.RegisterWatch\r
    XenBusRegisterWatchBackend,     // XenBusIo.RegisterWatchBackend\r
    XenBusUnregisterWatch,          // XenBusIo.UnregisterWatch\r
    XenBusWaitForWatch,             // XenBusIo.WaitForWatch\r
\r
    NULL,                           // XenBusIo.Type\r
    0,                              // XenBusIo.DeviceId\r
    NULL,                           // XenBusIo.Node\r
    NULL,                           // XenBusIo.Backend\r
  },\r
\r
  NULL,                             // Dev\r
  NULL                              // DevicePath\r
};\r