mirror of https://github.com/acidanthera/audk.git
326 lines
8.8 KiB
C
326 lines
8.8 KiB
C
/** @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.
|
|
|
|
**/
|
|
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.
|
|
|
|
**/
|
|
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 == %LX", snp->cdb.CPBaddr));
|
|
DEBUG ((EFI_D_NET, "\nsnp->cdb.DBaddr == %LX", snp->cdb.DBaddr));
|
|
DEBUG ((EFI_D_NET, "\ncpb->FrameAddr == %LX\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;
|
|
}
|