ArmPlatformPkg: Move the Secure Monitor initialization into a separate 'ArmTrustedMon...
[mirror_edk2.git] / ArmPlatformPkg / Sec / Sec.c
1 /** @file
2 * Main file supporting the SEC Phase on ARM Platforms
3 *
4 * Copyright (c) 2011-2012, ARM Limited. All rights reserved.
5 *
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
10 *
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.
13 *
14 **/
15
16 #include <Library/ArmTrustedMonitorLib.h>
17 #include <Library/DebugAgentLib.h>
18 #include <Library/PrintLib.h>
19 #include <Library/BaseMemoryLib.h>
20 #include <Library/SerialPortLib.h>
21 #include <Library/ArmGicLib.h>
22 #include <Library/ArmCpuLib.h>
23
24 #include "SecInternal.h"
25
26 #define SerialPrint(txt) SerialPortWrite ((UINT8*)txt, AsciiStrLen(txt)+1);
27
28 VOID
29 CEntryPoint (
30 IN UINTN MpId
31 )
32 {
33 CHAR8 Buffer[100];
34 UINTN CharCount;
35 UINTN JumpAddress;
36
37 // Invalidate the data cache. Doesn't have to do the Data cache clean.
38 ArmInvalidateDataCache();
39
40 // Invalidate Instruction Cache
41 ArmInvalidateInstructionCache();
42
43 // Invalidate I & D TLBs
44 ArmInvalidateInstructionAndDataTlb();
45
46 // CPU specific settings
47 ArmCpuSetup (MpId);
48
49 // Enable Floating Point Coprocessor if supported by the platform
50 if (FixedPcdGet32 (PcdVFPEnabled)) {
51 ArmEnableVFP();
52 }
53
54 // Primary CPU clears out the SCU tag RAMs, secondaries wait
55 if (IS_PRIMARY_CORE(MpId)) {
56 if (ArmIsMpCore()) {
57 ArmCpuSynchronizeSignal (ARM_CPU_EVENT_BOOT_MEM_INIT);
58 }
59
60 // SEC phase needs to run library constructors by hand. This assumes we are linked against the SerialLib
61 // In non SEC modules the init call is in autogenerated code.
62 SerialPortInitialize ();
63
64 // Start talking
65 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"UEFI firmware built at %a on %a\n\r",__TIME__, __DATE__);
66 SerialPortWrite ((UINT8 *) Buffer, CharCount);
67
68 // Initialize the Debug Agent for Source Level Debugging
69 InitializeDebugAgent (DEBUG_AGENT_INIT_PREMEM_SEC, NULL, NULL);
70 SaveAndSetDebugTimerInterrupt (TRUE);
71
72 // Now we've got UART, make the check:
73 // - The Vector table must be 32-byte aligned
74 ASSERT(((UINT32)SecVectorTable & ((1 << 5)-1)) == 0);
75
76 // Enable the GIC distributor and CPU Interface
77 // - no other Interrupts are enabled, doesn't have to worry about the priority.
78 // - all the cores are in secure state, use secure SGI's
79 ArmGicEnableDistributor (PcdGet32(PcdGicDistributorBase));
80 ArmGicEnableInterruptInterface (PcdGet32(PcdGicInterruptInterfaceBase));
81 } else {
82 // Enable the GIC CPU Interface
83 ArmGicEnableInterruptInterface (PcdGet32(PcdGicInterruptInterfaceBase));
84 }
85
86 // Enable Full Access to CoProcessors
87 ArmWriteCPACR (CPACR_CP_FULL_ACCESS);
88
89 if (IS_PRIMARY_CORE(MpId)) {
90 // Initialize peripherals that must be done at the early stage
91 // Example: Some L2x0 controllers must be initialized in Secure World
92 ArmPlatformSecInitialize ();
93
94 // If we skip the PEI Core we could want to initialize the DRAM in the SEC phase.
95 // If we are in standalone, we need the initialization to copy the UEFI firmware into DRAM
96 if (FeaturePcdGet (PcdSystemMemoryInitializeInSec)) {
97 // Initialize system memory (DRAM)
98 ArmPlatformInitializeSystemMemory ();
99 }
100 }
101
102 // Test if Trustzone is supported on this platform
103 if (FixedPcdGetBool (PcdTrustzoneSupport)) {
104 // Ensure the Monitor Stack Base & Size have been set
105 ASSERT(PcdGet32(PcdCPUCoresSecMonStackBase) != 0);
106 ASSERT(PcdGet32(PcdCPUCoreSecMonStackSize) != 0);
107
108 if (ArmIsMpCore()) {
109 // Setup SMP in Non Secure world
110 ArmCpuSetupSmpNonSecure (GET_CORE_ID(MpId));
111 }
112
113 // Enter Monitor Mode
114 enter_monitor_mode ((VOID*)(PcdGet32(PcdCPUCoresSecMonStackBase) + (PcdGet32(PcdCPUCoreSecMonStackSize) * (GET_CORE_POS(MpId) + 1))));
115
116 //-------------------- Monitor Mode ---------------------
117
118 // Set up Monitor World (Vector Table, etc)
119 ArmSecureMonitorWorldInitialize ();
120
121 // Setup the Trustzone Chipsets
122 if (IS_PRIMARY_CORE(MpId)) {
123 ArmPlatformTrustzoneInit ();
124
125 // Waiting for the Primary Core to have finished to initialize the Secure World
126 ArmCpuSynchronizeSignal (ARM_CPU_EVENT_SECURE_INIT);
127 } else {
128 // The secondary cores need to wait until the Trustzone chipsets configuration is done
129 // before switching to Non Secure World
130
131 // Waiting for the Primary Core to have finished to initialize the Secure World
132 ArmCpuSynchronizeWait (ARM_CPU_EVENT_SECURE_INIT);
133 }
134
135 // Transfer the interrupt to Non-secure World
136 ArmGicSetupNonSecure (PcdGet32(PcdGicDistributorBase), PcdGet32(PcdGicInterruptInterfaceBase));
137
138 // Write to CP15 Non-secure Access Control Register
139 ArmWriteNsacr (PcdGet32 (PcdArmNsacr));
140
141 // CP15 Secure Configuration Register
142 ArmWriteScr (PcdGet32 (PcdArmScr));
143 } else {
144 if (IS_PRIMARY_CORE(MpId)) {
145 SerialPrint ("Trust Zone Configuration is disabled\n\r");
146 }
147
148 // With Trustzone support the transition from Sec to Normal world is done by return_from_exception().
149 // If we want to keep this function call we need to ensure the SVC's SPSR point to the same Program
150 // Status Register as the the current one (CPSR).
151 copy_cpsr_into_spsr ();
152 }
153
154 JumpAddress = PcdGet32 (PcdFvBaseAddress);
155 ArmPlatformSecExtraAction (MpId, &JumpAddress);
156
157 // If PcdArmNonSecModeTransition is defined then set this specific mode to CPSR before the transition
158 // By not set, the mode for Non Secure World is SVC
159 if (PcdGet32 (PcdArmNonSecModeTransition) != 0) {
160 set_non_secure_mode ((ARM_PROCESSOR_MODE)PcdGet32 (PcdArmNonSecModeTransition));
161 }
162
163 return_from_exception (JumpAddress);
164 //-------------------- Non Secure Mode ---------------------
165
166 // PEI Core should always load and never return
167 ASSERT (FALSE);
168 }
169
170 VOID
171 SecCommonExceptionEntry (
172 IN UINT32 Entry,
173 IN UINT32 LR
174 )
175 {
176 CHAR8 Buffer[100];
177 UINTN CharCount;
178
179 switch (Entry) {
180 case 0:
181 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reset Exception at 0x%X\n\r",LR);
182 break;
183 case 1:
184 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Undefined Exception at 0x%X\n\r",LR);
185 break;
186 case 2:
187 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"SWI Exception at 0x%X\n\r",LR);
188 break;
189 case 3:
190 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"PrefetchAbort Exception at 0x%X\n\r",LR);
191 break;
192 case 4:
193 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"DataAbort Exception at 0x%X\n\r",LR);
194 break;
195 case 5:
196 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Reserved Exception at 0x%X\n\r",LR);
197 break;
198 case 6:
199 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"IRQ Exception at 0x%X\n\r",LR);
200 break;
201 case 7:
202 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"FIQ Exception at 0x%X\n\r",LR);
203 break;
204 default:
205 CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"Unknown Exception at 0x%X\n\r",LR);
206 break;
207 }
208 SerialPortWrite ((UINT8 *) Buffer, CharCount);
209 while(1);
210 }