add back CAPSULE_HOB_INFO definition for back-compatible.

[mirror_edk2.git] / MdeModulePkg / Library / DxeNetLib / DxeNetLib.c

/** @file\r
  Network library.\r
  \r
Copyright (c) 2005 - 2009, Intel Corporation.<BR>\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
\r
#include <Uefi.h>\r
\r
#include <Protocol/DriverBinding.h>\r
#include <Protocol/ServiceBinding.h>\r
#include <Protocol/SimpleNetwork.h>\r
#include <Protocol/HiiConfigRouting.h>\r
#include <Protocol/ComponentName.h>\r
#include <Protocol/ComponentName2.h>\r
\r
#include <Guid/NicIp4ConfigNvData.h>\r
\r
#include <Library/NetLib.h>\r
#include <Library/BaseLib.h>\r
#include <Library/DebugLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
#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
\r
GLOBAL_REMOVE_IF_UNREFERENCED CONST CHAR8 mNetLibHexStr[] = {'0','1','2','3','4','5','6','7','8','9','A','B','C','D','E','F'};\r
\r
#define NIC_ITEM_CONFIG_SIZE   sizeof (NIC_IP4_CONFIG_INFO) + sizeof (EFI_IP4_ROUTE_TABLE) * MAX_IP4_CONFIG_IN_VARIABLE\r
\r
//\r
// All the supported IP4 maskes in host byte order.\r
//\r
IP4_ADDR  gIp4AllMasks[IP4_MASK_NUM] = {\r
  0x00000000,\r
  0x80000000,\r
  0xC0000000,\r
  0xE0000000,\r
  0xF0000000,\r
  0xF8000000,\r
  0xFC000000,\r
  0xFE000000,\r
\r
  0xFF000000,\r
  0xFF800000,\r
  0xFFC00000,\r
  0xFFE00000,\r
  0xFFF00000,\r
  0xFFF80000,\r
  0xFFFC0000,\r
  0xFFFE0000,\r
\r
  0xFFFF0000,\r
  0xFFFF8000,\r
  0xFFFFC000,\r
  0xFFFFE000,\r
  0xFFFFF000,\r
  0xFFFFF800,\r
  0xFFFFFC00,\r
  0xFFFFFE00,\r
\r
  0xFFFFFF00,\r
  0xFFFFFF80,\r
  0xFFFFFFC0,\r
  0xFFFFFFE0,\r
  0xFFFFFFF0,\r
  0xFFFFFFF8,\r
  0xFFFFFFFC,\r
  0xFFFFFFFE,\r
  0xFFFFFFFF,\r
};\r
\r
EFI_IPv4_ADDRESS  mZeroIp4Addr = {{0, 0, 0, 0}};\r
\r
/**\r
  Return the length of the mask. \r
  \r
  Return the length of the mask, the correct value is from 0 to 32.\r
  If the mask is invalid, return the invalid length 33, which is IP4_MASK_NUM.\r
  NetMask is in the host byte order.\r
\r
  @param[in]  NetMask              The netmask to get the length from.\r
\r
  @return The length of the netmask, IP4_MASK_NUM if the mask is invalid.\r
  \r
**/\r
INTN\r
EFIAPI\r
NetGetMaskLength (\r
  IN IP4_ADDR               NetMask\r
  )\r
{\r
  INTN                      Index;\r
\r
  for (Index = 0; Index < IP4_MASK_NUM; Index++) {\r
    if (NetMask == gIp4AllMasks[Index]) {\r
      break;\r
    }\r
  }\r
\r
  return Index;\r
}\r
\r
\r
\r
/**\r
  Return the class of the IP address, such as class A, B, C.\r
  Addr is in host byte order.\r
  \r
  The address of class A  starts with 0.\r
  If the address belong to class A, return IP4_ADDR_CLASSA.\r
  The address of class B  starts with 10. \r
  If the address belong to class B, return IP4_ADDR_CLASSB.\r
  The address of class C  starts with 110. \r
  If the address belong to class C, return IP4_ADDR_CLASSC.\r
  The address of class D  starts with 1110. \r
  If the address belong to class D, return IP4_ADDR_CLASSD.\r
  The address of class E  starts with 1111.\r
  If the address belong to class E, return IP4_ADDR_CLASSE.\r
\r
  \r
  @param[in]   Addr                  The address to get the class from.\r
\r
  @return IP address class, such as IP4_ADDR_CLASSA.\r
\r
**/\r
INTN\r
EFIAPI\r
NetGetIpClass (\r
  IN IP4_ADDR               Addr\r
  )\r
{\r
  UINT8                     ByteOne;\r
\r
  ByteOne = (UINT8) (Addr >> 24);\r
\r
  if ((ByteOne & 0x80) == 0) {\r
    return IP4_ADDR_CLASSA;\r
\r
  } else if ((ByteOne & 0xC0) == 0x80) {\r
    return IP4_ADDR_CLASSB;\r
\r
  } else if ((ByteOne & 0xE0) == 0xC0) {\r
    return IP4_ADDR_CLASSC;\r
\r
  } else if ((ByteOne & 0xF0) == 0xE0) {\r
    return IP4_ADDR_CLASSD;\r
\r
  } else {\r
    return IP4_ADDR_CLASSE;\r
\r
  }\r
}\r
\r
\r
/**\r
  Check whether the IP is a valid unicast address according to\r
  the netmask. If NetMask is zero, use the IP address's class to get the default mask.\r
  \r
  If Ip is 0, IP is not a valid unicast address.\r
  Class D address is used for multicasting and class E address is reserved for future. If Ip\r
  belongs to class D or class E, IP is not a valid unicast address. \r
  If all bits of the host address of IP are 0 or 1, IP is also not a valid unicast address.\r
\r
  @param[in]  Ip                    The IP to check against.\r
  @param[in]  NetMask               The mask of the IP.\r
\r
  @return TRUE if IP is a valid unicast address on the network, otherwise FALSE.\r
\r
**/\r
BOOLEAN\r
EFIAPI\r
Ip4IsUnicast (\r
  IN IP4_ADDR               Ip,\r
  IN IP4_ADDR               NetMask\r
  )\r
{\r
  INTN                      Class;\r
\r
  Class = NetGetIpClass (Ip);\r
\r
  if ((Ip == 0) || (Class >= IP4_ADDR_CLASSD)) {\r
    return FALSE;\r
  }\r
\r
  if (NetMask == 0) {\r
    NetMask = gIp4AllMasks[Class << 3];\r
  }\r
\r
  if (((Ip &~NetMask) == ~NetMask) || ((Ip &~NetMask) == 0)) {\r
    return FALSE;\r
  }\r
\r
  return TRUE;\r
}\r
\r
/**\r
  Check whether the incoming IPv6 address is a valid unicast address.\r
\r
  If the address is a multicast address has binary 0xFF at the start, it is not\r
  a valid unicast address. If the address is unspecified ::, it is not a valid\r
  unicast address to be assigned to any node. If the address is loopback address\r
  ::1, it is also not a valid unicast address to be assigned to any physical\r
  interface. \r
\r
  @param[in]  Ip6                   The IPv6 address to check against.\r
\r
  @return TRUE if Ip6 is a valid unicast address on the network, otherwise FALSE.\r
\r
**/ \r
BOOLEAN\r
Ip6IsValidUnicast (\r
  IN EFI_IPv6_ADDRESS       *Ip6\r
  ) \r
{\r
  UINT8 t;\r
  UINT8 i;\r
  \r
  if (Ip6->Addr[0] == 0xFF) {\r
    return FALSE;\r
  }\r
\r
  for (i = 0; i < 15; i++) {\r
    if (Ip6->Addr[i] != 0) {\r
      return TRUE;\r
    }\r
  }\r
\r
  t = Ip6->Addr[i];\r
\r
  if (t == 0x0 || t == 0x1) {\r
    return FALSE;\r
  }\r
\r
  return TRUE;  \r
}\r
\r
/**\r
  Initialize a random seed using current time.\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
  \r
  @return The random seed initialized with current time.\r
\r
**/\r
UINT32\r
EFIAPI\r
NetRandomInitSeed (\r
  VOID\r
  )\r
{\r
  EFI_TIME                  Time;\r
  UINT32                    Seed;\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
  return Seed;\r
}\r
\r
\r
/**\r
  Extract a UINT32 from a byte stream.\r
  \r
  Copy a UINT32 from a byte stream, then converts it from Network \r
  byte order to host byte order. Use this function to avoid alignment error.\r
\r
  @param[in]  Buf                 The buffer to extract the UINT32.\r
\r
  @return The UINT32 extracted.\r
\r
**/\r
UINT32\r
EFIAPI\r
NetGetUint32 (\r
  IN UINT8                  *Buf\r
  )\r
{\r
  UINT32                    Value;\r
\r
  CopyMem (&Value, Buf, sizeof (UINT32));\r
  return NTOHL (Value);\r
}\r
\r
\r
/**\r
  Put a UINT32 to the byte stream in network byte order. \r
  \r
  Converts a UINT32 from host byte order to network byte order. Then copy it to the \r
  byte stream.\r
\r
  @param[in, out]  Buf          The buffer to put the UINT32.\r
  @param[in]      Data          The data to put.\r
  \r
**/\r
VOID\r
EFIAPI\r
NetPutUint32 (\r
  IN OUT UINT8                 *Buf,\r
  IN     UINT32                Data\r
  )\r
{\r
  Data = HTONL (Data);\r
  CopyMem (Buf, &Data, sizeof (UINT32));\r
}\r
\r
\r
/**\r
  Remove the first node entry on the list, and return the removed node entry.\r
  \r
  Removes the first node Entry from a doubly linked list. It is up to the caller of\r
  this function to release the memory used by the first node if that is required. On\r
  exit, the removed node is returned. \r
\r
  If Head is NULL, then ASSERT().\r
  If Head was not initialized, then ASSERT().\r
  If PcdMaximumLinkedListLength is not zero, and the number of nodes in the\r
  linked list including the head node is greater than or equal to PcdMaximumLinkedListLength,\r
  then ASSERT().    \r
\r
  @param[in, out]  Head                  The list header.\r
\r
  @return The first node entry that is removed from the list, NULL if the list is empty.\r
\r
**/\r
LIST_ENTRY *\r
EFIAPI\r
NetListRemoveHead (\r
  IN OUT LIST_ENTRY            *Head\r
  )\r
{\r
  LIST_ENTRY            *First;\r
\r
  ASSERT (Head != NULL);\r
\r
  if (IsListEmpty (Head)) {\r
    return NULL;\r
  }\r
\r
  First                         = Head->ForwardLink;\r
  Head->ForwardLink             = First->ForwardLink;\r
  First->ForwardLink->BackLink  = Head;\r
\r
  DEBUG_CODE (\r
    First->ForwardLink  = (LIST_ENTRY *) NULL;\r
    First->BackLink     = (LIST_ENTRY *) NULL;\r
  );\r
\r
  return First;\r
}\r
\r
\r
/**\r
  Remove the last node entry on the list and and return the removed node entry.\r
\r
  Removes the last node entry from a doubly linked list. It is up to the caller of\r
  this function to release the memory used by the first node if that is required. On\r
  exit, the removed node is returned. \r
\r
  If Head is NULL, then ASSERT().\r
  If Head was not initialized, then ASSERT().\r
  If PcdMaximumLinkedListLength is not zero, and the number of nodes in the\r
  linked list including the head node is greater than or equal to PcdMaximumLinkedListLength,\r
  then ASSERT(). \r
  \r
  @param[in, out]  Head                  The list head.\r
\r
  @return The last node entry that is removed from the list, NULL if the list is empty.\r
\r
**/\r
LIST_ENTRY *\r
EFIAPI\r
NetListRemoveTail (\r
  IN OUT LIST_ENTRY            *Head\r
  )\r
{\r
  LIST_ENTRY            *Last;\r
\r
  ASSERT (Head != NULL);\r
\r
  if (IsListEmpty (Head)) {\r
    return NULL;\r
  }\r
\r
  Last                        = Head->BackLink;\r
  Head->BackLink              = Last->BackLink;\r
  Last->BackLink->ForwardLink = Head;\r
\r
  DEBUG_CODE (\r
    Last->ForwardLink = (LIST_ENTRY *) NULL;\r
    Last->BackLink    = (LIST_ENTRY *) NULL;\r
  );\r
\r
  return Last;\r
}\r
\r
\r
/**\r
  Insert a new node entry after a designated node entry of a doubly linked list.\r
  \r
  Inserts a new node entry donated by NewEntry after the node entry donated by PrevEntry\r
  of the doubly linked list.\r
 \r
  @param[in, out]  PrevEntry             The previous entry to insert after.\r
  @param[in, out]  NewEntry              The new entry to insert.\r
\r
**/\r
VOID\r
EFIAPI\r
NetListInsertAfter (\r
  IN OUT LIST_ENTRY         *PrevEntry,\r
  IN OUT LIST_ENTRY         *NewEntry\r
  )\r
{\r
  NewEntry->BackLink                = PrevEntry;\r
  NewEntry->ForwardLink             = PrevEntry->ForwardLink;\r
  PrevEntry->ForwardLink->BackLink  = NewEntry;\r
  PrevEntry->ForwardLink            = NewEntry;\r
}\r
\r
\r
/**\r
  Insert a new node entry before a designated node entry of a doubly linked list.\r
  \r
  Inserts a new node entry donated by NewEntry after the node entry donated by PostEntry\r
  of the doubly linked list.\r
 \r
  @param[in, out]  PostEntry             The entry to insert before.\r
  @param[in, out]  NewEntry              The new entry to insert.\r
\r
**/\r
VOID\r
EFIAPI\r
NetListInsertBefore (\r
  IN OUT LIST_ENTRY     *PostEntry,\r
  IN OUT LIST_ENTRY     *NewEntry\r
  )\r
{\r
  NewEntry->ForwardLink             = PostEntry;\r
  NewEntry->BackLink                = PostEntry->BackLink;\r
  PostEntry->BackLink->ForwardLink  = NewEntry;\r
  PostEntry->BackLink               = NewEntry;\r
}\r
\r
\r
/**\r
  Initialize the netmap. Netmap is a reposity to keep the <Key, Value> pairs.\r
 \r
  Initialize the forward and backward links of two head nodes donated by Map->Used \r
  and Map->Recycled of two doubly linked lists.\r
  Initializes the count of the <Key, Value> pairs in the netmap to zero.\r
   \r
  If Map is NULL, then ASSERT().\r
  If the address of Map->Used is NULL, then ASSERT().\r
  If the address of Map->Recycled is NULl, then ASSERT().\r
 \r
  @param[in, out]  Map                   The netmap to initialize.\r
\r
**/\r
VOID\r
EFIAPI\r
NetMapInit (\r
  IN OUT NET_MAP                *Map\r
  )\r
{\r
  ASSERT (Map != NULL);\r
\r
  InitializeListHead (&Map->Used);\r
  InitializeListHead (&Map->Recycled);\r
  Map->Count = 0;\r
}\r
\r
\r
/**\r
  To clean up the netmap, that is, release allocated memories.\r
  \r
  Removes all nodes of the Used doubly linked list and free memory of all related netmap items.\r
  Removes all nodes of the Recycled doubly linked list and free memory of all related netmap items.\r
  The number of the <Key, Value> pairs in the netmap is set to be zero.\r
  \r
  If Map is NULL, then ASSERT().\r
  \r
  @param[in, out]  Map                   The netmap to clean up.\r
\r
**/\r
VOID\r
EFIAPI\r
NetMapClean (\r
  IN OUT NET_MAP            *Map\r
  )\r
{\r
  NET_MAP_ITEM              *Item;\r
  LIST_ENTRY                *Entry;\r
  LIST_ENTRY                *Next;\r
\r
  ASSERT (Map != NULL);\r
\r
  NET_LIST_FOR_EACH_SAFE (Entry, Next, &Map->Used) {\r
    Item = NET_LIST_USER_STRUCT (Entry, NET_MAP_ITEM, Link);\r
\r
    RemoveEntryList (&Item->Link);\r
    Map->Count--;\r
\r
    gBS->FreePool (Item);\r
  }\r
\r
  ASSERT ((Map->Count == 0) && IsListEmpty (&Map->Used));\r
\r
  NET_LIST_FOR_EACH_SAFE (Entry, Next, &Map->Recycled) {\r
    Item = NET_LIST_USER_STRUCT (Entry, NET_MAP_ITEM, Link);\r
\r
    RemoveEntryList (&Item->Link);\r
    gBS->FreePool (Item);\r
  }\r
\r
  ASSERT (IsListEmpty (&Map->Recycled));\r
}\r
\r
\r
/**\r
  Test whether the netmap is empty and return true if it is.\r
  \r
  If the number of the <Key, Value> pairs in the netmap is zero, return TRUE.\r
   \r
  If Map is NULL, then ASSERT().\r
 \r
  \r
  @param[in]  Map                   The net map to test.\r
\r
  @return TRUE if the netmap is empty, otherwise FALSE.\r
\r
**/\r
BOOLEAN\r
EFIAPI\r
NetMapIsEmpty (\r
  IN NET_MAP                *Map\r
  )\r
{\r
  ASSERT (Map != NULL);\r
  return (BOOLEAN) (Map->Count == 0);\r
}\r
\r
\r
/**\r
  Return the number of the <Key, Value> pairs in the netmap.\r
\r
  @param[in]  Map                   The netmap to get the entry number.\r
\r
  @return The entry number in the netmap.\r
\r
**/\r
UINTN\r
EFIAPI\r
NetMapGetCount (\r
  IN NET_MAP                *Map\r
  )\r
{\r
  return Map->Count;\r
}\r
\r
\r
/**\r
  Return one allocated item. \r
  \r
  If the Recycled doubly linked list of the netmap is empty, it will try to allocate \r
  a batch of items if there are enough resources and add corresponding nodes to the begining\r
  of the Recycled doubly linked list of the netmap. Otherwise, it will directly remove\r
  the fist node entry of the Recycled doubly linked list and return the corresponding item.\r
  \r
  If Map is NULL, then ASSERT().\r
  \r
  @param[in, out]  Map          The netmap to allocate item for.\r
\r
  @return                       The allocated item. If NULL, the\r
                                allocation failed due to resource limit.\r
\r
**/\r
NET_MAP_ITEM *\r
NetMapAllocItem (\r
  IN OUT NET_MAP            *Map\r
  )\r
{\r
  NET_MAP_ITEM              *Item;\r
  LIST_ENTRY                *Head;\r
  UINTN                     Index;\r
\r
  ASSERT (Map != NULL);\r
\r
  Head = &Map->Recycled;\r
\r
  if (IsListEmpty (Head)) {\r
    for (Index = 0; Index < NET_MAP_INCREAMENT; Index++) {\r
      Item = AllocatePool (sizeof (NET_MAP_ITEM));\r
\r
      if (Item == NULL) {\r
        if (Index == 0) {\r
          return NULL;\r
        }\r
\r
        break;\r
      }\r
\r
      InsertHeadList (Head, &Item->Link);\r
    }\r
  }\r
\r
  Item = NET_LIST_HEAD (Head, NET_MAP_ITEM, Link);\r
  NetListRemoveHead (Head);\r
\r
  return Item;\r
}\r
\r
\r
/**\r
  Allocate an item to save the <Key, Value> pair to the head of the netmap.\r
  \r
  Allocate an item to save the <Key, Value> pair and add corresponding node entry\r
  to the beginning of the Used doubly linked list. The number of the <Key, Value> \r
  pairs in the netmap increase by 1.\r
\r
  If Map is NULL, then ASSERT().\r
  \r
  @param[in, out]  Map                   The netmap to insert into.\r
  @param[in]       Key                   The user's key.\r
  @param[in]       Value                 The user's value for the key.\r
\r
  @retval EFI_OUT_OF_RESOURCES  Failed to allocate the memory for the item.\r
  @retval EFI_SUCCESS           The item is inserted to the head.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
NetMapInsertHead (\r
  IN OUT NET_MAP            *Map,\r
  IN VOID                   *Key,\r
  IN VOID                   *Value    OPTIONAL\r
  )\r
{\r
  NET_MAP_ITEM              *Item;\r
\r
  ASSERT (Map != NULL);\r
\r
  Item = NetMapAllocItem (Map);\r
\r
  if (Item == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Item->Key   = Key;\r
  Item->Value = Value;\r
  InsertHeadList (&Map->Used, &Item->Link);\r
\r
  Map->Count++;\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Allocate an item to save the <Key, Value> pair to the tail of the netmap.\r
\r
  Allocate an item to save the <Key, Value> pair and add corresponding node entry\r
  to the tail of the Used doubly linked list. The number of the <Key, Value> \r
  pairs in the netmap increase by 1.\r
\r
  If Map is NULL, then ASSERT().\r
  \r
  @param[in, out]  Map                   The netmap to insert into.\r
  @param[in]       Key                   The user's key.\r
  @param[in]       Value                 The user's value for the key.\r
\r
  @retval EFI_OUT_OF_RESOURCES  Failed to allocate the memory for the item.\r
  @retval EFI_SUCCESS           The item is inserted to the tail.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
NetMapInsertTail (\r
  IN OUT NET_MAP            *Map,\r
  IN VOID                   *Key,\r
  IN VOID                   *Value    OPTIONAL\r
  )\r
{\r
  NET_MAP_ITEM              *Item;\r
\r
  ASSERT (Map != NULL);\r
\r
  Item = NetMapAllocItem (Map);\r
\r
  if (Item == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Item->Key   = Key;\r
  Item->Value = Value;\r
  InsertTailList (&Map->Used, &Item->Link);\r
\r
  Map->Count++;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Check whether the item is in the Map and return TRUE if it is.\r
\r
  @param[in]  Map                   The netmap to search within.\r
  @param[in]  Item                  The item to search.\r
\r
  @return TRUE if the item is in the netmap, otherwise FALSE.\r
\r
**/\r
BOOLEAN\r
NetItemInMap (\r
  IN NET_MAP                *Map,\r
  IN NET_MAP_ITEM           *Item\r
  )\r
{\r
  LIST_ENTRY            *ListEntry;\r
\r
  NET_LIST_FOR_EACH (ListEntry, &Map->Used) {\r
    if (ListEntry == &Item->Link) {\r
      return TRUE;\r
    }\r
  }\r
\r
  return FALSE;\r
}\r
\r
\r
/**\r
  Find the key in the netmap and returns the point to the item contains the Key.\r
  \r
  Iterate the Used doubly linked list of the netmap to get every item. Compare the key of every \r
  item with the key to search. It returns the point to the item contains the Key if found.\r
\r
  If Map is NULL, then ASSERT().\r
  \r
  @param[in]  Map                   The netmap to search within.\r
  @param[in]  Key                   The key to search.\r
\r
  @return The point to the item contains the Key, or NULL if Key isn't in the map.\r
\r
**/\r
NET_MAP_ITEM *\r
EFIAPI\r
NetMapFindKey (\r
  IN  NET_MAP               *Map,\r
  IN  VOID                  *Key\r
  )\r
{\r
  LIST_ENTRY              *Entry;\r
  NET_MAP_ITEM            *Item;\r
\r
  ASSERT (Map != NULL);\r
\r
  NET_LIST_FOR_EACH (Entry, &Map->Used) {\r
    Item = NET_LIST_USER_STRUCT (Entry, NET_MAP_ITEM, Link);\r
\r
    if (Item->Key == Key) {\r
      return Item;\r
    }\r
  }\r
\r
  return NULL;\r
}\r
\r
\r
/**\r
  Remove the node entry of the item from the netmap and return the key of the removed item.\r
  \r
  Remove the node entry of the item from the Used doubly linked list of the netmap. \r
  The number of the <Key, Value> pairs in the netmap decrease by 1. Then add the node \r
  entry of the item to the Recycled doubly linked list of the netmap. If Value is not NULL,\r
  Value will point to the value of the item. It returns the key of the removed item.\r
  \r
  If Map is NULL, then ASSERT().\r
  If Item is NULL, then ASSERT().\r
  if item in not in the netmap, then ASSERT().\r
  \r
  @param[in, out]  Map                   The netmap to remove the item from.\r
  @param[in, out]  Item                  The item to remove.\r
  @param[out]      Value                 The variable to receive the value if not NULL.\r
\r
  @return                                The key of the removed item.\r
\r
**/\r
VOID *\r
EFIAPI\r
NetMapRemoveItem (\r
  IN  OUT NET_MAP             *Map,\r
  IN  OUT NET_MAP_ITEM        *Item,\r
  OUT VOID                    **Value           OPTIONAL\r
  )\r
{\r
  ASSERT ((Map != NULL) && (Item != NULL));\r
  ASSERT (NetItemInMap (Map, Item));\r
\r
  RemoveEntryList (&Item->Link);\r
  Map->Count--;\r
  InsertHeadList (&Map->Recycled, &Item->Link);\r
\r
  if (Value != NULL) {\r
    *Value = Item->Value;\r
  }\r
\r
  return Item->Key;\r
}\r
\r
\r
/**\r
  Remove the first node entry on the netmap and return the key of the removed item.\r
\r
  Remove the first node entry from the Used doubly linked list of the netmap. \r
  The number of the <Key, Value> pairs in the netmap decrease by 1. Then add the node \r
  entry to the Recycled doubly linked list of the netmap. If parameter Value is not NULL,\r
  parameter Value will point to the value of the item. It returns the key of the removed item.\r
  \r
  If Map is NULL, then ASSERT().\r
  If the Used doubly linked list is empty, then ASSERT().\r
  \r
  @param[in, out]  Map                   The netmap to remove the head from.\r
  @param[out]      Value                 The variable to receive the value if not NULL.\r
\r
  @return                                The key of the item removed.\r
\r
**/\r
VOID *\r
EFIAPI\r
NetMapRemoveHead (\r
  IN OUT NET_MAP            *Map,\r
  OUT VOID                  **Value         OPTIONAL\r
  )\r
{\r
  NET_MAP_ITEM  *Item;\r
\r
  //\r
  // Often, it indicates a programming error to remove\r
  // the first entry in an empty list\r
  //\r
  ASSERT (Map && !IsListEmpty (&Map->Used));\r
\r
  Item = NET_LIST_HEAD (&Map->Used, NET_MAP_ITEM, Link);\r
  RemoveEntryList (&Item->Link);\r
  Map->Count--;\r
  InsertHeadList (&Map->Recycled, &Item->Link);\r
\r
  if (Value != NULL) {\r
    *Value = Item->Value;\r
  }\r
\r
  return Item->Key;\r
}\r
\r
\r
/**\r
  Remove the last node entry on the netmap and return the key of the removed item.\r
\r
  Remove the last node entry from the Used doubly linked list of the netmap. \r
  The number of the <Key, Value> pairs in the netmap decrease by 1. Then add the node \r
  entry to the Recycled doubly linked list of the netmap. If parameter Value is not NULL,\r
  parameter Value will point to the value of the item. It returns the key of the removed item.\r
  \r
  If Map is NULL, then ASSERT().\r
  If the Used doubly linked list is empty, then ASSERT().\r
  \r
  @param[in, out]  Map                   The netmap to remove the tail from.\r
  @param[out]      Value                 The variable to receive the value if not NULL.\r
\r
  @return                                The key of the item removed.\r
\r
**/\r
VOID *\r
EFIAPI\r
NetMapRemoveTail (\r
  IN OUT NET_MAP            *Map,\r
  OUT VOID                  **Value       OPTIONAL\r
  )\r
{\r
  NET_MAP_ITEM              *Item;\r
\r
  //\r
  // Often, it indicates a programming error to remove\r
  // the last entry in an empty list\r
  //\r
  ASSERT (Map && !IsListEmpty (&Map->Used));\r
\r
  Item = NET_LIST_TAIL (&Map->Used, NET_MAP_ITEM, Link);\r
  RemoveEntryList (&Item->Link);\r
  Map->Count--;\r
  InsertHeadList (&Map->Recycled, &Item->Link);\r
\r
  if (Value != NULL) {\r
    *Value = Item->Value;\r
  }\r
\r
  return Item->Key;\r
}\r
\r
\r
/**\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
  from the loop. It returns the CallBack's last return value. This function is \r
  delete safe for the current item.\r
\r
  If Map is NULL, then ASSERT().\r
  If CallBack is NULL, then ASSERT().\r
  \r
  @param[in]  Map                   The Map to iterate through.\r
  @param[in]  CallBack              The callback function to call for each item.\r
  @param[in]  Arg                   The opaque parameter to the callback.\r
\r
  @retval EFI_SUCCESS            There is no item in the netmap or CallBack for each item\r
                                 return EFI_SUCCESS.\r
  @retval Others                 It returns the CallBack's last return value.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
NetMapIterate (\r
  IN NET_MAP                *Map,\r
  IN NET_MAP_CALLBACK       CallBack,\r
  IN VOID                   *Arg\r
  )\r
{\r
\r
  LIST_ENTRY            *Entry;\r
  LIST_ENTRY            *Next;\r
  LIST_ENTRY            *Head;\r
  NET_MAP_ITEM          *Item;\r
  EFI_STATUS            Result;\r
\r
  ASSERT ((Map != NULL) && (CallBack != NULL));\r
\r
  Head = &Map->Used;\r
\r
  if (IsListEmpty (Head)) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  NET_LIST_FOR_EACH_SAFE (Entry, Next, Head) {\r
    Item   = NET_LIST_USER_STRUCT (Entry, NET_MAP_ITEM, Link);\r
    Result = CallBack (Map, Item, Arg);\r
\r
    if (EFI_ERROR (Result)) {\r
      return Result;\r
    }\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  This is the default unload handle for all the network drivers.\r
\r
  Disconnect the driver specified by ImageHandle from all the devices in the handle database.\r
  Uninstall all the protocols installed in the driver entry point.\r
  \r
  @param[in]  ImageHandle       The drivers' driver image.\r
\r
  @retval EFI_SUCCESS           The image is unloaded.\r
  @retval Others                Failed to unload the image.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
NetLibDefaultUnload (\r
  IN EFI_HANDLE             ImageHandle\r
  )\r
{\r
  EFI_STATUS                        Status;\r
  EFI_HANDLE                        *DeviceHandleBuffer;\r
  UINTN                             DeviceHandleCount;\r
  UINTN                             Index;\r
  EFI_DRIVER_BINDING_PROTOCOL       *DriverBinding;\r
  EFI_COMPONENT_NAME_PROTOCOL       *ComponentName;\r
  EFI_COMPONENT_NAME2_PROTOCOL      *ComponentName2;\r
\r
  //\r
  // Get the list of all the handles in the handle database.\r
  // If there is an error getting the list, then the unload\r
  // operation fails.\r
  //\r
  Status = gBS->LocateHandleBuffer (\r
                  AllHandles,\r
                  NULL,\r
                  NULL,\r
                  &DeviceHandleCount,\r
                  &DeviceHandleBuffer\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Disconnect the driver specified by ImageHandle from all\r
  // the devices in the handle database.\r
  //\r
  for (Index = 0; Index < DeviceHandleCount; Index++) {\r
    Status = gBS->DisconnectController (\r
                    DeviceHandleBuffer[Index],\r
                    ImageHandle,\r
                    NULL\r
                    );\r
  }\r
\r
  //\r
  // Uninstall all the protocols installed in the driver entry point\r
  //\r
  for (Index = 0; Index < DeviceHandleCount; Index++) {\r
    Status = gBS->HandleProtocol (\r
                    DeviceHandleBuffer[Index],\r
                    &gEfiDriverBindingProtocolGuid,\r
                    (VOID **) &DriverBinding\r
                    );\r
\r
    if (EFI_ERROR (Status)) {\r
      continue;\r
    }\r
\r
    if (DriverBinding->ImageHandle != ImageHandle) {\r
      continue;\r
    }\r
\r
    gBS->UninstallProtocolInterface (\r
          ImageHandle,\r
          &gEfiDriverBindingProtocolGuid,\r
          DriverBinding\r
          );\r
    Status = gBS->HandleProtocol (\r
                    DeviceHandleBuffer[Index],\r
                    &gEfiComponentNameProtocolGuid,\r
                    (VOID **) &ComponentName\r
                    );\r
    if (!EFI_ERROR (Status)) {\r
      gBS->UninstallProtocolInterface (\r
             ImageHandle,\r
             &gEfiComponentNameProtocolGuid,\r
             ComponentName\r
             );\r
    }\r
\r
    Status = gBS->HandleProtocol (\r
                    DeviceHandleBuffer[Index],\r
                    &gEfiComponentName2ProtocolGuid,\r
                    (VOID **) &ComponentName2\r
                    );\r
    if (!EFI_ERROR (Status)) {\r
      gBS->UninstallProtocolInterface (\r
             ImageHandle,\r
             &gEfiComponentName2ProtocolGuid,\r
             ComponentName2\r
             );\r
    }\r
  }\r
\r
  //\r
  // Free the buffer containing the list of handles from the handle database\r
  //\r
  if (DeviceHandleBuffer != NULL) {\r
    gBS->FreePool (DeviceHandleBuffer);\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
\r
/**\r
  Create a child of the service that is identified by ServiceBindingGuid.\r
  \r
  Get the ServiceBinding Protocol first, then use it to create a child.\r
\r
  If ServiceBindingGuid is NULL, then ASSERT().\r
  If ChildHandle is NULL, then ASSERT().\r
  \r
  @param[in]       Controller            The controller which has the service installed.\r
  @param[in]       Image                 The image handle used to open service.\r
  @param[in]       ServiceBindingGuid    The service's Guid.\r
  @param[in, out]  ChildHandle           The handle to receive the create child.\r
\r
  @retval EFI_SUCCESS           The child is successfully created.\r
  @retval Others                Failed to create the child.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
NetLibCreateServiceChild (\r
  IN  EFI_HANDLE            Controller,\r
  IN  EFI_HANDLE            Image,\r
  IN  EFI_GUID              *ServiceBindingGuid,\r
  IN  OUT EFI_HANDLE        *ChildHandle\r
  )\r
{\r
  EFI_STATUS                    Status;\r
  EFI_SERVICE_BINDING_PROTOCOL  *Service;\r
\r
\r
  ASSERT ((ServiceBindingGuid != NULL) && (ChildHandle != NULL));\r
\r
  //\r
  // Get the ServiceBinding Protocol\r
  //\r
  Status = gBS->OpenProtocol (\r
                  Controller,\r
                  ServiceBindingGuid,\r
                  (VOID **) &Service,\r
                  Image,\r
                  Controller,\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // Create a child\r
  //\r
  Status = Service->CreateChild (Service, ChildHandle);\r
  return Status;\r
}\r
\r
\r
/**\r
  Destory a child of the service that is identified by ServiceBindingGuid.\r
  \r
  Get the ServiceBinding Protocol first, then use it to destroy a child.\r
  \r
  If ServiceBindingGuid is NULL, then ASSERT().\r
  \r
  @param[in]   Controller            The controller which has the service installed.\r
  @param[in]   Image                 The image handle used to open service.\r
  @param[in]   ServiceBindingGuid    The service's Guid.\r
  @param[in]   ChildHandle           The child to destory.\r
\r
  @retval EFI_SUCCESS           The child is successfully destoried.\r
  @retval Others                Failed to destory the child.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
NetLibDestroyServiceChild (\r
  IN  EFI_HANDLE            Controller,\r
  IN  EFI_HANDLE            Image,\r
  IN  EFI_GUID              *ServiceBindingGuid,\r
  IN  EFI_HANDLE            ChildHandle\r
  )\r
{\r
  EFI_STATUS                    Status;\r
  EFI_SERVICE_BINDING_PROTOCOL  *Service;\r
\r
  ASSERT (ServiceBindingGuid != NULL);\r
\r
  //\r
  // Get the ServiceBinding Protocol\r
  //\r
  Status = gBS->OpenProtocol (\r
                  Controller,\r
                  ServiceBindingGuid,\r
                  (VOID **) &Service,\r
                  Image,\r
                  Controller,\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  //\r
  // destory the child\r
  //\r
  Status = Service->DestroyChild (Service, ChildHandle);\r
  return Status;\r
}\r
\r
\r
/**\r
  Convert the mac address of the simple network protocol installed on\r
  SnpHandle to a unicode string. Callers are responsible for freeing the\r
  string storage.\r
\r
  Get the mac address of the Simple Network protocol from the SnpHandle. Then convert\r
  the mac address into a unicode string. It takes 2 unicode characters to represent \r
  a 1 byte binary buffer. Plus one unicode character for the null-terminator.\r
\r
\r
  @param[in]   SnpHandle             The handle where the simple network protocol is\r
                                     installed on.\r
  @param[in]   ImageHandle           The image handle used to act as the agent handle to\r
                                     get the simple network protocol.\r
  @param[out]  MacString             The pointer to store the address of the string\r
                                     representation of  the mac address.\r
  \r
  @retval EFI_SUCCESS           Convert the mac address a unicode string successfully.\r
  @retval EFI_OUT_OF_RESOURCES  There are not enough memory resource.\r
  @retval Others                Failed to open the simple network protocol.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
NetLibGetMacString (\r
  IN  EFI_HANDLE            SnpHandle,\r
  IN  EFI_HANDLE            ImageHandle,\r
  OUT CHAR16                **MacString\r
  )\r
{\r
  EFI_STATUS                   Status;\r
  EFI_SIMPLE_NETWORK_PROTOCOL  *Snp;\r
  EFI_SIMPLE_NETWORK_MODE      *Mode;\r
  CHAR16                       *MacAddress;\r
  UINTN                        Index;\r
\r
  *MacString = NULL;\r
\r
  //\r
  // Get the Simple Network protocol from the SnpHandle.\r
  //\r
  Status = gBS->OpenProtocol (\r
                  SnpHandle,\r
                  &gEfiSimpleNetworkProtocolGuid,\r
                  (VOID **) &Snp,\r
                  ImageHandle,\r
                  SnpHandle,\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Mode = Snp->Mode;\r
\r
  //\r
  // It takes 2 unicode characters to represent a 1 byte binary buffer.\r
  // Plus one unicode character for the null-terminator.\r
  //\r
  MacAddress = AllocatePool ((2 * Mode->HwAddressSize + 1) * sizeof (CHAR16));\r
  if (MacAddress == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  //\r
  // Convert the mac address into a unicode string.\r
  //\r
  for (Index = 0; Index < Mode->HwAddressSize; Index++) {\r
    MacAddress[Index * 2]     = (CHAR16) mNetLibHexStr[(Mode->CurrentAddress.Addr[Index] >> 4) & 0x0F];\r
    MacAddress[Index * 2 + 1] = (CHAR16) mNetLibHexStr[Mode->CurrentAddress.Addr[Index] & 0x0F];\r
  }\r
\r
  MacAddress[Mode->HwAddressSize * 2] = L'\0';\r
\r
  *MacString = MacAddress;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  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
   \r
  @param[in]   Controller     The controller handle which has the NIC Ip4 Config Protocol\r
                              relative with the default address to judge.\r
\r
  @retval TRUE           If the default address is static.\r
  @retval FALSE          If the default address is acquired from DHCP.\r
\r
**/\r
BOOLEAN\r
NetLibDefaultAddressIsStatic (\r
  IN EFI_HANDLE  Controller\r
  )\r
{\r
  EFI_STATUS                       Status;\r
  EFI_HII_CONFIG_ROUTING_PROTOCOL  *HiiConfigRouting;\r
  UINTN                            Len;\r
  NIC_IP4_CONFIG_INFO              *ConfigInfo;\r
  BOOLEAN                          IsStatic;\r
  EFI_STRING                       ConfigHdr;\r
  EFI_STRING                       ConfigResp;\r
  EFI_STRING                       AccessProgress;\r
  EFI_STRING                       AccessResults;\r
  EFI_STRING                       String;\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
  //\r
  // Construct config request string header\r
  //\r
  ConfigHdr = HiiConstructConfigHdr (&gEfiNicIp4ConfigVariableGuid, EFI_NIC_IP4_CONFIG_VARIABLE, Controller);\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
  if (EFI_ERROR (Status)) {\r
    goto ON_EXIT;\r
  }\r
\r
  ConfigInfo = AllocateZeroPool (sizeof (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
  if (EFI_ERROR (Status)) {\r
    goto ON_EXIT;\r
  }\r
\r
  IsStatic = (BOOLEAN) (ConfigInfo->Source == IP4_CONFIG_SOURCE_STATIC);\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
  return IsStatic;\r
}\r
\r
/**\r
  Create an IPv4 device path node.\r
  \r
  The header type of IPv4 device path node is MESSAGING_DEVICE_PATH.\r
  The header subtype of IPv4 device path node is MSG_IPv4_DP.\r
  The length of the IPv4 device path node in bytes is 19.\r
  Get other info from parameters to make up the whole IPv4 device path node.\r
\r
  @param[in, out]  Node                  Pointer to the IPv4 device path node.\r
  @param[in]       Controller            The handle where the NIC IP4 config protocol resides.\r
  @param[in]       LocalIp               The local IPv4 address.\r
  @param[in]       LocalPort             The local port.\r
  @param[in]       RemoteIp              The remote IPv4 address.\r
  @param[in]       RemotePort            The remote port.\r
  @param[in]       Protocol              The protocol type in the IP header.\r
  @param[in]       UseDefaultAddress     Whether this instance is using default address or not.\r
\r
**/\r
VOID\r
EFIAPI\r
NetLibCreateIPv4DPathNode (\r
  IN OUT IPv4_DEVICE_PATH  *Node,\r
  IN EFI_HANDLE            Controller,\r
  IN IP4_ADDR              LocalIp,\r
  IN UINT16                LocalPort,\r
  IN IP4_ADDR              RemoteIp,\r
  IN UINT16                RemotePort,\r
  IN UINT16                Protocol,\r
  IN BOOLEAN               UseDefaultAddress\r
  )\r
{\r
  Node->Header.Type    = MESSAGING_DEVICE_PATH;\r
  Node->Header.SubType = MSG_IPv4_DP;\r
  SetDevicePathNodeLength (&Node->Header, 19);\r
\r
  CopyMem (&Node->LocalIpAddress, &LocalIp, sizeof (EFI_IPv4_ADDRESS));\r
  CopyMem (&Node->RemoteIpAddress, &RemoteIp, sizeof (EFI_IPv4_ADDRESS));\r
\r
  Node->LocalPort  = LocalPort;\r
  Node->RemotePort = RemotePort;\r
\r
  Node->Protocol = Protocol;\r
\r
  if (!UseDefaultAddress) {\r
    Node->StaticIpAddress = TRUE;\r
  } else {\r
    Node->StaticIpAddress = NetLibDefaultAddressIsStatic (Controller);\r
  }\r
}\r
\r
\r
/**\r
  Find the UNDI/SNP handle from controller and protocol GUID.\r
  \r
  For example, IP will open a MNP child to transmit/receive\r
  packets, when MNP is stopped, IP should also be stopped. IP\r
  needs to find its own private data which is related the IP's\r
  service binding instance that is install on UNDI/SNP handle.\r
  Now, the controller is either a MNP or ARP child handle. But\r
  IP opens these handle BY_DRIVER, use that info, we can get the\r
  UNDI/SNP handle.\r
\r
  @param[in]  Controller            Then protocol handle to check.\r
  @param[in]  ProtocolGuid          The protocol that is related with the handle.\r
\r
  @return The UNDI/SNP handle or NULL for errors.\r
\r
**/\r
EFI_HANDLE\r
EFIAPI\r
NetLibGetNicHandle (\r
  IN EFI_HANDLE             Controller,\r
  IN EFI_GUID               *ProtocolGuid\r
  )\r
{\r
  EFI_OPEN_PROTOCOL_INFORMATION_ENTRY *OpenBuffer;\r
  EFI_HANDLE                          Handle;\r
  EFI_STATUS                          Status;\r
  UINTN                               OpenCount;\r
  UINTN                               Index;\r
\r
  Status = gBS->OpenProtocolInformation (\r
                  Controller,\r
                  ProtocolGuid,\r
                  &OpenBuffer,\r
                  &OpenCount\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    return NULL;\r
  }\r
\r
  Handle = NULL;\r
\r
  for (Index = 0; Index < OpenCount; Index++) {\r
    if (OpenBuffer[Index].Attributes & EFI_OPEN_PROTOCOL_BY_DRIVER) {\r
      Handle = OpenBuffer[Index].ControllerHandle;\r
      break;\r
    }\r
  }\r
\r
  gBS->FreePool (OpenBuffer);\r
  return Handle;\r
}\r