MdeModulePkg/FirmwarePerformancePei:Add FPDT records for S3 phase

[mirror_edk2.git] / MdeModulePkg / Universal / Acpi / FirmwarePerformanceDataTablePei / FirmwarePerformancePei.c

/** @file\r
  This module updates S3 Resume Performance Record in ACPI Firmware Performance\r
  Data Table in S3 resume boot mode.\r
\r
  This module register report status code listener to collect performance data\r
  for S3 Resume Performance Record on S3 resume boot path.\r
\r
  Copyright (c) 2011 - 2018, Intel Corporation. All rights reserved.<BR>\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 <PiPei.h>\r
\r
#include <Ppi/ReportStatusCodeHandler.h>\r
#include <Ppi/ReadOnlyVariable2.h>\r
\r
#include <Guid/FirmwarePerformance.h>\r
#include <Guid/Performance.h>\r
#include <Guid/ExtendedFirmwarePerformance.h>\r
\r
#include <Library/PeiServicesLib.h>\r
#include <Library/BaseLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/TimerLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/LockBoxLib.h>\r
#include <Library/PcdLib.h>\r
#include <Library/HobLib.h>\r
\r
/**\r
  Report status code listener for PEI. This is used to record the performance\r
  data for S3 FullResume in FPDT.\r
\r
  @param[in]  PeiServices         An indirect pointer to the EFI_PEI_SERVICES table published by the PEI Foundation.\r
  @param[in]  CodeType            Indicates the type of status code being reported.\r
  @param[in]  Value               Describes the current status of a hardware or software entity.\r
                                  This included information about the class and subclass that is used to\r
                                  classify the entity as well as an operation.\r
  @param[in]  Instance            The enumeration of a hardware or software entity within\r
                                  the system. Valid instance numbers start with 1.\r
  @param[in]  CallerId            This optional parameter may be used to identify the caller.\r
                                  This parameter allows the status code driver to apply different rules to\r
                                  different callers.\r
  @param[in]  Data                This optional parameter may be used to pass additional data.\r
\r
  @retval EFI_SUCCESS             Status code is what we expected.\r
  @retval EFI_UNSUPPORTED         Status code not supported.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
FpdtStatusCodeListenerPei (\r
  IN CONST  EFI_PEI_SERVICES        **PeiServices,\r
  IN        EFI_STATUS_CODE_TYPE    CodeType,\r
  IN        EFI_STATUS_CODE_VALUE   Value,\r
  IN        UINT32                  Instance,\r
  IN CONST  EFI_GUID                *CallerId,\r
  IN CONST  EFI_STATUS_CODE_DATA    *Data\r
  )\r
{\r
  EFI_STATUS                           Status;\r
  UINT64                               CurrentTime;\r
  UINTN                                VarSize;\r
  EFI_PHYSICAL_ADDRESS                 S3PerformanceTablePointer;\r
  S3_PERFORMANCE_TABLE                 *AcpiS3PerformanceTable;\r
  EFI_ACPI_5_0_FPDT_S3_RESUME_RECORD   *AcpiS3ResumeRecord;\r
  UINT64                               S3ResumeTotal;\r
  EFI_ACPI_5_0_FPDT_S3_SUSPEND_RECORD  S3SuspendRecord;\r
  EFI_ACPI_5_0_FPDT_S3_SUSPEND_RECORD  *AcpiS3SuspendRecord;\r
  EFI_PEI_READ_ONLY_VARIABLE2_PPI      *VariableServices;\r
  UINT8                                *BootPerformanceTable;\r
  FIRMWARE_PERFORMANCE_VARIABLE        PerformanceVariable;\r
  EFI_HOB_GUID_TYPE                    *GuidHob;\r
  FPDT_PEI_EXT_PERF_HEADER             *PeiPerformanceLogHeader;\r
  UINT8                                *FirmwarePerformanceData;\r
  UINT8                                *FirmwarePerformanceTablePtr;\r
\r
  //\r
  // Check whether status code is what we are interested in.\r
  //\r
  if (((CodeType & EFI_STATUS_CODE_TYPE_MASK) != EFI_PROGRESS_CODE) ||\r
      (Value != (EFI_SOFTWARE_PEI_MODULE | EFI_SW_PEI_PC_OS_WAKE))) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // Retrieve current time as early as possible.\r
  //\r
  CurrentTime = GetTimeInNanoSecond (GetPerformanceCounter ());\r
\r
  //\r
  // Update S3 Resume Performance Record.\r
  //\r
  S3PerformanceTablePointer = 0;\r
  VarSize = sizeof (EFI_PHYSICAL_ADDRESS);\r
  Status = RestoreLockBox (&gFirmwarePerformanceS3PointerGuid, &S3PerformanceTablePointer, &VarSize);\r
  ASSERT_EFI_ERROR (Status);\r
\r
  AcpiS3PerformanceTable = (S3_PERFORMANCE_TABLE *) (UINTN) S3PerformanceTablePointer;\r
  ASSERT (AcpiS3PerformanceTable != NULL);\r
  if (AcpiS3PerformanceTable->Header.Signature != EFI_ACPI_5_0_FPDT_S3_PERFORMANCE_TABLE_SIGNATURE) {\r
    DEBUG ((EFI_D_ERROR, "FPDT S3 performance data in ACPI memory get corrupted\n"));\r
    return EFI_ABORTED;\r
  }\r
  AcpiS3ResumeRecord = &AcpiS3PerformanceTable->S3Resume;\r
  AcpiS3ResumeRecord->FullResume = CurrentTime;\r
  //\r
  // Calculate average S3 resume time.\r
  //\r
  S3ResumeTotal = MultU64x32 (AcpiS3ResumeRecord->AverageResume, AcpiS3ResumeRecord->ResumeCount);\r
  AcpiS3ResumeRecord->ResumeCount++;\r
  AcpiS3ResumeRecord->AverageResume = DivU64x32 (S3ResumeTotal + AcpiS3ResumeRecord->FullResume, AcpiS3ResumeRecord->ResumeCount);\r
\r
  DEBUG ((EFI_D_INFO, "FPDT: S3 Resume Performance - ResumeCount   = %d\n", AcpiS3ResumeRecord->ResumeCount));\r
  DEBUG ((EFI_D_INFO, "FPDT: S3 Resume Performance - FullResume    = %ld\n", AcpiS3ResumeRecord->FullResume));\r
  DEBUG ((EFI_D_INFO, "FPDT: S3 Resume Performance - AverageResume = %ld\n", AcpiS3ResumeRecord->AverageResume));\r
\r
  //\r
  // Update S3 Suspend Performance Record.\r
  //\r
  AcpiS3SuspendRecord = &AcpiS3PerformanceTable->S3Suspend;\r
  VarSize = sizeof (EFI_ACPI_5_0_FPDT_S3_SUSPEND_RECORD);\r
  ZeroMem (&S3SuspendRecord, sizeof (EFI_ACPI_5_0_FPDT_S3_SUSPEND_RECORD));\r
  Status = RestoreLockBox (\r
             &gEfiFirmwarePerformanceGuid,\r
             &S3SuspendRecord,\r
             &VarSize\r
             );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  AcpiS3SuspendRecord->SuspendStart = S3SuspendRecord.SuspendStart;\r
  AcpiS3SuspendRecord->SuspendEnd   = S3SuspendRecord.SuspendEnd;\r
\r
  DEBUG ((EFI_D_INFO, "FPDT: S3 Suspend Performance - SuspendStart = %ld\n", AcpiS3SuspendRecord->SuspendStart));\r
  DEBUG ((EFI_D_INFO, "FPDT: S3 Suspend Performance - SuspendEnd   = %ld\n", AcpiS3SuspendRecord->SuspendEnd));\r
\r
  Status = PeiServicesLocatePpi (\r
             &gEfiPeiReadOnlyVariable2PpiGuid,\r
             0,\r
             NULL,\r
             (VOID **) &VariableServices\r
             );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  //\r
  // Update S3 boot records into the basic boot performance table.\r
  //\r
  VarSize = sizeof (PerformanceVariable);\r
  Status = VariableServices->GetVariable (\r
                               VariableServices,\r
                               EFI_FIRMWARE_PERFORMANCE_VARIABLE_NAME,\r
                               &gEfiFirmwarePerformanceGuid,\r
                               NULL,\r
                               &VarSize,\r
                               &PerformanceVariable\r
                               );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
  BootPerformanceTable = (UINT8*) (UINTN) PerformanceVariable.BootPerformanceTablePointer;\r
\r
  //\r
  // Dump PEI boot records\r
  //\r
  FirmwarePerformanceTablePtr = (BootPerformanceTable + sizeof (BOOT_PERFORMANCE_TABLE));\r
  GuidHob   = GetFirstGuidHob (&gEdkiiFpdtExtendedFirmwarePerformanceGuid);\r
  while (GuidHob != NULL) {\r
    FirmwarePerformanceData = GET_GUID_HOB_DATA (GuidHob);\r
    PeiPerformanceLogHeader = (FPDT_PEI_EXT_PERF_HEADER *) FirmwarePerformanceData;\r
\r
    CopyMem (FirmwarePerformanceTablePtr, FirmwarePerformanceData + sizeof (FPDT_PEI_EXT_PERF_HEADER), (UINTN)(PeiPerformanceLogHeader->SizeOfAllEntries));\r
\r
    GuidHob = GetNextGuidHob (&gEdkiiFpdtExtendedFirmwarePerformanceGuid, GET_NEXT_HOB (GuidHob));\r
\r
    FirmwarePerformanceTablePtr += (UINTN)(PeiPerformanceLogHeader->SizeOfAllEntries);\r
  }\r
\r
  //\r
  // Update Table length.\r
  //\r
  ((BOOT_PERFORMANCE_TABLE *) BootPerformanceTable)->Header.Length = (UINT32)((UINTN)FirmwarePerformanceTablePtr - (UINTN)BootPerformanceTable);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Main entry for Firmware Performance Data Table PEIM.\r
\r
  This routine is to register report status code listener for FPDT.\r
\r
  @param[in]  FileHandle              Handle of the file being invoked.\r
  @param[in]  PeiServices             Pointer to PEI Services table.\r
\r
  @retval EFI_SUCCESS Report status code listener is registered successfully.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
FirmwarePerformancePeiEntryPoint (\r
  IN       EFI_PEI_FILE_HANDLE  FileHandle,\r
  IN CONST EFI_PEI_SERVICES     **PeiServices\r
  )\r
{\r
  EFI_STATUS               Status;\r
  EFI_PEI_RSC_HANDLER_PPI  *RscHandler;\r
\r
  if (FeaturePcdGet (PcdFirmwarePerformanceDataTableS3Support)) {\r
    //\r
    // S3 resume - register status code listener for OS wake vector.\r
    //\r
    Status = PeiServicesLocatePpi (\r
               &gEfiPeiRscHandlerPpiGuid,\r
               0,\r
               NULL,\r
               (VOID **) &RscHandler\r
               );\r
    ASSERT_EFI_ERROR (Status);\r
\r
    Status = RscHandler->Register (FpdtStatusCodeListenerPei);\r
    ASSERT_EFI_ERROR (Status);\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r