PlDebugSupportX64.c

Go to the documentation of this file.

 
#include "PlDebugSupport.h"
 
IA32_IDT_GATE_DESCRIPTOR  NullDesc = {
  { 0, 0 }
};
 
UINTN
GetInterruptHandleFromIdt (
  IN IA32_IDT_GATE_DESCRIPTOR  *IdtGateDecriptor
  )
{
  UINTN  InterruptHandle;
 
  //
  // InterruptHandle  0-15 : OffsetLow
  // InterruptHandle 16-31 : OffsetHigh
  // InterruptHandle 32-63 : OffsetUpper
  //
  InterruptHandle = ((UINTN)IdtGateDecriptor->Bits.OffsetLow) |
                    (((UINTN)IdtGateDecriptor->Bits.OffsetHigh)  << 16) |
                    (((UINTN)IdtGateDecriptor->Bits.OffsetUpper) << 32);
 
  return InterruptHandle;
}
 
VOID
CreateEntryStub (
  IN EFI_EXCEPTION_TYPE  ExceptionType,
  OUT VOID               **Stub
  )
{
  UINT8  *StubCopy;
 
  StubCopy = *Stub;
 
  //
  // Fixup the stub code for this vector
  //
 
  // The stub code looks like this:
  //
  //    00000000  6A 00               push    0                       ; push vector number - will be modified before installed
  //    00000002  E9                  db      0e9h                    ; jump rel32
  //    00000003  00000000            dd      0                       ; fixed up to relative address of CommonIdtEntry
  //
 
  //
  // poke in the exception type so the second push pushes the exception type
  //
  StubCopy[0x1] = (UINT8)ExceptionType;
 
  //
  // fixup the jump target to point to the common entry
  //
  *(UINT32 *)&StubCopy[0x3] = (UINT32)((UINTN)CommonIdtEntry - (UINTN)&StubCopy[StubSize]);
 
  return;
}
 
EFI_STATUS
ManageIdtEntryTable (
  CALLBACK_FUNC       NewCallback,
  EFI_EXCEPTION_TYPE  ExceptionType
  )
{
  EFI_STATUS  Status;
 
  Status = EFI_SUCCESS;
 
  if (CompareMem (&IdtEntryTable[ExceptionType].NewDesc, &NullDesc, sizeof (IA32_IDT_GATE_DESCRIPTOR)) != 0) {
    //
    // we've already installed to this vector
    //
    if (NewCallback != NULL) {
      //
      // if the input handler is non-null, error
      //
      Status = EFI_ALREADY_STARTED;
    } else {
      UnhookEntry (ExceptionType);
    }
  } else {
    //
    // no user handler installed on this vector
    //
    if (NewCallback == NULL) {
      //
      // if the input handler is null, error
      //
      Status = EFI_INVALID_PARAMETER;
    } else {
      HookEntry (ExceptionType, NewCallback);
    }
  }
 
  return Status;
}