Missed a fix in the Cpu Driver. Added some more debug for Execption handling and...

[mirror_edk2.git] / BeagleBoardPkg / Sec / Sec.c

/** @file\r
  C Entry point for the SEC. First C code after the reset vector.\r
\r
  Copyright (c) 2008-2009, Apple Inc. All rights reserved.\r
  \r
  All rights reserved. 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 <Library/DebugLib.h>\r
#include <Library/PrePiLib.h>\r
#include <Library/PcdLib.h>\r
#include <Library/IoLib.h>\r
#include <Library/OmapLib.h>\r
#include <Library/ArmLib.h>\r
#include <Library/PeCoffGetEntryPointLib.h>\r
\r
#include <Ppi/GuidedSectionExtraction.h>\r
\r
#include <Omap3530/Omap3530.h>\r
\r
VOID\r
EFIAPI \r
_ModuleEntryPoint(\r
  VOID\r
  );\r
\r
CHAR8 *\r
DeCygwinPathIfNeeded (\r
  IN  CHAR8   *Name\r
  );\r
\r
VOID\r
PadConfiguration (\r
  VOID\r
  );\r
\r
VOID\r
ClockInit (\r
  VOID\r
  );\r
\r
VOID\r
TimerInit (\r
  VOID\r
  )\r
{\r
  UINTN  Timer            = FixedPcdGet32(PcdBeagleFreeTimer);\r
  UINT32 TimerBaseAddress = TimerBase(Timer);\r
\r
  // Set source clock for GPT3 & GPT4 to SYS_CLK\r
  MmioOr32(CM_CLKSEL_PER, CM_CLKSEL_PER_CLKSEL_GPT3_SYS \r
                          | CM_CLKSEL_PER_CLKSEL_GPT4_SYS);\r
\r
  // Set count & reload registers\r
  MmioWrite32(TimerBaseAddress + GPTIMER_TCRR, 0x00000000);\r
  MmioWrite32(TimerBaseAddress + GPTIMER_TLDR, 0x00000000);\r
\r
  // Disable interrupts\r
  MmioWrite32(TimerBaseAddress + GPTIMER_TIER, TIER_TCAR_IT_DISABLE | TIER_OVF_IT_DISABLE | TIER_MAT_IT_DISABLE);\r
\r
  // Start Timer\r
  MmioWrite32(TimerBaseAddress + GPTIMER_TCLR, TCLR_AR_AUTORELOAD | TCLR_ST_ON);\r
\r
  //Disable OMAP Watchdog timer (WDT2)\r
  MmioWrite32(WDTIMER2_BASE + WSPR, 0xAAAA);\r
  DEBUG ((EFI_D_ERROR, "Magic delay to disable watchdog timers properly.\n"));\r
  MmioWrite32(WDTIMER2_BASE + WSPR, 0x5555);\r
}\r
\r
VOID\r
UartInit (\r
  VOID\r
  )\r
{\r
  UINTN   Uart            = FixedPcdGet32(PcdBeagleConsoleUart);\r
  UINT32  UartBaseAddress = UartBase(Uart);\r
\r
  // Set MODE_SELECT=DISABLE before trying to initialize or modify DLL, DLH registers.\r
  MmioWrite32(UartBaseAddress + UART_MDR1_REG, UART_MDR1_MODE_SELECT_DISABLE);\r
\r
  // Put device in configuration mode.\r
  MmioWrite32(UartBaseAddress + UART_LCR_REG, UART_LCR_DIV_EN_ENABLE);\r
\r
  // Programmable divisor N = 48Mhz/16/115200 = 26\r
  MmioWrite32(UartBaseAddress + UART_DLL_REG, 26); // low divisor\r
  MmioWrite32(UartBaseAddress + UART_DLH_REG,  0); // high divisor\r
\r
  // Enter into UART operational mode.\r
  MmioWrite32(UartBaseAddress + UART_LCR_REG, UART_LCR_DIV_EN_DISABLE | UART_LCR_CHAR_LENGTH_8);\r
\r
  // Force DTR and RTS output to active\r
  MmioWrite32(UartBaseAddress + UART_MCR_REG, UART_MCR_RTS_FORCE_ACTIVE | UART_MCR_DTR_FORCE_ACTIVE);\r
\r
  // Clear & enable fifos\r
  MmioWrite32(UartBaseAddress + UART_FCR_REG, UART_FCR_TX_FIFO_CLEAR | UART_FCR_RX_FIFO_CLEAR | UART_FCR_FIFO_ENABLE);  \r
\r
  // Restore MODE_SELECT \r
  MmioWrite32(UartBaseAddress + UART_MDR1_REG, UART_MDR1_MODE_SELECT_UART_16X);\r
}\r
\r
VOID\r
InitCache (\r
  IN  UINT32  MemoryBase,\r
  IN  UINT32  MemoryLength\r
  );\r
\r
EFI_STATUS\r
EFIAPI\r
ExtractGuidedSectionLibConstructor (\r
  VOID\r
  );\r
\r
EFI_STATUS\r
EFIAPI\r
LzmaDecompressLibConstructor (\r
  VOID\r
  );\r
\r
/**\r
  If the build is done on cygwin the paths are cygpaths. \r
  /cygdrive/c/tmp.txt vs c:\tmp.txt so we need to convert\r
  them to work with RVD commands\r
\r
  This is just code to help print out RVD symbol load command.\r
  If you build with cygwin paths aren't compatible with RVD.\r
\r
  @param  Name  Path to convert if needed\r
\r
**/\r
CHAR8 *\r
SecDeCygwinPathIfNeeded (\r
  IN  CHAR8   *Name\r
  )\r
{\r
  CHAR8   *Ptr;\r
  UINTN   Index;\r
  UINTN   Len;\r
  \r
  Ptr = AsciiStrStr (Name, "/cygdrive/");\r
  if (Ptr == NULL) {\r
    return Name;\r
  }\r
  \r
  Len = AsciiStrLen (Ptr);\r
  \r
  // convert "/cygdrive" to spaces\r
  for (Index = 0; Index < 9; Index++) {\r
    Ptr[Index] = ' ';\r
  }\r
\r
  // convert /c to c:\r
  Ptr[9]  = Ptr[10];\r
  Ptr[10] = ':';\r
  \r
  // switch path seperators\r
  for (Index = 11; Index < Len; Index++) {\r
    if (Ptr[Index] == '/') {\r
      Ptr[Index] = '\\' ;\r
    }\r
  }\r
\r
  return Name;\r
}\r
\r
\r
VOID\r
CEntryPoint (\r
  IN  VOID  *MemoryBase,\r
  IN  UINTN MemorySize,\r
  IN  VOID  *StackBase,\r
  IN  UINTN StackSize\r
  )\r
{\r
  VOID *HobBase;\r
\r
  //Set up Pin muxing.\r
  PadConfiguration();\r
\r
  // Set up system clocking\r
  ClockInit();\r
\r
  // Build a basic HOB list\r
  HobBase      = (VOID *)(UINTN)(FixedPcdGet32(PcdEmbeddedFdBaseAddress) + FixedPcdGet32(PcdEmbeddedFdSize));\r
  CreateHobList(MemoryBase, MemorySize, HobBase, StackBase);\r
\r
  // Enable program flow prediction, if supported.\r
  ArmEnableBranchPrediction();\r
\r
  // Initialize CPU cache\r
  InitCache((UINT32)MemoryBase, (UINT32)MemorySize);\r
\r
  // Add memory allocation hob for relocated FD\r
  BuildMemoryAllocationHob(FixedPcdGet32(PcdEmbeddedFdBaseAddress), FixedPcdGet32(PcdEmbeddedFdSize), EfiBootServicesData);\r
\r
  // Add the FVs to the hob list\r
  BuildFvHob(PcdGet32(PcdFlashFvMainBase), PcdGet32(PcdFlashFvMainSize));\r
\r
  // Start talking\r
  UartInit();\r
  DEBUG((EFI_D_ERROR, "UART Enabled\n"));\r
\r
  DEBUG_CODE_BEGIN ();\r
    //\r
    // On a debug build print out information about the SEC. This is really info about\r
    // the PE/COFF file we are currently running from. Useful for loading symbols in a\r
    // debugger. Remember our image is really part of the FV.\r
    //\r
    RETURN_STATUS       Status;\r
    EFI_PEI_FV_HANDLE   VolumeHandle;\r
    EFI_PEI_FILE_HANDLE FileHandle;\r
    VOID                *PeCoffImage;\r
    UINT32              Offset;\r
    CHAR8               *FilePath;\r

    FfsAnyFvFindFirstFile (EFI_FV_FILETYPE_SECURITY_CORE, &VolumeHandle, &FileHandle);
    Status = FfsFindSectionData (EFI_SECTION_TE, FileHandle, &PeCoffImage);
    if (EFI_ERROR (Status)) {
      // Usually is a TE (PI striped down PE/COFF), but could be a full PE/COFF
      Status = FfsFindSectionData (EFI_SECTION_PE32, FileHandle, &PeCoffImage);
    }
    if (!EFI_ERROR (Status)) {
      Offset = PeCoffGetSizeOfHeaders (PeCoffImage);\r
      FilePath = PeCoffLoaderGetPdbPointer (PeCoffImage);
      if (FilePath != NULL) {
      
        // 
        // In general you should never have to use #ifdef __CC_ARM in the code. It
        // is hidden in the away in the MdePkg. But here we would like to print differnt things
        // for different toolchains. 
        //
#ifdef __CC_ARM
        // Print out the command for the RVD debugger to load symbols for this image
        DEBUG ((EFI_D_ERROR, "load /a /ni /np %a &0x%08x\n", SecDeCygwinPathIfNeeded (FilePath), PeCoffImage + Offset));
#elif __GNUC__\r
        // This may not work correctly if you generate PE/COFF directlyas then the Offset would not be required
        DEBUG ((EFI_D_ERROR, "add-symbol-file %a 0x%08x\n", FilePath, PeCoffImage + Offset));
#else\r
        DEBUG ((EFI_D_ERROR, "SEC starts at 0x%08x with an entry point at 0x%08x %a\n", PeCoffImage, _ModuleEntryPoint, FilePath));
#endif\r
      }\r
    }

   DEBUG_CODE_END ();\r
\r
\r
\r
  // Start up a free running time so that the timer lib will work\r
  TimerInit();\r
\r
  // SEC phase needs to run library constructors by hand.\r
  ExtractGuidedSectionLibConstructor();\r
  LzmaDecompressLibConstructor();\r
\r
  // Load the DXE Core and transfer control to it\r
  LoadDxeCoreFromFv(NULL, 0);\r
  \r
  // DXE Core should always load and never return\r
  ASSERT(FALSE);\r
}\r
\r