1 #------------------------------------------------------------------------------
3 # ARM VE Entry point. Reset vector in FV header will brach to
6 # Copyright (c) 2011, ARM Limited. All rights reserved.
8 # This program and the accompanying materials
9 # are licensed and made available under the terms and conditions of the BSD License
10 # which accompanies this distribution. The full text of the license may be found at
11 # http://opensource.org/licenses/bsd-license.php
13 # THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
14 # WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
16 #------------------------------------------------------------------------------
18 #include <AsmMacroIoLib.h>
20 #include <Library/PcdLib.h>
21 #include <Library/ArmPlatformLib.h>
24 #Start of Code section
28 #make _ModuleEntryPoint as global
29 GCC_ASM_EXPORT(_ModuleEntryPoint)
31 #global functions referenced by this module
32 GCC_ASM_IMPORT(CEntryPoint)
33 GCC_ASM_IMPORT(ArmPlatformSecBootAction)
34 GCC_ASM_IMPORT(ArmPlatformIsMemoryInitialized)
35 GCC_ASM_IMPORT(ArmPlatformInitializeBootMemory)
36 GCC_ASM_IMPORT(ArmDisableInterrupts)
37 GCC_ASM_IMPORT(ArmDisableCachesAndMmu)
38 GCC_ASM_IMPORT(ArmWriteVBar)
39 GCC_ASM_IMPORT(ArmReadMpidr)
40 GCC_ASM_IMPORT(SecVectorTable)
42 #if (FixedPcdGet32(PcdMPCoreSupport))
43 GCC_ASM_IMPORT(ArmIsScuEnable)
46 StartupAddr: .word ASM_PFX(CEntryPoint)
47 SecVectorTableAddr: .word ASM_PFX(SecVectorTable)
49 ASM_PFX(_ModuleEntryPoint):
50 # First ensure all interrupts are disabled
51 bl ASM_PFX(ArmDisableInterrupts)
53 # Ensure that the MMU and caches are off
54 bl ASM_PFX(ArmDisableCachesAndMmu)
56 # Jump to Platform Specific Boot Action function
57 blx ASM_PFX(ArmPlatformSecBootAction)
59 # Set VBAR to the start of the exception vectors in Secure Mode
60 ldr r0, =SecVectorTable
61 bl ASM_PFX(ArmWriteVBar)
65 bl ASM_PFX(ArmReadMpidr)
66 // Get ID of this CPU in Multicore system
67 LoadConstantToReg (FixedPcdGet32(PcdArmPrimaryCoreMask), r1)
70 #get ID of this CPU in Multicore system
71 LoadConstantToReg (FixedPcdGet32(PcdArmPrimaryCore), r1)
73 # Only the primary core initialize the memory (SMC)
76 #if (FixedPcdGet32(PcdMPCoreSupport))
77 # ... The secondary cores wait for SCU to be enabled
79 bl ASM_PFX(ArmIsScuEnable)
81 beq _WaitForEnabledScu
86 bl ASM_PFX(ArmPlatformIsMemoryInitialized)
89 # Initialize Init Memory
90 bl ASM_PFX(ArmPlatformInitializeBootMemory)
92 # Only Primary CPU could run this line (the secondary cores have jumped from _IdentifyCpu to _SetupStack)
96 # Setup Stack for the 4 CPU cores
97 #Read Stack Base address from PCD
98 LoadConstantToReg (FixedPcdGet32(PcdCPUCoresSecStackBase), r1)
100 #read Stack size from PCD
101 LoadConstantToReg (FixedPcdGet32(PcdCPUCoreSecStackSize), r2)
103 #calcuate Stack Pointer reg value using Stack size and CPU ID.
104 mov r3,r5 @ r3 = core_id
105 mul r3,r3,r2 @ r3 = core_id * stack_size = offset from the stack base
106 add r3,r3,r1 @ r3 ldr= stack_base + offset
109 # move sec startup address into a data register
110 # ensure we're jumping to FV version of the code (not boot remapped alias)
113 # Move the CoreId in r0 to be the first argument of the SEC Entry Point