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

/** @file\r
\r
Copyright (c) 2005 - 2008, 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
  MnpConfig.c\r
\r
Abstract:\r
\r
  Implementation of Managed Network Protocol private services.\r
\r
\r
**/\r
\r
\r
#include "MnpImpl.h"\r
\r
EFI_SERVICE_BINDING_PROTOCOL    mMnpServiceBindingProtocol = {\r
  MnpServiceBindingCreateChild,\r
  MnpServiceBindingDestroyChild\r
};\r
\r
EFI_MANAGED_NETWORK_PROTOCOL    mMnpProtocolTemplate = {\r
  MnpGetModeData,\r
  MnpConfigure,\r
  MnpMcastIpToMac,\r
  MnpGroups,\r
  MnpTransmit,\r
  MnpReceive,\r
  MnpCancel,\r
  MnpPoll\r
};\r
\r
EFI_MANAGED_NETWORK_CONFIG_DATA mMnpDefaultConfigData = {\r
  10000,\r
  10000,\r
  0,\r
  FALSE,\r
  FALSE,\r
  FALSE,\r
  FALSE,\r
  FALSE,\r
  FALSE,\r
  FALSE\r
};\r
\r
STATIC\r
EFI_STATUS\r
MnpAddFreeNbuf (\r
  IN MNP_SERVICE_DATA  *MnpServiceData,\r
  IN UINTN             Count\r
  );\r
\r
STATIC\r
EFI_STATUS\r
MnpStartSnp (\r
  IN EFI_SIMPLE_NETWORK_PROTOCOL  *Snp\r
  );\r
\r
STATIC\r
EFI_STATUS\r
MnpStopSnp (\r
  IN EFI_SIMPLE_NETWORK_PROTOCOL  *Snp\r
  );\r
\r
STATIC\r
EFI_STATUS\r
MnpStart (\r
  IN MNP_SERVICE_DATA  *MnpServiceData,\r
  IN BOOLEAN           IsConfigUpdate,\r
  IN BOOLEAN           EnableSystemPoll\r
  );\r
\r
STATIC\r
EFI_STATUS\r
MnpStop (\r
  IN MNP_SERVICE_DATA  *MnpServiceData\r
  );\r
\r
STATIC\r
EFI_STATUS\r
MnpConfigReceiveFilters (\r
  IN MNP_SERVICE_DATA  *MnpServiceData\r
  );\r
\r
STATIC\r
EFI_STATUS\r
MnpGroupOpAddCtrlBlk (\r
  IN MNP_INSTANCE_DATA        *Instance,\r
  IN MNP_GROUP_CONTROL_BLOCK  *CtrlBlk,\r
  IN MNP_GROUP_ADDRESS        *GroupAddress OPTIONAL,\r
  IN EFI_MAC_ADDRESS          *MacAddress,\r
  IN UINT32                   HwAddressSize\r
  );\r
\r
STATIC\r
BOOLEAN\r
MnpGroupOpDelCtrlBlk (\r
  IN MNP_INSTANCE_DATA        *Instance,\r
  IN MNP_GROUP_CONTROL_BLOCK  *CtrlBlk\r
  );\r
\r
\r
/**\r
  Add some NET_BUF into MnpServiceData->FreeNbufQue. The buffer length of\r
  the NET_BUF is specified by MnpServiceData->BufferLength.\r
\r
  @param  MnpServiceData        Pointer to the MNP_SERVICE_DATA.\r
  @param  Count                 Number of NET_BUFFERs to add.\r
\r
  @retval EFI_SUCCESS           The specified amount of NET_BUFs are allocated and\r
                                added into MnpServiceData->FreeNbufQue.\r
  @retval EFI_OUT_OF_RESOURCES  Failed to allocate a NET_BUF structure.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
MnpAddFreeNbuf (\r
  IN MNP_SERVICE_DATA  *MnpServiceData,\r
  IN UINTN             Count\r
  )\r
{\r
  EFI_STATUS  Status;\r
  UINTN       Index;\r
  NET_BUF     *Nbuf;\r
\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
  ASSERT ((Count > 0) && (MnpServiceData->BufferLength > 0));\r
\r
  Status = EFI_SUCCESS;\r
\r
  for (Index = 0; Index < Count; Index++) {\r
\r
    Nbuf = NetbufAlloc (MnpServiceData->BufferLength + MnpServiceData->PaddingSize);\r
    if (Nbuf == NULL) {\r
\r
      DEBUG ((EFI_D_ERROR, "MnpAddFreeNbuf: NetBufAlloc failed.\n"));\r
      Status = EFI_OUT_OF_RESOURCES;\r
      break;\r
    }\r
\r
    if (MnpServiceData->PaddingSize > 0) {\r
      //\r
      // Pad padding bytes before the media header\r
      //\r
      NetbufAllocSpace (Nbuf, MnpServiceData->PaddingSize, NET_BUF_TAIL);\r
      NetbufTrim (Nbuf, MnpServiceData->PaddingSize, NET_BUF_HEAD);\r
    }\r
\r
    NetbufQueAppend (&MnpServiceData->FreeNbufQue, Nbuf);\r
  }\r
\r
  MnpServiceData->NbufCnt += Index;\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Allocate a free NET_BUF from MnpServiceData->FreeNbufQue. If there is none\r
  in the queue, first try to allocate some and add them into the queue, then\r
  fetch the NET_BUF from the updated FreeNbufQue.\r
\r
  @param  MnpServiceData        Pointer to the MNP_SERVICE_DATA.\r
\r
  @return Pointer to the allocated free NET_BUF structure, if NULL the operation is failed.\r
\r
**/\r
NET_BUF *\r
MnpAllocNbuf (\r
  IN MNP_SERVICE_DATA  *MnpServiceData\r
  )\r
{\r
  EFI_STATUS    Status;\r
  NET_BUF_QUEUE *FreeNbufQue;\r
  NET_BUF       *Nbuf;\r
  EFI_TPL       OldTpl;\r
\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  FreeNbufQue = &MnpServiceData->FreeNbufQue;\r
\r
  OldTpl = gBS->RaiseTPL (TPL_NOTIFY);\r
\r
  //\r
  // Check whether there are available buffers, or else try to add some.\r
  //\r
  if (FreeNbufQue->BufNum == 0) {\r
\r
    if ((MnpServiceData->NbufCnt + MNP_NET_BUFFER_INCREASEMENT) > MNP_MAX_NET_BUFFER_NUM) {\r
\r
      DEBUG (\r
        (EFI_D_ERROR,\r
        "MnpAllocNbuf: The maximum NET_BUF size is reached for MNP driver instance %p.\n",\r
        MnpServiceData)\r
        );\r
\r
      Nbuf = NULL;\r
      goto ON_EXIT;\r
    }\r
\r
    Status = MnpAddFreeNbuf (MnpServiceData, MNP_NET_BUFFER_INCREASEMENT);\r
    if (EFI_ERROR (Status)) {\r
\r
      DEBUG (\r
        (EFI_D_ERROR,\r
        "MnpAllocNbuf: Failed to add NET_BUFs into the FreeNbufQue, %r.\n",\r
        Status)\r
        );\r
      //\r
      // Don't return NULL, perhaps MnpAddFreeNbuf does add some NET_BUFs but\r
      // the amount is less than MNP_NET_BUFFER_INCREASEMENT.\r
      //\r
    }\r
  }\r
\r
  Nbuf = NetbufQueRemove (FreeNbufQue);\r
\r
  //\r
  // Increase the RefCnt.\r
  //\r
  if (Nbuf != NULL) {\r
    NET_GET_REF (Nbuf);\r
  }\r
\r
ON_EXIT:\r
  gBS->RestoreTPL (OldTpl);\r
\r
  return Nbuf;\r
}\r
\r
\r
/**\r
  Try to reclaim the Nbuf into the buffer pool.\r
\r
  @param  MnpServiceData        Pointer to the mnp service context data.\r
  @param  Nbuf                  Pointer to the NET_BUF to free.\r
\r
  @return None.\r
\r
**/\r
VOID\r
MnpFreeNbuf (\r
  IN MNP_SERVICE_DATA  *MnpServiceData,\r
  IN NET_BUF           *Nbuf\r
  )\r
{\r
  EFI_TPL  OldTpl;\r
\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
  ASSERT (Nbuf->RefCnt > 1);\r
\r
  OldTpl = gBS->RaiseTPL (TPL_NOTIFY);\r
\r
  NET_PUT_REF (Nbuf);\r
\r
  if (Nbuf->RefCnt == 1) {\r
    //\r
    // Trim all buffer contained in the Nbuf, then append it to the NbufQue.\r
    //\r
    NetbufTrim (Nbuf, Nbuf->TotalSize, NET_BUF_TAIL);\r
    NetbufQueAppend (&MnpServiceData->FreeNbufQue, Nbuf);\r
  }\r
\r
  gBS->RestoreTPL (OldTpl);\r
}\r
\r
\r
/**\r
  Initialize the mnp service context data.\r
\r
  @param  MnpServiceData        Pointer to the mnp service context data.\r
  @param  Snp                   Pointer to the simple network protocol.\r
\r
  @retval EFI_SUCCESS           The mnp service context is initialized.\r
  @retval Other                 Some error occurs.\r
\r
**/\r
EFI_STATUS\r
MnpInitializeServiceData (\r
  IN MNP_SERVICE_DATA  *MnpServiceData,\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_HANDLE        ControllerHandle\r
  )\r
{\r
  EFI_STATUS                   Status;\r
  EFI_SIMPLE_NETWORK_PROTOCOL  *Snp;\r
  EFI_SIMPLE_NETWORK_MODE      *SnpMode;\r
\r
  MnpServiceData->Signature = MNP_SERVICE_DATA_SIGNATURE;\r
\r
  MnpServiceData->ControllerHandle = ControllerHandle;\r
\r
  //\r
  // Copy the ServiceBinding structure.\r
  //\r
  MnpServiceData->ServiceBinding = mMnpServiceBindingProtocol;\r
\r
  //\r
  // Open the Simple Network protocol.\r
  //\r
  Status = gBS->OpenProtocol (\r
                  ControllerHandle,\r
                  &gEfiSimpleNetworkProtocolGuid,\r
                  (VOID **) &Snp,\r
                  ImageHandle,\r
                  ControllerHandle,\r
                  EFI_OPEN_PROTOCOL_BY_DRIVER\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // Get MTU from Snp.\r
  //\r
  SnpMode             = Snp->Mode;\r
  MnpServiceData->Snp = Snp;\r
  MnpServiceData->Mtu = SnpMode->MaxPacketSize;\r
\r
  //\r
  // Initialize the lists.\r
  //\r
  InitializeListHead (&MnpServiceData->GroupAddressList);\r
  InitializeListHead (&MnpServiceData->ChildrenList);\r
\r
  //\r
  // Get the buffer length used to allocate NET_BUF to hold data received\r
  // from SNP. Do this before fill the FreeNetBufQue.\r
  //\r
  MnpServiceData->BufferLength = MnpServiceData->Mtu + SnpMode->MediaHeaderSize + NET_ETHER_FCS_SIZE;\r
\r
  //\r
  // Make sure the protocol headers immediately following the media header\r
  // 4-byte aligned\r
  //\r
  MnpServiceData->PaddingSize = (4 - SnpMode->MediaHeaderSize) & 0x3;\r
\r
  //\r
  // Initialize the FreeNetBufQue and pre-allocate some NET_BUFs.\r
  //\r
  NetbufQueInit (&MnpServiceData->FreeNbufQue);\r
  Status = MnpAddFreeNbuf (MnpServiceData, MNP_INIT_NET_BUFFER_NUM);\r
  if (EFI_ERROR (Status)) {\r
\r
    DEBUG ((EFI_D_ERROR, "MnpInitializeServiceData: MnpAddFreeNbuf failed, %r.\n", Status));\r
    goto ERROR;\r
  }\r
  //\r
  // Get one NET_BUF from the FreeNbufQue for rx cache.\r
  //\r
  MnpServiceData->RxNbufCache = MnpAllocNbuf (MnpServiceData);\r
  NetbufAllocSpace (\r
    MnpServiceData->RxNbufCache,\r
    MnpServiceData->BufferLength,\r
    NET_BUF_TAIL\r
    );\r
\r
  //\r
  // Allocate buffer pool for tx.\r
  //\r
  MnpServiceData->TxBuf = AllocatePool (MnpServiceData->Mtu + SnpMode->MediaHeaderSize);\r
  if (MnpServiceData->TxBuf == NULL) {\r
\r
    DEBUG ((EFI_D_ERROR, "MnpInitializeServiceData: AllocatePool failed.\n"));\r
    Status = EFI_OUT_OF_RESOURCES;\r
\r
    goto ERROR;\r
  }\r
\r
  //\r
  // Create the system poll timer.\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL | EVT_TIMER,\r
                  TPL_CALLBACK,\r
                  MnpSystemPoll,\r
                  MnpServiceData,\r
                  &MnpServiceData->PollTimer\r
                  );\r
  if (EFI_ERROR (Status)) {\r
\r
    DEBUG ((EFI_D_ERROR, "MnpInitializeServiceData: CreateEvent for poll timer failed.\n"));\r
    goto ERROR;\r
  }\r
\r
  //\r
  // Create the timer for packet timeout check.\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL | EVT_TIMER,\r
                  TPL_CALLBACK,\r
                  MnpCheckPacketTimeout,\r
                  MnpServiceData,\r
                  &MnpServiceData->TimeoutCheckTimer\r
                  );\r
  if (EFI_ERROR (Status)) {\r
\r
    DEBUG ((EFI_D_ERROR, "MnpInitializeServiceData: CreateEvent for packet timeout check failed.\n"));\r
    goto ERROR;\r
  }\r
\r
  //\r
  // Create the timer for tx timeout check.\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_TIMER,\r
                  TPL_CALLBACK,\r
                  NULL,\r
                  NULL,\r
                  &MnpServiceData->TxTimeoutEvent\r
                  );\r
  if (EFI_ERROR (Status)) {\r
\r
    DEBUG ((EFI_D_ERROR, "MnpInitializeServiceData: CreateEvent for tx timeout event failed.\n"));\r
  }\r
\r
ERROR:\r
\r
  if (EFI_ERROR (Status)) {\r
    //\r
    // Free the dynamic allocated resources if necessary.\r
    //\r
    if (MnpServiceData->TimeoutCheckTimer != NULL) {\r
\r
      gBS->CloseEvent (MnpServiceData->TimeoutCheckTimer);\r
    }\r
\r
    if (MnpServiceData->PollTimer != NULL) {\r
\r
      gBS->CloseEvent (MnpServiceData->PollTimer);\r
    }\r
\r
    if (MnpServiceData->TxBuf != NULL) {\r
\r
      gBS->FreePool (MnpServiceData->TxBuf);\r
    }\r
\r
    if (MnpServiceData->RxNbufCache != NULL) {\r
\r
      MnpFreeNbuf (MnpServiceData, MnpServiceData->RxNbufCache);\r
    }\r
\r
    if (MnpServiceData->FreeNbufQue.BufNum != 0) {\r
\r
      NetbufQueFlush (&MnpServiceData->FreeNbufQue);\r
    }\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Flush the mnp service context data.\r
\r
  @param  MnpServiceData        Pointer to the mnp service context data.\r
\r
  @return None.\r
\r
**/\r
VOID\r
MnpFlushServiceData (\r
  MNP_SERVICE_DATA  *MnpServiceData\r
  )\r
{\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  //\r
  // The GroupAddressList must be empty.\r
  //\r
  ASSERT (IsListEmpty (&MnpServiceData->GroupAddressList));\r
\r
  //\r
  // Close the event.\r
  //\r
  gBS->CloseEvent (&MnpServiceData->TxTimeoutEvent);\r
  gBS->CloseEvent (&MnpServiceData->TimeoutCheckTimer);\r
  gBS->CloseEvent (&MnpServiceData->PollTimer);\r
\r
  //\r
  // Free the tx buffer.\r
  //\r
  gBS->FreePool (MnpServiceData->TxBuf);\r
\r
  //\r
  // Free the RxNbufCache.\r
  //\r
  MnpFreeNbuf (MnpServiceData, MnpServiceData->RxNbufCache);\r
\r
  //\r
  // Flush the FreeNbufQue.\r
  //\r
  MnpServiceData->NbufCnt -= MnpServiceData->FreeNbufQue.BufNum;\r
  NetbufQueFlush (&MnpServiceData->FreeNbufQue);\r
\r
  DEBUG_CODE (\r
\r
  if (MnpServiceData->NbufCnt != 0) {\r
\r
    DEBUG ((EFI_D_WARN, "MnpFlushServiceData: Memory leak, MnpServiceData->NbufCnt != 0.\n"));\r
  }\r
  );\r
\r
  //\r
  // Close the Simple Network Protocol.\r
  //\r
  gBS->CloseProtocol (\r
        MnpServiceData->ControllerHandle,\r
        &gEfiSimpleNetworkProtocolGuid,\r
        This->DriverBindingHandle,\r
        MnpServiceData->ControllerHandle\r
        );\r
}\r
\r
\r
/**\r
  Initialize the mnp instance context data.\r
\r
  @param  MnpServiceData        Pointer to the mnp service context data.\r
  @param  Instance              Pointer to the mnp instance context data to\r
                                initialize.\r
\r
  @return None.\r
\r
**/\r
VOID\r
MnpInitializeInstanceData (\r
  IN MNP_SERVICE_DATA   *MnpServiceData,\r
  IN MNP_INSTANCE_DATA  *Instance\r
  )\r
{\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
  ASSERT (Instance != NULL);\r
\r
  //\r
  // Set the signature.\r
  //\r
  Instance->Signature = MNP_INSTANCE_DATA_SIGNATURE;\r
\r
  //\r
  // Copy the MNP Protocol interfaces from the template.\r
  //\r
  CopyMem (&Instance->ManagedNetwork, &mMnpProtocolTemplate, sizeof (Instance->ManagedNetwork));\r
\r
  //\r
  // Copy the default config data.\r
  //\r
  CopyMem (&Instance->ConfigData, &mMnpDefaultConfigData, sizeof (Instance->ConfigData));\r
\r
  //\r
  // Initialize the lists.\r
  //\r
  InitializeListHead (&Instance->GroupCtrlBlkList);\r
  InitializeListHead (&Instance->RcvdPacketQueue);\r
  InitializeListHead (&Instance->RxDeliveredPacketQueue);\r
\r
  //\r
  // Initialize the RxToken Map.\r
  //\r
  NetMapInit (&Instance->RxTokenMap);\r
\r
  //\r
  // Save the MnpServiceData info.\r
  //\r
  Instance->MnpServiceData = MnpServiceData;\r
}\r
\r
\r
/**\r
  Check whether the token specified by Arg maches the token in Item.\r
\r
  @param  Map                   Pointer to the NET_MAP.\r
  @param  Item                  Pointer to the NET_MAP_ITEM\r
  @param  Arg                   Pointer to the Arg, it's a pointer to the token to\r
                                check.\r
\r
  @retval EFI_SUCCESS           The token specified by Arg is different from the\r
                                token in Item.\r
  @retval EFI_ACCESS_DENIED     The token specified by Arg is the same as that in\r
                                Item.\r
\r
**/\r
EFI_STATUS\r
MnpTokenExist (\r
  IN NET_MAP       *Map,\r
  IN NET_MAP_ITEM  *Item,\r
  IN VOID          *Arg\r
  )\r
{\r
  EFI_MANAGED_NETWORK_COMPLETION_TOKEN  *Token;\r
  EFI_MANAGED_NETWORK_COMPLETION_TOKEN  *TokenInItem;\r
\r
  Token       = (EFI_MANAGED_NETWORK_COMPLETION_TOKEN *) Arg;\r
  TokenInItem = (EFI_MANAGED_NETWORK_COMPLETION_TOKEN *) Item->Key;\r
\r
  if ((Token == TokenInItem) || (Token->Event == TokenInItem->Event)) {\r
    //\r
    // The token is the same either the two tokens equals or the Events in\r
    // the two tokens are the same.\r
    //\r
    return EFI_ACCESS_DENIED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Cancel the token specified by Arg if it matches the token in Item.\r
\r
  @param  Map                   Pointer to the NET_MAP.\r
  @param  Item                  Pointer to the NET_MAP_ITEM\r
  @param  Arg                   Pointer to the Arg, it's a pointer to the token to\r
                                cancel.\r
\r
  @retval EFI_SUCCESS           The Arg is NULL, and the token in Item is\r
                                cancelled, or the Arg isn't NULL, and the token in\r
                                Item is different from the Arg.\r
  @retval EFI_ABORTED           The Arg isn't NULL, the token in Item mathces the\r
                                Arg, and the token is cancelled.\r
\r
**/\r
EFI_STATUS\r
MnpCancelTokens (\r
  IN NET_MAP       *Map,\r
  IN NET_MAP_ITEM  *Item,\r
  IN VOID          *Arg\r
  )\r
{\r
  EFI_MANAGED_NETWORK_COMPLETION_TOKEN  *TokenToCancel;\r
\r
  if ((Arg != NULL) && (Item->Key != Arg)) {\r
    //\r
    // The token in Item is not the token specified by Arg.\r
    //\r
    return EFI_SUCCESS;\r
  }\r
\r
  TokenToCancel         = (EFI_MANAGED_NETWORK_COMPLETION_TOKEN *) Item->Key;\r
\r
  //\r
  // Remove the item from the map.\r
  //\r
  NetMapRemoveItem (Map, Item, NULL);\r
\r
  //\r
  // Cancel this token with status set to EFI_ABORTED.\r
  //\r
  TokenToCancel->Status = EFI_ABORTED;\r
  gBS->SignalEvent (TokenToCancel->Event);\r
\r
  if (Arg != NULL) {\r
    //\r
    // Only abort the token specified by Arg if Arg isn't NULL.\r
    //\r
    return EFI_ABORTED;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Start and initialize the simple network.\r
\r
  @param  Snp                   Pointer to the simple network protocol.\r
\r
  @retval EFI_SUCCESS           The simple network protocol is started.\r
  @retval Other                 Some error occurs.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
MnpStartSnp (\r
  IN EFI_SIMPLE_NETWORK_PROTOCOL  *Snp\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  ASSERT (Snp != NULL);\r
\r
  //\r
  // Start the simple network.\r
  //\r
  Status = Snp->Start (Snp);\r
\r
  if (!EFI_ERROR (Status)) {\r
    //\r
    // Initialize the simple network.\r
    //\r
    Status  = Snp->Initialize (Snp, 0, 0);\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Stop the simple network.\r
\r
  @param  Snp                   Pointer to the simple network protocol.\r
\r
  @retval EFI_SUCCESS           The simple network is stopped.\r
  @retval Other                 Some error occurs.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
MnpStopSnp (\r
  IN EFI_SIMPLE_NETWORK_PROTOCOL  *Snp\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  ASSERT (Snp != NULL);\r
\r
  //\r
  // Shut down the simple network.\r
  //\r
  Status = Snp->Shutdown (Snp);\r
\r
  if (!EFI_ERROR (Status)) {\r
    //\r
    // Stop the simple network.\r
    //\r
    Status = Snp->Stop (Snp);\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Start the managed network, this function is called when one instance is configured\r
  or reconfigured.\r
\r
  @param  MnpServiceData        Pointer to the mnp service context data.\r
  @param  IsConfigUpdate        The instance is reconfigured or it's the first time\r
                                 the instanced is configured.\r
  @param  EnableSystemPoll      Enable the system polling or not.\r
\r
  @retval EFI_SUCCESS           The managed network is started and some\r
                                configuration is updated.\r
  @retval Other                 Some error occurs.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
MnpStart (\r
  IN MNP_SERVICE_DATA  *MnpServiceData,\r
  IN BOOLEAN           IsConfigUpdate,\r
  IN BOOLEAN           EnableSystemPoll\r
  )\r
{\r
  EFI_STATUS      Status;\r
  EFI_TIMER_DELAY TimerOpType;\r
\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  Status = EFI_SUCCESS;\r
\r
  if (!IsConfigUpdate) {\r
    //\r
    // If it's not a configuration update, increase the configured children number.\r
    //\r
    MnpServiceData->ConfiguredChildrenNumber++;\r
\r
    if (MnpServiceData->ConfiguredChildrenNumber == 1) {\r
      //\r
      // It's the first configured child, start the simple network.\r
      //\r
      Status = MnpStartSnp (MnpServiceData->Snp);\r
      if (EFI_ERROR (Status)) {\r
\r
        DEBUG ((EFI_D_ERROR, "MnpStart: MnpStartSnp failed, %r.\n", Status));\r
        goto ErrorExit;\r
      }\r
\r
      //\r
      // Start the timeout timer.\r
      //\r
      Status = gBS->SetTimer (\r
                      MnpServiceData->TimeoutCheckTimer,\r
                      TimerPeriodic,\r
                      MNP_TIMEOUT_CHECK_INTERVAL\r
                      );\r
      if (EFI_ERROR (Status)) {\r
\r
        DEBUG (\r
          (EFI_D_ERROR,\r
          "MnpStart, gBS->SetTimer for TimeoutCheckTimer %r.\n",\r
          Status)\r
          );\r
        goto ErrorExit;\r
      }\r
    }\r
  }\r
\r
  if (MnpServiceData->EnableSystemPoll ^ EnableSystemPoll) {\r
    //\r
    // The EnableSystemPoll differs with the current state, disable or enable\r
    // the system poll.\r
    //\r
    TimerOpType = EnableSystemPoll ? TimerPeriodic : TimerCancel;\r
\r
    Status      = gBS->SetTimer (MnpServiceData->PollTimer, TimerOpType, MNP_SYS_POLL_INTERVAL);\r
    if (EFI_ERROR (Status)) {\r
\r
      DEBUG ((EFI_D_ERROR, "MnpStart: gBS->SetTimer for PollTimer failed, %r.\n", Status));\r
      goto ErrorExit;\r
    }\r
\r
    MnpServiceData->EnableSystemPoll = EnableSystemPoll;\r
  }\r
\r
  //\r
  // Change the receive filters if need.\r
  //\r
  Status = MnpConfigReceiveFilters (MnpServiceData);\r
\r
ErrorExit:\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Stop the managed network.\r
\r
  @param  MnpServiceData        Pointer to the mnp service context data.\r
\r
  @retval EFI_SUCCESS           The managed network is stopped.\r
  @retval Other                 Some error occurs.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
MnpStop (\r
  IN MNP_SERVICE_DATA  *MnpServiceData\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
  ASSERT (MnpServiceData->ConfiguredChildrenNumber > 0);\r
\r
  //\r
  // Configure the receive filters.\r
  //\r
  MnpConfigReceiveFilters (MnpServiceData);\r
\r
  //\r
  // Decrease the children number.\r
  //\r
  MnpServiceData->ConfiguredChildrenNumber--;\r
\r
  if (MnpServiceData->ConfiguredChildrenNumber > 0) {\r
    //\r
    // If there are other configured chilren, return and keep the timers and\r
    // simple network unchanged.\r
    //\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // No configured children now.\r
  //\r
\r
  if (MnpServiceData->EnableSystemPoll) {\r
    //\r
    //  The system poll in on, cancel the poll timer.\r
    //\r
    Status  = gBS->SetTimer (MnpServiceData->PollTimer, TimerCancel, 0);\r
    MnpServiceData->EnableSystemPoll = FALSE;\r
  }\r
\r
  //\r
  // Cancel the timeout timer.\r
  //\r
  Status  = gBS->SetTimer (MnpServiceData->TimeoutCheckTimer, TimerCancel, 0);\r
\r
  //\r
  // Stop the simple network.\r
  //\r
  Status  = MnpStopSnp (MnpServiceData->Snp);\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Flush the instance's received data.\r
\r
  @param  Instance              Pointer to the mnp instance context data.\r
\r
  @return None.\r
\r
**/\r
VOID\r
MnpFlushRcvdDataQueue (\r
  IN MNP_INSTANCE_DATA  *Instance\r
  )\r
{\r
  EFI_TPL          OldTpl;\r
  MNP_RXDATA_WRAP *RxDataWrap;\r
\r
  NET_CHECK_SIGNATURE (Instance, MNP_INSTANCE_DATA_SIGNATURE);\r
\r
  OldTpl = gBS->RaiseTPL (TPL_NOTIFY);\r
\r
  while (!IsListEmpty (&Instance->RcvdPacketQueue)) {\r
    //\r
    // Remove all the Wraps.\r
    //\r
    RxDataWrap = NET_LIST_HEAD (&Instance->RcvdPacketQueue, MNP_RXDATA_WRAP, WrapEntry);\r
\r
    //\r
    // Recycle the RxDataWrap.\r
    //\r
    MnpRecycleRxData (NULL, (VOID *) RxDataWrap);\r
    Instance->RcvdPacketQueueSize--;\r
  }\r
\r
  ASSERT (Instance->RcvdPacketQueueSize == 0);\r
\r
  gBS->RestoreTPL (OldTpl);\r
}\r
\r
\r
/**\r
  Configure the Instance using ConfigData.\r
\r
  @param  Instance              Pointer to the mnp instance context data.\r
  @param  ConfigData            Pointer to the configuration data used to configure\r
                                the isntance.\r
\r
  @retval EFI_SUCCESS           The Instance is configured.\r
  @retval EFI_UNSUPPORTED       EnableReceiveTimestamps is on and the\r
                                implementation doesn't support it.\r
  @retval Other                 Some error occurs.\r
\r
**/\r
EFI_STATUS\r
MnpConfigureInstance (\r
  IN MNP_INSTANCE_DATA                *Instance,\r
  IN EFI_MANAGED_NETWORK_CONFIG_DATA  *ConfigData OPTIONAL\r
  )\r
{\r
  EFI_STATUS                      Status;\r
  MNP_SERVICE_DATA                *MnpServiceData;\r
  EFI_MANAGED_NETWORK_CONFIG_DATA *OldConfigData;\r
  EFI_MANAGED_NETWORK_CONFIG_DATA *NewConfigData;\r
  BOOLEAN                         IsConfigUpdate;\r
\r
  NET_CHECK_SIGNATURE (Instance, MNP_INSTANCE_DATA_SIGNATURE);\r
\r
  if ((ConfigData != NULL) && ConfigData->EnableReceiveTimestamps) {\r
    //\r
    // Don't support timestamp.\r
    //\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  Status          = EFI_SUCCESS;\r
\r
  MnpServiceData  = Instance->MnpServiceData;\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  IsConfigUpdate  = (BOOLEAN) ((Instance->Configured) && (ConfigData != NULL));\r
\r
  OldConfigData   = &Instance->ConfigData;\r
  NewConfigData   = ConfigData;\r
  if (NewConfigData == NULL) {\r
    //\r
    // Restore back the default config data if a reset of this instance\r
    // is required.\r
    //\r
    NewConfigData = &mMnpDefaultConfigData;\r
  }\r
\r
  //\r
  // Reset the instance's receive filter.\r
  //\r
  Instance->ReceiveFilter = 0;\r
\r
  //\r
  // Clear the receive counters according to the old ConfigData.\r
  //\r
  if (OldConfigData->EnableUnicastReceive) {\r
    MnpServiceData->UnicastCount--;\r
  }\r
\r
  if (OldConfigData->EnableMulticastReceive) {\r
    MnpServiceData->MulticastCount--;\r
  }\r
\r
  if (OldConfigData->EnableBroadcastReceive) {\r
    MnpServiceData->BroadcastCount--;\r
  }\r
\r
  if (OldConfigData->EnablePromiscuousReceive) {\r
    MnpServiceData->PromiscuousCount--;\r
  }\r
\r
  //\r
  // Set the receive filter counters and the receive filter of the\r
  // instance according to the new ConfigData.\r
  //\r
  if (NewConfigData->EnableUnicastReceive) {\r
    MnpServiceData->UnicastCount++;\r
    Instance->ReceiveFilter |= MNP_RECEIVE_UNICAST;\r
  }\r
\r
  if (NewConfigData->EnableMulticastReceive) {\r
    MnpServiceData->MulticastCount++;\r
  }\r
\r
  if (NewConfigData->EnableBroadcastReceive) {\r
    MnpServiceData->BroadcastCount++;\r
    Instance->ReceiveFilter |= MNP_RECEIVE_BROADCAST;\r
  }\r
\r
  if (NewConfigData->EnablePromiscuousReceive) {\r
    MnpServiceData->PromiscuousCount++;\r
  }\r
\r
  if (OldConfigData->FlushQueuesOnReset) {\r
\r
    MnpFlushRcvdDataQueue (Instance);\r
  }\r
\r
  if (ConfigData == NULL) {\r
\r
    Instance->ManagedNetwork.Cancel (&Instance->ManagedNetwork, NULL);\r
  }\r
\r
  if (!NewConfigData->EnableMulticastReceive) {\r
\r
    MnpGroupOp (Instance, FALSE, NULL, NULL);\r
  }\r
\r
  //\r
  // Save the new configuration data.\r
  //\r
  CopyMem (OldConfigData, NewConfigData, sizeof (*OldConfigData));\r
\r
  Instance->Configured  = (BOOLEAN) (ConfigData != NULL);\r
\r
  if (Instance->Configured) {\r
    //\r
    // The instance is configured, start the Mnp.\r
    //\r
    Status = MnpStart (\r
              MnpServiceData,\r
              IsConfigUpdate,\r
              (BOOLEAN) !NewConfigData->DisableBackgroundPolling\r
              );\r
  } else {\r
    //\r
    // The instance is changed to the unconfigured state, stop the Mnp.\r
    //\r
    Status = MnpStop (MnpServiceData);\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Configure the Snp receive filters according to the instances' receive filter\r
  settings.\r
\r
  @param  MnpServiceData        Pointer to the mnp service context data.\r
\r
  @retval EFI_SUCCESS           The receive filters is configured.\r
  @retval EFI_OUT_OF_RESOURCES  The receive filters can't be configured due to lack\r
                                of memory resource.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
MnpConfigReceiveFilters (\r
  IN MNP_SERVICE_DATA  *MnpServiceData\r
  )\r
{\r
  EFI_STATUS                  Status;\r
  EFI_SIMPLE_NETWORK_PROTOCOL *Snp;\r
  EFI_MAC_ADDRESS             *MCastFilter;\r
  UINT32                      MCastFilterCnt;\r
  UINT32                      EnableFilterBits;\r
  UINT32                      DisableFilterBits;\r
  BOOLEAN                     ResetMCastFilters;\r
  LIST_ENTRY                  *Entry;\r
  UINT32                      Index;\r
  MNP_GROUP_ADDRESS           *GroupAddress;\r
\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  Snp = MnpServiceData->Snp;\r
\r
  //\r
  // Initialize the enable filter and disable filter.\r
  //\r
  EnableFilterBits  = 0;\r
  DisableFilterBits = Snp->Mode->ReceiveFilterMask;\r
\r
  if (MnpServiceData->UnicastCount != 0) {\r
    //\r
    // Enable unicast if any instance wants to receive unicast.\r
    //\r
    EnableFilterBits |= EFI_SIMPLE_NETWORK_RECEIVE_UNICAST;\r
  }\r
\r
  if (MnpServiceData->BroadcastCount != 0) {\r
    //\r
    // Enable broadcast if any instance wants to receive broadcast.\r
    //\r
    EnableFilterBits |= EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST;\r
  }\r
\r
  MCastFilter       = NULL;\r
  MCastFilterCnt    = 0;\r
  ResetMCastFilters = TRUE;\r
\r
  if ((MnpServiceData->MulticastCount != 0) && (MnpServiceData->GroupAddressCount != 0)) {\r
    //\r
    // There are instances configured to receive multicast and already some group\r
    // addresses are joined.\r
    //\r
\r
    ResetMCastFilters = FALSE;\r
\r
    if (MnpServiceData->GroupAddressCount <= Snp->Mode->MaxMCastFilterCount) {\r
      //\r
      // The joind group address is less than simple network's maximum count.\r
      // Just configure the snp to do the multicast filtering.\r
      //\r
\r
      EnableFilterBits |= EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST;\r
\r
      //\r
      // Allocate pool for the mulicast addresses.\r
      //\r
      MCastFilterCnt  = MnpServiceData->GroupAddressCount;\r
      MCastFilter     = AllocatePool (sizeof (EFI_MAC_ADDRESS) * MCastFilterCnt);\r
      if (MCastFilter == NULL) {\r
\r
        DEBUG ((EFI_D_ERROR, "MnpConfigReceiveFilters: Failed to allocate memory resource for MCastFilter.\n"));\r
        return EFI_OUT_OF_RESOURCES;\r
      }\r
\r
      //\r
      // Fill the multicast HW address buffer.\r
      //\r
      Index = 0;\r
      NET_LIST_FOR_EACH (Entry, &MnpServiceData->GroupAddressList) {\r
\r
        GroupAddress            = NET_LIST_USER_STRUCT (Entry, MNP_GROUP_ADDRESS, AddrEntry);\r
        CopyMem (MCastFilter + Index, &GroupAddress->Address, sizeof (*(MCastFilter + Index)));\r
        Index++;\r
\r
        ASSERT (Index <= MCastFilterCnt);\r
      }\r
    } else {\r
      //\r
      // The maximum multicast is reached, set the filter to be promiscuous\r
      // multicast.\r
      //\r
\r
      if (Snp->Mode->ReceiveFilterMask & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST) {\r
        EnableFilterBits |= EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST;\r
      } else {\r
        //\r
        // Either MULTICAST or PROMISCUOUS_MULTICAST is not supported by Snp,\r
        // set the NIC to be promiscuous although this will tremendously degrade\r
        // the performance.\r
        //\r
        EnableFilterBits |= EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS;\r
      }\r
    }\r
  }\r
\r
  if (MnpServiceData->PromiscuousCount != 0) {\r
    //\r
    // Enable promiscuous if any instance wants to receive promiscuous.\r
    //\r
    EnableFilterBits |= EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS;\r
  }\r
\r
  //\r
  // Set the disable filter.\r
  //\r
  DisableFilterBits ^= EnableFilterBits;\r
\r
  //\r
  // Configure the receive filters of SNP.\r
  //\r
  Status = Snp->ReceiveFilters (\r
                  Snp,\r
                  EnableFilterBits,\r
                  DisableFilterBits,\r
                  ResetMCastFilters,\r
                  MCastFilterCnt,\r
                  MCastFilter\r
                  );\r
  DEBUG_CODE (\r
    if (EFI_ERROR (Status)) {\r
\r
    DEBUG (\r
      (EFI_D_ERROR,\r
      "MnpConfigReceiveFilters: Snp->ReceiveFilters failed, %r.\n",\r
      Status)\r
      );\r
  }\r
  );\r
\r
  if (MCastFilter != NULL) {\r
    //\r
    // Free the buffer used to hold the group addresses.\r
    //\r
    gBS->FreePool (MCastFilter);\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Add a group address control block which controls the MacAddress for\r
  this instance.\r
\r
  @param  Instance              Pointer to the mnp instance context data.\r
  @param  CtrlBlk               Pointer to the group address control block.\r
  @param  GroupAddress          Pointer to the group adress.\r
  @param  MacAddress            Pointer to the mac address.\r
  @param  HwAddressSize         The hardware address size.\r
\r
  @retval EFI_SUCCESS           The group address control block is added.\r
  @retval EFI_OUT_OF_RESOURCE   Failed due to lack of memory resources.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
MnpGroupOpAddCtrlBlk (\r
  IN MNP_INSTANCE_DATA        *Instance,\r
  IN MNP_GROUP_CONTROL_BLOCK  *CtrlBlk,\r
  IN MNP_GROUP_ADDRESS        *GroupAddress OPTIONAL,\r
  IN EFI_MAC_ADDRESS          *MacAddress,\r
  IN UINT32                   HwAddressSize\r
  )\r
{\r
  MNP_SERVICE_DATA  *MnpServiceData;\r
\r
  NET_CHECK_SIGNATURE (Instance, MNP_INSTANCE_DATA_SIGNATURE);\r
\r
  MnpServiceData = Instance->MnpServiceData;\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  if (GroupAddress == NULL) {\r
\r
    ASSERT (MacAddress != NULL);\r
\r
    //\r
    // Allocate a new GroupAddress to be added into MNP's GroupAddressList.\r
    //\r
    GroupAddress = AllocatePool (sizeof (MNP_GROUP_ADDRESS));\r
    if (GroupAddress == NULL) {\r
\r
      DEBUG ((EFI_D_ERROR, "MnpGroupOpFormCtrlBlk: Failed to allocate memory resource.\n"));\r
\r
      return EFI_OUT_OF_RESOURCES;\r
    }\r
\r
    CopyMem (&GroupAddress->Address, MacAddress, sizeof (GroupAddress->Address));\r
    GroupAddress->RefCnt  = 0;\r
    InsertTailList (\r
      &MnpServiceData->GroupAddressList,\r
      &GroupAddress->AddrEntry\r
      );\r
    MnpServiceData->GroupAddressCount++;\r
  }\r
\r
  //\r
  // Increase the RefCnt.\r
  //\r
  GroupAddress->RefCnt++;\r
\r
  //\r
  // Add the CtrlBlk into the instance's GroupCtrlBlkList.\r
  //\r
  CtrlBlk->GroupAddress = GroupAddress;\r
  InsertTailList (&Instance->GroupCtrlBlkList, &CtrlBlk->CtrlBlkEntry);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
\r
/**\r
  Delete a group control block from the instance. If the controlled group address's\r
  reference count reaches zero, the group address is removed too.\r
\r
  @param  Instance              Pointer to the instance context data.\r
  @param  CtrlBlk               Pointer to the group control block to delete.\r
\r
  @return The group address controlled by the control block is no longer used or not.\r
\r
**/\r
STATIC\r
BOOLEAN\r
MnpGroupOpDelCtrlBlk (\r
  IN MNP_INSTANCE_DATA        *Instance,\r
  IN MNP_GROUP_CONTROL_BLOCK  *CtrlBlk\r
  )\r
{\r
  MNP_SERVICE_DATA  *MnpServiceData;\r
  MNP_GROUP_ADDRESS *GroupAddress;\r
\r
  NET_CHECK_SIGNATURE (Instance, MNP_INSTANCE_DATA_SIGNATURE);\r
\r
  MnpServiceData = Instance->MnpServiceData;\r
  NET_CHECK_SIGNATURE (MnpServiceData, MNP_SERVICE_DATA_SIGNATURE);\r
\r
  //\r
  // Remove and free the CtrlBlk.\r
  //\r
  GroupAddress = CtrlBlk->GroupAddress;\r
  RemoveEntryList (&CtrlBlk->CtrlBlkEntry);\r
  gBS->FreePool (CtrlBlk);\r
\r
  ASSERT (GroupAddress->RefCnt > 0);\r
\r
  //\r
  // Count down the RefCnt.\r
  //\r
  GroupAddress->RefCnt--;\r
\r
  if (GroupAddress->RefCnt == 0) {\r
    //\r
    // Free this GroupAddress entry if no instance uses it.\r
    //\r
    MnpServiceData->GroupAddressCount--;\r
    RemoveEntryList (&GroupAddress->AddrEntry);\r
    gBS->FreePool (GroupAddress);\r
\r
    return TRUE;\r
  }\r
\r
  return FALSE;\r
}\r
\r
\r
/**\r
  Do the group operations for this instance.\r
\r
  @param  Instance              Pointer to the instance context data.\r
  @param  JoinFlag              Set to TRUE to join a group. Set to TRUE to leave a\r
                                group/groups.\r
  @param  MacAddress            Pointer to the group address to join or leave.\r
  @param  CtrlBlk               Pointer to the group control block if JoinFlag if\r
                                FALSE.\r
\r
  @retval EFI_SUCCESS           The group operation finished.\r
  @retval Other                 Some error occurs.\r
\r
**/\r
EFI_STATUS\r
MnpGroupOp (\r
  IN MNP_INSTANCE_DATA        *Instance,\r
  IN BOOLEAN                  JoinFlag,\r
  IN EFI_MAC_ADDRESS          *MacAddress OPTIONAL,\r
  IN MNP_GROUP_CONTROL_BLOCK  *CtrlBlk OPTIONAL\r
  )\r
{\r
  MNP_SERVICE_DATA        *MnpServiceData;\r
  LIST_ENTRY              *Entry;\r
  LIST_ENTRY              *NextEntry;\r
  MNP_GROUP_ADDRESS       *GroupAddress;\r
  EFI_SIMPLE_NETWORK_MODE *SnpMode;\r
  MNP_GROUP_CONTROL_BLOCK *NewCtrlBlk;\r
  EFI_STATUS              Status;\r
  BOOLEAN                 AddressExist;\r
  BOOLEAN                 NeedUpdate;\r
\r
  NET_CHECK_SIGNATURE (Instance, MNP_INSTANCE_DATA_SIGNATURE);\r
\r
  MnpServiceData  = Instance->MnpServiceData;\r
  SnpMode         = MnpServiceData->Snp->Mode;\r
\r
  if (JoinFlag) {\r
    //\r
    // A new gropu address is to be added.\r
    //\r
\r
    GroupAddress  = NULL;\r
    AddressExist  = FALSE;\r
\r
    //\r
    // Allocate memory for the control block.\r
    //\r
    NewCtrlBlk    = AllocatePool (sizeof (MNP_GROUP_CONTROL_BLOCK));\r
    if (NewCtrlBlk == NULL) {\r
\r
      DEBUG ((EFI_D_ERROR, "MnpGroupOp: Failed to allocate memory resource.\n"));\r
      return EFI_OUT_OF_RESOURCES;\r
    }\r
\r
    NET_LIST_FOR_EACH (Entry, &MnpServiceData->GroupAddressList) {\r
      //\r
      // Check whether the MacAddress is already joined by other instances.\r
      //\r
      GroupAddress = NET_LIST_USER_STRUCT (Entry, MNP_GROUP_ADDRESS, AddrEntry);\r
      if (0 == CompareMem (\r
                MacAddress,\r
                &GroupAddress->Address,\r
                SnpMode->HwAddressSize\r
                )) {\r
\r
        AddressExist = TRUE;\r
        break;\r
      }\r
    }\r
\r
    if (!AddressExist) {\r
      GroupAddress = NULL;\r
    }\r
\r
    //\r
    // Add the GroupAddress for this instance.\r
    //\r
    Status = MnpGroupOpAddCtrlBlk (\r
              Instance,\r
              NewCtrlBlk,\r
              GroupAddress,\r
              MacAddress,\r
              SnpMode->HwAddressSize\r
              );\r
    if (EFI_ERROR (Status)) {\r
\r
      return Status;\r
    }\r
\r
    NeedUpdate = TRUE;\r
  } else {\r
\r
    if (MacAddress != NULL) {\r
\r
      ASSERT (CtrlBlk != NULL);\r
\r
      //\r
      // Leave the specific multicast mac address.\r
      //\r
      NeedUpdate = MnpGroupOpDelCtrlBlk (Instance, CtrlBlk);\r
    } else {\r
      //\r
      // Leave all multicast mac addresses.\r
      //\r
      NeedUpdate = FALSE;\r
\r
      NET_LIST_FOR_EACH_SAFE (Entry, NextEntry, &Instance->GroupCtrlBlkList) {\r
\r
        NewCtrlBlk = NET_LIST_USER_STRUCT (\r
                      Entry,\r
                      MNP_GROUP_CONTROL_BLOCK,\r
                      CtrlBlkEntry\r
                      );\r
        //\r
        // Update is required if the group address left is no longer used\r
        // by other instances.\r
        //\r
        NeedUpdate = MnpGroupOpDelCtrlBlk (Instance, NewCtrlBlk);\r
      }\r
    }\r
  }\r
\r
  Status = EFI_SUCCESS;\r
\r
  if (NeedUpdate) {\r
    //\r
    // Reconfigure the receive filters if necessary.\r
    //\r
    Status = MnpConfigReceiveFilters (MnpServiceData);\r
  }\r
\r
  return Status;\r
}\r