rename

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

1 files changed, 327 insertions, 0 deletions

diff --git a/MdeModulePkg/Universal/Network/SnpDxe/Transmit.c b/MdeModulePkg/Universal/Network/SnpDxe/Transmit.c
new file mode 100644
index 0000000..8ee0cad
--- /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;

+}