1 files changed, 51 insertions, 3 deletions
diff --git a/SourceLevelDebugPkg/Library/DebugAgent/DebugAgentCommon/X64/ArchDebugSupport.c b/SourceLevelDebugPkg/Library/DebugAgent/DebugAgentCommon/X64/ArchDebugSupport.c
index 9803f0f7..60d3eb8b 100644
--- a/SourceLevelDebugPkg/Library/DebugAgent/DebugAgentCommon/X64/ArchDebugSupport.c
+++ b/SourceLevelDebugPkg/Library/DebugAgent/DebugAgentCommon/X64/ArchDebugSupport.c
@@ -1,7 +1,7 @@
 /** @file
   Supporting functions for X64 architecture.
 
-  Copyright (c) 2010 - 2012, Intel Corporation. All rights reserved.<BR>
+  Copyright (c) 2010 - 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
   which accompanies this distribution.  The full text of the license may be found at
@@ -39,9 +39,9 @@ InitializeDebugIdt (
   IdtEntry = (IA32_IDT_GATE_DESCRIPTOR *) IdtDescriptor.Base;
 
   for (Index = 0; Index < 20; Index ++) {
-    if ((PcdGet32 (PcdExceptionsIgnoredByDebugger) & (1 << Index)) != 0) {
+    if (((PcdGet32 (PcdExceptionsIgnoredByDebugger) & ~(BIT1 | BIT3)) & (1 << Index)) != 0) {
       //
-      // If the exception is masked to be reserved, skip it
+      // If the exception is masked to be reserved except for INT1 and INT3, skip it
       //
       continue;
     }
@@ -65,3 +65,51 @@ InitializeDebugIdt (
   //
   AsmWriteCr4 (AsmReadCr4 () | BIT3);
 }
+
+/**
+  Retrieve exception handler from IDT table by ExceptionNum.
+
+  @param[in]  ExceptionNum    Exception number
+ 
+  @return Exception handler
+
+**/
+VOID *
+GetExceptionHandlerInIdtEntry (
+  IN UINTN             ExceptionNum
+  )
+{
+  IA32_IDT_GATE_DESCRIPTOR   *IdtEntry;
+  IA32_DESCRIPTOR            IdtDescriptor;
+
+  AsmReadIdtr (&IdtDescriptor);
+  IdtEntry = (IA32_IDT_GATE_DESCRIPTOR *) IdtDescriptor.Base;
+
+  return (VOID *) (IdtEntry[ExceptionNum].Bits.OffsetLow |
+                  (((UINTN)IdtEntry[ExceptionNum].Bits.OffsetHigh) << 16) |
+                  (((UINTN)IdtEntry[ExceptionNum].Bits.OffsetUpper) << 32));
+} 
+
+/**
+  Set exception handler in IDT table by ExceptionNum.
+
+  @param[in]  ExceptionNum      Exception number
+  @param[in]  ExceptionHandler  Exception Handler to be set 
+
+**/
+VOID
+SetExceptionHandlerInIdtEntry (
+  IN UINTN             ExceptionNum,
+  IN VOID              *ExceptionHandler
+  )
+{
+  IA32_IDT_GATE_DESCRIPTOR   *IdtEntry;
+  IA32_DESCRIPTOR            IdtDescriptor;
+
+  AsmReadIdtr (&IdtDescriptor);
+  IdtEntry = (IA32_IDT_GATE_DESCRIPTOR *) IdtDescriptor.Base;
+
+  IdtEntry[ExceptionNum].Bits.OffsetLow   = (UINT16)(UINTN)ExceptionHandler;
+  IdtEntry[ExceptionNum].Bits.OffsetHigh  = (UINT16)((UINTN)ExceptionHandler >> 16);
+  IdtEntry[ExceptionNum].Bits.OffsetUpper = (UINT32)((UINTN)ExceptionHandler >> 32);
+}