[mirror_edk2.git] / NetworkPkg / Udp6Dxe / Udp6Impl.c

/** @file\r
  Udp6 driver's whole implementation.\r
\r
  Copyright (c) 2009 - 2016, Intel Corporation. All rights reserved.<BR>\r
\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
  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
\r
#include "Udp6Impl.h"\r
\r
UINT16  mUdp6RandomPort;\r
\r
/**\r
  This function checks and timeouts the I/O datagrams holding by the corresponding\r
  service context.\r
\r
  @param[in]  Event              The event this function is registered to.\r
  @param[in]  Context            The context data registered during the creation of\r
                                 the Event.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6CheckTimeout (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  );\r
\r
/**\r
  This function finds the udp instance by the specified <Address, Port> pair.\r
\r
  @param[in]  InstanceList       Pointer to the head of the list linking the udp\r
                                 instances.\r
  @param[in]  Address            Pointer to the specified IPv6 address.\r
  @param[in]  Port               The udp port number.\r
\r
  @retval TRUE     The specified <Address, Port> pair is found.\r
  @retval FALSE    Otherwise.\r
\r
**/\r
BOOLEAN\r
Udp6FindInstanceByPort (\r
  IN LIST_ENTRY        *InstanceList,\r
  IN EFI_IPv6_ADDRESS  *Address,\r
  IN UINT16            Port\r
  );\r
\r
/**\r
  This function is the packet transmitting notify function registered to the IpIo\r
  interface. It's called to signal the udp TxToken when the IpIo layer completes\r
  transmitting of the udp datagram.\r
\r
  @param[in]  Status            The completion status of the output udp datagram.\r
  @param[in]  Context           Pointer to the context data.\r
  @param[in]  Sender            Specify a EFI_IP6_PROTOCOL for sending.\r
  @param[in]  NotifyData        Pointer to the notify data.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6DgramSent (\r
  IN EFI_STATUS        Status,\r
  IN VOID              *Context,\r
  IN IP_IO_IP_PROTOCOL Sender,\r
  IN VOID              *NotifyData\r
  );\r
\r
/**\r
  This function processes the received datagram passed up by the IpIo layer.\r
\r
  @param[in]  Status            The status of this udp datagram.\r
  @param[in]  IcmpError         The IcmpError code, only available when Status is\r
                                EFI_ICMP_ERROR.\r
  @param[in]  NetSession        Pointer to the EFI_NET_SESSION_DATA.\r
  @param[in]  Packet            Pointer to the NET_BUF containing the received udp\r
                                datagram.\r
  @param[in]  Context           Pointer to the context data.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6DgramRcvd (\r
  IN EFI_STATUS            Status,\r
  IN UINT8                 IcmpError,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN NET_BUF               *Packet,\r
  IN VOID                  *Context\r
  );\r
\r
/**\r
  This function cancle the token specified by Arg in the Map.\r
\r
  @param[in]  Map             Pointer to the NET_MAP.\r
  @param[in]  Item            Pointer to the NET_MAP_ITEM.\r
  @param[in]  Arg             Pointer to the token to be cancelled, if NULL, all\r
                              the tokens in this Map will be cancelled.\r
                              This parameter is optional and may be NULL.\r
\r
  @retval EFI_SUCCESS         The token is cancelled if Arg is NULL or the token\r
                              is not the same as that in the Item if Arg is not\r
                              NULL.\r
  @retval EFI_ABORTED         Arg is not NULL, and the token specified by Arg is\r
                              cancelled.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Udp6CancelTokens (\r
  IN NET_MAP       *Map,\r
  IN NET_MAP_ITEM  *Item,\r
  IN VOID          *Arg OPTIONAL\r
  );\r
\r
/**\r
  This function check if the received udp datagram matches with the Instance.\r
\r
  @param[in]  Instance           Pointer to the udp instance context data.\r
  @param[in]  Udp6Session        Pointer to the EFI_UDP6_SESSION_DATA abstracted\r
                                 from the received udp datagram.\r
\r
  @retval TRUE     The udp datagram matches the receiving requirements of the Instance.\r
  @retval FALSE    The udp datagram doe not match the receiving requirements of the Instance.\r
\r
**/\r
BOOLEAN\r
Udp6MatchDgram (\r
  IN UDP6_INSTANCE_DATA     *Instance,\r
  IN EFI_UDP6_SESSION_DATA  *Udp6Session\r
  );\r
\r
/**\r
  This function removes the Wrap specified by Context and releases relevant resources.\r
\r
  @param[in]  Event                  The Event this notify function is registered to.\r
  @param[in]  Context                Pointer to the context data.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6RecycleRxDataWrap (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  );\r
\r
/**\r
  This function wraps the Packet into RxData.\r
\r
  @param[in]  Instance           Pointer to the instance context data.\r
  @param[in]  Packet             Pointer to the buffer containing the received\r
                                 datagram.\r
  @param[in]  RxData             Pointer to the EFI_UDP6_RECEIVE_DATA of this\r
                                 datagram.\r
\r
  @return Pointer to the structure wrapping the RxData and the Packet.\r
\r
**/\r
UDP6_RXDATA_WRAP *\r
Udp6WrapRxData (\r
  IN UDP6_INSTANCE_DATA     *Instance,\r
  IN NET_BUF                *Packet,\r
  IN EFI_UDP6_RECEIVE_DATA  *RxData\r
  );\r
\r
/**\r
  This function enqueues the received datagram into the instances' receiving queues.\r
\r
  @param[in]  Udp6Service        Pointer to the udp service context data.\r
  @param[in]  Packet             Pointer to the buffer containing the received\r
                                 datagram.\r
  @param[in]  RxData             Pointer to the EFI_UDP6_RECEIVE_DATA of this\r
                                 datagram.\r
\r
  @return The times this datagram is enqueued.\r
\r
**/\r
UINTN\r
Udp6EnqueueDgram (\r
  IN UDP6_SERVICE_DATA      *Udp6Service,\r
  IN NET_BUF                *Packet,\r
  IN EFI_UDP6_RECEIVE_DATA  *RxData\r
  );\r
\r
/**\r
  This function delivers the datagrams enqueued in the instances.\r
\r
  @param[in]  Udp6Service            Pointer to the udp service context data.\r
\r
**/\r
VOID\r
Udp6DeliverDgram (\r
  IN UDP6_SERVICE_DATA  *Udp6Service\r
  );\r
\r
/**\r
  This function demultiplexes the received udp datagram to the appropriate instances.\r
\r
  @param[in]  Udp6Service        Pointer to the udp service context data.\r
  @param[in]  NetSession         Pointer to the EFI_NET_SESSION_DATA abstracted from\r
                                 the received datagram.\r
  @param[in]  Packet             Pointer to the buffer containing the received udp\r
                                 datagram.\r
\r
**/\r
VOID\r
Udp6Demultiplex (\r
  IN UDP6_SERVICE_DATA     *Udp6Service,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN NET_BUF               *Packet\r
  );\r
\r
/**\r
  This function handles the received Icmp Error message and demultiplexes it to the\r
  instance.\r
\r
  @param[in]       Udp6Service        Pointer to the udp service context data.\r
  @param[in]       IcmpError          The icmp error code.\r
  @param[in]       NetSession         Pointer to the EFI_NET_SESSION_DATA abstracted\r
                                      from the received Icmp Error packet.\r
  @param[in, out]  Packet             Pointer to the Icmp Error packet.\r
\r
**/\r
VOID\r
Udp6IcmpHandler (\r
  IN UDP6_SERVICE_DATA     *Udp6Service,\r
  IN UINT8                 IcmpError,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN OUT NET_BUF           *Packet\r
  );\r
\r
/**\r
  This function builds and sends out a icmp port unreachable message.\r
\r
  @param[in]  IpIo               Pointer to the IP_IO instance.\r
  @param[in]  NetSession         Pointer to the EFI_NET_SESSION_DATA of the packet\r
                                 causes this icmp error message.\r
  @param[in]  Udp6Header         Pointer to the udp header of the datagram causes\r
                                 this icmp error message.\r
\r
**/\r
VOID\r
Udp6SendPortUnreach (\r
  IN IP_IO                 *IpIo,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN VOID                  *Udp6Header\r
  );\r
\r
/**\r
  Find the key in the netmap\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
Udp6MapMultiCastAddr (\r
  IN  NET_MAP               *Map,\r
  IN  VOID                  *Key\r
  );\r
\r
/**\r
  Create the Udp service context data.\r
\r
  @param[in]  Udp6Service        Pointer to the UDP6_SERVICE_DATA.\r
  @param[in]  ImageHandle        The image handle of this udp6 driver.\r
  @param[in]  ControllerHandle   The controller handle this udp6 driver binds on.\r
\r
  @retval EFI_SUCCESS            The udp6 service context data was created and\r
                                 initialized.\r
  @retval EFI_OUT_OF_RESOURCES   Cannot allocate memory.\r
  @retval Others                 An error condition occurred.\r
\r
**/\r
EFI_STATUS\r
Udp6CreateService (\r
  IN UDP6_SERVICE_DATA  *Udp6Service,\r
  IN EFI_HANDLE         ImageHandle,\r
  IN EFI_HANDLE         ControllerHandle\r
  )\r
{\r
  EFI_STATUS       Status;\r
  IP_IO_OPEN_DATA  OpenData;\r
\r
  ZeroMem (Udp6Service, sizeof (UDP6_SERVICE_DATA));\r
\r
  Udp6Service->Signature        = UDP6_SERVICE_DATA_SIGNATURE;\r
  Udp6Service->ServiceBinding   = mUdp6ServiceBinding;\r
  Udp6Service->ImageHandle      = ImageHandle;\r
  Udp6Service->ControllerHandle = ControllerHandle;\r
  Udp6Service->ChildrenNumber   = 0;\r
\r
  InitializeListHead (&Udp6Service->ChildrenList);\r
\r
  //\r
  // Create the IpIo for this service context.\r
  //\r
  Udp6Service->IpIo = IpIoCreate (ImageHandle, ControllerHandle, IP_VERSION_6);\r
  if (Udp6Service->IpIo == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  //\r
  // Set the OpenData used to open the IpIo.\r
  //\r
  CopyMem (\r
    &OpenData.IpConfigData.Ip6CfgData,\r
    &mIp6IoDefaultIpConfigData,\r
    sizeof (EFI_IP6_CONFIG_DATA)\r
    );\r
  OpenData.RcvdContext           = (VOID *) Udp6Service;\r
  OpenData.SndContext            = NULL;\r
  OpenData.PktRcvdNotify         = Udp6DgramRcvd;\r
  OpenData.PktSentNotify         = Udp6DgramSent;\r
\r
  //\r
  // Configure and start the IpIo.\r
  //\r
  Status = IpIoOpen (Udp6Service->IpIo, &OpenData);\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  //\r
  // Create the event for Udp timeout checking.\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
                  TPL_CALLBACK,\r
                  Udp6CheckTimeout,\r
                  Udp6Service,\r
                  &Udp6Service->TimeoutEvent\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  //\r
  // Start the timeout timer event.\r
  //\r
  Status = gBS->SetTimer (\r
                  Udp6Service->TimeoutEvent,\r
                  TimerPeriodic,\r
                  UDP6_TIMEOUT_INTERVAL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  return EFI_SUCCESS;\r
\r
ON_ERROR:\r
\r
  if (Udp6Service->TimeoutEvent != NULL) {\r
    gBS->CloseEvent (Udp6Service->TimeoutEvent);\r
  }\r
\r
  IpIoDestroy (Udp6Service->IpIo);\r
  Udp6Service->IpIo = NULL;\r
  \r
  return Status;\r
}\r
\r
\r
/**\r
  Clean the Udp service context data.\r
\r
  @param[in, out]  Udp6Service      Pointer to the UDP6_SERVICE_DATA.\r
\r
**/\r
VOID\r
Udp6CleanService (\r
  IN OUT UDP6_SERVICE_DATA  *Udp6Service\r
  )\r
{\r
  //\r
  // Close the TimeoutEvent timer.\r
  //\r
  gBS->CloseEvent (Udp6Service->TimeoutEvent);\r
\r
  //\r
  // Destroy the IpIo.\r
  //\r
  IpIoDestroy (Udp6Service->IpIo);\r
  Udp6Service->IpIo = NULL;\r
  \r
  ZeroMem (Udp6Service, sizeof (UDP6_SERVICE_DATA));\r
}\r
\r
\r
/**\r
  This function checks and times out the I/O datagrams listed in the\r
  UDP6_SERVICE_DATA which is specified by the input parameter Context.\r
\r
\r
  @param[in]  Event              The event this function registered to.\r
  @param[in]  Context            The context data registered during the creation of\r
                                 the Event.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6CheckTimeout (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  )\r
{\r
  UDP6_SERVICE_DATA   *Udp6Service;\r
  LIST_ENTRY          *Entry;\r
  UDP6_INSTANCE_DATA  *Instance;\r
  LIST_ENTRY          *WrapEntry;\r
  LIST_ENTRY          *NextEntry;\r
  UDP6_RXDATA_WRAP    *Wrap;\r
\r
  Udp6Service = (UDP6_SERVICE_DATA *) Context;\r
  NET_CHECK_SIGNATURE (Udp6Service, UDP6_SERVICE_DATA_SIGNATURE);\r
\r
  NET_LIST_FOR_EACH (Entry, &Udp6Service->ChildrenList) {\r
    //\r
    // Iterate all the instances belonging to this service context.\r
    //\r
    Instance = NET_LIST_USER_STRUCT (Entry, UDP6_INSTANCE_DATA, Link);\r
    NET_CHECK_SIGNATURE (Instance, UDP6_INSTANCE_DATA_SIGNATURE);\r
\r
    if (!Instance->Configured || (Instance->ConfigData.ReceiveTimeout == 0)) {\r
      //\r
      // Skip this instance if it's not configured or no receive timeout.\r
      //\r
      continue;\r
    }\r
\r
    NET_LIST_FOR_EACH_SAFE (WrapEntry, NextEntry, &Instance->RcvdDgramQue) {\r
      //\r
      // Iterate all the rxdatas belonging to this udp instance.\r
      //\r
      Wrap = NET_LIST_USER_STRUCT (WrapEntry, UDP6_RXDATA_WRAP, Link);\r
\r
      if (Wrap->TimeoutTick < UDP6_TIMEOUT_INTERVAL / 10) {\r
        //\r
        // Remove this RxData if it timeouts.\r
        //\r
        Udp6RecycleRxDataWrap (NULL, (VOID *) Wrap);\r
      } else {\r
        Wrap->TimeoutTick -= UDP6_TIMEOUT_INTERVAL / 10;\r
      }\r
    }\r
  }\r
}\r
\r
\r
/**\r
  This function intializes the new created udp instance.\r
\r
  @param[in]       Udp6Service      Pointer to the UDP6_SERVICE_DATA.\r
  @param[in, out]  Instance         Pointer to the un-initialized UDP6_INSTANCE_DATA.\r
\r
**/\r
VOID\r
Udp6InitInstance (\r
  IN UDP6_SERVICE_DATA       *Udp6Service,\r
  IN OUT UDP6_INSTANCE_DATA  *Instance\r
  )\r
{\r
  //\r
  // Set the signature.\r
  //\r
  Instance->Signature = UDP6_INSTANCE_DATA_SIGNATURE;\r
\r
  //\r
  // Init the lists.\r
  //\r
  InitializeListHead (&Instance->Link);\r
  InitializeListHead (&Instance->RcvdDgramQue);\r
  InitializeListHead (&Instance->DeliveredDgramQue);\r
\r
  //\r
  // Init the NET_MAPs.\r
  //\r
  NetMapInit (&Instance->TxTokens);\r
  NetMapInit (&Instance->RxTokens);\r
  NetMapInit (&Instance->McastIps);\r
\r
  //\r
  // Save the pointer to the UDP6_SERVICE_DATA, and initialize other members.\r
  //\r
  Instance->Udp6Service = Udp6Service;\r
  CopyMem (&Instance->Udp6Proto, &mUdp6Protocol, sizeof (EFI_UDP6_PROTOCOL));\r
  Instance->IcmpError   = EFI_SUCCESS;\r
  Instance->Configured  = FALSE;\r
  Instance->IsNoMapping = FALSE;\r
  Instance->InDestroy   = FALSE;\r
}\r
\r
\r
/**\r
  This function cleans the udp instance.\r
\r
  @param[in, out]  Instance       Pointer to the UDP6_INSTANCE_DATA to clean.\r
\r
**/\r
VOID\r
Udp6CleanInstance (\r
  IN OUT UDP6_INSTANCE_DATA  *Instance\r
  )\r
{\r
  NetMapClean (&Instance->McastIps);\r
  NetMapClean (&Instance->RxTokens);\r
  NetMapClean (&Instance->TxTokens);\r
}\r
\r
\r
/**\r
  This function finds the udp instance by the specified <Address, Port> pair.\r
\r
  @param[in]  InstanceList       Pointer to the head of the list linking the udp\r
                                 instances.\r
  @param[in]  Address            Pointer to the specified IPv6 address.\r
  @param[in]  Port               The udp port number.\r
\r
  @retval TRUE     The specified <Address, Port> pair is found.\r
  @retval FALSE    Otherwise.\r
\r
**/\r
BOOLEAN\r
Udp6FindInstanceByPort (\r
  IN LIST_ENTRY        *InstanceList,\r
  IN EFI_IPv6_ADDRESS  *Address,\r
  IN UINT16            Port\r
  )\r
{\r
  LIST_ENTRY            *Entry;\r
  UDP6_INSTANCE_DATA    *Instance;\r
  EFI_UDP6_CONFIG_DATA  *ConfigData;\r
\r
  NET_LIST_FOR_EACH (Entry, InstanceList) {\r
    //\r
    // Iterate all the udp instances.\r
    //\r
    Instance   = NET_LIST_USER_STRUCT (Entry, UDP6_INSTANCE_DATA, Link);\r
    ConfigData = &Instance->ConfigData;\r
\r
    if (!Instance->Configured || ConfigData->AcceptAnyPort) {\r
      //\r
      // If the instance is not configured, or the configdata of the instance indicates\r
      // this instance accepts any port, skip it.\r
      //\r
      continue;\r
    }\r
\r
    if (EFI_IP6_EQUAL (&ConfigData->StationAddress, Address) &&\r
        (ConfigData->StationPort == Port)\r
        ) {\r
      //\r
      // If both the address and the port are the same, return TRUE.\r
      //\r
      return TRUE;\r
    }\r
  }\r
\r
  //\r
  // Return FALSE when matching fails.\r
  //\r
  return FALSE;\r
}\r
\r
\r
/**\r
  This function tries to bind the udp instance according to the configured port\r
  allocation stragety.\r
\r
  @param[in]  InstanceList       Pointer to the head of the list linking the udp\r
                                 instances.\r
  @param[in]  ConfigData         Pointer to the ConfigData of the instance to be\r
                                 bound.\r
\r
  @retval EFI_SUCCESS            The bound operation completed successfully.\r
  @retval EFI_ACCESS_DENIED      The <Address, Port> specified by the ConfigData is\r
                                 already used by other instance.\r
  @retval EFI_OUT_OF_RESOURCES   No available port resources.\r
\r
**/\r
EFI_STATUS\r
Udp6Bind (\r
  IN LIST_ENTRY            *InstanceList,\r
  IN EFI_UDP6_CONFIG_DATA  *ConfigData\r
  )\r
{\r
  EFI_IPv6_ADDRESS  *StationAddress;\r
  UINT16            StartPort;\r
\r
  if (ConfigData->AcceptAnyPort) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  StationAddress = &ConfigData->StationAddress;\r
\r
  if (ConfigData->StationPort != 0) {\r
\r
    if (!ConfigData->AllowDuplicatePort &&\r
        Udp6FindInstanceByPort (InstanceList, StationAddress, ConfigData->StationPort)\r
        ) {\r
      //\r
      // Do not allow duplicate ports and the port is already used by other instance.\r
      //\r
      return EFI_ACCESS_DENIED;\r
    }\r
  } else {\r
    //\r
    // Select a random port for this instance.\r
    //\r
    if (ConfigData->AllowDuplicatePort) {\r
      //\r
      // Just pick up the random port if the instance allows duplicate port.\r
      //\r
      ConfigData->StationPort = mUdp6RandomPort;\r
    } else {\r
\r
      StartPort = mUdp6RandomPort;\r
\r
      while (Udp6FindInstanceByPort (InstanceList, StationAddress, mUdp6RandomPort)) {\r
\r
        mUdp6RandomPort++;\r
        if (mUdp6RandomPort == 0) {\r
          mUdp6RandomPort = UDP6_PORT_KNOWN;\r
        }\r
\r
        if (mUdp6RandomPort == StartPort) {\r
          //\r
          // No available port.\r
          //\r
          return EFI_OUT_OF_RESOURCES;\r
        }\r
      }\r
\r
      ConfigData->StationPort = mUdp6RandomPort;\r
    }\r
\r
    mUdp6RandomPort++;\r
    if (mUdp6RandomPort == 0) {\r
      mUdp6RandomPort = UDP6_PORT_KNOWN;\r
    }\r
  }\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  This function is used to check whether the NewConfigData has any un-reconfigurable\r
  parameters changed compared to the OldConfigData.\r
\r
  @param[in]  OldConfigData    Pointer to the current ConfigData the udp instance\r
                               uses.\r
  @param[in]  NewConfigData    Pointer to the new ConfigData.\r
\r
  @retval TRUE     The instance is reconfigurable according to the NewConfigData.\r
  @retval FALSE    Otherwise.\r
\r
**/\r
BOOLEAN\r
Udp6IsReconfigurable (\r
  IN EFI_UDP6_CONFIG_DATA  *OldConfigData,\r
  IN EFI_UDP6_CONFIG_DATA  *NewConfigData\r
  )\r
{\r
  if ((NewConfigData->AcceptAnyPort != OldConfigData->AcceptAnyPort) ||\r
      (NewConfigData->AcceptPromiscuous != OldConfigData->AcceptPromiscuous) ||\r
      (NewConfigData->AllowDuplicatePort != OldConfigData->AllowDuplicatePort)\r
      ) {\r
    //\r
    // The receiving filter parameters cannot be changed.\r
    //\r
    return FALSE;\r
  }\r
\r
  if ((!NewConfigData->AcceptAnyPort) &&\r
      (NewConfigData->StationPort != OldConfigData->StationPort)\r
      ) {\r
    //\r
    // The port is not changeable.\r
    //\r
    return FALSE;\r
  }\r
\r
  if (!EFI_IP6_EQUAL (&NewConfigData->StationAddress, &OldConfigData->StationAddress)) {\r
    //\r
    //  The StationAddress is not the same.\r
    //\r
    return FALSE;\r
  }\r
\r
\r
  if (!EFI_IP6_EQUAL (&NewConfigData->RemoteAddress, &OldConfigData->RemoteAddress)) {\r
    //\r
    // The remoteaddress is not the same.\r
    //\r
    return FALSE;\r
  }\r
\r
  if (!NetIp6IsUnspecifiedAddr (&NewConfigData->RemoteAddress) &&\r
      (NewConfigData->RemotePort != OldConfigData->RemotePort)\r
      ) {\r
    //\r
    // The RemotePort differs if it's designated in the configdata.\r
    //\r
    return FALSE;\r
  }\r
\r
  //\r
  // All checks pass, return TRUE.\r
  //\r
  return TRUE;\r
}\r
\r
\r
/**\r
  This function builds the Ip6 configdata from the Udp6ConfigData.\r
\r
  @param[in]       Udp6ConfigData         Pointer to the EFI_UDP6_CONFIG_DATA.\r
  @param[in, out]  Ip6ConfigData          Pointer to the EFI_IP6_CONFIG_DATA.\r
\r
**/\r
VOID\r
Udp6BuildIp6ConfigData (\r
  IN EFI_UDP6_CONFIG_DATA      *Udp6ConfigData,\r
  IN OUT EFI_IP6_CONFIG_DATA   *Ip6ConfigData\r
  )\r
{\r
  CopyMem (\r
    Ip6ConfigData,\r
    &mIp6IoDefaultIpConfigData,\r
    sizeof (EFI_IP6_CONFIG_DATA)\r
    );\r
  Ip6ConfigData->DefaultProtocol      = EFI_IP_PROTO_UDP;\r
  Ip6ConfigData->AcceptPromiscuous    = Udp6ConfigData->AcceptPromiscuous;\r
  IP6_COPY_ADDRESS (&Ip6ConfigData->StationAddress, &Udp6ConfigData->StationAddress);\r
  IP6_COPY_ADDRESS (&Ip6ConfigData->DestinationAddress, &Udp6ConfigData->RemoteAddress);\r
  //\r
  // Use the -1 magic number to disable the receiving process of the ip instance.\r
  //\r
  Ip6ConfigData->ReceiveTimeout    = (UINT32) (-1);\r
}\r
\r
\r
/**\r
  This function validates the TxToken. It returns the error code according to the spec.\r
\r
  @param[in]  Instance           Pointer to the udp instance context data.\r
  @param[in]  TxToken            Pointer to the token to be checked.\r
\r
  @retval EFI_SUCCESS            The TxToken is valid.\r
  @retval EFI_INVALID_PARAMETER  One or more of the following are TRUE:\r
                                 Token.Event is NULL;\r
                                 Token.Packet.TxData is NULL;\r
                                 Token.Packet.TxData.FragmentCount is zero;\r
                                 Token.Packet.TxData.DataLength is not equal to the\r
                                 sum of fragment lengths;\r
                                 One or more of the\r
                                 Token.Packet.TxData.FragmentTable[].FragmentLength\r
                                 fields is zero;\r
                                 One or more of the\r
                                 Token.Packet.TxData.FragmentTable[].FragmentBuffer\r
                                 fields is NULL;\r
                                 UdpSessionData.DestinationAddress are not valid\r
                                 unicast IPv6 addresses if the UdpSessionData is\r
                                 not NULL;\r
                                 UdpSessionData.DestinationPort and\r
                                 ConfigData.RemotePort are all zero if the\r
                                 UdpSessionData is not NULL.\r
  @retval EFI_BAD_BUFFER_SIZE    The data length is greater than the maximum UDP\r
                                 packet size.\r
\r
**/\r
EFI_STATUS\r
Udp6ValidateTxToken (\r
  IN UDP6_INSTANCE_DATA         *Instance,\r
  IN EFI_UDP6_COMPLETION_TOKEN  *TxToken\r
  )\r
{\r
  EFI_UDP6_TRANSMIT_DATA  *TxData;\r
  UINT32                  Index;\r
  UINT32                  TotalLen;\r
  EFI_UDP6_CONFIG_DATA    *ConfigData;\r
  EFI_UDP6_SESSION_DATA   *UdpSessionData;\r
\r
\r
  if (TxToken->Event == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  TxData = TxToken->Packet.TxData;\r
\r
  if ((TxData == NULL) || (TxData->FragmentCount == 0)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  TotalLen = 0;\r
  for (Index = 0; Index < TxData->FragmentCount; Index++) {\r
\r
    if ((TxData->FragmentTable[Index].FragmentBuffer == NULL) ||\r
        (TxData->FragmentTable[Index].FragmentLength == 0)\r
        ) {\r
      //\r
      // If the FragmentBuffer is NULL, or the FragmentLeng is zero.\r
      //\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    TotalLen += TxData->FragmentTable[Index].FragmentLength;\r
  }\r
\r
  if (TotalLen != TxData->DataLength) {\r
    //\r
    // The TotalLen calculated by adding all the FragmentLeng doesn't equal to the\r
    // DataLength.\r
    //\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  ConfigData     = &Instance->ConfigData;\r
  UdpSessionData = TxData->UdpSessionData;\r
\r
  if (UdpSessionData != NULL) {\r
\r
    if ((UdpSessionData->DestinationPort == 0) && (ConfigData->RemotePort == 0)) {\r
      //\r
      // Ambiguous; no avalaible DestinationPort for this token.\r
      //\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    if (NetIp6IsUnspecifiedAddr (&UdpSessionData->DestinationAddress) &&\r
        NetIp6IsUnspecifiedAddr (&ConfigData->RemoteAddress)\r
        ) {\r
      //\r
      // The DestinationAddress is not specificed.\r
      //\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    if (!NetIp6IsUnspecifiedAddr (&UdpSessionData->DestinationAddress) &&\r
        !NetIp6IsUnspecifiedAddr (&ConfigData->RemoteAddress)\r
        ) {\r
      //\r
      // The ConfigData.RemoteAddress is not zero and the UdpSessionData.DestinationAddress\r
      // is not zero too.\r
      //\r
      return EFI_INVALID_PARAMETER;\r
    }\r
  } else if (NetIp6IsUnspecifiedAddr (&ConfigData->RemoteAddress)) {\r
    //\r
    // The configured RemoteAddress is all zero, and the user doesn't override the\r
    // destination address.\r
    //\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (TxData->DataLength > UDP6_MAX_DATA_SIZE) {\r
    return EFI_BAD_BUFFER_SIZE;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  This function checks whether the specified Token duplicates the one in the Map.\r
\r
  @param[in]  Map                Pointer to the NET_MAP.\r
  @param[in]  Item               Pointer to the NET_MAP_ITEM contain the pointer to\r
                                 the Token.\r
  @param[in]  Context            Pointer to the Token to be checked.\r
\r
  @retval EFI_SUCCESS            The Token specified by Context differs from the\r
                                 one in the Item.\r
  @retval EFI_ACCESS_DENIED      The Token duplicates with the one in the Item.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Udp6TokenExist (\r
  IN NET_MAP       *Map,\r
  IN NET_MAP_ITEM  *Item,\r
  IN VOID          *Context\r
  )\r
{\r
  EFI_UDP6_COMPLETION_TOKEN  *Token;\r
  EFI_UDP6_COMPLETION_TOKEN  *TokenInItem;\r
\r
  Token       = (EFI_UDP6_COMPLETION_TOKEN *) Context;\r
  TokenInItem = (EFI_UDP6_COMPLETION_TOKEN *) Item->Key;\r
\r
  if ((Token == TokenInItem) || (Token->Event == TokenInItem->Event)) {\r
    //\r
    // The Token duplicates with the TokenInItem in case either the two pointers are the\r
    // same, or the Events of these two tokens are the same.\r
    //\r
    return EFI_ACCESS_DENIED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  This function calculates the checksum for the Packet, utilizing the pre-calculated\r
  pseudo HeadSum to reduce some overhead.\r
\r
  @param[in]  Packet           Pointer to the NET_BUF contains the udp datagram.\r
  @param[in]  HeadSum          Checksum of the pseudo header, execpt the length\r
                               field.\r
\r
  @return The 16-bit checksum of this udp datagram.\r
\r
**/\r
UINT16\r
Udp6Checksum (\r
  IN NET_BUF *Packet,\r
  IN UINT16  HeadSum\r
  )\r
{\r
  UINT16  Checksum;\r
\r
  Checksum  = NetbufChecksum (Packet);\r
  Checksum  = NetAddChecksum (Checksum, HeadSum);\r
\r
  Checksum  = NetAddChecksum (Checksum, HTONS ((UINT16) Packet->TotalSize));\r
  Checksum  = (UINT16) (~Checksum);\r
  return Checksum;\r
}\r
\r
\r
/**\r
  This function removes the specified Token from the TokenMap.\r
\r
  @param[in]  TokenMap           Pointer to the NET_MAP containing the tokens.\r
  @param[in]  Token              Pointer to the Token to be removed.\r
\r
  @retval EFI_SUCCESS            The specified Token is removed from the TokenMap.\r
  @retval EFI_NOT_FOUND          The specified Token is not found in the TokenMap.\r
\r
**/\r
EFI_STATUS\r
Udp6RemoveToken (\r
  IN NET_MAP                    *TokenMap,\r
  IN EFI_UDP6_COMPLETION_TOKEN  *Token\r
  )\r
{\r
  NET_MAP_ITEM  *Item;\r
\r
  //\r
  // Find the Token first.\r
  //\r
  Item = NetMapFindKey (TokenMap, (VOID *) Token);\r
\r
  if (Item != NULL) {\r
    //\r
    // Remove the token if it's found in the map.\r
    //\r
    NetMapRemoveItem (TokenMap, Item, NULL);\r
\r
    return EFI_SUCCESS;\r
  }\r
  return EFI_NOT_FOUND;\r
}\r
\r
\r
/**\r
  This function is the packet transmitting notify function registered to the IpIo\r
  interface. It's called to signal the udp TxToken when IpIo layer completes the\r
  transmitting of the udp datagram.\r
\r
  @param[in]  Status            The completion status of the output udp datagram.\r
  @param[in]  Context           Pointer to the context data.\r
  @param[in]  Sender            Specify a EFI_IP6_PROTOCOL for sending.\r
  @param[in]  NotifyData        Pointer to the notify data.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6DgramSent (\r
  IN EFI_STATUS        Status,\r
  IN VOID              *Context,\r
  IN IP_IO_IP_PROTOCOL Sender,\r
  IN VOID              *NotifyData\r
  )\r
{\r
  UDP6_INSTANCE_DATA         *Instance;\r
  EFI_UDP6_COMPLETION_TOKEN  *Token;\r
\r
  Instance = (UDP6_INSTANCE_DATA *) Context;\r
  Token    = (EFI_UDP6_COMPLETION_TOKEN *) NotifyData;\r
\r
  if (Udp6RemoveToken (&Instance->TxTokens, Token) == EFI_SUCCESS) {\r
    //\r
    // The token may be cancelled. Only signal it if the remove operation succeeds.\r
    //\r
    Token->Status = Status;\r
    gBS->SignalEvent (Token->Event);\r
    DispatchDpc ();\r
  }\r
}\r
\r
\r
/**\r
  This function processes the received datagram passed up by the IpIo layer.\r
\r
  @param[in]  Status            The status of this udp datagram.\r
  @param[in]  IcmpError         The IcmpError code, only available when Status is\r
                                EFI_ICMP_ERROR.\r
  @param[in]  NetSession        Pointer to the EFI_NET_SESSION_DATA.\r
  @param[in]  Packet            Pointer to the NET_BUF containing the received udp\r
                                datagram.\r
  @param[in]  Context           Pointer to the context data.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6DgramRcvd (\r
  IN EFI_STATUS            Status,\r
  IN UINT8                 IcmpError,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN NET_BUF               *Packet,\r
  IN VOID                  *Context\r
  )\r
{\r
  NET_CHECK_SIGNATURE (Packet, NET_BUF_SIGNATURE);\r
\r
  //\r
  // IpIo only passes received packets with Status EFI_SUCCESS or EFI_ICMP_ERROR.\r
  //\r
  if (Status == EFI_SUCCESS) {\r
\r
    //\r
    // Demultiplex the received datagram.\r
    //\r
    Udp6Demultiplex ((UDP6_SERVICE_DATA *) Context, NetSession, Packet);\r
  } else {\r
    //\r
    // Handle the ICMP6 Error packet.\r
    //\r
    Udp6IcmpHandler ((UDP6_SERVICE_DATA *) Context, IcmpError, NetSession, Packet);\r
  }\r
\r
  //\r
  // Dispatch the DPC queued by the NotifyFunction of the rx token's events\r
  // that are signaled with received data.\r
  //\r
  DispatchDpc ();\r
}\r
\r
\r
/**\r
  This function removes the multicast group specified by Arg from the Map.\r
\r
  @param[in]  Map                Pointer to the NET_MAP.\r
  @param[in]  Item               Pointer to the NET_MAP_ITEM.\r
  @param[in]  Arg                Pointer to the Arg, it's the pointer to a\r
                                 multicast IPv6 Address. This parameter is\r
                                 optional and may be NULL.\r
\r
  @retval EFI_SUCCESS            The multicast address is removed.\r
  @retval EFI_ABORTED            The specified multicast address is removed, and the\r
                                 Arg is not NULL.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Udp6LeaveGroup (\r
  IN NET_MAP       *Map,\r
  IN NET_MAP_ITEM  *Item,\r
  IN VOID          *Arg OPTIONAL\r
  )\r
{\r
  EFI_IPv6_ADDRESS  *McastIp;\r
\r
  McastIp = Arg;\r
\r
  if ((McastIp != NULL) &&\r
      !EFI_IP6_EQUAL (McastIp, ((EFI_IPv6_ADDRESS *)Item->Key))\r
      ) {\r
    //\r
    // McastIp is not NULL and the multicast address contained in the Item\r
    // is not the same as McastIp.\r
    //\r
    return EFI_SUCCESS;\r
  }\r
\r
  FreePool (Item->Key);\r
\r
  //\r
  // Remove this Item.\r
  //\r
  NetMapRemoveItem (Map, Item, NULL);\r
\r
  if (McastIp != NULL) {\r
    //\r
    // Return EFI_ABORTED in case McastIp is not NULL to terminate the iteration.\r
    //\r
    return EFI_ABORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  This function cancle the token specified by Arg in the Map.\r
\r
  @param[in]  Map             Pointer to the NET_MAP.\r
  @param[in]  Item            Pointer to the NET_MAP_ITEM.\r
  @param[in]  Arg             Pointer to the token to be cancelled. If NULL, all\r
                              the tokens in this Map will be cancelled.\r
                              This parameter is optional and may be NULL.\r
\r
  @retval EFI_SUCCESS         The token is cancelled if Arg is NULL, or the token\r
                              is not the same as that in the Item, if Arg is not\r
                              NULL.\r
  @retval EFI_ABORTED         Arg is not NULL, and the token specified by Arg is\r
                              cancelled.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Udp6CancelTokens (\r
  IN NET_MAP       *Map,\r
  IN NET_MAP_ITEM  *Item,\r
  IN VOID          *Arg OPTIONAL\r
  )\r
{\r
  EFI_UDP6_COMPLETION_TOKEN  *TokenToCancel;\r
  NET_BUF                    *Packet;\r
  IP_IO                      *IpIo;\r
\r
  if ((Arg != NULL) && (Item->Key != Arg)) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  if (Item->Value != NULL) {\r
    //\r
    // If the token is a transmit token, the corresponding Packet is recorded in\r
    // Item->Value, invoke IpIo to cancel this packet first. The IpIoCancelTxToken\r
    // will invoke Udp6DgramSent, the token will be signaled and this Item will\r
    // be removed from the Map there.\r
    //\r
    Packet  = (NET_BUF *) (Item->Value);\r
    IpIo    = (IP_IO *) (*((UINTN *) &Packet->ProtoData[0]));\r
\r
    IpIoCancelTxToken (IpIo, Packet);\r
  } else {\r
    //\r
    // The token is a receive token. Abort it and remove it from the Map.\r
    //\r
    TokenToCancel = (EFI_UDP6_COMPLETION_TOKEN *) Item->Key;\r
    NetMapRemoveItem (Map, Item, NULL);\r
\r
    TokenToCancel->Status = EFI_ABORTED;\r
    gBS->SignalEvent (TokenToCancel->Event);\r
  }\r
\r
  if (Arg != NULL) {\r
    return EFI_ABORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  This function removes all the Wrap datas in the RcvdDgramQue.\r
\r
  @param[in]  Instance    Pointer to the Udp6 Instance.\r
\r
**/\r
VOID\r
Udp6FlushRcvdDgram (\r
  IN UDP6_INSTANCE_DATA  *Instance\r
  )\r
{\r
  UDP6_RXDATA_WRAP  *Wrap;\r
\r
  while (!IsListEmpty (&Instance->RcvdDgramQue)) {\r
    //\r
    // Iterate all the Wraps in the RcvdDgramQue.\r
    //\r
    Wrap = NET_LIST_HEAD (&Instance->RcvdDgramQue, UDP6_RXDATA_WRAP, Link);\r
\r
    //\r
    // The Wrap will be removed from the RcvdDgramQue by this function call.\r
    //\r
    Udp6RecycleRxDataWrap (NULL, (VOID *) Wrap);\r
  }\r
}\r
\r
\r
\r
/**\r
  Cancel Udp6 tokens from the Udp6 instance.\r
\r
  @param[in]  Instance           Pointer to the udp instance context data.\r
  @param[in]  Token              Pointer to the token to be canceled. If NULL, all\r
                                 tokens in this instance will be cancelled.\r
                                 This parameter is optional and may be NULL.\r
\r
  @retval EFI_SUCCESS            The Token is cancelled.\r
  @retval EFI_NOT_FOUND          The Token is not found.\r
\r
**/\r
EFI_STATUS\r
Udp6InstanceCancelToken (\r
  IN UDP6_INSTANCE_DATA         *Instance,\r
  IN EFI_UDP6_COMPLETION_TOKEN  *Token OPTIONAL\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  //\r
  // Cancel this token from the TxTokens map.\r
  //\r
  Status = NetMapIterate (&Instance->TxTokens, Udp6CancelTokens, Token);\r
\r
  if ((Token != NULL) && (Status == EFI_ABORTED)) {\r
    //\r
    // If Token isn't NULL and Status is EFI_ABORTED, the token is cancelled from\r
    // the TxTokens and returns success.\r
    //\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Try to cancel this token from the RxTokens map in condition either the Token\r
  // is NULL or the specified Token is not in TxTokens.\r
  //\r
  Status = NetMapIterate (&Instance->RxTokens, Udp6CancelTokens, Token);\r
\r
  if ((Token != NULL) && (Status == EFI_SUCCESS)) {\r
    //\r
    // If Token isn't NULL and Status is EFI_SUCCESS, the token is neither in the\r
    // TxTokens nor the RxTokens, or say, it's not found.\r
    //\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  ASSERT ((Token != NULL) ||\r
          ((0 == NetMapGetCount (&Instance->TxTokens)) &&\r
          (0 == NetMapGetCount (&Instance->RxTokens)))\r
          );\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  This function checks if the received udp datagram matches with the Instance.\r
\r
  @param[in]  Instance           Pointer to the udp instance context data.\r
  @param[in]  Udp6Session        Pointer to the EFI_UDP6_SESSION_DATA abstracted\r
                                 from the received udp datagram.\r
\r
  @retval TRUE     The udp datagram matches the receiving requirements of the Instance.\r
  @retval FALSE    The udp datagram does not matche the receiving requirements of the Instance.\r
\r
**/\r
BOOLEAN\r
Udp6MatchDgram (\r
  IN UDP6_INSTANCE_DATA     *Instance,\r
  IN EFI_UDP6_SESSION_DATA  *Udp6Session\r
  )\r
{\r
  EFI_UDP6_CONFIG_DATA  *ConfigData;\r
  EFI_IPv6_ADDRESS      Destination;\r
\r
  ConfigData = &Instance->ConfigData;\r
\r
  if (ConfigData->AcceptPromiscuous) {\r
    //\r
    // Always matches if this instance is in the promiscuous state.\r
    //\r
    return TRUE;\r
  }\r
\r
  if ((!ConfigData->AcceptAnyPort && (Udp6Session->DestinationPort != ConfigData->StationPort)) ||\r
      ((ConfigData->RemotePort != 0) && (Udp6Session->SourcePort != ConfigData->RemotePort))\r
      ) {\r
    //\r
    // The local port or the remote port doesn't match.\r
    //\r
    return FALSE;\r
  }\r
\r
  if (!NetIp6IsUnspecifiedAddr (&ConfigData->RemoteAddress) &&\r
      !EFI_IP6_EQUAL (&ConfigData->RemoteAddress, &Udp6Session->SourceAddress)\r
      ) {\r
    //\r
    // This datagram doesn't come from the instance's specified sender.\r
    //\r
    return FALSE;\r
  }\r
\r
  if (NetIp6IsUnspecifiedAddr (&ConfigData->StationAddress) ||\r
      EFI_IP6_EQUAL (&Udp6Session->DestinationAddress, &ConfigData->StationAddress)\r
      ) {\r
    //\r
    // The instance is configured to receive datagrams destinated to any station IP or\r
    // the destination address of this datagram matches the configured station IP.\r
    //\r
    return TRUE;\r
  }\r
\r
  IP6_COPY_ADDRESS (&Destination, &Udp6Session->DestinationAddress);\r
\r
  if (IP6_IS_MULTICAST (&Destination) &&\r
      (NULL != Udp6MapMultiCastAddr (&Instance->McastIps, &Destination))\r
      ) {\r
    //\r
    // It's a multicast packet and the multicast address is accepted by this instance.\r
    //\r
    return TRUE;\r
  }\r
\r
  return FALSE;\r
}\r
\r
\r
/**\r
  This function removes the Wrap specified by Context and release relevant resources.\r
\r
  @param[in]  Event                  The Event this notify function registered to.\r
  @param[in]  Context                Pointer to the context data.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6RecycleRxDataWrap (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  )\r
{\r
  UDP6_RXDATA_WRAP  *Wrap;\r
\r
  Wrap = (UDP6_RXDATA_WRAP *) Context;\r
\r
  //\r
  // Remove the Wrap from the list it belongs to.\r
  //\r
  RemoveEntryList (&Wrap->Link);\r
\r
  //\r
  // Free the Packet associated with this Wrap.\r
  //\r
  NetbufFree (Wrap->Packet);\r
\r
  //\r
  // Close the event.\r
  //\r
  gBS->CloseEvent (Wrap->RxData.RecycleSignal);\r
\r
  FreePool (Wrap);\r
}\r
\r
\r
/**\r
  This function wraps the Packet into RxData.\r
\r
  @param[in]  Instance           Pointer to the instance context data.\r
  @param[in]  Packet             Pointer to the buffer containing the received\r
                                 datagram.\r
  @param[in]  RxData             Pointer to the EFI_UDP6_RECEIVE_DATA of this\r
                                 datagram.\r
\r
  @return Pointer to the structure wrapping the RxData and the Packet.\r
\r
**/\r
UDP6_RXDATA_WRAP *\r
Udp6WrapRxData (\r
  IN UDP6_INSTANCE_DATA     *Instance,\r
  IN NET_BUF                *Packet,\r
  IN EFI_UDP6_RECEIVE_DATA  *RxData\r
  )\r
{\r
  EFI_STATUS            Status;\r
  UDP6_RXDATA_WRAP      *Wrap;\r
\r
  //\r
  // Allocate buffer for the Wrap.\r
  //\r
  Wrap = AllocateZeroPool (sizeof (UDP6_RXDATA_WRAP) +\r
         (Packet->BlockOpNum - 1) * sizeof (EFI_UDP6_FRAGMENT_DATA));\r
  if (Wrap == NULL) {\r
    return NULL;\r
  }\r
\r
  InitializeListHead (&Wrap->Link);\r
\r
  CopyMem (&Wrap->RxData, RxData, sizeof(EFI_UDP6_RECEIVE_DATA));\r
  //\r
  // Create the Recycle event.\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL,\r
                  TPL_NOTIFY,\r
                  Udp6RecycleRxDataWrap,\r
                  Wrap,\r
                  &Wrap->RxData.RecycleSignal\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    FreePool (Wrap);\r
    return NULL;\r
  }\r
\r
  Wrap->Packet      = Packet;\r
  Wrap->TimeoutTick = Instance->ConfigData.ReceiveTimeout;\r
\r
  return Wrap;\r
}\r
\r
\r
/**\r
  This function enqueues the received datagram into the instances' receiving queues.\r
\r
  @param[in]  Udp6Service        Pointer to the udp service context data.\r
  @param[in]  Packet             Pointer to the buffer containing the received\r
                                 datagram.\r
  @param[in]  RxData             Pointer to the EFI_UDP6_RECEIVE_DATA of this\r
                                 datagram.\r
\r
  @return The times this datagram is enqueued.\r
\r
**/\r
UINTN\r
Udp6EnqueueDgram (\r
  IN UDP6_SERVICE_DATA      *Udp6Service,\r
  IN NET_BUF                *Packet,\r
  IN EFI_UDP6_RECEIVE_DATA  *RxData\r
  )\r
{\r
  LIST_ENTRY          *Entry;\r
  UDP6_INSTANCE_DATA  *Instance;\r
  UDP6_RXDATA_WRAP    *Wrap;\r
  UINTN               Enqueued;\r
\r
  Enqueued = 0;\r
\r
  NET_LIST_FOR_EACH (Entry, &Udp6Service->ChildrenList) {\r
    //\r
    // Iterate the instances.\r
    //\r
    Instance = NET_LIST_USER_STRUCT (Entry, UDP6_INSTANCE_DATA, Link);\r
\r
    if (!Instance->Configured) {\r
      continue;\r
    }\r
\r
    if (Udp6MatchDgram (Instance, &RxData->UdpSession)) {\r
      //\r
      // Wrap the RxData and put this Wrap into the instances RcvdDgramQue.\r
      //\r
      Wrap = Udp6WrapRxData (Instance, Packet, RxData);\r
      if (Wrap == NULL) {\r
        continue;\r
      }\r
\r
      NET_GET_REF (Packet);\r
\r
      InsertTailList (&Instance->RcvdDgramQue, &Wrap->Link);\r
\r
      Enqueued++;\r
    }\r
  }\r
\r
  return Enqueued;\r
}\r
\r
\r
/**\r
  This function delivers the received datagrams to the specified instance.\r
\r
  @param[in]  Instance               Pointer to the instance context data.\r
\r
**/\r
VOID\r
Udp6InstanceDeliverDgram (\r
  IN UDP6_INSTANCE_DATA  *Instance\r
  )\r
{\r
  UDP6_RXDATA_WRAP           *Wrap;\r
  EFI_UDP6_COMPLETION_TOKEN  *Token;\r
  NET_BUF                    *Dup;\r
  EFI_UDP6_RECEIVE_DATA      *RxData;\r
  EFI_TPL                    OldTpl;\r
\r
  if (!IsListEmpty (&Instance->RcvdDgramQue) &&\r
      !NetMapIsEmpty (&Instance->RxTokens)\r
      ) {\r
\r
    Wrap = NET_LIST_HEAD (&Instance->RcvdDgramQue, UDP6_RXDATA_WRAP, Link);\r
\r
    if (NET_BUF_SHARED (Wrap->Packet)) {\r
      //\r
      // Duplicate the Packet if it is shared between instances.\r
      //\r
      Dup = NetbufDuplicate (Wrap->Packet, NULL, 0);\r
      if (Dup == NULL) {\r
        return;\r
      }\r
\r
      NetbufFree (Wrap->Packet);\r
\r
      Wrap->Packet = Dup;\r
    }\r
\r
    NetListRemoveHead (&Instance->RcvdDgramQue);\r
\r
    Token = (EFI_UDP6_COMPLETION_TOKEN *) NetMapRemoveHead (&Instance->RxTokens, NULL);\r
\r
    //\r
    // Build the FragmentTable and set the FragmentCount in RxData.\r
    //\r
    RxData                = &Wrap->RxData;\r
    RxData->FragmentCount = Wrap->Packet->BlockOpNum;\r
\r
    NetbufBuildExt (\r
      Wrap->Packet,\r
      (NET_FRAGMENT *) RxData->FragmentTable,\r
      &RxData->FragmentCount\r
      );\r
\r
    Token->Status        = EFI_SUCCESS;\r
    Token->Packet.RxData = &Wrap->RxData;\r
\r
    OldTpl = gBS->RaiseTPL (TPL_NOTIFY);\r
    InsertTailList (&Instance->DeliveredDgramQue, &Wrap->Link);\r
    gBS->RestoreTPL (OldTpl);\r
\r
    gBS->SignalEvent (Token->Event);\r
  }\r
}\r
\r
\r
/**\r
  This function delivers the datagrams enqueued in the instances.\r
\r
  @param[in]  Udp6Service            Pointer to the udp service context data.\r
\r
**/\r
VOID\r
Udp6DeliverDgram (\r
  IN UDP6_SERVICE_DATA  *Udp6Service\r
  )\r
{\r
  LIST_ENTRY          *Entry;\r
  UDP6_INSTANCE_DATA  *Instance;\r
\r
  NET_LIST_FOR_EACH (Entry, &Udp6Service->ChildrenList) {\r
    //\r
    // Iterate the instances.\r
    //\r
    Instance = NET_LIST_USER_STRUCT (Entry, UDP6_INSTANCE_DATA, Link);\r
\r
    if (!Instance->Configured) {\r
      continue;\r
    }\r
\r
    //\r
    // Deliver the datagrams of this instance.\r
    //\r
    Udp6InstanceDeliverDgram (Instance);\r
  }\r
}\r
\r
\r
/**\r
  This function demultiplexes the received udp datagram to the appropriate instances.\r
\r
  @param[in]  Udp6Service        Pointer to the udp service context data.\r
  @param[in]  NetSession         Pointer to the EFI_NET_SESSION_DATA abstracted from\r
                                 the received datagram.\r
  @param[in]  Packet             Pointer to the buffer containing the received udp\r
                                 datagram.\r
\r
**/\r
VOID\r
Udp6Demultiplex (\r
  IN UDP6_SERVICE_DATA     *Udp6Service,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN NET_BUF               *Packet\r
  )\r
{\r
  EFI_UDP_HEADER        *Udp6Header;\r
  UINT16                 HeadSum;\r
  EFI_UDP6_RECEIVE_DATA  RxData;\r
  EFI_UDP6_SESSION_DATA  *Udp6Session;\r
  UINTN                  Enqueued;\r
\r
  if (Packet->TotalSize < sizeof (EFI_UDP_HEADER)) {\r
    NetbufFree (Packet);\r
    return;\r
  }\r
  \r
  //\r
  // Get the datagram header from the packet buffer.\r
  //\r
  Udp6Header = (EFI_UDP_HEADER *) NetbufGetByte (Packet, 0, NULL);\r
  ASSERT (Udp6Header != NULL);\r
\r
  if (Udp6Header->Checksum != 0) {\r
    //\r
    // check the checksum.\r
    //\r
    HeadSum = NetIp6PseudoHeadChecksum (\r
                &NetSession->Source.v6,\r
                &NetSession->Dest.v6,\r
                EFI_IP_PROTO_UDP,\r
                0\r
                );\r
\r
    if (Udp6Checksum (Packet, HeadSum) != 0) {\r
      //\r
      // Wrong checksum.\r
      //\r
      NetbufFree (Packet);\r
      return;\r
    }\r
  }\r
\r
  Udp6Session                  = &RxData.UdpSession;\r
  Udp6Session->SourcePort      = NTOHS (Udp6Header->SrcPort);\r
  Udp6Session->DestinationPort = NTOHS (Udp6Header->DstPort);\r
\r
  IP6_COPY_ADDRESS (&Udp6Session->SourceAddress, &NetSession->Source);\r
  IP6_COPY_ADDRESS (&Udp6Session->DestinationAddress, &NetSession->Dest);\r
\r
  //\r
  // Trim the UDP header.\r
  //\r
  NetbufTrim (Packet, UDP6_HEADER_SIZE, TRUE);\r
\r
  RxData.DataLength = (UINT32) Packet->TotalSize;\r
\r
  //\r
  // Try to enqueue this datagram into the instances.\r
  //\r
  Enqueued = Udp6EnqueueDgram (Udp6Service, Packet, &RxData);\r
\r
  if (Enqueued == 0) {\r
    //\r
    // Send the port unreachable ICMP packet before we free this NET_BUF\r
    //\r
    Udp6SendPortUnreach (Udp6Service->IpIo, NetSession, Udp6Header);\r
  }\r
\r
  //\r
  // Try to free the packet before deliver it.\r
  //\r
  NetbufFree (Packet);\r
\r
  if (Enqueued > 0) {\r
    //\r
    // Deliver the datagram.\r
    //\r
    Udp6DeliverDgram (Udp6Service);\r
  }\r
}\r
\r
\r
/**\r
  This function builds and sends out a icmp port unreachable message.\r
\r
  @param[in]  IpIo               Pointer to the IP_IO instance.\r
  @param[in]  NetSession         Pointer to the EFI_NET_SESSION_DATA of the packet\r
                                 causes this icmp error message.\r
  @param[in]  Udp6Header         Pointer to the udp header of the datagram causes\r
                                 this icmp error message.\r
\r
**/\r
VOID\r
Udp6SendPortUnreach (\r
  IN IP_IO                 *IpIo,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN VOID                  *Udp6Header\r
  )\r
{\r
  NET_BUF              *Packet;\r
  UINT32               Len;\r
  IP6_ICMP_ERROR_HEAD  *IcmpErrHdr;\r
  UINT8                *Ptr;\r
  IP_IO_OVERRIDE       Override;\r
  IP_IO_IP_INFO        *IpSender;\r
  EFI_IP6_MODE_DATA    *Ip6ModeData;\r
  EFI_STATUS           Status;\r
  EFI_IP6_PROTOCOL     *Ip6Protocol;\r
\r
  Ip6ModeData = NULL;\r
\r
  //\r
  // An ICMPv6 error message MUST NOT be originated as A packet destined to\r
  // 1) an IPv6 multicast address 2) The IPv6 Unspecified Address\r
  //\r
  if (NetSession->IpVersion == IP_VERSION_6) {\r
    if (NetIp6IsUnspecifiedAddr (&NetSession->Dest.v6) ||\r
      IP6_IS_MULTICAST (&NetSession->Dest.v6)\r
      ) {\r
      goto EXIT;\r
    }\r
  }\r
\r
\r
  IpSender    = IpIoFindSender (&IpIo, NetSession->IpVersion, &NetSession->Dest);\r
\r
  //\r
  // Get the Ipv6 Mode Data.\r
  //\r
  Ip6ModeData = AllocateZeroPool (sizeof (EFI_IP6_MODE_DATA));\r
  ASSERT (Ip6ModeData != NULL);\r
\r
  //\r
  // If not finding the related IpSender use the default IpIo to send out\r
  // the port unreachable ICMP message.\r
  //\r
  if (IpSender == NULL) {\r
    Ip6Protocol = IpIo->Ip.Ip6;\r
  } else {\r
    Ip6Protocol = IpSender->Ip.Ip6;\r
  }\r
\r
  Status = Ip6Protocol->GetModeData (\r
                          Ip6Protocol,\r
                          Ip6ModeData,\r
                          NULL,\r
                          NULL\r
                          );\r
\r
  if (EFI_ERROR (Status)) {\r
    goto EXIT;\r
  }\r
  //\r
  // The ICMP6 packet length, includes whole invoking packet and ICMP6 error header.\r
  //\r
  Len = NetSession->IpHdrLen +\r
        NTOHS(((EFI_UDP_HEADER *) Udp6Header)->Length) +\r
        sizeof (IP6_ICMP_ERROR_HEAD);\r
\r
  //\r
  // If the ICMP6 packet length larger than IP MTU, adjust its length to MTU.\r
  //\r
  if (Ip6ModeData->MaxPacketSize < Len) {\r
    Len = Ip6ModeData->MaxPacketSize;\r
  }\r
\r
  //\r
  // Allocate buffer for the icmp error message.\r
  //\r
  Packet = NetbufAlloc (Len);\r
  if (Packet == NULL) {\r
    goto EXIT;\r
  }\r
\r
  //\r
  // Allocate space for the IP6_ICMP_ERROR_HEAD.\r
  //\r
  IcmpErrHdr = (IP6_ICMP_ERROR_HEAD *) NetbufAllocSpace (Packet, Len, FALSE);\r
  ASSERT (IcmpErrHdr != NULL);\r
\r
  //\r
  // Set the required fields for the icmp port unreachable message.\r
  //\r
  IcmpErrHdr->Head.Type     = ICMP_V6_DEST_UNREACHABLE;\r
  IcmpErrHdr->Head.Code     = ICMP_V6_PORT_UNREACHABLE;\r
  IcmpErrHdr->Head.Checksum = 0;\r
  IcmpErrHdr->Fourth        = 0;\r
\r
  //\r
  // Copy as much of invoking Packet as possible without the ICMPv6 packet\r
  // exceeding the minimum Ipv6 MTU. The length of IP6_ICMP_ERROR_HEAD contains\r
  // the length of EFI_IP6_HEADER, so when using the length of IP6_ICMP_ERROR_HEAD\r
  // for pointer movement that fact should be considered.\r
  //\r
  Ptr = (VOID *) &IcmpErrHdr->Head;\r
  Ptr = (UINT8 *) (UINTN) ((UINTN) Ptr + sizeof (IP6_ICMP_ERROR_HEAD) - sizeof (EFI_IP6_HEADER));\r
  CopyMem (Ptr, NetSession->IpHdr.Ip6Hdr, NetSession->IpHdrLen);\r
  CopyMem (\r
    Ptr + NetSession->IpHdrLen,\r
    Udp6Header,\r
    Len - NetSession->IpHdrLen - sizeof (IP6_ICMP_ERROR_HEAD) + sizeof (EFI_IP6_HEADER)\r
    );\r
\r
  //\r
  // Set the checksum as zero, and IP6 driver will calcuate it with pseudo header.\r
  //\r
  IcmpErrHdr->Head.Checksum = 0;\r
\r
  //\r
  // Fill the override data.\r
  //\r
  Override.Ip6OverrideData.FlowLabel     = 0;\r
  Override.Ip6OverrideData.HopLimit      = 255;\r
  Override.Ip6OverrideData.Protocol      = IP6_ICMP;\r
\r
  //\r
  // Send out this icmp packet.\r
  //\r
  IpIoSend (IpIo, Packet, IpSender, NULL, NULL, &NetSession->Source, &Override);\r
\r
  NetbufFree (Packet);\r
\r
EXIT:\r
  if (Ip6ModeData != NULL) {\r
    FreePool (Ip6ModeData);\r
  }\r
}\r
\r
\r
/**\r
  This function handles the received Icmp Error message and de-multiplexes it to the\r
  instance.\r
\r
  @param[in]       Udp6Service        Pointer to the udp service context data.\r
  @param[in]       IcmpError          The icmp error code.\r
  @param[in]       NetSession         Pointer to the EFI_NET_SESSION_DATA abstracted\r
                                      from the received Icmp Error packet.\r
  @param[in, out]  Packet             Pointer to the Icmp Error packet.\r
\r
**/\r
VOID\r
Udp6IcmpHandler (\r
  IN UDP6_SERVICE_DATA     *Udp6Service,\r
  IN UINT8                 IcmpError,\r
  IN EFI_NET_SESSION_DATA  *NetSession,\r
  IN OUT NET_BUF           *Packet\r
  )\r
{\r
  EFI_UDP_HEADER         *Udp6Header;\r
  EFI_UDP6_SESSION_DATA  Udp6Session;\r
  LIST_ENTRY             *Entry;\r
  UDP6_INSTANCE_DATA     *Instance;\r
\r
  if (Packet->TotalSize < sizeof (EFI_UDP_HEADER)) {\r
    NetbufFree (Packet);\r
    return;\r
  }\r
  \r
  Udp6Header = (EFI_UDP_HEADER *) NetbufGetByte (Packet, 0, NULL);\r
  ASSERT (Udp6Header != NULL);\r
\r
  IP6_COPY_ADDRESS (&Udp6Session.SourceAddress, &NetSession->Source);\r
  IP6_COPY_ADDRESS (&Udp6Session.DestinationAddress, &NetSession->Dest);\r
\r
  Udp6Session.SourcePort      = NTOHS (Udp6Header->DstPort);\r
  Udp6Session.DestinationPort = NTOHS (Udp6Header->SrcPort);\r
\r
  NET_LIST_FOR_EACH (Entry, &Udp6Service->ChildrenList) {\r
    //\r
    // Iterate all the instances.\r
    //\r
    Instance = NET_LIST_USER_STRUCT (Entry, UDP6_INSTANCE_DATA, Link);\r
\r
    if (!Instance->Configured) {\r
      continue;\r
    }\r
\r
    if (Udp6MatchDgram (Instance, &Udp6Session)) {\r
      //\r
      // Translate the Icmp Error code according to the udp spec.\r
      //\r
      Instance->IcmpError = IpIoGetIcmpErrStatus (IcmpError, IP_VERSION_6, NULL, NULL);\r
\r
      if (IcmpError > ICMP_ERR_UNREACH_PORT) {\r
        Instance->IcmpError = EFI_ICMP_ERROR;\r
      }\r
\r
      //\r
      // Notify the instance with the received Icmp Error.\r
      //\r
      Udp6ReportIcmpError (Instance);\r
\r
      break;\r
    }\r
  }\r
\r
  NetbufFree (Packet);\r
}\r
\r
\r
/**\r
  This function reports the received ICMP error.\r
\r
  @param[in]  Instance          Pointer to the udp instance context data.\r
\r
**/\r
VOID\r
Udp6ReportIcmpError (\r
  IN UDP6_INSTANCE_DATA  *Instance\r
  )\r
{\r
  EFI_UDP6_COMPLETION_TOKEN  *Token;\r
\r
  if (NetMapIsEmpty (&Instance->RxTokens)) {\r
    //\r
    // There are no receive tokens to deliver the ICMP error.\r
    //\r
    return;\r
  }\r
\r
  if (EFI_ERROR (Instance->IcmpError)) {\r
    //\r
    // Try to get a RxToken from the RxTokens map.\r
    //\r
    Token = (EFI_UDP6_COMPLETION_TOKEN *) NetMapRemoveHead (&Instance->RxTokens, NULL);\r
\r
    if (Token != NULL) {\r
      //\r
      // Report the error through the Token.\r
      //\r
      Token->Status = Instance->IcmpError;\r
      gBS->SignalEvent (Token->Event);\r
\r
      //\r
      // Clear the IcmpError.\r
      //\r
      Instance->IcmpError = EFI_SUCCESS;\r
    }\r
  }\r
}\r
\r
\r
/**\r
  This function is a dummy ext-free function for the NET_BUF created for the output\r
  udp datagram.\r
\r
  @param[in]  Context                Pointer to the context data.\r
\r
**/\r
VOID\r
EFIAPI\r
Udp6NetVectorExtFree (\r
  IN VOID  *Context\r
  )\r
{\r
} \r
\r
/**\r
  Find the key in the netmap.\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
Udp6MapMultiCastAddr (\r
  IN  NET_MAP               *Map,\r
  IN  VOID                  *Key\r
  )\r
{\r
  LIST_ENTRY        *Entry;\r
  NET_MAP_ITEM      *Item;\r
  EFI_IPv6_ADDRESS  *Addr;\r
\r
  ASSERT (Map != NULL);\r
  NET_LIST_FOR_EACH (Entry, &Map->Used) {\r
    Item  = NET_LIST_USER_STRUCT (Entry, NET_MAP_ITEM, Link);\r
    Addr  = (EFI_IPv6_ADDRESS *) Item->Key;\r
    if (EFI_IP6_EQUAL (Addr, Key)) {\r
      return Item;\r
    }\r
  }\r
  return NULL;\r
}\r
\r