Vlv2TbltDevicePkg/PpmPolicy: Fix call to MP Services Protocol

[mirror_edk2.git] / Vlv2TbltDevicePkg / PpmPolicy / PpmPolicy.c

/** \r
  Copyright (c) 2009 - 2019, Intel Corporation. All rights reserved.<BR>\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
\r
Module Name:\r
\r
\r
  PpmPolicy.c\r
\r
Abstract:\r
\r
  This file is a wrapper for Intel PPM Platform Policy driver.\r
  Get Setup Value to initilize Intel PPM DXE Platform Policy.\r
\r
--*/\r
#include "PpmPolicy.h"\r
#include <Protocol/MpService.h>\r
#include <Library/BaseLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/CpuIA32.h>\r
\r
#include <PchRegs.h>\r
#include <Library/PchPlatformLib.h>\r
\r
#define EFI_CPUID_FAMILY                      0x0F00\r
#define EFI_CPUID_MODEL                       0x00F0\r
#define EFI_CPUID_STEPPING                    0x000F\r
\r
EFI_STATUS \r
EFIAPI\r
PpmPolicyEntry(\r
  IN EFI_HANDLE ImageHandle,\r
  IN EFI_SYSTEM_TABLE *SystemTable\r
)\r
{\r
  EFI_BOOT_SERVICES        *pBS;\r
  EFI_MP_SERVICES_PROTOCOL *MpService;\r
  EFI_CPUID_REGISTER        Cpuid01 = { 0, 0, 0, 0};\r
  EFI_HANDLE                Handle;\r
  EFI_STATUS                Status;\r
  UINTN                     CpuCount;\r
  UINTN                     CpuEnabledCount;\r
  UINT8                     CPUMobileFeature;\r
\r
  PCH_STEPPING              Stepping;\r
\r
  pBS = SystemTable->BootServices;\r
\r
  //\r
  // Set PPM policy structure to known value\r
  //\r
  pBS->SetMem (&mDxePlatformPpmPolicy, sizeof(PPM_PLATFORM_POLICY_PROTOCOL), 0);\r
\r
  //\r
  // Find the MpService Protocol\r
  //\r
  Status = pBS->LocateProtocol (&gEfiMpServiceProtocolGuid,\r
                                NULL,\r
                                (void **)&MpService\r
                               );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  //\r
  // Get processor count from MP service.\r
  //\r
  Status = MpService->GetNumberOfProcessors (MpService, &CpuCount, &CpuEnabledCount);\r
  ASSERT_EFI_ERROR (Status);\r
\r
  //\r
  // Store the CPUID for use by SETUP items.\r
  //\r
  AsmCpuid (EFI_CPUID_VERSION_INFO, &Cpuid01.RegEax, &Cpuid01.RegEbx, &Cpuid01.RegEcx, &Cpuid01.RegEdx);\r
\r
  mDxePlatformPpmPolicy.Revision                       = PPM_PLATFORM_POLICY_PROTOCOL_REVISION_4;\r
\r
  //Read CPU Mobile feature from PLATFORM_ID_MSR MSR(0x17) NOTFB_I_AM_NOT_MOBILE_FUSE_CLIAMC00H Bit 28\r
  //Bit Description: { Disables Mobile features 0 = I am NOT a mobile part 1 = I am a mobile part (default)"}\r
  CPUMobileFeature = ((RShiftU64 (AsmReadMsr64(EFI_MSR_IA32_PLATFORM_ID), 28)) & 0x1);\r
\r
  if (!EFI_ERROR(Status)) {\r
    if (CPUMobileFeature == 1){//CPU mobile feature\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableGv       = ICH_DEVICE_ENABLE;\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableCx       = ICH_DEVICE_ENABLE;\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableCxe      = ICH_DEVICE_DISABLE;\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableTm       = ICH_DEVICE_ENABLE;\r
      //MaxC7\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableC7       = ICH_DEVICE_ENABLE;\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableC6       = ICH_DEVICE_ENABLE;\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableC4       = ICH_DEVICE_ENABLE;\r
       \r
      \r
    }else{//CPU desktop feature\r
       mDxePlatformPpmPolicy.FunctionEnables.EnableGv       = ICH_DEVICE_DISABLE;\r
       mDxePlatformPpmPolicy.FunctionEnables.EnableCx       = ICH_DEVICE_DISABLE;\r
       mDxePlatformPpmPolicy.FunctionEnables.EnableCxe      = ICH_DEVICE_DISABLE;\r
       mDxePlatformPpmPolicy.FunctionEnables.EnableTm       = ICH_DEVICE_DISABLE;\r
       mDxePlatformPpmPolicy.FunctionEnables.EnableC4       = ICH_DEVICE_DISABLE;\r
       mDxePlatformPpmPolicy.FunctionEnables.EnableC6       = ICH_DEVICE_DISABLE;\r
       mDxePlatformPpmPolicy.FunctionEnables.EnableC7       = ICH_DEVICE_DISABLE;\r
    }\r
\r
\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableProcHot  = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.TStatesEnable  = ICH_DEVICE_ENABLE;\r
\r
    \r
    Stepping = PchStepping();\r
    if (Stepping < PchB3) {\r
      // If SoC is B0~B2 Stepping, disable the Turbo\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableTurboMode= ICH_DEVICE_DISABLE;\r
    } else {\r
      mDxePlatformPpmPolicy.FunctionEnables.EnableTurboMode= ICH_DEVICE_ENABLE;\r
    }\r
    \r
    mDxePlatformPpmPolicy.FunctionEnables.EnableTm      = ICH_DEVICE_ENABLE;\r
\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableCMP      = ICH_DEVICE_ENABLE;\r
\r
  } else {\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableGv       = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableCx       = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableCxe      = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableTm      = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableProcHot  = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableCMP       = ICH_DEVICE_DISABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.TStatesEnable  = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableTurboMode= ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableC4       = ICH_DEVICE_ENABLE;\r
    mDxePlatformPpmPolicy.FunctionEnables.EnableC6       = ICH_DEVICE_ENABLE;\r
  }\r
\r
\r
\r
  mDxePlatformPpmPolicy.S3RestoreMsrSwSmiNumber                       = S3_RESTORE_MSR_SW_SMI;\r
\r
  Handle = NULL;\r
  Status = pBS->InstallMultipleProtocolInterfaces (\r
                                                  &Handle,\r
                                                  &gPpmPlatformPolicyProtocolGuid,\r
                                                  &mDxePlatformPpmPolicy,\r
                                                  NULL\r
                                                  );\r
\r
  ASSERT_EFI_ERROR (Status);\r
\r
  return EFI_SUCCESS;\r
}\r