UefiCpuPkg: Move AsmRelocateApLoopStart from Mpfuncs.nasm to AmdSev.nasm

[mirror_edk2.git] / ShellPkg / Library / UefiShellAcpiViewCommandLib / Parsers / Dbg2 / Dbg2Parser.c

/** @file\r
  DBG2 table parser\r
\r
  Copyright (c) 2016 - 2020, ARM Limited. All rights reserved.\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
  @par Reference(s):\r
    - Microsoft Debug Port Table 2 (DBG2) Specification - December 10, 2015.\r
**/\r
\r
#include <IndustryStandard/DebugPort2Table.h>\r
#include <Library/UefiLib.h>\r
#include "AcpiParser.h"\r
#include "AcpiTableParser.h"\r
\r
// Local variables pointing to the table fields\r
STATIC CONST UINT32                  *OffsetDbgDeviceInfo;\r
STATIC CONST UINT32                  *NumberDbgDeviceInfo;\r
STATIC CONST UINT16                  *DbgDevInfoLen;\r
STATIC CONST UINT8                   *GasCount;\r
STATIC CONST UINT16                  *NameSpaceStringLength;\r
STATIC CONST UINT16                  *NameSpaceStringOffset;\r
STATIC CONST UINT16                  *OEMDataLength;\r
STATIC CONST UINT16                  *OEMDataOffset;\r
STATIC CONST UINT16                  *BaseAddrRegOffset;\r
STATIC CONST UINT16                  *AddrSizeOffset;\r
STATIC ACPI_DESCRIPTION_HEADER_INFO  AcpiHdrInfo;\r
\r
/**\r
  This function validates the NameSpace string length.\r
\r
  @param [in] Ptr     Pointer to the start of the buffer.\r
  @param [in] Context Pointer to context specific information e.g. this\r
                      could be a pointer to the ACPI table header.\r
**/\r
STATIC\r
VOID\r
EFIAPI\r
ValidateNameSpaceStrLen (\r
  IN UINT8  *Ptr,\r
  IN VOID   *Context\r
  )\r
{\r
  UINT16  NameSpaceStrLen;\r
\r
  NameSpaceStrLen = *(UINT16 *)Ptr;\r
\r
  if (NameSpaceStrLen < 2) {\r
    IncrementErrorCount ();\r
    Print (\r
      L"\nERROR: NamespaceString Length = %d. If no Namespace device exists, " \\r
      L"NamespaceString[] must contain a period '.'",\r
      NameSpaceStrLen\r
      );\r
  }\r
}\r
\r
/// An ACPI_PARSER array describing the ACPI DBG2 table.\r
STATIC CONST ACPI_PARSER  Dbg2Parser[] = {\r
  PARSE_ACPI_HEADER (&AcpiHdrInfo),\r
  { L"OffsetDbgDeviceInfo",        4,     36, L"0x%x", NULL,\r
    (VOID **)&OffsetDbgDeviceInfo, NULL,  NULL },\r
  { L"NumberDbgDeviceInfo",        4,     40, L"%d",   NULL,\r
    (VOID **)&NumberDbgDeviceInfo, NULL,  NULL }\r
};\r
\r
/// An ACPI_PARSER array describing the debug device information structure\r
/// header.\r
STATIC CONST ACPI_PARSER  DbgDevInfoHeaderParser[] = {\r
  { L"Revision", 1, 0, L"0x%x", NULL, NULL,                    NULL, NULL },\r
  { L"Length",   2, 1, L"%d",   NULL, (VOID **)&DbgDevInfoLen, NULL, NULL }\r
};\r
\r
/// An ACPI_PARSER array describing the debug device information.\r
STATIC CONST ACPI_PARSER  DbgDevInfoParser[] = {\r
  { L"Revision",                        1, 0,  L"0x%x", NULL, NULL,                    NULL, NULL },\r
  { L"Length",                          2, 1,  L"%d",   NULL, NULL,                    NULL, NULL },\r
\r
  { L"Generic Address Registers Count", 1, 3,  L"0x%x", NULL,\r
    (VOID **)&GasCount, NULL, NULL },\r
  { L"NameSpace String Length",         2, 4,  L"%d",   NULL,\r
    (VOID **)&NameSpaceStringLength, ValidateNameSpaceStrLen, NULL },\r
  { L"NameSpace String Offset",         2, 6,  L"0x%x", NULL,\r
    (VOID **)&NameSpaceStringOffset, NULL, NULL },\r
  { L"OEM Data Length",                 2, 8,  L"%d",   NULL, (VOID **)&OEMDataLength,\r
    NULL, NULL },\r
  { L"OEM Data Offset",                 2, 10, L"0x%x", NULL, (VOID **)&OEMDataOffset,\r
    NULL, NULL },\r
\r
  { L"Port Type",                       2, 12, L"0x%x", NULL, NULL,                    NULL, NULL },\r
  { L"Port SubType",                    2, 14, L"0x%x", NULL, NULL,                    NULL, NULL },\r
  { L"Reserved",                        2, 16, L"%x",   NULL, NULL,                    NULL, NULL },\r
\r
  { L"Base Address Register Offset",    2, 18, L"0x%x", NULL,\r
    (VOID **)&BaseAddrRegOffset, NULL, NULL },\r
  { L"Address Size Offset",             2, 20, L"0x%x", NULL,\r
    (VOID **)&AddrSizeOffset, NULL, NULL }\r
};\r
\r
/**\r
  This function parses the debug device information structure.\r
\r
  @param [in] Ptr     Pointer to the start of the buffer.\r
  @param [in] Length  Length of the debug device information structure.\r
**/\r
STATIC\r
VOID\r
EFIAPI\r
DumpDbgDeviceInfo (\r
  IN UINT8   *Ptr,\r
  IN UINT16  Length\r
  )\r
{\r
  UINT16  Index;\r
  UINT16  Offset;\r
\r
  ParseAcpi (\r
    TRUE,\r
    2,\r
    "Debug Device Info",\r
    Ptr,\r
    Length,\r
    PARSER_PARAMS (DbgDevInfoParser)\r
    );\r
\r
  // Check if the values used to control the parsing logic have been\r
  // successfully read.\r
  if ((GasCount == NULL)              ||\r
      (NameSpaceStringLength == NULL) ||\r
      (NameSpaceStringOffset == NULL) ||\r
      (OEMDataLength == NULL)         ||\r
      (OEMDataOffset == NULL)         ||\r
      (BaseAddrRegOffset == NULL)     ||\r
      (AddrSizeOffset == NULL))\r
  {\r
    IncrementErrorCount ();\r
    Print (\r
      L"ERROR: Insufficient Debug Device Information Structure length. " \\r
      L"Length = %d.\n",\r
      Length\r
      );\r
    return;\r
  }\r
\r
  // GAS\r
  Index  = 0;\r
  Offset = *BaseAddrRegOffset;\r
  while ((Index++ < *GasCount) &&\r
         (Offset < Length))\r
  {\r
    PrintFieldName (4, L"BaseAddressRegister");\r
    Offset += (UINT16)DumpGasStruct (\r
                        Ptr + Offset,\r
                        4,\r
                        Length - Offset\r
                        );\r
  }\r
\r
  // Make sure the array of address sizes corresponding to each GAS fit in the\r
  // Debug Device Information structure\r
  if ((*AddrSizeOffset + (*GasCount * sizeof (UINT32))) > Length) {\r
    IncrementErrorCount ();\r
    Print (\r
      L"ERROR: Invalid GAS count. GasCount = %d. RemainingBufferLength = %d. " \\r
      L"Parsing of the Debug Device Information structure aborted.\n",\r
      *GasCount,\r
      Length - *AddrSizeOffset\r
      );\r
    return;\r
  }\r
\r
  // Address Size\r
  Index  = 0;\r
  Offset = *AddrSizeOffset;\r
  while ((Index++ < *GasCount) &&\r
         (Offset < Length))\r
  {\r
    PrintFieldName (4, L"Address Size");\r
    Print (L"0x%x\n", *((UINT32 *)(Ptr + Offset)));\r
    Offset += sizeof (UINT32);\r
  }\r
\r
  // NameSpace String\r
  Index  = 0;\r
  Offset = *NameSpaceStringOffset;\r
  PrintFieldName (4, L"NameSpace String");\r
  while ((Index++ < *NameSpaceStringLength) &&\r
         (Offset < Length))\r
  {\r
    Print (L"%c", *(Ptr + Offset));\r
    Offset++;\r
  }\r
\r
  Print (L"\n");\r
\r
  // OEM Data\r
  if (*OEMDataOffset != 0) {\r
    Index  = 0;\r
    Offset = *OEMDataOffset;\r
    PrintFieldName (4, L"OEM Data");\r
    while ((Index++ < *OEMDataLength) &&\r
           (Offset < Length))\r
    {\r
      Print (L"%x ", *(Ptr + Offset));\r
      if ((Index & 7) == 0) {\r
        Print (L"\n%-*s   ", OUTPUT_FIELD_COLUMN_WIDTH, L"");\r
      }\r
\r
      Offset++;\r
    }\r
\r
    Print (L"\n");\r
  }\r
}\r
\r
/**\r
  This function parses the ACPI DBG2 table.\r
  When trace is enabled this function parses the DBG2 table and\r
  traces the ACPI table fields.\r
\r
  This function also performs validation of the ACPI table fields.\r
\r
  @param [in] Trace              If TRUE, trace the ACPI fields.\r
  @param [in] Ptr                Pointer to the start of the buffer.\r
  @param [in] AcpiTableLength    Length of the ACPI table.\r
  @param [in] AcpiTableRevision  Revision of the ACPI table.\r
**/\r
VOID\r
EFIAPI\r
ParseAcpiDbg2 (\r
  IN BOOLEAN  Trace,\r
  IN UINT8    *Ptr,\r
  IN UINT32   AcpiTableLength,\r
  IN UINT8    AcpiTableRevision\r
  )\r
{\r
  UINT32  Offset;\r
  UINT32  Index;\r
\r
  if (!Trace) {\r
    return;\r
  }\r
\r
  Offset = ParseAcpi (\r
             TRUE,\r
             0,\r
             "DBG2",\r
             Ptr,\r
             AcpiTableLength,\r
             PARSER_PARAMS (Dbg2Parser)\r
             );\r
\r
  // Check if the values used to control the parsing logic have been\r
  // successfully read.\r
  if ((OffsetDbgDeviceInfo == NULL) ||\r
      (NumberDbgDeviceInfo == NULL))\r
  {\r
    IncrementErrorCount ();\r
    Print (\r
      L"ERROR: Insufficient table length. AcpiTableLength = %d\n",\r
      AcpiTableLength\r
      );\r
    return;\r
  }\r
\r
  Offset = *OffsetDbgDeviceInfo;\r
  Index  = 0;\r
\r
  while (Index++ < *NumberDbgDeviceInfo) {\r
    // Parse the Debug Device Information Structure header to obtain Length\r
    ParseAcpi (\r
      FALSE,\r
      0,\r
      NULL,\r
      Ptr + Offset,\r
      AcpiTableLength - Offset,\r
      PARSER_PARAMS (DbgDevInfoHeaderParser)\r
      );\r
\r
    // Check if the values used to control the parsing logic have been\r
    // successfully read.\r
    if (DbgDevInfoLen == NULL) {\r
      IncrementErrorCount ();\r
      Print (\r
        L"ERROR: Insufficient remaining table buffer length to read the " \\r
        L"Debug Device Information structure's 'Length' field. " \\r
        L"RemainingTableBufferLength = %d.\n",\r
        AcpiTableLength - Offset\r
        );\r
      return;\r
    }\r
\r
    // Validate Debug Device Information Structure length\r
    if ((*DbgDevInfoLen == 0) ||\r
        ((Offset + (*DbgDevInfoLen)) > AcpiTableLength))\r
    {\r
      IncrementErrorCount ();\r
      Print (\r
        L"ERROR: Invalid Debug Device Information Structure length. " \\r
        L"Length = %d. Offset = %d. AcpiTableLength = %d.\n",\r
        *DbgDevInfoLen,\r
        Offset,\r
        AcpiTableLength\r
        );\r
      return;\r
    }\r
\r
    DumpDbgDeviceInfo (Ptr + Offset, (*DbgDevInfoLen));\r
    Offset += (*DbgDevInfoLen);\r
  }\r
}\r