Contributed-under: TianoCore Contribution Agreement 1.0 Signed-off-by: Hao Wu <hao.a.wu@intel.com> Reviewed-by: Jiewen Yao <jiewen.yao@intel.com> git-svn-id: https://svn.code.sf.net/p/edk2/code/trunk/edk2@17743 6f19259b-4bc3-4df7-8a09-765794883524
		
			
				
	
	
		
			329 lines
		
	
	
		
			9.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			329 lines
		
	
	
		
			9.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/** @file
 | 
						|
 | 
						|
  Copyright (c) 2014 - 2015, 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
 | 
						|
  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.
 | 
						|
 | 
						|
**/
 | 
						|
 | 
						|
#include <Base.h>
 | 
						|
#include <Library/DebugLib.h>
 | 
						|
#include <Library/BaseLib.h>
 | 
						|
#include <Library/PrintLib.h>
 | 
						|
#include <Library/PcdLib.h>
 | 
						|
#include <Library/BaseMemoryLib.h>
 | 
						|
#include <Library/SerialPortLib.h>
 | 
						|
#include <Library/DebugDeviceLib.h>
 | 
						|
#include <Library/DebugPrintErrorLevelLib.h>
 | 
						|
 | 
						|
//
 | 
						|
// Define the maximum debug and assert message length that this library supports
 | 
						|
//
 | 
						|
#define MAX_DEBUG_MESSAGE_LENGTH  0x100
 | 
						|
 | 
						|
CONST CHAR8  *mHexTable = "0123456789ABCDEF";
 | 
						|
 | 
						|
/**
 | 
						|
  Get stack frame pointer of function call.
 | 
						|
 | 
						|
  @return StackFramePointer  stack frame pointer of function call.
 | 
						|
**/
 | 
						|
UINT32 *
 | 
						|
EFIAPI
 | 
						|
GetStackFramePointer (
 | 
						|
  VOID
 | 
						|
  );
 | 
						|
 | 
						|
 | 
						|
/**
 | 
						|
  Prints a debug message to the debug output device if the specified error level is enabled.
 | 
						|
 | 
						|
  If any bit in ErrorLevel is also set in DebugPrintErrorLevelLib function
 | 
						|
  GetDebugPrintErrorLevel (), then print the message specified by Format and the
 | 
						|
  associated variable argument list to the debug output device.
 | 
						|
 | 
						|
  If Format is NULL, then ASSERT().
 | 
						|
 | 
						|
  @param  ErrorLevel  The error level of the debug message.
 | 
						|
  @param  Format      Format string for the debug message to print.
 | 
						|
  @param  ...         Variable argument list whose contents are accessed
 | 
						|
                      based on the format string specified by Format.
 | 
						|
 | 
						|
**/
 | 
						|
VOID
 | 
						|
EFIAPI
 | 
						|
DebugPrint (
 | 
						|
  IN  UINTN        ErrorLevel,
 | 
						|
  IN  CONST CHAR8  *Format,
 | 
						|
  ...
 | 
						|
  )
 | 
						|
{
 | 
						|
  CHAR8    Buffer[MAX_DEBUG_MESSAGE_LENGTH];
 | 
						|
  VA_LIST  Marker;
 | 
						|
 | 
						|
  //
 | 
						|
  // If Format is NULL, then ASSERT().
 | 
						|
  //
 | 
						|
  if (!GetDebugPrintDeviceEnable ()) {
 | 
						|
    return;
 | 
						|
  }
 | 
						|
 | 
						|
  //
 | 
						|
  // Check driver debug mask value and global mask
 | 
						|
  //
 | 
						|
  if ((ErrorLevel & GetDebugPrintErrorLevel ()) == 0) {
 | 
						|
    return;
 | 
						|
  }
 | 
						|
 | 
						|
  //
 | 
						|
  // If Format is NULL, then ASSERT().
 | 
						|
  //
 | 
						|
  ASSERT (Format != NULL);
 | 
						|
 | 
						|
  //
 | 
						|
  // Convert the DEBUG() message to an ASCII String
 | 
						|
  //
 | 
						|
  VA_START (Marker, Format);
 | 
						|
  AsciiVSPrint (Buffer, sizeof (Buffer), Format, Marker);
 | 
						|
  VA_END (Marker);
 | 
						|
 | 
						|
  //
 | 
						|
  // Send the print string to a Serial Port
 | 
						|
  //
 | 
						|
  SerialPortWrite ((UINT8 *)Buffer, AsciiStrLen (Buffer));
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
  Convert an UINT32 value into HEX string sepcified by Buffer.
 | 
						|
 | 
						|
  @param  Value   The HEX value to convert to string
 | 
						|
  @param  Buffer  The pointer to the target buffer to be filled with HEX string
 | 
						|
 | 
						|
**/
 | 
						|
VOID
 | 
						|
FillHex (
 | 
						|
  UINT32   Value,
 | 
						|
  CHAR8   *Buffer
 | 
						|
  )
 | 
						|
{
 | 
						|
  INTN  Idx;
 | 
						|
  for (Idx = 7; Idx >= 0; Idx--) {
 | 
						|
    Buffer[Idx] = mHexTable[Value & 0x0F];
 | 
						|
    Value >>= 4;
 | 
						|
  }
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
  Prints an assert message containing a filename, line number, and description.
 | 
						|
  This may be followed by a breakpoint or a dead loop.
 | 
						|
 | 
						|
  Print a message of the form "ASSERT <FileName>(<LineNumber>): <Description>\n"
 | 
						|
  to the debug output device.  If DEBUG_PROPERTY_ASSERT_BREAKPOINT_ENABLED bit of
 | 
						|
  PcdDebugProperyMask is set then CpuBreakpoint() is called. Otherwise, if
 | 
						|
  DEBUG_PROPERTY_ASSERT_DEADLOOP_ENABLED bit of PcdDebugProperyMask is set then
 | 
						|
  CpuDeadLoop() is called.  If neither of these bits are set, then this function
 | 
						|
  returns immediately after the message is printed to the debug output device.
 | 
						|
  DebugAssert() must actively prevent recursion.  If DebugAssert() is called while
 | 
						|
  processing another DebugAssert(), then DebugAssert() must return immediately.
 | 
						|
 | 
						|
  If FileName is NULL, then a <FileName> string of "(NULL) Filename" is printed.
 | 
						|
  If Description is NULL, then a <Description> string of "(NULL) Description" is printed.
 | 
						|
 | 
						|
**/
 | 
						|
VOID
 | 
						|
DebugAssertInternal (
 | 
						|
  VOID
 | 
						|
  )
 | 
						|
{
 | 
						|
  CHAR8     Buffer[MAX_DEBUG_MESSAGE_LENGTH];
 | 
						|
  UINT32   *Frame;
 | 
						|
 | 
						|
  Frame = (UINT32 *)GetStackFramePointer ();
 | 
						|
 | 
						|
  //
 | 
						|
  // Generate the ASSERT() message in Ascii format
 | 
						|
  //
 | 
						|
  AsciiStrnCpyS (
 | 
						|
    Buffer,
 | 
						|
    sizeof(Buffer) / sizeof(CHAR8),
 | 
						|
    "-> EBP:0x00000000  EIP:0x00000000\n",
 | 
						|
    sizeof(Buffer) / sizeof(CHAR8) - 1
 | 
						|
    );
 | 
						|
  SerialPortWrite ((UINT8 *)"ASSERT DUMP:\n", 13);
 | 
						|
  while (Frame != NULL) {
 | 
						|
    FillHex ((UINT32)Frame, Buffer + 9);
 | 
						|
    FillHex (Frame[1], Buffer + 9 + 8 + 8);
 | 
						|
    SerialPortWrite ((UINT8 *)Buffer, AsciiStrLen (Buffer));
 | 
						|
    if ((Frame[0] > (UINT32)Frame) && (Frame[0] < (UINT32)Frame + 0x00100000)) {
 | 
						|
      Frame = (UINT32 *)Frame[0];
 | 
						|
    } else {
 | 
						|
      Frame = NULL;
 | 
						|
    }
 | 
						|
  }
 | 
						|
 | 
						|
  //
 | 
						|
  // Dead loop
 | 
						|
  //
 | 
						|
  CpuDeadLoop ();
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
  Prints an assert message containing a filename, line number, and description.
 | 
						|
  This may be followed by a breakpoint or a dead loop.
 | 
						|
 | 
						|
  Print a message of the form "ASSERT <FileName>(<LineNumber>): <Description>\n"
 | 
						|
  to the debug output device.  If DEBUG_PROPERTY_ASSERT_BREAKPOINT_ENABLED bit of
 | 
						|
  PcdDebugProperyMask is set then CpuBreakpoint() is called. Otherwise, if
 | 
						|
  DEBUG_PROPERTY_ASSERT_DEADLOOP_ENABLED bit of PcdDebugProperyMask is set then
 | 
						|
  CpuDeadLoop() is called.  If neither of these bits are set, then this function
 | 
						|
  returns immediately after the message is printed to the debug output device.
 | 
						|
  DebugAssert() must actively prevent recursion.  If DebugAssert() is called while
 | 
						|
  processing another DebugAssert(), then DebugAssert() must return immediately.
 | 
						|
 | 
						|
  If FileName is NULL, then a <FileName> string of "(NULL) Filename" is printed.
 | 
						|
  If Description is NULL, then a <Description> string of "(NULL) Description" is printed.
 | 
						|
 | 
						|
  @param  FileName     The pointer to the name of the source file that generated the assert condition.
 | 
						|
  @param  LineNumber   The line number in the source file that generated the assert condition
 | 
						|
  @param  Description  The pointer to the description of the assert condition.
 | 
						|
 | 
						|
**/
 | 
						|
VOID
 | 
						|
EFIAPI
 | 
						|
DebugAssert (
 | 
						|
  IN CONST CHAR8  *FileName,
 | 
						|
  IN UINTN        LineNumber,
 | 
						|
  IN CONST CHAR8  *Description
 | 
						|
  )
 | 
						|
{
 | 
						|
  DebugAssertInternal ();
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/**
 | 
						|
  Fills a target buffer with PcdDebugClearMemoryValue, and returns the target buffer.
 | 
						|
 | 
						|
  This function fills Length bytes of Buffer with the value specified by
 | 
						|
  PcdDebugClearMemoryValue, and returns Buffer.
 | 
						|
 | 
						|
  If Buffer is NULL, then ASSERT().
 | 
						|
  If Length is greater than (MAX_ADDRESS - Buffer + 1), then ASSERT().
 | 
						|
 | 
						|
  @param   Buffer  The pointer to the target buffer to be filled with PcdDebugClearMemoryValue.
 | 
						|
  @param   Length  The number of bytes in Buffer to fill with zeros PcdDebugClearMemoryValue.
 | 
						|
 | 
						|
  @return  Buffer  The pointer to the target buffer filled with PcdDebugClearMemoryValue.
 | 
						|
 | 
						|
**/
 | 
						|
VOID *
 | 
						|
EFIAPI
 | 
						|
DebugClearMemory (
 | 
						|
  OUT VOID  *Buffer,
 | 
						|
  IN UINTN  Length
 | 
						|
  )
 | 
						|
{
 | 
						|
  return Buffer;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/**
 | 
						|
  Returns TRUE if ASSERT() macros are enabled.
 | 
						|
 | 
						|
  This function returns TRUE if the DEBUG_PROPERTY_DEBUG_ASSERT_ENABLED bit of
 | 
						|
  PcdDebugProperyMask is set.  Otherwise FALSE is returned.
 | 
						|
 | 
						|
  @retval  TRUE    The DEBUG_PROPERTY_DEBUG_ASSERT_ENABLED bit of PcdDebugProperyMask is set.
 | 
						|
  @retval  FALSE   The DEBUG_PROPERTY_DEBUG_ASSERT_ENABLED bit of PcdDebugProperyMask is clear.
 | 
						|
 | 
						|
**/
 | 
						|
BOOLEAN
 | 
						|
EFIAPI
 | 
						|
DebugAssertEnabled (
 | 
						|
  VOID
 | 
						|
  )
 | 
						|
{
 | 
						|
  return (BOOLEAN) ((PcdGet8(PcdDebugPropertyMask) & DEBUG_PROPERTY_DEBUG_ASSERT_ENABLED) != 0);
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/**
 | 
						|
  Returns TRUE if DEBUG() macros are enabled.
 | 
						|
 | 
						|
  This function returns TRUE if the DEBUG_PROPERTY_DEBUG_PRINT_ENABLED bit of
 | 
						|
  PcdDebugProperyMask is set.  Otherwise FALSE is returned.
 | 
						|
 | 
						|
  @retval  TRUE    The DEBUG_PROPERTY_DEBUG_PRINT_ENABLED bit of PcdDebugProperyMask is set.
 | 
						|
  @retval  FALSE   The DEBUG_PROPERTY_DEBUG_PRINT_ENABLED bit of PcdDebugProperyMask is clear.
 | 
						|
 | 
						|
**/
 | 
						|
BOOLEAN
 | 
						|
EFIAPI
 | 
						|
DebugPrintEnabled (
 | 
						|
  VOID
 | 
						|
  )
 | 
						|
{
 | 
						|
  return (BOOLEAN) ((PcdGet8(PcdDebugPropertyMask) & DEBUG_PROPERTY_DEBUG_PRINT_ENABLED) != 0);
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
  Returns TRUE if DEBUG_CODE() macros are enabled.
 | 
						|
 | 
						|
  This function returns TRUE if the DEBUG_PROPERTY_DEBUG_CODE_ENABLED bit of
 | 
						|
  PcdDebugProperyMask is set.  Otherwise FALSE is returned.
 | 
						|
 | 
						|
  @retval  TRUE    The DEBUG_PROPERTY_DEBUG_CODE_ENABLED bit of PcdDebugProperyMask is set.
 | 
						|
  @retval  FALSE   The DEBUG_PROPERTY_DEBUG_CODE_ENABLED bit of PcdDebugProperyMask is clear.
 | 
						|
 | 
						|
**/
 | 
						|
BOOLEAN
 | 
						|
EFIAPI
 | 
						|
DebugCodeEnabled (
 | 
						|
  VOID
 | 
						|
  )
 | 
						|
{
 | 
						|
  return (BOOLEAN) ((PcdGet8(PcdDebugPropertyMask) & DEBUG_PROPERTY_DEBUG_CODE_ENABLED) != 0);
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/**
 | 
						|
  Returns TRUE if DEBUG_CLEAR_MEMORY() macro is enabled.
 | 
						|
 | 
						|
  This function returns TRUE if the DEBUG_PROPERTY_CLEAR_MEMORY_ENABLED bit of
 | 
						|
  PcdDebugProperyMask is set.  Otherwise FALSE is returned.
 | 
						|
 | 
						|
  @retval  TRUE    The DEBUG_PROPERTY_CLEAR_MEMORY_ENABLED bit of PcdDebugProperyMask is set.
 | 
						|
  @retval  FALSE   The DEBUG_PROPERTY_CLEAR_MEMORY_ENABLED bit of PcdDebugProperyMask is clear.
 | 
						|
 | 
						|
**/
 | 
						|
BOOLEAN
 | 
						|
EFIAPI
 | 
						|
DebugClearMemoryEnabled (
 | 
						|
  VOID
 | 
						|
  )
 | 
						|
{
 | 
						|
  return (BOOLEAN) ((PcdGet8(PcdDebugPropertyMask) & DEBUG_PROPERTY_CLEAR_MEMORY_ENABLED) != 0);
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
  Returns TRUE if any one of the bit is set both in ErrorLevel and PcdFixedDebugPrintErrorLevel.
 | 
						|
 | 
						|
  This function compares the bit mask of ErrorLevel and PcdFixedDebugPrintErrorLevel.
 | 
						|
 | 
						|
  @retval  TRUE    Current ErrorLevel is supported.
 | 
						|
  @retval  FALSE   Current ErrorLevel is not supported.
 | 
						|
 | 
						|
**/
 | 
						|
BOOLEAN
 | 
						|
EFIAPI
 | 
						|
DebugPrintLevelEnabled (
 | 
						|
  IN  CONST UINTN        ErrorLevel
 | 
						|
  )
 | 
						|
{
 | 
						|
  return (BOOLEAN) ((ErrorLevel & PcdGet32(PcdFixedDebugPrintErrorLevel)) != 0);
 | 
						|
}
 |