SmmStmSupport.c

Go to the documentation of this file.

 
#include <PiMm.h>
#include <Library/DebugLib.h>
 
#include "SmmStm.h"
 
#define IA32_PG_P   BIT0
#define IA32_PG_RW  BIT1
#define IA32_PG_PS  BIT7
 
VOID
StmGen4GPageTable (
  IN UINTN  PageTableBase
  )
{
  UINTN   Index;
  UINTN   SubIndex;
  UINT64  *Pde;
  UINT64  *Pte;
  UINT64  *Pml4;
 
  Pml4           = (UINT64 *)(UINTN)PageTableBase;
  PageTableBase += SIZE_4KB;
  *Pml4          = PageTableBase | IA32_PG_RW | IA32_PG_P;
 
  Pde            = (UINT64 *)(UINTN)PageTableBase;
  PageTableBase += SIZE_4KB;
  Pte            = (UINT64 *)(UINTN)PageTableBase;
 
  for (Index = 0; Index < 4; Index++) {
    *Pde = PageTableBase | IA32_PG_RW | IA32_PG_P;
    Pde++;
    PageTableBase += SIZE_4KB;
 
    for (SubIndex = 0; SubIndex < SIZE_4KB / sizeof (*Pte); SubIndex++) {
      *Pte = (((Index << 9) + SubIndex) << 21) | IA32_PG_PS | IA32_PG_RW | IA32_PG_P;
      Pte++;
    }
  }
}
 
UINT32
EFIAPI
SmmStmExceptionHandler (
  IN OUT STM_PROTECTION_EXCEPTION_STACK_FRAME  Context
  )
{
  // TBD - SmmStmExceptionHandler, record information
  DEBUG ((DEBUG_ERROR, "SmmStmExceptionHandler ...\n"));
  //
  // Skip this instruction and continue;
  //
  Context.X64StackFrame->Rip += Context.X64StackFrame->VmcsExitInstructionLength;
 
  return 0;
}