Clean up code.

[mirror_edk2.git] / IntelFspPkg / FspSecCore / SecFsp.c

/** @file\r
\r
  Copyright (c) 2014, 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 "SecFsp.h"\r
\r
UINT32  FspImageSizeOffset = FSP_INFO_HEADER_OFF + OFFSET_IN_FSP_INFO_HEADER(ImageSize);\r
\r
/**\r
\r
  Calculate the FSP IDT gate descriptor.\r
\r
  @param[in] IdtEntryTemplate     IDT gate descriptor template.\r
\r
  @return                     FSP specific IDT gate descriptor.\r
\r
**/\r
UINT64\r
FspGetExceptionHandler(\r
  IN  UINT64  IdtEntryTemplate\r
  )\r
{\r
  UINT32                    Entry;\r
  UINT64                    ExceptionHandler;\r
  IA32_IDT_GATE_DESCRIPTOR *IdtGateDescriptor;\r
  FSP_INFO_HEADER          *FspInfoHeader;\r
\r
  FspInfoHeader     = (FSP_INFO_HEADER *)(GetFspBaseAddress() + FSP_INFO_HEADER_OFF);\r
  ExceptionHandler  = IdtEntryTemplate;\r
  IdtGateDescriptor = (IA32_IDT_GATE_DESCRIPTOR *)&ExceptionHandler;\r
  Entry = (IdtGateDescriptor->Bits.OffsetHigh << 16) | IdtGateDescriptor->Bits.OffsetLow;\r
  Entry = FspInfoHeader->ImageBase + FspInfoHeader->ImageSize - (~Entry + 1);\r
  IdtGateDescriptor->Bits.OffsetHigh = (UINT16)(Entry >> 16);\r
  IdtGateDescriptor->Bits.OffsetLow  = (UINT16)Entry;\r
\r
  return ExceptionHandler;\r
}\r
\r
/**\r
  This function gets the FSP UPD region offset in flash.\r
\r
  @return the offset of the UPD region.\r
\r
**/\r
UINT32\r
EFIAPI\r
GetFspUpdRegionOffset (\r
  VOID\r
  )\r
{\r
  FSP_GLOBAL_DATA                   *FspData;\r
  UINT32                            *Offset;\r
\r
  FspData       = GetFspGlobalDataPointer ();\r
\r
  //\r
  // It is required to put PcdUpdRegionOffset at offset 0x000C\r
  // for all FSPs.\r
  // gPlatformFspPkgTokenSpaceGuid.PcdUpdRegionOffset       | 0x000C | 0x12345678\r
  //\r
  Offset        = (UINT32 *)(FspData->FspInfoHeader->ImageBase + \\r
                             FspData->FspInfoHeader->CfgRegionOffset + 0x0C);\r
\r
  return  *Offset;\r
}\r
\r
/**\r
  This interface fills platform specific data.\r
\r
  @param[in,out]  FspData           Pointer to the FSP global data.\r
\r
**/\r
VOID\r
EFIAPI\r
SecGetPlatformData (\r
  IN OUT  FSP_GLOBAL_DATA    *FspData\r
  )\r
{\r
  FSP_PLAT_DATA    *FspPlatformData;\r
  UINT32            TopOfCar;\r
  UINT32           *StackPtr;\r
  UINT32            DwordSize;\r
\r
  FspPlatformData = &FspData->PlatformData;\r
\r
  //\r
  // The entries of platform information, together with the number of them,\r
  // reside in the bottom of stack, left untouched by normal stack operation.\r
  //\r
  TopOfCar = PcdGet32 (PcdTemporaryRamBase) + PcdGet32 (PcdTemporaryRamSize);\r
\r
  FspPlatformData->DataPtr   = NULL;\r
  FspPlatformData->CodeRegionSize      = 0;\r
  FspPlatformData->CodeRegionBase      = 0;\r
  FspPlatformData->MicorcodeRegionBase = 0;\r
  FspPlatformData->MicorcodeRegionSize = 0;\r
\r
  //\r
  // Pointer to the size field\r
  //\r
  StackPtr  = (UINT32 *)(TopOfCar - sizeof(UINT32));\r
\r
  while (*StackPtr != 0) {\r
    if (*(StackPtr - 1) == FSP_MCUD_SIGNATURE) {\r
      //\r
      // This following data was pushed onto stack after TempRamInit API\r
      //\r
      DwordSize = 4;\r
      StackPtr  = StackPtr - 1 - DwordSize;\r
      CopyMem (&(FspPlatformData->CodeRegionBase), StackPtr, (DwordSize << 2));\r
      StackPtr--;\r
    } else if (*(StackPtr - 1) == FSP_PER0_SIGNATURE) {\r
      //\r
      // This is the performance data for InitTempMemory API entry/exit\r
      //\r
      DwordSize = 4;\r
      StackPtr  = StackPtr - 1 - DwordSize;\r
      CopyMem (FspData->PerfData, StackPtr, (DwordSize << 2));\r
      ((UINT8 *)(&FspData->PerfData[0]))[7] = FSP_PERF_ID_API_TMPRAMINIT_ENTRY;\r
      ((UINT8 *)(&FspData->PerfData[1]))[7] = FSP_PERF_ID_API_TMPRAMINIT_EXIT;\r
      StackPtr--;\r
    } else {\r
      StackPtr -= (*StackPtr);\r
    }\r
  }\r
}\r
\r
/**\r
\r
  Initialize the FSP global data region.\r
  It needs to be done as soon as possible after the stack is setup.\r
\r
  @param[in,out] PeiFspData             Pointer of the FSP global data.\r
  @param[in]     BootFirmwareVolume     Point to the address of BootFirmwareVolume in stack.\r
\r
**/\r
VOID\r
FspGlobalDataInit (\r
  IN OUT  FSP_GLOBAL_DATA    *PeiFspData,\r
  IN      VOID              **BootFirmwareVolume\r
  )\r
{\r
  VOID              *UpdDataRgnPtr;\r
  FSP_INIT_PARAMS   *FspInitParams;\r
  CHAR8              ImageId[9];\r
  UINTN              Idx;\r
\r
  //\r
  // Init PCIE_BAR with value and set global FSP data pointer.\r
  // PciExpress Base should have been programmed by platform already.\r
  //\r
  SetFspGlobalDataPointer    (PeiFspData);\r
  ZeroMem  ((VOID *)PeiFspData, sizeof(FSP_GLOBAL_DATA));\r
\r
  PeiFspData->Signature          = FSP_GLOBAL_DATA_SIGNATURE;\r
  PeiFspData->CoreStack          = *(UINTN *)(BootFirmwareVolume + 2);\r
  PeiFspData->PerfIdx            = 2;\r
\r
  SetFspMeasurePoint (FSP_PERF_ID_API_FSPINIT_ENTRY);\r
\r
  //\r
  // Get FSP Header offset\r
  // It may have multiple FVs, so look into the last one for FSP header\r
  //\r
  PeiFspData->FspInfoHeader      = (FSP_INFO_HEADER *)(GetFspBaseAddress() + FSP_INFO_HEADER_OFF);\r
  SecGetPlatformData (PeiFspData);\r
\r
  //\r
  // Initialize UPD pointer.\r
  //\r
  FspInitParams = (FSP_INIT_PARAMS *)GetFspApiParameter ();\r
  UpdDataRgnPtr = ((FSP_INIT_RT_COMMON_BUFFER *)FspInitParams->RtBufferPtr)->UpdDataRgnPtr;\r
  if (UpdDataRgnPtr == NULL) {\r
    UpdDataRgnPtr = (VOID *)(PeiFspData->FspInfoHeader->ImageBase + GetFspUpdRegionOffset());\r
  }\r
  SetFspUpdDataPointer (UpdDataRgnPtr);\r
\r
  //\r
  // Initialize serial port\r
  // It might have been done in ProcessLibraryConstructorList(), however,\r
  // the FSP global data is not initialized at that time. So do it again\r
  // for safe.\r
  //\r
  SerialPortInitialize ();\r
\r
  //\r
  // Ensure the golbal data pointer is valid\r
  //\r
  ASSERT (GetFspGlobalDataPointer () == PeiFspData);\r
\r
  for (Idx = 0; Idx < 8; Idx++) {\r
    ImageId[Idx] = PeiFspData->FspInfoHeader->ImageId[Idx];\r
  }\r
  ImageId[Idx] = 0;\r
\r
  DEBUG ((DEBUG_INFO | DEBUG_INIT, "\n============= PEIM FSP  (%a 0x%08X) =============\n", \\r
         ImageId, PeiFspData->FspInfoHeader->ImageRevision));\r
\r
}\r
\r
/**\r
\r
  Adjust the FSP data pointers after the stack is migrated to memory.\r
\r
  @param[in] OffsetGap             The offset gap between the old stack and the new stack.\r
\r
**/\r
VOID\r
FspDataPointerFixUp (\r
  IN UINT32   OffsetGap\r
  )\r
{\r
  FSP_GLOBAL_DATA  *NewFspData;\r
\r
  NewFspData = (FSP_GLOBAL_DATA *)((UINTN)GetFspGlobalDataPointer() + (UINTN)OffsetGap);\r
  SetFspGlobalDataPointer (NewFspData);\r
}\r
\r
/**\r
  This function check the FSP API calling condition.\r
\r
  @param[in]  ApiIdx           Internal index of the FSP API.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
FspApiCallingCheck (\r
  UINT32   ApiIdx\r
  )\r
{\r
  EFI_STATUS       Status;\r
  FSP_GLOBAL_DATA *FspData;\r
\r
  Status = EFI_SUCCESS;\r
  FspData  = GetFspGlobalDataPointer ();\r
  if (ApiIdx == 1) {\r
    //\r
    // FspInit check\r
    //\r
    if ((UINT32)FspData != 0xFFFFFFFF) {\r
      Status = EFI_UNSUPPORTED;\r
    }\r
  } else if (ApiIdx == 2) {\r
    //\r
    // NotifyPhase check\r
    //\r
    if ((FspData == NULL) || ((UINT32)FspData == 0xFFFFFFFF)) {\r
      Status = EFI_UNSUPPORTED;\r
    } else {\r
      if (FspData->Signature != FSP_GLOBAL_DATA_SIGNATURE) {\r
        Status = EFI_UNSUPPORTED;\r
      }\r
    }\r
  } else {\r
    Status = EFI_UNSUPPORTED;\r
  }\r
\r
  return Status;\r
}\r