[mirror_edk2.git] / NetworkPkg / Ip6Dxe / Ip6Mld.c

/** @file\r
  Multicast Listener Discovery support routines.\r
\r
  Copyright (c) 2009 - 2010, Intel Corporation. All rights reserved.<BR>\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "Ip6Impl.h"\r
\r
/**\r
  Create a IP6_MLD_GROUP list entry node and record to IP6 service binding data.\r
\r
  @param[in, out]  IpSb          Points to IP6 service binding instance.\r
  @param[in]       MulticastAddr The IPv6 multicast address to be recorded.\r
  @param[in]       DelayTimer    The maximum allowed delay before sending a responding\r
                                 report, in units of milliseconds.\r
  @return The created IP6_ML_GROUP list entry or NULL.\r
\r
**/\r
IP6_MLD_GROUP *\r
Ip6CreateMldEntry (\r
  IN OUT IP6_SERVICE        *IpSb,\r
  IN EFI_IPv6_ADDRESS       *MulticastAddr,\r
  IN UINT32                 DelayTimer\r
  )\r
{\r
  IP6_MLD_GROUP             *Entry;\r
\r
  NET_CHECK_SIGNATURE (IpSb, IP6_SERVICE_SIGNATURE);\r
  ASSERT (MulticastAddr != NULL && IP6_IS_MULTICAST (MulticastAddr));\r
\r
  Entry = AllocatePool (sizeof (IP6_MLD_GROUP));\r
  if (Entry != NULL) {\r
    Entry->RefCnt     = 1;\r
    Entry->DelayTimer = DelayTimer;\r
    Entry->SendByUs   = FALSE;\r
    IP6_COPY_ADDRESS (&Entry->Address, MulticastAddr);\r
    InsertTailList (&IpSb->MldCtrl.Groups, &Entry->Link);\r
  }\r
\r
  return Entry;\r
}\r
\r
/**\r
  Search a IP6_MLD_GROUP list entry node from a list array.\r
\r
  @param[in]       IpSb          Points to IP6 service binding instance.\r
  @param[in]       MulticastAddr The IPv6 multicast address to be searched.\r
\r
  @return The found IP6_ML_GROUP list entry or NULL.\r
\r
**/\r
IP6_MLD_GROUP *\r
Ip6FindMldEntry (\r
  IN IP6_SERVICE            *IpSb,\r
  IN EFI_IPv6_ADDRESS       *MulticastAddr\r
  )\r
{\r
  LIST_ENTRY                *Entry;\r
  IP6_MLD_GROUP             *Group;\r
\r
  NET_CHECK_SIGNATURE (IpSb, IP6_SERVICE_SIGNATURE);\r
  ASSERT (MulticastAddr != NULL && IP6_IS_MULTICAST (MulticastAddr));\r
\r
  NET_LIST_FOR_EACH (Entry, &IpSb->MldCtrl.Groups) {\r
    Group = NET_LIST_USER_STRUCT (Entry, IP6_MLD_GROUP, Link);\r
    if (EFI_IP6_EQUAL (MulticastAddr, &Group->Address)) {\r
      return Group;\r
    }\r
  }\r
\r
  return NULL;\r
}\r
\r
/**\r
  Count the number of IP6 multicast groups that are mapped to the\r
  same MAC address. Several IP6 multicast address may be mapped to\r
  the same MAC address.\r
\r
  @param[in]  MldCtrl              The MLD control block to search in.\r
  @param[in]  Mac                  The MAC address to search.\r
\r
  @return The number of the IP6 multicast group that mapped to the same\r
          multicast group Mac.\r
\r
**/\r
INTN\r
Ip6FindMac (\r
  IN IP6_MLD_SERVICE_DATA   *MldCtrl,\r
  IN EFI_MAC_ADDRESS        *Mac\r
  )\r
{\r
  LIST_ENTRY                *Entry;\r
  IP6_MLD_GROUP             *Group;\r
  INTN                      Count;\r
\r
  Count = 0;\r
\r
  NET_LIST_FOR_EACH (Entry, &MldCtrl->Groups) {\r
    Group = NET_LIST_USER_STRUCT (Entry, IP6_MLD_GROUP, Link);\r
\r
    if (NET_MAC_EQUAL (&Group->Mac, Mac, sizeof (EFI_MAC_ADDRESS))) {\r
      Count++;\r
    }\r
  }\r
\r
  return Count;\r
}\r
\r
/**\r
  Generate MLD report message and send it out to MulticastAddr.\r
\r
  @param[in]  IpSb               The IP service to send the packet.\r
  @param[in]  Interface          The IP interface to send the packet.\r
                                 If NULL, a system interface will be selected.\r
  @param[in]  MulticastAddr      The specific IPv6 multicast address to which\r
                                 the message sender is listening.\r
\r
  @retval EFI_OUT_OF_RESOURCES   There are not sufficient resources to complete the\r
                                 operation.\r
  @retval EFI_SUCCESS            The MLD report message was successfully sent out.\r
\r
**/\r
EFI_STATUS\r
Ip6SendMldReport (\r
  IN IP6_SERVICE            *IpSb,\r
  IN IP6_INTERFACE          *Interface OPTIONAL,\r
  IN EFI_IPv6_ADDRESS       *MulticastAddr\r
  )\r
{\r
  IP6_MLD_HEAD              *MldHead;\r
  NET_BUF                   *Packet;\r
  EFI_IP6_HEADER            Head;\r
  UINT16                    PayloadLen;\r
  UINTN                     OptionLen;\r
  UINT8                     *Options;\r
  EFI_STATUS                Status;\r
  UINT16                    HeadChecksum;\r
  UINT16                    PseudoChecksum;\r
\r
  NET_CHECK_SIGNATURE (IpSb, IP6_SERVICE_SIGNATURE);\r
  ASSERT (MulticastAddr != NULL && IP6_IS_MULTICAST (MulticastAddr));\r
\r
  //\r
  // Generate the packet to be sent\r
  // IPv6 basic header + Hop by Hop option + MLD message\r
  //\r
\r
  OptionLen = 0;\r
  Status = Ip6FillHopByHop (NULL, &OptionLen, IP6_ICMP);\r
  ASSERT (Status == EFI_BUFFER_TOO_SMALL);\r
\r
  PayloadLen = (UINT16) (OptionLen + sizeof (IP6_MLD_HEAD));\r
  Packet = NetbufAlloc (sizeof (EFI_IP6_HEADER) + (UINT32) PayloadLen);\r
  if (Packet == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  //\r
  // Create the basic IPv6 header.\r
  // RFC3590: Use link-local address as source address if it is available,\r
  // otherwise use the unspecified address.\r
  //\r
  Head.FlowLabelL     = 0;\r
  Head.FlowLabelH     = 0;\r
  Head.PayloadLength  = HTONS (PayloadLen);\r
  Head.NextHeader     = IP6_HOP_BY_HOP;\r
  Head.HopLimit       = 1;\r
  IP6_COPY_ADDRESS (&Head.DestinationAddress, MulticastAddr);\r
\r
  //\r
  // If Link-Local address is not ready, we use unspecified address.\r
  //\r
  IP6_COPY_ADDRESS (&Head.SourceAddress, &IpSb->LinkLocalAddr);\r
\r
  NetbufReserve (Packet, sizeof (EFI_IP6_HEADER));\r
\r
  //\r
  // Fill a IPv6 Router Alert option in a Hop-by-Hop Options Header\r
  //\r
  Options = NetbufAllocSpace (Packet, (UINT32) OptionLen, FALSE);\r
  ASSERT (Options != NULL);\r
  Status = Ip6FillHopByHop (Options, &OptionLen, IP6_ICMP);\r
  if (EFI_ERROR (Status)) {\r
    NetbufFree (Packet);\r
    Packet = NULL;\r
    return Status;\r
  }\r
\r
  //\r
  // Fill in MLD message - Report\r
  //\r
  MldHead = (IP6_MLD_HEAD *) NetbufAllocSpace (Packet, sizeof (IP6_MLD_HEAD), FALSE);\r
  ASSERT (MldHead != NULL);\r
  ZeroMem (MldHead, sizeof (IP6_MLD_HEAD));\r
  MldHead->Head.Type = ICMP_V6_LISTENER_REPORT;\r
  MldHead->Head.Code = 0;\r
  IP6_COPY_ADDRESS (&MldHead->Group, MulticastAddr);\r
\r
  HeadChecksum   = NetblockChecksum ((UINT8 *) MldHead, sizeof (IP6_MLD_HEAD));\r
  PseudoChecksum = NetIp6PseudoHeadChecksum (\r
                     &Head.SourceAddress,\r
                     &Head.DestinationAddress,\r
                     IP6_ICMP,\r
                     sizeof (IP6_MLD_HEAD)\r
                     );\r
\r
  MldHead->Head.Checksum = (UINT16) ~NetAddChecksum (HeadChecksum, PseudoChecksum);\r
\r
  //\r
  // Transmit the packet\r
  //\r
  return Ip6Output (IpSb, Interface, NULL, Packet, &Head, NULL, 0, Ip6SysPacketSent, NULL);\r
}\r
\r
/**\r
  Generate MLD Done message and send it out to MulticastAddr.\r
\r
  @param[in]  IpSb               The IP service to send the packet.\r
  @param[in]  MulticastAddr      The specific IPv6 multicast address to which\r
                                 the message sender is ceasing to listen.\r
\r
  @retval EFI_OUT_OF_RESOURCES   There are not sufficient resources to complete the\r
                                 operation.\r
  @retval EFI_SUCCESS            The MLD report message was successfully sent out.\r
\r
**/\r
EFI_STATUS\r
Ip6SendMldDone (\r
  IN IP6_SERVICE            *IpSb,\r
  IN EFI_IPv6_ADDRESS       *MulticastAddr\r
  )\r
{\r
  IP6_MLD_HEAD              *MldHead;\r
  NET_BUF                   *Packet;\r
  EFI_IP6_HEADER            Head;\r
  UINT16                    PayloadLen;\r
  UINTN                     OptionLen;\r
  UINT8                     *Options;\r
  EFI_STATUS                Status;\r
  EFI_IPv6_ADDRESS          Destination;\r
  UINT16                    HeadChecksum;\r
  UINT16                    PseudoChecksum;\r
\r
  NET_CHECK_SIGNATURE (IpSb, IP6_SERVICE_SIGNATURE);\r
  ASSERT (MulticastAddr != NULL && IP6_IS_MULTICAST (MulticastAddr));\r
\r
  //\r
  // Generate the packet to be sent\r
  // IPv6 basic header + Hop by Hop option + MLD message\r
  //\r
\r
  OptionLen = 0;\r
  Status = Ip6FillHopByHop (NULL, &OptionLen, IP6_ICMP);\r
  ASSERT (Status == EFI_BUFFER_TOO_SMALL);\r
\r
  PayloadLen = (UINT16) (OptionLen + sizeof (IP6_MLD_HEAD));\r
  Packet = NetbufAlloc (sizeof (EFI_IP6_HEADER) + (UINT32) PayloadLen);\r
  if (Packet == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  //\r
  // Create the basic IPv6 header.\r
  //\r
  Head.FlowLabelL     = 0;\r
  Head.FlowLabelH     = 0;\r
  Head.PayloadLength  = HTONS (PayloadLen);\r
  Head.NextHeader     = IP6_HOP_BY_HOP;\r
  Head.HopLimit       = 1;\r
\r
  //\r
  // If Link-Local address is not ready, we use unspecified address.\r
  //\r
  IP6_COPY_ADDRESS (&Head.SourceAddress, &IpSb->LinkLocalAddr);\r
\r
  Ip6SetToAllNodeMulticast (TRUE, IP6_LINK_LOCAL_SCOPE, &Destination);\r
  IP6_COPY_ADDRESS (&Head.DestinationAddress, &Destination);\r
\r
  NetbufReserve (Packet, sizeof (EFI_IP6_HEADER));\r
\r
  //\r
  // Fill a IPv6 Router Alert option in a Hop-by-Hop Options Header\r
  //\r
  Options = NetbufAllocSpace (Packet, (UINT32) OptionLen, FALSE);\r
  ASSERT (Options != NULL);\r
  Status = Ip6FillHopByHop (Options, &OptionLen, IP6_ICMP);\r
  if (EFI_ERROR (Status)) {\r
    NetbufFree (Packet);\r
    Packet = NULL;\r
    return Status;\r
  }\r
\r
  //\r
  // Fill in MLD message - Done\r
  //\r
  MldHead = (IP6_MLD_HEAD *) NetbufAllocSpace (Packet, sizeof (IP6_MLD_HEAD), FALSE);\r
  ASSERT (MldHead != NULL);\r
  ZeroMem (MldHead, sizeof (IP6_MLD_HEAD));\r
  MldHead->Head.Type = ICMP_V6_LISTENER_DONE;\r
  MldHead->Head.Code = 0;\r
  IP6_COPY_ADDRESS (&MldHead->Group, MulticastAddr);\r
\r
  HeadChecksum   = NetblockChecksum ((UINT8 *) MldHead, sizeof (IP6_MLD_HEAD));\r
  PseudoChecksum = NetIp6PseudoHeadChecksum (\r
                     &Head.SourceAddress,\r
                     &Head.DestinationAddress,\r
                     IP6_ICMP,\r
                     sizeof (IP6_MLD_HEAD)\r
                     );\r
\r
  MldHead->Head.Checksum = (UINT16) ~NetAddChecksum (HeadChecksum, PseudoChecksum);\r
\r
  //\r
  // Transmit the packet\r
  //\r
  return Ip6Output (IpSb, NULL, NULL, Packet, &Head, NULL, 0, Ip6SysPacketSent, NULL);\r
}\r
\r
/**\r
  Init the MLD data of the IP6 service instance. Configure\r
  MNP to receive ALL SYSTEM multicast.\r
\r
  @param[in]  IpSb              The IP6 service whose MLD is to be initialized.\r
\r
  @retval EFI_OUT_OF_RESOURCES  There are not sufficient resourcet to complete the\r
                                operation.\r
  @retval EFI_SUCCESS           The MLD module successfully initialized.\r
\r
**/\r
EFI_STATUS\r
Ip6InitMld (\r
  IN IP6_SERVICE            *IpSb\r
  )\r
{\r
  EFI_IPv6_ADDRESS          AllNodes;\r
  IP6_MLD_GROUP             *Group;\r
  EFI_STATUS                Status;\r
\r
  //\r
  // Join the link-scope all-nodes multicast address (FF02::1).\r
  // This address is started in Idle Listener state and never transitions to\r
  // another state, and never sends a Report or Done for that address.\r
  //\r
\r
  Ip6SetToAllNodeMulticast (FALSE, IP6_LINK_LOCAL_SCOPE, &AllNodes);\r
\r
  Group = Ip6CreateMldEntry (IpSb, &AllNodes, (UINT32) IP6_INFINIT_LIFETIME);\r
  if (Group == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Status = Ip6GetMulticastMac (IpSb->Mnp, &AllNodes, &Group->Mac);\r
  if (EFI_ERROR (Status)) {\r
    goto ERROR;\r
  }\r
\r
  //\r
  // Configure MNP to receive all-nodes multicast\r
  //\r
  Status = IpSb->Mnp->Groups (IpSb->Mnp, TRUE, &Group->Mac);\r
  if (EFI_ERROR (Status) && (Status != EFI_ALREADY_STARTED)) {\r
    goto ERROR;\r
  }\r
\r
  return EFI_SUCCESS;\r
\r
ERROR:\r
  RemoveEntryList (&Group->Link);\r
  FreePool (Group);\r
  return Status;\r
}\r
\r
/**\r
  Add a group address to the array of group addresses.\r
  The caller should make sure that no duplicated address\r
  existed in the array.\r
\r
  @param[in, out]  IpInstance       Points to an IP6_PROTOCOL instance.\r
  @param[in]       Group            The IP6 multicast address to add.\r
\r
  @retval EFI_OUT_OF_RESOURCES      There are not sufficient resources to complete\r
                                    the operation.\r
  @retval EFI_SUCESS                The address is added to the group address array.\r
\r
**/\r
EFI_STATUS\r
Ip6CombineGroups (\r
  IN OUT IP6_PROTOCOL *IpInstance,\r
  IN EFI_IPv6_ADDRESS *Group\r
  )\r
{\r
  EFI_IPv6_ADDRESS     *GroupList;\r
\r
  NET_CHECK_SIGNATURE (IpInstance, IP6_PROTOCOL_SIGNATURE);\r
  ASSERT (Group != NULL && IP6_IS_MULTICAST (Group));\r
\r
  IpInstance->GroupCount++;\r
\r
  GroupList = AllocatePool (IpInstance->GroupCount * sizeof (EFI_IPv6_ADDRESS));\r
  if (GroupList == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  if (IpInstance->GroupCount > 1) {\r
    ASSERT (IpInstance->GroupList != NULL);\r
\r
    CopyMem (\r
      GroupList,\r
      IpInstance->GroupList,\r
      (IpInstance->GroupCount - 1) * sizeof (EFI_IPv6_ADDRESS)\r
      );\r
\r
    FreePool (IpInstance->GroupList);\r
  }\r
\r
  IP6_COPY_ADDRESS (GroupList + (IpInstance->GroupCount - 1), Group);\r
\r
  IpInstance->GroupList = GroupList;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Remove a group address from the array of group addresses.\r
  Although the function doesn't assume the byte order of Group,\r
  the network byte order is used by the caller.\r
\r
  @param[in, out]  IpInstance       Points to an IP6_PROTOCOL instance.\r
  @param[in]       Group            The IP6 multicast address to remove.\r
\r
  @retval EFI_NOT_FOUND             Cannot find the to be removed group address.\r
  @retval EFI_SUCCESS               The group address was successfully removed.\r
\r
**/\r
EFI_STATUS\r
Ip6RemoveGroup (\r
  IN OUT IP6_PROTOCOL *IpInstance,\r
  IN EFI_IPv6_ADDRESS *Group\r
  )\r
{\r
  UINT32                    Index;\r
  UINT32                    Count;\r
\r
  Count = IpInstance->GroupCount;\r
\r
  for (Index = 0; Index < Count; Index++) {\r
    if (EFI_IP6_EQUAL (IpInstance->GroupList + Index, Group)) {\r
      break;\r
    }\r
  }\r
\r
  if (Index == Count) {\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  while (Index < Count - 1) {\r
    IP6_COPY_ADDRESS (IpInstance->GroupList + Index, IpInstance->GroupList + Index + 1);\r
    Index++;\r
  }\r
\r
  ASSERT (IpInstance->GroupCount > 0);\r
  IpInstance->GroupCount--;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Join the multicast group on behalf of this IP6 service binding instance.\r
\r
  @param[in]  IpSb               The IP6 service binding instance.\r
  @param[in]  Interface          Points to an IP6_INTERFACE structure.\r
  @param[in]  Address            The group address to join.\r
\r
  @retval EFI_SUCCESS            Successfully join the multicast group.\r
  @retval EFI_OUT_OF_RESOURCES   Failed to allocate resources.\r
  @retval Others                 Failed to join the multicast group.\r
\r
**/\r
EFI_STATUS\r
Ip6JoinGroup (\r
  IN IP6_SERVICE            *IpSb,\r
  IN IP6_INTERFACE          *Interface,\r
  IN EFI_IPv6_ADDRESS       *Address\r
  )\r
{\r
  IP6_MLD_GROUP            *Group;\r
  EFI_STATUS               Status;\r
\r
  Group = Ip6FindMldEntry (IpSb, Address);\r
  if (Group != NULL) {\r
    Group->RefCnt++;\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Repeat the report once or twcie after short delays [Unsolicited Report Interval] (default:10s)\r
  // Simulate this operation as a Multicast-Address-Specific Query was received for that addresss.\r
  //\r
  Group = Ip6CreateMldEntry (IpSb, Address, IP6_UNSOLICITED_REPORT_INTERVAL);\r
  if (Group == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Group->SendByUs = TRUE;\r
\r
  Status = Ip6GetMulticastMac (IpSb->Mnp, Address, &Group->Mac);\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Status = IpSb->Mnp->Groups (IpSb->Mnp, TRUE, &Group->Mac);\r
  if (EFI_ERROR (Status) && (Status != EFI_ALREADY_STARTED)) {\r
    goto ERROR;\r
  }\r
\r
  //\r
  // Send unsolicited report when a node starts listening to a multicast address\r
  //\r
  Status = Ip6SendMldReport (IpSb, Interface, Address);\r
  if (EFI_ERROR (Status)) {\r
    goto ERROR;\r
  }\r
\r
  return EFI_SUCCESS;\r
\r
ERROR:\r
  RemoveEntryList (&Group->Link);\r
  FreePool (Group);\r
  return Status;\r
}\r
\r
/**\r
  Leave the IP6 multicast group.\r
\r
  @param[in]  IpSb               The IP6 service binding instance.\r
  @param[in]  Address            The group address to leave.\r
\r
  @retval EFI_NOT_FOUND          The IP6 service instance isn't in the group.\r
  @retval EFI_SUCCESS            Successfully leave the multicast group..\r
  @retval Others                 Failed to leave the multicast group.\r
\r
**/\r
EFI_STATUS\r
Ip6LeaveGroup (\r
 IN IP6_SERVICE            *IpSb,\r
 IN EFI_IPv6_ADDRESS       *Address\r
  )\r
{\r
  IP6_MLD_GROUP            *Group;\r
  EFI_STATUS               Status;\r
\r
  Group = Ip6FindMldEntry (IpSb, Address);\r
  if (Group == NULL) {\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  //\r
  // If more than one instance is in the group, decrease\r
  // the RefCnt then return.\r
  //\r
  if ((Group->RefCnt > 0) && (--Group->RefCnt > 0)) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // If multiple IP6 group addresses are mapped to the same\r
  // multicast MAC address, don't configure the MNP to leave\r
  // the MAC.\r
  //\r
  if (Ip6FindMac (&IpSb->MldCtrl, &Group->Mac) == 1) {\r
    Status = IpSb->Mnp->Groups (IpSb->Mnp, FALSE, &Group->Mac);\r
    if (EFI_ERROR (Status) && (Status != EFI_NOT_FOUND)) {\r
      return Status;\r
    }\r
  }\r
\r
  //\r
  // Send a leave report if we are the last node to report\r
  //\r
  if (Group->SendByUs) {\r
    Status = Ip6SendMldDone (IpSb, Address);\r
    if (EFI_ERROR (Status)) {\r
      return Status;\r
    }\r
  }\r
\r
  RemoveEntryList (&Group->Link);\r
  FreePool (Group);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Worker function for EfiIp6Groups(). The caller\r
  should make sure that the parameters are valid.\r
\r
  @param[in]  IpInstance        The IP6 child to change the setting.\r
  @param[in]  JoinFlag          TRUE to join the group, otherwise leave it.\r
  @param[in]  GroupAddress      The target group address. If NULL, leave all\r
                                the group addresses.\r
\r
  @retval EFI_ALREADY_STARTED   Wants to join the group, but is already a member of it\r
  @retval EFI_OUT_OF_RESOURCES  Failed to allocate sufficient resources.\r
  @retval EFI_DEVICE_ERROR      Failed to set the group configuraton.\r
  @retval EFI_SUCCESS           Successfully updated the group setting.\r
  @retval EFI_NOT_FOUND         Try to leave the group which it isn't a member.\r
\r
**/\r
EFI_STATUS\r
Ip6Groups (\r
  IN IP6_PROTOCOL           *IpInstance,\r
  IN BOOLEAN                JoinFlag,\r
  IN EFI_IPv6_ADDRESS       *GroupAddress       OPTIONAL\r
  )\r
{\r
  EFI_STATUS                Status;\r
  IP6_SERVICE               *IpSb;\r
  UINT32                    Index;\r
  EFI_IPv6_ADDRESS          *Group;\r
\r
  IpSb = IpInstance->Service;\r
\r
  if (JoinFlag) {\r
    ASSERT (GroupAddress != NULL);\r
\r
    for (Index = 0; Index < IpInstance->GroupCount; Index++) {\r
      if (EFI_IP6_EQUAL (IpInstance->GroupList + Index, GroupAddress)) {\r
        return EFI_ALREADY_STARTED;\r
      }\r
    }\r
\r
    Status = Ip6JoinGroup (IpSb, IpInstance->Interface, GroupAddress);\r
    if (!EFI_ERROR (Status)) {\r
      return Ip6CombineGroups (IpInstance, GroupAddress);\r
    }\r
\r
    return Status;\r
  }\r
\r
  //\r
  // Leave the group. Leave all the groups if GroupAddress is NULL.\r
  //\r
  for (Index = IpInstance->GroupCount; Index > 0; Index--) {\r
    Group = IpInstance->GroupList + (Index - 1);\r
\r
    if ((GroupAddress == NULL) || EFI_IP6_EQUAL (Group, GroupAddress)) {\r
      Status = Ip6LeaveGroup (IpInstance->Service, Group);\r
      if (EFI_ERROR (Status)) {\r
        return Status;\r
      }\r
\r
      Ip6RemoveGroup (IpInstance, Group);\r
\r
      if (IpInstance->GroupCount == 0) {\r
        ASSERT (Index == 1);\r
        FreePool (IpInstance->GroupList);\r
        IpInstance->GroupList = NULL;\r
      }\r
\r
      if (GroupAddress != NULL) {\r
        return EFI_SUCCESS;\r
      }\r
    }\r
  }\r
\r
  return ((GroupAddress != NULL) ? EFI_NOT_FOUND : EFI_SUCCESS);\r
}\r
\r
/**\r
  Set a random value of the delay timer for the multicast address from the range\r
  [0, Maximum Response Delay]. If a timer for any address is already\r
  running, it is reset to the new random value only if the requested\r
  Maximum Response Delay is less than the remaining value of the\r
  running timer.  If the Query packet specifies a Maximum Response\r
  Delay of zero, each timer is effectively set to zero, and the action\r
  specified below for timer expiration is performed immediately.\r
\r
  @param[in]      IpSb               The IP6 service binding instance.\r
  @param[in]      MaxRespDelay       The Maximum Response Delay, in milliseconds.\r
  @param[in]      MulticastAddr      The multicast address.\r
  @param[in, out] Group              Points to a IP6_MLD_GROUP list entry node.\r
\r
  @retval EFI_SUCCESS                The delay timer is successfully updated or\r
                                     timer expiration is performed immediately.\r
  @retval Others                     Failed to send out MLD report message.\r
\r
**/\r
EFI_STATUS\r
Ip6UpdateDelayTimer (\r
  IN IP6_SERVICE            *IpSb,\r
  IN UINT16                 MaxRespDelay,\r
  IN EFI_IPv6_ADDRESS       *MulticastAddr,\r
  IN OUT IP6_MLD_GROUP      *Group\r
  )\r
{\r
  UINT32                    Delay;\r
\r
  //\r
  // If the Query packet specifies a Maximum Response Delay of zero, perform timer\r
  // expiration immediately.\r
  //\r
  if (MaxRespDelay == 0) {\r
    Group->DelayTimer = 0;\r
    return Ip6SendMldReport (IpSb, NULL, MulticastAddr);\r
  }\r
\r
  Delay = (UINT32) (MaxRespDelay / 1000);\r
\r
  //\r
  // Sets a delay timer to a random value selected from the range [0, Maximum Response Delay]\r
  // If a timer is already running, resets it if the request Maximum Response Delay\r
  // is less than the remaining value of the running timer.\r
  //\r
  if (Group->DelayTimer == 0 || Delay < Group->DelayTimer) {\r
    Group->DelayTimer = Delay / 4294967295UL * NET_RANDOM (NetRandomInitSeed ());\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Process the Multicast Listener Query message.\r
\r
  @param[in]  IpSb               The IP service that received the packet.\r
  @param[in]  Head               The IP head of the MLD query packet.\r
  @param[in]  Packet             The content of the MLD query packet with IP head\r
                                 removed.\r
\r
  @retval EFI_SUCCESS            The MLD query packet processed successfully.\r
  @retval EFI_INVALID_PARAMETER  The packet is invalid.\r
  @retval Others                 Failed to process the packet.\r
\r
**/\r
EFI_STATUS\r
Ip6ProcessMldQuery (\r
  IN IP6_SERVICE            *IpSb,\r
  IN EFI_IP6_HEADER         *Head,\r
  IN NET_BUF                *Packet\r
  )\r
{\r
  EFI_IPv6_ADDRESS          AllNodes;\r
  IP6_MLD_GROUP             *Group;\r
  IP6_MLD_HEAD              MldPacket;\r
  LIST_ENTRY                *Entry;\r
  EFI_STATUS                Status;\r
\r
  Status = EFI_INVALID_PARAMETER;\r
\r
  //\r
  // Check the validity of the packet, generic query or specific query\r
  //\r
  if (!NetIp6IsUnspecifiedAddr (&Head->SourceAddress) && !NetIp6IsLinkLocalAddr (&Head->SourceAddress)) {\r
    goto Exit;\r
  }\r
\r
  if (Head->HopLimit != 1 || !IP6_IS_MULTICAST (&Head->DestinationAddress)) {\r
    goto Exit;\r
  }\r
\r
  //\r
  // The Packet points to MLD report raw data without Hop-By-Hop option.\r
  //\r
  NetbufCopy (Packet, 0, sizeof (IP6_MLD_HEAD), (UINT8 *) &MldPacket);\r
  MldPacket.MaxRespDelay = NTOHS (MldPacket.MaxRespDelay);\r
\r
  Ip6SetToAllNodeMulticast (FALSE, IP6_LINK_LOCAL_SCOPE, &AllNodes);\r
  if (!EFI_IP6_EQUAL (&Head->DestinationAddress, &AllNodes)) {\r
    //\r
    // Receives a Multicast-Address-Specific Query, check it firstly\r
    //\r
    if (!EFI_IP6_EQUAL (&Head->DestinationAddress, &MldPacket.Group)) {\r
      goto Exit;\r
    }\r
    //\r
    // The node is not listening but it receives the specific query. Just return.\r
    //\r
    Group = Ip6FindMldEntry (IpSb, &MldPacket.Group);\r
    if (Group == NULL) {\r
      Status = EFI_SUCCESS;\r
      goto Exit;\r
    }\r
\r
    Status = Ip6UpdateDelayTimer (\r
               IpSb,\r
               MldPacket.MaxRespDelay,\r
               &MldPacket.Group,\r
               Group\r
               );\r
    goto Exit;\r
  }\r
\r
  //\r
  // Receives a General Query, sets a delay timer for each multicast address it is listening\r
  //\r
  NET_LIST_FOR_EACH (Entry, &IpSb->MldCtrl.Groups) {\r
    Group  = NET_LIST_USER_STRUCT (Entry, IP6_MLD_GROUP, Link);\r
    Status = Ip6UpdateDelayTimer (IpSb, MldPacket.MaxRespDelay, &Group->Address, Group);\r
    if (EFI_ERROR (Status)) {\r
      goto Exit;\r
    }\r
  }\r
\r
  Status = EFI_SUCCESS;\r
\r
Exit:\r
  NetbufFree (Packet);\r
  return Status;\r
}\r
\r
/**\r
  Process the Multicast Listener Report message.\r
\r
  @param[in]  IpSb               The IP service that received the packet.\r
  @param[in]  Head               The IP head of the MLD report packet.\r
  @param[in]  Packet             The content of the MLD report packet with IP head\r
                                 removed.\r
\r
  @retval EFI_SUCCESS            The MLD report packet processed successfully.\r
  @retval EFI_INVALID_PARAMETER  The packet is invalid.\r
\r
**/\r
EFI_STATUS\r
Ip6ProcessMldReport (\r
  IN IP6_SERVICE            *IpSb,\r
  IN EFI_IP6_HEADER         *Head,\r
  IN NET_BUF                *Packet\r
  )\r
{\r
  IP6_MLD_HEAD              MldPacket;\r
  IP6_MLD_GROUP             *Group;\r
  EFI_STATUS                Status;\r
\r
  Status = EFI_INVALID_PARAMETER;\r
\r
  //\r
  // Validate the incoming message, if invalid, drop it.\r
  //\r
  if (!NetIp6IsUnspecifiedAddr (&Head->SourceAddress) && !NetIp6IsLinkLocalAddr (&Head->SourceAddress)) {\r
    goto Exit;\r
  }\r
\r
  if (Head->HopLimit != 1 || !IP6_IS_MULTICAST (&Head->DestinationAddress)) {\r
    goto Exit;\r
  }\r
\r
  //\r
  // The Packet points to MLD report raw data without Hop-By-Hop option.\r
  //\r
  NetbufCopy (Packet, 0, sizeof (IP6_MLD_HEAD), (UINT8 *) &MldPacket);\r
  if (!EFI_IP6_EQUAL (&Head->DestinationAddress, &MldPacket.Group)) {\r
    goto Exit;\r
  }\r
\r
  Group = Ip6FindMldEntry (IpSb, &MldPacket.Group);\r
  if (Group == NULL) {\r
    goto Exit;\r
  }\r
\r
  //\r
  // The report is sent by another node, stop its own timer relates to the multicast address and clear\r
  //\r
\r
  if (!Group->SendByUs) {\r
    Group->DelayTimer = 0;\r
  }\r
\r
  Status = EFI_SUCCESS;\r
\r
Exit:\r
  NetbufFree (Packet);\r
  return Status;\r
}\r
\r
/**\r
  The heartbeat timer of MLD module. It sends out a solicited MLD report when\r
  DelayTimer expires.\r
\r
  @param[in]  IpSb              The IP6 service binding instance.\r
\r
**/\r
VOID\r
Ip6MldTimerTicking (\r
  IN IP6_SERVICE            *IpSb\r
  )\r
{\r
  IP6_MLD_GROUP             *Group;\r
  LIST_ENTRY                *Entry;\r
\r
  //\r
  // Send solicited report when timer expires\r
  //\r
  NET_LIST_FOR_EACH (Entry, &IpSb->MldCtrl.Groups) {\r
    Group = NET_LIST_USER_STRUCT (Entry, IP6_MLD_GROUP, Link);\r
    if ((Group->DelayTimer > 0) && (--Group->DelayTimer == 0)) {\r
      Ip6SendMldReport (IpSb, NULL, &Group->Address);\r
    }\r
  }\r
}\r
\r