2 Main SEC phase code. Transitions to PEI.
4 Copyright (c) 2008 - 2011, Intel Corporation. All rights reserved.<BR>
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
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.
18 #include <Library/PeimEntryPoint.h>
19 #include <Library/BaseLib.h>
20 #include <Library/DebugLib.h>
21 #include <Library/BaseMemoryLib.h>
22 #include <Library/PeiServicesLib.h>
23 #include <Library/PcdLib.h>
24 #include <Library/UefiCpuLib.h>
25 #include <Library/DebugAgentLib.h>
26 #include <Library/IoLib.h>
27 #include <Library/PeCoffLib.h>
28 #include <Library/PeCoffGetEntryPointLib.h>
29 #include <Library/PeCoffExtraActionLib.h>
30 #include <Library/ExtractGuidedSectionLib.h>
32 #include <Ppi/TemporaryRamSupport.h>
34 #define SEC_IDT_ENTRY_COUNT 34
36 typedef struct _SEC_IDT_TABLE
{
37 EFI_PEI_SERVICES
*PeiService
;
38 IA32_IDT_GATE_DESCRIPTOR IdtTable
[SEC_IDT_ENTRY_COUNT
];
49 TemporaryRamMigration (
50 IN CONST EFI_PEI_SERVICES
**PeiServices
,
51 IN EFI_PHYSICAL_ADDRESS TemporaryMemoryBase
,
52 IN EFI_PHYSICAL_ADDRESS PermanentMemoryBase
,
59 EFI_PEI_TEMPORARY_RAM_SUPPORT_PPI mTemporaryRamSupportPpi
= {
63 EFI_PEI_PPI_DESCRIPTOR mPrivateDispatchTable
[] = {
65 (EFI_PEI_PPI_DESCRIPTOR_PPI
| EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST
),
66 &gEfiTemporaryRamSupportPpiGuid
,
67 &mTemporaryRamSupportPpi
72 // Template of an IDT entry pointing to 10:FFFFFFE4h.
74 IA32_IDT_GATE_DESCRIPTOR mIdtEntryTemplate
= {
79 IA32_IDT_GATE_TYPE_INTERRUPT_32
, // GateType
85 Locates the main boot firmware volume.
87 @param[in,out] BootFv On input, the base of the BootFv
88 On output, the decompressed main firmware volume
90 @retval EFI_SUCCESS The main firmware volume was located and decompressed
91 @retval EFI_NOT_FOUND The main firmware volume was not found
96 IN OUT EFI_FIRMWARE_VOLUME_HEADER
**BootFv
99 EFI_FIRMWARE_VOLUME_HEADER
*Fv
;
102 ASSERT (((UINTN
) *BootFv
& EFI_PAGE_MASK
) == 0);
105 Distance
= (UINTN
) (*BootFv
)->FvLength
;
107 Fv
= (EFI_FIRMWARE_VOLUME_HEADER
*) ((UINT8
*) Fv
- EFI_PAGE_SIZE
);
108 Distance
+= EFI_PAGE_SIZE
;
109 if (Distance
> SIZE_32MB
) {
110 return EFI_NOT_FOUND
;
113 if (Fv
->Signature
!= EFI_FVH_SIGNATURE
) {
117 if ((UINTN
) Fv
->FvLength
> Distance
) {
128 Locates a section within a series of sections
129 with the specified section type.
131 @param[in] Sections The sections to search
132 @param[in] SizeOfSections Total size of all sections
133 @param[in] SectionType The section type to locate
134 @param[out] FoundSection The FFS section if found
136 @retval EFI_SUCCESS The file and section was found
137 @retval EFI_NOT_FOUND The file and section was not found
138 @retval EFI_VOLUME_CORRUPTED The firmware volume was corrupted
142 FindFfsSectionInSections (
144 IN UINTN SizeOfSections
,
145 IN EFI_SECTION_TYPE SectionType
,
146 OUT EFI_COMMON_SECTION_HEADER
**FoundSection
149 EFI_PHYSICAL_ADDRESS CurrentAddress
;
151 EFI_PHYSICAL_ADDRESS EndOfSections
;
152 EFI_COMMON_SECTION_HEADER
*Section
;
153 EFI_PHYSICAL_ADDRESS EndOfSection
;
156 // Loop through the FFS file sections within the PEI Core FFS file
158 EndOfSection
= (EFI_PHYSICAL_ADDRESS
)(UINTN
) Sections
;
159 EndOfSections
= EndOfSection
+ SizeOfSections
;
161 if (EndOfSection
== EndOfSections
) {
164 CurrentAddress
= (EndOfSection
+ 3) & ~(3ULL);
165 if (CurrentAddress
>= EndOfSections
) {
166 return EFI_VOLUME_CORRUPTED
;
169 Section
= (EFI_COMMON_SECTION_HEADER
*)(UINTN
) CurrentAddress
;
170 DEBUG ((EFI_D_INFO
, "Section->Type: 0x%x\n", Section
->Type
));
172 Size
= SECTION_SIZE (Section
);
173 if (Size
< sizeof (*Section
)) {
174 return EFI_VOLUME_CORRUPTED
;
177 EndOfSection
= CurrentAddress
+ Size
;
178 if (EndOfSection
> EndOfSections
) {
179 return EFI_VOLUME_CORRUPTED
;
183 // Look for the requested section type
185 if (Section
->Type
== SectionType
) {
186 *FoundSection
= Section
;
189 DEBUG ((EFI_D_INFO
, "Section->Type (0x%x) != SectionType (0x%x)\n", Section
->Type
, SectionType
));
192 return EFI_NOT_FOUND
;
196 Locates a FFS file with the specified file type and a section
197 within that file with the specified section type.
199 @param[in] Fv The firmware volume to search
200 @param[in] FileType The file type to locate
201 @param[in] SectionType The section type to locate
202 @param[out] FoundSection The FFS section if found
204 @retval EFI_SUCCESS The file and section was found
205 @retval EFI_NOT_FOUND The file and section was not found
206 @retval EFI_VOLUME_CORRUPTED The firmware volume was corrupted
211 FindFfsFileAndSection (
212 IN EFI_FIRMWARE_VOLUME_HEADER
*Fv
,
213 IN EFI_FV_FILETYPE FileType
,
214 IN EFI_SECTION_TYPE SectionType
,
215 OUT EFI_COMMON_SECTION_HEADER
**FoundSection
219 EFI_PHYSICAL_ADDRESS CurrentAddress
;
220 EFI_PHYSICAL_ADDRESS EndOfFirmwareVolume
;
221 EFI_FFS_FILE_HEADER
*File
;
223 EFI_PHYSICAL_ADDRESS EndOfFile
;
225 if (Fv
->Signature
!= EFI_FVH_SIGNATURE
) {
226 DEBUG ((EFI_D_INFO
, "FV at %p does not have FV header signature\n", Fv
));
227 return EFI_VOLUME_CORRUPTED
;
230 CurrentAddress
= (EFI_PHYSICAL_ADDRESS
)(UINTN
) Fv
;
231 EndOfFirmwareVolume
= CurrentAddress
+ Fv
->FvLength
;
234 // Loop through the FFS files in the Boot Firmware Volume
236 for (EndOfFile
= CurrentAddress
+ Fv
->HeaderLength
; ; ) {
238 CurrentAddress
= (EndOfFile
+ 7) & ~(7ULL);
239 if (CurrentAddress
> EndOfFirmwareVolume
) {
240 return EFI_VOLUME_CORRUPTED
;
243 File
= (EFI_FFS_FILE_HEADER
*)(UINTN
) CurrentAddress
;
244 Size
= *(UINT32
*) File
->Size
& 0xffffff;
245 if (Size
< (sizeof (*File
) + sizeof (EFI_COMMON_SECTION_HEADER
))) {
246 return EFI_VOLUME_CORRUPTED
;
248 DEBUG ((EFI_D_INFO
, "File->Type: 0x%x\n", File
->Type
));
250 EndOfFile
= CurrentAddress
+ Size
;
251 if (EndOfFile
> EndOfFirmwareVolume
) {
252 return EFI_VOLUME_CORRUPTED
;
256 // Look for the request file type
258 if (File
->Type
!= FileType
) {
259 DEBUG ((EFI_D_INFO
, "File->Type (0x%x) != FileType (0x%x)\n", File
->Type
, FileType
));
263 Status
= FindFfsSectionInSections (
265 (UINTN
) EndOfFile
- (UINTN
) (File
+ 1),
269 if (!EFI_ERROR (Status
) || (Status
== EFI_VOLUME_CORRUPTED
)) {
276 Locates the compressed main firmware volume and decompresses it.
278 @param[in,out] Fv On input, the firmware volume to search
279 On output, the decompressed main FV
281 @retval EFI_SUCCESS The file and section was found
282 @retval EFI_NOT_FOUND The file and section was not found
283 @retval EFI_VOLUME_CORRUPTED The firmware volume was corrupted
289 IN OUT EFI_FIRMWARE_VOLUME_HEADER
**Fv
293 EFI_GUID_DEFINED_SECTION
*Section
;
294 UINT32 OutputBufferSize
;
295 UINT32 ScratchBufferSize
;
296 UINT16 SectionAttribute
;
297 UINT32 AuthenticationStatus
;
300 EFI_FIRMWARE_VOLUME_IMAGE_SECTION
*NewFvSection
;
301 EFI_FIRMWARE_VOLUME_HEADER
*NewFv
;
303 NewFvSection
= (EFI_FIRMWARE_VOLUME_IMAGE_SECTION
*) NULL
;
305 Status
= FindFfsFileAndSection (
307 EFI_FV_FILETYPE_FIRMWARE_VOLUME_IMAGE
,
308 EFI_SECTION_GUID_DEFINED
,
309 (EFI_COMMON_SECTION_HEADER
**) &Section
311 if (EFI_ERROR (Status
)) {
312 DEBUG ((EFI_D_ERROR
, "Unable to find GUID defined section\n"));
316 Status
= ExtractGuidedSectionGetInfo (
322 if (EFI_ERROR (Status
)) {
323 DEBUG ((EFI_D_ERROR
, "Unable to GetInfo for GUIDed section\n"));
327 //PcdGet32 (PcdOvmfMemFvBase), PcdGet32 (PcdOvmfMemFvSize)
328 OutputBuffer
= (VOID
*) ((UINT8
*)(UINTN
) PcdGet32 (PcdOvmfMemFvBase
) + SIZE_1MB
);
329 ScratchBuffer
= ALIGN_POINTER ((UINT8
*) OutputBuffer
+ OutputBufferSize
, SIZE_1MB
);
330 Status
= ExtractGuidedSectionDecode (
334 &AuthenticationStatus
336 if (EFI_ERROR (Status
)) {
337 DEBUG ((EFI_D_ERROR
, "Error during GUID section decode\n"));
341 Status
= FindFfsSectionInSections (
344 EFI_SECTION_FIRMWARE_VOLUME_IMAGE
,
345 (EFI_COMMON_SECTION_HEADER
**) &NewFvSection
347 if (EFI_ERROR (Status
)) {
348 DEBUG ((EFI_D_ERROR
, "Unable to find FV image in extracted data\n"));
352 NewFv
= (EFI_FIRMWARE_VOLUME_HEADER
*)(UINTN
) PcdGet32 (PcdOvmfMemFvBase
);
353 CopyMem (NewFv
, (VOID
*) (NewFvSection
+ 1), PcdGet32 (PcdOvmfMemFvSize
));
355 if (NewFv
->Signature
!= EFI_FVH_SIGNATURE
) {
356 DEBUG ((EFI_D_ERROR
, "Extracted FV at %p does not have FV header signature\n", NewFv
));
358 return EFI_VOLUME_CORRUPTED
;
366 Locates the PEI Core entry point address
368 @param[in] Fv The firmware volume to search
369 @param[out] PeiCoreEntryPoint The entry point of the PEI Core image
371 @retval EFI_SUCCESS The file and section was found
372 @retval EFI_NOT_FOUND The file and section was not found
373 @retval EFI_VOLUME_CORRUPTED The firmware volume was corrupted
378 FindPeiCoreImageBaseInFv (
379 IN EFI_FIRMWARE_VOLUME_HEADER
*Fv
,
380 OUT EFI_PHYSICAL_ADDRESS
*PeiCoreImageBase
384 EFI_COMMON_SECTION_HEADER
*Section
;
386 Status
= FindFfsFileAndSection (
388 EFI_FV_FILETYPE_PEI_CORE
,
392 if (EFI_ERROR (Status
)) {
393 Status
= FindFfsFileAndSection (
395 EFI_FV_FILETYPE_PEI_CORE
,
399 if (EFI_ERROR (Status
)) {
400 DEBUG ((EFI_D_ERROR
, "Unable to find PEI Core image\n"));
405 *PeiCoreImageBase
= (EFI_PHYSICAL_ADDRESS
)(UINTN
)(Section
+ 1);
410 Locates the PEI Core entry point address
412 @param[in,out] Fv The firmware volume to search
413 @param[out] PeiCoreEntryPoint The entry point of the PEI Core image
415 @retval EFI_SUCCESS The file and section was found
416 @retval EFI_NOT_FOUND The file and section was not found
417 @retval EFI_VOLUME_CORRUPTED The firmware volume was corrupted
422 FindPeiCoreImageBase (
423 IN OUT EFI_FIRMWARE_VOLUME_HEADER
**BootFv
,
424 OUT EFI_PHYSICAL_ADDRESS
*PeiCoreImageBase
427 *PeiCoreImageBase
= 0;
431 DecompressGuidedFv (BootFv
);
433 FindPeiCoreImageBaseInFv (*BootFv
, PeiCoreImageBase
);
437 Find core image base.
443 IN EFI_FIRMWARE_VOLUME_HEADER
*BootFirmwareVolumePtr
,
444 OUT EFI_PHYSICAL_ADDRESS
*SecCoreImageBase
447 EFI_PHYSICAL_ADDRESS CurrentAddress
;
448 EFI_PHYSICAL_ADDRESS EndOfFirmwareVolume
;
449 EFI_FFS_FILE_HEADER
*File
;
451 EFI_PHYSICAL_ADDRESS EndOfFile
;
452 EFI_COMMON_SECTION_HEADER
*Section
;
453 EFI_PHYSICAL_ADDRESS EndOfSection
;
455 *SecCoreImageBase
= 0;
457 CurrentAddress
= (EFI_PHYSICAL_ADDRESS
)(UINTN
) BootFirmwareVolumePtr
;
458 EndOfFirmwareVolume
= CurrentAddress
+ BootFirmwareVolumePtr
->FvLength
;
461 // Loop through the FFS files in the Boot Firmware Volume
463 for (EndOfFile
= CurrentAddress
+ BootFirmwareVolumePtr
->HeaderLength
; ; ) {
465 CurrentAddress
= (EndOfFile
+ 7) & 0xfffffffffffffff8ULL
;
466 if (CurrentAddress
> EndOfFirmwareVolume
) {
467 return EFI_NOT_FOUND
;
470 File
= (EFI_FFS_FILE_HEADER
*)(UINTN
) CurrentAddress
;
471 Size
= *(UINT32
*) File
->Size
& 0xffffff;
472 if (Size
< sizeof (*File
)) {
473 return EFI_NOT_FOUND
;
476 EndOfFile
= CurrentAddress
+ Size
;
477 if (EndOfFile
> EndOfFirmwareVolume
) {
478 return EFI_NOT_FOUND
;
484 if (File
->Type
!= EFI_FV_FILETYPE_SECURITY_CORE
) {
489 // Loop through the FFS file sections within the FFS file
491 EndOfSection
= (EFI_PHYSICAL_ADDRESS
)(UINTN
) (File
+ 1);
493 CurrentAddress
= (EndOfSection
+ 3) & 0xfffffffffffffffcULL
;
494 Section
= (EFI_COMMON_SECTION_HEADER
*)(UINTN
) CurrentAddress
;
496 Size
= *(UINT32
*) Section
->Size
& 0xffffff;
497 if (Size
< sizeof (*Section
)) {
498 return EFI_NOT_FOUND
;
501 EndOfSection
= CurrentAddress
+ Size
;
502 if (EndOfSection
> EndOfFile
) {
503 return EFI_NOT_FOUND
;
507 // Look for executable sections
509 if (Section
->Type
== EFI_SECTION_PE32
|| Section
->Type
== EFI_SECTION_TE
) {
510 if (File
->Type
== EFI_FV_FILETYPE_SECURITY_CORE
) {
511 *SecCoreImageBase
= (PHYSICAL_ADDRESS
) (UINTN
) (Section
+ 1);
518 // SEC Core image found
520 if (*SecCoreImageBase
!= 0) {
527 Find and return Pei Core entry point.
529 It also find SEC and PEI Core file debug inforamtion. It will report them if
530 remote debug is enabled.
535 FindAndReportEntryPoints (
536 IN EFI_FIRMWARE_VOLUME_HEADER
**BootFirmwareVolumePtr
,
537 OUT EFI_PEI_CORE_ENTRY_POINT
*PeiCoreEntryPoint
541 EFI_PHYSICAL_ADDRESS SecCoreImageBase
;
542 EFI_PHYSICAL_ADDRESS PeiCoreImageBase
;
543 PE_COFF_LOADER_IMAGE_CONTEXT ImageContext
;
546 // Find SEC Core and PEI Core image base
548 Status
= FindImageBase (*BootFirmwareVolumePtr
, &SecCoreImageBase
);
549 ASSERT_EFI_ERROR (Status
);
551 FindPeiCoreImageBase (BootFirmwareVolumePtr
, &PeiCoreImageBase
);
553 ZeroMem ((VOID
*) &ImageContext
, sizeof (PE_COFF_LOADER_IMAGE_CONTEXT
));
555 // Report SEC Core debug information when remote debug is enabled
557 ImageContext
.ImageAddress
= SecCoreImageBase
;
558 ImageContext
.PdbPointer
= PeCoffLoaderGetPdbPointer ((VOID
*) (UINTN
) ImageContext
.ImageAddress
);
559 PeCoffLoaderRelocateImageExtraAction (&ImageContext
);
562 // Report PEI Core debug information when remote debug is enabled
564 ImageContext
.ImageAddress
= (EFI_PHYSICAL_ADDRESS
)(UINTN
)PeiCoreImageBase
;
565 ImageContext
.PdbPointer
= PeCoffLoaderGetPdbPointer ((VOID
*) (UINTN
) ImageContext
.ImageAddress
);
566 PeCoffLoaderRelocateImageExtraAction (&ImageContext
);
569 // Find PEI Core entry point
571 Status
= PeCoffLoaderGetEntryPoint ((VOID
*) (UINTN
) PeiCoreImageBase
, (VOID
**) PeiCoreEntryPoint
);
572 if (EFI_ERROR (Status
)) {
573 *PeiCoreEntryPoint
= 0;
581 SecCoreStartupWithStack (
582 IN EFI_FIRMWARE_VOLUME_HEADER
*BootFv
,
583 IN VOID
*TopOfCurrentStack
586 EFI_SEC_PEI_HAND_OFF SecCoreData
;
587 SEC_IDT_TABLE IdtTableInStack
;
588 IA32_DESCRIPTOR IdtDescriptor
;
591 ProcessLibraryConstructorList (NULL
, NULL
);
594 "SecCoreStartupWithStack(0x%x, 0x%x)\n",
595 (UINT32
)(UINTN
)BootFv
,
596 (UINT32
)(UINTN
)TopOfCurrentStack
600 // Initialize floating point operating environment
601 // to be compliant with UEFI spec.
603 InitializeFloatingPointUnits ();
608 IdtTableInStack
.PeiService
= NULL
;
609 for (Index
= 0; Index
< SEC_IDT_ENTRY_COUNT
; Index
++) {
610 CopyMem (&IdtTableInStack
.IdtTable
[Index
], &mIdtEntryTemplate
, sizeof (mIdtEntryTemplate
));
613 IdtDescriptor
.Base
= (UINTN
)&IdtTableInStack
.IdtTable
;
614 IdtDescriptor
.Limit
= (UINT16
)(sizeof (IdtTableInStack
.IdtTable
) - 1);
616 AsmWriteIdtr (&IdtDescriptor
);
619 // |-------------| <-- TopOfCurrentStack
623 // |-------------| <-- SecCoreData.TemporaryRamBase
627 // Initialize SEC hand-off state
629 SecCoreData
.DataSize
= sizeof(EFI_SEC_PEI_HAND_OFF
);
631 SecCoreData
.TemporaryRamSize
= SIZE_64KB
;
632 SecCoreData
.TemporaryRamBase
= (VOID
*)((UINT8
*)TopOfCurrentStack
- SecCoreData
.TemporaryRamSize
);
634 SecCoreData
.PeiTemporaryRamBase
= SecCoreData
.TemporaryRamBase
;
635 SecCoreData
.PeiTemporaryRamSize
= SecCoreData
.TemporaryRamSize
>> 1;
637 SecCoreData
.StackBase
= (UINT8
*)SecCoreData
.TemporaryRamBase
+ SecCoreData
.PeiTemporaryRamSize
;
638 SecCoreData
.StackSize
= SecCoreData
.TemporaryRamSize
>> 1;
640 SecCoreData
.BootFirmwareVolumeBase
= BootFv
;
641 SecCoreData
.BootFirmwareVolumeSize
= (UINTN
) BootFv
->FvLength
;
644 // Make sure the 8259 is masked before initializing the Debug Agent and the debug timer is enabled
646 IoWrite8 (0x21, 0xff);
647 IoWrite8 (0xA1, 0xff);
650 // Initialize Debug Agent to support source level debug in SEC/PEI phases before memory ready.
652 InitializeDebugAgent (DEBUG_AGENT_INIT_PREMEM_SEC
, &SecCoreData
, SecStartupPhase2
);
656 Caller provided function to be invoked at the end of InitializeDebugAgent().
658 Entry point to the C language phase of SEC. After the SEC assembly
659 code has initialized some temporary memory and set up the stack,
660 the control is transferred to this function.
662 @param[in] Context The first input parameter of InitializeDebugAgent().
671 EFI_SEC_PEI_HAND_OFF
*SecCoreData
;
672 EFI_FIRMWARE_VOLUME_HEADER
*BootFv
;
673 EFI_PEI_CORE_ENTRY_POINT PeiCoreEntryPoint
;
675 SecCoreData
= (EFI_SEC_PEI_HAND_OFF
*) Context
;
678 // Find PEI Core entry point. It will report SEC and Pei Core debug information if remote debug
681 BootFv
= (EFI_FIRMWARE_VOLUME_HEADER
*)SecCoreData
->BootFirmwareVolumeBase
;
682 FindAndReportEntryPoints (&BootFv
, &PeiCoreEntryPoint
);
683 SecCoreData
->BootFirmwareVolumeBase
= BootFv
;
684 SecCoreData
->BootFirmwareVolumeSize
= (UINTN
) BootFv
->FvLength
;
687 // Transfer the control to the PEI core
689 (*PeiCoreEntryPoint
) (SecCoreData
, (EFI_PEI_PPI_DESCRIPTOR
*)&mPrivateDispatchTable
);
692 // If we get here then the PEI Core returned, which is not recoverable.
700 TemporaryRamMigration (
701 IN CONST EFI_PEI_SERVICES
**PeiServices
,
702 IN EFI_PHYSICAL_ADDRESS TemporaryMemoryBase
,
703 IN EFI_PHYSICAL_ADDRESS PermanentMemoryBase
,
707 IA32_DESCRIPTOR IdtDescriptor
;
712 DEBUG_AGENT_CONTEXT_POSTMEM_SEC DebugAgentContext
;
714 BASE_LIBRARY_JUMP_BUFFER JumpBuffer
;
716 DEBUG ((EFI_D_ERROR
, "TemporaryRamMigration(0x%x, 0x%x, 0x%x)\n", (UINTN
)TemporaryMemoryBase
, (UINTN
)PermanentMemoryBase
, CopySize
));
718 OldHeap
= (VOID
*)(UINTN
)TemporaryMemoryBase
;
719 NewHeap
= (VOID
*)((UINTN
)PermanentMemoryBase
+ (CopySize
>> 1));
721 OldStack
= (VOID
*)((UINTN
)TemporaryMemoryBase
+ (CopySize
>> 1));
722 NewStack
= (VOID
*)(UINTN
)PermanentMemoryBase
;
724 DebugAgentContext
.HeapMigrateOffset
= (UINTN
)NewHeap
- (UINTN
)OldHeap
;
725 DebugAgentContext
.StackMigrateOffset
= (UINTN
)NewStack
- (UINTN
)OldStack
;
727 OldStatus
= SaveAndSetDebugTimerInterrupt (FALSE
);
728 InitializeDebugAgent (DEBUG_AGENT_INIT_POSTMEM_SEC
, (VOID
*) &DebugAgentContext
, NULL
);
733 CopyMem (NewHeap
, OldHeap
, CopySize
>> 1);
738 CopyMem (NewStack
, OldStack
, CopySize
>> 1);
741 // Rebase IDT table in permanent memory
743 AsmReadIdtr (&IdtDescriptor
);
744 IdtDescriptor
.Base
= IdtDescriptor
.Base
- (UINTN
)OldStack
+ (UINTN
)NewStack
;
746 AsmWriteIdtr (&IdtDescriptor
);
749 // Use SetJump()/LongJump() to switch to a new stack.
751 if (SetJump (&JumpBuffer
) == 0) {
752 #if defined (MDE_CPU_IA32)
753 JumpBuffer
.Esp
= JumpBuffer
.Esp
+ DebugAgentContext
.StackMigrateOffset
;
755 #if defined (MDE_CPU_X64)
756 JumpBuffer
.Rsp
= JumpBuffer
.Rsp
+ DebugAgentContext
.StackMigrateOffset
;
758 LongJump (&JumpBuffer
, (UINTN
)-1);
761 SaveAndSetDebugTimerInterrupt (OldStatus
);