MdeModulePkg/Ip4Dxe: return error on memory allocate failure instead of ASSERT.

[mirror_edk2.git] / MdeModulePkg / Universal / Network / Ip4Dxe / Ip4Impl.c

/** @file\r
\r
Copyright (c) 2005 - 2017, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution.  The full text of the license may be found at\r
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 "Ip4Impl.h"\r
\r
EFI_IPSEC2_PROTOCOL    *mIpSec = NULL;\r
\r
/**\r
  Gets the current operational settings for this instance of the EFI IPv4 Protocol driver.\r
\r
  The GetModeData() function returns the current operational mode data for this\r
  driver instance. The data fields in EFI_IP4_MODE_DATA are read only. This\r
  function is used optionally to retrieve the operational mode data of underlying\r
  networks or drivers.\r
\r
  @param[in]   This          Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[out]  Ip4ModeData   Pointer to the EFI IPv4 Protocol mode data structure.\r
  @param[out]  MnpConfigData Pointer to the managed network configuration data structure.\r
  @param[out]  SnpModeData   Pointer to the simple network mode data structure.\r
\r
  @retval EFI_SUCCESS           The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER This is NULL.\r
  @retval EFI_OUT_OF_RESOURCES  The required mode data could not be allocated.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4GetModeData (\r
  IN  CONST EFI_IP4_PROTOCOL                *This,\r
  OUT       EFI_IP4_MODE_DATA               *Ip4ModeData     OPTIONAL,\r
  OUT       EFI_MANAGED_NETWORK_CONFIG_DATA *MnpConfigData   OPTIONAL,\r
  OUT       EFI_SIMPLE_NETWORK_MODE         *SnpModeData     OPTIONAL\r
  );\r
\r
/**\r
  Assigns an IPv4 address and subnet mask to this EFI IPv4 Protocol driver instance.\r
\r
  The Configure() function is used to set, change, or reset the operational\r
  parameters and filter settings for this EFI IPv4 Protocol instance. Until these\r
  parameters have been set, no network traffic can be sent or received by this\r
  instance. Once the parameters have been reset (by calling this function with\r
  IpConfigData set to NULL), no more traffic can be sent or received until these\r
  parameters have been set again. Each EFI IPv4 Protocol instance can be started\r
  and stopped independently of each other by enabling or disabling their receive\r
  filter settings with the Configure() function.\r
\r
  When IpConfigData.UseDefaultAddress is set to FALSE, the new station address will\r
  be appended as an alias address into the addresses list in the EFI IPv4 Protocol\r
  driver. While set to TRUE, Configure() will trigger the EFI_IP4_CONFIG_PROTOCOL\r
  to retrieve the default IPv4 address if it is not available yet. Clients could\r
  frequently call GetModeData() to check the status to ensure that the default IPv4\r
  address is ready.\r
\r
  If operational parameters are reset or changed, any pending transmit and receive\r
  requests will be cancelled. Their completion token status will be set to EFI_ABORTED\r
  and their events will be signaled.\r
\r
  @param[in]  This              Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  IpConfigData      Pointer to the EFI IPv4 Protocol configuration data structure.\r
\r
  @retval EFI_SUCCESS           The driver instance was successfully opened.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                RARP, etc.) is not finished yet.\r
  @retval EFI_INVALID_PARAMETER One or more of the following conditions is TRUE:\r
  @retval EFI_UNSUPPORTED       One or more of the following conditions is TRUE:\r
                                A configuration protocol (DHCP, BOOTP, RARP, etc.) could\r
                                not be located when clients choose to use the default IPv4\r
                                address. This EFI IPv4 Protocol implementation does not\r
                                support this requested filter or timeout setting.\r
  @retval EFI_OUT_OF_RESOURCES  The EFI IPv4 Protocol driver instance data could not be allocated.\r
  @retval EFI_ALREADY_STARTED   The interface is already open and must be stopped before the\r
                                IPv4 address or subnet mask can be changed. The interface must\r
                                also be stopped when switching to/from raw packet mode.\r
  @retval EFI_DEVICE_ERROR      An unexpected system or network error occurred. The EFI IPv4\r
                                Protocol driver instance is not opened.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Configure (\r
  IN EFI_IP4_PROTOCOL       *This,\r
  IN EFI_IP4_CONFIG_DATA    *IpConfigData       OPTIONAL\r
  );\r
\r
/**\r
  Joins and leaves multicast groups.\r
\r
  The Groups() function is used to join and leave multicast group sessions. Joining\r
  a group will enable reception of matching multicast packets. Leaving a group will\r
  disable the multicast packet reception.\r
\r
  If JoinFlag is FALSE and GroupAddress is NULL, all joined groups will be left.\r
\r
  @param[in]  This                  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  JoinFlag              Set to TRUE to join the multicast group session and FALSE to leave.\r
  @param[in]  GroupAddress          Pointer to the IPv4 multicast address.\r
\r
  @retval EFI_SUCCESS           The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER One or more of the following is TRUE:\r
                                - This is NULL.\r
                                - JoinFlag is TRUE and GroupAddress is NULL.\r
                                - GroupAddress is not NULL and *GroupAddress is\r
                                not a multicast IPv4 address.\r
  @retval EFI_NOT_STARTED       This instance has not been started.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                RARP, etc.) is not finished yet.\r
  @retval EFI_OUT_OF_RESOURCES  System resources could not be allocated.\r
  @retval EFI_UNSUPPORTED       This EFI IPv4 Protocol implementation does not support multicast groups.\r
  @retval EFI_ALREADY_STARTED   The group address is already in the group table (when\r
                                JoinFlag is TRUE).\r
  @retval EFI_NOT_FOUND         The group address is not in the group table (when JoinFlag is FALSE).\r
  @retval EFI_DEVICE_ERROR      An unexpected system or network error occurred.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Groups (\r
  IN EFI_IP4_PROTOCOL       *This,\r
  IN BOOLEAN                JoinFlag,\r
  IN EFI_IPv4_ADDRESS       *GroupAddress     OPTIONAL\r
  );\r
\r
/**\r
  Adds and deletes routing table entries.\r
\r
  The Routes() function adds a route to or deletes a route from the routing table.\r
\r
  Routes are determined by comparing the SubnetAddress with the destination IPv4\r
  address arithmetically AND-ed with the SubnetMask. The gateway address must be\r
  on the same subnet as the configured station address.\r
\r
  The default route is added with SubnetAddress and SubnetMask both set to 0.0.0.0.\r
  The default route matches all destination IPv4 addresses that do not match any\r
  other routes.\r
\r
  A GatewayAddress that is zero is a nonroute. Packets are sent to the destination\r
  IP address if it can be found in the ARP cache or on the local subnet. One automatic\r
  nonroute entry will be inserted into the routing table for outgoing packets that\r
  are addressed to a local subnet (gateway address of 0.0.0.0).\r
\r
  Each EFI IPv4 Protocol instance has its own independent routing table. Those EFI\r
  IPv4 Protocol instances that use the default IPv4 address will also have copies\r
  of the routing table that was provided by the EFI_IP4_CONFIG_PROTOCOL, and these\r
  copies will be updated whenever the EIF IPv4 Protocol driver reconfigures its\r
  instances. As a result, client modification to the routing table will be lost.\r
\r
  @param[in]  This                   Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  DeleteRoute            Set to TRUE to delete this route from the routing table. Set to\r
                                     FALSE to add this route to the routing table. SubnetAddress\r
                                     and SubnetMask are used as the key to each route entry.\r
  @param[in]  SubnetAddress          The address of the subnet that needs to be routed.\r
  @param[in]  SubnetMask             The subnet mask of SubnetAddress.\r
  @param[in]  GatewayAddress         The unicast gateway IPv4 address for this route.\r
\r
  @retval EFI_SUCCESS            The operation completed successfully.\r
  @retval EFI_NOT_STARTED        The driver instance has not been started.\r
  @retval EFI_NO_MAPPING         When using the default address, configuration (DHCP, BOOTP,\r
                                 RARP, etc.) is not finished yet.\r
  @retval EFI_INVALID_PARAMETER  One or more of the following conditions is TRUE:\r
                                 - This is NULL.\r
                                 - SubnetAddress is NULL.\r
                                 - SubnetMask is NULL.\r
                                 - GatewayAddress is NULL.\r
                                 - *SubnetAddress is not a valid subnet address.\r
                                 - *SubnetMask is not a valid subnet mask.\r
                                 - *GatewayAddress is not a valid unicast IPv4 address.\r
  @retval EFI_OUT_OF_RESOURCES   Could not add the entry to the routing table.\r
  @retval EFI_NOT_FOUND          This route is not in the routing table (when DeleteRoute is TRUE).\r
  @retval EFI_ACCESS_DENIED      The route is already defined in the routing table (when\r
                                  DeleteRoute is FALSE).\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Routes (\r
  IN EFI_IP4_PROTOCOL       *This,\r
  IN BOOLEAN                DeleteRoute,\r
  IN EFI_IPv4_ADDRESS       *SubnetAddress,\r
  IN EFI_IPv4_ADDRESS       *SubnetMask,\r
  IN EFI_IPv4_ADDRESS       *GatewayAddress\r
  );\r
\r
/**\r
  Places outgoing data packets into the transmit queue.\r
\r
  The Transmit() function places a sending request in the transmit queue of this\r
  EFI IPv4 Protocol instance. Whenever the packet in the token is sent out or some\r
  errors occur, the event in the token will be signaled and the status is updated.\r
\r
  @param[in]  This  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  Token Pointer to the transmit token.\r
\r
  @retval  EFI_SUCCESS           The data has been queued for transmission.\r
  @retval  EFI_NOT_STARTED       This instance has not been started.\r
  @retval  EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                 RARP, etc.) is not finished yet.\r
  @retval  EFI_INVALID_PARAMETER One or more pameters are invalid.\r
  @retval  EFI_ACCESS_DENIED     The transmit completion token with the same Token.Event\r
                                 was already in the transmit queue.\r
  @retval  EFI_NOT_READY         The completion token could not be queued because the transmit\r
                                 queue is full.\r
  @retval  EFI_NOT_FOUND         Not route is found to destination address.\r
  @retval  EFI_OUT_OF_RESOURCES  Could not queue the transmit data.\r
  @retval  EFI_BUFFER_TOO_SMALL  Token.Packet.TxData.TotalDataLength is too\r
                                 short to transmit.\r
  @retval  EFI_BAD_BUFFER_SIZE   The length of the IPv4 header + option length + total data length is\r
                                 greater than MTU (or greater than the maximum packet size if\r
                                 Token.Packet.TxData.OverrideData.\r
                                 DoNotFragment is TRUE.)\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Transmit (\r
  IN EFI_IP4_PROTOCOL         *This,\r
  IN EFI_IP4_COMPLETION_TOKEN *Token\r
  );\r
\r
/**\r
  Places a receiving request into the receiving queue.\r
\r
  The Receive() function places a completion token into the receive packet queue.\r
  This function is always asynchronous.\r
\r
  The Token.Event field in the completion token must be filled in by the caller\r
  and cannot be NULL. When the receive operation completes, the EFI IPv4 Protocol\r
  driver updates the Token.Status and Token.Packet.RxData fields and the Token.Event\r
  is signaled.\r
\r
  @param[in]  This  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  Token Pointer to a token that is associated with the receive data descriptor.\r
\r
  @retval EFI_SUCCESS           The receive completion token was cached.\r
  @retval EFI_NOT_STARTED       This EFI IPv4 Protocol instance has not been started.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP, RARP, etc.)\r
                                is not finished yet.\r
  @retval EFI_INVALID_PARAMETER One or more of the following conditions is TRUE:\r
                                - This is NULL.\r
                                - Token is NULL.\r
                                - Token.Event is NULL.\r
  @retval EFI_OUT_OF_RESOURCES  The receive completion token could not be queued due to a lack of system\r
                                resources (usually memory).\r
  @retval EFI_DEVICE_ERROR      An unexpected system or network error occurred.\r
                                The EFI IPv4 Protocol instance has been reset to startup defaults.\r
                                EFI_ACCESS_DENIED The receive completion token with the same Token.Event was already\r
                                in the receive queue.\r
  @retval EFI_NOT_READY         The receive request could not be queued because the receive queue is full.\r
  @retval EFI_ICMP_ERROR        An ICMP error packet was received.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Receive (\r
  IN EFI_IP4_PROTOCOL         *This,\r
  IN EFI_IP4_COMPLETION_TOKEN *Token\r
  );\r
\r
/**\r
  Abort an asynchronous transmit or receive request.\r
\r
  The Cancel() function is used to abort a pending transmit or receive request.\r
  If the token is in the transmit or receive request queues, after calling this\r
  function, Token->Status will be set to EFI_ABORTED and then Token->Event will\r
  be signaled. If the token is not in one of the queues, which usually means the\r
  asynchronous operation has completed, this function will not signal the token\r
  and EFI_NOT_FOUND is returned.\r
\r
  @param[in]  This  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  Token Pointer to a token that has been issued by\r
                    EFI_IP4_PROTOCOL.Transmit() or\r
                    EFI_IP4_PROTOCOL.Receive(). If NULL, all pending\r
                    tokens are aborted. Type EFI_IP4_COMPLETION_TOKEN is\r
                    defined in EFI_IP4_PROTOCOL.Transmit().\r
\r
  @retval EFI_SUCCESS           The asynchronous I/O request was aborted and\r
                                Token.->Event was signaled. When Token is NULL, all\r
                                pending requests were aborted and their events were signaled.\r
  @retval EFI_INVALID_PARAMETER This is NULL.\r
  @retval EFI_NOT_STARTED       This instance has not been started.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                RARP, etc.) is not finished yet.\r
  @retval EFI_NOT_FOUND         When Token is not NULL, the asynchronous I/O request was\r
                                not found in the transmit or receive queue. It has either completed\r
                                or was not issued by Transmit() and Receive().\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Cancel (\r
  IN EFI_IP4_PROTOCOL         *This,\r
  IN EFI_IP4_COMPLETION_TOKEN *Token    OPTIONAL\r
  );\r
\r
/**\r
  Polls for incoming data packets and processes outgoing data packets.\r
\r
  The Poll() function polls for incoming data packets and processes outgoing data\r
  packets. Network drivers and applications can call the EFI_IP4_PROTOCOL.Poll()\r
  function to increase the rate that data packets are moved between the communications\r
  device and the transmit and receive queues.\r
\r
  In some systems the periodic timer event may not poll the underlying communications\r
  device fast enough to transmit and/or receive all data packets without missing\r
  incoming packets or dropping outgoing packets. Drivers and applications that are\r
  experiencing packet loss should try calling the EFI_IP4_PROTOCOL.Poll() function\r
  more often.\r
\r
  @param[in]  This               Pointer to the EFI_IP4_PROTOCOL instance.\r
\r
  @retval  EFI_SUCCESS           Incoming or outgoing data was processed.\r
  @retval  EFI_NOT_STARTED       This EFI IPv4 Protocol instance has not been started.\r
  @retval  EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                 RARP, etc.) is not finished yet.\r
  @retval  EFI_INVALID_PARAMETER This is NULL.\r
  @retval  EFI_DEVICE_ERROR      An unexpected system or network error occurred.\r
  @retval  EFI_NOT_READY         No incoming or outgoing data is processed.\r
  @retval  EFI_TIMEOUT           Data was dropped out of the transmit and/or receive queue.\r
                                 Consider increasing the polling rate.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Poll (\r
  IN EFI_IP4_PROTOCOL       *This\r
  );\r
\r
EFI_IP4_PROTOCOL\r
mEfiIp4ProtocolTemplete = {\r
  EfiIp4GetModeData,\r
  EfiIp4Configure,\r
  EfiIp4Groups,\r
  EfiIp4Routes,\r
  EfiIp4Transmit,\r
  EfiIp4Receive,\r
  EfiIp4Cancel,\r
  EfiIp4Poll\r
};\r
\r
/**\r
  Gets the current operational settings for this instance of the EFI IPv4 Protocol driver.\r
\r
  The GetModeData() function returns the current operational mode data for this\r
  driver instance. The data fields in EFI_IP4_MODE_DATA are read only. This\r
  function is used optionally to retrieve the operational mode data of underlying\r
  networks or drivers.\r
\r
  @param[in]   This          Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[out]  Ip4ModeData   Pointer to the EFI IPv4 Protocol mode data structure.\r
  @param[out]  MnpConfigData Pointer to the managed network configuration data structure.\r
  @param[out]  SnpModeData   Pointer to the simple network mode data structure.\r
\r
  @retval EFI_SUCCESS           The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER This is NULL.\r
  @retval EFI_OUT_OF_RESOURCES  The required mode data could not be allocated.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4GetModeData (\r
  IN  CONST EFI_IP4_PROTOCOL                *This,\r
  OUT       EFI_IP4_MODE_DATA               *Ip4ModeData     OPTIONAL,\r
  OUT       EFI_MANAGED_NETWORK_CONFIG_DATA *MnpConfigData   OPTIONAL,\r
  OUT       EFI_SIMPLE_NETWORK_MODE         *SnpModeData     OPTIONAL\r
  )\r
{\r
  IP4_PROTOCOL              *IpInstance;\r
  IP4_SERVICE               *IpSb;\r
  EFI_IP4_CONFIG_DATA       *Config;\r
  EFI_STATUS                Status;\r
  EFI_TPL                   OldTpl;\r
  IP4_ADDR                  Ip;\r
\r
  if (This == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  OldTpl     = gBS->RaiseTPL (TPL_CALLBACK);\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
  IpSb       = IpInstance->Service;\r
\r
  if (Ip4ModeData != NULL) {\r
    //\r
    // IsStarted is "whether the EfiIp4Configure has been called".\r
    // IsConfigured is "whether the station address has been configured"\r
    //\r
    Ip4ModeData->IsStarted     = (BOOLEAN)(IpInstance->State == IP4_STATE_CONFIGED);\r
    CopyMem (&Ip4ModeData->ConfigData, &IpInstance->ConfigData, sizeof (Ip4ModeData->ConfigData));\r
    Ip4ModeData->IsConfigured  = FALSE;\r
\r
    Ip4ModeData->GroupCount    = IpInstance->GroupCount;\r
    Ip4ModeData->GroupTable    = (EFI_IPv4_ADDRESS *) IpInstance->Groups;\r
\r
    Ip4ModeData->IcmpTypeCount = 23;\r
    Ip4ModeData->IcmpTypeList  = mIp4SupportedIcmp;\r
\r
    Ip4ModeData->RouteTable    = NULL;\r
    Ip4ModeData->RouteCount    = 0;\r
\r
    Ip4ModeData->MaxPacketSize = IpSb->MaxPacketSize;\r
\r
    //\r
    // return the current station address for this IP child. So,\r
    // the user can get the default address through this. Some\r
    // application wants to know it station address even it is\r
    // using the default one, such as a ftp server.\r
    //\r
    if (Ip4ModeData->IsStarted) {\r
      Config  = &Ip4ModeData->ConfigData;\r
\r
      Ip = HTONL (IpInstance->Interface->Ip);\r
      CopyMem (&Config->StationAddress, &Ip, sizeof (EFI_IPv4_ADDRESS));\r
\r
      Ip = HTONL (IpInstance->Interface->SubnetMask);\r
      CopyMem (&Config->SubnetMask, &Ip, sizeof (EFI_IPv4_ADDRESS));\r
\r
      Ip4ModeData->IsConfigured = IpInstance->Interface->Configured;\r
\r
      //\r
      // Build a EFI route table for user from the internal route table.\r
      //\r
      Status = Ip4BuildEfiRouteTable (IpInstance);\r
\r
      if (EFI_ERROR (Status)) {\r
        gBS->RestoreTPL (OldTpl);\r
        return Status;\r
      }\r
\r
      Ip4ModeData->RouteTable = IpInstance->EfiRouteTable;\r
      Ip4ModeData->RouteCount = IpInstance->EfiRouteCount;\r
    }\r
  }\r
\r
  //\r
  // Get fresh mode data from MNP, since underlying media status may change\r
  //\r
  Status = IpSb->Mnp->GetModeData (IpSb->Mnp, MnpConfigData, SnpModeData);\r
\r
  gBS->RestoreTPL (OldTpl);\r
  return Status;\r
}\r
\r
\r
/**\r
  Config the MNP parameter used by IP. The IP driver use one MNP\r
  child to transmit/receive frames. By default, it configures MNP\r
  to receive unicast/multicast/broadcast. And it will enable/disable\r
  the promiscous receive according to whether there is IP child\r
  enable that or not. If Force is FALSE, it will iterate through\r
  all the IP children to check whether the promiscuous receive\r
  setting has been changed. If it hasn't been changed, it won't\r
  reconfigure the MNP. If Force is TRUE, the MNP is configured no\r
  matter whether that is changed or not.\r
\r
  @param[in]  IpSb               The IP4 service instance that is to be changed.\r
  @param[in]  Force              Force the configuration or not.\r
\r
  @retval EFI_SUCCESS            The MNP is successfully configured/reconfigured.\r
  @retval Others                 Configuration failed.\r
\r
**/\r
EFI_STATUS\r
Ip4ServiceConfigMnp (\r
  IN IP4_SERVICE            *IpSb,\r
  IN BOOLEAN                Force\r
  )\r
{\r
  LIST_ENTRY                *Entry;\r
  LIST_ENTRY                *ProtoEntry;\r
  IP4_INTERFACE             *IpIf;\r
  IP4_PROTOCOL              *IpInstance;\r
  BOOLEAN                   Reconfig;\r
  BOOLEAN                   PromiscReceive;\r
  EFI_STATUS                Status;\r
\r
  Reconfig       = FALSE;\r
  PromiscReceive = FALSE;\r
\r
  if (!Force) {\r
    //\r
    // Iterate through the IP children to check whether promiscuous\r
    // receive setting has been changed. Update the interface's receive\r
    // filter also.\r
    //\r
    NET_LIST_FOR_EACH (Entry, &IpSb->Interfaces) {\r
\r
      IpIf              = NET_LIST_USER_STRUCT (Entry, IP4_INTERFACE, Link);\r
      IpIf->PromiscRecv = FALSE;\r
\r
      NET_LIST_FOR_EACH (ProtoEntry, &IpIf->IpInstances) {\r
        IpInstance = NET_LIST_USER_STRUCT (ProtoEntry, IP4_PROTOCOL, AddrLink);\r
\r
        if (IpInstance->ConfigData.AcceptPromiscuous) {\r
          IpIf->PromiscRecv = TRUE;\r
          PromiscReceive    = TRUE;\r
        }\r
      }\r
    }\r
\r
    //\r
    // If promiscuous receive isn't changed, it isn't necessary to reconfigure.\r
    //\r
    if (PromiscReceive == IpSb->MnpConfigData.EnablePromiscuousReceive) {\r
      return EFI_SUCCESS;\r
    }\r
\r
    Reconfig  = TRUE;\r
    IpSb->MnpConfigData.EnablePromiscuousReceive = PromiscReceive;\r
  }\r
\r
  Status = IpSb->Mnp->Configure (IpSb->Mnp, &IpSb->MnpConfigData);\r
\r
  //\r
  // recover the original configuration if failed to set the configure.\r
  //\r
  if (EFI_ERROR (Status) && Reconfig) {\r
    IpSb->MnpConfigData.EnablePromiscuousReceive = (BOOLEAN) !PromiscReceive;\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Intiialize the IP4_PROTOCOL structure to the unconfigured states.\r
\r
  @param  IpSb                   The IP4 service instance.\r
  @param  IpInstance             The IP4 child instance.\r
\r
**/\r
VOID\r
Ip4InitProtocol (\r
  IN     IP4_SERVICE            *IpSb,\r
  IN OUT IP4_PROTOCOL           *IpInstance\r
  )\r
{\r
  ASSERT ((IpSb != NULL) && (IpInstance != NULL));\r
\r
  ZeroMem (IpInstance, sizeof (IP4_PROTOCOL));\r
\r
  IpInstance->Signature = IP4_PROTOCOL_SIGNATURE;\r
  CopyMem (&IpInstance->Ip4Proto, &mEfiIp4ProtocolTemplete, sizeof (IpInstance->Ip4Proto));\r
  IpInstance->State     = IP4_STATE_UNCONFIGED;\r
  IpInstance->InDestroy   = FALSE;\r
  IpInstance->Service   = IpSb;\r
\r
  InitializeListHead (&IpInstance->Link);\r
  NetMapInit  (&IpInstance->RxTokens);\r
  NetMapInit  (&IpInstance->TxTokens);\r
  InitializeListHead (&IpInstance->Received);\r
  InitializeListHead (&IpInstance->Delivered);\r
  InitializeListHead (&IpInstance->AddrLink);\r
\r
  EfiInitializeLock (&IpInstance->RecycleLock, TPL_NOTIFY);\r
}\r
\r
\r
/**\r
  Configure the IP4 child. If the child is already configured,\r
  change the configuration parameter. Otherwise configure it\r
  for the first time. The caller should validate the configuration\r
  before deliver them to it. It also don't do configure NULL.\r
\r
  @param[in, out]  IpInstance         The IP4 child to configure.\r
  @param[in]       Config             The configure data.\r
\r
  @retval EFI_SUCCESS            The IP4 child is successfully configured.\r
  @retval EFI_DEVICE_ERROR       Failed to free the pending transive or to\r
                                 configure  underlying MNP or other errors.\r
  @retval EFI_NO_MAPPING         The IP4 child is configured to use default\r
                                 address, but the default address hasn't been\r
                                 configured. The IP4 child doesn't need to be\r
                                 reconfigured when default address is configured.\r
  @retval EFI_OUT_OF_RESOURCES   No more memory space is available.\r
  @retval other                  Other error occurs.\r
\r
**/\r
EFI_STATUS\r
Ip4ConfigProtocol (\r
  IN OUT IP4_PROTOCOL         *IpInstance,\r
  IN     EFI_IP4_CONFIG_DATA  *Config\r
  )\r
{\r
  IP4_SERVICE               *IpSb;\r
  IP4_INTERFACE             *IpIf;\r
  EFI_STATUS                Status;\r
  IP4_ADDR                  Ip;\r
  IP4_ADDR                  Netmask;\r
  EFI_ARP_PROTOCOL          *Arp;\r
  EFI_IP4_CONFIG2_PROTOCOL  *Ip4Config2;\r
  EFI_IP4_CONFIG2_POLICY    Policy;\r
\r
  IpSb = IpInstance->Service;\r
\r
  Ip4Config2  = NULL;\r
\r
  //\r
  // User is changing packet filters. It must be stopped\r
  // before the station address can be changed.\r
  //\r
  if (IpInstance->State == IP4_STATE_CONFIGED) {\r
    //\r
    // Cancel all the pending transmit/receive from upper layer\r
    //\r
    Status = Ip4Cancel (IpInstance, NULL);\r
\r
    if (EFI_ERROR (Status)) {\r
      return EFI_DEVICE_ERROR;\r
    }\r
\r
    CopyMem (&IpInstance->ConfigData, Config, sizeof (IpInstance->ConfigData));\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Configure a fresh IP4 protocol instance. Create a route table.\r
  // Each IP child has its own route table, which may point to the\r
  // default table if it is using default address.\r
  //\r
  Status                 = EFI_OUT_OF_RESOURCES;\r
  IpInstance->RouteTable = Ip4CreateRouteTable ();\r
\r
  if (IpInstance->RouteTable == NULL) {\r
    return Status;\r
  }\r
\r
  //\r
  // Set up the interface.\r
  //\r
  CopyMem (&Ip, &Config->StationAddress, sizeof (IP4_ADDR));\r
  CopyMem (&Netmask, &Config->SubnetMask, sizeof (IP4_ADDR));\r
\r
  Ip      = NTOHL (Ip);\r
  Netmask = NTOHL (Netmask);\r
\r
  if (!Config->UseDefaultAddress) {\r
    //\r
    // Find whether there is already an interface with the same\r
    // station address. All the instances with the same station\r
    // address shares one interface.\r
    //\r
    IpIf = Ip4FindStationAddress (IpSb, Ip, Netmask);\r
\r
    if (IpIf != NULL) {\r
      NET_GET_REF (IpIf);\r
\r
    } else {\r
      IpIf = Ip4CreateInterface (IpSb->Mnp, IpSb->Controller, IpSb->Image);\r
\r
      if (IpIf == NULL) {\r
        goto ON_ERROR;\r
      }\r
\r
      Status = Ip4SetAddress (IpIf, Ip, Netmask);\r
\r
      if (EFI_ERROR (Status)) {\r
        Status = EFI_DEVICE_ERROR;\r
        Ip4FreeInterface (IpIf, IpInstance);\r
        goto ON_ERROR;\r
      }\r
\r
      InsertTailList (&IpSb->Interfaces, &IpIf->Link);\r
    }\r
\r
    //\r
    // Add a route to this connected network in the route table\r
    //\r
    Ip4AddRoute (IpInstance->RouteTable, Ip, Netmask, IP4_ALLZERO_ADDRESS);\r
\r
  } else {\r
    //\r
    // Use the default address. Check the state.\r
    //\r
    if (IpSb->State == IP4_SERVICE_UNSTARTED) {\r
      //\r
      // Trigger the EFI_IP4_CONFIG2_PROTOCOL to retrieve the \r
      // default IPv4 address if it is not available yet.\r
      //\r
      Policy = IpSb->Ip4Config2Instance.Policy;\r
      if (Policy != Ip4Config2PolicyDhcp) {\r
        Ip4Config2 = &IpSb->Ip4Config2Instance.Ip4Config2;\r
        Policy = Ip4Config2PolicyDhcp;\r
        Status= Ip4Config2->SetData (\r
                              Ip4Config2,\r
                              Ip4Config2DataTypePolicy,\r
                              sizeof (EFI_IP4_CONFIG2_POLICY),\r
                              &Policy\r
                              );\r
        if (EFI_ERROR (Status)) {\r
          goto ON_ERROR;\r
        }\r
      }\r
    }\r
\r
    IpIf = IpSb->DefaultInterface;\r
    NET_GET_REF (IpSb->DefaultInterface);\r
\r
    //\r
    // If default address is used, so is the default route table.\r
    // Any route set by the instance has the precedence over the\r
    // routes in the default route table. Link the default table\r
    // after the instance's table. Routing will search the local\r
    // table first.\r
    //\r
    NET_GET_REF (IpSb->DefaultRouteTable);\r
    IpInstance->RouteTable->Next = IpSb->DefaultRouteTable;\r
  }\r
\r
  IpInstance->Interface = IpIf;\r
  if (IpIf->Arp != NULL) {\r
    Arp = NULL;\r
    Status = gBS->OpenProtocol (\r
                    IpIf->ArpHandle,\r
                    &gEfiArpProtocolGuid,\r
                    (VOID **) &Arp,\r
                    gIp4DriverBinding.DriverBindingHandle,\r
                    IpInstance->Handle,\r
                    EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r
                    );\r
    if (EFI_ERROR (Status)) {\r
      goto ON_ERROR;\r
    }\r
  }\r
  InsertTailList (&IpIf->IpInstances, &IpInstance->AddrLink);\r
\r
  CopyMem (&IpInstance->ConfigData, Config, sizeof (IpInstance->ConfigData));\r
  IpInstance->State       = IP4_STATE_CONFIGED;\r
\r
  //\r
  // Although EFI_NO_MAPPING is an error code, the IP child has been\r
  // successfully configured and doesn't need reconfiguration when\r
  // default address is acquired.\r
  //\r
  if (Config->UseDefaultAddress && IP4_NO_MAPPING (IpInstance)) {\r
    return EFI_NO_MAPPING;\r
  }\r
\r
  return EFI_SUCCESS;\r
\r
ON_ERROR:\r
  Ip4FreeRouteTable (IpInstance->RouteTable);\r
  IpInstance->RouteTable = NULL;\r
  return Status;\r
}\r
\r
\r
/**\r
  Clean up the IP4 child, release all the resources used by it.\r
\r
  @param[in]  IpInstance         The IP4 child to clean up.\r
\r
  @retval EFI_SUCCESS            The IP4 child is cleaned up.\r
  @retval EFI_DEVICE_ERROR       Some resources failed to be released.\r
\r
**/\r
EFI_STATUS\r
Ip4CleanProtocol (\r
  IN  IP4_PROTOCOL          *IpInstance\r
  )\r
{\r
  if (EFI_ERROR (Ip4Cancel (IpInstance, NULL))) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  if (EFI_ERROR (Ip4Groups (IpInstance, FALSE, NULL))) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  //\r
  // Some packets haven't been recycled. It is because either the\r
  // user forgets to recycle the packets, or because the callback\r
  // hasn't been called. Just leave it alone.\r
  //\r
  if (!IsListEmpty (&IpInstance->Delivered)) {\r
    ;\r
  }\r
\r
  if (IpInstance->Interface != NULL) {\r
    RemoveEntryList (&IpInstance->AddrLink);\r
    if (IpInstance->Interface->Arp != NULL) {\r
      gBS->CloseProtocol (\r
             IpInstance->Interface->ArpHandle,\r
             &gEfiArpProtocolGuid,\r
             gIp4DriverBinding.DriverBindingHandle,\r
             IpInstance->Handle\r
             );\r
    }\r
    Ip4FreeInterface (IpInstance->Interface, IpInstance);\r
    IpInstance->Interface = NULL;\r
  }\r
\r
  if (IpInstance->RouteTable != NULL) {\r
    if (IpInstance->RouteTable->Next != NULL) {\r
      Ip4FreeRouteTable (IpInstance->RouteTable->Next);\r
    }\r
\r
    Ip4FreeRouteTable (IpInstance->RouteTable);\r
    IpInstance->RouteTable = NULL;\r
  }\r
\r
  if (IpInstance->EfiRouteTable != NULL) {\r
    FreePool (IpInstance->EfiRouteTable);\r
    IpInstance->EfiRouteTable = NULL;\r
    IpInstance->EfiRouteCount = 0;\r
  }\r
\r
  if (IpInstance->Groups != NULL) {\r
    FreePool (IpInstance->Groups);\r
    IpInstance->Groups      = NULL;\r
    IpInstance->GroupCount  = 0;\r
  }\r
\r
  NetMapClean (&IpInstance->TxTokens);\r
\r
  NetMapClean (&IpInstance->RxTokens);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Assigns an IPv4 address and subnet mask to this EFI IPv4 Protocol driver instance.\r
\r
  The Configure() function is used to set, change, or reset the operational\r
  parameters and filter settings for this EFI IPv4 Protocol instance. Until these\r
  parameters have been set, no network traffic can be sent or received by this\r
  instance. Once the parameters have been reset (by calling this function with\r
  IpConfigData set to NULL), no more traffic can be sent or received until these\r
  parameters have been set again. Each EFI IPv4 Protocol instance can be started\r
  and stopped independently of each other by enabling or disabling their receive\r
  filter settings with the Configure() function.\r
\r
  When IpConfigData.UseDefaultAddress is set to FALSE, the new station address will\r
  be appended as an alias address into the addresses list in the EFI IPv4 Protocol\r
  driver. While set to TRUE, Configure() will trigger the EFI_IP4_CONFIG_PROTOCOL\r
  to retrieve the default IPv4 address if it is not available yet. Clients could\r
  frequently call GetModeData() to check the status to ensure that the default IPv4\r
  address is ready.\r
\r
  If operational parameters are reset or changed, any pending transmit and receive\r
  requests will be cancelled. Their completion token status will be set to EFI_ABORTED\r
  and their events will be signaled.\r
\r
  @param[in]  This              Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  IpConfigData      Pointer to the EFI IPv4 Protocol configuration data structure.\r
\r
  @retval EFI_SUCCESS           The driver instance was successfully opened.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                RARP, etc.) is not finished yet.\r
  @retval EFI_INVALID_PARAMETER One or more of the following conditions is TRUE:\r
  @retval EFI_UNSUPPORTED       One or more of the following conditions is TRUE:\r
                                A configuration protocol (DHCP, BOOTP, RARP, etc.) could\r
                                not be located when clients choose to use the default IPv4\r
                                address. This EFI IPv4 Protocol implementation does not\r
                                support this requested filter or timeout setting.\r
  @retval EFI_OUT_OF_RESOURCES  The EFI IPv4 Protocol driver instance data could not be allocated.\r
  @retval EFI_ALREADY_STARTED   The interface is already open and must be stopped before the\r
                                IPv4 address or subnet mask can be changed. The interface must\r
                                also be stopped when switching to/from raw packet mode.\r
  @retval EFI_DEVICE_ERROR      An unexpected system or network error occurred. The EFI IPv4\r
                                Protocol driver instance is not opened.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Configure (\r
  IN EFI_IP4_PROTOCOL       *This,\r
  IN EFI_IP4_CONFIG_DATA    *IpConfigData       OPTIONAL\r
  )\r
{\r
  IP4_PROTOCOL              *IpInstance;\r
  EFI_IP4_CONFIG_DATA       *Current;\r
  EFI_TPL                   OldTpl;\r
  EFI_STATUS                Status;\r
  BOOLEAN                   AddrOk;\r
  IP4_ADDR                  IpAddress;\r
  IP4_ADDR                  SubnetMask;\r
\r
  //\r
  // First, validate the parameters\r
  //\r
  if (This == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
  OldTpl     = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  //\r
  // Validate the configuration first.\r
  //\r
  if (IpConfigData != NULL) {\r
\r
    CopyMem (&IpAddress, &IpConfigData->StationAddress, sizeof (IP4_ADDR));\r
    CopyMem (&SubnetMask, &IpConfigData->SubnetMask, sizeof (IP4_ADDR));\r
\r
    IpAddress  = NTOHL (IpAddress);\r
    SubnetMask = NTOHL (SubnetMask);\r
\r
    //\r
    // Check whether the station address is a valid unicast address\r
    //\r
    if (!IpConfigData->UseDefaultAddress) {\r
      AddrOk = Ip4StationAddressValid (IpAddress, SubnetMask);\r
\r
      if (!AddrOk) {\r
        Status = EFI_INVALID_PARAMETER;\r
        goto ON_EXIT;\r
      }\r
    }\r
\r
    //\r
    // User can only update packet filters when already configured.\r
    // If it wants to change the station address, it must configure(NULL)\r
    // the instance first.\r
    //\r
    if (IpInstance->State == IP4_STATE_CONFIGED) {\r
      Current = &IpInstance->ConfigData;\r
\r
      if (Current->UseDefaultAddress != IpConfigData->UseDefaultAddress) {\r
        Status = EFI_ALREADY_STARTED;\r
        goto ON_EXIT;\r
      }\r
\r
      if (!Current->UseDefaultAddress &&\r
         (!EFI_IP4_EQUAL (&Current->StationAddress, &IpConfigData->StationAddress) ||\r
          !EFI_IP4_EQUAL (&Current->SubnetMask, &IpConfigData->SubnetMask))) {\r
        Status = EFI_ALREADY_STARTED;\r
        goto ON_EXIT;\r
      }\r
\r
      if (Current->UseDefaultAddress && IP4_NO_MAPPING (IpInstance)) {\r
        Status = EFI_NO_MAPPING;\r
        goto ON_EXIT;\r
      }\r
    }\r
  }\r
\r
  //\r
  // Configure the instance or clean it up.\r
  //\r
  if (IpConfigData != NULL) {\r
    Status = Ip4ConfigProtocol (IpInstance, IpConfigData);\r
  } else {\r
    Status = Ip4CleanProtocol (IpInstance);\r
\r
    //\r
    // Consider the following valid sequence: Mnp is unloaded-->Ip Stopped-->Udp Stopped,\r
    // Configure (ThisIp, NULL). If the state is changed to UNCONFIGED,\r
    // the unload fails miserably.\r
    //\r
    if (IpInstance->State == IP4_STATE_CONFIGED) {\r
      IpInstance->State = IP4_STATE_UNCONFIGED;\r
    }\r
  }\r
\r
  //\r
  // Update the MNP's configure data. Ip4ServiceConfigMnp will check\r
  // whether it is necessary to reconfigure the MNP.\r
  //\r
  Ip4ServiceConfigMnp (IpInstance->Service, FALSE);\r
\r
ON_EXIT:\r
  gBS->RestoreTPL (OldTpl);\r
  return Status;\r
\r
}\r
\r
\r
/**\r
  Change the IP4 child's multicast setting. The caller\r
  should make sure that the parameters is valid.\r
\r
  @param[in]  IpInstance             The IP4 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.\r
\r
  @retval EFI_ALREADY_STARTED    Want to join the group, but already a member of it.\r
  @retval EFI_OUT_OF_RESOURCES   Failed to allocate some 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
Ip4Groups (\r
  IN IP4_PROTOCOL           *IpInstance,\r
  IN BOOLEAN                JoinFlag,\r
  IN EFI_IPv4_ADDRESS       *GroupAddress       OPTIONAL\r
  )\r
{\r
  IP4_ADDR                  *Members;\r
  IP4_ADDR                  Group;\r
  UINT32                    Index;\r
\r
  //\r
  // Add it to the instance's Groups, and join the group by IGMP.\r
  // IpInstance->Groups is in network byte order. IGMP operates in\r
  // host byte order\r
  //\r
  if (JoinFlag) {\r
    //\r
    // When JoinFlag is TRUE, GroupAddress shouldn't be NULL.\r
    //\r
    ASSERT (GroupAddress != NULL);\r
    CopyMem (&Group, GroupAddress, sizeof (IP4_ADDR));\r
\r
    for (Index = 0; Index < IpInstance->GroupCount; Index++) {\r
      if (IpInstance->Groups[Index] == Group) {\r
        return EFI_ALREADY_STARTED;\r
      }\r
    }\r
\r
    Members = Ip4CombineGroups (IpInstance->Groups, IpInstance->GroupCount, Group);\r
\r
    if (Members == NULL) {\r
      return EFI_OUT_OF_RESOURCES;\r
    }\r
\r
    if (EFI_ERROR (Ip4JoinGroup (IpInstance, NTOHL (Group)))) {\r
      FreePool (Members);\r
      return EFI_DEVICE_ERROR;\r
    }\r
\r
    if (IpInstance->Groups != NULL) {\r
      FreePool (IpInstance->Groups);\r
    }\r
\r
    IpInstance->Groups = Members;\r
    IpInstance->GroupCount++;\r
\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Leave the group. Leave all the groups if GroupAddress is NULL.\r
  // Must iterate from the end to the beginning because the GroupCount\r
  // is decreamented each time an address is removed..\r
  //\r
  for (Index = IpInstance->GroupCount; Index > 0 ; Index--) {\r
    Group = IpInstance->Groups[Index - 1];\r
\r
    if ((GroupAddress == NULL) || EFI_IP4_EQUAL (&Group, GroupAddress)) {\r
      if (EFI_ERROR (Ip4LeaveGroup (IpInstance, NTOHL (Group)))) {\r
        return EFI_DEVICE_ERROR;\r
      }\r
\r
      Ip4RemoveGroupAddr (IpInstance->Groups, IpInstance->GroupCount, Group);\r
      IpInstance->GroupCount--;\r
\r
      if (IpInstance->GroupCount == 0) {\r
        ASSERT (Index == 1);\r
\r
        FreePool (IpInstance->Groups);\r
        IpInstance->Groups = 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
/**\r
  Joins and leaves multicast groups.\r
\r
  The Groups() function is used to join and leave multicast group sessions. Joining\r
  a group will enable reception of matching multicast packets. Leaving a group will\r
  disable the multicast packet reception.\r
\r
  If JoinFlag is FALSE and GroupAddress is NULL, all joined groups will be left.\r
\r
  @param[in]  This                  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  JoinFlag              Set to TRUE to join the multicast group session and FALSE to leave.\r
  @param[in]  GroupAddress          Pointer to the IPv4 multicast address.\r
\r
  @retval EFI_SUCCESS           The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER One or more of the following is TRUE:\r
                                - This is NULL.\r
                                - JoinFlag is TRUE and GroupAddress is NULL.\r
                                - GroupAddress is not NULL and *GroupAddress is\r
                                not a multicast IPv4 address.\r
  @retval EFI_NOT_STARTED       This instance has not been started.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                RARP, etc.) is not finished yet.\r
  @retval EFI_OUT_OF_RESOURCES  System resources could not be allocated.\r
  @retval EFI_UNSUPPORTED       This EFI IPv4 Protocol implementation does not support multicast groups.\r
  @retval EFI_ALREADY_STARTED   The group address is already in the group table (when\r
                                JoinFlag is TRUE).\r
  @retval EFI_NOT_FOUND         The group address is not in the group table (when JoinFlag is FALSE).\r
  @retval EFI_DEVICE_ERROR      An unexpected system or network error occurred.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Groups (\r
  IN EFI_IP4_PROTOCOL       *This,\r
  IN BOOLEAN                JoinFlag,\r
  IN EFI_IPv4_ADDRESS       *GroupAddress     OPTIONAL\r
  )\r
{\r
  IP4_PROTOCOL              *IpInstance;\r
  EFI_STATUS                Status;\r
  EFI_TPL                   OldTpl;\r
  IP4_ADDR                  McastIp;\r
\r
  if ((This == NULL) || (JoinFlag && (GroupAddress == NULL))) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (GroupAddress != NULL) {\r
    CopyMem (&McastIp, GroupAddress, sizeof (IP4_ADDR));\r
\r
    if (!IP4_IS_MULTICAST (NTOHL (McastIp))) {\r
      return EFI_INVALID_PARAMETER;\r
    }\r
  }\r
\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
  OldTpl     = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  if (IpInstance->State != IP4_STATE_CONFIGED) {\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  if (IpInstance->ConfigData.UseDefaultAddress && IP4_NO_MAPPING (IpInstance)) {\r
    Status = EFI_NO_MAPPING;\r
    goto ON_EXIT;\r
  }\r
\r
  Status = Ip4Groups (IpInstance, JoinFlag, GroupAddress);\r
\r
ON_EXIT:\r
  gBS->RestoreTPL (OldTpl);\r
  return Status;\r
}\r
\r
\r
/**\r
  Adds and deletes routing table entries.\r
\r
  The Routes() function adds a route to or deletes a route from the routing table.\r
\r
  Routes are determined by comparing the SubnetAddress with the destination IPv4\r
  address arithmetically AND-ed with the SubnetMask. The gateway address must be\r
  on the same subnet as the configured station address.\r
\r
  The default route is added with SubnetAddress and SubnetMask both set to 0.0.0.0.\r
  The default route matches all destination IPv4 addresses that do not match any\r
  other routes.\r
\r
  A GatewayAddress that is zero is a nonroute. Packets are sent to the destination\r
  IP address if it can be found in the ARP cache or on the local subnet. One automatic\r
  nonroute entry will be inserted into the routing table for outgoing packets that\r
  are addressed to a local subnet (gateway address of 0.0.0.0).\r
\r
  Each EFI IPv4 Protocol instance has its own independent routing table. Those EFI\r
  IPv4 Protocol instances that use the default IPv4 address will also have copies\r
  of the routing table that was provided by the EFI_IP4_CONFIG_PROTOCOL, and these\r
  copies will be updated whenever the EIF IPv4 Protocol driver reconfigures its\r
  instances. As a result, client modification to the routing table will be lost.\r
\r
  @param[in]  This                   Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  DeleteRoute            Set to TRUE to delete this route from the routing table. Set to\r
                                     FALSE to add this route to the routing table. SubnetAddress\r
                                     and SubnetMask are used as the key to each route entry.\r
  @param[in]  SubnetAddress          The address of the subnet that needs to be routed.\r
  @param[in]  SubnetMask             The subnet mask of SubnetAddress.\r
  @param[in]  GatewayAddress         The unicast gateway IPv4 address for this route.\r
\r
  @retval EFI_SUCCESS            The operation completed successfully.\r
  @retval EFI_NOT_STARTED        The driver instance has not been started.\r
  @retval EFI_NO_MAPPING         When using the default address, configuration (DHCP, BOOTP,\r
                                 RARP, etc.) is not finished yet.\r
  @retval EFI_INVALID_PARAMETER  One or more of the following conditions is TRUE:\r
                                 - This is NULL.\r
                                 - SubnetAddress is NULL.\r
                                 - SubnetMask is NULL.\r
                                 - GatewayAddress is NULL.\r
                                 - *SubnetAddress is not a valid subnet address.\r
                                 - *SubnetMask is not a valid subnet mask.\r
                                 - *GatewayAddress is not a valid unicast IPv4 address.\r
  @retval EFI_OUT_OF_RESOURCES   Could not add the entry to the routing table.\r
  @retval EFI_NOT_FOUND          This route is not in the routing table (when DeleteRoute is TRUE).\r
  @retval EFI_ACCESS_DENIED      The route is already defined in the routing table (when\r
                                  DeleteRoute is FALSE).\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Routes (\r
  IN EFI_IP4_PROTOCOL       *This,\r
  IN BOOLEAN                DeleteRoute,\r
  IN EFI_IPv4_ADDRESS       *SubnetAddress,\r
  IN EFI_IPv4_ADDRESS       *SubnetMask,\r
  IN EFI_IPv4_ADDRESS       *GatewayAddress\r
  )\r
{\r
  IP4_PROTOCOL              *IpInstance;\r
  IP4_INTERFACE             *IpIf;\r
  IP4_ADDR                  Dest;\r
  IP4_ADDR                  Netmask;\r
  IP4_ADDR                  Nexthop;\r
  EFI_STATUS                Status;\r
  EFI_TPL                   OldTpl;\r
\r
  //\r
  // First, validate the parameters\r
  //\r
  if ((This == NULL) || (SubnetAddress == NULL) ||\r
      (SubnetMask == NULL) || (GatewayAddress == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
  OldTpl     = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  if (IpInstance->State != IP4_STATE_CONFIGED) {\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  if (IpInstance->ConfigData.UseDefaultAddress && IP4_NO_MAPPING (IpInstance)) {\r
    Status = EFI_NO_MAPPING;\r
    goto ON_EXIT;\r
  }\r
\r
  CopyMem (&Dest, SubnetAddress, sizeof (IP4_ADDR));\r
  CopyMem (&Netmask, SubnetMask, sizeof (IP4_ADDR));\r
  CopyMem (&Nexthop, GatewayAddress, sizeof (IP4_ADDR));\r
\r
  Dest    = NTOHL (Dest);\r
  Netmask = NTOHL (Netmask);\r
  Nexthop = NTOHL (Nexthop);\r
\r
  IpIf    = IpInstance->Interface;\r
\r
  if (!IP4_IS_VALID_NETMASK (Netmask)) {\r
    Status = EFI_INVALID_PARAMETER;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // the gateway address must be a unicast on the connected network if not zero.\r
  //\r
  if ((Nexthop != IP4_ALLZERO_ADDRESS) &&\r
      (!IP4_NET_EQUAL (Nexthop, IpIf->Ip, IpIf->SubnetMask) ||\r
        IP4_IS_BROADCAST (Ip4GetNetCast (Nexthop, IpIf)))) {\r
\r
    Status = EFI_INVALID_PARAMETER;\r
    goto ON_EXIT;\r
  }\r
\r
  if (DeleteRoute) {\r
    Status = Ip4DelRoute (IpInstance->RouteTable, Dest, Netmask, Nexthop);\r
  } else {\r
    Status = Ip4AddRoute (IpInstance->RouteTable, Dest, Netmask, Nexthop);\r
  }\r
\r
ON_EXIT:\r
  gBS->RestoreTPL (OldTpl);\r
  return Status;\r
}\r
\r
\r
/**\r
  Check whether the user's token or event has already\r
  been enqueued on IP4's list.\r
\r
  @param[in]  Map                    The container of either user's transmit or receive\r
                                     token.\r
  @param[in]  Item                   Current item to check against.\r
  @param[in]  Context                The Token to check againist.\r
\r
  @retval EFI_ACCESS_DENIED      The token or event has already been enqueued in IP.\r
  @retval EFI_SUCCESS            The current item isn't the same token/event as the\r
                                 context.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip4TokenExist (\r
  IN NET_MAP                *Map,\r
  IN NET_MAP_ITEM           *Item,\r
  IN VOID                   *Context\r
  )\r
{\r
  EFI_IP4_COMPLETION_TOKEN  *Token;\r
  EFI_IP4_COMPLETION_TOKEN  *TokenInItem;\r
\r
  Token       = (EFI_IP4_COMPLETION_TOKEN *) Context;\r
  TokenInItem = (EFI_IP4_COMPLETION_TOKEN *) Item->Key;\r
\r
  if ((Token == TokenInItem) || (Token->Event == TokenInItem->Event)) {\r
    return EFI_ACCESS_DENIED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Validate the user's token against current station address.\r
\r
  @param[in]  Token              User's token to validate.\r
  @param[in]  IpIf               The IP4 child's interface.\r
  @param[in]  RawData            Set to TRUE to send unformatted packets.\r
\r
  @retval EFI_INVALID_PARAMETER  Some parameters are invalid.\r
  @retval EFI_BAD_BUFFER_SIZE    The user's option/data is too long.\r
  @retval EFI_SUCCESS            The token is valid.\r
\r
**/\r
EFI_STATUS\r
Ip4TxTokenValid (\r
  IN EFI_IP4_COMPLETION_TOKEN   *Token,\r
  IN IP4_INTERFACE              *IpIf,\r
  IN BOOLEAN                    RawData\r
  )\r
{\r
  EFI_IP4_TRANSMIT_DATA     *TxData;\r
  EFI_IP4_OVERRIDE_DATA     *Override;\r
  IP4_ADDR                  Src;\r
  IP4_ADDR                  Gateway;\r
  UINT32                    Offset;\r
  UINT32                    Index;\r
  UINT32                    HeadLen;\r
\r
  if ((Token == NULL) || (Token->Event == NULL) || (Token->Packet.TxData == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  TxData = Token->Packet.TxData;\r
\r
  //\r
  // Check the fragment table: no empty fragment, and length isn't bogus.\r
  //\r
  if ((TxData->TotalDataLength == 0) || (TxData->FragmentCount == 0)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Offset = TxData->TotalDataLength;\r
\r
  if (Offset > IP4_MAX_PACKET_SIZE) {\r
    return EFI_BAD_BUFFER_SIZE;\r
  }\r
\r
  for (Index = 0; Index < TxData->FragmentCount; Index++) {\r
    if ((TxData->FragmentTable[Index].FragmentBuffer == NULL) ||\r
        (TxData->FragmentTable[Index].FragmentLength == 0)) {\r
\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    Offset -= TxData->FragmentTable[Index].FragmentLength;\r
  }\r
\r
  if (Offset != 0) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // NOTE that OptionsLength/OptionsBuffer/OverrideData are ignored if RawData\r
  // is TRUE.\r
  //\r
  if (RawData) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Check the IP options: no more than 40 bytes and format is OK\r
  //\r
  if (TxData->OptionsLength != 0) {\r
    if ((TxData->OptionsLength > 40) || (TxData->OptionsBuffer == NULL)) {\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    if (!Ip4OptionIsValid (TxData->OptionsBuffer, TxData->OptionsLength, FALSE)) {\r
      return EFI_INVALID_PARAMETER;\r
    }\r
  }\r
\r
  //\r
  // Check the source and gateway: they must be a valid unicast.\r
  // Gateway must also be on the connected network.\r
  //\r
  if (TxData->OverrideData != NULL) {\r
    Override = TxData->OverrideData;\r
\r
    CopyMem (&Src, &Override->SourceAddress, sizeof (IP4_ADDR));\r
    CopyMem (&Gateway, &Override->GatewayAddress, sizeof (IP4_ADDR));\r
\r
    Src     = NTOHL (Src);\r
    Gateway = NTOHL (Gateway);\r
\r
    if ((NetGetIpClass (Src) > IP4_ADDR_CLASSC) ||\r
        (Src == IP4_ALLONE_ADDRESS) ||\r
        IP4_IS_BROADCAST (Ip4GetNetCast (Src, IpIf))) {\r
\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    //\r
    // If gateway isn't zero, it must be a unicast address, and\r
    // on the connected network.\r
    //\r
    if ((Gateway != IP4_ALLZERO_ADDRESS) &&\r
        ((NetGetIpClass (Gateway) > IP4_ADDR_CLASSC) ||\r
         !IP4_NET_EQUAL (Gateway, IpIf->Ip, IpIf->SubnetMask) ||\r
         IP4_IS_BROADCAST (Ip4GetNetCast (Gateway, IpIf)))) {\r
\r
      return EFI_INVALID_PARAMETER;\r
    }\r
  }\r
\r
  //\r
  // Check the packet length: Head length and packet length all has a limit\r
  //\r
  HeadLen = sizeof (IP4_HEAD) + ((TxData->OptionsLength + 3) &~0x03);\r
\r
  if ((HeadLen > IP4_MAX_HEADLEN) ||\r
      (TxData->TotalDataLength + HeadLen > IP4_MAX_PACKET_SIZE)) {\r
\r
    return EFI_BAD_BUFFER_SIZE;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  The callback function for the net buffer which wraps the user's\r
  transmit token. Although it seems this function is pretty simple,\r
  there are some subtle things.\r
  When user requests the IP to transmit a packet by passing it a\r
  token, the token is wrapped in an IP4_TXTOKEN_WRAP and the data\r
  is wrapped in an net buffer. the net buffer's Free function is\r
  set to Ip4FreeTxToken. The Token and token wrap are added to the\r
  IP child's TxToken map. Then the buffer is passed to Ip4Output for\r
  transmission. If something error happened before that, the buffer\r
  is freed, which in turn will free the token wrap. The wrap may\r
  have been added to the TxToken map or not, and the user's event\r
  shouldn't be fired because we are still in the EfiIp4Transmit. If\r
  the buffer has been sent by Ip4Output, it should be removed from\r
  the TxToken map and user's event signaled. The token wrap and buffer\r
  are bound together. Check the comments in Ip4Output for information\r
  about IP fragmentation.\r
\r
  @param[in]  Context                The token's wrap.\r
\r
**/\r
VOID\r
EFIAPI\r
Ip4FreeTxToken (\r
  IN VOID                   *Context\r
  )\r
{\r
  IP4_TXTOKEN_WRAP          *Wrap;\r
  NET_MAP_ITEM              *Item;\r
\r
  Wrap = (IP4_TXTOKEN_WRAP *) Context;\r
\r
  //\r
  // Signal IpSecRecycleEvent to inform IPsec free the memory\r
  //\r
  if (Wrap->IpSecRecycleSignal != NULL) {\r
    gBS->SignalEvent (Wrap->IpSecRecycleSignal);\r
  }\r
\r
  //\r
  // Find the token in the instance's map. EfiIp4Transmit put the\r
  // token to the map. If that failed, NetMapFindKey will return NULL.\r
  //\r
  Item = NetMapFindKey (&Wrap->IpInstance->TxTokens, Wrap->Token);\r
\r
  if (Item != NULL) {\r
    NetMapRemoveItem (&Wrap->IpInstance->TxTokens, Item, NULL);\r
  }\r
\r
  if (Wrap->Sent) {\r
    gBS->SignalEvent (Wrap->Token->Event);\r
\r
    //\r
    // Dispatch the DPC queued by the NotifyFunction of Token->Event.\r
    //\r
    DispatchDpc ();\r
  }\r
\r
  FreePool (Wrap);\r
}\r
\r
\r
/**\r
  The callback function to Ip4Output to update the transmit status.\r
\r
  @param  Ip4Instance            The Ip4Instance that request the transmit.\r
  @param  Packet                 The user's transmit request.\r
  @param  IoStatus               The result of the transmission.\r
  @param  Flag                   Not used during transmission.\r
  @param  Context                The token's wrap.\r
\r
**/\r
VOID\r
Ip4OnPacketSent (\r
  IP4_PROTOCOL              *Ip4Instance,\r
  NET_BUF                   *Packet,\r
  EFI_STATUS                IoStatus,\r
  UINT32                    Flag,\r
  VOID                      *Context\r
  )\r
{\r
  IP4_TXTOKEN_WRAP          *Wrap;\r
\r
  //\r
  // This is the transmission request from upper layer,\r
  // not the IP4 driver itself.\r
  //\r
  ASSERT (Ip4Instance != NULL);\r
\r
  //\r
  // The first fragment of the packet has been sent. Update\r
  // the token's status. That is, if fragmented, the transmit's\r
  // status is the first fragment's status. The Wrap will be\r
  // release when all the fragments are release. Check the comments\r
  // in Ip4FreeTxToken and Ip4Output for information.\r
  //\r
  Wrap                = (IP4_TXTOKEN_WRAP *) Context;\r
  Wrap->Token->Status = IoStatus;\r
\r
  NetbufFree (Wrap->Packet);\r
}\r
\r
\r
/**\r
  Places outgoing data packets into the transmit queue.\r
\r
  The Transmit() function places a sending request in the transmit queue of this\r
  EFI IPv4 Protocol instance. Whenever the packet in the token is sent out or some\r
  errors occur, the event in the token will be signaled and the status is updated.\r
\r
  @param[in]  This  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  Token Pointer to the transmit token.\r
\r
  @retval  EFI_SUCCESS           The data has been queued for transmission.\r
  @retval  EFI_NOT_STARTED       This instance has not been started.\r
  @retval  EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                 RARP, etc.) is not finished yet.\r
  @retval  EFI_INVALID_PARAMETER One or more pameters are invalid.\r
  @retval  EFI_ACCESS_DENIED     The transmit completion token with the same Token.Event\r
                                 was already in the transmit queue.\r
  @retval  EFI_NOT_READY         The completion token could not be queued because the transmit\r
                                 queue is full.\r
  @retval  EFI_NOT_FOUND         Not route is found to destination address.\r
  @retval  EFI_OUT_OF_RESOURCES  Could not queue the transmit data.\r
  @retval  EFI_BUFFER_TOO_SMALL  Token.Packet.TxData.TotalDataLength is too\r
                                 short to transmit.\r
  @retval  EFI_BAD_BUFFER_SIZE   The length of the IPv4 header + option length + total data length is\r
                                 greater than MTU (or greater than the maximum packet size if\r
                                 Token.Packet.TxData.OverrideData.\r
                                 DoNotFragment is TRUE).\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Transmit (\r
  IN EFI_IP4_PROTOCOL         *This,\r
  IN EFI_IP4_COMPLETION_TOKEN *Token\r
  )\r
{\r
  IP4_SERVICE               *IpSb;\r
  IP4_PROTOCOL              *IpInstance;\r
  IP4_INTERFACE             *IpIf;\r
  IP4_TXTOKEN_WRAP          *Wrap;\r
  EFI_IP4_TRANSMIT_DATA     *TxData;\r
  EFI_IP4_CONFIG_DATA       *Config;\r
  EFI_IP4_OVERRIDE_DATA     *Override;\r
  IP4_HEAD                  Head;\r
  IP4_ADDR                  GateWay;\r
  EFI_STATUS                Status;\r
  EFI_TPL                   OldTpl;\r
  BOOLEAN                   DontFragment;\r
  UINT32                    HeadLen;\r
  UINT8                     RawHdrLen;\r
  UINT32                    OptionsLength;\r
  UINT8                     *OptionsBuffer;\r
  VOID                      *FirstFragment;\r
\r
  if (This == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
\r
  if (IpInstance->State != IP4_STATE_CONFIGED) {\r
    return EFI_NOT_STARTED;\r
  }\r
\r
  OldTpl  = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  IpSb    = IpInstance->Service;\r
  IpIf    = IpInstance->Interface;\r
  Config  = &IpInstance->ConfigData;\r
\r
  if (Config->UseDefaultAddress && IP4_NO_MAPPING (IpInstance)) {\r
    Status = EFI_NO_MAPPING;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // make sure that token is properly formated\r
  //\r
  Status = Ip4TxTokenValid (Token, IpIf, Config->RawData);\r
\r
  if (EFI_ERROR (Status)) {\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Check whether the token or signal already existed.\r
  //\r
  if (EFI_ERROR (NetMapIterate (&IpInstance->TxTokens, Ip4TokenExist, Token))) {\r
    Status = EFI_ACCESS_DENIED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Build the IP header, need to fill in the Tos, TotalLen, Id,\r
  // fragment, Ttl, protocol, Src, and Dst.\r
  //\r
  TxData = Token->Packet.TxData;\r
\r
  FirstFragment = NULL;\r
\r
  if (Config->RawData) {\r
    //\r
    // When RawData is TRUE, first buffer in FragmentTable points to a raw\r
    // IPv4 fragment including IPv4 header and options.\r
    //\r
    FirstFragment = TxData->FragmentTable[0].FragmentBuffer;\r
    CopyMem (&RawHdrLen, FirstFragment, sizeof (UINT8));\r
\r
    RawHdrLen = (UINT8) (RawHdrLen & 0x0f);\r
    if (RawHdrLen < 5) {\r
      Status = EFI_INVALID_PARAMETER;\r
      goto ON_EXIT;\r
    }\r
\r
    RawHdrLen = (UINT8) (RawHdrLen << 2);\r
    \r
    CopyMem (&Head, FirstFragment, IP4_MIN_HEADLEN);\r
\r
    Ip4NtohHead (&Head);\r
    HeadLen      = 0;\r
    DontFragment = IP4_DO_NOT_FRAGMENT (Head.Fragment);\r
\r
    if (!DontFragment) {\r
      Status = EFI_INVALID_PARAMETER;\r
      goto ON_EXIT;\r
    }\r
\r
    GateWay = IP4_ALLZERO_ADDRESS;\r
\r
    //\r
    // Get IPv4 options from first fragment.\r
    //\r
    if (RawHdrLen == IP4_MIN_HEADLEN) {\r
      OptionsLength = 0;\r
      OptionsBuffer = NULL;\r
    } else {\r
      OptionsLength = RawHdrLen - IP4_MIN_HEADLEN;\r
      OptionsBuffer = (UINT8 *) FirstFragment + IP4_MIN_HEADLEN;\r
    }\r
\r
    //\r
    // Trim off IPv4 header and options from first fragment.\r
    //\r
    TxData->FragmentTable[0].FragmentBuffer = (UINT8 *) FirstFragment + RawHdrLen;\r
    TxData->FragmentTable[0].FragmentLength = TxData->FragmentTable[0].FragmentLength - RawHdrLen;\r
  } else {\r
    CopyMem (&Head.Dst, &TxData->DestinationAddress, sizeof (IP4_ADDR));\r
    Head.Dst = NTOHL (Head.Dst);\r
\r
    if (TxData->OverrideData != NULL) {\r
      Override      = TxData->OverrideData;\r
      Head.Protocol = Override->Protocol;\r
      Head.Tos      = Override->TypeOfService;\r
      Head.Ttl      = Override->TimeToLive;\r
      DontFragment  = Override->DoNotFragment;\r
\r
      CopyMem (&Head.Src, &Override->SourceAddress, sizeof (IP4_ADDR));\r
      CopyMem (&GateWay, &Override->GatewayAddress, sizeof (IP4_ADDR));\r
\r
      Head.Src = NTOHL (Head.Src);\r
      GateWay  = NTOHL (GateWay);\r
    } else {\r
      Head.Src      = IpIf->Ip;\r
      GateWay       = IP4_ALLZERO_ADDRESS;\r
      Head.Protocol = Config->DefaultProtocol;\r
      Head.Tos      = Config->TypeOfService;\r
      Head.Ttl      = Config->TimeToLive;\r
      DontFragment  = Config->DoNotFragment;\r
    }\r
\r
    Head.Fragment = IP4_HEAD_FRAGMENT_FIELD (DontFragment, FALSE, 0);\r
    HeadLen       = (TxData->OptionsLength + 3) & (~0x03);\r
\r
    OptionsLength = TxData->OptionsLength;\r
    OptionsBuffer = (UINT8 *) (TxData->OptionsBuffer);\r
  }\r
\r
  //\r
  // If don't fragment and fragment needed, return error\r
  //\r
  if (DontFragment && (TxData->TotalDataLength + HeadLen > IpSb->MaxPacketSize)) {\r
    Status = EFI_BAD_BUFFER_SIZE;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // OK, it survives all the validation check. Wrap the token in\r
  // a IP4_TXTOKEN_WRAP and the data in a netbuf\r
  //\r
  Status = EFI_OUT_OF_RESOURCES;\r
  Wrap   = AllocateZeroPool (sizeof (IP4_TXTOKEN_WRAP));\r
  if (Wrap == NULL) {\r
    goto ON_EXIT;\r
  }\r
\r
  Wrap->IpInstance  = IpInstance;\r
  Wrap->Token       = Token;\r
  Wrap->Sent        = FALSE;\r
  Wrap->Life        = IP4_US_TO_SEC (Config->TransmitTimeout);\r
  Wrap->Packet      = NetbufFromExt (\r
                        (NET_FRAGMENT *) TxData->FragmentTable,\r
                        TxData->FragmentCount,\r
                        IP4_MAX_HEADLEN,\r
                        0,\r
                        Ip4FreeTxToken,\r
                        Wrap\r
                        );\r
\r
  if (Wrap->Packet == NULL) {\r
    FreePool (Wrap);\r
    goto ON_EXIT;\r
  }\r
\r
  Token->Status = EFI_NOT_READY;\r
\r
  if (EFI_ERROR (NetMapInsertTail (&IpInstance->TxTokens, Token, Wrap))) {\r
    //\r
    // NetbufFree will call Ip4FreeTxToken, which in turn will\r
    // free the IP4_TXTOKEN_WRAP. Now, the token wrap hasn't been\r
    // enqueued.\r
    //\r
    if (Config->RawData) {\r
      //\r
      // Restore pointer of first fragment in RawData mode.\r
      //\r
      TxData->FragmentTable[0].FragmentBuffer = (UINT8 *) FirstFragment;\r
    }\r
\r
    NetbufFree (Wrap->Packet);\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Mark the packet sent before output it. Mark it not sent again if the\r
  // returned status is not EFI_SUCCESS;\r
  //\r
  Wrap->Sent = TRUE;\r
\r
  Status = Ip4Output (\r
             IpSb,\r
             IpInstance,\r
             Wrap->Packet,\r
             &Head,\r
             OptionsBuffer,\r
             OptionsLength,\r
             GateWay,\r
             Ip4OnPacketSent,\r
             Wrap\r
             );\r
\r
  if (EFI_ERROR (Status)) {\r
    Wrap->Sent = FALSE;\r
\r
    if (Config->RawData) {\r
      //\r
      // Restore pointer of first fragment in RawData mode.\r
      //\r
      TxData->FragmentTable[0].FragmentBuffer = (UINT8 *) FirstFragment;\r
    }\r
\r
    NetbufFree (Wrap->Packet);\r
  }\r
\r
  if (Config->RawData) {\r
    //\r
    // Restore pointer of first fragment in RawData mode.\r
    //\r
    TxData->FragmentTable[0].FragmentBuffer = (UINT8 *) FirstFragment;\r
  }\r
\r
ON_EXIT:\r
  gBS->RestoreTPL (OldTpl);\r
  return Status;\r
}\r
\r
\r
/**\r
  Places a receiving request into the receiving queue.\r
\r
  The Receive() function places a completion token into the receive packet queue.\r
  This function is always asynchronous.\r
\r
  The Token.Event field in the completion token must be filled in by the caller\r
  and cannot be NULL. When the receive operation completes, the EFI IPv4 Protocol\r
  driver updates the Token.Status and Token.Packet.RxData fields and the Token.Event\r
  is signaled.\r
\r
  @param[in]  This  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  Token Pointer to a token that is associated with the receive data descriptor.\r
\r
  @retval EFI_SUCCESS           The receive completion token was cached.\r
  @retval EFI_NOT_STARTED       This EFI IPv4 Protocol instance has not been started.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP, RARP, etc.)\r
                                is not finished yet.\r
  @retval EFI_INVALID_PARAMETER One or more of the following conditions is TRUE:\r
                                - This is NULL.\r
                                - Token is NULL.\r
                                - Token.Event is NULL.\r
  @retval EFI_OUT_OF_RESOURCES  The receive completion token could not be queued due to a lack of system\r
                                resources (usually memory).\r
  @retval EFI_DEVICE_ERROR      An unexpected system or network error occurred.\r
                                The EFI IPv4 Protocol instance has been reset to startup defaults.\r
                                EFI_ACCESS_DENIED The receive completion token with the same Token.Event was already\r
                                in the receive queue.\r
  @retval EFI_NOT_READY         The receive request could not be queued because the receive queue is full.\r
  @retval EFI_ICMP_ERROR        An ICMP error packet was received.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Receive (\r
  IN EFI_IP4_PROTOCOL         *This,\r
  IN EFI_IP4_COMPLETION_TOKEN *Token\r
  )\r
{\r
  IP4_PROTOCOL              *IpInstance;\r
  EFI_STATUS                Status;\r
  EFI_TPL                   OldTpl;\r
\r
  //\r
  // First validate the parameters\r
  //\r
  if ((This == NULL) || (Token == NULL) || (Token->Event == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
\r
  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  if (IpInstance->State != IP4_STATE_CONFIGED) {\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Check whether the toke is already on the receive queue.\r
  //\r
  Status = NetMapIterate (&IpInstance->RxTokens, Ip4TokenExist, Token);\r
\r
  if (EFI_ERROR (Status)) {\r
    Status = EFI_ACCESS_DENIED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Queue the token then check whether there is pending received packet.\r
  //\r
  Status = NetMapInsertTail (&IpInstance->RxTokens, Token, NULL);\r
\r
  if (EFI_ERROR (Status)) {\r
    goto ON_EXIT;\r
  }\r
\r
  Status = Ip4InstanceDeliverPacket (IpInstance);\r
\r
  //\r
  // Dispatch the DPC queued by the NotifyFunction of this instane's receive\r
  // event.\r
  //\r
  DispatchDpc ();\r
\r
ON_EXIT:\r
  gBS->RestoreTPL (OldTpl);\r
  return Status;\r
}\r
\r
\r
/**\r
  Cancel the transmitted but not recycled packet. If a matching\r
  token is found, it will call Ip4CancelPacket to cancel the\r
  packet. Ip4CancelPacket will cancel all the fragments of the\r
  packet. When all the fragments are freed, the IP4_TXTOKEN_WRAP\r
  will be deleted from the Map, and user's event signalled.\r
  Because Ip4CancelPacket and other functions are all called in\r
  line, so, after Ip4CancelPacket returns, the Item has been freed.\r
\r
  @param[in]  Map                The IP4 child's transmit queue.\r
  @param[in]  Item               The current transmitted packet to test.\r
  @param[in]  Context            The user's token to cancel.\r
\r
  @retval EFI_SUCCESS            Continue to check the next Item.\r
  @retval EFI_ABORTED            The user's Token (Token != NULL) is cancelled.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip4CancelTxTokens (\r
  IN NET_MAP                *Map,\r
  IN NET_MAP_ITEM           *Item,\r
  IN VOID                   *Context\r
  )\r
{\r
  EFI_IP4_COMPLETION_TOKEN  *Token;\r
  IP4_TXTOKEN_WRAP          *Wrap;\r
\r
  Token = (EFI_IP4_COMPLETION_TOKEN *) Context;\r
\r
  //\r
  // Return EFI_SUCCESS to check the next item in the map if\r
  // this one doesn't match.\r
  //\r
  if ((Token != NULL) && (Token != Item->Key)) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  Wrap = (IP4_TXTOKEN_WRAP *) Item->Value;\r
  ASSERT (Wrap != NULL);\r
\r
  //\r
  // Don't access the Item, Wrap and Token's members after this point.\r
  // Item and wrap has been freed. And we no longer own the Token.\r
  //\r
  Ip4CancelPacket (Wrap->IpInstance->Interface, Wrap->Packet, EFI_ABORTED);\r
\r
  //\r
  // If only one item is to be cancel, return EFI_ABORTED to stop\r
  // iterating the map any more.\r
  //\r
  if (Token != NULL) {\r
    return EFI_ABORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Cancel the receive request. This is quiet simple, because\r
  it is only enqueued in our local receive map.\r
\r
  @param[in]  Map                The IP4 child's receive queue.\r
  @param[in]  Item               Current receive request to cancel.\r
  @param[in]  Context            The user's token to cancel.\r
\r
  @retval EFI_SUCCESS            Continue to check the next receive request on the\r
                                 queue.\r
  @retval EFI_ABORTED            The user's token (token != NULL) has been\r
                                 cancelled.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip4CancelRxTokens (\r
  IN NET_MAP                *Map,\r
  IN NET_MAP_ITEM           *Item,\r
  IN VOID                   *Context\r
  )\r
{\r
  EFI_IP4_COMPLETION_TOKEN  *Token;\r
  EFI_IP4_COMPLETION_TOKEN  *This;\r
\r
  Token = (EFI_IP4_COMPLETION_TOKEN *) Context;\r
  This  = Item->Key;\r
\r
  if ((Token != NULL) && (Token != This)) {\r
    return EFI_SUCCESS;\r
  }\r
\r
  NetMapRemoveItem (Map, Item, NULL);\r
\r
  This->Status        = EFI_ABORTED;\r
  This->Packet.RxData = NULL;\r
  gBS->SignalEvent (This->Event);\r
\r
  if (Token != NULL) {\r
    return EFI_ABORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Cancel the user's receive/transmit request.\r
\r
  @param[in]  IpInstance         The IP4 child.\r
  @param[in]  Token              The token to cancel. If NULL, all token will be\r
                                 cancelled.\r
\r
  @retval EFI_SUCCESS            The token is cancelled.\r
  @retval EFI_NOT_FOUND          The token isn't found on either the\r
                                 transmit/receive queue.\r
  @retval EFI_DEVICE_ERROR       Not all token is cancelled when Token is NULL.\r
\r
**/\r
EFI_STATUS\r
Ip4Cancel (\r
  IN IP4_PROTOCOL             *IpInstance,\r
  IN EFI_IP4_COMPLETION_TOKEN *Token          OPTIONAL\r
  )\r
{\r
  EFI_STATUS                Status;\r
\r
  //\r
  // First check the transmitted packet. Ip4CancelTxTokens returns\r
  // EFI_ABORTED to mean that the token has been cancelled when\r
  // token != NULL. So, return EFI_SUCCESS for this condition.\r
  //\r
  Status = NetMapIterate (&IpInstance->TxTokens, Ip4CancelTxTokens, Token);\r
\r
  if (EFI_ERROR (Status)) {\r
    if ((Token != NULL) && (Status == EFI_ABORTED)) {\r
      return EFI_SUCCESS;\r
    }\r
\r
    return Status;\r
  }\r
\r
  //\r
  // Check the receive queue. Ip4CancelRxTokens also returns EFI_ABORT\r
  // for Token!=NULL and it is cancelled.\r
  //\r
  Status = NetMapIterate (&IpInstance->RxTokens, Ip4CancelRxTokens, Token);\r
  //\r
  // Dispatch the DPCs queued by the NotifyFunction of the canceled rx token's\r
  // events.\r
  //\r
  DispatchDpc ();\r
  if (EFI_ERROR (Status)) {\r
    if ((Token != NULL) && (Status == EFI_ABORTED)) {\r
      return EFI_SUCCESS;\r
    }\r
\r
    return Status;\r
  }\r
\r
  //\r
  // OK, if the Token is found when Token != NULL, the NetMapIterate\r
  // will return EFI_ABORTED, which has been interrupted as EFI_SUCCESS.\r
  //\r
  if (Token != NULL) {\r
    return EFI_NOT_FOUND;\r
  }\r
\r
  //\r
  // If Token == NULL, cancel all the tokens. return error if no\r
  // all of them are cancelled.\r
  //\r
  if (!NetMapIsEmpty (&IpInstance->TxTokens) ||\r
      !NetMapIsEmpty (&IpInstance->RxTokens)) {\r
\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Abort an asynchronous transmit or receive request.\r
\r
  The Cancel() function is used to abort a pending transmit or receive request.\r
  If the token is in the transmit or receive request queues, after calling this\r
  function, Token->Status will be set to EFI_ABORTED and then Token->Event will\r
  be signaled. If the token is not in one of the queues, which usually means the\r
  asynchronous operation has completed, this function will not signal the token\r
  and EFI_NOT_FOUND is returned.\r
\r
  @param[in]  This  Pointer to the EFI_IP4_PROTOCOL instance.\r
  @param[in]  Token Pointer to a token that has been issued by\r
                    EFI_IP4_PROTOCOL.Transmit() or\r
                    EFI_IP4_PROTOCOL.Receive(). If NULL, all pending\r
                    tokens are aborted. Type EFI_IP4_COMPLETION_TOKEN is\r
                    defined in EFI_IP4_PROTOCOL.Transmit().\r
\r
  @retval EFI_SUCCESS           The asynchronous I/O request was aborted and\r
                                Token.->Event was signaled. When Token is NULL, all\r
                                pending requests were aborted and their events were signaled.\r
  @retval EFI_INVALID_PARAMETER This is NULL.\r
  @retval EFI_NOT_STARTED       This instance has not been started.\r
  @retval EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                RARP, etc.) is not finished yet.\r
  @retval EFI_NOT_FOUND         When Token is not NULL, the asynchronous I/O request was\r
                                not found in the transmit or receive queue. It has either completed\r
                                or was not issued by Transmit() and Receive().\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Cancel (\r
  IN EFI_IP4_PROTOCOL         *This,\r
  IN EFI_IP4_COMPLETION_TOKEN *Token    OPTIONAL\r
  )\r
{\r
  IP4_PROTOCOL              *IpInstance;\r
  EFI_STATUS                Status;\r
  EFI_TPL                   OldTpl;\r
\r
  if (This == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
\r
  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  if (IpInstance->State != IP4_STATE_CONFIGED) {\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  if (IpInstance->ConfigData.UseDefaultAddress && IP4_NO_MAPPING (IpInstance)) {\r
    Status = EFI_NO_MAPPING;\r
    goto ON_EXIT;\r
  }\r
\r
  Status = Ip4Cancel (IpInstance, Token);\r
\r
ON_EXIT:\r
  gBS->RestoreTPL (OldTpl);\r
  return Status;\r
}\r
\r
\r
/**\r
  Polls for incoming data packets and processes outgoing data packets.\r
\r
  The Poll() function polls for incoming data packets and processes outgoing data\r
  packets. Network drivers and applications can call the EFI_IP4_PROTOCOL.Poll()\r
  function to increase the rate that data packets are moved between the communications\r
  device and the transmit and receive queues.\r
\r
  In some systems the periodic timer event may not poll the underlying communications\r
  device fast enough to transmit and/or receive all data packets without missing\r
  incoming packets or dropping outgoing packets. Drivers and applications that are\r
  experiencing packet loss should try calling the EFI_IP4_PROTOCOL.Poll() function\r
  more often.\r
\r
  @param[in]  This               Pointer to the EFI_IP4_PROTOCOL instance.\r
\r
  @retval  EFI_SUCCESS           Incoming or outgoing data was processed.\r
  @retval  EFI_NOT_STARTED       This EFI IPv4 Protocol instance has not been started.\r
  @retval  EFI_NO_MAPPING        When using the default address, configuration (DHCP, BOOTP,\r
                                 RARP, etc.) is not finished yet.\r
  @retval  EFI_INVALID_PARAMETER This is NULL.\r
  @retval  EFI_DEVICE_ERROR      An unexpected system or network error occurred.\r
  @retval  EFI_NOT_READY         No incoming or outgoing data is processed.\r
  @retval  EFI_TIMEOUT           Data was dropped out of the transmit and/or receive queue.\r
                                 Consider increasing the polling rate.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
EfiIp4Poll (\r
  IN EFI_IP4_PROTOCOL       *This\r
  )\r
{\r
  IP4_PROTOCOL                  *IpInstance;\r
  EFI_MANAGED_NETWORK_PROTOCOL  *Mnp;\r
\r
  if (This == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  IpInstance = IP4_INSTANCE_FROM_PROTOCOL (This);\r
\r
  if (IpInstance->State == IP4_STATE_UNCONFIGED) {\r
    return EFI_NOT_STARTED;\r
  }\r
\r
  Mnp = IpInstance->Service->Mnp;\r
\r
  //\r
  // Don't lock the Poll function to enable the deliver of\r
  // the packet polled up.\r
  //\r
  return Mnp->Poll (Mnp);\r
}\r
\r
/**\r
  Decrease the life of the transmitted packets. If it is\r
  decreased to zero, cancel the packet. This function is\r
  called by Ip4PacketTimerTicking which time out both the\r
  received-but-not-delivered and transmitted-but-not-recycle\r
  packets.\r
\r
  @param[in]  Map                    The IP4 child's transmit map.\r
  @param[in]  Item                   Current transmitted packet.\r
  @param[in]  Context                Not used.\r
\r
  @retval EFI_SUCCESS            Always returns EFI_SUCCESS.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip4SentPacketTicking (\r
  IN NET_MAP                *Map,\r
  IN NET_MAP_ITEM           *Item,\r
  IN VOID                   *Context\r
  )\r
{\r
  IP4_TXTOKEN_WRAP          *Wrap;\r
\r
  Wrap = (IP4_TXTOKEN_WRAP *) Item->Value;\r
  ASSERT (Wrap != NULL);\r
\r
  if ((Wrap->Life > 0) && (--Wrap->Life == 0)) {\r
    Ip4CancelPacket (Wrap->IpInstance->Interface, Wrap->Packet, EFI_ABORTED);\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  There are two steps for this the heart beat timer of IP4 service instance. \r
  First, it times out all of its IP4 children's received-but-not-delivered \r
  and transmitted-but-not-recycle packets, and provides time input for its \r
  IGMP protocol.\r
  Second, a dedicated timer is used to poll underlying media status. In case \r
  of cable swap, a new round auto configuration will be initiated. The timer \r
  will signal the IP4 to run DHCP configuration again. IP4 driver will free\r
  old IP address related resource, such as route table and Interface, then\r
  initiate a DHCP process to acquire new IP, eventually create route table \r
  for new IP address.\r
\r
  @param[in]  Event                  The IP4 service instance's heart beat timer.\r
  @param[in]  Context                The IP4 service instance.\r
\r
**/\r
VOID\r
EFIAPI\r
Ip4TimerTicking (\r
  IN EFI_EVENT              Event,\r
  IN VOID                   *Context\r
  )\r
{\r
  IP4_SERVICE               *IpSb;\r
  BOOLEAN                   OldMediaPresent;\r
  EFI_STATUS                Status;\r
  EFI_SIMPLE_NETWORK_MODE   SnpModeData;\r
\r
  IpSb = (IP4_SERVICE *) Context;\r
  NET_CHECK_SIGNATURE (IpSb, IP4_SERVICE_SIGNATURE);\r
  \r
  OldMediaPresent = IpSb->MediaPresent;\r
\r
  Ip4PacketTimerTicking (IpSb);\r
  Ip4IgmpTicking (IpSb);\r
\r
  //\r
  // Get fresh mode data from MNP, since underlying media status may change. \r
  // Here, it needs to mention that the MediaPresent can also be checked even if \r
  // EFI_NOT_STARTED returned while this MNP child driver instance isn't configured.\r
  //\r
  Status = IpSb->Mnp->GetModeData (IpSb->Mnp, NULL, &SnpModeData);\r
  if (EFI_ERROR (Status) && (Status != EFI_NOT_STARTED)) {\r
    return;\r
  }\r
\r
  IpSb->MediaPresent = SnpModeData.MediaPresent;\r
  //\r
  // Media transimit Unpresent to Present means new link movement is detected.\r
  //\r
  if (!OldMediaPresent && IpSb->MediaPresent && (IpSb->Ip4Config2Instance.Policy == Ip4Config2PolicyDhcp)) {\r
    //\r
    // Signal the IP4 to run the dhcp configuration again. IP4 driver will free\r
    // old IP address related resource, such as route table and Interface, then \r
    // initiate a DHCP round to acquire new IP, eventually \r
    // create route table for new IP address.\r
    //\r
    if (IpSb->ReconfigEvent != NULL) {\r
      Status = gBS->SignalEvent (IpSb->ReconfigEvent);\r
      DispatchDpc ();\r
    }\r
  }\r
}\r