mirror of https://github.com/acidanthera/audk.git
OvmfPkg: VirtioNetDxe: implement Tx: SNP.Transmit and SNP.GetStatus
Contributed-under: TianoCore Contribution Agreement 1.0 Signed-off-by: Laszlo Ersek <lersek@redhat.com> Reviewed-by: Jordan Justen <jordan.l.justen@intel.com> Reviewed-by: Stefan Hajnoczi <stefanha@redhat.com> git-svn-id: https://svn.code.sf.net/p/edk2/code/trunk/edk2@14413 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
parent
e12fadc3cf
commit
b6dfc654c8
|
@ -0,0 +1,158 @@
|
||||||
|
/** @file
|
||||||
|
|
||||||
|
Implementation of the SNP.GetStatus() function and its private helpers if
|
||||||
|
any.
|
||||||
|
|
||||||
|
Copyright (C) 2013, Red Hat, Inc.
|
||||||
|
Copyright (c) 2006 - 2010, Intel Corporation. All rights reserved.<BR>
|
||||||
|
|
||||||
|
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.
|
||||||
|
|
||||||
|
**/
|
||||||
|
|
||||||
|
#include <Library/BaseLib.h>
|
||||||
|
#include <Library/UefiBootServicesTableLib.h>
|
||||||
|
|
||||||
|
#include "VirtioNet.h"
|
||||||
|
|
||||||
|
/**
|
||||||
|
Reads the current interrupt status and recycled transmit buffer status from
|
||||||
|
a network interface.
|
||||||
|
|
||||||
|
@param This The protocol instance pointer.
|
||||||
|
@param InterruptStatus A pointer to the bit mask of the currently active
|
||||||
|
interrupts If this is NULL, the interrupt status will
|
||||||
|
not be read from the device. If this is not NULL, the
|
||||||
|
interrupt status will be read from the device. When
|
||||||
|
the interrupt status is read, it will also be
|
||||||
|
cleared. Clearing the transmit interrupt does not
|
||||||
|
empty the recycled transmit buffer array.
|
||||||
|
@param TxBuf Recycled transmit buffer address. The network
|
||||||
|
interface will not transmit if its internal recycled
|
||||||
|
transmit buffer array is full. Reading the transmit
|
||||||
|
buffer does not clear the transmit interrupt. If this
|
||||||
|
is NULL, then the transmit buffer status will not be
|
||||||
|
read. If there are no transmit buffers to recycle and
|
||||||
|
TxBuf is not NULL, * TxBuf will be set to NULL.
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS The status of the network interface was
|
||||||
|
retrieved.
|
||||||
|
@retval EFI_NOT_STARTED The network interface has not been started.
|
||||||
|
@retval EFI_INVALID_PARAMETER One or more of the parameters has an
|
||||||
|
unsupported value.
|
||||||
|
@retval EFI_DEVICE_ERROR The command could not be sent to the network
|
||||||
|
interface.
|
||||||
|
@retval EFI_UNSUPPORTED This function is not supported by the network
|
||||||
|
interface.
|
||||||
|
|
||||||
|
**/
|
||||||
|
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
VirtioNetGetStatus (
|
||||||
|
IN EFI_SIMPLE_NETWORK_PROTOCOL *This,
|
||||||
|
OUT UINT32 *InterruptStatus OPTIONAL,
|
||||||
|
OUT VOID **TxBuf OPTIONAL
|
||||||
|
)
|
||||||
|
{
|
||||||
|
VNET_DEV *Dev;
|
||||||
|
EFI_TPL OldTpl;
|
||||||
|
EFI_STATUS Status;
|
||||||
|
UINT16 RxCurUsed;
|
||||||
|
UINT16 TxCurUsed;
|
||||||
|
|
||||||
|
if (This == NULL) {
|
||||||
|
return EFI_INVALID_PARAMETER;
|
||||||
|
}
|
||||||
|
|
||||||
|
Dev = VIRTIO_NET_FROM_SNP (This);
|
||||||
|
OldTpl = gBS->RaiseTPL (TPL_CALLBACK);
|
||||||
|
switch (Dev->Snm.State) {
|
||||||
|
case EfiSimpleNetworkStopped:
|
||||||
|
Status = EFI_NOT_STARTED;
|
||||||
|
goto Exit;
|
||||||
|
case EfiSimpleNetworkStarted:
|
||||||
|
Status = EFI_DEVICE_ERROR;
|
||||||
|
goto Exit;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// update link status
|
||||||
|
//
|
||||||
|
if (Dev->Snm.MediaPresentSupported) {
|
||||||
|
UINT16 LinkStatus;
|
||||||
|
|
||||||
|
Status = VIRTIO_CFG_READ (Dev, VhdrLinkStatus, &LinkStatus);
|
||||||
|
if (EFI_ERROR (Status)) {
|
||||||
|
goto Exit;
|
||||||
|
}
|
||||||
|
Dev->Snm.MediaPresent = !!(LinkStatus & VIRTIO_NET_S_LINK_UP);
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// virtio-0.9.5, 2.4.2 Receiving Used Buffers From the Device
|
||||||
|
//
|
||||||
|
MemoryFence ();
|
||||||
|
RxCurUsed = *Dev->RxRing.Used.Idx;
|
||||||
|
TxCurUsed = *Dev->TxRing.Used.Idx;
|
||||||
|
|
||||||
|
if (InterruptStatus != NULL) {
|
||||||
|
//
|
||||||
|
// report the receive interrupt if there is data available for reception,
|
||||||
|
// report the transmit interrupt if we have transmitted at least one buffer
|
||||||
|
//
|
||||||
|
*InterruptStatus = 0;
|
||||||
|
if (Dev->RxLastUsed != RxCurUsed) {
|
||||||
|
*InterruptStatus |= EFI_SIMPLE_NETWORK_RECEIVE_INTERRUPT;
|
||||||
|
}
|
||||||
|
if (Dev->TxLastUsed != TxCurUsed) {
|
||||||
|
ASSERT (Dev->TxCurPending > 0);
|
||||||
|
*InterruptStatus |= EFI_SIMPLE_NETWORK_TRANSMIT_INTERRUPT;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (TxBuf != NULL) {
|
||||||
|
if (Dev->TxLastUsed == TxCurUsed) {
|
||||||
|
*TxBuf = NULL;
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
UINT16 UsedElemIdx;
|
||||||
|
UINT32 DescIdx;
|
||||||
|
|
||||||
|
//
|
||||||
|
// fetch the first descriptor among those that the hypervisor reports
|
||||||
|
// completed
|
||||||
|
//
|
||||||
|
ASSERT (Dev->TxCurPending > 0);
|
||||||
|
ASSERT (Dev->TxCurPending <= Dev->TxMaxPending);
|
||||||
|
|
||||||
|
UsedElemIdx = Dev->TxLastUsed++ % Dev->TxRing.QueueSize;
|
||||||
|
DescIdx = Dev->TxRing.Used.UsedElem[UsedElemIdx].Id;
|
||||||
|
ASSERT (DescIdx < 2 * Dev->TxMaxPending - 1);
|
||||||
|
|
||||||
|
//
|
||||||
|
// report buffer address to caller that has been enqueued by caller
|
||||||
|
//
|
||||||
|
*TxBuf = (VOID *) Dev->TxRing.Desc[DescIdx + 1].Addr;
|
||||||
|
|
||||||
|
//
|
||||||
|
// now this descriptor can be used again to enqueue a transmit buffer
|
||||||
|
//
|
||||||
|
Dev->TxFreeStack[--Dev->TxCurPending] = (UINT16) DescIdx;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
Status = EFI_SUCCESS;
|
||||||
|
|
||||||
|
Exit:
|
||||||
|
gBS->RestoreTPL (OldTpl);
|
||||||
|
return Status;
|
||||||
|
}
|
|
@ -0,0 +1,169 @@
|
||||||
|
/** @file
|
||||||
|
|
||||||
|
Implementation of the SNP.Transmit() function and its private helpers if any.
|
||||||
|
|
||||||
|
Copyright (C) 2013, Red Hat, Inc.
|
||||||
|
Copyright (c) 2006 - 2010, Intel Corporation. All rights reserved.<BR>
|
||||||
|
|
||||||
|
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.
|
||||||
|
|
||||||
|
**/
|
||||||
|
|
||||||
|
#include <Library/BaseLib.h>
|
||||||
|
#include <Library/BaseMemoryLib.h>
|
||||||
|
#include <Library/UefiBootServicesTableLib.h>
|
||||||
|
|
||||||
|
#include "VirtioNet.h"
|
||||||
|
|
||||||
|
/**
|
||||||
|
Places a packet in the transmit queue of a network interface.
|
||||||
|
|
||||||
|
@param This The protocol instance pointer.
|
||||||
|
@param HeaderSize The size, in bytes, of the media header to be filled in by
|
||||||
|
the Transmit() function. If HeaderSize is non-zero, then
|
||||||
|
it must be equal to This->Mode->MediaHeaderSize and the
|
||||||
|
DestAddr and Protocol parameters must not be NULL.
|
||||||
|
@param BufferSize The size, in bytes, of the entire packet (media header and
|
||||||
|
data) to be transmitted through the network interface.
|
||||||
|
@param Buffer A pointer to the packet (media header followed by data) to
|
||||||
|
be transmitted. This parameter cannot be NULL. If
|
||||||
|
HeaderSize is zero, then the media header in Buffer must
|
||||||
|
already be filled in by the caller. If HeaderSize is
|
||||||
|
non-zero, then the media header will be filled in by the
|
||||||
|
Transmit() function.
|
||||||
|
@param SrcAddr The source HW MAC address. If HeaderSize is zero, then
|
||||||
|
this parameter is ignored. If HeaderSize is non-zero and
|
||||||
|
SrcAddr is NULL, then This->Mode->CurrentAddress is used
|
||||||
|
for the source HW MAC address.
|
||||||
|
@param DestAddr The destination HW MAC address. If HeaderSize is zero,
|
||||||
|
then this parameter is ignored.
|
||||||
|
@param Protocol The type of header to build. If HeaderSize is zero, then
|
||||||
|
this parameter is ignored. See RFC 1700, section "Ether
|
||||||
|
Types", for examples.
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS The packet was placed on the transmit queue.
|
||||||
|
@retval EFI_NOT_STARTED The network interface has not been started.
|
||||||
|
@retval EFI_NOT_READY The network interface is too busy to accept
|
||||||
|
this transmit request.
|
||||||
|
@retval EFI_BUFFER_TOO_SMALL The BufferSize parameter is too small.
|
||||||
|
@retval EFI_INVALID_PARAMETER One or more of the parameters has an
|
||||||
|
unsupported value.
|
||||||
|
@retval EFI_DEVICE_ERROR The command could not be sent to the network
|
||||||
|
interface.
|
||||||
|
@retval EFI_UNSUPPORTED This function is not supported by the network
|
||||||
|
interface.
|
||||||
|
|
||||||
|
**/
|
||||||
|
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
VirtioNetTransmit (
|
||||||
|
IN EFI_SIMPLE_NETWORK_PROTOCOL *This,
|
||||||
|
IN UINTN HeaderSize,
|
||||||
|
IN UINTN BufferSize,
|
||||||
|
IN /* +OUT! */ VOID *Buffer,
|
||||||
|
IN EFI_MAC_ADDRESS *SrcAddr OPTIONAL,
|
||||||
|
IN EFI_MAC_ADDRESS *DestAddr OPTIONAL,
|
||||||
|
IN UINT16 *Protocol OPTIONAL
|
||||||
|
)
|
||||||
|
{
|
||||||
|
VNET_DEV *Dev;
|
||||||
|
EFI_TPL OldTpl;
|
||||||
|
EFI_STATUS Status;
|
||||||
|
UINT16 DescIdx;
|
||||||
|
UINT16 AvailIdx;
|
||||||
|
|
||||||
|
if (This == NULL || BufferSize == 0 || Buffer == NULL) {
|
||||||
|
return EFI_INVALID_PARAMETER;
|
||||||
|
}
|
||||||
|
|
||||||
|
Dev = VIRTIO_NET_FROM_SNP (This);
|
||||||
|
OldTpl = gBS->RaiseTPL (TPL_CALLBACK);
|
||||||
|
switch (Dev->Snm.State) {
|
||||||
|
case EfiSimpleNetworkStopped:
|
||||||
|
Status = EFI_NOT_STARTED;
|
||||||
|
goto Exit;
|
||||||
|
case EfiSimpleNetworkStarted:
|
||||||
|
Status = EFI_DEVICE_ERROR;
|
||||||
|
goto Exit;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (BufferSize < Dev->Snm.MediaHeaderSize) {
|
||||||
|
Status = EFI_BUFFER_TOO_SMALL;
|
||||||
|
goto Exit;
|
||||||
|
}
|
||||||
|
if (BufferSize > Dev->Snm.MediaHeaderSize + Dev->Snm.MaxPacketSize) {
|
||||||
|
Status = EFI_INVALID_PARAMETER;
|
||||||
|
goto Exit;
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// check if we have room for transmission
|
||||||
|
//
|
||||||
|
ASSERT (Dev->TxCurPending <= Dev->TxMaxPending);
|
||||||
|
if (Dev->TxCurPending == Dev->TxMaxPending) {
|
||||||
|
Status = EFI_NOT_READY;
|
||||||
|
goto Exit;
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// the caller may want us to fill in the media header:
|
||||||
|
// dst MAC, src MAC, Ethertype
|
||||||
|
//
|
||||||
|
if (HeaderSize != 0) {
|
||||||
|
UINT8 *Ptr;
|
||||||
|
|
||||||
|
if (HeaderSize != Dev->Snm.MediaHeaderSize ||
|
||||||
|
DestAddr == NULL || Protocol == NULL) {
|
||||||
|
Status = EFI_INVALID_PARAMETER;
|
||||||
|
goto Exit;
|
||||||
|
}
|
||||||
|
Ptr = Buffer;
|
||||||
|
ASSERT (SIZE_OF_VNET (VhdrMac) <= sizeof (EFI_MAC_ADDRESS));
|
||||||
|
|
||||||
|
CopyMem (Ptr, DestAddr, SIZE_OF_VNET (VhdrMac));
|
||||||
|
Ptr += SIZE_OF_VNET (VhdrMac);
|
||||||
|
|
||||||
|
CopyMem (Ptr,
|
||||||
|
(SrcAddr == NULL) ? &Dev->Snm.CurrentAddress : SrcAddr,
|
||||||
|
SIZE_OF_VNET (VhdrMac));
|
||||||
|
Ptr += SIZE_OF_VNET (VhdrMac);
|
||||||
|
|
||||||
|
*Ptr++ = (UINT8) (*Protocol >> 8);
|
||||||
|
*Ptr++ = (UINT8) *Protocol;
|
||||||
|
|
||||||
|
ASSERT (Ptr - (UINT8 *) Buffer == Dev->Snm.MediaHeaderSize);
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// virtio-0.9.5, 2.4.1 Supplying Buffers to The Device
|
||||||
|
//
|
||||||
|
DescIdx = Dev->TxFreeStack[Dev->TxCurPending++];
|
||||||
|
Dev->TxRing.Desc[DescIdx + 1].Addr = (UINTN) Buffer;
|
||||||
|
Dev->TxRing.Desc[DescIdx + 1].Len = (UINT32) BufferSize;
|
||||||
|
|
||||||
|
//
|
||||||
|
// the available index is never written by the host, we can read it back
|
||||||
|
// without a barrier
|
||||||
|
//
|
||||||
|
AvailIdx = *Dev->TxRing.Avail.Idx;
|
||||||
|
Dev->TxRing.Avail.Ring[AvailIdx++ % Dev->TxRing.QueueSize] = DescIdx;
|
||||||
|
|
||||||
|
MemoryFence ();
|
||||||
|
*Dev->TxRing.Avail.Idx = AvailIdx;
|
||||||
|
|
||||||
|
MemoryFence ();
|
||||||
|
Status = VIRTIO_CFG_WRITE (Dev, Generic.VhdrQueueNotify, VIRTIO_NET_Q_TX);
|
||||||
|
|
||||||
|
Exit:
|
||||||
|
gBS->RestoreTPL (OldTpl);
|
||||||
|
return Status;
|
||||||
|
}
|
Loading…
Reference in New Issue