2 // Copyright (c) 2011-2014, ARM Limited. All rights reserved.
4 // SPDX-License-Identifier: BSD-2-Clause-Patent
8 #include <AsmMacroIoLibV8.h>
10 ASM_FUNC(_ModuleEntryPoint)
11 // Do early platform specific actions
12 bl ASM_PFX(ArmPlatformPeiBootAction)
14 // NOTE: We could be booting from EL3, EL2 or EL1. Need to correctly detect
15 // and configure the system accordingly. EL2 is default if possible.
16 // If we started in EL3 we need to switch and run at EL2.
17 // If we are running at EL2 stay in EL2
18 // If we are starting at EL1 stay in EL1.
20 // If started at EL3 Sec is run and switches to EL2 before jumping to PEI.
21 // If started at EL1 or EL2 Sec jumps directly to PEI without making any
24 // Which EL are we running at? Every EL needs some level of setup...
25 // We should not run this code in EL3
27 1:bl ASM_PFX(SetupExceptionLevel1)
28 b ASM_PFX(MainEntryPoint)
29 2:bl ASM_PFX(SetupExceptionLevel2)
30 b ASM_PFX(MainEntryPoint)
32 ASM_PFX(MainEntryPoint):
34 bl ASM_PFX(ArmReadMpidr)
35 // Keep a copy of the MpId register value
38 // Is it the Primary Core ?
39 bl ASM_PFX(ArmPlatformIsPrimaryCore)
41 // Get the top of the primary stacks (and the base of the secondary stacks)
42 MOV64 (x1, FixedPcdGet64(PcdCPUCoresStackBase) + FixedPcdGet32(PcdCPUCorePrimaryStackSize))
44 // x0 is equal to 1 if I am the primary core
46 b.eq _SetupPrimaryCoreStack
48 _SetupSecondaryCoreStack:
49 // x1 contains the base of the secondary stacks
51 // Get the Core Position
52 mov x6, x1 // Save base of the secondary stacks
54 bl ASM_PFX(ArmPlatformGetCorePosition)
55 // The stack starts at the top of the stack region. Add '1' to the Core Position to get the top of the stack
58 // StackOffset = CorePos * StackSize
59 MOV32 (x2, FixedPcdGet32(PcdCPUCoreSecondaryStackSize))
61 // SP = StackBase + StackOffset
65 // The PEI Core Entry Point has been computed by GenFV and stored in the second entry of the Reset Vector
66 MOV64 (x2, FixedPcdGet64(PcdFvBaseAddress))
69 // Move sec startup address into a data register
70 // Ensure we're jumping to FV version of the code (not boot remapped alias)
71 ldr x3, =ASM_PFX(CEntryPoint)
73 // Set the frame pointer to NULL so any backtraces terminate here
76 // Jump to PrePeiCore C code
78 // x1 = pei_core_address
82 _SetupPrimaryCoreStack:
84 MOV64 (x8, FixedPcdGet64 (PcdCPUCoresStackBase))
85 MOV64 (x9, FixedPcdGet32 (PcdInitValueInTempStack) |\
86 FixedPcdGet32 (PcdInitValueInTempStack) << 32)
87 0:stp x9, x9, [x8], #16