DynamicTablesPkg: Add AmlGetEisaIdFromString() to AcpiHelperLib

[mirror_edk2.git] / DynamicTablesPkg / Library / Common / AcpiHelperLib / AcpiHelper.c

/** @file\r
  Acpi Helper\r
\r
  Copyright (c) 2017 - 2021, Arm Limited. All rights reserved.<BR>\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
**/\r
\r
#include <Library/BaseLib.h>\r
#include <Library/DebugLib.h>\r
\r
// Module specific include files.\r
#include <Library/AcpiHelperLib.h>\r
\r
/** Convert a hex number to its ASCII code.\r
\r
 @param [in]  Hex   Hex number to convert.\r
                    Must be 0 <= x < 16.\r
\r
 @return The ASCII code corresponding to x.\r
         -1 if error.\r
**/\r
UINT8\r
EFIAPI\r
AsciiFromHex (\r
  IN  UINT8   Hex\r
  )\r
{\r
  if (Hex < 10) {\r
    return (UINT8)(Hex + '0');\r
  }\r
\r
  if (Hex < 16) {\r
    return (UINT8)(Hex - 10 + 'A');\r
  }\r
\r
  ASSERT (FALSE);\r
  return (UINT8)-1;\r
}\r
\r
/** Convert an ASCII char representing an hexadecimal number\r
    to its integer value.\r
\r
 @param [in]  Char  Char to convert.\r
                    Must be between '0'-'9' or 'A'-'F' or 'a'-'f'.\r
\r
 @return The corresponding integer (between 0-16).\r
         -1 if error.\r
**/\r
UINT8\r
EFIAPI\r
HexFromAscii (\r
  IN  CHAR8   Char\r
  )\r
{\r
  if ((Char >= '0') && (Char <= '9')) {\r
    return (UINT8)(Char - '0');\r
  }\r
\r
  if ((Char >= 'A') && (Char <= 'F')) {\r
    return (UINT8)(Char - 'A' + 10);\r
  }\r
\r
  if ((Char >= 'a') && (Char <= 'f')) {\r
    return (UINT8)(Char - 'a' + 10);\r
  }\r
\r
  ASSERT (FALSE);\r
  return (UINT8)-1;\r
}\r
\r
/** Check if a HID is a valid PNP ID.\r
\r
  @param     [in] Hid     The Hid to validate.\r
\r
  @retval    TRUE         The Hid is a valid PNP ID.\r
  @retval    FALSE        The Hid is not a valid PNP ID.\r
**/\r
BOOLEAN\r
IsValidPnpId (\r
  IN  CONST CHAR8  * Hid\r
  )\r
{\r
  UINTN Index;\r
\r
  if (AsciiStrLen (Hid) != 7) {\r
    return FALSE;\r
  }\r
\r
  // A valid PNP ID must be of the form "AAA####"\r
  // where A is an uppercase letter and # is a hex digit.\r
  for (Index = 0; Index < 3; Index++) {\r
    if (!IS_UPPER_CHAR (Hid[Index])) {\r
      return FALSE;\r
    }\r
  }\r
\r
  for (Index = 3; Index < 7; Index++) {\r
    if (!IS_UPPER_HEX (Hid[Index])) {\r
      return FALSE;\r
    }\r
  }\r
\r
  return TRUE;\r
}\r
\r
/** Check if a HID is a valid ACPI ID.\r
\r
  @param     [in] Hid     The Hid to validate.\r
\r
  @retval    TRUE         The Hid is a valid ACPI ID.\r
  @retval    FALSE        The Hid is not a valid ACPI ID.\r
**/\r
BOOLEAN\r
IsValidAcpiId (\r
  IN  CONST CHAR8  * Hid\r
  )\r
{\r
  UINTN Index;\r
\r
  if (AsciiStrLen (Hid) != 8) {\r
    return FALSE;\r
  }\r
\r
  // A valid ACPI ID must be of the form "NNNN####"\r
  // where N is an uppercase letter or a digit ('0'-'9')\r
  // and # is a hex digit.\r
  for (Index = 0; Index < 4; Index++) {\r
    if (!(IS_UPPER_CHAR (Hid[Index]) || IS_DIGIT (Hid[Index]))) {\r
      return FALSE;\r
    }\r
  }\r
\r
  for (Index = 4; Index < 8; Index++) {\r
    if (!IS_UPPER_HEX (Hid[Index])) {\r
      return FALSE;\r
    }\r
  }\r
\r
  return TRUE;\r
}\r
\r
/** Convert a EisaId string to its compressed UINT32 equivalent.\r
\r
  Cf. ACPI 6.4 specification, s19.3.4 "ASL Macros": "Eisaid"\r
\r
  @param  [in]  EisaIdStr   Input EisaId string.\r
  @param  [out] EisaIdInt   Output EisaId UINT32 (compressed).\r
\r
  @retval EFI_SUCCESS             The function completed successfully.\r
  @retval EFI_INVALID_PARAMETER   Invalid parameter.\r
**/\r
EFI_STATUS\r
EFIAPI\r
AmlGetEisaIdFromString (\r
  IN  CONST CHAR8   * EisaIdStr,\r
  OUT       UINT32  * EisaIdInt\r
  )\r
{\r
  if ((EisaIdStr == NULL)         ||\r
      (!IsValidPnpId (EisaIdStr)) ||\r
      (EisaIdInt == NULL)) {\r
    ASSERT (0);\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  /* Cf. ACPI 6.4 specification, s19.3.4 "ASL Macros": "Eisaid"\r
\r
  Converts and compresses the 7-character text argument into its corresponding\r
  4-byte numeric EISA ID encoding (Integer). This can be used when declaring\r
  IDs for devices that are EISA IDs.\r
\r
  The algorithm used to convert the TextID is as shown in the following\r
  example:\r
    Starting with a seven character input string "PNP0303", we want to create\r
    a DWordConst. This string contains a three character manufacturer code\r
    "PNP", a three character hex product identifier "030", and a one character\r
    revision identifier "3".\r
    The compressed manufacturer code is created as follows:\r
      1) Find hex ASCII value for each letter\r
      2) Subtract 40h from each ASCII value\r
      3) Retain 5 least significant bits for each letter and discard remaining\r
         0's:\r
\r
      Byte 0:\r
        Bit 7: reserved (0)\r
        Bit 6-2: 1st character of compressed mfg code "P"\r
        Bit 1-0: Upper 2 bits of 2nd character of mfg code "N"\r
      Byte 1:\r
        Bit 7-5: Lower 3 bits of 2nd character of mfg code "N"\r
        Bit 4-0: 3rd character of mfg code "P"\r
      Byte 2:\r
        Bit 7-4: 1st hex digit of product number "0"\r
        Bit 3-0: 2nd hex digit of product number "3"\r
      Byte 3:\r
        Bit 7-4: 3rd hex digit of product number "0"\r
        Bit 3-0: 4th hex digit of product number "3"\r
  */\r
  *EisaIdInt = SwapBytes32 (\r
    ((EisaIdStr[0] - 0x40) << 26)       |\r
    ((EisaIdStr[1] - 0x40) << 21)       |\r
    ((EisaIdStr[2] - 0x40) << 16)       |\r
    (HexFromAscii (EisaIdStr[3]) << 12) |\r
    (HexFromAscii (EisaIdStr[4]) << 8)  |\r
    (HexFromAscii (EisaIdStr[5]) << 4)  |\r
    (HexFromAscii (EisaIdStr[6]))\r
    );\r
\r
  return EFI_SUCCESS;\r
}\r