2 * Main file supporting the transition to PEI Core in Normal World for Versatile Express
4 * Copyright (c) 2011, ARM Limited. All rights reserved.
6 * This program and the accompanying materials
7 * are licensed and made available under the terms and conditions of the BSD License
8 * which accompanies this distribution. The full text of the license may be found at
9 * http://opensource.org/licenses/bsd-license.php
11 * THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
16 #include <Library/BaseLib.h>
17 #include <Library/DebugAgentLib.h>
18 #include <Library/PrintLib.h>
19 #include <Library/ArmLib.h>
20 #include <Library/SerialPortLib.h>
22 #include <Ppi/ArmGlobalVariable.h>
23 #include <Chipset/ArmV7.h>
25 #include "PrePeiCore.h"
27 EFI_PEI_TEMPORARY_RAM_SUPPORT_PPI mTemporaryRamSupportPpi
= { PrePeiCoreTemporaryRamSupport
};
28 ARM_GLOBAL_VARIABLE_PPI mGlobalVariablePpi
= { PrePeiCoreGetGlobalVariableMemory
};
30 EFI_PEI_PPI_DESCRIPTOR gCommonPpiTable
[] = {
32 EFI_PEI_PPI_DESCRIPTOR_PPI
,
33 &gEfiTemporaryRamSupportPpiGuid
,
34 &mTemporaryRamSupportPpi
37 EFI_PEI_PPI_DESCRIPTOR_PPI
,
38 &gArmGlobalVariablePpiGuid
,
45 OUT UINTN
*PpiListSize
,
46 OUT EFI_PEI_PPI_DESCRIPTOR
**PpiList
49 EFI_PEI_PPI_DESCRIPTOR
*PlatformPpiList
;
50 UINTN PlatformPpiListSize
;
52 EFI_PEI_PPI_DESCRIPTOR
*LastPpi
;
54 // Get the Platform PPIs
55 PlatformPpiListSize
= 0;
56 ArmPlatformGetPlatformPpiList (&PlatformPpiListSize
, &PlatformPpiList
);
58 // Copy the Common and Platform PPis in Temporrary Memory
59 ListBase
= PcdGet32 (PcdCPUCoresStackBase
);
60 CopyMem ((VOID
*)ListBase
, gCommonPpiTable
, sizeof(gCommonPpiTable
));
61 CopyMem ((VOID
*)(ListBase
+ sizeof(gCommonPpiTable
)), PlatformPpiList
, PlatformPpiListSize
);
63 // Set the Terminate flag on the last PPI entry
64 LastPpi
= (EFI_PEI_PPI_DESCRIPTOR
*)ListBase
+ ((sizeof(gCommonPpiTable
) + PlatformPpiListSize
) / sizeof(EFI_PEI_PPI_DESCRIPTOR
)) - 1;
65 LastPpi
->Flags
|= EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST
;
67 *PpiList
= (EFI_PEI_PPI_DESCRIPTOR
*)ListBase
;
68 *PpiListSize
= sizeof(gCommonPpiTable
) + PlatformPpiListSize
;
74 IN EFI_PEI_CORE_ENTRY_POINT PeiCoreEntryPoint
78 ArmCleanInvalidateDataCache();
80 //Invalidate instruction cache
81 ArmInvalidateInstructionCache();
83 // Enable Instruction & Data caches
84 ArmEnableDataCache ();
85 ArmEnableInstructionCache ();
88 // Note: Doesn't have to Enable CPU interface in non-secure world,
89 // as Non-secure interface is already enabled in Secure world.
92 // Write VBAR - The Vector table must be 32-byte aligned
93 ASSERT(((UINT32
)PeiVectorTable
& ((1 << 5)-1)) == 0);
94 ArmWriteVBar((UINT32
)PeiVectorTable
);
96 //Note: The MMU will be enabled by MemoryPeim. Only the primary core will have the MMU on.
98 // If not primary Jump to Secondary Main
99 if (IS_PRIMARY_CORE(MpId
)) {
100 // Initialize the Debug Agent for Source Level Debugging
101 InitializeDebugAgent (DEBUG_AGENT_INIT_POSTMEM_SEC
, NULL
, NULL
);
102 SaveAndSetDebugTimerInterrupt (TRUE
);
104 // Goto primary Main.
105 PrimaryMain (PeiCoreEntryPoint
);
107 SecondaryMain (MpId
);
110 // PEI Core should always load and never return
116 PrePeiCoreTemporaryRamSupport (
117 IN CONST EFI_PEI_SERVICES
**PeiServices
,
118 IN EFI_PHYSICAL_ADDRESS TemporaryMemoryBase
,
119 IN EFI_PHYSICAL_ADDRESS PermanentMemoryBase
,
128 OldHeap
= (VOID
*)(UINTN
)TemporaryMemoryBase
;
129 NewHeap
= (VOID
*)((UINTN
)PermanentMemoryBase
+ (CopySize
>> 1));
131 OldStack
= (VOID
*)((UINTN
)TemporaryMemoryBase
+ (CopySize
>> 1));
132 NewStack
= (VOID
*)(UINTN
)PermanentMemoryBase
;
135 // Migrate the temporary memory stack to permanent memory stack.
137 CopyMem (NewStack
, OldStack
, CopySize
>> 1);
140 // Migrate the temporary memory heap to permanent memory heap.
142 CopyMem (NewHeap
, OldHeap
, CopySize
>> 1);
144 SecSwitchStack ((UINTN
)NewStack
- (UINTN
)OldStack
);
150 PrePeiCoreGetGlobalVariableMemory (
151 OUT EFI_PHYSICAL_ADDRESS
*GlobalVariableBase
154 ASSERT (GlobalVariableBase
!= NULL
);
156 *GlobalVariableBase
= (UINTN
)PcdGet32 (PcdCPUCoresStackBase
) +
157 (UINTN
)PcdGet32 (PcdCPUCorePrimaryStackSize
) -
158 (UINTN
)PcdGet32 (PcdPeiGlobalVariableSize
);
164 PeiCommonExceptionEntry (
174 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"Reset Exception at 0x%X\n\r",LR
);
177 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"Undefined Exception at 0x%X\n\r",LR
);
180 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"SWI Exception at 0x%X\n\r",LR
);
183 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"PrefetchAbort Exception at 0x%X\n\r",LR
);
186 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"DataAbort Exception at 0x%X\n\r",LR
);
189 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"Reserved Exception at 0x%X\n\r",LR
);
192 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"IRQ Exception at 0x%X\n\r",LR
);
195 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"FIQ Exception at 0x%X\n\r",LR
);
198 CharCount
= AsciiSPrint (Buffer
,sizeof (Buffer
),"Unknown Exception at 0x%X\n\r",LR
);
201 SerialPortWrite ((UINT8
*) Buffer
, CharCount
);