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

[mirror_edk2.git] / UefiCpuPkg / Library / CpuCommonFeaturesLib / X2Apic.c

/** @file\r
  X2Apic feature.\r
\r
  Copyright (c) 2017, Intel Corporation. All rights reserved.<BR>\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "CpuCommonFeatures.h"\r
\r
/**\r
  Prepares for the data used by CPU feature detection and initialization.\r
\r
  @param[in]  NumberOfProcessors  The number of CPUs in the platform.\r
\r
  @return  Pointer to a buffer of CPU related configuration data.\r
\r
  @note This service could be called by BSP only.\r
**/\r
VOID *\r
EFIAPI\r
X2ApicGetConfigData (\r
  IN UINTN  NumberOfProcessors\r
  )\r
{\r
  BOOLEAN  *ConfigData;\r
\r
  ConfigData = AllocateZeroPool (sizeof (BOOLEAN) * NumberOfProcessors);\r
  ASSERT (ConfigData != NULL);\r
  return ConfigData;\r
}\r
\r
/**\r
  Detects if X2Apci feature supported on current processor.\r
\r
  Detect if X2Apci has been already enabled.\r
\r
  @param[in]  ProcessorNumber  The index of the CPU executing this function.\r
  @param[in]  CpuInfo          A pointer to the REGISTER_CPU_FEATURE_INFORMATION\r
                               structure for the CPU executing this function.\r
  @param[in]  ConfigData       A pointer to the configuration buffer returned\r
                               by CPU_FEATURE_GET_CONFIG_DATA.  NULL if\r
                               CPU_FEATURE_GET_CONFIG_DATA was not provided in\r
                               RegisterCpuFeature().\r
\r
  @retval TRUE     X2Apci feature is supported.\r
  @retval FALSE    X2Apci feature is not supported.\r
\r
  @note This service could be called by BSP/APs.\r
**/\r
BOOLEAN\r
EFIAPI\r
X2ApicSupport (\r
  IN UINTN                             ProcessorNumber,\r
  IN REGISTER_CPU_FEATURE_INFORMATION  *CpuInfo,\r
  IN VOID                              *ConfigData  OPTIONAL\r
  )\r
{\r
  BOOLEAN  *X2ApicEnabled;\r
\r
  ASSERT (ConfigData != NULL);\r
  X2ApicEnabled = (BOOLEAN *)ConfigData;\r
  //\r
  // *ConfigData indicates if X2APIC enabled on current processor\r
  //\r
  X2ApicEnabled[ProcessorNumber] = (GetApicMode () == LOCAL_APIC_MODE_X2APIC) ? TRUE : FALSE;\r
\r
  return (CpuInfo->CpuIdVersionInfoEcx.Bits.x2APIC == 1);\r
}\r
\r
/**\r
  Initializes X2Apci feature to specific state.\r
\r
  @param[in]  ProcessorNumber  The index of the CPU executing this function.\r
  @param[in]  CpuInfo          A pointer to the REGISTER_CPU_FEATURE_INFORMATION\r
                               structure for the CPU executing this function.\r
  @param[in]  ConfigData       A pointer to the configuration buffer returned\r
                               by CPU_FEATURE_GET_CONFIG_DATA.  NULL if\r
                               CPU_FEATURE_GET_CONFIG_DATA was not provided in\r
                               RegisterCpuFeature().\r
  @param[in]  State            If TRUE, then the X2Apci feature must be enabled.\r
                               If FALSE, then the X2Apci feature must be disabled.\r
\r
  @retval RETURN_SUCCESS       X2Apci feature is initialized.\r
\r
  @note This service could be called by BSP only.\r
**/\r
RETURN_STATUS\r
EFIAPI\r
X2ApicInitialize (\r
  IN UINTN                             ProcessorNumber,\r
  IN REGISTER_CPU_FEATURE_INFORMATION  *CpuInfo,\r
  IN VOID                              *ConfigData   OPTIONAL,\r
  IN BOOLEAN                           State\r
  )\r
{\r
  BOOLEAN  *X2ApicEnabled;\r
\r
  //\r
  // The scope of the MSR_IA32_APIC_BASE is core for below processor type, only program\r
  // MSR_IA32_APIC_BASE for thread 0 in each core.\r
  //\r
  if (IS_SILVERMONT_PROCESSOR (CpuInfo->DisplayFamily, CpuInfo->DisplayModel)) {\r
    if (CpuInfo->ProcessorInfo.Location.Thread != 0) {\r
      return RETURN_SUCCESS;\r
    }\r
  }\r
\r
  ASSERT (ConfigData != NULL);\r
  X2ApicEnabled = (BOOLEAN *)ConfigData;\r
  if (X2ApicEnabled[ProcessorNumber]) {\r
    PRE_SMM_CPU_REGISTER_TABLE_WRITE_FIELD (\r
      ProcessorNumber,\r
      Msr,\r
      MSR_IA32_APIC_BASE,\r
      MSR_IA32_APIC_BASE_REGISTER,\r
      Bits.EXTD,\r
      1\r
      );\r
  } else {\r
    //\r
    // Enable X2APIC mode only if X2APIC is not enabled,\r
    // Needn't to disabe X2APIC mode again if X2APIC is not enabled\r
    //\r
    if (State) {\r
      CPU_REGISTER_TABLE_WRITE_FIELD (\r
        ProcessorNumber,\r
        Msr,\r
        MSR_IA32_APIC_BASE,\r
        MSR_IA32_APIC_BASE_REGISTER,\r
        Bits.EXTD,\r
        1\r
        );\r
    }\r
  }\r
\r
  return RETURN_SUCCESS;\r
}\r