ArmPkg/Drivers/CpuPei/CpuPei.c

   1 /**@file
   2
   3 Copyright (c) 2006, Intel Corporation. All rights reserved.<BR>
   4 Copyright (c) 2011 Hewlett Packard Corporation. All rights reserved.<BR>
   5 Copyright (c) 2011, ARM Limited. All rights reserved.<BR>
   6
   7 This program and the accompanying materials
   8 are licensed and made available under the terms and conditions of the BSD License
   9 which accompanies this distribution.  The full text of the license may be found at
  10 http://opensource.org/licenses/bsd-license.php
  11
  12 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
  13 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  14
  15 Module Name:
  16
  17   MemoryInit.c
  18
  19 Abstract:
  20
  21   PEIM to provide fake memory init
  22
  23 **/
  24
  25
  26
  27 //
  28 // The package level header files this module uses
  29 //
  30 #include <PiPei.h>
  31 //
  32 // The protocols, PPI and GUID defintions for this module
  33 //
  34 #include <Ppi/ArmMpCoreInfo.h>
  35
  36 //
  37 // The Library classes this module consumes
  38 //
  39 #include <Library/DebugLib.h>
  40 #include <Library/PeimEntryPoint.h>
  41 #include <Library/PeiServicesLib.h>
  42 #include <Library/PcdLib.h>
  43 #include <Library/HobLib.h>
  44 #include <Library/ArmLib.h>
  45
  46 //
  47 // Module globals
  48 //
  49
  50 #define DDR_ATTRIBUTES_CACHED                ARM_MEMORY_REGION_ATTRIBUTE_WRITE_BACK
  51 #define DDR_ATTRIBUTES_UNCACHED              ARM_MEMORY_REGION_ATTRIBUTE_UNCACHED_UNBUFFERED
  52
  53 EFI_STATUS
  54 FindMainMemory (
  55   OUT UINT32    *PhysicalBase,
  56   OUT UINT32    *Length
  57   )
  58 {
  59   EFI_PEI_HOB_POINTERS      NextHob;
  60
  61   // Look at the resource descriptor hobs, choose the first system memory one
  62   NextHob.Raw = GetHobList ();
  63   while ((NextHob.Raw = GetNextHob (EFI_HOB_TYPE_RESOURCE_DESCRIPTOR, NextHob.Raw)) != NULL) {
  64     if(NextHob.ResourceDescriptor->ResourceType == EFI_RESOURCE_SYSTEM_MEMORY)
  65     {
  66       *PhysicalBase = (UINT32)NextHob.ResourceDescriptor->PhysicalStart;
  67       *Length = (UINT32)NextHob.ResourceDescriptor->ResourceLength;
  68       return EFI_SUCCESS;
  69     }
  70
  71     NextHob.Raw = GET_NEXT_HOB (NextHob);
  72   }
  73
  74   return EFI_NOT_FOUND;
  75 }
  76
  77 VOID
  78 ConfigureMmu (
  79   VOID
  80   )
  81 {
  82   EFI_STATUS                    Status;
  83   UINTN                         Idx;
  84   UINT32                        CacheAttributes;
  85   UINT32                        SystemMemoryBase;
  86   UINT32                        SystemMemoryLength;
  87   UINT32                        SystemMemoryLastAddress;
  88   ARM_MEMORY_REGION_DESCRIPTOR  MemoryTable[4];
  89   VOID                          *TranslationTableBase;
  90   UINTN                         TranslationTableSize;
  91
  92   if (FeaturePcdGet(PcdCacheEnable) == TRUE) {
  93     CacheAttributes = DDR_ATTRIBUTES_CACHED;
  94   } else {
  95     CacheAttributes = DDR_ATTRIBUTES_UNCACHED;
  96   }
  97
  98   Idx = 0;
  99
 100   // Main Memory
 101   Status = FindMainMemory (&SystemMemoryBase, &SystemMemoryLength);
 102   ASSERT_EFI_ERROR (Status);
 103
 104   SystemMemoryLastAddress = SystemMemoryBase + (SystemMemoryLength-1);
 105
 106   // If system memory does not begin at 0
 107   if(SystemMemoryBase > 0) {
 108     MemoryTable[Idx].PhysicalBase = 0;
 109     MemoryTable[Idx].VirtualBase  = 0;
 110     MemoryTable[Idx].Length       = SystemMemoryBase;
 111     MemoryTable[Idx].Attributes   = ARM_MEMORY_REGION_ATTRIBUTE_DEVICE;
 112     Idx++;
 113   }
 114
 115   MemoryTable[Idx].PhysicalBase = SystemMemoryBase;
 116   MemoryTable[Idx].VirtualBase  = SystemMemoryBase;
 117   MemoryTable[Idx].Length       = SystemMemoryLength;
 118   MemoryTable[Idx].Attributes   = (ARM_MEMORY_REGION_ATTRIBUTES)CacheAttributes;
 119   Idx++;
 120
 121   // If system memory does not go to the last address (0xFFFFFFFF)
 122   if( SystemMemoryLastAddress < MAX_ADDRESS ) {
 123     MemoryTable[Idx].PhysicalBase = SystemMemoryLastAddress + 1;
 124     MemoryTable[Idx].VirtualBase  = MemoryTable[Idx].PhysicalBase;
 125     MemoryTable[Idx].Length       = MAX_ADDRESS - MemoryTable[Idx].PhysicalBase + 1;
 126     MemoryTable[Idx].Attributes   = ARM_MEMORY_REGION_ATTRIBUTE_DEVICE;
 127     Idx++;
 128   }
 129
 130   // End of Table
 131   MemoryTable[Idx].PhysicalBase = 0;
 132   MemoryTable[Idx].VirtualBase  = 0;
 133   MemoryTable[Idx].Length       = 0;
 134   MemoryTable[Idx].Attributes   = (ARM_MEMORY_REGION_ATTRIBUTES)0;
 135
 136   DEBUG ((EFI_D_INFO, "Enabling MMU, setting 0x%08x + %d MB to %a\n",
 137     SystemMemoryBase, SystemMemoryLength/1024/1024,
 138     (CacheAttributes == DDR_ATTRIBUTES_CACHED) ? "cacheable" : "uncacheable"));
 139
 140   ArmConfigureMmu (MemoryTable, &TranslationTableBase, &TranslationTableSize);
 141
 142   BuildMemoryAllocationHob((EFI_PHYSICAL_ADDRESS)(UINTN)TranslationTableBase, TranslationTableSize, EfiBootServicesData);
 143 }
 144
 145 /*++
 146
 147 Routine Description:
 148
 149
 150
 151 Arguments:
 152
 153   FileHandle  - Handle of the file being invoked.
 154   PeiServices - Describes the list of possible PEI Services.
 155
 156 Returns:
 157
 158   Status -  EFI_SUCCESS if the boot mode could be set
 159
 160 --*/
 161 EFI_STATUS
 162 EFIAPI
 163 InitializeCpuPeim (
 164   IN       EFI_PEI_FILE_HANDLE  FileHandle,
 165   IN CONST EFI_PEI_SERVICES     **PeiServices
 166   )
 167 {
 168   EFI_STATUS              Status;
 169   ARM_MP_CORE_INFO_PPI    *ArmMpCoreInfoPpi;
 170   UINTN                   ArmCoreCount;
 171   ARM_CORE_INFO           *ArmCoreInfoTable;
 172
 173   // Enable program flow prediction, if supported.
 174   ArmEnableBranchPrediction ();
 175
 176   // Publish the CPU memory and io spaces sizes
 177   BuildCpuHob (PcdGet8 (PcdPrePiCpuMemorySize), PcdGet8 (PcdPrePiCpuIoSize));
 178
 179   //ConfigureMmu();
 180
 181   // Only MP Core platform need to produce gArmMpCoreInfoPpiGuid
 182   Status = PeiServicesLocatePpi (&gArmMpCoreInfoPpiGuid, 0, NULL, (VOID**)&ArmMpCoreInfoPpi);
 183   if (!EFI_ERROR(Status)) {
 184     // Build the MP Core Info Table
 185     ArmCoreCount = 0;
 186     Status = ArmMpCoreInfoPpi->GetMpCoreInfo (&ArmCoreCount, &ArmCoreInfoTable);
 187     if (!EFI_ERROR(Status) && (ArmCoreCount > 0)) {
 188       // Build MPCore Info HOB
 189       BuildGuidDataHob (&gArmMpCoreInfoGuid, ArmCoreInfoTable, sizeof (ARM_CORE_INFO) * ArmCoreCount);
 190     }
 191   }
 192
 193   return EFI_SUCCESS;
 194 }