1. Sync the latest network stack. Add NetLibCreateIPv4DPathNode () in netlib library.

[mirror_edk2.git] / MdeModulePkg / Universal / Network / MnpDxe / MnpMain.c

/** @file\r
\r
Copyright (c) 2005 - 2007, Intel Corporation\r
All rights reserved. This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution.  The full text of the license may be found at\r
http://opensource.org/licenses/bsd-license.php\r
\r
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
\r
Module Name:\r
\r
  MnpMain.c\r
\r
Abstract:\r
\r
  Implementation of Managed Network Protocol public services.\r
\r
\r
**/\r
\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/BaseLib.h>\r
\r
#include "MnpImpl.h"\r
\r
\r
/**\r
  Get configuration data of this instance.\r
\r
  @param  This                   Pointer to the Managed Network Protocol.\r
  @param  MnpConfigData          Pointer to strorage for MNP operational\r
                                 parameters.\r
  @param  SnpModeData            Pointer to strorage for SNP operational\r
                                 parameters.\r
\r
  @retval EFI_SUCCESS            The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER  This is NULL.\r
  @retval EFI_NOT_STARTED        This MNP child driver instance has not been\r
                                 configured The default values are returned in\r
                                 MnpConfigData if it is not NULL.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MnpGetModeData (\r
  IN  EFI_MANAGED_NETWORK_PROTOCOL     *This,\r
  OUT EFI_MANAGED_NETWORK_CONFIG_DATA  *MnpConfigData OPTIONAL,\r
  OUT EFI_SIMPLE_NETWORK_MODE          *SnpModeData OPTIONAL\r
  )\r
{\r
  MNP_INSTANCE_DATA           *Instance;\r
  EFI_SIMPLE_NETWORK_PROTOCOL *Snp;\r
  EFI_TPL                     OldTpl;\r
  EFI_STATUS                  Status;\r
\r
  if (This == NULL) {\r
\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance = MNP_INSTANCE_DATA_FROM_THIS (This);\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if (MnpConfigData != NULL) {\r
    //\r
    // Copy the instance configuration data.\r
    //\r
    CopyMem (MnpConfigData, &Instance->ConfigData, sizeof (*MnpConfigData));\r
  }\r
\r
  if (SnpModeData != NULL) {\r
    //\r
    // Copy the underlayer Snp mode data.\r
    //\r
    Snp           = Instance->MnpServiceData->Snp;\r
    CopyMem (SnpModeData, Snp->Mode, sizeof (*SnpModeData));\r
  }\r
\r
  if (!Instance->Configured) {\r
    Status = EFI_NOT_STARTED;\r
  } else {\r
    Status = EFI_SUCCESS;\r
  }\r
\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Set or clear the operational parameters for the MNP child driver.\r
\r
  @param  This                   Pointer to the Managed Network Protocol.\r
  @param  MnpConfigData          Pointer to the configuration data that will be\r
                                 assigned to the MNP child driver instance. If\r
                                 NULL, the MNP child driver instance is reset to\r
                                 startup defaults and all pending transmit and\r
                                 receive requests are flushed.\r
\r
  @retval EFI_SUCCESS            The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER  One or more parameter is invalid.\r
  @retval EFI_OUT_OF_RESOURCES   Required system resources (usually memory) could\r
                                 not be allocated.\r
  @retval EFI_UNSUPPORTED        EnableReceiveTimestamps is TRUE, this\r
                                 implementation doesn't support it.\r
  @retval EFI_DEVICE_ERROR       An unexpected network or system error occurred.\r
  @retval Other                  The MNP child driver instance has been reset to\r
                                 startup defaults.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MnpConfigure (\r
  IN EFI_MANAGED_NETWORK_PROTOCOL     *This,\r
  IN EFI_MANAGED_NETWORK_CONFIG_DATA  *MnpConfigData OPTIONAL\r
  )\r
{\r
  MNP_INSTANCE_DATA  *Instance;\r
  EFI_TPL            OldTpl;\r
  EFI_STATUS         Status;\r
\r
  if ((This == NULL) ||\r
    ((MnpConfigData != NULL) &&\r
    (MnpConfigData->ProtocolTypeFilter > 0) &&\r
    (MnpConfigData->ProtocolTypeFilter <= 1500))) {\r
\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance = MNP_INSTANCE_DATA_FROM_THIS (This);\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if ((MnpConfigData == NULL) && (!Instance->Configured)) {\r
    //\r
    // If the instance is not configured and a reset is requested, just return.\r
    //\r
    Status = EFI_SUCCESS;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Configure the instance.\r
  //\r
  Status = MnpConfigureInstance (Instance, MnpConfigData);\r
\r
ON_EXIT:\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Translate a multicast IP address to a multicast hardware (MAC) address.\r
\r
  @param  This                   Pointer to the Managed Network Protocol.\r
  @param  Ipv6Flag               Set to TRUE if IpAddress is an IPv6 multicast\r
                                 address. Set to FALSE if IpAddress is an IPv4\r
                                 multicast address.\r
  @param  IpAddress              Pointer to the multicast IP address to convert.\r
  @param  MacAddress             Pointer to the resulting multicast MAC address.\r
\r
  @retval EFI_SUCCESS            The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER  One or more parameter is invalid.\r
  @retval EFI_NOT_STARTED        This MNP child driver instance has not been\r
                                 configured.\r
  @retval EFI_UNSUPPORTED        Ipv6Flag is TRUE, this implementation doesn't\r
                                 supported it.\r
  @retval EFI_DEVICE_ERROR       An unexpected network or system error occurred.\r
  @retval Other                  The address could not be converted.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MnpMcastIpToMac (\r
  IN  EFI_MANAGED_NETWORK_PROTOCOL  *This,\r
  IN  BOOLEAN                       Ipv6Flag,\r
  IN  EFI_IP_ADDRESS                *IpAddress,\r
  OUT EFI_MAC_ADDRESS               *MacAddress\r
  )\r
{\r
  EFI_STATUS                  Status;\r
  MNP_INSTANCE_DATA           *Instance;\r
  EFI_SIMPLE_NETWORK_PROTOCOL *Snp;\r
  EFI_TPL                     OldTpl;\r
\r
  if ((This == NULL) || (IpAddress == NULL) || (MacAddress == NULL)) {\r
\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  if (Ipv6Flag) {\r
    //\r
    // Currently IPv6 isn't supported.\r
    //\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  if (!IP4_IS_MULTICAST (EFI_NTOHL (*IpAddress))) {\r
    //\r
    // The IPv4 address passed in is not a multicast address.\r
    //\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance = MNP_INSTANCE_DATA_FROM_THIS (This);\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if (!Instance->Configured) {\r
\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  Snp = Instance->MnpServiceData->Snp;\r
  ASSERT (Snp != NULL);\r
\r
  if (Snp->Mode->IfType == NET_IFTYPE_ETHERNET) {\r
    //\r
    // Translate the IPv4 address into a multicast MAC address if the NIC is an\r
    // ethernet NIC.\r
    //\r
    MacAddress->Addr[0] = 0x01;\r
    MacAddress->Addr[1] = 0x00;\r
    MacAddress->Addr[2] = 0x5E;\r
    MacAddress->Addr[3] = (UINT8) (IpAddress->v4.Addr[1] & 0x7F);\r
    MacAddress->Addr[4] = IpAddress->v4.Addr[2];\r
    MacAddress->Addr[5] = IpAddress->v4.Addr[3];\r
\r
    Status = EFI_SUCCESS;\r
  } else {\r
    //\r
    // Invoke Snp to translate the multicast IP address.\r
    //\r
    Status = Snp->MCastIpToMac (\r
                    Snp,\r
                    Ipv6Flag,\r
                    IpAddress,\r
                    MacAddress\r
                    );\r
  }\r
\r
ON_EXIT:\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Enable or disable receie filters for multicast address.\r
\r
  @param  This                   Pointer to the Managed Network Protocol.\r
  @param  JoinFlag               Set to TRUE to join this multicast group. Set to\r
                                 FALSE to leave this multicast group.\r
  @param  MacAddress             Pointer to the multicast MAC group (address) to\r
                                 join or leave.\r
\r
  @retval EFI_SUCCESS            The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER  One or more parameter is invalid\r
  @retval EFI_NOT_STARTED        This MNP child driver instance has not been\r
                                 configured.\r
  @retval EFI_ALREADY_STARTED    The supplied multicast group is already joined.\r
  @retval EFI_NOT_FOUND          The supplied multicast group is not joined.\r
  @retval EFI_DEVICE_ERROR       An unexpected network or system error occurred.\r
  @retval Other                  The requested operation could not be completed.\r
                                 The MNP multicast group settings are unchanged.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MnpGroups (\r
  IN EFI_MANAGED_NETWORK_PROTOCOL  *This,\r
  IN BOOLEAN                       JoinFlag,\r
  IN EFI_MAC_ADDRESS               *MacAddress OPTIONAL\r
  )\r
{\r
  MNP_INSTANCE_DATA       *Instance;\r
  EFI_SIMPLE_NETWORK_MODE *SnpMode;\r
  MNP_GROUP_CONTROL_BLOCK *GroupCtrlBlk;\r
  MNP_GROUP_ADDRESS       *GroupAddress;\r
  NET_LIST_ENTRY          *ListEntry;\r
  BOOLEAN                 AddressExist;\r
  EFI_TPL                 OldTpl;\r
  EFI_STATUS              Status;\r
\r
  if (This == NULL || (JoinFlag && (MacAddress == NULL))) {\r
    //\r
    // This is NULL, or it's a join operation but MacAddress is NULL.\r
    //\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance  = MNP_INSTANCE_DATA_FROM_THIS (This);\r
  SnpMode   = Instance->MnpServiceData->Snp->Mode;\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if (!Instance->Configured) {\r
\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  if ((!Instance->ConfigData.EnableMulticastReceive) ||\r
    ((MacAddress != NULL) && !NET_MAC_IS_MULTICAST (MacAddress, &SnpMode->BroadcastAddress, SnpMode->HwAddressSize))) {\r
    //\r
    // The instance isn't configured to do mulitcast receive. OR\r
    // the passed in MacAddress is not a mutlticast mac address.\r
    //\r
    Status = EFI_INVALID_PARAMETER;\r
    goto ON_EXIT;\r
  }\r
\r
  Status       = EFI_SUCCESS;\r
  AddressExist = FALSE;\r
  GroupCtrlBlk = NULL;\r
\r
  if (MacAddress != NULL) {\r
    //\r
    // Search the instance's GroupCtrlBlkList to find the specific address.\r
    //\r
    NET_LIST_FOR_EACH (ListEntry, &Instance->GroupCtrlBlkList) {\r
\r
      GroupCtrlBlk = NET_LIST_USER_STRUCT (\r
                      ListEntry,\r
                      MNP_GROUP_CONTROL_BLOCK,\r
                      CtrlBlkEntry\r
                      );\r
      GroupAddress = GroupCtrlBlk->GroupAddress;\r
      if (0 == NetCompareMem (\r
                MacAddress,\r
                &GroupAddress->Address,\r
                SnpMode->HwAddressSize\r
                )) {\r
        //\r
        // There is already the same multicast mac address configured.\r
        //\r
        AddressExist = TRUE;\r
        break;\r
      }\r
    }\r
\r
    if (JoinFlag && AddressExist) {\r
      //\r
      // The multicast mac address to join already exists.\r
      //\r
      Status = EFI_ALREADY_STARTED;\r
    }\r
\r
    if (!JoinFlag && !AddressExist) {\r
      //\r
      // The multicast mac address to leave doesn't exist in this instance.\r
      //\r
      Status = EFI_NOT_FOUND;\r
    }\r
\r
    if (EFI_ERROR (Status)) {\r
      goto ON_EXIT;\r
    }\r
  } else if (NetListIsEmpty (&Instance->GroupCtrlBlkList)) {\r
    //\r
    // The MacAddress is NULL and there is no configured multicast mac address,\r
    // just return.\r
    //\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // OK, it is time to take action.\r
  //\r
  Status = MnpGroupOp (Instance, JoinFlag, MacAddress, GroupCtrlBlk);\r
\r
ON_EXIT:\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Place an outgoing packet into the transmit queue.\r
\r
  @param  This                   Pointer to the Managed Network Protocol.\r
  @param  Token                  Pointer to a token associated with the transmit\r
                                 data descriptor.\r
\r
  @retval EFI_SUCCESS            The operation completed successfully.\r
  @retval EFI_INVALID_PARAMETER  One or more parameter is invalid\r
  @retval EFI_NOT_STARTED        This MNP child driver instance has not been\r
                                 configured.\r
  @retval EFI_ACCESS_DENIED      The transmit completion token is already in the\r
                                 transmit queue.\r
  @retval EFI_OUT_OF_RESOURCES   The transmit data could not be queued due to a\r
                                 lack of system resources (usually memory).\r
  @retval EFI_DEVICE_ERROR       An unexpected system or network error occurred.\r
                                 The MNP child driver instance has been reset to\r
                                 startup defaults.\r
  @retval EFI_NOT_READY          The transmit request could not be queued because\r
                                 the transmit queue is full.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MnpTransmit (\r
  IN EFI_MANAGED_NETWORK_PROTOCOL          *This,\r
  IN EFI_MANAGED_NETWORK_COMPLETION_TOKEN  *Token\r
  )\r
{\r
  EFI_STATUS        Status;\r
  MNP_INSTANCE_DATA *Instance;\r
  MNP_SERVICE_DATA  *MnpServiceData;\r
  UINT8             *PktBuf;\r
  UINT32            PktLen;\r
  EFI_TPL           OldTpl;\r
\r
  if ((This == NULL) || (Token == NULL)) {\r
\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance = MNP_INSTANCE_DATA_FROM_THIS (This);\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if (!Instance->Configured) {\r
\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  if (!MnpIsValidTxToken (Instance, Token)) {\r
    //\r
    // The Token is invalid.\r
    //\r
    Status = EFI_INVALID_PARAMETER;\r
    goto ON_EXIT;\r
  }\r
\r
  MnpServiceData = Instance->MnpServiceData;\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  //\r
  // Build the tx packet\r
  //\r
  MnpBuildTxPacket (MnpServiceData, Token->Packet.TxData, &PktBuf, &PktLen);\r
\r
  //\r
  //  OK, send the packet synchronously.\r
  //\r
  Status = MnpSyncSendPacket (MnpServiceData, PktBuf, PktLen, Token);\r
\r
ON_EXIT:\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Place an asynchronous receiving request into the receiving queue.\r
\r
  @param  This                   Pointer to the EFI_MANAGED_NETWORK_PROTOCOL\r
                                 instance.\r
  @param  Token                  Pointer to a token associated with the receive\r
                                 data descriptor.\r
\r
  @retval EFI_SUCCESS            The receive completion token was cached.\r
  @retval EFI_NOT_STARTED        This MNP child driver instance has not been\r
                                 configured.\r
  @retval EFI_INVALID_PARAMETER  One or more parameter is invalid.\r
  @retval EFI_OUT_OF_RESOURCES   The transmit data could not be queued due to a\r
                                 lack of system resources (usually memory).\r
  @retval EFI_DEVICE_ERROR       An unexpected system or network error occurred.\r
                                 The MNP child driver instance has been reset to\r
                                 startup defaults.\r
  @retval EFI_ACCESS_DENIED      The receive completion token was already in the\r
                                 receive queue.\r
  @retval EFI_NOT_READY          The receive request could not be queued because\r
                                 the receive queue is full.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MnpReceive (\r
  IN EFI_MANAGED_NETWORK_PROTOCOL          *This,\r
  IN EFI_MANAGED_NETWORK_COMPLETION_TOKEN  *Token\r
  )\r
{\r
  EFI_STATUS         Status;\r
  MNP_INSTANCE_DATA  *Instance;\r
  EFI_TPL            OldTpl;\r
\r
  if ((This == NULL) || (Token == NULL) || (Token->Event == NULL)) {\r
\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance = MNP_INSTANCE_DATA_FROM_THIS (This);\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if (!Instance->Configured) {\r
\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Check whether this token(event) is already in the rx token queue.\r
  //\r
  Status = NetMapIterate (&Instance->RxTokenMap, MnpTokenExist, (VOID *) Token);\r
  if (EFI_ERROR (Status)) {\r
\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Insert the Token into the RxTokenMap.\r
  //\r
  Status = NetMapInsertTail (&Instance->RxTokenMap, (VOID *) Token, NULL);\r
\r
  if (!EFI_ERROR (Status)) {\r
    //\r
    // Try to deliver any buffered packets.\r
    //\r
    Status = MnpInstanceDeliverPacket (Instance);\r
  }\r
\r
ON_EXIT:\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Abort a pending transmit or receive request.\r
\r
  @param  This                   Pointer to the EFI_MANAGED_NETWORK_PROTOCOL\r
                                 instance.\r
  @param  Token                  Pointer to a token that has been issued by\r
                                 EFI_MANAGED_NETWORK_PROTOCOL.Transmit() or\r
                                 EFI_MANAGED_NETWORK_PROTOCOL.Receive(). If NULL,\r
                                 all pending tokens are aborted.\r
\r
  @retval EFI_SUCCESS            The asynchronous I/O request was aborted and\r
                                 Token->Event was signaled.\r
  @retval EFI_NOT_STARTED        This MNP child driver instance has not been\r
                                 configured.\r
  @retval EFI_INVALID_PARAMETER  This is NULL.\r
  @retval EFI_NOT_FOUND          The asynchronous I/O request was not found in the\r
                                 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
MnpCancel (\r
  IN EFI_MANAGED_NETWORK_PROTOCOL          *This,\r
  IN EFI_MANAGED_NETWORK_COMPLETION_TOKEN  *Token OPTIONAL\r
  )\r
{\r
  EFI_STATUS         Status;\r
  MNP_INSTANCE_DATA  *Instance;\r
  EFI_TPL            OldTpl;\r
\r
  if (This == NULL) {\r
\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance = MNP_INSTANCE_DATA_FROM_THIS (This);\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if (!Instance->Configured) {\r
\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Iterate the RxTokenMap to cancel the specified Token.\r
  //\r
  Status = NetMapIterate (&Instance->RxTokenMap, MnpCancelTokens, (VOID *) Token);\r
\r
  if (Token != NULL) {\r
\r
    Status = (Status == EFI_ABORTED) ? EFI_SUCCESS : EFI_NOT_FOUND;\r
  }\r
\r
ON_EXIT:\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Poll the network interface to do transmit/receive work.\r
\r
  @param  This                   Pointer to the EFI_MANAGED_NETWORK_PROTOCOL\r
                                 instance.\r
\r
  @retval EFI_SUCCESS            Incoming or outgoing data was processed.\r
  @retval EFI_NOT_STARTED        This MNP child driver instance has not been\r
                                 configured.\r
  @retval EFI_DEVICE_ERROR       An unexpected system or network error occurred.\r
                                 The MNP child driver instance has been reset to\r
                                 startup defaults.\r
  @retval EFI_NOT_READY          No incoming or outgoing data was processed.\r
  @retval EFI_TIMEOUT            Data was dropped out of the transmit and/or\r
                                 receive queue.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
MnpPoll (\r
  IN EFI_MANAGED_NETWORK_PROTOCOL  *This\r
  )\r
{\r
  EFI_STATUS         Status;\r
  MNP_INSTANCE_DATA  *Instance;\r
  EFI_TPL            OldTpl;\r
\r
  if (This == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Instance = MNP_INSTANCE_DATA_FROM_THIS (This);\r
\r
  OldTpl = NET_RAISE_TPL (NET_TPL_LOCK);\r
\r
  if (!Instance->Configured) {\r
    Status = EFI_NOT_STARTED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Try to receive packets.\r
  //\r
  Status = MnpReceivePacket (Instance->MnpServiceData);\r
\r
ON_EXIT:\r
  NET_RESTORE_TPL (OldTpl);\r
\r
  return Status;\r
}\r