Revision: 14896
          http://sourceforge.net/p/edk2/code/14896
Author:   lzeng14
Date:     2013-11-25 06:20:18 +0000 (Mon, 25 Nov 2013)
Log Message:
-----------
MdeModulePkg BootScriptExecutorDxe: Fix S3 failure When PcdUse1GPageTable 
defined as dynamic.

Contributed-under: TianoCore Contribution Agreement 1.0
Signed-off-by: Star Zeng <[email protected]>
Reviewed-by: Jiewen Yao <[email protected]>

Modified Paths:
--------------
    
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/BootScriptExecutorDxe.inf
    trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.c
    trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.h
    
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/X64/SetIdtEntry.c

Modified: 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/BootScriptExecutorDxe.inf
===================================================================
--- 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/BootScriptExecutorDxe.inf
      2013-11-25 02:55:45 UTC (rev 14895)
+++ 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/BootScriptExecutorDxe.inf
      2013-11-25 06:20:18 UTC (rev 14896)
@@ -4,7 +4,7 @@
 # This is a standalone Boot Script Executor. Standalone means it does not
 # depends on any PEI or DXE service.
 #
-# Copyright (c) 2006 - 2012, Intel Corporation. All rights reserved.<BR>
+# Copyright (c) 2006 - 2013, Intel Corporation. All rights reserved.<BR>
 #
 # This program and the accompanying materials are
 # licensed and made available under the terms and conditions of the BSD License
@@ -75,6 +75,9 @@
   gPerformanceProtocolGuid
   gEfiEventExitBootServicesGuid
 
+[Protocols]
+  gEfiDxeSmmReadyToLockProtocolGuid
+
 [FeaturePcd]
   gEfiMdeModulePkgTokenSpaceGuid.PcdDxeIplSwitchToLongMode
 

Modified: 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.c
===================================================================
--- 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.c    
    2013-11-25 02:55:45 UTC (rev 14895)
+++ 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.c    
    2013-11-25 06:20:18 UTC (rev 14896)
@@ -1,10 +1,10 @@
 /** @file
   This is the code for Boot Script Executer module.
 
-  This driver is dispatched by Dxe core and the driver will reload itself to 
ACPI NVS memory
+  This driver is dispatched by Dxe core and the driver will reload itself to 
ACPI reserved memory
   in the entry point. The functionality is to interpret and restore the S3 
boot script
 
-Copyright (c) 2006 - 2012, Intel Corporation. All rights reserved.<BR>
+Copyright (c) 2006 - 2013, Intel Corporation. All rights reserved.<BR>
 
 This program and the accompanying materials
 are licensed and made available under the terms and conditions of the BSD 
License
@@ -22,6 +22,8 @@
   0x9a8d3433, 0x9fe8, 0x42b6, { 0x87, 0xb, 0x1e, 0x31, 0xc8, 0x4e, 0xbe, 0x3b }
 };
 
+BOOLEAN               mPage1GSupport = FALSE;
+
 /**
   Entry function of Boot script exector. This function will be executed in
   S3 boot path.
@@ -205,7 +207,122 @@
   CpuDeadLoop();
   return EFI_UNSUPPORTED;
 }
+
 /**
+  This is the Event notification function to reload BootScriptExecutor image
+  to RESERVED mem and save it to LockBox.
+  
+  @param    Event   Pointer to this event
+  @param    Context Event hanlder private data 
+ **/
+VOID
+EFIAPI
+ReadyToLockEventNotify (
+  IN EFI_EVENT  Event,
+  IN VOID       *Context
+  )
+{
+  EFI_STATUS                                    Status;
+  VOID                                          *Interface;
+  UINT8                                         *Buffer;
+  UINTN                                         BufferSize;
+  EFI_HANDLE                                    NewImageHandle;
+  UINTN                                         Pages;
+  EFI_PHYSICAL_ADDRESS                          FfsBuffer;
+  PE_COFF_LOADER_IMAGE_CONTEXT                  ImageContext;
+
+  Status = gBS->LocateProtocol (&gEfiDxeSmmReadyToLockProtocolGuid, NULL, 
&Interface);
+  if (EFI_ERROR (Status)) {
+    return;
+  }
+
+  //
+  // A workaround: Here we install a dummy handle
+  //
+  NewImageHandle = NULL;
+  Status = gBS->InstallProtocolInterface (
+                  &NewImageHandle,
+                  &gEfiCallerIdGuid,
+                  EFI_NATIVE_INTERFACE,
+                  NULL
+                  );
+  ASSERT_EFI_ERROR (Status);
+
+  //
+  // Reload BootScriptExecutor image itself to RESERVED mem
+  //
+  Status = GetSectionFromAnyFv  (
+             &gEfiCallerIdGuid,
+             EFI_SECTION_PE32,
+             0,
+             (VOID **) &Buffer,
+             &BufferSize
+             );
+  ASSERT_EFI_ERROR (Status);
+  ImageContext.Handle    = Buffer;
+  ImageContext.ImageRead = PeCoffLoaderImageReadFromMemory;
+  //
+  // Get information about the image being loaded
+  //
+  Status = PeCoffLoaderGetImageInfo (&ImageContext);
+  ASSERT_EFI_ERROR (Status);
+  Pages = EFI_SIZE_TO_PAGES(BufferSize + ImageContext.SectionAlignment);
+  FfsBuffer = 0xFFFFFFFF;
+  Status = gBS->AllocatePages (
+                  AllocateMaxAddress,
+                  EfiReservedMemoryType,
+                  Pages,
+                  &FfsBuffer
+                  );
+  ASSERT_EFI_ERROR (Status);
+  ImageContext.ImageAddress = (PHYSICAL_ADDRESS)(UINTN)FfsBuffer;
+  //
+  // Align buffer on section boundry
+  //
+  ImageContext.ImageAddress += ImageContext.SectionAlignment - 1;
+  ImageContext.ImageAddress &= ~(ImageContext.SectionAlignment - 1);
+  //
+  // Load the image to our new buffer
+  //
+  Status = PeCoffLoaderLoadImage (&ImageContext);
+  ASSERT_EFI_ERROR (Status);
+
+  //
+  // Relocate the image in our new buffer
+  //
+  Status = PeCoffLoaderRelocateImage (&ImageContext);
+  ASSERT_EFI_ERROR (Status);
+
+  //
+  // Free the buffer allocated by ReadSection since the image has been 
relocated in the new buffer
+  //
+  gBS->FreePool (Buffer);
+
+  //
+  // Flush the instruction cache so the image data is written before we 
execute it
+  //
+  InvalidateInstructionCacheRange ((VOID *)(UINTN)ImageContext.ImageAddress, 
(UINTN)ImageContext.ImageSize);
+  Status = ((EFI_IMAGE_ENTRY_POINT)(UINTN)(ImageContext.EntryPoint)) 
(NewImageHandle, gST);
+  ASSERT_EFI_ERROR (Status);
+
+  //
+  // Additional step for BootScript integrity
+  // Save BootScriptExecutor image
+  //
+  Status = SaveLockBox (
+             &mBootScriptExecutorImageGuid,
+             (VOID *)(UINTN)ImageContext.ImageAddress,
+             (UINTN)ImageContext.ImageSize
+             );
+  ASSERT_EFI_ERROR (Status);
+
+  Status = SetLockBoxAttributes (&mBootScriptExecutorImageGuid, 
LOCK_BOX_ATTRIBUTE_RESTORE_IN_PLACE);
+  ASSERT_EFI_ERROR (Status);
+
+  gBS->CloseEvent (Event);
+}
+
+/**
   Entrypoint of Boot script exector driver, this function will be executed in
   normal boot phase and invoked by DXE dispatch.
 
@@ -222,16 +339,16 @@
   IN EFI_SYSTEM_TABLE     *SystemTable
   )
 {
-  UINT8                                         *Buffer;
   UINTN                                         BufferSize;
   UINTN                                         Pages;
-  EFI_PHYSICAL_ADDRESS                          FfsBuffer;
-  PE_COFF_LOADER_IMAGE_CONTEXT                  ImageContext;
   BOOT_SCRIPT_EXECUTOR_VARIABLE                 *EfiBootScriptExecutorVariable;
   EFI_PHYSICAL_ADDRESS                          BootScriptExecutorBuffer;
   EFI_STATUS                                    Status;
   VOID                                          *DevicePath;
-  EFI_HANDLE                                    NewImageHandle;
+  EFI_EVENT                                     ReadyToLockEvent;
+  VOID                                          *Registration;
+  UINT32                                        RegEax;
+  UINT32                                        RegEdx;
 
   //
   // Test if the gEfiCallerIdGuid of this image is already installed. if not, 
the entry
@@ -240,94 +357,32 @@
   //
   Status = gBS->LocateProtocol (&gEfiCallerIdGuid, NULL, &DevicePath);
   if (EFI_ERROR (Status)) {
-
       //
-      // This is the first-time loaded by DXE core. reload itself to RESERVED 
mem
+      // Create ReadyToLock event to reload BootScriptExecutor image
+      // to RESERVED mem and save it to LockBox.
       //
-      //
-      // A workaround: Here we install a dummy handle
-      //
-      NewImageHandle = NULL;
-      Status = gBS->InstallProtocolInterface (
-                  &NewImageHandle,
-                  &gEfiCallerIdGuid,
-                  EFI_NATIVE_INTERFACE,
-                  NULL
-                  );
-      ASSERT_EFI_ERROR (Status);
-
-      Status = GetSectionFromAnyFv  (
-                 &gEfiCallerIdGuid,
-                 EFI_SECTION_PE32,
-                 0,
-                 (VOID **) &Buffer,
-                 &BufferSize
-                 );
-      ASSERT_EFI_ERROR (Status);
-      ImageContext.Handle    = Buffer;
-      ImageContext.ImageRead = PeCoffLoaderImageReadFromMemory;
-      //
-      // Get information about the image being loaded
-      //
-      Status = PeCoffLoaderGetImageInfo (&ImageContext);
-      ASSERT_EFI_ERROR (Status);
-      Pages = EFI_SIZE_TO_PAGES(BufferSize + ImageContext.SectionAlignment);
-      FfsBuffer = 0xFFFFFFFF;
-      Status = gBS->AllocatePages (
-                    AllocateMaxAddress,
-                    EfiReservedMemoryType,
-                    Pages,
-                    &FfsBuffer
-                    );
-      ASSERT_EFI_ERROR (Status);
-      ImageContext.ImageAddress = (PHYSICAL_ADDRESS)(UINTN)FfsBuffer;
-      //
-      // Align buffer on section boundry
-      //
-      ImageContext.ImageAddress += ImageContext.SectionAlignment - 1;
-      ImageContext.ImageAddress &= ~(ImageContext.SectionAlignment - 1);
-      //
-      // Load the image to our new buffer
-      //
-      Status = PeCoffLoaderLoadImage (&ImageContext);
-      ASSERT_EFI_ERROR (Status);
-
-      //
-      // Relocate the image in our new buffer
-      //
-      Status = PeCoffLoaderRelocateImage (&ImageContext);
-      ASSERT_EFI_ERROR (Status);
-
-      //
-      // Free the buffer allocated by ReadSection since the image has been 
relocated in the new buffer
-      //
-      gBS->FreePool (Buffer);
-
-      //
-      // Flush the instruction cache so the image data is written before we 
execute it
-      //
-      InvalidateInstructionCacheRange ((VOID 
*)(UINTN)ImageContext.ImageAddress, (UINTN)ImageContext.ImageSize);
-      Status = ((EFI_IMAGE_ENTRY_POINT)(UINTN)(ImageContext.EntryPoint)) 
(NewImageHandle, SystemTable);
-      ASSERT_EFI_ERROR (Status);
-
-      //
-      // Additional step for BootScript integrity
-      // Save BootScriptExecutor image
-      //
-      Status = SaveLockBox (
-                 &mBootScriptExecutorImageGuid,
-                 (VOID *)(UINTN)ImageContext.ImageAddress,
-                 (UINTN)ImageContext.ImageSize
-                 );
-      ASSERT_EFI_ERROR (Status);
-
-      Status = SetLockBoxAttributes (&mBootScriptExecutorImageGuid, 
LOCK_BOX_ATTRIBUTE_RESTORE_IN_PLACE);
-      ASSERT_EFI_ERROR (Status);
-
+      ReadyToLockEvent = EfiCreateProtocolNotifyEvent  (
+                           &gEfiDxeSmmReadyToLockProtocolGuid,
+                           TPL_NOTIFY,
+                           ReadyToLockEventNotify,
+                           NULL,
+                           &Registration
+                           );
+      ASSERT (ReadyToLockEvent != NULL);
     } else {
       //
       // the entry point is invoked after reloading. following code only run 
in RESERVED mem
       //
+      if (PcdGetBool(PcdUse1GPageTable)) {
+        AsmCpuid (0x80000000, &RegEax, NULL, NULL, NULL);
+        if (RegEax >= 0x80000001) {
+          AsmCpuid (0x80000001, NULL, NULL, NULL, &RegEdx);
+          if ((RegEdx & BIT26) != 0) {
+            mPage1GSupport = TRUE;
+          }
+        }
+      }
+
       BufferSize = sizeof (BOOT_SCRIPT_EXECUTOR_VARIABLE);
 
       BootScriptExecutorBuffer = 0xFFFFFFFF;
@@ -363,11 +418,8 @@
 
       Status = SetLockBoxAttributes (&gEfiBootScriptExecutorContextGuid, 
LOCK_BOX_ATTRIBUTE_RESTORE_IN_PLACE);
       ASSERT_EFI_ERROR (Status);
-
     }
 
     return EFI_SUCCESS;
 }
 
-
-

Modified: 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.h
===================================================================
--- 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.h    
    2013-11-25 02:55:45 UTC (rev 14895)
+++ 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/ScriptExecute.h    
    2013-11-25 06:20:18 UTC (rev 14896)
@@ -1,10 +1,10 @@
 /** @file
   The header file for Boot Script Executer module.
   
-  This driver is dispatched by Dxe core and the driver will reload itself to 
ACPI NVS memory 
+  This driver is dispatched by Dxe core and the driver will reload itself to 
ACPI reserved memory 
   in the entry point. The functionality is to interpret and restore the S3 
boot script 
   
-Copyright (c) 2006 - 2012, Intel Corporation. All rights reserved.<BR>
+Copyright (c) 2006 - 2013, Intel Corporation. All rights reserved.<BR>
 
 This program and the accompanying materials
 are licensed and made available under the terms and conditions of the BSD 
License
@@ -39,7 +39,7 @@
 
 #include <Guid/AcpiS3Context.h>
 #include <Guid/BootScriptExecutorVariable.h>
-#include <Guid/EventGroup.h>
+#include <Protocol/DxeSmmReadyToLock.h>
 #include <IndustryStandard/Acpi.h>
 /**
   a ASM function to transfer control to OS.
@@ -83,5 +83,6 @@
 
 extern UINT32 AsmFixAddress16;
 extern UINT32 AsmJmpAddr32;
+extern BOOLEAN mPage1GSupport;
 
 #endif //_BOOT_SCRIPT_EXECUTOR_H_

Modified: 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/X64/SetIdtEntry.c
===================================================================
--- 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/X64/SetIdtEntry.c  
    2013-11-25 02:55:45 UTC (rev 14895)
+++ 
trunk/edk2/MdeModulePkg/Universal/Acpi/BootScriptExecutorDxe/X64/SetIdtEntry.c  
    2013-11-25 06:20:18 UTC (rev 14896)
@@ -21,7 +21,6 @@
 #define IA32_PG_PS                  BIT7
 
 UINT64                             mPhyMask;
-BOOLEAN                            mPage1GSupport;
 VOID                               *mOriginalHandler;
 UINTN                              mS3NvsPageTableAddress;
 
@@ -47,24 +46,19 @@
   )
 {
   UINT32         RegEax;
-  UINT32         RegEdx;
+  UINT8          PhysicalAddressBits;
   UINTN          PageFaultHandlerHookAddress;
 
-  AsmCpuid (0x80000008, &RegEax, NULL, NULL, NULL);
-  mPhyMask = LShiftU64 (1, (UINT8)RegEax) - 1;
+  AsmCpuid (0x80000000, &RegEax, NULL, NULL, NULL);
+  if (RegEax >= 0x80000008) {
+    AsmCpuid (0x80000008, &RegEax, NULL, NULL, NULL);
+    PhysicalAddressBits = (UINT8) RegEax;
+  } else {
+    PhysicalAddressBits = 36;
+  }
+  mPhyMask = LShiftU64 (1, PhysicalAddressBits) - 1;
   mPhyMask &= (1ull << 48) - SIZE_4KB;
 
-  mPage1GSupport = FALSE;
-  if (PcdGetBool(PcdUse1GPageTable)) {
-    AsmCpuid (0x80000000, &RegEax, NULL, NULL, NULL);
-    if (RegEax >= 0x80000001) {
-      AsmCpuid (0x80000001, NULL, NULL, NULL, &RegEdx);
-      if ((RegEdx & BIT26) != 0) {
-        mPage1GSupport = TRUE;
-      }
-    }
-  }
-
   //
   // Set Page Fault entry to catch >4G access
   //

This was sent by the SourceForge.net collaborative development platform, the 
world's largest Open Source development site.


------------------------------------------------------------------------------
Shape the Mobile Experience: Free Subscription
Software experts and developers: Be at the forefront of tech innovation.
Intel(R) Software Adrenaline delivers strategic insight and game-changing 
conversations that shape the rapidly evolving mobile landscape. Sign up now. 
http://pubads.g.doubleclick.net/gampad/clk?id=63431311&iu=/4140/ostg.clktrk
_______________________________________________
edk2-commits mailing list
[email protected]
https://lists.sourceforge.net/lists/listinfo/edk2-commits

Reply via email to