1 files changed, 93 insertions, 0 deletions
diff --git a/DuetPkg/EfiLdr/Debug.c b/DuetPkg/EfiLdr/Debug.c
new file mode 100644
index 0000000000..2cc8c73a1e
--- /dev/null
+++ b/DuetPkg/EfiLdr/Debug.c
@@ -0,0 +1,93 @@
+/*++
+
+Copyright (c) 2006, Intel Corporation                                                         
+All rights reserved. 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        
+http://opensource.org/licenses/bsd-license.php                                            
+                                                                                          
+THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     
+WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             
+
+Module Name:
+  Debug.c
+
+Abstract:
+
+Revision History:
+
+--*/
+#include "EfiLdr.h"
+#include "Debug.h"
+
+UINT8 *mCursor;
+UINT8 mHeaderIndex = 10;
+
+VOID
+PrintHeader (
+  CHAR8 Char
+  )
+{
+  *(UINT8 *)(UINTN)(0x000b8000 + mHeaderIndex) = Char;
+  mHeaderIndex += 2;
+}
+
+VOID
+ClearScreen (
+  VOID
+  )
+{
+  UINT32 Index;
+
+  mCursor = (UINT8 *)(UINTN)(0x000b8000 + 160);
+  for (Index = 0; Index < 80 * 49; Index++) {
+    *mCursor = ' ';
+    mCursor += 2;
+  }
+  mCursor = (UINT8 *)(UINTN)(0x000b8000 + 160);
+}
+
+VOID
+PrintValue64 (
+  UINT64 Value
+  )
+{
+  PrintValue ((UINT32) RShiftU64 (Value, 32));
+  PrintValue ((UINT32) Value);
+}
+
+VOID
+PrintValue (
+  UINT32 Value
+  )
+{
+  UINT32 Index;
+  UINT8  Char;
+
+  for (Index = 0; Index < 8; Index++) {
+    Char = (UINT8)((Value >> ((7 - Index) * 4)) & 0x0f) + '0';
+    if (Char > '9') {
+      Char = Char - '0' - 10 + 'A';
+    }
+    *mCursor = Char;
+    mCursor += 2;
+  }
+}
+
+VOID
+PrintString (
+  UINT8 *String
+  )
+{
+  UINT32 Index;
+
+  for (Index = 0; String[Index] != 0; Index++) {
+    if (String[Index] == '\n') {
+      mCursor = (UINT8 *)(UINTN)(0xb8000 + (((((UINTN)mCursor - 0xb8000) + 160) / 160) * 160));
+    } else {
+      *mCursor = String[Index];
+      mCursor += 2;
+    }
+  }
+}
+