[mirror_edk2.git] / EmulatorPkg / Unix / Host / BerkeleyPacketFilter.c

/**@file\r
 Berkeley Packet Filter implementation of the EMU_SNP_PROTOCOL that allows the\r
 emulator to get on real networks.\r
\r
 Tested on Mac OS X.\r
\r
Copyright (c) 2004 - 2019, Intel Corporation. All rights reserved.<BR>\r
Portions copyright (c) 2011, Apple Inc. All rights reserved.\r
\r
SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "Host.h"\r
\r
#ifdef __APPLE__\r
\r
  #include <Library/NetLib.h>\r
\r
#define EMU_SNP_PRIVATE_SIGNATURE  SIGNATURE_32('E', 'M', 's', 'n')\r
typedef struct {\r
  UINTN                      Signature;\r
\r
  EMU_IO_THUNK_PROTOCOL      *Thunk;\r
  EMU_SNP_PROTOCOL           EmuSnp;\r
  EFI_SIMPLE_NETWORK_MODE    *Mode;\r
\r
  int                        BpfFd;\r
  char                       *InterfaceName;\r
  EFI_MAC_ADDRESS            MacAddress;\r
  u_int                      ReadBufferSize;\r
  VOID                       *ReadBuffer;\r
\r
  //\r
  // Two walking pointers to manage the multiple packets that can be returned\r
  // in a single read.\r
  //\r
  VOID                       *CurrentReadPointer;\r
  VOID                       *EndReadPointer;\r
\r
  UINT32                     ReceivedPackets;\r
  UINT32                     DroppedPackets;\r
} EMU_SNP_PRIVATE;\r
\r
#define EMU_SNP_PRIVATE_DATA_FROM_THIS(a) \\r
         CR(a, EMU_SNP_PRIVATE, EmuSnp, EMU_SNP_PRIVATE_SIGNATURE)\r
\r
//\r
// Strange, but there doesn't appear to be any structure for the Ethernet header in edk2...\r
//\r
\r
typedef struct {\r
  UINT8     DstAddr[NET_ETHER_ADDR_LEN];\r
  UINT8     SrcAddr[NET_ETHER_ADDR_LEN];\r
  UINT16    Type;\r
} ETHERNET_HEADER;\r
\r
/**\r
  Register storage for SNP Mode.\r
\r
  @param  This Protocol instance pointer.\r
  @param  Mode SimpleNetworkProtocol Mode structure passed into driver.\r
\r
  @retval EFI_SUCCESS           The network interface was started.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
\r
**/\r
EFI_STATUS\r
EmuSnpCreateMapping (\r
  IN     EMU_SNP_PROTOCOL         *This,\r
  IN     EFI_SIMPLE_NETWORK_MODE  *Mode\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  Private->Mode = Mode;\r
\r
  //\r
  // Set the broadcast address.\r
  //\r
  SetMem (&Mode->BroadcastAddress, sizeof (EFI_MAC_ADDRESS), 0xFF);\r
\r
  CopyMem (&Mode->CurrentAddress, &Private->MacAddress, sizeof (EFI_MAC_ADDRESS));\r
  CopyMem (&Mode->PermanentAddress, &Private->MacAddress, sizeof (EFI_MAC_ADDRESS));\r
\r
  //\r
  // Since the fake SNP is based on a real NIC, to avoid conflict with the host NIC\r
  // network stack, we use a different MAC address.\r
  // So just change the last byte of the MAC address for the real NIC.\r
  //\r
  Mode->CurrentAddress.Addr[NET_ETHER_ADDR_LEN - 1]++;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
static struct bpf_insn  mFilterInstructionTemplate[] = {\r
  // Load 4 bytes from the destination MAC address.\r
  BPF_STMT (BPF_LD + BPF_W + BPF_ABS,  OFFSET_OF (ETHERNET_HEADER, DstAddr[0])),\r
\r
  // Compare to first 4 bytes of fake MAC address.\r
  BPF_JUMP (BPF_JMP + BPF_JEQ + BPF_K, 0x12345678,                 0,           3),\r
\r
  // Load remaining 2 bytes from the destination MAC address.\r
  BPF_STMT (BPF_LD + BPF_H + BPF_ABS,  OFFSET_OF (ETHERNET_HEADER, DstAddr[4])),\r
\r
  // Compare to remaining 2 bytes of fake MAC address.\r
  BPF_JUMP (BPF_JMP + BPF_JEQ + BPF_K, 0x9ABC,                     5,           0),\r
\r
  // Load 4 bytes from the destination MAC address.\r
  BPF_STMT (BPF_LD + BPF_W + BPF_ABS,  OFFSET_OF (ETHERNET_HEADER, DstAddr[0])),\r
\r
  // Compare to first 4 bytes of broadcast MAC address.\r
  BPF_JUMP (BPF_JMP + BPF_JEQ + BPF_K, 0xFFFFFFFF,                 0,           2),\r
\r
  // Load remaining 2 bytes from the destination MAC address.\r
  BPF_STMT (BPF_LD + BPF_H + BPF_ABS,  OFFSET_OF (ETHERNET_HEADER, DstAddr[4])),\r
\r
  // Compare to remaining 2 bytes of broadcast MAC address.\r
  BPF_JUMP (BPF_JMP + BPF_JEQ + BPF_K, 0xFFFF,                     1,           0),\r
\r
  // Reject packet.\r
  BPF_STMT (BPF_RET + BPF_K,           0),\r
\r
  // Receive entire packet.\r
  BPF_STMT (BPF_RET + BPF_K,           -1)\r
};\r
\r
EFI_STATUS\r
OpenBpfFileDescriptor (\r
  IN EMU_SNP_PRIVATE  *Private,\r
  OUT int             *Fd\r
  )\r
{\r
  char  BfpDeviceName[256];\r
  int   Index;\r
\r
  //\r
  // Open a Berkeley Packet Filter device.  This must be done as root, so this is probably\r
  // the place which is most likely to fail...\r
  //\r
  for (Index = 0; TRUE; Index++ ) {\r
    snprintf (BfpDeviceName, sizeof (BfpDeviceName), "/dev/bpf%d", Index);\r
\r
    *Fd = open (BfpDeviceName, O_RDWR, 0);\r
    if ( *Fd >= 0 ) {\r
      return EFI_SUCCESS;\r
    }\r
\r
    if (errno == EACCES) {\r
      printf (\r
        "SNP: Permissions on '%s' are incorrect.  Fix with 'sudo chmod 666 %s'.\n",\r
        BfpDeviceName,\r
        BfpDeviceName\r
        );\r
    }\r
\r
    if (errno != EBUSY) {\r
      break;\r
    }\r
  }\r
\r
  return EFI_OUT_OF_RESOURCES;\r
}\r
\r
/**\r
  Changes the state of a network interface from "stopped" to "started".\r
\r
  @param  This Protocol instance pointer.\r
\r
  @retval EFI_SUCCESS           The network interface was started.\r
  @retval EFI_ALREADY_STARTED   The network interface is already in the started state.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpStart (\r
  IN EMU_SNP_PROTOCOL  *This\r
  )\r
{\r
  EFI_STATUS          Status;\r
  EMU_SNP_PRIVATE     *Private;\r
  struct ifreq        BoundIf;\r
  struct bpf_program  BpfProgram;\r
  struct bpf_insn     *FilterProgram;\r
  u_int               Value;\r
  u_int               ReadBufferSize;\r
  UINT16              Temp16;\r
  UINT32              Temp32;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  switch (Private->Mode->State) {\r
    case EfiSimpleNetworkStopped:\r
      break;\r
\r
    case EfiSimpleNetworkStarted:\r
    case EfiSimpleNetworkInitialized:\r
      return EFI_ALREADY_STARTED;\r
      break;\r
\r
    default:\r
      return EFI_DEVICE_ERROR;\r
      break;\r
  }\r
\r
  Status              = EFI_SUCCESS;\r
  Private->ReadBuffer = NULL;\r
  if (Private->BpfFd == 0) {\r
    Status = OpenBpfFileDescriptor (Private, &Private->BpfFd);\r
    if (EFI_ERROR (Status)) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    //\r
    // Get the read buffer size.\r
    //\r
    if (ioctl (Private->BpfFd, BIOCGBLEN, &ReadBufferSize) < 0) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    //\r
    // Default value from BIOCGBLEN is usually too small, so use a much larger size, if necessary.\r
    //\r
    if (ReadBufferSize < FixedPcdGet32 (PcdNetworkPacketFilterSize)) {\r
      ReadBufferSize = FixedPcdGet32 (PcdNetworkPacketFilterSize);\r
      if (ioctl (Private->BpfFd, BIOCSBLEN, &ReadBufferSize) < 0) {\r
        goto DeviceErrorExit;\r
      }\r
    }\r
\r
    //\r
    // Associate our interface with this BPF file descriptor.\r
    //\r
    AsciiStrCpyS (BoundIf.ifr_name, sizeof (BoundIf.ifr_name), Private->InterfaceName);\r
    if (ioctl (Private->BpfFd, BIOCSETIF, &BoundIf) < 0) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    //\r
    // Enable immediate mode.\r
    //\r
    Value = 1;\r
    if (ioctl (Private->BpfFd, BIOCIMMEDIATE, &Value) < 0) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    //\r
    // Enable non-blocking I/O.\r
    //\r
    if (fcntl (Private->BpfFd, F_GETFL, 0) == -1) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    Value |= O_NONBLOCK;\r
\r
    if (fcntl (Private->BpfFd, F_SETFL, Value) == -1) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    //\r
    // Disable "header complete" flag.  This means the supplied source MAC address is\r
    // what goes on the wire.\r
    //\r
    Value = 1;\r
    if (ioctl (Private->BpfFd, BIOCSHDRCMPLT, &Value) < 0) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    //\r
    // Allocate read buffer.\r
    //\r
    Private->ReadBufferSize = ReadBufferSize;\r
    Private->ReadBuffer     = malloc (Private->ReadBufferSize);\r
    if (Private->ReadBuffer == NULL) {\r
      goto ErrorExit;\r
    }\r
\r
    Private->CurrentReadPointer = Private->EndReadPointer = Private->ReadBuffer;\r
\r
    //\r
    // Install our packet filter: successful reads should only produce broadcast or unicast\r
    // packets directed to our fake MAC address.\r
    //\r
    FilterProgram = malloc (sizeof (mFilterInstructionTemplate));\r
    if ( FilterProgram == NULL ) {\r
      goto ErrorExit;\r
    }\r
\r
    CopyMem (FilterProgram, &mFilterInstructionTemplate, sizeof (mFilterInstructionTemplate));\r
\r
    //\r
    // Insert out fake MAC address into the filter.  The data has to be host endian.\r
    //\r
    CopyMem (&Temp32, &Private->Mode->CurrentAddress.Addr[0], sizeof (UINT32));\r
    FilterProgram[1].k = NTOHL (Temp32);\r
    CopyMem (&Temp16, &Private->Mode->CurrentAddress.Addr[4], sizeof (UINT16));\r
    FilterProgram[3].k = NTOHS (Temp16);\r
\r
    BpfProgram.bf_len   = sizeof (mFilterInstructionTemplate) / sizeof (struct bpf_insn);\r
    BpfProgram.bf_insns = FilterProgram;\r
\r
    if (ioctl (Private->BpfFd, BIOCSETF, &BpfProgram) < 0) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    free (FilterProgram);\r
\r
    //\r
    // Enable promiscuous mode.\r
    //\r
    if (ioctl (Private->BpfFd, BIOCPROMISC, 0) < 0) {\r
      goto DeviceErrorExit;\r
    }\r
\r
    Private->Mode->State = EfiSimpleNetworkStarted;\r
  }\r
\r
  return Status;\r
\r
DeviceErrorExit:\r
  Status = EFI_DEVICE_ERROR;\r
ErrorExit:\r
  if (Private->ReadBuffer != NULL) {\r
    free (Private->ReadBuffer);\r
    Private->ReadBuffer = NULL;\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Changes the state of a network interface from "started" to "stopped".\r
\r
  @param  This Protocol instance pointer.\r
\r
  @retval EFI_SUCCESS           The network interface was stopped.\r
  @retval EFI_ALREADY_STARTED   The network interface is already in the stopped state.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpStop (\r
  IN EMU_SNP_PROTOCOL  *This\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  switch ( Private->Mode->State ) {\r
    case EfiSimpleNetworkStarted:\r
      break;\r
\r
    case EfiSimpleNetworkStopped:\r
      return EFI_NOT_STARTED;\r
      break;\r
\r
    default:\r
      return EFI_DEVICE_ERROR;\r
      break;\r
  }\r
\r
  if (Private->BpfFd != 0) {\r
    close (Private->BpfFd);\r
    Private->BpfFd = 0;\r
  }\r
\r
  if (Private->ReadBuffer != NULL) {\r
    free (Private->ReadBuffer);\r
    Private->CurrentReadPointer = Private->EndReadPointer = Private->ReadBuffer = NULL;\r
  }\r
\r
  Private->Mode->State = EfiSimpleNetworkStopped;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Resets a network adapter and allocates the transmit and receive buffers\r
  required by the network interface; optionally, also requests allocation\r
  of additional transmit and receive buffers.\r
\r
  @param  This              The protocol instance pointer.\r
  @param  ExtraRxBufferSize The size, in bytes, of the extra receive buffer space\r
                            that the driver should allocate for the network interface.\r
                            Some network interfaces will not be able to use the extra\r
                            buffer, and the caller will not know if it is actually\r
                            being used.\r
  @param  ExtraTxBufferSize The size, in bytes, of the extra transmit buffer space\r
                            that the driver should allocate for the network interface.\r
                            Some network interfaces will not be able to use the extra\r
                            buffer, and the caller will not know if it is actually\r
                            being used.\r
\r
  @retval EFI_SUCCESS           The network interface was initialized.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_OUT_OF_RESOURCES  There was not enough memory for the transmit and\r
                                receive buffers.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpInitialize (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  IN UINTN             ExtraRxBufferSize  OPTIONAL,\r
  IN UINTN             ExtraTxBufferSize  OPTIONAL\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  switch ( Private->Mode->State ) {\r
    case EfiSimpleNetworkStarted:\r
      break;\r
\r
    case EfiSimpleNetworkStopped:\r
      return EFI_NOT_STARTED;\r
      break;\r
\r
    default:\r
      return EFI_DEVICE_ERROR;\r
      break;\r
  }\r
\r
  Private->Mode->MCastFilterCount     = 0;\r
  Private->Mode->ReceiveFilterSetting = 0;\r
  ZeroMem (Private->Mode->MCastFilter, sizeof (Private->Mode->MCastFilter));\r
\r
  Private->Mode->State = EfiSimpleNetworkInitialized;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Resets a network adapter and re-initializes it with the parameters that were\r
  provided in the previous call to Initialize().\r
\r
  @param  This                 The protocol instance pointer.\r
  @param  ExtendedVerification Indicates that the driver may perform a more\r
                               exhaustive verification operation of the device\r
                               during reset.\r
\r
  @retval EFI_SUCCESS           The network interface was reset.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpReset (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  IN BOOLEAN           ExtendedVerification\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  switch ( Private->Mode->State ) {\r
    case EfiSimpleNetworkInitialized:\r
      break;\r
\r
    case EfiSimpleNetworkStopped:\r
      return EFI_NOT_STARTED;\r
      break;\r
\r
    default:\r
      return EFI_DEVICE_ERROR;\r
      break;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Resets a network adapter and leaves it in a state that is safe for\r
  another driver to initialize.\r
\r
  @param  This Protocol instance pointer.\r
\r
  @retval EFI_SUCCESS           The network interface was shutdown.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpShutdown (\r
  IN EMU_SNP_PROTOCOL  *This\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  switch ( Private->Mode->State ) {\r
    case EfiSimpleNetworkInitialized:\r
      break;\r
\r
    case EfiSimpleNetworkStopped:\r
      return EFI_NOT_STARTED;\r
      break;\r
\r
    default:\r
      return EFI_DEVICE_ERROR;\r
      break;\r
  }\r
\r
  Private->Mode->State = EfiSimpleNetworkStarted;\r
\r
  Private->Mode->ReceiveFilterSetting = 0;\r
  Private->Mode->MCastFilterCount     = 0;\r
  ZeroMem (Private->Mode->MCastFilter, sizeof (Private->Mode->MCastFilter));\r
\r
  if (Private->BpfFd != 0) {\r
    close (Private->BpfFd);\r
    Private->BpfFd = 0;\r
  }\r
\r
  if (Private->ReadBuffer != NULL) {\r
    free (Private->ReadBuffer);\r
    Private->CurrentReadPointer = Private->EndReadPointer = Private->ReadBuffer = NULL;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Manages the multicast receive filters of a network interface.\r
\r
  @param  This             The protocol instance pointer.\r
  @param  Enable           A bit mask of receive filters to enable on the network interface.\r
  @param  Disable          A bit mask of receive filters to disable on the network interface.\r
  @param  ResetMCastFilter Set to TRUE to reset the contents of the multicast receive\r
                           filters on the network interface to their default values.\r
  @param  McastFilterCnt   Number of multicast HW MAC addresses in the new\r
                           MCastFilter list. This value must be less than or equal to\r
                           the MCastFilterCnt field of EMU_SNP_MODE. This\r
                           field is optional if ResetMCastFilter is TRUE.\r
  @param  MCastFilter      A pointer to a list of new multicast receive filter HW MAC\r
                           addresses. This list will replace any existing multicast\r
                           HW MAC address list. This field is optional if\r
                           ResetMCastFilter is TRUE.\r
\r
  @retval EFI_SUCCESS           The multicast receive filter list was updated.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpReceiveFilters (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  IN UINT32            Enable,\r
  IN UINT32            Disable,\r
  IN BOOLEAN           ResetMCastFilter,\r
  IN UINTN             MCastFilterCnt     OPTIONAL,\r
  IN EFI_MAC_ADDRESS   *MCastFilter OPTIONAL\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  // For now, just succeed...\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Modifies or resets the current station address, if supported.\r
\r
  @param  This  The protocol instance pointer.\r
  @param  Reset Flag used to reset the station address to the network interfaces\r
                permanent address.\r
  @param  New   The new station address to be used for the network interface.\r
\r
  @retval EFI_SUCCESS           The network interfaces station address was updated.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpStationAddress (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  IN BOOLEAN           Reset,\r
  IN EFI_MAC_ADDRESS   *New OPTIONAL\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  return EFI_UNSUPPORTED;\r
}\r
\r
/**\r
  Resets or collects the statistics on a network interface.\r
\r
  @param  This            Protocol instance pointer.\r
  @param  Reset           Set to TRUE to reset the statistics for the network interface.\r
  @param  StatisticsSize  On input the size, in bytes, of StatisticsTable. On\r
                          output the size, in bytes, of the resulting table of\r
                          statistics.\r
  @param  StatisticsTable A pointer to the EFI_NETWORK_STATISTICS structure that\r
                          contains the statistics.\r
\r
  @retval EFI_SUCCESS           The statistics were collected from the network interface.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_BUFFER_TOO_SMALL  The Statistics buffer was too small. The current buffer\r
                                size needed to hold the statistics is returned in\r
                                StatisticsSize.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpStatistics (\r
  IN EMU_SNP_PROTOCOL         *This,\r
  IN BOOLEAN                  Reset,\r
  IN OUT UINTN                *StatisticsSize   OPTIONAL,\r
  OUT EFI_NETWORK_STATISTICS  *StatisticsTable  OPTIONAL\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  return EFI_UNSUPPORTED;\r
}\r
\r
/**\r
  Converts a multicast IP address to a multicast HW MAC address.\r
\r
  @param  This The protocol instance pointer.\r
  @param  IPv6 Set to TRUE if the multicast IP address is IPv6 [RFC 2460]. Set\r
               to FALSE if the multicast IP address is IPv4 [RFC 791].\r
  @param  IP   The multicast IP address that is to be converted to a multicast\r
               HW MAC address.\r
  @param  MAC  The multicast HW MAC address that is to be generated from IP.\r
\r
  @retval EFI_SUCCESS           The multicast IP address was mapped to the multicast\r
                                HW MAC address.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_BUFFER_TOO_SMALL  The Statistics buffer was too small. The current buffer\r
                                size needed to hold the statistics is returned in\r
                                StatisticsSize.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpMCastIpToMac (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  IN BOOLEAN           IPv6,\r
  IN EFI_IP_ADDRESS    *IP,\r
  OUT EFI_MAC_ADDRESS  *MAC\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  return EFI_UNSUPPORTED;\r
}\r
\r
/**\r
  Performs read and write operations on the NVRAM device attached to a\r
  network interface.\r
\r
  @param  This       The protocol instance pointer.\r
  @param  ReadWrite  TRUE for read operations, FALSE for write operations.\r
  @param  Offset     Byte offset in the NVRAM device at which to start the read or\r
                     write operation. This must be a multiple of NvRamAccessSize and\r
                     less than NvRamSize.\r
  @param  BufferSize The number of bytes to read or write from the NVRAM device.\r
                     This must also be a multiple of NvramAccessSize.\r
  @param  Buffer     A pointer to the data buffer.\r
\r
  @retval EFI_SUCCESS           The NVRAM access was performed.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpNvData (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  IN BOOLEAN           ReadWrite,\r
  IN UINTN             Offset,\r
  IN UINTN             BufferSize,\r
  IN OUT VOID          *Buffer\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  return EFI_UNSUPPORTED;\r
}\r
\r
/**\r
  Reads the current interrupt status and recycled transmit buffer status from\r
  a network interface.\r
\r
  @param  This            The protocol instance pointer.\r
  @param  InterruptStatus A pointer to the bit mask of the currently active interrupts\r
                          If this is NULL, the interrupt status will not be read from\r
                          the device. If this is not NULL, the interrupt status will\r
                          be read from the device. When the  interrupt status is read,\r
                          it will also be cleared. Clearing the transmit  interrupt\r
                          does not empty the recycled transmit buffer array.\r
  @param  TxBuf           Recycled transmit buffer address. The network interface will\r
                          not transmit if its internal recycled transmit buffer array\r
                          is full. Reading the transmit buffer does not clear the\r
                          transmit interrupt. If this is NULL, then the transmit buffer\r
                          status will not be read. If there are no transmit buffers to\r
                          recycle and TxBuf is not NULL, * TxBuf will be set to NULL.\r
\r
  @retval EFI_SUCCESS           The status of the network interface was retrieved.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpGetStatus (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  OUT UINT32           *InterruptStatus OPTIONAL,\r
  OUT VOID             **TxBuf OPTIONAL\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  if ( InterruptStatus != NULL ) {\r
    *InterruptStatus = EFI_SIMPLE_NETWORK_TRANSMIT_INTERRUPT;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Places a packet in the transmit queue of a network interface.\r
\r
  @param  This       The protocol instance pointer.\r
  @param  HeaderSize The size, in bytes, of the media header to be filled in by\r
                     the Transmit() function. If HeaderSize is non-zero, then it\r
                     must be equal to This->Mode->MediaHeaderSize and the DestAddr\r
                     and Protocol parameters must not be NULL.\r
  @param  BufferSize The size, in bytes, of the entire packet (media header and\r
                     data) to be transmitted through the network interface.\r
  @param  Buffer     A pointer to the packet (media header followed by data) to be\r
                     transmitted. This parameter cannot be NULL. If HeaderSize is zero,\r
                     then the media header in Buffer must already be filled in by the\r
                     caller. If HeaderSize is non-zero, then the media header will be\r
                     filled in by the Transmit() function.\r
  @param  SrcAddr    The source HW MAC address. If HeaderSize is zero, then this parameter\r
                     is ignored. If HeaderSize is non-zero and SrcAddr is NULL, then\r
                     This->Mode->CurrentAddress is used for the source HW MAC address.\r
  @param  DestAddr   The destination HW MAC address. If HeaderSize is zero, then this\r
                     parameter is ignored.\r
  @param  Protocol   The type of header to build. If HeaderSize is zero, then this\r
                     parameter is ignored. See RFC 1700, section "Ether Types", for\r
                     examples.\r
\r
  @retval EFI_SUCCESS           The packet was placed on the transmit queue.\r
  @retval EFI_NOT_STARTED       The network interface has not been started.\r
  @retval EFI_NOT_READY         The network interface is too busy to accept this transmit request.\r
  @retval EFI_BUFFER_TOO_SMALL  The BufferSize parameter is too small.\r
  @retval EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpTransmit (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  IN UINTN             HeaderSize,\r
  IN UINTN             BufferSize,\r
  IN VOID              *Buffer,\r
  IN EFI_MAC_ADDRESS   *SrcAddr  OPTIONAL,\r
  IN EFI_MAC_ADDRESS   *DestAddr OPTIONAL,\r
  IN UINT16            *Protocol OPTIONAL\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
  ETHERNET_HEADER  *EnetHeader;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  if (Private->Mode->State < EfiSimpleNetworkStarted) {\r
    return EFI_NOT_STARTED;\r
  }\r
\r
  if ( HeaderSize != 0 ) {\r
    if ((DestAddr == NULL) || (Protocol == NULL) || (HeaderSize != Private->Mode->MediaHeaderSize)) {\r
      return EFI_INVALID_PARAMETER;\r
    }\r
\r
    if (SrcAddr == NULL) {\r
      SrcAddr = &Private->Mode->CurrentAddress;\r
    }\r
\r
    EnetHeader = (ETHERNET_HEADER *)Buffer;\r
\r
    CopyMem (EnetHeader->DstAddr, DestAddr, NET_ETHER_ADDR_LEN);\r
    CopyMem (EnetHeader->SrcAddr, SrcAddr, NET_ETHER_ADDR_LEN);\r
\r
    EnetHeader->Type = HTONS (*Protocol);\r
  }\r
\r
  if (write (Private->BpfFd, Buffer, BufferSize) < 0) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Receives a packet from a network interface.\r
\r
  @param  This       The protocol instance pointer.\r
  @param  HeaderSize The size, in bytes, of the media header received on the network\r
                     interface. If this parameter is NULL, then the media header size\r
                     will not be returned.\r
  @param  BufferSize On entry, the size, in bytes, of Buffer. On exit, the size, in\r
                     bytes, of the packet that was received on the network interface.\r
  @param  Buffer     A pointer to the data buffer to receive both the media header and\r
                     the data.\r
  @param  SrcAddr    The source HW MAC address. If this parameter is NULL, the\r
                     HW MAC source address will not be extracted from the media\r
                     header.\r
  @param  DestAddr   The destination HW MAC address. If this parameter is NULL,\r
                     the HW MAC destination address will not be extracted from the\r
                     media header.\r
  @param  Protocol   The media header type. If this parameter is NULL, then the\r
                     protocol will not be extracted from the media header. See\r
                     RFC 1700 section "Ether Types" for examples.\r
\r
  @retval  EFI_SUCCESS           The received data was stored in Buffer, and BufferSize has\r
                                 been updated to the number of bytes received.\r
  @retval  EFI_NOT_STARTED       The network interface has not been started.\r
  @retval  EFI_NOT_READY         The network interface is too busy to accept this transmit\r
                                 request.\r
  @retval  EFI_BUFFER_TOO_SMALL  The BufferSize parameter is too small.\r
  @retval  EFI_INVALID_PARAMETER One or more of the parameters has an unsupported value.\r
  @retval  EFI_DEVICE_ERROR      The command could not be sent to the network interface.\r
  @retval  EFI_UNSUPPORTED       This function is not supported by the network interface.\r
\r
**/\r
EFI_STATUS\r
EmuSnpReceive (\r
  IN EMU_SNP_PROTOCOL  *This,\r
  OUT UINTN            *HeaderSize OPTIONAL,\r
  IN OUT UINTN         *BufferSize,\r
  OUT VOID             *Buffer,\r
  OUT EFI_MAC_ADDRESS  *SrcAddr    OPTIONAL,\r
  OUT EFI_MAC_ADDRESS  *DestAddr   OPTIONAL,\r
  OUT UINT16           *Protocol   OPTIONAL\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
  struct bpf_hdr   *BpfHeader;\r
  struct bpf_stat  BpfStats;\r
  ETHERNET_HEADER  *EnetHeader;\r
  ssize_t          Result;\r
\r
  Private = EMU_SNP_PRIVATE_DATA_FROM_THIS (This);\r
\r
  if (Private->Mode->State < EfiSimpleNetworkStarted) {\r
    return EFI_NOT_STARTED;\r
  }\r
\r
  ZeroMem (&BpfStats, sizeof (BpfStats));\r
\r
  if (ioctl (Private->BpfFd, BIOCGSTATS, &BpfStats) == 0) {\r
    Private->ReceivedPackets += BpfStats.bs_recv;\r
    if (BpfStats.bs_drop > Private->DroppedPackets) {\r
      printf (\r
        "SNP: STATS: RCVD = %d DROPPED = %d.  Probably need to increase BPF PcdNetworkPacketFilterSize?\n",\r
        BpfStats.bs_recv,\r
        BpfStats.bs_drop - Private->DroppedPackets\r
        );\r
      Private->DroppedPackets = BpfStats.bs_drop;\r
    }\r
  }\r
\r
  //\r
  // Do we have any remaining packets from the previous read?\r
  //\r
  if (Private->CurrentReadPointer >= Private->EndReadPointer) {\r
    Result = read (Private->BpfFd, Private->ReadBuffer, Private->ReadBufferSize);\r
    if (Result < 0) {\r
      // EAGAIN means that there's no I/O outstanding against this file descriptor.\r
      return (errno == EAGAIN) ? EFI_NOT_READY : EFI_DEVICE_ERROR;\r
    }\r
\r
    if (Result == 0) {\r
      return EFI_NOT_READY;\r
    }\r
\r
    Private->CurrentReadPointer = Private->ReadBuffer;\r
    Private->EndReadPointer     = Private->CurrentReadPointer + Result;\r
  }\r
\r
  BpfHeader  = Private->CurrentReadPointer;\r
  EnetHeader = Private->CurrentReadPointer + BpfHeader->bh_hdrlen;\r
\r
  if (BpfHeader->bh_caplen > *BufferSize) {\r
    *BufferSize = BpfHeader->bh_caplen;\r
    return EFI_BUFFER_TOO_SMALL;\r
  }\r
\r
  CopyMem (Buffer, EnetHeader, BpfHeader->bh_caplen);\r
  *BufferSize = BpfHeader->bh_caplen;\r
\r
  if (HeaderSize != NULL) {\r
    *HeaderSize = sizeof (ETHERNET_HEADER);\r
  }\r
\r
  if (DestAddr != NULL) {\r
    ZeroMem (DestAddr, sizeof (EFI_MAC_ADDRESS));\r
    CopyMem (DestAddr, EnetHeader->DstAddr, NET_ETHER_ADDR_LEN);\r
  }\r
\r
  if (SrcAddr != NULL) {\r
    ZeroMem (SrcAddr, sizeof (EFI_MAC_ADDRESS));\r
    CopyMem (SrcAddr, EnetHeader->SrcAddr, NET_ETHER_ADDR_LEN);\r
  }\r
\r
  if (Protocol != NULL) {\r
    *Protocol = NTOHS (EnetHeader->Type);\r
  }\r
\r
  Private->CurrentReadPointer += BPF_WORDALIGN (BpfHeader->bh_hdrlen + BpfHeader->bh_caplen);\r
  return EFI_SUCCESS;\r
}\r
\r
EMU_SNP_PROTOCOL  gEmuSnpProtocol = {\r
  GasketSnpCreateMapping,\r
  GasketSnpStart,\r
  GasketSnpStop,\r
  GasketSnpInitialize,\r
  GasketSnpReset,\r
  GasketSnpShutdown,\r
  GasketSnpReceiveFilters,\r
  GasketSnpStationAddress,\r
  GasketSnpStatistics,\r
  GasketSnpMCastIpToMac,\r
  GasketSnpNvData,\r
  GasketSnpGetStatus,\r
  GasketSnpTransmit,\r
  GasketSnpReceive\r
};\r
\r
EFI_STATUS\r
GetInterfaceMacAddr (\r
  EMU_SNP_PRIVATE  *Private\r
  )\r
{\r
  EFI_STATUS          Status;\r
  struct ifaddrs      *IfAddrs;\r
  struct ifaddrs      *If;\r
  struct sockaddr_dl  *IfSdl;\r
\r
  if (getifaddrs (&IfAddrs) != 0) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  //\r
  // Convert the interface name to ASCII so we can find it.\r
  //\r
  Private->InterfaceName = malloc (StrSize (Private->Thunk->ConfigString));\r
  if (Private->InterfaceName == NULL) {\r
    Status = EFI_OUT_OF_RESOURCES;\r
    goto Exit;\r
  }\r
\r
  UnicodeStrToAsciiStrS (\r
    Private->Thunk->ConfigString,\r
    Private->InterfaceName,\r
    StrSize (Private->Thunk->ConfigString)\r
    );\r
\r
  Status = EFI_NOT_FOUND;\r
  If     = IfAddrs;\r
  while (If != NULL) {\r
    IfSdl = (struct sockaddr_dl *)If->ifa_addr;\r
\r
    if (IfSdl->sdl_family == AF_LINK) {\r
      if (!AsciiStrCmp (Private->InterfaceName, If->ifa_name)) {\r
        CopyMem (&Private->MacAddress, LLADDR (IfSdl), NET_ETHER_ADDR_LEN);\r
\r
        Status = EFI_SUCCESS;\r
        break;\r
      }\r
    }\r
\r
    If = If->ifa_next;\r
  }\r
\r
Exit:\r
  freeifaddrs (IfAddrs);\r
  return Status;\r
}\r
\r
EFI_STATUS\r
EmuSnpThunkOpen (\r
  IN  EMU_IO_THUNK_PROTOCOL  *This\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  if (This->Private != NULL) {\r
    return EFI_ALREADY_STARTED;\r
  }\r
\r
  if (!CompareGuid (This->Protocol, &gEmuSnpProtocolGuid)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  Private = malloc (sizeof (EMU_SNP_PRIVATE));\r
  if (Private == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Private->Signature = EMU_SNP_PRIVATE_SIGNATURE;\r
  Private->Thunk     = This;\r
  CopyMem (&Private->EmuSnp, &gEmuSnpProtocol, sizeof (gEmuSnpProtocol));\r
  GetInterfaceMacAddr (Private);\r
\r
  This->Interface = &Private->EmuSnp;\r
  This->Private   = Private;\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EmuSnpThunkClose (\r
  IN  EMU_IO_THUNK_PROTOCOL  *This\r
  )\r
{\r
  EMU_SNP_PRIVATE  *Private;\r
\r
  if (!CompareGuid (This->Protocol, &gEmuSnpProtocolGuid)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  Private = This->Private;\r
  free (Private);\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EMU_IO_THUNK_PROTOCOL  gSnpThunkIo = {\r
  &gEmuSnpProtocolGuid,\r
  NULL,\r
  NULL,\r
  0,\r
  GasketSnpThunkOpen,\r
  GasketSnpThunkClose,\r
  NULL\r
};\r
\r
#endif\r