Add MP support. Based on PcdEmuApCount APs (Application Processors) are created in...

[mirror_edk2.git] / InOsEmuPkg / Library / DxeEmuLib / DxeEmuLib.c

/*++ @file\r
\r
Copyright (c) 2006 - 2008, Intel Corporation. All rights reserved.<BR>\r
Portions copyright (c) 2011, Apple Inc. All rights reserved. \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 <PiDxe.h>\r
\r
#include <Library/DebugLib.h>\r
#include <Library/HobLib.h>\r
#include <Library/EmuThunkLib.h>\r
#include <Library/BaseMemoryLib.h>\r
\r
EMU_THUNK_PROTOCOL   *gEmuThunk = NULL;\r
\r
\r
/**\r
  The constructor function caches the pointer of EMU Thunk protocol.\r
\r
  @param  ImageHandle   The firmware allocated handle for the EFI image.\r
  @param  SystemTable   A pointer to the EFI System Table.\r
\r
  @retval EFI_SUCCESS   The constructor always returns EFI_SUCCESS.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
DxeEmuLibConstructor (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
{\r
  EFI_HOB_GUID_TYPE        *GuidHob;\r
\r
  GuidHob = GetFirstGuidHob (&gEmuThunkProtocolGuid);\r
  ASSERT (GuidHob != NULL);\r
  \r
  gEmuThunk = (EMU_THUNK_PROTOCOL *)(*(UINTN *)(GET_GUID_HOB_DATA (GuidHob)));\r
  ASSERT (gEmuThunk != NULL);\r
  \r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Serach the EMU IO Thunk database for a matching EMU IO Thunk \r
  Protocol instance.\r
\r
  @param  Protocol   Protocol to search for.\r
  @param  Instance   Instance of protocol to search for.\r
\r
  @retval NULL       Protocol and Instance not found.\r
  @retval other      EMU IO Thunk protocol that matched.\r
\r
**/\r
EMU_IO_THUNK_PROTOCOL *\r
EFIAPI\r
GetIoThunkInstance (\r
  IN  EFI_GUID  *Protocol,\r
  IN  UINTN     Instance\r
  )\r
{\r
  EFI_STATUS              Status;\r
  EMU_IO_THUNK_PROTOCOL   *EmuIoThunk;\r
  \r
  for (Status = EFI_SUCCESS, EmuIoThunk = NULL; !EFI_ERROR (Status); ) {\r
    Status = gEmuThunk->GetNextProtocol (FALSE, &EmuIoThunk);\r
    if (EFI_ERROR (Status)) {\r
      break;\r
    }\r
  \r
    if (EmuIoThunk->Instance == Instance) {\r
      if (CompareGuid (EmuIoThunk->Protocol, Protocol)) {\r
        return EmuIoThunk;\r
      }\r
    }\r
  }\r
  \r
  return NULL;\r
}