rename

git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@4725 6f19259b-4bc3-4df7-8a09-765794883524

1 files changed, 406 insertions, 0 deletions

diff --git a/MdeModulePkg/Universal/Network/SnpDxe/Receive_filters.c b/MdeModulePkg/Universal/Network/SnpDxe/Receive_filters.c
new file mode 100644
index 0000000..3886d20
--- /dev/null
+++ b/MdeModulePkg/Universal/Network/SnpDxe/Receive_filters.c
@@ -0,0 +1,406 @@
+/** @file

+Copyright (c) 2004 - 2007, Intel Corporation

+All rights reserved. This program and the accompanying materials

+are licensed and made available under the terms and conditions of the BSD License

+which accompanies this distribution.  The full text of the license may be found at

+http://opensource.org/licenses/bsd-license.php

+

+THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,

+WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.

+

+Module name:

+  receive_filters.c

+

+Abstract:

+

+Revision history:

+  2000-Feb-17 M(f)J   Genesis.

+

+**/

+

+

+

+#include "Snp.h"

+

+/**

+  this routine calls undi to enable the receive filters.

+

+  @param  snp                pointer to snp driver structure

+  @param  EnableFlags        bit mask for enabling the receive filters

+  @param  MCastAddressCount  multicast address count for a new multicast address

+                             list

+  @param  MCastAddressList   list of new multicast addresses

+

+

+**/

+STATIC

+EFI_STATUS

+pxe_rcvfilter_enable (

+  SNP_DRIVER      *snp,

+  UINT32          EnableFlags,

+  UINTN           MCastAddressCount,

+  EFI_MAC_ADDRESS *MCastAddressList

+  )

+{

+  snp->cdb.OpCode     = PXE_OPCODE_RECEIVE_FILTERS;

+  snp->cdb.OpFlags    = PXE_OPFLAGS_RECEIVE_FILTER_ENABLE;

+  snp->cdb.CPBsize    = PXE_CPBSIZE_NOT_USED;

+  snp->cdb.DBsize     = PXE_DBSIZE_NOT_USED;

+  snp->cdb.CPBaddr    = PXE_CPBADDR_NOT_USED;

+  snp->cdb.DBaddr     = PXE_DBADDR_NOT_USED;

+  snp->cdb.StatCode   = PXE_STATCODE_INITIALIZE;

+  snp->cdb.StatFlags  = PXE_STATFLAGS_INITIALIZE;

+  snp->cdb.IFnum      = snp->if_num;

+  snp->cdb.Control    = PXE_CONTROL_LAST_CDB_IN_LIST;

+

+  if ((EnableFlags & EFI_SIMPLE_NETWORK_RECEIVE_UNICAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_UNICAST;

+  }

+

+  if ((EnableFlags & EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_BROADCAST;

+  }

+

+  if ((EnableFlags & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_PROMISCUOUS;

+  }

+

+  if ((EnableFlags & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_ALL_MULTICAST;

+  }

+

+  if ((EnableFlags & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_FILTERED_MULTICAST;

+  }

+

+  if (MCastAddressCount != 0) {

+    snp->cdb.CPBsize  = (UINT16) (MCastAddressCount * sizeof (EFI_MAC_ADDRESS));

+    snp->cdb.CPBaddr  = (UINT64)(UINTN) snp->cpb;

+    CopyMem (snp->cpb, MCastAddressList, snp->cdb.CPBsize);

+  }

+  //

+  // Issue UNDI command and check result.

+  //

+  DEBUG ((EFI_D_NET, "\nsnp->undi.receive_filters()  "));

+

+  (*snp->issue_undi32_command) ((UINT64)(UINTN) &snp->cdb);

+

+  if (snp->cdb.StatCode != EFI_SUCCESS) {

+    //

+    // UNDI command failed.  Return UNDI status to caller.

+    //

+    DEBUG (

+      (EFI_D_ERROR,

+      "\nsnp->undi.receive_filters()  %xh:%xh\n",

+      snp->cdb.StatFlags,

+      snp->cdb.StatCode)

+      );

+

+    switch (snp->cdb.StatCode) {

+    case PXE_STATCODE_INVALID_CDB:

+    case PXE_STATCODE_INVALID_CPB:

+    case PXE_STATCODE_INVALID_PARAMETER:

+      return EFI_INVALID_PARAMETER;

+

+    case PXE_STATCODE_UNSUPPORTED:

+      return EFI_UNSUPPORTED;

+    }

+

+    return EFI_DEVICE_ERROR;

+  }

+

+  return EFI_SUCCESS;

+}

+

+/**

+  this routine calls undi to disable the receive filters.

+

+  @param  snp                pointer to snp driver structure

+  @param  DisableFlags       bit mask for disabling the receive filters

+  @param  ResetMCastList     boolean flag to reset/delete the multicast filter list

+

+

+**/

+STATIC

+EFI_STATUS

+pxe_rcvfilter_disable (

+  SNP_DRIVER *snp,

+  UINT32     DisableFlags,

+  BOOLEAN    ResetMCastList

+  )

+{

+  snp->cdb.OpCode     = PXE_OPCODE_RECEIVE_FILTERS;

+  snp->cdb.CPBsize    = PXE_CPBSIZE_NOT_USED;

+  snp->cdb.DBsize     = PXE_DBSIZE_NOT_USED;

+  snp->cdb.CPBaddr    = PXE_CPBADDR_NOT_USED;

+  snp->cdb.DBaddr     = PXE_DBADDR_NOT_USED;

+  snp->cdb.StatCode   = PXE_STATCODE_INITIALIZE;

+  snp->cdb.StatFlags  = PXE_STATFLAGS_INITIALIZE;

+  snp->cdb.IFnum      = snp->if_num;

+  snp->cdb.Control    = PXE_CONTROL_LAST_CDB_IN_LIST;

+

+  snp->cdb.OpFlags    = (UINT16) (DisableFlags ? PXE_OPFLAGS_RECEIVE_FILTER_DISABLE : PXE_OPFLAGS_NOT_USED);

+

+  if (ResetMCastList) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_RESET_MCAST_LIST;

+  }

+

+  if ((DisableFlags & EFI_SIMPLE_NETWORK_RECEIVE_UNICAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_UNICAST;

+  }

+

+  if ((DisableFlags & EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_BROADCAST;

+  }

+

+  if ((DisableFlags & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_PROMISCUOUS;

+  }

+

+  if ((DisableFlags & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_ALL_MULTICAST;

+  }

+

+  if ((DisableFlags & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) != 0) {

+    snp->cdb.OpFlags |= PXE_OPFLAGS_RECEIVE_FILTER_FILTERED_MULTICAST;

+  }

+  //

+  // Issue UNDI command and check result.

+  //

+  DEBUG ((EFI_D_NET, "\nsnp->undi.receive_filters()  "));

+

+  (*snp->issue_undi32_command) ((UINT64)(UINTN) &snp->cdb);

+

+  if (snp->cdb.StatCode != EFI_SUCCESS) {

+    //

+    // UNDI command failed.  Return UNDI status to caller.

+    //

+    DEBUG (

+      (EFI_D_ERROR,

+      "\nsnp->undi.receive_filters()  %xh:%xh\n",

+      snp->cdb.StatFlags,

+      snp->cdb.StatCode)

+      );

+

+    return EFI_DEVICE_ERROR;

+  }

+

+  return EFI_SUCCESS;

+}

+

+/**

+  this routine calls undi to read the receive filters.

+

+  @param  snp                pointer to snp driver structure

+

+

+**/

+STATIC

+EFI_STATUS

+pxe_rcvfilter_read (

+  SNP_DRIVER *snp

+  )

+{

+  snp->cdb.OpCode   = PXE_OPCODE_RECEIVE_FILTERS;

+  snp->cdb.OpFlags  = PXE_OPFLAGS_RECEIVE_FILTER_READ;

+  snp->cdb.CPBsize  = PXE_CPBSIZE_NOT_USED;

+  snp->cdb.DBsize   = (UINT16) (snp->mode.MaxMCastFilterCount * sizeof (EFI_MAC_ADDRESS));

+  snp->cdb.CPBaddr  = PXE_CPBADDR_NOT_USED;

+  if (snp->cdb.DBsize == 0) {

+    snp->cdb.DBaddr = (UINT64)(UINTN) NULL;

+  } else {

+    snp->cdb.DBaddr = (UINT64)(UINTN) snp->db;

+    ZeroMem (snp->db, snp->cdb.DBsize);

+  }

+

+  snp->cdb.StatCode   = PXE_STATCODE_INITIALIZE;

+  snp->cdb.StatFlags  = PXE_STATFLAGS_INITIALIZE;

+  snp->cdb.IFnum      = snp->if_num;

+  snp->cdb.Control    = PXE_CONTROL_LAST_CDB_IN_LIST;

+

+  DEBUG ((EFI_D_NET, "\nsnp->undi.receive_filters()  "));

+

+  (*snp->issue_undi32_command) ((UINT64)(UINTN) &snp->cdb);

+

+  if (snp->cdb.StatCode != EFI_SUCCESS) {

+    //

+    // UNDI command failed.  Return UNDI status to caller.

+    //

+    DEBUG (

+      (EFI_D_ERROR,

+      "\nsnp->undi.receive_filters()  %xh:%xh\n",

+      snp->cdb.StatFlags,

+      snp->cdb.StatCode)

+      );

+

+    return EFI_DEVICE_ERROR;

+  }

+  //

+  // Convert UNDI32 StatFlags to EFI SNP filter flags.

+  //

+  snp->mode.ReceiveFilterSetting = 0;

+

+  if ((snp->cdb.StatFlags & PXE_STATFLAGS_RECEIVE_FILTER_UNICAST) != 0) {

+    snp->mode.ReceiveFilterSetting |= EFI_SIMPLE_NETWORK_RECEIVE_UNICAST;

+  }

+

+  if ((snp->cdb.StatFlags & PXE_STATFLAGS_RECEIVE_FILTER_BROADCAST) != 0) {

+    snp->mode.ReceiveFilterSetting |= EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST;

+  }

+

+  if ((snp->cdb.StatFlags & PXE_STATFLAGS_RECEIVE_FILTER_PROMISCUOUS) != 0) {

+    snp->mode.ReceiveFilterSetting |= EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS;

+  }

+

+  if ((snp->cdb.StatFlags & PXE_STATFLAGS_RECEIVE_FILTER_ALL_MULTICAST) != 0) {

+    snp->mode.ReceiveFilterSetting |= EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST;

+  }

+

+  if ((snp->cdb.StatFlags & PXE_STATFLAGS_RECEIVE_FILTER_FILTERED_MULTICAST) != 0) {

+    snp->mode.ReceiveFilterSetting |= EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST;

+  }

+

+  CopyMem (snp->mode.MCastFilter, snp->db, snp->cdb.DBsize);

+

+  //

+  // Count number of active entries in multicast filter list.

+  //

+  {

+    EFI_MAC_ADDRESS ZeroMacAddr;

+

+    SetMem (&ZeroMacAddr, sizeof ZeroMacAddr, 0);

+

+    for (snp->mode.MCastFilterCount = 0;

+         snp->mode.MCastFilterCount < snp->mode.MaxMCastFilterCount;

+         snp->mode.MCastFilterCount++

+        ) {

+      if (CompareMem (

+            &snp->mode.MCastFilter[snp->mode.MCastFilterCount],

+            &ZeroMacAddr,

+            sizeof ZeroMacAddr

+            ) == 0) {

+        break;

+      }

+    }

+  }

+

+  return EFI_SUCCESS;

+}

+

+

+/**

+  This is the SNP interface routine for reading/enabling/disabling the

+  receive filters.

+  This routine basically retrieves snp structure, checks the SNP state and

+  checks the parameter validity, calls one of the above routines to actually

+  do the work

+

+  @param  this               context pointer

+  @param  EnableFlags        bit mask for enabling the receive filters

+  @param  DisableFlags       bit mask for disabling the receive filters

+  @param  ResetMCastList     boolean flag to reset/delete the multicast filter list

+  @param  MCastAddressCount  multicast address count for a new multicast address

+                             list

+  @param  MCastAddressList   list of new multicast addresses

+

+

+**/

+EFI_STATUS

+EFIAPI

+snp_undi32_receive_filters (

+  IN EFI_SIMPLE_NETWORK_PROTOCOL * this,

+  IN UINT32                      EnableFlags,

+  IN UINT32                      DisableFlags,

+  IN BOOLEAN                     ResetMCastList,

+  IN UINTN                       MCastAddressCount OPTIONAL,

+  IN EFI_MAC_ADDRESS             * MCastAddressList OPTIONAL

+  )

+{

+  SNP_DRIVER  *snp;

+  EFI_STATUS  Status;

+  EFI_TPL     OldTpl;

+

+  if (this == NULL) {

+    return EFI_INVALID_PARAMETER;

+  }

+

+  snp = EFI_SIMPLE_NETWORK_DEV_FROM_THIS (this);

+

+  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);

+

+  switch (snp->mode.State) {

+  case EfiSimpleNetworkInitialized:

+    break;

+

+  case EfiSimpleNetworkStopped:

+    Status = EFI_NOT_STARTED;

+    goto ON_EXIT;

+

+  default:

+    Status = EFI_DEVICE_ERROR;

+    goto ON_EXIT;

+  }

+  //

+  // check if we are asked to enable or disable something that the UNDI

+  // does not even support!

+  //

+  if (((EnableFlags &~snp->mode.ReceiveFilterMask) != 0) ||

+    ((DisableFlags &~snp->mode.ReceiveFilterMask) != 0)) {

+    Status = EFI_INVALID_PARAMETER;

+    goto ON_EXIT;

+  }

+

+  if (ResetMCastList) {

+

+    DisableFlags |= EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST & snp->mode.ReceiveFilterMask;

+    MCastAddressCount = 0;

+    MCastAddressList  = NULL;

+  } else {

+    if (MCastAddressCount != 0) {

+      if ((MCastAddressCount > snp->mode.MaxMCastFilterCount) ||

+        (MCastAddressList == NULL)) {

+

+        Status = EFI_INVALID_PARAMETER;

+        goto ON_EXIT;

+      }

+    }

+  }

+

+  if (EnableFlags == 0 && DisableFlags == 0 && !ResetMCastList && MCastAddressCount == 0) {

+    Status = EFI_SUCCESS;

+    goto ON_EXIT;

+  }

+

+  if ((EnableFlags & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) != 0 && MCastAddressCount == 0) {

+    Status = EFI_INVALID_PARAMETER;

+    goto ON_EXIT;

+  }

+

+  if ((EnableFlags != 0) || (MCastAddressCount != 0)) {

+    Status = pxe_rcvfilter_enable (

+              snp,

+              EnableFlags,

+              MCastAddressCount,

+              MCastAddressList

+              );

+

+    if (EFI_ERROR (Status)) {

+      goto ON_EXIT;

+    }

+  }

+

+  if ((DisableFlags != 0) || ResetMCastList) {

+    Status = pxe_rcvfilter_disable (snp, DisableFlags, ResetMCastList);

+

+    if (EFI_ERROR (Status)) {

+      goto ON_EXIT;

+    }

+  }

+

+  Status = pxe_rcvfilter_read (snp);

+

+ON_EXIT:

+  gBS->RestoreTPL (OldTpl);

+

+  return Status;

+}