OvmfPkg: Apply uncrustify changes

[mirror_edk2.git] / OvmfPkg / SmmAccess / SmmAccessPei.c

/** @file\r
\r
  A PEIM with the following responsibilities:\r
\r
  - verify & configure the Q35 TSEG in the entry point,\r
  - provide SMRAM access by producing PEI_SMM_ACCESS_PPI,\r
  - set aside the SMM_S3_RESUME_STATE object at the bottom of TSEG, and expose\r
    it via the gEfiAcpiVariableGuid GUID HOB.\r
\r
  This PEIM runs from RAM, so we can write to variables with static storage\r
  duration.\r
\r
  Copyright (C) 2013, 2015, Red Hat, Inc.<BR>\r
  Copyright (c) 2010, Intel Corporation. All rights reserved.<BR>\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include <Guid/AcpiS3Context.h>\r
#include <Library/BaseLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/HobLib.h>\r
#include <Library/IoLib.h>\r
#include <Library/PcdLib.h>\r
#include <Library/PciLib.h>\r
#include <Library/PeiServicesLib.h>\r
#include <Ppi/SmmAccess.h>\r
\r
#include <OvmfPlatforms.h>\r
\r
#include "SmramInternal.h"\r
\r
//\r
// PEI_SMM_ACCESS_PPI implementation.\r
//\r
\r
/**\r
  Opens the SMRAM area to be accessible by a PEIM driver.\r
\r
  This function "opens" SMRAM so that it is visible while not inside of SMM.\r
  The function should return EFI_UNSUPPORTED if the hardware does not support\r
  hiding of SMRAM. The function should return EFI_DEVICE_ERROR if the SMRAM\r
  configuration is locked.\r
\r
  @param  PeiServices            General purpose services available to every\r
                                 PEIM.\r
  @param  This                   The pointer to the SMM Access Interface.\r
  @param  DescriptorIndex        The region of SMRAM to Open.\r
\r
  @retval EFI_SUCCESS            The region was successfully opened.\r
  @retval EFI_DEVICE_ERROR       The region could not be opened because locked\r
                                 by chipset.\r
  @retval EFI_INVALID_PARAMETER  The descriptor index was out of bounds.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
SmmAccessPeiOpen (\r
  IN EFI_PEI_SERVICES    **PeiServices,\r
  IN PEI_SMM_ACCESS_PPI  *This,\r
  IN UINTN               DescriptorIndex\r
  )\r
{\r
  if (DescriptorIndex >= DescIdxCount) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // According to current practice, DescriptorIndex is not considered at all,\r
  // beyond validating it.\r
  //\r
  return SmramAccessOpen (&This->LockState, &This->OpenState);\r
}\r
\r
/**\r
  Inhibits access to the SMRAM.\r
\r
  This function "closes" SMRAM so that it is not visible while outside of SMM.\r
  The function should return EFI_UNSUPPORTED if the hardware does not support\r
  hiding of SMRAM.\r
\r
  @param  PeiServices              General purpose services available to every\r
                                   PEIM.\r
  @param  This                     The pointer to the SMM Access Interface.\r
  @param  DescriptorIndex          The region of SMRAM to Close.\r
\r
  @retval EFI_SUCCESS              The region was successfully closed.\r
  @retval EFI_DEVICE_ERROR         The region could not be closed because\r
                                   locked by chipset.\r
  @retval EFI_INVALID_PARAMETER    The descriptor index was out of bounds.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
SmmAccessPeiClose (\r
  IN EFI_PEI_SERVICES    **PeiServices,\r
  IN PEI_SMM_ACCESS_PPI  *This,\r
  IN UINTN               DescriptorIndex\r
  )\r
{\r
  if (DescriptorIndex >= DescIdxCount) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // According to current practice, DescriptorIndex is not considered at all,\r
  // beyond validating it.\r
  //\r
  return SmramAccessClose (&This->LockState, &This->OpenState);\r
}\r
\r
/**\r
  Inhibits access to the SMRAM.\r
\r
  This function prohibits access to the SMRAM region.  This function is usually\r
  implemented such that it is a write-once operation.\r
\r
  @param  PeiServices              General purpose services available to every\r
                                   PEIM.\r
  @param  This                     The pointer to the SMM Access Interface.\r
  @param  DescriptorIndex          The region of SMRAM to Close.\r
\r
  @retval EFI_SUCCESS            The region was successfully locked.\r
  @retval EFI_DEVICE_ERROR       The region could not be locked because at\r
                                 least one range is still open.\r
  @retval EFI_INVALID_PARAMETER  The descriptor index was out of bounds.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
SmmAccessPeiLock (\r
  IN EFI_PEI_SERVICES    **PeiServices,\r
  IN PEI_SMM_ACCESS_PPI  *This,\r
  IN UINTN               DescriptorIndex\r
  )\r
{\r
  if (DescriptorIndex >= DescIdxCount) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // According to current practice, DescriptorIndex is not considered at all,\r
  // beyond validating it.\r
  //\r
  return SmramAccessLock (&This->LockState, &This->OpenState);\r
}\r
\r
/**\r
  Queries the memory controller for the possible regions that will support\r
  SMRAM.\r
\r
  @param  PeiServices           General purpose services available to every\r
                                PEIM.\r
  @param This                   The pointer to the SmmAccessPpi Interface.\r
  @param SmramMapSize           The pointer to the variable containing size of\r
                                the buffer to contain the description\r
                                information.\r
  @param SmramMap               The buffer containing the data describing the\r
                                Smram region descriptors.\r
\r
  @retval EFI_BUFFER_TOO_SMALL  The user did not provide a sufficient buffer.\r
  @retval EFI_SUCCESS           The user provided a sufficiently-sized buffer.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
EFIAPI\r
SmmAccessPeiGetCapabilities (\r
  IN EFI_PEI_SERVICES          **PeiServices,\r
  IN PEI_SMM_ACCESS_PPI        *This,\r
  IN OUT UINTN                 *SmramMapSize,\r
  IN OUT EFI_SMRAM_DESCRIPTOR  *SmramMap\r
  )\r
{\r
  return SmramAccessGetCapabilities (\r
           This->LockState,\r
           This->OpenState,\r
           SmramMapSize,\r
           SmramMap\r
           );\r
}\r
\r
//\r
// LockState and OpenState will be filled in by the entry point.\r
//\r
STATIC PEI_SMM_ACCESS_PPI  mAccess = {\r
  &SmmAccessPeiOpen,\r
  &SmmAccessPeiClose,\r
  &SmmAccessPeiLock,\r
  &SmmAccessPeiGetCapabilities\r
};\r
\r
STATIC EFI_PEI_PPI_DESCRIPTOR  mPpiList[] = {\r
  {\r
    EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST,\r
    &gPeiSmmAccessPpiGuid, &mAccess\r
  }\r
};\r
\r
//\r
// Utility functions.\r
//\r
STATIC\r
UINT8\r
CmosRead8 (\r
  IN UINT8  Index\r
  )\r
{\r
  IoWrite8 (0x70, Index);\r
  return IoRead8 (0x71);\r
}\r
\r
STATIC\r
UINT32\r
GetSystemMemorySizeBelow4gb (\r
  VOID\r
  )\r
{\r
  UINT32  Cmos0x34;\r
  UINT32  Cmos0x35;\r
\r
  Cmos0x34 = CmosRead8 (0x34);\r
  Cmos0x35 = CmosRead8 (0x35);\r
\r
  return ((Cmos0x35 << 8 | Cmos0x34) << 16) + SIZE_16MB;\r
}\r
\r
//\r
// Entry point of this driver.\r
//\r
EFI_STATUS\r
EFIAPI\r
SmmAccessPeiEntryPoint (\r
  IN       EFI_PEI_FILE_HANDLE  FileHandle,\r
  IN CONST EFI_PEI_SERVICES     **PeiServices\r
  )\r
{\r
  UINT16                HostBridgeDevId;\r
  UINT8                 EsmramcVal;\r
  UINT8                 RegMask8;\r
  UINT32                TopOfLowRam, TopOfLowRamMb;\r
  EFI_STATUS            Status;\r
  UINTN                 SmramMapSize;\r
  EFI_SMRAM_DESCRIPTOR  SmramMap[DescIdxCount];\r
  VOID                  *GuidHob;\r
\r
  //\r
  // This module should only be included if SMRAM support is required.\r
  //\r
  ASSERT (FeaturePcdGet (PcdSmmSmramRequire));\r
\r
  //\r
  // Verify if we're running on a Q35 machine type.\r
  //\r
  HostBridgeDevId = PciRead16 (OVMF_HOSTBRIDGE_DID);\r
  if (HostBridgeDevId != INTEL_Q35_MCH_DEVICE_ID) {\r
    DEBUG ((\r
      DEBUG_ERROR,\r
      "%a: no SMRAM with host bridge DID=0x%04x; only "\r
      "DID=0x%04x (Q35) is supported\n",\r
      __FUNCTION__,\r
      HostBridgeDevId,\r
      INTEL_Q35_MCH_DEVICE_ID\r
      ));\r
    goto WrongConfig;\r
  }\r
\r
  //\r
  // Confirm if QEMU supports SMRAM.\r
  //\r
  // With no support for it, the ESMRAMC (Extended System Management RAM\r
  // Control) register reads as zero. If there is support, the cache-enable\r
  // bits are hard-coded as 1 by QEMU.\r
  //\r
  EsmramcVal = PciRead8 (DRAMC_REGISTER_Q35 (MCH_ESMRAMC));\r
  RegMask8   = MCH_ESMRAMC_SM_CACHE | MCH_ESMRAMC_SM_L1 | MCH_ESMRAMC_SM_L2;\r
  if ((EsmramcVal & RegMask8) != RegMask8) {\r
    DEBUG ((\r
      DEBUG_ERROR,\r
      "%a: this Q35 implementation lacks SMRAM\n",\r
      __FUNCTION__\r
      ));\r
    goto WrongConfig;\r
  }\r
\r
  TopOfLowRam = GetSystemMemorySizeBelow4gb ();\r
  ASSERT ((TopOfLowRam & (SIZE_1MB - 1)) == 0);\r
  TopOfLowRamMb = TopOfLowRam >> 20;\r
\r
  //\r
  // Some of the following registers are no-ops for QEMU at the moment, but it\r
  // is recommended to set them correctly, since the ESMRAMC that we ultimately\r
  // care about is in the same set of registers.\r
  //\r
  // First, we disable the integrated VGA, and set both the GTT Graphics Memory\r
  // Size and the Graphics Mode Select memory pre-allocation fields to zero.\r
  // This takes just one write to the Graphics Control Register.\r
  //\r
  PciWrite16 (DRAMC_REGISTER_Q35 (MCH_GGC), MCH_GGC_IVD);\r
\r
  //\r
  // Set Top of Low Usable DRAM.\r
  //\r
  PciWrite16 (\r
    DRAMC_REGISTER_Q35 (MCH_TOLUD),\r
    (UINT16)(TopOfLowRamMb << MCH_TOLUD_MB_SHIFT)\r
    );\r
\r
  //\r
  // Given the zero graphics memory sizes configured above, set the\r
  // graphics-related stolen memory bases to the same as TOLUD.\r
  //\r
  PciWrite32 (\r
    DRAMC_REGISTER_Q35 (MCH_GBSM),\r
    TopOfLowRamMb << MCH_GBSM_MB_SHIFT\r
    );\r
  PciWrite32 (\r
    DRAMC_REGISTER_Q35 (MCH_BGSM),\r
    TopOfLowRamMb << MCH_BGSM_MB_SHIFT\r
    );\r
\r
  //\r
  // Set TSEG Memory Base.\r
  //\r
  InitQ35TsegMbytes ();\r
  PciWrite32 (\r
    DRAMC_REGISTER_Q35 (MCH_TSEGMB),\r
    (TopOfLowRamMb - mQ35TsegMbytes) << MCH_TSEGMB_MB_SHIFT\r
    );\r
\r
  //\r
  // Set TSEG size, and disable TSEG visibility outside of SMM. Note that the\r
  // T_EN bit has inverse meaning; when T_EN is set, then TSEG visibility is\r
  // *restricted* to SMM.\r
  //\r
  EsmramcVal &= ~(UINT32)MCH_ESMRAMC_TSEG_MASK;\r
  EsmramcVal |= mQ35TsegMbytes == 8 ? MCH_ESMRAMC_TSEG_8MB :\r
                mQ35TsegMbytes == 2 ? MCH_ESMRAMC_TSEG_2MB :\r
                mQ35TsegMbytes == 1 ? MCH_ESMRAMC_TSEG_1MB :\r
                MCH_ESMRAMC_TSEG_EXT;\r
  EsmramcVal |= MCH_ESMRAMC_T_EN;\r
  PciWrite8 (DRAMC_REGISTER_Q35 (MCH_ESMRAMC), EsmramcVal);\r
\r
  //\r
  // TSEG should be closed (see above), but unlocked, initially. Set G_SMRAME\r
  // (Global SMRAM Enable) too, as both D_LCK and T_EN depend on it.\r
  //\r
  PciAndThenOr8 (\r
    DRAMC_REGISTER_Q35 (MCH_SMRAM),\r
    (UINT8)((~(UINT32)MCH_SMRAM_D_LCK) & 0xff),\r
    MCH_SMRAM_G_SMRAME\r
    );\r
\r
  //\r
  // Create the GUID HOB and point it to the first SMRAM range.\r
  //\r
  GetStates (&mAccess.LockState, &mAccess.OpenState);\r
  SmramMapSize = sizeof SmramMap;\r
  Status       = SmramAccessGetCapabilities (\r
                   mAccess.LockState,\r
                   mAccess.OpenState,\r
                   &SmramMapSize,\r
                   SmramMap\r
                   );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  DEBUG_CODE_BEGIN ();\r
  {\r
    UINTN  Count;\r
    UINTN  Idx;\r
\r
    Count = SmramMapSize / sizeof SmramMap[0];\r
    DEBUG ((\r
      DEBUG_VERBOSE,\r
      "%a: SMRAM map follows, %d entries\n",\r
      __FUNCTION__,\r
      (INT32)Count\r
      ));\r
    DEBUG ((\r
      DEBUG_VERBOSE,\r
      "% 20a % 20a % 20a % 20a\n",\r
      "PhysicalStart(0x)",\r
      "PhysicalSize(0x)",\r
      "CpuStart(0x)",\r
      "RegionState(0x)"\r
      ));\r
    for (Idx = 0; Idx < Count; ++Idx) {\r
      DEBUG ((\r
        DEBUG_VERBOSE,\r
        "% 20Lx % 20Lx % 20Lx % 20Lx\n",\r
        SmramMap[Idx].PhysicalStart,\r
        SmramMap[Idx].PhysicalSize,\r
        SmramMap[Idx].CpuStart,\r
        SmramMap[Idx].RegionState\r
        ));\r
    }\r
  }\r
  DEBUG_CODE_END ();\r
\r
  GuidHob = BuildGuidHob (\r
              &gEfiAcpiVariableGuid,\r
              sizeof SmramMap[DescIdxSmmS3ResumeState]\r
              );\r
  if (GuidHob == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  CopyMem (\r
    GuidHob,\r
    &SmramMap[DescIdxSmmS3ResumeState],\r
    sizeof SmramMap[DescIdxSmmS3ResumeState]\r
    );\r
\r
  //\r
  // SmramAccessLock() depends on "mQ35SmramAtDefaultSmbase"; init the latter\r
  // just before exposing the former via PEI_SMM_ACCESS_PPI.Lock().\r
  //\r
  InitQ35SmramAtDefaultSmbase ();\r
\r
  //\r
  // We're done. The next step should succeed, but even if it fails, we can't\r
  // roll back the above BuildGuidHob() allocation, because PEI doesn't support\r
  // releasing memory.\r
  //\r
  return PeiServicesInstallPpi (mPpiList);\r
\r
WrongConfig:\r
  //\r
  // We really don't want to continue in this case.\r
  //\r
  ASSERT (FALSE);\r
  CpuDeadLoop ();\r
  return EFI_UNSUPPORTED;\r
}\r