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);
 | |
| }
 |