]> git.proxmox.com Git - mirror_edk2.git/blobdiff - MdeModulePkg/Library/DxeNetLib/DxeNetLib.c
MdePkg/Include: Add enumeration size checks to Base.h
[mirror_edk2.git] / MdeModulePkg / Library / DxeNetLib / DxeNetLib.c
index cfda3962bb82a3d072c90476937455869820ee1b..148bebf4e7fdd1ebbf1400438eb4d8a9c19df9e6 100644 (file)
@@ -1,7 +1,8 @@
 /** @file\r
   Network library.\r
 \r
-Copyright (c) 2005 - 2013, Intel Corporation. All rights reserved.<BR>\r
+Copyright (c) 2005 - 2016, Intel Corporation. All rights reserved.<BR>\r
+(C) Copyright 2015 Hewlett Packard Enterprise Development LP<BR>\r
 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
@@ -19,12 +20,10 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
 #include <Protocol/ServiceBinding.h>\r
 #include <Protocol/SimpleNetwork.h>\r
 #include <Protocol/ManagedNetwork.h>\r
-#include <Protocol/HiiConfigRouting.h>\r
+#include <Protocol/Ip4Config2.h>\r
 #include <Protocol/ComponentName.h>\r
 #include <Protocol/ComponentName2.h>\r
-#include <Protocol/HiiConfigAccess.h>\r
 \r
-#include <Guid/NicIp4ConfigNvData.h>\r
 #include <Guid/SmBios.h>\r
 \r
 #include <Library/NetLib.h>\r
@@ -35,7 +34,6 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
 #include <Library/UefiRuntimeServicesTableLib.h>\r
 #include <Library/MemoryAllocationLib.h>\r
 #include <Library/DevicePathLib.h>\r
-#include <Library/HiiLib.h>\r
 #include <Library/PrintLib.h>\r
 #include <Library/UefiLib.h>\r
 \r
@@ -303,7 +301,7 @@ ON_EXIT:
   Build a syslog packet, including the Ethernet/Ip/Udp headers\r
   and user's message.\r
 \r
-  @param[in]  Level     Syslog servity level\r
+  @param[in]  Level     Syslog severity level\r
   @param[in]  Module    The module that generates the log\r
   @param[in]  File      The file that contains the current log\r
   @param[in]  Line      The line of code in the File that contains the current log\r
@@ -477,7 +475,7 @@ NetDebugASPrint (
   This function will locate a instance of SNP then send the message through it.\r
   Because it isn't open the SNP BY_DRIVER, apply caution when using it.\r
 \r
-  @param Level    The servity level of the message.\r
+  @param Level    The severity level of the message.\r
   @param Module   The Moudle that generates the log.\r
   @param File     The file that contains the log.\r
   @param Line     The exact line that contains the log.\r
@@ -567,7 +565,7 @@ NetGetMaskLength (
 {\r
   INTN                      Index;\r
 \r
-  for (Index = 0; Index < IP4_MASK_NUM; Index++) {\r
+  for (Index = 0; Index <= IP4_MASK_MAX; Index++) {\r
     if (NetMask == gIp4AllMasks[Index]) {\r
       break;\r
     }\r
@@ -796,7 +794,7 @@ NetIp6IsNetEqual (
   UINT8 Bit;\r
   UINT8 Mask;\r
 \r
-  ASSERT ((Ip1 != NULL) && (Ip2 != NULL) && (PrefixLength < IP6_PREFIX_NUM));\r
+  ASSERT ((Ip1 != NULL) && (Ip2 != NULL) && (PrefixLength <= IP6_PREFIX_MAX));\r
 \r
   if (PrefixLength == 0) {\r
     return TRUE;\r
@@ -856,11 +854,11 @@ Ip6Swap128 (
 }\r
 \r
 /**\r
-  Initialize a random seed using current time.\r
+  Initialize a random seed using current time and monotonic count.\r
 \r
-  Get current time first. Then initialize a random seed based on some basic\r
-  mathematics operation on the hour, day, minute, second, nanosecond and year\r
-  of the current time.\r
+  Get current time and monotonic count first. Then initialize a random seed \r
+  based on some basic mathematics operation on the hour, day, minute, second,\r
+  nanosecond and year of the current time and the monotonic count value.\r
 \r
   @return The random seed initialized with current time.\r
 \r
@@ -873,12 +871,16 @@ NetRandomInitSeed (
 {\r
   EFI_TIME                  Time;\r
   UINT32                    Seed;\r
+  UINT64                    MonotonicCount;\r
 \r
   gRT->GetTime (&Time, NULL);\r
   Seed = (~Time.Hour << 24 | Time.Day << 16 | Time.Minute << 8 | Time.Second);\r
   Seed ^= Time.Nanosecond;\r
   Seed ^= Time.Year << 7;\r
 \r
+  gBS->GetNextMonotonicCount (&MonotonicCount);\r
+  Seed += (UINT32) MonotonicCount;\r
+\r
   return Seed;\r
 }\r
 \r
@@ -1149,7 +1151,7 @@ NetDestroyLinkList (
   @param[in]  ChildHandleBuffer  An array of child handles to be freed. May be NULL\r
                                  if NumberOfChildren is 0.\r
 \r
-  @retval TURE                   Found the input Handle in ChildHandleBuffer.\r
+  @retval TRUE                   Found the input Handle in ChildHandleBuffer.\r
   @retval FALSE                  Can't find the input Handle in ChildHandleBuffer.\r
 \r
 **/\r
@@ -1634,7 +1636,7 @@ NetMapRemoveTail (
 /**\r
   Iterate through the netmap and call CallBack for each item.\r
 \r
-  It will contiue the traverse if CallBack returns EFI_SUCCESS, otherwise, break\r
+  It will continue the traverse if CallBack returns EFI_SUCCESS, otherwise, break\r
   from the loop. It returns the CallBack's last return value. This function is\r
   delete safe for the current item.\r
 \r
@@ -1686,86 +1688,6 @@ NetMapIterate (
 }\r
 \r
 \r
-/**\r
-  Internal function to get the child handle of the NIC handle.\r
-\r
-  @param[in]   Controller    NIC controller handle.\r
-  @param[out]  ChildHandle   Returned child handle.\r
-\r
-  @retval EFI_SUCCESS        Successfully to get child handle.\r
-  @retval Others             Failed to get child handle.\r
-\r
-**/\r
-EFI_STATUS\r
-NetGetChildHandle (\r
-  IN EFI_HANDLE         Controller,\r
-  OUT EFI_HANDLE        *ChildHandle\r
-  )\r
-{\r
-  EFI_STATUS                 Status;\r
-  EFI_HANDLE                 *Handles;\r
-  UINTN                      HandleCount;\r
-  UINTN                      Index;\r
-  EFI_DEVICE_PATH_PROTOCOL   *ChildDeviceDevicePath;\r
-  VENDOR_DEVICE_PATH         *VendorDeviceNode;\r
-\r
-  //\r
-  // Locate all EFI Hii Config Access protocols\r
-  //\r
-  Status = gBS->LocateHandleBuffer (\r
-                 ByProtocol,\r
-                 &gEfiHiiConfigAccessProtocolGuid,\r
-                 NULL,\r
-                 &HandleCount,\r
-                 &Handles\r
-                 );\r
-  if (EFI_ERROR (Status) || (HandleCount == 0)) {\r
-    return Status;\r
-  }\r
-\r
-  Status = EFI_NOT_FOUND;\r
-\r
-  for (Index = 0; Index < HandleCount; Index++) {\r
-\r
-    Status = EfiTestChildHandle (Controller, Handles[Index], &gEfiManagedNetworkServiceBindingProtocolGuid);\r
-    if (!EFI_ERROR (Status)) {\r
-      //\r
-      // Get device path on the child handle\r
-      //\r
-      Status = gBS->HandleProtocol (\r
-                     Handles[Index],\r
-                     &gEfiDevicePathProtocolGuid,\r
-                     (VOID **) &ChildDeviceDevicePath\r
-                     );\r
-\r
-      if (!EFI_ERROR (Status)) {\r
-        while (!IsDevicePathEnd (ChildDeviceDevicePath)) {\r
-          ChildDeviceDevicePath = NextDevicePathNode (ChildDeviceDevicePath);\r
-          //\r
-          // Parse one instance\r
-          //\r
-          if (ChildDeviceDevicePath->Type == HARDWARE_DEVICE_PATH &&\r
-              ChildDeviceDevicePath->SubType == HW_VENDOR_DP) {\r
-            VendorDeviceNode = (VENDOR_DEVICE_PATH *) ChildDeviceDevicePath;\r
-            if (CompareMem (&VendorDeviceNode->Guid, &gEfiNicIp4ConfigVariableGuid, sizeof (EFI_GUID)) == 0) {\r
-              //\r
-              // Found item matched gEfiNicIp4ConfigVariableGuid\r
-              //\r
-              *ChildHandle = Handles[Index];\r
-              FreePool (Handles);\r
-              return EFI_SUCCESS;\r
-            }\r
-          }\r
-        }\r
-      }\r
-    }\r
-  }\r
-\r
-  FreePool (Handles);\r
-  return Status;\r
-}\r
-\r
-\r
 /**\r
   This is the default unload handle for all the network drivers.\r
 \r
@@ -2250,7 +2172,7 @@ NetLibGetMacAddress (
     // Try to get SNP mode from MNP\r
     //\r
     Status = Mnp->GetModeData (Mnp, NULL, &SnpModeData);\r
-    if (EFI_ERROR (Status)) {\r
+    if (EFI_ERROR (Status) && (Status != EFI_NOT_STARTED)) {\r
       MnpSb->DestroyChild (MnpSb, MnpChildHandle);\r
       return Status;\r
     }\r
@@ -2564,12 +2486,11 @@ Exit:
   Check the default address used by the IPv4 driver is static or dynamic (acquired\r
   from DHCP).\r
 \r
-  If the controller handle does not have the NIC Ip4 Config Protocol installed, the\r
-  default address is static. If the EFI variable to save the configuration is not found,\r
-  the default address is static. Otherwise, get the result from the EFI variable which\r
-  saving the configuration.\r
+  If the controller handle does not have the EFI_IP4_CONFIG2_PROTOCOL installed, the\r
+  default address is static. If failed to get the policy from Ip4 Config2 Protocol, \r
+  the default address is static. Otherwise, get the result from Ip4 Config2 Protocol.\r
 \r
-  @param[in]   Controller     The controller handle which has the NIC Ip4 Config Protocol\r
+  @param[in]   Controller     The controller handle which has the EFI_IP4_CONFIG2_PROTOCOL \r
                               relative with the default address to judge.\r
 \r
   @retval TRUE           If the default address is static.\r
@@ -2582,107 +2503,34 @@ NetLibDefaultAddressIsStatic (
   )\r
 {\r
   EFI_STATUS                       Status;\r
-  EFI_HII_CONFIG_ROUTING_PROTOCOL  *HiiConfigRouting;\r
-  UINTN                            Len;\r
-  NIC_IP4_CONFIG_INFO              *ConfigInfo;\r
+  EFI_IP4_CONFIG2_PROTOCOL         *Ip4Config2;\r
+  UINTN                            DataSize;  \r
+  EFI_IP4_CONFIG2_POLICY           Policy;\r
   BOOLEAN                          IsStatic;\r
-  EFI_STRING                       ConfigHdr;\r
-  EFI_STRING                       ConfigResp;\r
-  EFI_STRING                       AccessProgress;\r
-  EFI_STRING                       AccessResults;\r
-  EFI_STRING                       String;\r
-  EFI_HANDLE                       ChildHandle;\r
-\r
-  ConfigInfo       = NULL;\r
-  ConfigHdr        = NULL;\r
-  ConfigResp       = NULL;\r
-  AccessProgress   = NULL;\r
-  AccessResults    = NULL;\r
-  IsStatic         = TRUE;\r
-\r
-  Status = gBS->LocateProtocol (\r
-                  &gEfiHiiConfigRoutingProtocolGuid,\r
-                  NULL,\r
-                  (VOID **) &HiiConfigRouting\r
-                  );\r
-  if (EFI_ERROR (Status)) {\r
-    return TRUE;\r
-  }\r
 \r
-  Status = NetGetChildHandle (Controller, &ChildHandle);\r
-  if (EFI_ERROR (Status)) {\r
-    return TRUE;\r
-  }\r
+  Ip4Config2 = NULL;\r
+  \r
+  DataSize = sizeof (EFI_IP4_CONFIG2_POLICY);\r
+\r
+  IsStatic   = TRUE;\r
 \r
   //\r
-  // Construct config request string header\r
+  // Get Ip4Config2 policy.\r
   //\r
-  ConfigHdr = HiiConstructConfigHdr (&gEfiNicIp4ConfigVariableGuid, EFI_NIC_IP4_CONFIG_VARIABLE, ChildHandle);\r
-  if (ConfigHdr == NULL) {\r
-    return TRUE;\r
-  }\r
-\r
-  Len = StrLen (ConfigHdr);\r
-  ConfigResp = AllocateZeroPool ((Len + NIC_ITEM_CONFIG_SIZE * 2 + 100) * sizeof (CHAR16));\r
-  if (ConfigResp == NULL) {\r
-    goto ON_EXIT;\r
-  }\r
-  StrCpy (ConfigResp, ConfigHdr);\r
-\r
-  String = ConfigResp + Len;\r
-  UnicodeSPrint (\r
-    String,\r
-    (8 + 4 + 7 + 4 + 1) * sizeof (CHAR16),\r
-    L"&OFFSET=%04X&WIDTH=%04X",\r
-    OFFSET_OF (NIC_IP4_CONFIG_INFO, Source),\r
-    sizeof (UINT32)\r
-    );\r
-\r
-  Status = HiiConfigRouting->ExtractConfig (\r
-                               HiiConfigRouting,\r
-                               ConfigResp,\r
-                               &AccessProgress,\r
-                               &AccessResults\r
-                               );\r
+  Status = gBS->HandleProtocol (Controller, &gEfiIp4Config2ProtocolGuid, (VOID **) &Ip4Config2);\r
   if (EFI_ERROR (Status)) {\r
     goto ON_EXIT;\r
   }\r
 \r
-  ConfigInfo = AllocateZeroPool (NIC_ITEM_CONFIG_SIZE);\r
-  if (ConfigInfo == NULL) {\r
-    goto ON_EXIT;\r
-  }\r
-\r
-  ConfigInfo->Source = IP4_CONFIG_SOURCE_STATIC;\r
-  Len = NIC_ITEM_CONFIG_SIZE;\r
-  Status = HiiConfigRouting->ConfigToBlock (\r
-                               HiiConfigRouting,\r
-                               AccessResults,\r
-                               (UINT8 *) ConfigInfo,\r
-                               &Len,\r
-                               &AccessProgress\r
-                               );\r
+  Status = Ip4Config2->GetData (Ip4Config2, Ip4Config2DataTypePolicy, &DataSize, &Policy);\r
   if (EFI_ERROR (Status)) {\r
     goto ON_EXIT;\r
   }\r
-\r
-  IsStatic = (BOOLEAN) (ConfigInfo->Source == IP4_CONFIG_SOURCE_STATIC);\r
+  \r
+  IsStatic = (BOOLEAN) (Policy == Ip4Config2PolicyStatic);\r
 \r
 ON_EXIT:\r
-\r
-  if (AccessResults != NULL) {\r
-    FreePool (AccessResults);\r
-  }\r
-  if (ConfigInfo != NULL) {\r
-    FreePool (ConfigInfo);\r
-  }\r
-  if (ConfigResp != NULL) {\r
-    FreePool (ConfigResp);\r
-  }\r
-  if (ConfigHdr != NULL) {\r
-    FreePool (ConfigHdr);\r
-  }\r
-\r
+  \r
   return IsStatic;\r
 }\r
 \r
@@ -2878,6 +2726,9 @@ NetLibAsciiStrToIp4 (
     TempStr = Ip4Str;\r
 \r
     while ((*Ip4Str != '\0') && (*Ip4Str != '.')) {\r
+      if (!NET_IS_DIGIT (*Ip4Str)) {\r
+        return EFI_INVALID_PARAMETER;\r
+      }\r
       Ip4Str++;\r
     }\r
 \r
@@ -2914,7 +2765,7 @@ NetLibAsciiStrToIp4 (
 \r
 /**\r
   Convert one Null-terminated ASCII string to EFI_IPv6_ADDRESS. The format of the\r
-  string is defined in RFC 4291 - Text Pepresentation of Addresses.\r
+  string is defined in RFC 4291 - Text Representation of Addresses.\r
 \r
   @param[in]      String         The pointer to the Ascii string.\r
   @param[out]     Ip6Address     The pointer to the converted IPv6 address.\r
@@ -3128,18 +2979,20 @@ NetLibStrToIp4 (
   )\r
 {\r
   CHAR8                          *Ip4Str;\r
+  UINTN                          StringSize;\r
   EFI_STATUS                     Status;\r
 \r
   if ((String == NULL) || (Ip4Address == NULL)) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
 \r
-  Ip4Str = (CHAR8 *) AllocatePool ((StrLen (String) + 1) * sizeof (CHAR8));\r
+  StringSize = StrLen (String) + 1;\r
+  Ip4Str = (CHAR8 *) AllocatePool (StringSize * sizeof (CHAR8));\r
   if (Ip4Str == NULL) {\r
     return EFI_OUT_OF_RESOURCES;\r
   }\r
 \r
-  UnicodeStrToAsciiStr (String, Ip4Str);\r
+  UnicodeStrToAsciiStrS (String, Ip4Str, StringSize);\r
 \r
   Status = NetLibAsciiStrToIp4 (Ip4Str, Ip4Address);\r
 \r
@@ -3151,7 +3004,7 @@ NetLibStrToIp4 (
 \r
 /**\r
   Convert one Null-terminated Unicode string to EFI_IPv6_ADDRESS.  The format of\r
-  the string is defined in RFC 4291 - Text Pepresentation of Addresses.\r
+  the string is defined in RFC 4291 - Text Representation of Addresses.\r
 \r
   @param[in]      String         The pointer to the Ascii string.\r
   @param[out]     Ip6Address     The pointer to the converted IPv6 address.\r
@@ -3169,18 +3022,20 @@ NetLibStrToIp6 (
   )\r
 {\r
   CHAR8                          *Ip6Str;\r
+  UINTN                          StringSize;\r
   EFI_STATUS                     Status;\r
 \r
   if ((String == NULL) || (Ip6Address == NULL)) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
 \r
-  Ip6Str = (CHAR8 *) AllocatePool ((StrLen (String) + 1) * sizeof (CHAR8));\r
+  StringSize = StrLen (String) + 1;\r
+  Ip6Str = (CHAR8 *) AllocatePool (StringSize * sizeof (CHAR8));\r
   if (Ip6Str == NULL) {\r
     return EFI_OUT_OF_RESOURCES;\r
   }\r
 \r
-  UnicodeStrToAsciiStr (String, Ip6Str);\r
+  UnicodeStrToAsciiStrS (String, Ip6Str, StringSize);\r
 \r
   Status = NetLibAsciiStrToIp6 (Ip6Str, Ip6Address);\r
 \r
@@ -3191,7 +3046,7 @@ NetLibStrToIp6 (
 \r
 /**\r
   Convert one Null-terminated Unicode string to EFI_IPv6_ADDRESS and prefix length.\r
-  The format of the string is defined in RFC 4291 - Text Pepresentation of Addresses\r
+  The format of the string is defined in RFC 4291 - Text Representation of Addresses\r
   Prefixes: ipv6-address/prefix-length.\r
 \r
   @param[in]      String         The pointer to the Ascii string.\r
@@ -3212,6 +3067,7 @@ NetLibStrToIp6andPrefix (
   )\r
 {\r
   CHAR8                          *Ip6Str;\r
+  UINTN                          StringSize;\r
   CHAR8                          *PrefixStr;\r
   CHAR8                          *TempStr;\r
   EFI_STATUS                     Status;\r
@@ -3221,12 +3077,13 @@ NetLibStrToIp6andPrefix (
     return EFI_INVALID_PARAMETER;\r
   }\r
 \r
-  Ip6Str = (CHAR8 *) AllocatePool ((StrLen (String) + 1) * sizeof (CHAR8));\r
+  StringSize = StrLen (String) + 1;\r
+  Ip6Str = (CHAR8 *) AllocatePool (StringSize * sizeof (CHAR8));\r
   if (Ip6Str == NULL) {\r
     return EFI_OUT_OF_RESOURCES;\r
   }\r
 \r
-  UnicodeStrToAsciiStr (String, Ip6Str);\r
+  UnicodeStrToAsciiStrS (String, Ip6Str, StringSize);\r
 \r
   //\r
   // Get the sub string describing prefix length.\r
@@ -3267,7 +3124,7 @@ NetLibStrToIp6andPrefix (
     while (*PrefixStr != '\0') {\r
       if (NET_IS_DIGIT (*PrefixStr)) {\r
         Length = (UINT8) (Length * 10 + (*PrefixStr - '0'));\r
-        if (Length >= IP6_PREFIX_NUM) {\r
+        if (Length > IP6_PREFIX_MAX) {\r
           goto Exit;\r
         }\r
       } else {\r
@@ -3387,7 +3244,7 @@ NetLibIp6ToStr (
     return EFI_BUFFER_TOO_SMALL;\r
   }\r
 \r
-  StrCpy (String, Buffer);\r
+  StrCpyS (String, StringSize / sizeof (CHAR16), Buffer);\r
 \r
   return EFI_SUCCESS;\r
 }\r
@@ -3407,22 +3264,27 @@ NetLibGetSystemGuid (
   OUT EFI_GUID              *SystemGuid\r
   )\r
 {\r
-  EFI_STATUS                Status;\r
-  SMBIOS_TABLE_ENTRY_POINT  *SmbiosTable;\r
-  SMBIOS_STRUCTURE_POINTER  Smbios;\r
-  SMBIOS_STRUCTURE_POINTER  SmbiosEnd;\r
-  CHAR8                     *String;\r
+  EFI_STATUS                    Status;\r
+  SMBIOS_TABLE_ENTRY_POINT      *SmbiosTable;\r
+  SMBIOS_TABLE_3_0_ENTRY_POINT  *Smbios30Table;\r
+  SMBIOS_STRUCTURE_POINTER      Smbios;\r
+  SMBIOS_STRUCTURE_POINTER      SmbiosEnd;\r
+  CHAR8                         *String;\r
 \r
   SmbiosTable = NULL;\r
-  Status      = EfiGetSystemConfigurationTable (&gEfiSmbiosTableGuid, (VOID **) &SmbiosTable);\r
-\r
-  if (EFI_ERROR (Status) || SmbiosTable == NULL) {\r
-    return EFI_NOT_FOUND;\r
+  Status = EfiGetSystemConfigurationTable (&gEfiSmbios3TableGuid, (VOID **) &Smbios30Table);\r
+  if (!(EFI_ERROR (Status) || Smbios30Table == NULL)) {\r
+    Smbios.Hdr = (SMBIOS_STRUCTURE *) (UINTN) Smbios30Table->TableAddress;\r
+    SmbiosEnd.Raw = (UINT8 *) (UINTN) (Smbios30Table->TableAddress + Smbios30Table->TableMaximumSize);\r
+  } else {\r
+    Status = EfiGetSystemConfigurationTable (&gEfiSmbiosTableGuid, (VOID **) &SmbiosTable);\r
+    if (EFI_ERROR (Status) || SmbiosTable == NULL) {\r
+      return EFI_NOT_FOUND;\r
+    }\r
+    Smbios.Hdr    = (SMBIOS_STRUCTURE *) (UINTN) SmbiosTable->TableAddress;\r
+    SmbiosEnd.Raw = (UINT8 *) (UINTN) (SmbiosTable->TableAddress + SmbiosTable->TableLength);\r
   }\r
 \r
-  Smbios.Hdr    = (SMBIOS_STRUCTURE *) (UINTN) SmbiosTable->TableAddress;\r
-  SmbiosEnd.Raw = (UINT8 *) (UINTN) (SmbiosTable->TableAddress + SmbiosTable->TableLength);\r
-\r
   do {\r
     if (Smbios.Hdr->Type == 1) {\r
       if (Smbios.Hdr->Length < 0x19) {\r
@@ -3473,3 +3335,70 @@ NetLibGetSystemGuid (
   } while (Smbios.Raw < SmbiosEnd.Raw);\r
   return EFI_NOT_FOUND;\r
 }\r
+\r
+/**\r
+  Create Dns QName according the queried domain name. \r
+  QName is a domain name represented as a sequence of labels, \r
+  where each label consists of a length octet followed by that \r
+  number of octets. The QName terminates with the zero \r
+  length octet for the null label of the root. Caller should \r
+  take responsibility to free the buffer in returned pointer.\r
+\r
+  @param  DomainName    The pointer to the queried domain name string.  \r
+\r
+  @retval NULL          Failed to fill QName.\r
+  @return               QName filled successfully.\r
+  \r
+**/ \r
+CHAR8 *\r
+EFIAPI\r
+NetLibCreateDnsQName (\r
+  IN  CHAR16              *DomainName\r
+  )\r
+{\r
+  CHAR8                 *QueryName;\r
+  UINTN                 QueryNameSize;\r
+  CHAR8                 *Header;\r
+  CHAR8                 *Tail;\r
+  UINTN                 Len;\r
+  UINTN                 Index;\r
+\r
+  QueryName     = NULL;\r
+  QueryNameSize = 0;\r
+  Header        = NULL;\r
+  Tail          = NULL;\r
+\r
+  //\r
+  // One byte for first label length, one byte for terminated length zero. \r
+  //\r
+  QueryNameSize = StrLen (DomainName) + 2;\r
+  \r
+  if (QueryNameSize > DNS_MAX_NAME_SIZE) {\r
+    return NULL;\r
+  }\r
+\r
+  QueryName = AllocateZeroPool (QueryNameSize);\r
+  if (QueryName == NULL) {\r
+    return NULL;\r
+  }\r
+  \r
+  Header = QueryName;\r
+  Tail = Header + 1;\r
+  Len = 0;\r
+  for (Index = 0; DomainName[Index] != 0; Index++) {\r
+    *Tail = (CHAR8) DomainName[Index];\r
+    if (*Tail == '.') {\r
+      *Header = (CHAR8) Len;\r
+      Header = Tail;\r
+      Tail ++;\r
+      Len = 0;\r
+    } else {\r
+      Tail++;\r
+      Len++;\r
+    }\r
+  }\r
+  *Header = (CHAR8) Len;\r
+  *Tail = 0;\r
+\r
+  return QueryName;\r
+}\r