]>
Commit | Line | Data |
---|---|---|
615c6dd0 | 1 | /** @file\r |
b1f6a7c6 | 2 | EFI PEI Core dispatch services\r |
3 | \r | |
192f6d4c | 4 | Copyright (c) 2006, Intel Corporation\r |
5 | All rights reserved. This program and the accompanying materials\r | |
6 | are licensed and made available under the terms and conditions of the BSD License\r | |
7 | which accompanies this distribution. The full text of the license may be found at\r | |
8 | http://opensource.org/licenses/bsd-license.php\r | |
9 | \r | |
10 | THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r | |
11 | WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r | |
12 | \r | |
615c6dd0 | 13 | **/\r |
192f6d4c | 14 | \r |
192f6d4c | 15 | #include <PeiMain.h>\r |
16 | \r | |
b1f6a7c6 | 17 | ///\r |
18 | /// CAR is filled with this initial value during SEC phase\r | |
19 | ///\r | |
a7715e73 | 20 | #define INIT_CAR_VALUE 0x5AA55AA5\r |
21 | \r | |
797a9d67 | 22 | typedef struct {\r |
23 | EFI_STATUS_CODE_DATA DataHeader;\r | |
24 | EFI_HANDLE Handle;\r | |
25 | } PEIM_FILE_HANDLE_EXTENDED_DATA;\r | |
26 | \r | |
b1f6a7c6 | 27 | /**\r |
b0d803fe | 28 | \r |
29 | Discover all Peims and optional Apriori file in one FV. There is at most one\r | |
30 | Apriori file in one FV.\r | |
31 | \r | |
b0d803fe | 32 | \r |
b1f6a7c6 | 33 | @param Private - Pointer to the private data passed in from caller\r |
34 | @param VolumeHandle - Fv handle.\r | |
b0d803fe | 35 | \r |
b1f6a7c6 | 36 | **/\r |
37 | VOID\r | |
38 | DiscoverPeimsAndOrderWithApriori (\r | |
39 | IN PEI_CORE_INSTANCE *Private,\r | |
40 | IN EFI_PEI_FV_HANDLE VolumeHandle\r | |
41 | )\r | |
b0d803fe | 42 | {\r |
43 | EFI_STATUS Status;\r | |
44 | EFI_PEI_FV_HANDLE FileHandle;\r | |
177aabe6 | 45 | EFI_PEI_FILE_HANDLE AprioriFileHandle;\r |
b0d803fe | 46 | EFI_GUID *Apriori;\r |
47 | UINTN Index;\r | |
48 | UINTN Index2;\r | |
49 | UINTN PeimIndex;\r | |
50 | UINTN PeimCount;\r | |
51 | EFI_GUID *Guid;\r | |
177aabe6 | 52 | EFI_PEI_FV_HANDLE TempFileHandles[FixedPcdGet32 (PcdPeiCoreMaxPeimPerFv)];\r |
53 | EFI_GUID FileGuid[FixedPcdGet32 (PcdPeiCoreMaxPeimPerFv)];\r | |
b0d803fe | 54 | \r |
55 | //\r | |
56 | // Walk the FV and find all the PEIMs and the Apriori file.\r | |
57 | //\r | |
58 | AprioriFileHandle = NULL;\r | |
59 | Private->CurrentFvFileHandles[0] = NULL;\r | |
60 | Guid = NULL;\r | |
61 | FileHandle = NULL;\r | |
62 | \r | |
63 | //\r | |
64 | // If the current Fv has been scanned, directly get its cachable record.\r | |
65 | //\r | |
66 | if (Private->Fv[Private->CurrentPeimFvCount].ScanFv) {\r | |
67 | CopyMem (Private->CurrentFvFileHandles, Private->Fv[Private->CurrentPeimFvCount].FvFileHandles, sizeof (Private->CurrentFvFileHandles));\r | |
68 | return;\r | |
69 | }\r | |
70 | \r | |
71 | //\r | |
72 | // Go ahead to scan this Fv, and cache FileHandles within it.\r | |
73 | //\r | |
177aabe6 | 74 | for (PeimCount = 0; PeimCount < FixedPcdGet32 (PcdPeiCoreMaxPeimPerFv); PeimCount++) {\r |
b0d803fe | 75 | Status = PeiFindFileEx (\r |
58dcdada | 76 | VolumeHandle,\r |
77 | NULL,\r | |
78 | PEI_CORE_INTERNAL_FFS_FILE_DISPATCH_TYPE,\r | |
b0d803fe | 79 | &FileHandle,\r |
80 | &AprioriFileHandle\r | |
81 | );\r | |
82 | if (Status != EFI_SUCCESS) {\r | |
83 | break;\r | |
84 | }\r | |
58dcdada | 85 | \r |
b0d803fe | 86 | Private->CurrentFvFileHandles[PeimCount] = FileHandle;\r |
87 | }\r | |
88 | \r | |
58dcdada | 89 | Private->AprioriCount = 0;\r |
b0d803fe | 90 | if (AprioriFileHandle != NULL) {\r |
91 | //\r | |
92 | // Read the Apriori file\r | |
93 | //\r | |
177aabe6 | 94 | Status = PeiServicesFfsFindSectionData (EFI_SECTION_RAW, AprioriFileHandle, (VOID **) &Apriori);\r |
b0d803fe | 95 | if (!EFI_ERROR (Status)) {\r |
96 | //\r | |
97 | // Calculate the number of PEIMs in the A Priori list\r | |
98 | //\r | |
99 | Private->AprioriCount = *(UINT32 *)(((EFI_FFS_FILE_HEADER *)AprioriFileHandle)->Size) & 0x00FFFFFF;\r | |
58dcdada | 100 | Private->AprioriCount -= sizeof (EFI_FFS_FILE_HEADER) - sizeof (EFI_COMMON_SECTION_HEADER);\r |
b0d803fe | 101 | Private->AprioriCount /= sizeof (EFI_GUID);\r |
58dcdada | 102 | \r |
b0d803fe | 103 | SetMem (FileGuid, sizeof (FileGuid), 0);\r |
104 | for (Index = 0; Index < PeimCount; Index++) {\r | |
105 | //\r | |
106 | // Make an array of file name guids that matches the FileHandle array so we can convert\r | |
107 | // quickly from file name to file handle\r | |
108 | //\r | |
58dcdada | 109 | CopyMem (&FileGuid[Index], &((EFI_FFS_FILE_HEADER *)Private->CurrentFvFileHandles[Index])->Name,sizeof(EFI_GUID));\r |
b0d803fe | 110 | }\r |
111 | \r | |
112 | //\r | |
113 | // Walk through FileGuid array to find out who is invalid PEIM guid in Apriori file.\r | |
58dcdada | 114 | // Add avalible PEIMs in Apriori file into TempFileHandles array at first.\r |
b0d803fe | 115 | //\r |
116 | Index2 = 0;\r | |
117 | for (Index = 0; Index2 < Private->AprioriCount; Index++) {\r | |
118 | while (Index2 < Private->AprioriCount) {\r | |
119 | Guid = ScanGuid (FileGuid, PeimCount * sizeof (EFI_GUID), &Apriori[Index2++]);\r | |
120 | if (Guid != NULL) {\r | |
121 | break;\r | |
122 | }\r | |
123 | }\r | |
124 | if (Guid == NULL) {\r | |
58dcdada | 125 | break;\r |
b0d803fe | 126 | }\r |
127 | PeimIndex = ((UINTN)Guid - (UINTN)&FileGuid[0])/sizeof (EFI_GUID);\r | |
128 | TempFileHandles[Index] = Private->CurrentFvFileHandles[PeimIndex];\r | |
129 | \r | |
130 | //\r | |
131 | // Since we have copied the file handle we can remove it from this list.\r | |
132 | //\r | |
133 | Private->CurrentFvFileHandles[PeimIndex] = NULL;\r | |
134 | }\r | |
135 | \r | |
136 | //\r | |
137 | // Update valid Aprioricount\r | |
138 | //\r | |
139 | Private->AprioriCount = Index;\r | |
58dcdada | 140 | \r |
b0d803fe | 141 | //\r |
142 | // Add in any PEIMs not in the Apriori file\r | |
143 | //\r | |
144 | for (;Index < PeimCount; Index++) {\r | |
145 | for (Index2 = 0; Index2 < PeimCount; Index2++) {\r | |
146 | if (Private->CurrentFvFileHandles[Index2] != NULL) {\r | |
147 | TempFileHandles[Index] = Private->CurrentFvFileHandles[Index2];\r | |
148 | Private->CurrentFvFileHandles[Index2] = NULL;\r | |
149 | break;\r | |
150 | }\r | |
151 | }\r | |
152 | }\r | |
153 | //\r | |
154 | //Index the end of array contains re-range Pei moudle.\r | |
155 | //\r | |
156 | TempFileHandles[Index] = NULL;\r | |
58dcdada | 157 | \r |
b0d803fe | 158 | //\r |
159 | // Private->CurrentFvFileHandles is currently in PEIM in the FV order.\r | |
58dcdada | 160 | // We need to update it to start with files in the A Priori list and\r |
161 | // then the remaining files in PEIM order.\r | |
b0d803fe | 162 | //\r |
163 | CopyMem (Private->CurrentFvFileHandles, TempFileHandles, sizeof (Private->CurrentFvFileHandles));\r | |
164 | }\r | |
165 | }\r | |
166 | //\r | |
167 | // Cache the current Fv File Handle. So that we don't have to scan the Fv again.\r | |
168 | // Instead, we can retrieve the file handles within this Fv from cachable data.\r | |
169 | //\r | |
170 | Private->Fv[Private->CurrentPeimFvCount].ScanFv = TRUE;\r | |
171 | CopyMem (Private->Fv[Private->CurrentPeimFvCount].FvFileHandles, Private->CurrentFvFileHandles, sizeof (Private->CurrentFvFileHandles));\r | |
58dcdada | 172 | \r |
173 | }\r | |
174 | \r | |
b1f6a7c6 | 175 | /**\r |
176 | Shadow PeiCore module from flash to installed memory.\r | |
177 | \r | |
178 | @param PeiServices Pointer to PeiService table\r | |
179 | @param PrivateInMem PeiCore's private data structure\r | |
180 | \r | |
181 | **/\r | |
58dcdada | 182 | VOID*\r |
183 | ShadowPeiCore(\r | |
184 | EFI_PEI_SERVICES **PeiServices,\r | |
185 | PEI_CORE_INSTANCE *PrivateInMem\r | |
186 | )\r | |
187 | {\r | |
188 | EFI_PEI_FILE_HANDLE PeiCoreFileHandle;\r | |
189 | EFI_PHYSICAL_ADDRESS EntryPoint;\r | |
190 | EFI_STATUS Status;\r | |
191 | UINT32 AuthenticationState;\r | |
192 | \r | |
193 | PeiCoreFileHandle = NULL;\r | |
194 | \r | |
195 | //\r | |
196 | // Find the PEI Core in the BFV\r | |
197 | //\r | |
198 | Status = PeiFindFileEx (\r | |
199 | (EFI_PEI_FV_HANDLE)PrivateInMem->Fv[0].FvHeader,\r | |
200 | NULL,\r | |
201 | EFI_FV_FILETYPE_PEI_CORE,\r | |
202 | &PeiCoreFileHandle,\r | |
203 | NULL\r | |
204 | );\r | |
205 | ASSERT_EFI_ERROR (Status);\r | |
206 | \r | |
207 | //\r | |
208 | // Shadow PEI Core into memory so it will run faster\r | |
209 | //\r | |
210 | Status = PeiLoadImage (\r | |
211 | PeiServices,\r | |
212 | *((EFI_PEI_FILE_HANDLE*)&PeiCoreFileHandle),\r | |
213 | &EntryPoint,\r | |
214 | &AuthenticationState\r | |
215 | );\r | |
216 | ASSERT_EFI_ERROR (Status);\r | |
217 | \r | |
218 | return (VOID*) ((UINTN) EntryPoint + (UINTN) PeiCore - (UINTN) _ModuleEntryPoint);\r | |
b0d803fe | 219 | }\r |
220 | \r | |
b1f6a7c6 | 221 | /**\r |
192f6d4c | 222 | Conduct PEIM dispatch.\r |
223 | \r | |
b1f6a7c6 | 224 | @param SecCoreData Points to a data structure containing information about the PEI core's operating\r |
5aae0aa7 | 225 | environment, such as the size and location of temporary RAM, the stack location and\r |
226 | the BFV location.\r | |
b1f6a7c6 | 227 | @param Private Pointer to the private data passed in from caller\r |
192f6d4c | 228 | \r |
b1f6a7c6 | 229 | @retval EFI_SUCCESS - Successfully dispatched PEIM.\r |
230 | @retval EFI_NOT_FOUND - The dispatch failed.\r | |
192f6d4c | 231 | \r |
b1f6a7c6 | 232 | **/\r |
233 | VOID\r | |
234 | PeiDispatcher (\r | |
235 | IN CONST EFI_SEC_PEI_HAND_OFF *SecCoreData,\r | |
236 | IN PEI_CORE_INSTANCE *Private\r | |
237 | )\r | |
192f6d4c | 238 | {\r |
b0d803fe | 239 | EFI_STATUS Status;\r |
240 | UINT32 Index1;\r | |
241 | UINT32 Index2;\r | |
242 | EFI_PEI_SERVICES **PeiServices;\r | |
58dcdada | 243 | EFI_PEI_FV_HANDLE VolumeHandle;\r |
b0d803fe | 244 | EFI_PEI_FILE_HANDLE PeimFileHandle;\r |
245 | UINTN FvCount;\r | |
246 | UINTN PeimCount;\r | |
247 | UINT32 AuthenticationState;\r | |
248 | EFI_PHYSICAL_ADDRESS EntryPoint;\r | |
797a9d67 | 249 | EFI_PEIM_ENTRY_POINT2 PeimEntryPoint;\r |
b0d803fe | 250 | BOOLEAN PeimNeedingDispatch;\r |
251 | BOOLEAN PeimDispatchOnThisPass;\r | |
252 | UINTN SaveCurrentPeimCount;\r | |
1053e0c5 | 253 | UINTN SaveCurrentFvCount;\r |
b0d803fe | 254 | EFI_PEI_FILE_HANDLE SaveCurrentFileHandle;\r |
797a9d67 | 255 | PEIM_FILE_HANDLE_EXTENDED_DATA ExtendedData;\r |
58dcdada | 256 | EFI_PHYSICAL_ADDRESS NewPermenentMemoryBase;\r |
257 | TEMPORARY_RAM_SUPPORT_PPI *TemporaryRamSupportPpi;\r | |
258 | EFI_HOB_HANDOFF_INFO_TABLE *OldHandOffTable;\r | |
259 | EFI_HOB_HANDOFF_INFO_TABLE *NewHandOffTable;\r | |
66c69dea | 260 | INTN StackOffset;\r |
261 | INTN HeapOffset;\r | |
58dcdada | 262 | PEI_CORE_INSTANCE *PrivateInMem;\r |
263 | UINT64 NewPeiStackSize;\r | |
264 | UINT64 OldPeiStackSize;\r | |
265 | UINT64 StackGap;\r | |
288f9b38 | 266 | EFI_FV_FILE_INFO FvFileInfo;\r |
58dcdada | 267 | UINTN OldCheckingTop;\r |
268 | UINTN OldCheckingBottom;\r | |
b0d803fe | 269 | \r |
270 | \r | |
271 | PeiServices = &Private->PS;\r | |
272 | PeimEntryPoint = NULL;\r | |
273 | PeimFileHandle = NULL;\r | |
288f9b38 | 274 | EntryPoint = 0;\r |
b0d803fe | 275 | \r |
276 | if ((Private->PeiMemoryInstalled) && (Private->HobList.HandoffInformationTable->BootMode != BOOT_ON_S3_RESUME)) {\r | |
277 | //\r | |
278 | // Once real memory is available, shadow the RegisterForShadow modules. And meanwhile\r | |
279 | // update the modules' status from PEIM_STATE_REGISITER_FOR_SHADOW to PEIM_STATE_DONE.\r | |
280 | //\r | |
281 | SaveCurrentPeimCount = Private->CurrentPeimCount;\r | |
1053e0c5 | 282 | SaveCurrentFvCount = Private->CurrentPeimFvCount;\r |
b0d803fe | 283 | SaveCurrentFileHandle = Private->CurrentFileHandle;\r |
284 | \r | |
1053e0c5 | 285 | for (Index1 = 0; Index1 <= SaveCurrentFvCount; Index1++) {\r |
177aabe6 | 286 | for (Index2 = 0; (Index2 < FixedPcdGet32 (PcdPeiCoreMaxPeimPerFv)) && (Private->Fv[Index1].FvFileHandles[Index2] != NULL); Index2++) {\r |
b0d803fe | 287 | if (Private->Fv[Index1].PeimState[Index2] == PEIM_STATE_REGISITER_FOR_SHADOW) {\r |
58dcdada | 288 | PeimFileHandle = Private->Fv[Index1].FvFileHandles[Index2];\r |
b0d803fe | 289 | Status = PeiLoadImage (\r |
58dcdada | 290 | &Private->PS,\r |
291 | PeimFileHandle,\r | |
292 | &EntryPoint,\r | |
b0d803fe | 293 | &AuthenticationState\r |
294 | );\r | |
295 | if (Status == EFI_SUCCESS) {\r | |
296 | //\r | |
297 | // PEIM_STATE_REGISITER_FOR_SHADOW move to PEIM_STATE_DONE\r | |
298 | //\r | |
299 | Private->Fv[Index1].PeimState[Index2]++;\r | |
1053e0c5 | 300 | Private->CurrentFileHandle = PeimFileHandle;\r |
58dcdada | 301 | Private->CurrentPeimFvCount = Index1;\r |
302 | Private->CurrentPeimCount = Index2;\r | |
b0d803fe | 303 | //\r |
304 | // Call the PEIM entry point\r | |
305 | //\r | |
797a9d67 | 306 | PeimEntryPoint = (EFI_PEIM_ENTRY_POINT2)(UINTN)EntryPoint;\r |
58dcdada | 307 | \r |
b0d803fe | 308 | PERF_START (0, "PEIM", NULL, 0);\r |
797a9d67 | 309 | PeimEntryPoint(PeimFileHandle, (const EFI_PEI_SERVICES **) &Private->PS);\r |
b0d803fe | 310 | PERF_END (0, "PEIM", NULL, 0);\r |
58dcdada | 311 | }\r |
312 | \r | |
b0d803fe | 313 | //\r |
314 | // Process the Notify list and dispatch any notifies for\r | |
315 | // newly installed PPIs.\r | |
316 | //\r | |
317 | ProcessNotifyList (Private);\r | |
318 | }\r | |
319 | }\r | |
320 | }\r | |
58dcdada | 321 | Private->CurrentFileHandle = SaveCurrentFileHandle;\r |
322 | Private->CurrentPeimFvCount = SaveCurrentFvCount;\r | |
323 | Private->CurrentPeimCount = SaveCurrentPeimCount;\r | |
b0d803fe | 324 | }\r |
192f6d4c | 325 | \r |
326 | //\r | |
327 | // This is the main dispatch loop. It will search known FVs for PEIMs and\r | |
328 | // attempt to dispatch them. If any PEIM gets dispatched through a single\r | |
329 | // pass of the dispatcher, it will start over from the Bfv again to see\r | |
330 | // if any new PEIMs dependencies got satisfied. With a well ordered\r | |
331 | // FV where PEIMs are found in the order their dependencies are also\r | |
332 | // satisfied, this dipatcher should run only once.\r | |
333 | //\r | |
b0d803fe | 334 | do {\r |
335 | PeimNeedingDispatch = FALSE;\r | |
336 | PeimDispatchOnThisPass = FALSE;\r | |
337 | \r | |
338 | for (FvCount = Private->CurrentPeimFvCount; FvCount < Private->FvCount; FvCount++) {\r | |
339 | Private->CurrentPeimFvCount = FvCount;\r | |
340 | VolumeHandle = Private->Fv[FvCount].FvHeader;\r | |
192f6d4c | 341 | \r |
b0d803fe | 342 | if (Private->CurrentPeimCount == 0) {\r |
343 | //\r | |
344 | // When going through each FV, at first, search Apriori file to\r | |
58dcdada | 345 | // reorder all PEIMs to ensure the PEIMs in Apriori file to get\r |
b0d803fe | 346 | // dispatch at first.\r |
347 | //\r | |
348 | DiscoverPeimsAndOrderWithApriori (Private, VolumeHandle);\r | |
349 | }\r | |
192f6d4c | 350 | \r |
351 | //\r | |
b0d803fe | 352 | // Start to dispatch all modules within the current Fv.\r |
192f6d4c | 353 | //\r |
58dcdada | 354 | for (PeimCount = Private->CurrentPeimCount;\r |
355 | (PeimCount < FixedPcdGet32 (PcdPeiCoreMaxPeimPerFv)) && (Private->CurrentFvFileHandles[PeimCount] != NULL);\r | |
b0d803fe | 356 | PeimCount++) {\r |
357 | Private->CurrentPeimCount = PeimCount;\r | |
358 | PeimFileHandle = Private->CurrentFileHandle = Private->CurrentFvFileHandles[PeimCount];\r | |
359 | \r | |
360 | if (Private->Fv[FvCount].PeimState[PeimCount] == PEIM_STATE_NOT_DISPATCHED) {\r | |
361 | if (!DepexSatisfied (Private, PeimFileHandle, PeimCount)) {\r | |
362 | PeimNeedingDispatch = TRUE;\r | |
363 | } else {\r | |
288f9b38 LG |
364 | Status = PeiFfsGetFileInfo (PeimFileHandle, &FvFileInfo);\r |
365 | ASSERT_EFI_ERROR (Status);\r | |
366 | if (FvFileInfo.FileType == EFI_FV_FILETYPE_FIRMWARE_VOLUME_IMAGE) {\r | |
367 | //\r | |
368 | // For Fv type file, Produce new FV PPI and FV hob\r | |
369 | //\r | |
370 | Status = ProcessFvFile (PeiServices, PeimFileHandle, &AuthenticationState);\r | |
371 | } else {\r | |
372 | //\r | |
373 | // For PEIM driver, Load its entry point\r | |
374 | //\r | |
375 | Status = PeiLoadImage (\r | |
58dcdada | 376 | PeiServices,\r |
377 | PeimFileHandle,\r | |
378 | &EntryPoint,\r | |
288f9b38 LG |
379 | &AuthenticationState\r |
380 | );\r | |
381 | }\r | |
382 | \r | |
b0d803fe | 383 | if ((Status == EFI_SUCCESS)) {\r |
192f6d4c | 384 | //\r |
58dcdada | 385 | // The PEIM has its dependencies satisfied, and its entry point\r |
386 | // has been found, so invoke it.\r | |
192f6d4c | 387 | //\r |
b0d803fe | 388 | PERF_START (0, "PEIM", NULL, 0);\r |
192f6d4c | 389 | \r |
b0d803fe | 390 | ExtendedData.Handle = (EFI_HANDLE)PeimFileHandle;\r |
192f6d4c | 391 | \r |
392 | REPORT_STATUS_CODE_WITH_EXTENDED_DATA (\r | |
393 | EFI_PROGRESS_CODE,\r | |
797a9d67 | 394 | FixedPcdGet32(PcdStatusCodeValuePeimDispatch),\r |
192f6d4c | 395 | (VOID *)(&ExtendedData),\r |
396 | sizeof (ExtendedData)\r | |
397 | );\r | |
398 | \r | |
b0d803fe | 399 | Status = VerifyPeim (Private, VolumeHandle, PeimFileHandle);\r |
400 | if (Status != EFI_SECURITY_VIOLATION && (AuthenticationState == 0)) {\r | |
401 | //\r | |
402 | // PEIM_STATE_NOT_DISPATCHED move to PEIM_STATE_DISPATCHED\r | |
403 | //\r | |
404 | Private->Fv[FvCount].PeimState[PeimCount]++;\r | |
58dcdada | 405 | \r |
288f9b38 LG |
406 | if (FvFileInfo.FileType != EFI_FV_FILETYPE_FIRMWARE_VOLUME_IMAGE) {\r |
407 | //\r | |
408 | // Call the PEIM entry point for PEIM driver\r | |
409 | //\r | |
797a9d67 | 410 | PeimEntryPoint = (EFI_PEIM_ENTRY_POINT2)(UINTN)EntryPoint;\r |
411 | PeimEntryPoint (PeimFileHandle, (const EFI_PEI_SERVICES **) PeiServices);\r | |
288f9b38 | 412 | }\r |
797a9d67 | 413 | \r |
b0d803fe | 414 | PeimDispatchOnThisPass = TRUE;\r |
192f6d4c | 415 | }\r |
416 | \r | |
417 | REPORT_STATUS_CODE_WITH_EXTENDED_DATA (\r | |
418 | EFI_PROGRESS_CODE,\r | |
797a9d67 | 419 | FixedPcdGet32(PcdStatusCodeValuePeimDispatch),\r |
192f6d4c | 420 | (VOID *)(&ExtendedData),\r |
421 | sizeof (ExtendedData)\r | |
422 | );\r | |
b0d803fe | 423 | PERF_END (0, "PEIM", NULL, 0);\r |
424 | \r | |
58dcdada | 425 | }\r |
426 | \r | |
427 | if (Private->SwitchStackSignal) {\r | |
a7715e73 | 428 | //\r |
429 | // Before switch stack from CAR to permenent memory, caculate the heap and stack\r | |
430 | // usage in temporary memory for debuging.\r | |
431 | //\r | |
432 | DEBUG_CODE_BEGIN ();\r | |
96317468 | 433 | UINT32 *StackPointer;\r |
a7715e73 | 434 | \r |
96317468 | 435 | for (StackPointer = (UINT32*)SecCoreData->StackBase;\r |
436 | (StackPointer < (UINT32*)((UINTN)SecCoreData->StackBase + SecCoreData->StackSize)) \\r | |
a7715e73 | 437 | && (*StackPointer == INIT_CAR_VALUE);\r |
438 | StackPointer ++);\r | |
439 | \r | |
440 | DEBUG ((EFI_D_INFO, "Total Cache as RAM: %d bytes.\n", SecCoreData->TemporaryRamSize));\r | |
441 | DEBUG ((EFI_D_INFO, " CAR stack ever used: %d bytes.\n",\r | |
442 | (SecCoreData->StackSize - ((UINTN) StackPointer - (UINTN)SecCoreData->StackBase))\r | |
443 | ));\r | |
444 | DEBUG ((EFI_D_INFO, " CAR heap used: %d bytes.\n",\r | |
445 | ((UINTN) Private->HobList.HandoffInformationTable->EfiFreeMemoryBottom -\r | |
446 | (UINTN) Private->HobList.Raw)\r | |
447 | ));\r | |
448 | DEBUG_CODE_END ();\r | |
449 | \r | |
a3a15d21 | 450 | //\r |
58dcdada | 451 | // Reserve the size of new stack at bottom of physical memory\r |
a3a15d21 | 452 | //\r |
58dcdada | 453 | OldPeiStackSize = Private->StackSize;\r |
454 | NewPeiStackSize = (RShiftU64 (Private->PhysicalMemoryLength, 1) + EFI_PAGE_MASK) & ~EFI_PAGE_MASK;\r | |
455 | if (FixedPcdGet32(PcdPeiCoreMaxPeiStackSize) > (UINT32) NewPeiStackSize) {\r | |
456 | Private->StackSize = NewPeiStackSize;\r | |
457 | } else {\r | |
458 | Private->StackSize = FixedPcdGet32(PcdPeiCoreMaxPeiStackSize);\r | |
459 | }\r | |
192f6d4c | 460 | \r |
58dcdada | 461 | //\r |
462 | // In theory, the size of new stack in permenent memory should large than\r | |
463 | // size of old stack in temporary memory.\r | |
464 | // But if new stack is smaller than the size of old stack, we also reserve\r | |
465 | // the size of old stack at bottom of permenent memory.\r | |
466 | //\r | |
467 | StackGap = 0;\r | |
468 | if (Private->StackSize > OldPeiStackSize) {\r | |
469 | StackGap = Private->StackSize - OldPeiStackSize;\r | |
470 | }\r | |
d74eeda8 | 471 | \r |
58dcdada | 472 | //\r |
473 | // Update HandOffHob for new installed permenent memory\r | |
474 | //\r | |
475 | OldHandOffTable = Private->HobList.HandoffInformationTable;\r | |
5c5a0601 | 476 | OldCheckingBottom = (UINTN)(SecCoreData->TemporaryRamBase);\r |
58dcdada | 477 | OldCheckingTop = (UINTN)(OldCheckingBottom + SecCoreData->TemporaryRamSize);\r |
192f6d4c | 478 | \r |
479 | //\r | |
58dcdada | 480 | // The whole temporary memory will be migrated to physical memory.\r |
481 | // CAUTION: The new base is computed accounding to gap of new stack.\r | |
192f6d4c | 482 | //\r |
58dcdada | 483 | NewPermenentMemoryBase = Private->PhysicalMemoryBegin + StackGap;\r |
40f26b8f | 484 | \r |
485 | //\r | |
486 | // Caculate stack offset and heap offset between CAR and new permement \r | |
487 | // memory seperately.\r | |
488 | //\r | |
d74eeda8 | 489 | StackOffset = (UINTN) NewPermenentMemoryBase - (UINTN) SecCoreData->StackBase;\r |
66c69dea | 490 | HeapOffset = (INTN) ((UINTN) Private->PhysicalMemoryBegin + Private->StackSize - \\r |
491 | (UINTN) SecCoreData->PeiTemporaryRamBase);\r | |
492 | DEBUG ((EFI_D_INFO, "Heap Offset = 0x%X Stack Offset = 0x%X\n", HeapOffset, StackOffset));\r | |
493 | \r | |
40f26b8f | 494 | //\r |
495 | // Caculate new HandOffTable and PrivateData address in permenet memory's stack\r | |
496 | //\r | |
66c69dea | 497 | NewHandOffTable = (EFI_HOB_HANDOFF_INFO_TABLE *)((UINTN)OldHandOffTable + HeapOffset);\r |
498 | PrivateInMem = (PEI_CORE_INSTANCE *)((UINTN) (VOID*) Private + StackOffset);\r | |
192f6d4c | 499 | \r |
500 | //\r | |
58dcdada | 501 | // TemporaryRamSupportPpi is produced by platform's SEC\r |
192f6d4c | 502 | //\r |
58dcdada | 503 | Status = PeiLocatePpi (\r |
504 | (CONST EFI_PEI_SERVICES **) PeiServices,\r | |
505 | &gEfiTemporaryRamSupportPpiGuid,\r | |
506 | 0,\r | |
507 | NULL,\r | |
508 | (VOID**)&TemporaryRamSupportPpi\r | |
509 | );\r | |
510 | \r | |
81c7803c | 511 | \r |
58dcdada | 512 | if (!EFI_ERROR (Status)) {\r |
40f26b8f | 513 | //\r |
514 | // Temporary Ram support Ppi is provided by platform, it will copy \r | |
515 | // temporary memory to permenent memory and do stack switching.\r | |
516 | // After invoken temporary Ram support, following code's stack is in \r | |
517 | // memory but not in CAR.\r | |
518 | //\r | |
58dcdada | 519 | TemporaryRamSupportPpi->TemporaryRamMigration (\r |
520 | (CONST EFI_PEI_SERVICES **) PeiServices,\r | |
521 | (EFI_PHYSICAL_ADDRESS)(UINTN) SecCoreData->TemporaryRamBase,\r | |
522 | (EFI_PHYSICAL_ADDRESS)(UINTN) NewPermenentMemoryBase,\r | |
523 | SecCoreData->TemporaryRamSize\r | |
524 | );\r | |
525 | \r | |
526 | } else {\r | |
b414ea4b | 527 | //\r |
528 | // In IA32/x64/Itanium architecture, we need platform provide\r | |
529 | // TEMPORAY_RAM_MIGRATION_PPI.\r | |
530 | //\r | |
531 | ASSERT (FALSE);\r | |
58dcdada | 532 | }\r |
533 | \r | |
534 | \r | |
535 | //\r | |
b0d803fe | 536 | //\r |
58dcdada | 537 | // Fixup the PeiCore's private data\r |
b0d803fe | 538 | //\r |
58dcdada | 539 | PrivateInMem->PS = &PrivateInMem->ServiceTableShadow;\r |
540 | PrivateInMem->CpuIo = &PrivateInMem->ServiceTableShadow.CpuIo;\r | |
66c69dea | 541 | PrivateInMem->HobList.Raw = (VOID*) ((UINTN) PrivateInMem->HobList.Raw + HeapOffset);\r |
58dcdada | 542 | PrivateInMem->StackBase = (EFI_PHYSICAL_ADDRESS)(((UINTN)PrivateInMem->PhysicalMemoryBegin + EFI_PAGE_MASK) & ~EFI_PAGE_MASK);\r |
543 | \r | |
544 | PeiServices = &PrivateInMem->PS;\r | |
545 | \r | |
546 | //\r | |
547 | // Fixup for PeiService's address\r | |
548 | //\r | |
549 | SetPeiServicesTablePointer(PeiServices);\r | |
550 | \r | |
551 | //\r | |
552 | // Update HandOffHob for new installed permenent memory\r | |
553 | //\r | |
554 | NewHandOffTable->EfiEndOfHobList =\r | |
66c69dea | 555 | (EFI_PHYSICAL_ADDRESS)((UINTN) NewHandOffTable->EfiEndOfHobList + HeapOffset);\r |
58dcdada | 556 | NewHandOffTable->EfiMemoryTop = PrivateInMem->PhysicalMemoryBegin +\r |
557 | PrivateInMem->PhysicalMemoryLength;\r | |
558 | NewHandOffTable->EfiMemoryBottom = PrivateInMem->PhysicalMemoryBegin;\r | |
559 | NewHandOffTable->EfiFreeMemoryTop = PrivateInMem->FreePhysicalMemoryTop;\r | |
560 | NewHandOffTable->EfiFreeMemoryBottom = NewHandOffTable->EfiEndOfHobList +\r | |
561 | sizeof (EFI_HOB_GENERIC_HEADER);\r | |
562 | \r | |
563 | //\r | |
564 | // We need convert the PPI desciptor's pointer\r | |
565 | //\r | |
40f26b8f | 566 | ConvertPpiPointers (PrivateInMem, \r |
58dcdada | 567 | OldCheckingBottom, \r |
568 | OldCheckingTop, \r | |
5c5a0601 | 569 | HeapOffset\r |
570 | );\r | |
58dcdada | 571 | \r |
572 | DEBUG ((EFI_D_INFO, "Stack Hob: BaseAddress=0x%X Length=0x%X\n",\r | |
573 | (UINTN)PrivateInMem->StackBase,\r | |
574 | PrivateInMem->StackSize));\r | |
575 | BuildStackHob (PrivateInMem->StackBase, PrivateInMem->StackSize);\r | |
576 | \r | |
577 | //\r | |
578 | // After the whole temporary memory is migrated, then we can allocate page in\r | |
579 | // permenent memory.\r | |
580 | //\r | |
581 | PrivateInMem->PeiMemoryInstalled = TRUE;\r | |
582 | \r | |
7bc3788c | 583 | //\r |
584 | // Restart scan of all PEIMs on next pass\r | |
585 | //\r | |
586 | PrivateInMem->CurrentPeimCount = 0;\r | |
587 | \r | |
192f6d4c | 588 | //\r |
b0d803fe | 589 | // Shadow PEI Core. When permanent memory is avaiable, shadow\r |
590 | // PEI Core and PEIMs to get high performance.\r | |
192f6d4c | 591 | //\r |
58dcdada | 592 | PrivateInMem->ShadowedPeiCore = ShadowPeiCore (\r |
593 | PeiServices,\r | |
594 | PrivateInMem\r | |
595 | );\r | |
b0d803fe | 596 | //\r |
58dcdada | 597 | // Process the Notify list and dispatch any notifies for\r |
598 | // newly installed PPIs.\r | |
b0d803fe | 599 | //\r |
58dcdada | 600 | ProcessNotifyList (PrivateInMem);\r |
601 | \r | |
b0d803fe | 602 | //\r |
58dcdada | 603 | // Entry PEI Phase 2\r |
b0d803fe | 604 | //\r |
58dcdada | 605 | PeiCore (SecCoreData, NULL, PrivateInMem);\r |
b0d803fe | 606 | \r |
58dcdada | 607 | //\r |
608 | // Code should not come here\r | |
609 | //\r | |
610 | ASSERT_EFI_ERROR(FALSE);\r | |
192f6d4c | 611 | }\r |
192f6d4c | 612 | \r |
58dcdada | 613 | //\r |
614 | // Process the Notify list and dispatch any notifies for\r | |
615 | // newly installed PPIs.\r | |
616 | //\r | |
617 | ProcessNotifyList (Private);\r | |
618 | \r | |
b0d803fe | 619 | if ((Private->PeiMemoryInstalled) && (Private->Fv[FvCount].PeimState[PeimCount] == PEIM_STATE_REGISITER_FOR_SHADOW) && \\r |
620 | (Private->HobList.HandoffInformationTable->BootMode != BOOT_ON_S3_RESUME)) {\r | |
621 | //\r | |
58dcdada | 622 | // If memory is availble we shadow images by default for performance reasons.\r |
623 | // We call the entry point a 2nd time so the module knows it's shadowed.\r | |
b0d803fe | 624 | //\r |
625 | //PERF_START (PeiServices, L"PEIM", PeimFileHandle, 0);\r | |
797a9d67 | 626 | PeimEntryPoint (PeimFileHandle, (const EFI_PEI_SERVICES **) PeiServices);\r |
b0d803fe | 627 | //PERF_END (PeiServices, L"PEIM", PeimFileHandle, 0);\r |
58dcdada | 628 | \r |
b0d803fe | 629 | //\r |
630 | // PEIM_STATE_REGISITER_FOR_SHADOW move to PEIM_STATE_DONE\r | |
631 | //\r | |
632 | Private->Fv[FvCount].PeimState[PeimCount]++;\r | |
192f6d4c | 633 | \r |
192f6d4c | 634 | //\r |
b0d803fe | 635 | // Process the Notify list and dispatch any notifies for\r |
636 | // newly installed PPIs.\r | |
192f6d4c | 637 | //\r |
b0d803fe | 638 | ProcessNotifyList (Private);\r |
192f6d4c | 639 | }\r |
640 | }\r | |
641 | }\r | |
192f6d4c | 642 | }\r |
192f6d4c | 643 | \r |
b0d803fe | 644 | //\r |
645 | // We set to NULL here to optimize the 2nd entry to this routine after\r | |
646 | // memory is found. This reprevents rescanning of the FV. We set to\r | |
647 | // NULL here so we start at the begining of the next FV\r | |
648 | //\r | |
649 | Private->CurrentFileHandle = NULL;\r | |
650 | Private->CurrentPeimCount = 0;\r | |
651 | //\r | |
652 | // Before walking through the next FV,Private->CurrentFvFileHandles[]should set to NULL\r | |
653 | //\r | |
654 | SetMem (Private->CurrentFvFileHandles, sizeof (Private->CurrentFvFileHandles), 0);\r | |
192f6d4c | 655 | }\r |
656 | \r | |
657 | //\r | |
58dcdada | 658 | // Before making another pass, we should set Private->CurrentPeimFvCount =0 to go\r |
b0d803fe | 659 | // through all the FV.\r |
192f6d4c | 660 | //\r |
b0d803fe | 661 | Private->CurrentPeimFvCount = 0;\r |
192f6d4c | 662 | \r |
663 | //\r | |
58dcdada | 664 | // PeimNeedingDispatch being TRUE means we found a PEIM that did not get\r |
b0d803fe | 665 | // dispatched. So we need to make another pass\r |
192f6d4c | 666 | //\r |
58dcdada | 667 | // PeimDispatchOnThisPass being TRUE means we dispatched a PEIM on this\r |
b0d803fe | 668 | // pass. If we did not dispatch a PEIM there is no point in trying again\r |
669 | // as it will fail the next time too (nothing has changed).\r | |
192f6d4c | 670 | //\r |
b0d803fe | 671 | } while (PeimNeedingDispatch && PeimDispatchOnThisPass);\r |
192f6d4c | 672 | \r |
192f6d4c | 673 | }\r |
674 | \r | |
b1f6a7c6 | 675 | /**\r |
192f6d4c | 676 | Initialize the Dispatcher's data members\r |
677 | \r | |
b1f6a7c6 | 678 | @param PrivateData PeiCore's private data structure\r |
679 | @param OldCoreData Old data from SecCore\r | |
192f6d4c | 680 | NULL if being run in non-permament memory mode.\r |
b1f6a7c6 | 681 | @param SecCoreData Points to a data structure containing information about the PEI core's operating\r |
5aae0aa7 | 682 | environment, such as the size and location of temporary RAM, the stack location and\r |
683 | the BFV location.\r | |
192f6d4c | 684 | \r |
b1f6a7c6 | 685 | @return None.\r |
192f6d4c | 686 | \r |
b1f6a7c6 | 687 | **/\r |
688 | VOID\r | |
689 | InitializeDispatcherData (\r | |
690 | IN PEI_CORE_INSTANCE *PrivateData,\r | |
691 | IN PEI_CORE_INSTANCE *OldCoreData,\r | |
692 | IN CONST EFI_SEC_PEI_HAND_OFF *SecCoreData\r | |
693 | )\r | |
192f6d4c | 694 | {\r |
192f6d4c | 695 | if (OldCoreData == NULL) {\r |
b0d803fe | 696 | PeiInitializeFv (PrivateData, SecCoreData);\r |
192f6d4c | 697 | }\r |
698 | \r | |
699 | return;\r | |
700 | }\r | |
701 | \r | |
b1f6a7c6 | 702 | /**\r |
703 | This routine parses the Dependency Expression, if available, and\r | |
704 | decides if the module can be executed.\r | |
705 | \r | |
706 | \r | |
707 | @param Private PeiCore's private data structure\r | |
708 | @param FileHandle PEIM's file handle\r | |
709 | @param PeimCount Peim count in all dispatched PEIMs.\r | |
192f6d4c | 710 | \r |
b1f6a7c6 | 711 | @retval TRUE Can be dispatched\r |
712 | @retval FALSE Cannot be dispatched\r | |
713 | \r | |
714 | **/\r | |
192f6d4c | 715 | BOOLEAN\r |
716 | DepexSatisfied (\r | |
b0d803fe | 717 | IN PEI_CORE_INSTANCE *Private,\r |
718 | IN EFI_PEI_FILE_HANDLE FileHandle,\r | |
719 | IN UINTN PeimCount\r | |
192f6d4c | 720 | )\r |
192f6d4c | 721 | {\r |
288f9b38 LG |
722 | EFI_STATUS Status;\r |
723 | VOID *DepexData;\r | |
b0d803fe | 724 | \r |
725 | if (PeimCount < Private->AprioriCount) {\r | |
726 | //\r | |
727 | // If its in the A priori file then we set Depex to TRUE\r | |
728 | //\r | |
729 | return TRUE;\r | |
730 | }\r | |
58dcdada | 731 | \r |
288f9b38 | 732 | //\r |
58dcdada | 733 | // Depex section not in the encapsulated section.\r |
288f9b38 LG |
734 | //\r |
735 | Status = PeiServicesFfsFindSectionData (\r | |
736 | EFI_SECTION_PEI_DEPEX,\r | |
58dcdada | 737 | FileHandle,\r |
288f9b38 LG |
738 | (VOID **)&DepexData\r |
739 | );\r | |
b0d803fe | 740 | \r |
192f6d4c | 741 | if (EFI_ERROR (Status)) {\r |
b0d803fe | 742 | //\r |
743 | // If there is no DEPEX, assume the module can be executed\r | |
744 | //\r | |
192f6d4c | 745 | return TRUE;\r |
746 | }\r | |
747 | \r | |
748 | //\r | |
749 | // Evaluate a given DEPEX\r | |
750 | //\r | |
b0d803fe | 751 | return PeimDispatchReadiness (&Private->PS, DepexData);\r |
192f6d4c | 752 | }\r |
753 | \r | |
14e8823a | 754 | /**\r |
755 | This routine enable a PEIM to register itself to shadow when PEI Foundation\r | |
756 | discovery permanent memory.\r | |
757 | \r | |
b1f6a7c6 | 758 | @param FileHandle File handle of a PEIM.\r |
58dcdada | 759 | \r |
b1f6a7c6 | 760 | @retval EFI_NOT_FOUND The file handle doesn't point to PEIM itself.\r |
761 | @retval EFI_ALREADY_STARTED Indicate that the PEIM has been registered itself.\r | |
762 | @retval EFI_SUCCESS Successfully to register itself.\r | |
14e8823a | 763 | \r |
58dcdada | 764 | **/\r |
14e8823a | 765 | EFI_STATUS\r |
766 | EFIAPI\r | |
767 | PeiRegisterForShadow (\r | |
768 | IN EFI_PEI_FILE_HANDLE FileHandle\r | |
769 | )\r | |
770 | {\r | |
771 | PEI_CORE_INSTANCE *Private;\r | |
772 | Private = PEI_CORE_INSTANCE_FROM_PS_THIS (GetPeiServicesTablePointer ());\r | |
773 | \r | |
774 | if (Private->CurrentFileHandle != FileHandle) {\r | |
775 | //\r | |
776 | // The FileHandle must be for the current PEIM\r | |
777 | //\r | |
778 | return EFI_NOT_FOUND;\r | |
779 | }\r | |
780 | \r | |
781 | if (Private->Fv[Private->CurrentPeimFvCount].PeimState[Private->CurrentPeimCount] >= PEIM_STATE_REGISITER_FOR_SHADOW) {\r | |
782 | //\r | |
783 | // If the PEIM has already entered the PEIM_STATE_REGISTER_FOR_SHADOW or PEIM_STATE_DONE then it's already been started\r | |
784 | //\r | |
785 | return EFI_ALREADY_STARTED;\r | |
786 | }\r | |
58dcdada | 787 | \r |
14e8823a | 788 | Private->Fv[Private->CurrentPeimFvCount].PeimState[Private->CurrentPeimCount] = PEIM_STATE_REGISITER_FOR_SHADOW;\r |
789 | \r | |
790 | return EFI_SUCCESS;\r | |
791 | }\r | |
792 | \r | |
288f9b38 LG |
793 | /**\r |
794 | Get Fv image from the FV type file, then install FV INFO ppi, Build FV hob.\r | |
795 | \r | |
b1f6a7c6 | 796 | @param PeiServices Pointer to the PEI Core Services Table.\r |
797 | @param FvFileHandle File handle of a Fv type file.\r | |
288f9b38 LG |
798 | @param AuthenticationState Pointer to attestation authentication state of image.\r |
799 | \r | |
58dcdada | 800 | \r |
b1f6a7c6 | 801 | @retval EFI_NOT_FOUND FV image can't be found.\r |
802 | @retval EFI_SUCCESS Successfully to process it.\r | |
288f9b38 LG |
803 | \r |
804 | **/\r | |
805 | EFI_STATUS\r | |
806 | ProcessFvFile (\r | |
807 | IN EFI_PEI_SERVICES **PeiServices,\r | |
808 | IN EFI_PEI_FILE_HANDLE FvFileHandle,\r | |
809 | OUT UINT32 *AuthenticationState\r | |
810 | )\r | |
811 | {\r | |
812 | EFI_STATUS Status;\r | |
813 | EFI_PEI_FV_HANDLE FvImageHandle;\r | |
814 | EFI_FV_INFO FvImageInfo;\r | |
815 | UINT32 FvAlignment;\r | |
816 | VOID *FvBuffer;\r | |
817 | EFI_PEI_HOB_POINTERS HobFv2;\r | |
58dcdada | 818 | \r |
288f9b38 LG |
819 | FvBuffer = NULL;\r |
820 | *AuthenticationState = 0;\r | |
821 | \r | |
822 | //\r | |
58dcdada | 823 | // Check if this EFI_FV_FILETYPE_FIRMWARE_VOLUME_IMAGE file has already\r |
288f9b38 LG |
824 | // been extracted.\r |
825 | //\r | |
826 | HobFv2.Raw = GetHobList ();\r | |
827 | while ((HobFv2.Raw = GetNextHob (EFI_HOB_TYPE_FV2, HobFv2.Raw)) != NULL) {\r | |
828 | if (CompareGuid (&(((EFI_FFS_FILE_HEADER *)FvFileHandle)->Name), &HobFv2.FirmwareVolume2->FileName)) {\r | |
829 | //\r | |
830 | // this FILE has been dispatched, it will not be dispatched again.\r | |
831 | //\r | |
832 | return EFI_SUCCESS;\r | |
833 | }\r | |
834 | HobFv2.Raw = GET_NEXT_HOB (HobFv2);\r | |
835 | }\r | |
58dcdada | 836 | \r |
288f9b38 LG |
837 | //\r |
838 | // Find FvImage in FvFile\r | |
839 | //\r | |
840 | Status = PeiFfsFindSectionData (\r | |
841 | (CONST EFI_PEI_SERVICES **) PeiServices,\r | |
842 | EFI_SECTION_FIRMWARE_VOLUME_IMAGE,\r | |
843 | FvFileHandle,\r | |
844 | (VOID **)&FvImageHandle\r | |
845 | );\r | |
58dcdada | 846 | \r |
288f9b38 LG |
847 | if (EFI_ERROR (Status)) {\r |
848 | return Status;\r | |
849 | }\r | |
850 | //\r | |
851 | // Collect FvImage Info.\r | |
852 | //\r | |
853 | Status = PeiFfsGetVolumeInfo (FvImageHandle, &FvImageInfo);\r | |
854 | ASSERT_EFI_ERROR (Status);\r | |
855 | //\r | |
856 | // FvAlignment must be more than 8 bytes required by FvHeader structure.\r | |
857 | //\r | |
858 | FvAlignment = 1 << ((FvImageInfo.FvAttributes & EFI_FVB2_ALIGNMENT) >> 16);\r | |
859 | if (FvAlignment < 8) {\r | |
860 | FvAlignment = 8;\r | |
861 | }\r | |
58dcdada | 862 | //\r |
288f9b38 LG |
863 | // Check FvImage\r |
864 | //\r | |
865 | if ((UINTN) FvImageInfo.FvStart % FvAlignment != 0) {\r | |
866 | FvBuffer = AllocateAlignedPages (EFI_SIZE_TO_PAGES ((UINT32) FvImageInfo.FvSize), FvAlignment);\r | |
867 | if (FvBuffer == NULL) {\r | |
868 | return EFI_OUT_OF_RESOURCES;\r | |
869 | }\r | |
870 | CopyMem (FvBuffer, FvImageInfo.FvStart, (UINTN) FvImageInfo.FvSize);\r | |
871 | //\r | |
872 | // Update FvImageInfo after reload FvImage to new aligned memory\r | |
873 | //\r | |
874 | PeiFfsGetVolumeInfo ((EFI_PEI_FV_HANDLE) FvBuffer, &FvImageInfo);\r | |
875 | }\r | |
58dcdada | 876 | \r |
288f9b38 LG |
877 | //\r |
878 | // Install FvPpi and Build FvHob\r | |
879 | //\r | |
880 | PiLibInstallFvInfoPpi (\r | |
881 | NULL,\r | |
882 | FvImageInfo.FvStart,\r | |
883 | (UINT32) FvImageInfo.FvSize,\r | |
884 | &(FvImageInfo.FvName),\r | |
885 | &(((EFI_FFS_FILE_HEADER*)FvFileHandle)->Name)\r | |
886 | );\r | |
887 | \r | |
888 | //\r | |
889 | // Inform HOB consumer phase, i.e. DXE core, the existance of this FV\r | |
890 | //\r | |
891 | BuildFvHob (\r | |
892 | (EFI_PHYSICAL_ADDRESS) (UINTN) FvImageInfo.FvStart,\r | |
893 | FvImageInfo.FvSize\r | |
894 | );\r | |
895 | //\r | |
896 | // Makes the encapsulated volume show up in DXE phase to skip processing of\r | |
897 | // encapsulated file again.\r | |
898 | //\r | |
899 | BuildFv2Hob (\r | |
900 | (EFI_PHYSICAL_ADDRESS) (UINTN) FvImageInfo.FvStart,\r | |
901 | FvImageInfo.FvSize,\r | |
902 | &FvImageInfo.FvName,\r | |
903 | &(((EFI_FFS_FILE_HEADER *)FvFileHandle)->Name)\r | |
904 | );\r | |
58dcdada | 905 | \r |
288f9b38 LG |
906 | return EFI_SUCCESS;\r |
907 | }\r |