]> git.proxmox.com Git - mirror_edk2.git/blame - UefiCpuPkg/Universal/Acpi/S3Resume2Pei/S3Resume.c
OvmfPkg: Support GCC47 toolchain
[mirror_edk2.git] / UefiCpuPkg / Universal / Acpi / S3Resume2Pei / S3Resume.c
CommitLineData
1f569620 1/** @file\r
2 This module produces the EFI_PEI_S3_RESUME_PPI.\r
3 This module works with StandAloneBootScriptExecutor to S3 resume to OS.\r
4 This module will excute the boot script saved during last boot and after that,\r
5 control is passed to OS waking up handler.\r
6\r
e47459e6 7 Copyright (c) 2006 - 2012, Intel Corporation. All rights reserved.<BR>\r
1f569620 8\r
9 This program and the accompanying materials\r
10 are licensed and made available under the terms and conditions\r
11 of the BSD License which accompanies this distribution. The\r
12 full text of the license may be found at\r
13 http://opensource.org/licenses/bsd-license.php\r
14\r
15 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
16 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
17\r
18**/\r
19\r
20#include <PiPei.h>\r
21\r
22#include <Guid/AcpiS3Context.h>\r
23#include <Guid/BootScriptExecutorVariable.h>\r
24#include <Guid/Performance.h>\r
25#include <Ppi/ReadOnlyVariable2.h>\r
26#include <Ppi/S3Resume2.h>\r
27#include <Ppi/SmmAccess.h>\r
28#include <Ppi/PostBootScriptTable.h>\r
29#include <Ppi/EndOfPeiPhase.h>\r
30\r
31#include <Library/DebugLib.h>\r
32#include <Library/BaseLib.h>\r
33#include <Library/TimerLib.h>\r
34#include <Library/PeimEntryPoint.h>\r
35#include <Library/PeiServicesLib.h>\r
36#include <Library/HobLib.h>\r
37#include <Library/PerformanceLib.h>\r
38#include <Library/PeiServicesTablePointerLib.h>\r
39#include <Library/IoLib.h>\r
40#include <Library/BaseMemoryLib.h>\r
41#include <Library/MemoryAllocationLib.h>\r
42#include <Library/PcdLib.h>\r
43#include <Library/DebugAgentLib.h>\r
44#include <Library/LocalApicLib.h>\r
45#include <Library/ReportStatusCodeLib.h>\r
46#include <Library/PrintLib.h>\r
c56b6566 47#include <Library/HobLib.h>\r
1f569620 48#include <Library/LockBoxLib.h>\r
49#include <IndustryStandard/Acpi.h>\r
50\r
51#pragma pack(1)\r
52typedef union {\r
53 struct {\r
54 UINT32 LimitLow : 16;\r
55 UINT32 BaseLow : 16;\r
56 UINT32 BaseMid : 8;\r
57 UINT32 Type : 4;\r
58 UINT32 System : 1;\r
59 UINT32 Dpl : 2;\r
60 UINT32 Present : 1;\r
61 UINT32 LimitHigh : 4;\r
62 UINT32 Software : 1;\r
63 UINT32 Reserved : 1;\r
64 UINT32 DefaultSize : 1;\r
65 UINT32 Granularity : 1;\r
66 UINT32 BaseHigh : 8;\r
67 } Bits;\r
68 UINT64 Uint64;\r
69} IA32_GDT;\r
70\r
71//\r
72// Page-Map Level-4 Offset (PML4) and\r
73// Page-Directory-Pointer Offset (PDPE) entries 4K & 2MB\r
74//\r
75typedef union {\r
76 struct {\r
77 UINT64 Present:1; // 0 = Not present in memory, 1 = Present in memory\r
78 UINT64 ReadWrite:1; // 0 = Read-Only, 1= Read/Write\r
79 UINT64 UserSupervisor:1; // 0 = Supervisor, 1=User\r
80 UINT64 WriteThrough:1; // 0 = Write-Back caching, 1=Write-Through caching\r
81 UINT64 CacheDisabled:1; // 0 = Cached, 1=Non-Cached\r
82 UINT64 Accessed:1; // 0 = Not accessed, 1 = Accessed (set by CPU)\r
83 UINT64 Reserved:1; // Reserved\r
84 UINT64 MustBeZero:2; // Must Be Zero\r
85 UINT64 Available:3; // Available for use by system software\r
86 UINT64 PageTableBaseAddress:40; // Page Table Base Address\r
87 UINT64 AvabilableHigh:11; // Available for use by system software\r
88 UINT64 Nx:1; // No Execute bit\r
89 } Bits;\r
90 UINT64 Uint64;\r
91} PAGE_MAP_AND_DIRECTORY_POINTER;\r
92\r
93//\r
94// Page Table Entry 2MB\r
95//\r
96typedef union {\r
97 struct {\r
98 UINT64 Present:1; // 0 = Not present in memory, 1 = Present in memory\r
99 UINT64 ReadWrite:1; // 0 = Read-Only, 1= Read/Write\r
100 UINT64 UserSupervisor:1; // 0 = Supervisor, 1=User\r
101 UINT64 WriteThrough:1; // 0 = Write-Back caching, 1=Write-Through caching\r
102 UINT64 CacheDisabled:1; // 0 = Cached, 1=Non-Cached\r
103 UINT64 Accessed:1; // 0 = Not accessed, 1 = Accessed (set by CPU)\r
104 UINT64 Dirty:1; // 0 = Not Dirty, 1 = written by processor on access to page\r
105 UINT64 MustBe1:1; // Must be 1 \r
106 UINT64 Global:1; // 0 = Not global page, 1 = global page TLB not cleared on CR3 write\r
107 UINT64 Available:3; // Available for use by system software\r
108 UINT64 PAT:1; //\r
109 UINT64 MustBeZero:8; // Must be zero;\r
110 UINT64 PageTableBaseAddress:31; // Page Table Base Address\r
111 UINT64 AvabilableHigh:11; // Available for use by system software\r
112 UINT64 Nx:1; // 0 = Execute Code, 1 = No Code Execution\r
113 } Bits;\r
114 UINT64 Uint64;\r
115} PAGE_TABLE_ENTRY;\r
116\r
c56b6566
JY
117//\r
118// Page Table Entry 1GB\r
119//\r
120typedef union {\r
121 struct {\r
122 UINT64 Present:1; // 0 = Not present in memory, 1 = Present in memory\r
123 UINT64 ReadWrite:1; // 0 = Read-Only, 1= Read/Write\r
124 UINT64 UserSupervisor:1; // 0 = Supervisor, 1=User\r
125 UINT64 WriteThrough:1; // 0 = Write-Back caching, 1=Write-Through caching\r
126 UINT64 CacheDisabled:1; // 0 = Cached, 1=Non-Cached\r
127 UINT64 Accessed:1; // 0 = Not accessed, 1 = Accessed (set by CPU)\r
128 UINT64 Dirty:1; // 0 = Not Dirty, 1 = written by processor on access to page\r
129 UINT64 MustBe1:1; // Must be 1 \r
130 UINT64 Global:1; // 0 = Not global page, 1 = global page TLB not cleared on CR3 write\r
131 UINT64 Available:3; // Available for use by system software\r
132 UINT64 PAT:1; //\r
133 UINT64 MustBeZero:17; // Must be zero;\r
134 UINT64 PageTableBaseAddress:22; // Page Table Base Address\r
135 UINT64 AvabilableHigh:11; // Available for use by system software\r
136 UINT64 Nx:1; // 0 = Execute Code, 1 = No Code Execution\r
137 } Bits;\r
138 UINT64 Uint64;\r
139} PAGE_TABLE_1G_ENTRY;\r
140\r
1f569620 141#pragma pack()\r
142\r
143//\r
144// Function prototypes\r
145//\r
146/**\r
147 a ASM function to transfer control to OS.\r
148 \r
149 @param S3WakingVector The S3 waking up vector saved in ACPI Facs table\r
150 @param AcpiLowMemoryBase a buffer under 1M which could be used during the transfer \r
151**/\r
152typedef\r
153VOID\r
154(EFIAPI *ASM_TRANSFER_CONTROL) (\r
155 IN UINT32 S3WakingVector,\r
156 IN UINT32 AcpiLowMemoryBase\r
157 );\r
158\r
159/**\r
160 Restores the platform to its preboot configuration for an S3 resume and\r
161 jumps to the OS waking vector.\r
162\r
163 This function will restore the platform to its pre-boot configuration that was\r
164 pre-stored in the boot script table and transfer control to OS waking vector.\r
165 Upon invocation, this function is responsible for locating the following\r
166 information before jumping to OS waking vector:\r
167 - ACPI tables\r
168 - boot script table\r
169 - any other information that it needs\r
170\r
171 The S3RestoreConfig() function then executes the pre-stored boot script table\r
172 and transitions the platform to the pre-boot state. The boot script is recorded\r
173 during regular boot using the EFI_S3_SAVE_STATE_PROTOCOL.Write() and\r
174 EFI_S3_SMM_SAVE_STATE_PROTOCOL.Write() functions. Finally, this function\r
175 transfers control to the OS waking vector. If the OS supports only a real-mode\r
176 waking vector, this function will switch from flat mode to real mode before\r
177 jumping to the waking vector. If all platform pre-boot configurations are\r
178 successfully restored and all other necessary information is ready, this\r
179 function will never return and instead will directly jump to the OS waking\r
180 vector. If this function returns, it indicates that the attempt to resume\r
181 from the ACPI S3 sleep state failed.\r
182\r
183 @param[in] This Pointer to this instance of the PEI_S3_RESUME_PPI\r
184\r
185 @retval EFI_ABORTED Execution of the S3 resume boot script table failed.\r
186 @retval EFI_NOT_FOUND Some necessary information that is used for the S3\r
187 resume boot path could not be located.\r
188\r
189**/\r
190EFI_STATUS\r
191EFIAPI\r
192S3RestoreConfig2 (\r
193 IN EFI_PEI_S3_RESUME2_PPI *This\r
194 );\r
195\r
196//\r
197// Globals\r
198//\r
199EFI_PEI_S3_RESUME2_PPI mS3ResumePpi = { S3RestoreConfig2 };\r
200\r
201EFI_PEI_PPI_DESCRIPTOR mPpiList = {\r
202 (EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST),\r
203 &gEfiPeiS3Resume2PpiGuid,\r
204 &mS3ResumePpi\r
205};\r
206\r
207EFI_PEI_PPI_DESCRIPTOR mPpiListPostScriptTable = {\r
208 (EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST),\r
209 &gPeiPostScriptTablePpiGuid,\r
210 0\r
211};\r
212\r
213EFI_PEI_PPI_DESCRIPTOR mPpiListEndOfPeiTable = {\r
214 (EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST),\r
215 &gEfiEndOfPeiSignalPpiGuid,\r
216 0\r
217};\r
218\r
219//\r
220// Global Descriptor Table (GDT)\r
221//\r
222GLOBAL_REMOVE_IF_UNREFERENCED IA32_GDT mGdtEntries[] = {\r
223/* selector { Global Segment Descriptor } */\r
224/* 0x00 */ {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}},\r
225/* 0x08 */ {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}},\r
226/* 0x10 */ {{0xFFFF, 0, 0, 0xB, 1, 0, 1, 0xF, 0, 0, 1, 1, 0}},\r
227/* 0x18 */ {{0xFFFF, 0, 0, 0x3, 1, 0, 1, 0xF, 0, 0, 1, 1, 0}},\r
228/* 0x20 */ {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}},\r
229/* 0x28 */ {{0xFFFF, 0, 0, 0xB, 1, 0, 1, 0xF, 0, 0, 0, 1, 0}},\r
230/* 0x30 */ {{0xFFFF, 0, 0, 0x3, 1, 0, 1, 0xF, 0, 0, 0, 1, 0}},\r
231/* 0x38 */ {{0xFFFF, 0, 0, 0xB, 1, 0, 1, 0xF, 0, 1, 0, 1, 0}},\r
232/* 0x40 */ {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}},\r
233};\r
234\r
235//\r
236// IA32 Gdt register\r
237//\r
238GLOBAL_REMOVE_IF_UNREFERENCED CONST IA32_DESCRIPTOR mGdt = {\r
239 sizeof (mGdtEntries) - 1,\r
240 (UINTN) mGdtEntries\r
241 };\r
242\r
243/**\r
244 Performance measure function to get S3 detailed performance data.\r
245\r
246 This function will getS3 detailed performance data and saved in pre-reserved ACPI memory.\r
247**/\r
248VOID\r
249WriteToOsS3PerformanceData (\r
250 VOID\r
251 )\r
252{\r
253 EFI_STATUS Status;\r
254 EFI_PHYSICAL_ADDRESS mAcpiLowMemoryBase;\r
255 PERF_HEADER *PerfHeader;\r
256 PERF_DATA *PerfData;\r
257 UINT64 Ticker;\r
258 UINTN Index;\r
259 EFI_PEI_READ_ONLY_VARIABLE2_PPI *VariableServices;\r
260 UINTN VarSize;\r
261 UINTN LogEntryKey;\r
262 CONST VOID *Handle;\r
263 CONST CHAR8 *Token;\r
264 CONST CHAR8 *Module;\r
265 UINT64 StartTicker;\r
266 UINT64 EndTicker;\r
267 UINT64 StartValue;\r
268 UINT64 EndValue;\r
269 BOOLEAN CountUp;\r
270 UINT64 Freq;\r
271\r
272 //\r
273 // Retrive time stamp count as early as possilbe\r
274 //\r
275 Ticker = GetPerformanceCounter ();\r
276\r
277 Freq = GetPerformanceCounterProperties (&StartValue, &EndValue);\r
278\r
279 Freq = DivU64x32 (Freq, 1000);\r
280\r
281 Status = PeiServicesLocatePpi (\r
282 &gEfiPeiReadOnlyVariable2PpiGuid,\r
283 0,\r
284 NULL,\r
285 (VOID **) &VariableServices\r
286 );\r
40ef06fc
SZ
287 if (EFI_ERROR (Status)) {\r
288 return;\r
289 }\r
1f569620 290\r
291 VarSize = sizeof (EFI_PHYSICAL_ADDRESS);\r
292 Status = VariableServices->GetVariable (\r
293 VariableServices,\r
294 L"PerfDataMemAddr",\r
295 &gPerformanceProtocolGuid,\r
296 NULL,\r
297 &VarSize,\r
298 &mAcpiLowMemoryBase\r
299 );\r
300 if (EFI_ERROR (Status)) {\r
301 DEBUG ((EFI_D_ERROR, "Fail to retrieve variable to log S3 performance data \n"));\r
302 return;\r
303 }\r
304\r
305 PerfHeader = (PERF_HEADER *) (UINTN) mAcpiLowMemoryBase;\r
306\r
307 if (PerfHeader->Signiture != PERFORMANCE_SIGNATURE) {\r
308 DEBUG ((EFI_D_ERROR, "Performance data in ACPI memory get corrupted! \n"));\r
309 return;\r
310 }\r
311\r
312 //\r
313 // Record total S3 resume time.\r
314 //\r
315 if (EndValue >= StartValue) {\r
316 PerfHeader->S3Resume = Ticker - StartValue;\r
317 CountUp = TRUE;\r
318 } else {\r
319 PerfHeader->S3Resume = StartValue - Ticker;\r
320 CountUp = FALSE;\r
321 }\r
322\r
323 //\r
324 // Get S3 detailed performance data\r
325 //\r
326 Index = 0;\r
327 LogEntryKey = 0;\r
328 while ((LogEntryKey = GetPerformanceMeasurement (\r
329 LogEntryKey,\r
330 &Handle,\r
331 &Token,\r
332 &Module,\r
333 &StartTicker,\r
334 &EndTicker)) != 0) {\r
335 if (EndTicker != 0) {\r
336 PerfData = &PerfHeader->S3Entry[Index];\r
337\r
338 //\r
339 // Use File Handle to specify the different performance log for PEIM.\r
340 // File Handle is the base address of PEIM FFS file.\r
341 //\r
342 if ((AsciiStrnCmp (Token, "PEIM", PEI_PERFORMANCE_STRING_SIZE) == 0) && (Handle != NULL)) {\r
343 AsciiSPrint (PerfData->Token, PERF_TOKEN_LENGTH, "0x%11p", Handle);\r
344 } else {\r
345 AsciiStrnCpy (PerfData->Token, Token, PERF_TOKEN_LENGTH);\r
346 }\r
347 if (StartTicker == 1) {\r
348 StartTicker = StartValue;\r
349 }\r
350 if (EndTicker == 1) {\r
351 EndTicker = StartValue;\r
352 }\r
353 Ticker = CountUp? (EndTicker - StartTicker) : (StartTicker - EndTicker);\r
354 PerfData->Duration = (UINT32) DivU64x32 (Ticker, (UINT32) Freq);\r
355\r
356 //\r
357 // Only Record > 1ms performance data so that more big performance can be recorded.\r
358 //\r
359 if ((Ticker > Freq) && (++Index >= PERF_PEI_ENTRY_MAX_NUM)) {\r
360 //\r
361 // Reach the maximum number of PEI performance log entries.\r
362 //\r
363 break;\r
364 }\r
365 }\r
366 }\r
367 PerfHeader->S3EntryNum = (UINT32) Index;\r
368}\r
369\r
370/**\r
371 Jump to OS waking vector.\r
372 The function will install boot script done PPI, report S3 resume status code, and then jump to OS waking vector.\r
373\r
374 @param AcpiS3Context a pointer to a structure of ACPI_S3_CONTEXT\r
375 @param PeiS3ResumeState a pointer to a structure of PEI_S3_RESUME_STATE\r
376**/\r
377VOID\r
378EFIAPI\r
379S3ResumeBootOs (\r
380 IN ACPI_S3_CONTEXT *AcpiS3Context,\r
381 IN PEI_S3_RESUME_STATE *PeiS3ResumeState\r
382 )\r
383{\r
384 EFI_STATUS Status;\r
385 EFI_ACPI_4_0_FIRMWARE_ACPI_CONTROL_STRUCTURE *Facs;\r
386 ASM_TRANSFER_CONTROL AsmTransferControl;\r
387 UINTN TempStackTop;\r
388 UINTN TempStack[0x10];\r
389\r
390 //\r
391 // Restore IDT\r
392 //\r
393 AsmWriteIdtr (&PeiS3ResumeState->Idtr);\r
394\r
5c0687cc
SZ
395 PERF_END (NULL, "ScriptExec", NULL, 0);\r
396\r
1f569620 397 //\r
398 // Install BootScriptDonePpi\r
399 //\r
400 Status = PeiServicesInstallPpi (&mPpiListPostScriptTable);\r
401 ASSERT_EFI_ERROR (Status);\r
402\r
403 //\r
404 // Get ACPI Table Address\r
405 //\r
406 Facs = (EFI_ACPI_4_0_FIRMWARE_ACPI_CONTROL_STRUCTURE *) ((UINTN) (AcpiS3Context->AcpiFacsTable));\r
407\r
408 if ((Facs == NULL) ||\r
409 (Facs->Signature != EFI_ACPI_4_0_FIRMWARE_ACPI_CONTROL_STRUCTURE_SIGNATURE) ||\r
410 ((Facs->FirmwareWakingVector == 0) && (Facs->XFirmwareWakingVector == 0)) ) {\r
411 CpuDeadLoop ();\r
412 return ;\r
413 }\r
414\r
1f569620 415 //\r
416 // Install EndOfPeiPpi\r
417 //\r
418 Status = PeiServicesInstallPpi (&mPpiListEndOfPeiTable);\r
419 ASSERT_EFI_ERROR (Status);\r
420\r
26c0ba77
SZ
421 //\r
422 // report status code on S3 resume\r
423 //\r
424 REPORT_STATUS_CODE (EFI_PROGRESS_CODE, EFI_SOFTWARE_PEI_MODULE | EFI_SW_PEI_PC_OS_WAKE);\r
425\r
1f569620 426 PERF_CODE (\r
427 WriteToOsS3PerformanceData ();\r
428 );\r
429\r
430 AsmTransferControl = (ASM_TRANSFER_CONTROL)(UINTN)PeiS3ResumeState->AsmTransferControl;\r
431 if (Facs->XFirmwareWakingVector != 0) {\r
432 //\r
433 // Switch to native waking vector\r
434 //\r
435 TempStackTop = (UINTN)&TempStack + sizeof(TempStack);\r
436 if ((Facs->Version == EFI_ACPI_4_0_FIRMWARE_ACPI_CONTROL_STRUCTURE_VERSION) &&\r
437 ((Facs->Flags & EFI_ACPI_4_0_64BIT_WAKE_SUPPORTED_F) != 0) &&\r
438 ((Facs->Flags & EFI_ACPI_4_0_OSPM_64BIT_WAKE__F) != 0)) {\r
439 //\r
440 // X64 long mode waking vector\r
441 //\r
442 DEBUG (( EFI_D_ERROR, "Transfer to 64bit OS waking vector - %x\r\n", (UINTN)Facs->XFirmwareWakingVector));\r
443 if (FeaturePcdGet (PcdDxeIplSwitchToLongMode)) {\r
444 AsmEnablePaging64 (\r
445 0x38,\r
446 Facs->XFirmwareWakingVector,\r
447 0,\r
448 0,\r
449 (UINT64)(UINTN)TempStackTop\r
450 );\r
451 } else {\r
452 DEBUG (( EFI_D_ERROR, "Unsupported for 32bit DXE transfer to 64bit OS waking vector!\r\n"));\r
453 ASSERT (FALSE);\r
454 }\r
455 } else {\r
456 //\r
457 // IA32 protected mode waking vector (Page disabled)\r
458 //\r
459 DEBUG (( EFI_D_ERROR, "Transfer to 32bit OS waking vector - %x\r\n", (UINTN)Facs->XFirmwareWakingVector));\r
460 SwitchStack (\r
461 (SWITCH_STACK_ENTRY_POINT) (UINTN) Facs->XFirmwareWakingVector,\r
462 NULL,\r
463 NULL,\r
464 (VOID *)(UINTN)TempStackTop\r
465 );\r
466 }\r
467 } else {\r
468 //\r
469 // 16bit Realmode waking vector\r
470 //\r
471 DEBUG (( EFI_D_ERROR, "Transfer to 16bit OS waking vector - %x\r\n", (UINTN)Facs->FirmwareWakingVector));\r
472 AsmTransferControl (Facs->FirmwareWakingVector, 0x0);\r
473 }\r
474\r
475 //\r
476 // Never run to here\r
477 //\r
478 CpuDeadLoop();\r
479}\r
480\r
481/**\r
482 Restore S3 page table because we do not trust ACPINvs content.\r
483 If BootScriptExector driver will not run in 64-bit mode, this function will do nothing. \r
484\r
485 @param S3NvsPageTableAddress PageTableAddress in ACPINvs\r
486**/\r
487VOID\r
488RestoreS3PageTables (\r
489 IN UINTN S3NvsPageTableAddress\r
490 )\r
491{\r
492 if (FeaturePcdGet (PcdDxeIplSwitchToLongMode)) {\r
493 UINT32 RegEax;\r
c56b6566 494 UINT32 RegEdx;\r
1f569620 495 UINT8 PhysicalAddressBits;\r
496 EFI_PHYSICAL_ADDRESS PageAddress;\r
497 UINTN IndexOfPml4Entries;\r
498 UINTN IndexOfPdpEntries;\r
499 UINTN IndexOfPageDirectoryEntries;\r
c56b6566
JY
500 UINT32 NumberOfPml4EntriesNeeded;\r
501 UINT32 NumberOfPdpEntriesNeeded;\r
1f569620 502 PAGE_MAP_AND_DIRECTORY_POINTER *PageMapLevel4Entry;\r
503 PAGE_MAP_AND_DIRECTORY_POINTER *PageMap;\r
504 PAGE_MAP_AND_DIRECTORY_POINTER *PageDirectoryPointerEntry;\r
505 PAGE_TABLE_ENTRY *PageDirectoryEntry;\r
c56b6566
JY
506 VOID *Hob;\r
507 BOOLEAN Page1GSupport;\r
508 PAGE_TABLE_1G_ENTRY *PageDirectory1GEntry;\r
1f569620 509\r
510 //\r
511 // NOTE: We have to ASSUME the page table generation format, because we do not know whole page table information.\r
512 // The whole page table is too large to be saved in SMRAM.\r
513 //\r
514 // The assumption is : whole page table is allocated in CONTINOUS memory and CR3 points to TOP page.\r
515 //\r
516 DEBUG ((EFI_D_ERROR, "S3NvsPageTableAddress - %x\n", S3NvsPageTableAddress));\r
517\r
518 //\r
519 // By architecture only one PageMapLevel4 exists - so lets allocate storgage for it.\r
520 //\r
521 PageMap = (PAGE_MAP_AND_DIRECTORY_POINTER *)S3NvsPageTableAddress;\r
522 S3NvsPageTableAddress += SIZE_4KB;\r
523 \r
c56b6566 524 Page1GSupport = FALSE;\r
378175d2
JY
525 if (PcdGetBool(PcdUse1GPageTable)) {\r
526 AsmCpuid (0x80000000, &RegEax, NULL, NULL, NULL);\r
527 if (RegEax >= 0x80000001) {\r
528 AsmCpuid (0x80000001, NULL, NULL, NULL, &RegEdx);\r
529 if ((RegEdx & BIT26) != 0) {\r
530 Page1GSupport = TRUE;\r
531 }\r
c56b6566
JY
532 }\r
533 }\r
534 \r
1f569620 535 //\r
536 // Get physical address bits supported.\r
537 //\r
c56b6566
JY
538 Hob = GetFirstHob (EFI_HOB_TYPE_CPU);\r
539 if (Hob != NULL) {\r
540 PhysicalAddressBits = ((EFI_HOB_CPU *) Hob)->SizeOfMemorySpace;\r
1f569620 541 } else {\r
c56b6566
JY
542 AsmCpuid (0x80000000, &RegEax, NULL, NULL, NULL);\r
543 if (RegEax >= 0x80000008) {\r
544 AsmCpuid (0x80000008, &RegEax, NULL, NULL, NULL);\r
545 PhysicalAddressBits = (UINT8) RegEax;\r
546 } else {\r
547 PhysicalAddressBits = 36;\r
548 }\r
1f569620 549 }\r
550 \r
c56b6566
JY
551 //\r
552 // IA-32e paging translates 48-bit linear addresses to 52-bit physical addresses.\r
553 //\r
554 ASSERT (PhysicalAddressBits <= 52);\r
555 if (PhysicalAddressBits > 48) {\r
556 PhysicalAddressBits = 48;\r
557 }\r
558\r
1f569620 559 //\r
560 // Calculate the table entries needed.\r
561 //\r
562 if (PhysicalAddressBits <= 39) {\r
563 NumberOfPml4EntriesNeeded = 1;\r
c56b6566 564 NumberOfPdpEntriesNeeded = (UINT32)LShiftU64 (1, (PhysicalAddressBits - 30));\r
1f569620 565 } else {\r
c56b6566 566 NumberOfPml4EntriesNeeded = (UINT32)LShiftU64 (1, (PhysicalAddressBits - 39));\r
1f569620 567 NumberOfPdpEntriesNeeded = 512;\r
568 }\r
569 \r
570 PageMapLevel4Entry = PageMap;\r
571 PageAddress = 0;\r
572 for (IndexOfPml4Entries = 0; IndexOfPml4Entries < NumberOfPml4EntriesNeeded; IndexOfPml4Entries++, PageMapLevel4Entry++) {\r
573 //\r
574 // Each PML4 entry points to a page of Page Directory Pointer entires.\r
575 // So lets allocate space for them and fill them in in the IndexOfPdpEntries loop.\r
576 //\r
577 PageDirectoryPointerEntry = (PAGE_MAP_AND_DIRECTORY_POINTER *)S3NvsPageTableAddress;\r
578 S3NvsPageTableAddress += SIZE_4KB;\r
579 \r
580 //\r
581 // Make a PML4 Entry\r
582 //\r
583 PageMapLevel4Entry->Uint64 = (UINT64)(UINTN)PageDirectoryPointerEntry;\r
584 PageMapLevel4Entry->Bits.ReadWrite = 1;\r
585 PageMapLevel4Entry->Bits.Present = 1;\r
c56b6566
JY
586\r
587 if (Page1GSupport) {\r
54d3b84e 588 PageDirectory1GEntry = (VOID *) PageDirectoryPointerEntry;\r
1f569620 589 \r
c56b6566 590 for (IndexOfPageDirectoryEntries = 0; IndexOfPageDirectoryEntries < 512; IndexOfPageDirectoryEntries++, PageDirectory1GEntry++, PageAddress += SIZE_1GB) {\r
1f569620 591 //\r
592 // Fill in the Page Directory entries\r
593 //\r
c56b6566
JY
594 PageDirectory1GEntry->Uint64 = (UINT64)PageAddress;\r
595 PageDirectory1GEntry->Bits.ReadWrite = 1;\r
596 PageDirectory1GEntry->Bits.Present = 1;\r
597 PageDirectory1GEntry->Bits.MustBe1 = 1;\r
598 }\r
599 } else {\r
600 for (IndexOfPdpEntries = 0; IndexOfPdpEntries < NumberOfPdpEntriesNeeded; IndexOfPdpEntries++, PageDirectoryPointerEntry++) {\r
601 //\r
602 // Each Directory Pointer entries points to a page of Page Directory entires.\r
603 // So allocate space for them and fill them in in the IndexOfPageDirectoryEntries loop.\r
604 // \r
605 PageDirectoryEntry = (PAGE_TABLE_ENTRY *)S3NvsPageTableAddress;\r
606 S3NvsPageTableAddress += SIZE_4KB;\r
607 \r
608 //\r
609 // Fill in a Page Directory Pointer Entries\r
610 //\r
611 PageDirectoryPointerEntry->Uint64 = (UINT64)(UINTN)PageDirectoryEntry;\r
612 PageDirectoryPointerEntry->Bits.ReadWrite = 1;\r
613 PageDirectoryPointerEntry->Bits.Present = 1;\r
614 \r
615 for (IndexOfPageDirectoryEntries = 0; IndexOfPageDirectoryEntries < 512; IndexOfPageDirectoryEntries++, PageDirectoryEntry++, PageAddress += SIZE_2MB) {\r
616 //\r
617 // Fill in the Page Directory entries\r
618 //\r
619 PageDirectoryEntry->Uint64 = (UINT64)PageAddress;\r
620 PageDirectoryEntry->Bits.ReadWrite = 1;\r
621 PageDirectoryEntry->Bits.Present = 1;\r
622 PageDirectoryEntry->Bits.MustBe1 = 1;\r
623 }\r
1f569620 624 }\r
625 }\r
626 }\r
627 return ;\r
628 } else {\r
629 //\r
630 // If DXE is running 32-bit mode, no need to establish page table.\r
631 //\r
632 return ;\r
633 }\r
634}\r
635\r
636/**\r
637 Jump to boot script executor driver.\r
638\r
639 The function will close and lock SMRAM and then jump to boot script execute driver to executing S3 boot script table.\r
640\r
641 @param AcpiS3Context a pointer to a structure of ACPI_S3_CONTEXT\r
642 @param EfiBootScriptExecutorVariable The function entry to executing S3 boot Script table. This function is build in\r
643 boot script execute driver\r
644**/\r
645VOID\r
646EFIAPI\r
647S3ResumeExecuteBootScript (\r
648 IN ACPI_S3_CONTEXT *AcpiS3Context,\r
649 IN BOOT_SCRIPT_EXECUTOR_VARIABLE *EfiBootScriptExecutorVariable\r
650 )\r
651{\r
652 EFI_STATUS Status;\r
653 PEI_SMM_ACCESS_PPI *SmmAccess;\r
654 UINTN Index;\r
655 VOID *GuidHob;\r
656 IA32_DESCRIPTOR *IdtDescriptor;\r
657 VOID *IdtBuffer;\r
658 PEI_S3_RESUME_STATE *PeiS3ResumeState;\r
659\r
660 DEBUG ((EFI_D_ERROR, "S3ResumeExecuteBootScript()\n"));\r
661\r
662 //\r
663 // Attempt to use content from SMRAM first\r
664 //\r
665 GuidHob = GetFirstGuidHob (&gEfiAcpiVariableGuid);\r
666 if (GuidHob != NULL) {\r
667 //\r
668 // Last step for SMM - send SMI for initialization\r
669 //\r
670\r
671 //\r
672 // Send SMI to APs\r
673 // \r
674 SendSmiIpiAllExcludingSelf ();\r
675 //\r
676 // Send SMI to BSP\r
677 //\r
678 SendSmiIpi (GetApicId ());\r
679\r
680 Status = PeiServicesLocatePpi (\r
681 &gPeiSmmAccessPpiGuid,\r
682 0,\r
683 NULL,\r
684 (VOID **) &SmmAccess\r
685 );\r
40ef06fc
SZ
686 if (!EFI_ERROR (Status)) {\r
687 DEBUG ((EFI_D_ERROR, "Close all SMRAM regions before executing boot script\n"));\r
688 \r
689 for (Index = 0, Status = EFI_SUCCESS; !EFI_ERROR (Status); Index++) {\r
690 Status = SmmAccess->Close ((EFI_PEI_SERVICES **)GetPeiServicesTablePointer (), SmmAccess, Index);\r
691 }\r
1f569620 692\r
40ef06fc
SZ
693 DEBUG ((EFI_D_ERROR, "Lock all SMRAM regions before executing boot script\n"));\r
694 \r
695 for (Index = 0, Status = EFI_SUCCESS; !EFI_ERROR (Status); Index++) {\r
696 Status = SmmAccess->Lock ((EFI_PEI_SERVICES **)GetPeiServicesTablePointer (), SmmAccess, Index);\r
697 }\r
1f569620 698 }\r
699 }\r
700\r
701 if (FeaturePcdGet (PcdDxeIplSwitchToLongMode)) {\r
1f569620 702 AsmWriteCr3 ((UINTN)AcpiS3Context->S3NvsPageTableAddress);\r
703 }\r
704\r
705 if (FeaturePcdGet (PcdFrameworkCompatibilitySupport)) {\r
706 //\r
707 // On some platform, such as ECP, a dispatch node in boot script table may execute a 32-bit PEIM which may need PeiServices\r
708 // pointer. So PeiServices need preserve in (IDTBase- sizeof (UINTN)). \r
709 //\r
710 IdtDescriptor = (IA32_DESCRIPTOR *) (UINTN) (AcpiS3Context->IdtrProfile);\r
711 //\r
712 // Make sure the newly allcated IDT align with 16-bytes\r
713 // \r
714 IdtBuffer = AllocatePages (EFI_SIZE_TO_PAGES((IdtDescriptor->Limit + 1) + 16));\r
715 ASSERT (IdtBuffer != NULL);\r
e47459e6 716 //\r
717 // Additional 16 bytes allocated to save IA32 IDT descriptor and Pei Service Table Pointer\r
718 // IA32 IDT descriptor will be used to setup IA32 IDT table for 32-bit Framework Boot Script code\r
719 // \r
720 ZeroMem (IdtBuffer, 16);\r
721 AsmReadIdtr ((IA32_DESCRIPTOR *)IdtBuffer);\r
1f569620 722 CopyMem ((VOID*)((UINT8*)IdtBuffer + 16),(VOID*)(IdtDescriptor->Base), (IdtDescriptor->Limit + 1));\r
723 IdtDescriptor->Base = (UINTN)((UINT8*)IdtBuffer + 16);\r
724 *(UINTN*)(IdtDescriptor->Base - sizeof(UINTN)) = (UINTN)GetPeiServicesTablePointer ();\r
725 }\r
726\r
727 //\r
728 // Need to make sure the GDT is loaded with values that support long mode and real mode.\r
729 //\r
730 AsmWriteGdtr (&mGdt);\r
731\r
732 //\r
733 // Prepare data for return back\r
734 //\r
735 PeiS3ResumeState = AllocatePool (sizeof(*PeiS3ResumeState));\r
736 ASSERT (PeiS3ResumeState != NULL);\r
737 DEBUG (( EFI_D_ERROR, "PeiS3ResumeState - %x\r\n", PeiS3ResumeState));\r
738 PeiS3ResumeState->ReturnCs = 0x10;\r
739 PeiS3ResumeState->ReturnEntryPoint = (EFI_PHYSICAL_ADDRESS)(UINTN)S3ResumeBootOs;\r
740 PeiS3ResumeState->ReturnStackPointer = (EFI_PHYSICAL_ADDRESS)(UINTN)&Status;\r
741 //\r
742 // Save IDT\r
743 //\r
744 AsmReadIdtr (&PeiS3ResumeState->Idtr);\r
745\r
5c0687cc
SZ
746 PERF_START (NULL, "ScriptExec", NULL, 0);\r
747\r
1f569620 748 if (FeaturePcdGet (PcdDxeIplSwitchToLongMode)) {\r
749 //\r
750 // X64 S3 Resume\r
751 //\r
752 DEBUG (( EFI_D_ERROR, "Enable X64 and transfer control to Standalone Boot Script Executor\r\n"));\r
753\r
754 //\r
755 // Switch to long mode to complete resume.\r
756 //\r
757 AsmEnablePaging64 (\r
758 0x38,\r
759 EfiBootScriptExecutorVariable->BootScriptExecutorEntrypoint,\r
760 (UINT64)(UINTN)AcpiS3Context,\r
761 (UINT64)(UINTN)PeiS3ResumeState,\r
762 (UINT64)(UINTN)(AcpiS3Context->BootScriptStackBase + AcpiS3Context->BootScriptStackSize)\r
763 );\r
764 } else {\r
765 //\r
766 // IA32 S3 Resume\r
767 //\r
768 DEBUG (( EFI_D_ERROR, "transfer control to Standalone Boot Script Executor\r\n"));\r
769 SwitchStack (\r
770 (SWITCH_STACK_ENTRY_POINT) (UINTN) EfiBootScriptExecutorVariable->BootScriptExecutorEntrypoint,\r
771 (VOID *)AcpiS3Context,\r
772 (VOID *)PeiS3ResumeState,\r
773 (VOID *)(UINTN)(AcpiS3Context->BootScriptStackBase + AcpiS3Context->BootScriptStackSize)\r
774 );\r
775 }\r
776\r
777 //\r
778 // Never run to here\r
779 //\r
780 CpuDeadLoop();\r
781}\r
782/**\r
783 Restores the platform to its preboot configuration for an S3 resume and\r
784 jumps to the OS waking vector.\r
785\r
786 This function will restore the platform to its pre-boot configuration that was\r
787 pre-stored in the boot script table and transfer control to OS waking vector.\r
788 Upon invocation, this function is responsible for locating the following\r
789 information before jumping to OS waking vector:\r
790 - ACPI tables\r
791 - boot script table\r
792 - any other information that it needs\r
793\r
794 The S3RestoreConfig() function then executes the pre-stored boot script table\r
795 and transitions the platform to the pre-boot state. The boot script is recorded\r
796 during regular boot using the EFI_S3_SAVE_STATE_PROTOCOL.Write() and\r
797 EFI_S3_SMM_SAVE_STATE_PROTOCOL.Write() functions. Finally, this function\r
798 transfers control to the OS waking vector. If the OS supports only a real-mode\r
799 waking vector, this function will switch from flat mode to real mode before\r
800 jumping to the waking vector. If all platform pre-boot configurations are\r
801 successfully restored and all other necessary information is ready, this\r
802 function will never return and instead will directly jump to the OS waking\r
803 vector. If this function returns, it indicates that the attempt to resume\r
804 from the ACPI S3 sleep state failed.\r
805\r
806 @param[in] This Pointer to this instance of the PEI_S3_RESUME_PPI\r
807\r
808 @retval EFI_ABORTED Execution of the S3 resume boot script table failed.\r
809 @retval EFI_NOT_FOUND Some necessary information that is used for the S3\r
810 resume boot path could not be located.\r
811\r
812**/\r
813EFI_STATUS\r
814EFIAPI\r
815S3RestoreConfig2 (\r
816 IN EFI_PEI_S3_RESUME2_PPI *This\r
817 )\r
818{\r
819 EFI_STATUS Status;\r
820 PEI_SMM_ACCESS_PPI *SmmAccess;\r
821 UINTN Index;\r
822 ACPI_S3_CONTEXT *AcpiS3Context;\r
1f569620 823 EFI_PHYSICAL_ADDRESS TempEfiBootScriptExecutorVariable;\r
824 EFI_PHYSICAL_ADDRESS TempAcpiS3Context;\r
825 BOOT_SCRIPT_EXECUTOR_VARIABLE *EfiBootScriptExecutorVariable;\r
826 UINTN VarSize;\r
827 EFI_SMRAM_DESCRIPTOR *SmramDescriptor;\r
828 SMM_S3_RESUME_STATE *SmmS3ResumeState;\r
829 VOID *GuidHob;\r
830\r
831 DEBUG ((EFI_D_ERROR, "Enter S3 PEIM\r\n"));\r
832\r
1f569620 833 VarSize = sizeof (EFI_PHYSICAL_ADDRESS);\r
834 Status = RestoreLockBox (\r
835 &gEfiAcpiVariableGuid,\r
836 &TempAcpiS3Context,\r
837 &VarSize\r
838 );\r
839 ASSERT_EFI_ERROR (Status);\r
840\r
841 AcpiS3Context = (ACPI_S3_CONTEXT *)(UINTN)TempAcpiS3Context;\r
842 ASSERT (AcpiS3Context != NULL);\r
843\r
844 Status = RestoreLockBox (\r
845 &gEfiAcpiS3ContextGuid,\r
846 NULL,\r
847 NULL\r
848 );\r
849 ASSERT_EFI_ERROR (Status);\r
850\r
851 VarSize = sizeof (TempEfiBootScriptExecutorVariable);\r
852 Status = RestoreLockBox (\r
853 &gEfiBootScriptExecutorVariableGuid,\r
854 &TempEfiBootScriptExecutorVariable,\r
855 &VarSize\r
856 );\r
857 ASSERT_EFI_ERROR (Status);\r
858\r
859 Status = RestoreLockBox (\r
860 &gEfiBootScriptExecutorContextGuid,\r
861 NULL,\r
862 NULL\r
863 );\r
864 ASSERT_EFI_ERROR (Status);\r
865\r
866 EfiBootScriptExecutorVariable = (BOOT_SCRIPT_EXECUTOR_VARIABLE *) (UINTN) TempEfiBootScriptExecutorVariable;\r
867\r
868 DEBUG (( EFI_D_ERROR, "AcpiS3Context = %x\n", AcpiS3Context));\r
869 DEBUG (( EFI_D_ERROR, "Waking Vector = %x\n", ((EFI_ACPI_2_0_FIRMWARE_ACPI_CONTROL_STRUCTURE *) ((UINTN) (AcpiS3Context->AcpiFacsTable)))->FirmwareWakingVector));\r
870 DEBUG (( EFI_D_ERROR, "AcpiS3Context->AcpiFacsTable = %x\n", AcpiS3Context->AcpiFacsTable));\r
871 DEBUG (( EFI_D_ERROR, "AcpiS3Context->S3NvsPageTableAddress = %x\n", AcpiS3Context->S3NvsPageTableAddress));\r
872 DEBUG (( EFI_D_ERROR, "AcpiS3Context->S3DebugBufferAddress = %x\n", AcpiS3Context->S3DebugBufferAddress));\r
873 DEBUG (( EFI_D_ERROR, "EfiBootScriptExecutorVariable->BootScriptExecutorEntrypoint = %x\n", EfiBootScriptExecutorVariable->BootScriptExecutorEntrypoint));\r
874\r
875 //\r
876 // Additional step for BootScript integrity - we only handle BootScript and BootScriptExecutor.\r
877 // Script dispatch image and context (parameter) are handled by platform.\r
878 // We just use restore all lock box in place, no need restore one by one.\r
879 //\r
880 Status = RestoreAllLockBoxInPlace ();\r
881 ASSERT_EFI_ERROR (Status);\r
882 if (EFI_ERROR (Status)) {\r
883 // Something wrong\r
884 CpuDeadLoop ();\r
885 }\r
886\r
3a69f7cb 887 if (FeaturePcdGet (PcdDxeIplSwitchToLongMode)) {\r
888 //\r
889 // Need reconstruct page table here, since we do not trust ACPINvs.\r
890 //\r
891 RestoreS3PageTables ((UINTN)AcpiS3Context->S3NvsPageTableAddress);\r
892 }\r
893\r
1f569620 894 //\r
895 // Attempt to use content from SMRAM first\r
896 //\r
897 GuidHob = GetFirstGuidHob (&gEfiAcpiVariableGuid);\r
898 if (GuidHob != NULL) {\r
40ef06fc
SZ
899 Status = PeiServicesLocatePpi (\r
900 &gPeiSmmAccessPpiGuid,\r
901 0,\r
902 NULL,\r
903 (VOID **) &SmmAccess\r
904 );\r
905 for (Index = 0; !EFI_ERROR (Status); Index++) {\r
906 Status = SmmAccess->Open ((EFI_PEI_SERVICES **)GetPeiServicesTablePointer (), SmmAccess, Index);\r
907 }\r
908\r
1f569620 909 SmramDescriptor = (EFI_SMRAM_DESCRIPTOR *) GET_GUID_HOB_DATA (GuidHob);\r
910 SmmS3ResumeState = (SMM_S3_RESUME_STATE *)(UINTN)SmramDescriptor->CpuStart;\r
911\r
912 SmmS3ResumeState->ReturnCs = AsmReadCs ();\r
913 SmmS3ResumeState->ReturnEntryPoint = (EFI_PHYSICAL_ADDRESS)(UINTN)S3ResumeExecuteBootScript;\r
914 SmmS3ResumeState->ReturnContext1 = (EFI_PHYSICAL_ADDRESS)(UINTN)AcpiS3Context;\r
915 SmmS3ResumeState->ReturnContext2 = (EFI_PHYSICAL_ADDRESS)(UINTN)EfiBootScriptExecutorVariable;\r
916 SmmS3ResumeState->ReturnStackPointer = (EFI_PHYSICAL_ADDRESS)(UINTN)&Status;\r
917\r
918 DEBUG (( EFI_D_ERROR, "SMM S3 Signature = %x\n", SmmS3ResumeState->Signature));\r
919 DEBUG (( EFI_D_ERROR, "SMM S3 Stack Base = %x\n", SmmS3ResumeState->SmmS3StackBase));\r
920 DEBUG (( EFI_D_ERROR, "SMM S3 Stack Size = %x\n", SmmS3ResumeState->SmmS3StackSize));\r
921 DEBUG (( EFI_D_ERROR, "SMM S3 Resume Entry Point = %x\n", SmmS3ResumeState->SmmS3ResumeEntryPoint));\r
922 DEBUG (( EFI_D_ERROR, "SMM S3 CR0 = %x\n", SmmS3ResumeState->SmmS3Cr0));\r
923 DEBUG (( EFI_D_ERROR, "SMM S3 CR3 = %x\n", SmmS3ResumeState->SmmS3Cr3));\r
924 DEBUG (( EFI_D_ERROR, "SMM S3 CR4 = %x\n", SmmS3ResumeState->SmmS3Cr4));\r
925 DEBUG (( EFI_D_ERROR, "SMM S3 Return CS = %x\n", SmmS3ResumeState->ReturnCs));\r
926 DEBUG (( EFI_D_ERROR, "SMM S3 Return Entry Point = %x\n", SmmS3ResumeState->ReturnEntryPoint));\r
927 DEBUG (( EFI_D_ERROR, "SMM S3 Return Context1 = %x\n", SmmS3ResumeState->ReturnContext1));\r
928 DEBUG (( EFI_D_ERROR, "SMM S3 Return Context2 = %x\n", SmmS3ResumeState->ReturnContext2));\r
929 DEBUG (( EFI_D_ERROR, "SMM S3 Return Stack Pointer = %x\n", SmmS3ResumeState->ReturnStackPointer));\r
930 DEBUG (( EFI_D_ERROR, "SMM S3 Smst = %x\n", SmmS3ResumeState->Smst));\r
931\r
932 //\r
933 // Disable interrupt of Debug timer.\r
934 //\r
935 SaveAndSetDebugTimerInterrupt (FALSE);\r
936\r
937 if (SmmS3ResumeState->Signature == SMM_S3_RESUME_SMM_32) {\r
938 SwitchStack (\r
939 (SWITCH_STACK_ENTRY_POINT)(UINTN)SmmS3ResumeState->SmmS3ResumeEntryPoint,\r
940 (VOID *)AcpiS3Context,\r
941 0,\r
942 (VOID *)(UINTN)(SmmS3ResumeState->SmmS3StackBase + SmmS3ResumeState->SmmS3StackSize)\r
943 );\r
944 }\r
945 if (SmmS3ResumeState->Signature == SMM_S3_RESUME_SMM_64) {\r
946 //\r
947 // Switch to long mode to complete resume.\r
948 //\r
949\r
950 //\r
951 // Need to make sure the GDT is loaded with values that support long mode and real mode.\r
952 //\r
953 AsmWriteGdtr (&mGdt);\r
954 AsmWriteCr3 ((UINTN)SmmS3ResumeState->SmmS3Cr3);\r
955 AsmEnablePaging64 (\r
956 0x38,\r
957 SmmS3ResumeState->SmmS3ResumeEntryPoint,\r
958 (UINT64)(UINTN)AcpiS3Context,\r
959 0,\r
960 SmmS3ResumeState->SmmS3StackBase + SmmS3ResumeState->SmmS3StackSize\r
961 );\r
962 }\r
963\r
964 }\r
965\r
966 S3ResumeExecuteBootScript (AcpiS3Context, EfiBootScriptExecutorVariable );\r
967 return EFI_SUCCESS;\r
968}\r
969/**\r
970 Main entry for S3 Resume PEIM.\r
971\r
972 This routine is to install EFI_PEI_S3_RESUME2_PPI.\r
973 \r
974 @param FileHandle Handle of the file being invoked.\r
975 @param PeiServices Pointer to PEI Services table.\r
976\r
977 @retval EFI_SUCCESS S3Resume Ppi is installed successfully.\r
978\r
979**/\r
980EFI_STATUS\r
981EFIAPI\r
982PeimS3ResumeEntryPoint (\r
983 IN EFI_PEI_FILE_HANDLE FileHandle,\r
984 IN CONST EFI_PEI_SERVICES **PeiServices\r
985 )\r
986{\r
987 EFI_STATUS Status;\r
988\r
989 //\r
990 // Install S3 Resume Ppi\r
991 //\r
992 Status = (**PeiServices).InstallPpi (PeiServices, &mPpiList);\r
993 ASSERT_EFI_ERROR (Status);\r
994\r
995 return EFI_SUCCESS;\r
996}\r
997\r