X-Git-Url: https://git.proxmox.com/?a=blobdiff_plain;f=MdeModulePkg%2FUniversal%2FNetwork%2FSnpDxe%2FTransmit.c;fp=MdeModulePkg%2FUniversal%2FNetwork%2FSnpDxe%2FTransmit.c;h=8ee0cad566632a2aeffac06347233d8670be9172;hb=a3c5f87a011497f57c1b2d400b62e15b194db2eb;hp=0000000000000000000000000000000000000000;hpb=a1dbee50f5e8e9cdcc02c2fa73501aebb44c98ca;p=mirror_edk2.git

diff --git a/MdeModulePkg/Universal/Network/SnpDxe/Transmit.c b/MdeModulePkg/Universal/Network/SnpDxe/Transmit.c
new file mode 100644
index 0000000000..8ee0cad566
--- /dev/null
+++ b/MdeModulePkg/Universal/Network/SnpDxe/Transmit.c
@@ -0,0 +1,327 @@
+/** @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:
+
+    transmit.c
+
+Abstract:
+
+Revision history:
+  2000-Feb-03 M(f)J   Genesis.
+
+**/
+
+#include "Snp.h"
+
+
+/**
+  This routine calls undi to create the meadia header for the given data buffer.
+
+  @param  snp                 pointer to SNP driver structure
+  @param  MacHeaderPtr        address where the media header will be filled in.
+  @param  MacHeaderSize       size of the memory at MacHeaderPtr
+  @param  BufferPtr           data buffer pointer
+  @param  BufferLength        Size of data in the BufferPtr
+  @param  DestinationAddrPtr  address of the destination mac address buffer
+  @param  SourceAddrPtr       address of the source mac address buffer
+  @param  ProtocolPtr         address of the protocol type
+
+  @retval EFI_SUCCESS         if successfully completed the undi call
+  @retval Other               error return from undi call.
+
+**/
+STATIC
+EFI_STATUS
+pxe_fillheader (
+  SNP_DRIVER      *snp,
+  VOID            *MacHeaderPtr,
+  UINTN           MacHeaderSize,
+  VOID            *BufferPtr,
+  UINTN           BufferLength,
+  EFI_MAC_ADDRESS *DestinationAddrPtr,
+  EFI_MAC_ADDRESS *SourceAddrPtr,
+  UINT16          *ProtocolPtr
+  )
+{
+  PXE_CPB_FILL_HEADER_FRAGMENTED  *cpb;
+
+  cpb = snp->cpb;
+  if (SourceAddrPtr) {
+    CopyMem (
+      (VOID *) cpb->SrcAddr,
+      (VOID *) SourceAddrPtr,
+      snp->mode.HwAddressSize
+      );
+  } else {
+    CopyMem (
+      (VOID *) cpb->SrcAddr,
+      (VOID *) &(snp->mode.CurrentAddress),
+      snp->mode.HwAddressSize
+      );
+  }
+
+  CopyMem (
+    (VOID *) cpb->DestAddr,
+    (VOID *) DestinationAddrPtr,
+    snp->mode.HwAddressSize
+    );
+
+  //
+  // we need to do the byte swapping
+  //
+  cpb->Protocol             = (UINT16) PXE_SWAP_UINT16 (*ProtocolPtr);
+
+  cpb->PacketLen            = (UINT32) (BufferLength);
+  cpb->MediaHeaderLen       = (UINT16) MacHeaderSize;
+
+  cpb->FragCnt              = 2;
+  cpb->reserved             = 0;
+
+  cpb->FragDesc[0].FragAddr = (UINT64)(UINTN) MacHeaderPtr;
+  cpb->FragDesc[0].FragLen  = (UINT32) MacHeaderSize;
+  cpb->FragDesc[1].FragAddr = (UINT64)(UINTN) BufferPtr;
+  cpb->FragDesc[1].FragLen  = (UINT32) BufferLength;
+
+  cpb->FragDesc[0].reserved = cpb->FragDesc[1].reserved = 0;
+
+  snp->cdb.OpCode     = PXE_OPCODE_FILL_HEADER;
+  snp->cdb.OpFlags    = PXE_OPFLAGS_FILL_HEADER_FRAGMENTED;
+
+  snp->cdb.DBsize     = PXE_DBSIZE_NOT_USED;
+  snp->cdb.DBaddr     = PXE_DBADDR_NOT_USED;
+
+  snp->cdb.CPBsize    = sizeof (PXE_CPB_FILL_HEADER_FRAGMENTED);
+  snp->cdb.CPBaddr    = (UINT64)(UINTN) cpb;
+
+  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;
+
+  //
+  // Issue UNDI command and check result.
+  //
+  DEBUG ((EFI_D_NET, "\nsnp->undi.fill_header()  "));
+
+  (*snp->issue_undi32_command) ((UINT64) (UINTN) &snp->cdb);
+
+  switch (snp->cdb.StatCode) {
+  case PXE_STATCODE_SUCCESS:
+    return EFI_SUCCESS;
+
+  case PXE_STATCODE_INVALID_PARAMETER:
+    DEBUG (
+      (EFI_D_ERROR,
+      "\nsnp->undi.fill_header()  %xh:%xh\n",
+      snp->cdb.StatFlags,
+      snp->cdb.StatCode)
+      );
+
+    return EFI_INVALID_PARAMETER;
+
+  default:
+    DEBUG (
+      (EFI_D_ERROR,
+      "\nsnp->undi.fill_header()  %xh:%xh\n",
+      snp->cdb.StatFlags,
+      snp->cdb.StatCode)
+      );
+
+    return EFI_DEVICE_ERROR;
+  }
+}
+
+
+/**
+  This routine calls undi to transmit the given data buffer
+
+  @param  snp                 pointer to SNP driver structure
+  @param  BufferPtr           data buffer pointer
+  @param  BufferLength        Size of data in the BufferPtr
+
+  @retval EFI_SUCCESS         if successfully completed the undi call
+  @retval Other               error return from undi call.
+
+**/
+STATIC
+EFI_STATUS
+pxe_transmit (
+  SNP_DRIVER *snp,
+  VOID       *BufferPtr,
+  UINTN      BufferLength
+  )
+{
+  PXE_CPB_TRANSMIT  *cpb;
+  EFI_STATUS        Status;
+
+  cpb             = snp->cpb;
+  cpb->FrameAddr  = (UINT64) (UINTN) BufferPtr;
+  cpb->DataLen    = (UINT32) BufferLength;
+
+  cpb->MediaheaderLen = 0;
+  cpb->reserved       = 0;
+
+  snp->cdb.OpFlags    = PXE_OPFLAGS_TRANSMIT_WHOLE;
+
+  snp->cdb.CPBsize    = sizeof (PXE_CPB_TRANSMIT);
+  snp->cdb.CPBaddr    = (UINT64)(UINTN) cpb;
+
+  snp->cdb.OpCode     = PXE_OPCODE_TRANSMIT;
+  snp->cdb.DBsize     = PXE_DBSIZE_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;
+
+  //
+  // Issue UNDI command and check result.
+  //
+  DEBUG ((EFI_D_NET, "\nsnp->undi.transmit()  "));
+  DEBUG ((EFI_D_NET, "\nsnp->cdb.OpCode  == %x", snp->cdb.OpCode));
+  DEBUG ((EFI_D_NET, "\nsnp->cdb.CPBaddr == %X", snp->cdb.CPBaddr));
+  DEBUG ((EFI_D_NET, "\nsnp->cdb.DBaddr  == %X", snp->cdb.DBaddr));
+  DEBUG ((EFI_D_NET, "\ncpb->FrameAddr   == %X\n", cpb->FrameAddr));
+
+  (*snp->issue_undi32_command) ((UINT64) (UINTN) &snp->cdb);
+
+  DEBUG ((EFI_D_NET, "\nexit snp->undi.transmit()  "));
+  DEBUG ((EFI_D_NET, "\nsnp->cdb.StatCode == %r", snp->cdb.StatCode));
+
+  //
+  // we will unmap the buffers in get_status call, not here
+  //
+  switch (snp->cdb.StatCode) {
+  case PXE_STATCODE_SUCCESS:
+    return EFI_SUCCESS;
+
+  case PXE_STATCODE_QUEUE_FULL:
+  case PXE_STATCODE_BUSY:
+    Status = EFI_NOT_READY;
+    break;
+
+  default:
+    Status = EFI_DEVICE_ERROR;
+  }
+
+  DEBUG (
+    (EFI_D_ERROR,
+    "\nsnp->undi.transmit()  %xh:%xh\n",
+    snp->cdb.StatFlags,
+    snp->cdb.StatCode)
+    );
+
+  return Status;
+}
+
+
+/**
+  This is the snp interface routine for transmitting a packet. this routine
+  basically retrieves the snp structure, checks the snp state and calls
+  pxe_fill_header and pxe_transmit calls to complete the transmission.
+
+  @param  this                pointer to SNP driver context
+  @param  MacHeaderSize       size of the memory at MacHeaderPtr
+  @param  BufferLength        Size of data in the BufferPtr
+  @param  BufferPtr           data buffer pointer
+  @param  SourceAddrPtr       address of the source mac address buffer
+  @param  DestinationAddrPtr  address of the destination mac address buffer
+  @param  ProtocolPtr         address of the protocol type
+
+  @retval EFI_SUCCESS         if successfully completed the undi call
+  @retval Other               error return from undi call.
+
+**/
+EFI_STATUS
+EFIAPI
+snp_undi32_transmit (
+  IN EFI_SIMPLE_NETWORK_PROTOCOL * this,
+  IN UINTN                       MacHeaderSize,
+  IN UINTN                       BufferLength,
+  IN VOID                        *BufferPtr,
+  IN EFI_MAC_ADDRESS             * SourceAddrPtr OPTIONAL,
+  IN EFI_MAC_ADDRESS             * DestinationAddrPtr OPTIONAL,
+  IN UINT16                      *ProtocolPtr 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);
+
+  if (snp == NULL) {
+    return EFI_DEVICE_ERROR;
+  }
+
+  switch (snp->mode.State) {
+  case EfiSimpleNetworkInitialized:
+    break;
+
+  case EfiSimpleNetworkStopped:
+    Status = EFI_NOT_STARTED;
+    goto ON_EXIT;
+
+  default:
+    Status = EFI_DEVICE_ERROR;
+    goto ON_EXIT;
+  }
+
+  if (BufferPtr == NULL) {
+    Status = EFI_INVALID_PARAMETER;
+    goto ON_EXIT;
+  }
+
+  if (BufferLength < snp->mode.MediaHeaderSize) {
+    Status = EFI_BUFFER_TOO_SMALL;
+    goto ON_EXIT;
+  }
+
+  //
+  // if the MacHeaderSize is non-zero, we need to fill up the header and for that
+  // we need the destination address and the protocol
+  //
+  if (MacHeaderSize != 0) {
+    if (MacHeaderSize != snp->mode.MediaHeaderSize || DestinationAddrPtr == 0 || ProtocolPtr == 0) {
+      Status = EFI_INVALID_PARAMETER;
+      goto ON_EXIT;
+    }
+
+    Status = pxe_fillheader (
+              snp,
+              BufferPtr,
+              MacHeaderSize,
+              (UINT8 *) BufferPtr + MacHeaderSize,
+              BufferLength - MacHeaderSize,
+              DestinationAddrPtr,
+              SourceAddrPtr,
+              ProtocolPtr
+              );
+
+    if (EFI_ERROR (Status)) {
+      goto ON_EXIT;
+    }
+  }
+
+  Status = pxe_transmit (snp, BufferPtr, BufferLength);
+
+ON_EXIT:
+  gBS->RestoreTPL (OldTpl);
+
+  return Status;
+}