Initial import.

[mirror_edk2.git] / EdkModulePkg / Library / EdkDxeDebugLibReportStatusCode / DebugLib.c

/*++\r
\r
Copyright (c) 2006, Intel Corporation                                                         \r
All rights reserved. This program and the accompanying materials                          \r
are licensed and made available under the terms and conditions of the BSD License         \r
which accompanies this distribution.  The full text of the license may be found at        \r
http://opensource.org/licenses/bsd-license.php                                            \r
                                                                                          \r
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     \r
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             \r
\r
Module Name:\r
\r
  DebugLib.c\r
\r
Abstract:\r
\r
  EFI Debug Library \r
\r
--*/\r
\r
static BOOLEAN                   mDebugLevelInstalled = FALSE;\r
static EFI_DEBUG_LEVEL_PROTOCOL  mDebugLevel = { 0 };\r
\r
EFI_STATUS\r
DebugLibConstructor (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
/*++\r
\r
Routine Description:\r
\r
Arguments:\r
\r
Returns:\r
\r
--*/\r
{\r
  EFI_STATUS               Status;\r
\r
  //\r
  // Initialize Debug Level Protocol\r
  //\r
  mDebugLevel.DebugLevel = PcdGet32(PcdDebugPrintErrorLevel);\r
\r
  //\r
  // Install Debug Level Protocol \r
  //\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  &ImageHandle,\r
                  &gEfiDebugLevelProtocolGuid, &mDebugLevel,\r
                  NULL\r
                  );\r
  ASSERT_EFI_ERROR (Status);\r
\r
  //\r
  // Set flag to show that the Debug Level Protocol has been installed\r
  //\r
  mDebugLevelInstalled = TRUE;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
VOID\r
EFIAPI\r
DebugAssert (\r
  IN CHAR8  *FileName,\r
  IN INTN   LineNumber,\r
  IN CHAR8  *Description\r
  )\r
/*++\r
\r
Routine Description:\r
\r
  Worker function for ASSERT(). If Error Logging hub is loaded log ASSERT\r
  information. If Error Logging hub is not loaded CpuBreakpoint ().\r
\r
  We use UINT64 buffers due to IPF alignment concerns.\r
\r
Arguments:\r
\r
  FileName    - File name of failing routine.\r
\r
  LineNumber  - Line number of failing ASSERT().\r
\r
  Description - Descritption, usally the assertion,\r
  \r
Returns:\r
  \r
  None\r
\r
--*/\r
{\r
  UINT64                 Buffer[EFI_STATUS_CODE_DATA_MAX_SIZE / sizeof(UINT64)];\r
  EFI_DEBUG_ASSERT_DATA  *AssertData;\r
  UINTN                  TotalSize;\r
  CHAR8                  *Temp;\r
\r
  if ((PcdGet8(PcdDebugPropertyMask) & DEBUG_PROPERTY_DEBUG_ASSERT_ENABLED) == 0) {\r
    return;\r
  }\r
\r
  //\r
  // Make sure it will all fit in the passed in buffer\r
  //\r
  TotalSize = sizeof (EFI_DEBUG_ASSERT_DATA) + AsciiStrLen (FileName) + 1 + AsciiStrLen (Description) + 1;\r
  if (TotalSize <= EFI_STATUS_CODE_DATA_MAX_SIZE) {\r
    //\r
    // Fill in EFI_DEBUG_ASSERT_DATA\r
    //\r
    AssertData = (EFI_DEBUG_ASSERT_DATA *)Buffer;\r
    AssertData->LineNumber = (UINT32)LineNumber;\r
\r
    //\r
    // Copy Ascii FileName including NULL.\r
    //\r
    Temp = AsciiStrCpy ((CHAR8 *)(AssertData + 1), FileName);\r
\r
    //\r
    // Copy Ascii Description \r
    //\r
    AsciiStrCpy (Temp + AsciiStrLen(FileName) + 1, Description);\r
\r
    REPORT_STATUS_CODE_WITH_EXTENDED_DATA (\r
      (EFI_ERROR_CODE | EFI_ERROR_UNRECOVERED),\r
      (EFI_SOFTWARE_DXE_BS_DRIVER | EFI_SW_EC_ILLEGAL_SOFTWARE_STATE),\r
      AssertData,\r
      TotalSize\r
      );\r
  }\r
\r
  //\r
  // Put break point in module that contained the error.\r
  //\r
  CpuBreakpoint ();\r
}\r
\r
VOID\r
DebugVPrint (\r
  IN  UINTN    ErrorLevel,\r
  IN  CHAR8    *Format,\r
  IN  VA_LIST  Marker\r
  )\r
/*++\r
\r
Routine Description:\r
\r
  Worker function for DEBUG(). If Error Logging hub is loaded log ASSERT\r
  information. If Error Logging hub is not loaded do nothing.\r
\r
  We use UINT64 buffers due to IPF alignment concerns.\r
\r
Arguments:\r
\r
  ErrorLevel - If error level is set do the debug print.\r
\r
  Format     - String to use for the print, followed by Print arguments.\r
\r
  Marker     - VarArgs\r
  \r
Returns:\r
  \r
  None\r
\r
--*/\r
{\r
  UINT64          Buffer[EFI_STATUS_CODE_DATA_MAX_SIZE / sizeof (UINT64)];\r
  EFI_DEBUG_INFO  *DebugInfo;\r
  UINTN           TotalSize;\r
  UINTN           Index;\r
  UINT64          *ArgumentPointer;\r
\r
  //\r
  // Check driver Debug Level value and global debug level\r
  //\r
  if (mDebugLevelInstalled) {\r
    if ((ErrorLevel & mDebugLevel.DebugLevel) == 0) {\r
      return;\r
    }\r
  } else {\r
    if ((ErrorLevel & PcdGet32(PcdDebugPrintErrorLevel)) == 0) {\r
      return;\r
    }\r
  }\r
\r
  TotalSize = sizeof (EFI_DEBUG_INFO) + 12 * sizeof (UINT64 *) + AsciiStrLen (Format) + 1;\r
  if (TotalSize > EFI_STATUS_CODE_DATA_MAX_SIZE) {\r
    return;\r
  }\r
\r
  //\r
  // Then EFI_DEBUG_INFO\r
  //\r
  DebugInfo = (EFI_DEBUG_INFO *)Buffer;\r
  DebugInfo->ErrorLevel = (UINT32)ErrorLevel;\r
\r
  //\r
  // 256 byte mini Var Arg stack. That is followed by the format string.\r
  //\r
  for (Index = 0, ArgumentPointer = (UINT64 *)(DebugInfo + 1); Index < 12; Index++, ArgumentPointer++) {\r
    *ArgumentPointer = VA_ARG (Marker, UINT64);\r
  }\r
  AsciiStrCpy ((CHAR8 *)ArgumentPointer, Format);\r
\r
  //\r
  //\r
  //\r
  REPORT_STATUS_CODE_WITH_EXTENDED_DATA (\r
    EFI_DEBUG_CODE,\r
    (EFI_SOFTWARE_DXE_BS_DRIVER | EFI_DC_UNSPECIFIED),\r
    DebugInfo,\r
    TotalSize\r
    );\r
}\r
\r
VOID\r
EFIAPI\r
DebugPrint (\r
  IN  UINTN  ErrorLevel,\r
  IN  CHAR8  *Format,\r
  ...\r
  )\r
/*++\r
\r
Routine Description:\r
\r
  Wrapper for DebugVPrint ()\r
  \r
Arguments:\r
\r
  ErrorLevel - If error level is set do the debug print.\r
\r
  Format     - String to use for the print, followed by Print arguments.\r
\r
  ...        - Print arguments.\r
\r
Returns:\r
  \r
  None\r
\r
--*/\r
{\r
  VA_LIST Marker;\r
\r
  VA_START (Marker, Format);\r
  DebugVPrint (ErrorLevel, Format, Marker);\r
  VA_END (Marker);\r
}\r
\r
/**\r
  Fills a target buffer with PcdDebugClearMemoryValue, and returns the target buffer.\r
\r
  This function fills Length bytes of Buffer with the value specified by \r
  PcdDebugClearMemoryValue, and returns Buffer.\r
\r
  If Buffer is NULL, then ASSERT().\r
\r