ParaNdis-VirtIO.c File Reference

#include "ndis56common.h"

Include dependency graph for ParaNdis-VirtIO.c:

Go to the source code of this file.

Macros
#define	PORT_MASK   0xFFFF

Functions
static u32	ReadVirtIODeviceRegister (ULONG_PTR ulRegister)
static void	WriteVirtIODeviceRegister (ULONG_PTR ulRegister, u32 ulValue)
static u8	ReadVirtIODeviceByte (ULONG_PTR ulRegister)
static void	WriteVirtIODeviceByte (ULONG_PTR ulRegister, u8 bValue)
static u16	ReadVirtIODeviceWord (ULONG_PTR ulRegister)
static void	WriteVirtIODeviceWord (ULONG_PTR ulRegister, u16 wValue)
static void *	mem_alloc_contiguous_pages (void *context, size_t size)
static void	mem_free_contiguous_pages (void *context, void *virt)
static ULONGLONG	mem_get_physical_address (void *context, void *virt)
static void *	mem_alloc_nonpaged_block (void *context, size_t size)
static void	mem_free_nonpaged_block (void *context, void *addr)
static int	PCIReadConfig (PPARANDIS_ADAPTER pContext, int where, void *buffer, size_t length)
static int	pci_read_config_byte (void *context, int where, u8 *bVal)
static int	pci_read_config_word (void *context, int where, u16 *wVal)
static int	pci_read_config_dword (void *context, int where, u32 *dwVal)
static size_t	pci_get_resource_len (void *context, int bar)
static void *	pci_map_address_range (void *context, int bar, size_t offset, size_t maxlen)
static u16	vdev_get_msix_vector (void *context, int queue)
static void	vdev_sleep (void *context, unsigned int msecs)

Variables
VirtIOSystemOps	ParaNdisSystemOps

Macro Definition Documentation

PORT_MASK

#define PORT_MASK   0xFFFF

Definition at line 41 of file ParaNdis-VirtIO.c.

Function Documentation

mem_alloc_contiguous_pages()

static void* mem_alloc_contiguous_pages ( void *  context, size_t  size  )

static

Definition at line 135 of file ParaNdis-VirtIO.c.

{
    PARANDIS_ADAPTER *pContext = (PARANDIS_ADAPTER *)context;
    PVOID retVal = NULL;
    ULONG i;

    /* find the first unused memory range of the requested size */
    for (i = 0; i < MAX_NUM_OF_QUEUES; i++) {
        if (pContext->SharedMemoryRanges[i].pBase != NULL &&
            pContext->SharedMemoryRanges[i].bUsed == FALSE &&
            pContext->SharedMemoryRanges[i].uLength == (ULONG)size) {
            retVal = pContext->SharedMemoryRanges[i].pBase;
            pContext->SharedMemoryRanges[i].bUsed = TRUE;
            break;
        }
    }

    if (!retVal) {
        /* find the first null memory range descriptor and allocate */
        for (i = 0; i < MAX_NUM_OF_QUEUES; i++) {
            if (pContext->SharedMemoryRanges[i].pBase == NULL) {
                break;
            }
        }
        if (i < MAX_NUM_OF_QUEUES) {
            NdisMAllocateSharedMemory(
                pContext->MiniportHandle,
                (ULONG)size,
                TRUE /* Cached */,
                &pContext->SharedMemoryRanges[i].pBase,
                &pContext->SharedMemoryRanges[i].BasePA);
            retVal = pContext->SharedMemoryRanges[i].pBase;
            if (retVal) {
                NdisZeroMemory(retVal, size);
                pContext->SharedMemoryRanges[i].uLength = (ULONG)size;
                pContext->SharedMemoryRanges[i].bUsed = TRUE;
            }
        }
    }

    if (retVal) {
        DPrintf(6, ("[%s] returning %p, size %x\n", __FUNCTION__, retVal, (ULONG)size));
    } else {
        DPrintf(0, ("[%s] failed to allocate size %x\n", __FUNCTION__, (ULONG)size));
    }
    return retVal;
}

mem_alloc_nonpaged_block()

static void* mem_alloc_nonpaged_block ( void *  context, size_t  size  )

static

Definition at line 222 of file ParaNdis-VirtIO.c.

{
    PVOID retVal;

    if (NdisAllocateMemoryWithTag(
        &retVal,
        (UINT)size,
        PARANDIS_MEMORY_TAG) != NDIS_STATUS_SUCCESS) {
        retVal = NULL;
    }

    if (retVal) {
        NdisZeroMemory(retVal, size);
        DPrintf(6, ("[%s] returning %p, len %x\n", __FUNCTION__, retVal, (ULONG)size));
    } else {
        DPrintf(0, ("[%s] failed to allocate size %x\n", __FUNCTION__, (ULONG)size));
    }
    return retVal;
}

mem_free_contiguous_pages()

static void mem_free_contiguous_pages ( void *  context, void *  virt  )

static

Definition at line 183 of file ParaNdis-VirtIO.c.

{
    PARANDIS_ADAPTER *pContext = (PARANDIS_ADAPTER *)context;
    ULONG i;

    for (i = 0; i < MAX_NUM_OF_QUEUES; i++) {
        if (pContext->SharedMemoryRanges[i].pBase == virt) {
            pContext->SharedMemoryRanges[i].bUsed = FALSE;
            break;
        }
    }

    if (i < MAX_NUM_OF_QUEUES) {
        DPrintf(6, ("[%s] freed %p at index %d\n", __FUNCTION__, virt, i));
    } else {
        DPrintf(0, ("[%s] failed to free %p\n", __FUNCTION__, virt));
    }
}

mem_free_nonpaged_block()

static void mem_free_nonpaged_block ( void *  context, void *  addr  )

static

Definition at line 242 of file ParaNdis-VirtIO.c.

{
    UNREFERENCED_PARAMETER(context);

    NdisFreeMemory(addr, 0, 0);
    DPrintf(6, ("[%s] freed %p\n", __FUNCTION__, addr));
}

mem_get_physical_address()

static ULONGLONG mem_get_physical_address ( void *  context, void *  virt  )

static

Definition at line 202 of file ParaNdis-VirtIO.c.

{
    PARANDIS_ADAPTER *pContext = (PARANDIS_ADAPTER *)context;
    ULONG_PTR uAddr = (ULONG_PTR)virt;
    ULONG i;

    for (i = 0; i < MAX_NUM_OF_QUEUES; i++) {
        ULONG_PTR uBase = (ULONG_PTR)pContext->SharedMemoryRanges[i].pBase;
        if (uAddr >= uBase && uAddr < (uBase + pContext->SharedMemoryRanges[i].uLength)) {
            ULONGLONG retVal = pContext->SharedMemoryRanges[i].BasePA.QuadPart + (uAddr - uBase);

            DPrintf(6, ("[%s] translated %p to %I64X\n", __FUNCTION__, virt, retVal));
            return retVal;
        }
    }

    DPrintf(0, ("[%s] failed to translate %p\n", __FUNCTION__, virt));
    return 0;
}

pci_get_resource_len()

static size_t pci_get_resource_len ( void *  context, int  bar  )

static

Definition at line 288 of file ParaNdis-VirtIO.c.

{
    PARANDIS_ADAPTER *pContext = (PARANDIS_ADAPTER *)context;

    if (bar < PCI_TYPE0_ADDRESSES) {
        return pContext->AdapterResources.PciBars[bar].uLength;
    }

    DPrintf(0, ("[%s] queried invalid BAR %d\n", __FUNCTION__, bar));
    return 0;
}

pci_map_address_range()

static void* pci_map_address_range ( void *  context, int  bar, size_t  offset, size_t  maxlen  )

static

Definition at line 300 of file ParaNdis-VirtIO.c.

{
    PARANDIS_ADAPTER *pContext = (PARANDIS_ADAPTER *)context;

    if (bar < PCI_TYPE0_ADDRESSES) {
        tBusResource *pRes = &pContext->AdapterResources.PciBars[bar];
        if (pRes->pBase == NULL) {
            /* BAR not mapped yet */
            if (pRes->bPortSpace) {
                if (NDIS_STATUS_SUCCESS == NdisMRegisterIoPortRange(
                    &pRes->pBase,
                    pContext->MiniportHandle,
                    pRes->BasePA.LowPart,
                    pRes->uLength)) {
                    DPrintf(6, ("[%s] mapped port BAR at %x\n", __FUNCTION__, pRes->BasePA.LowPart));
                } else {
                    pRes->pBase = NULL;
                    DPrintf(0, ("[%s] failed to map port BAR at %x\n", __FUNCTION__, pRes->BasePA.LowPart));
                }
            } else {
                if (NDIS_STATUS_SUCCESS == NdisMMapIoSpace(
                    &pRes->pBase,
                    pContext->MiniportHandle,
                    pRes->BasePA,
                    pRes->uLength)) {
                    DPrintf(6, ("[%s] mapped memory BAR at %I64x\n", __FUNCTION__, pRes->BasePA.QuadPart));
                } else {
                    pRes->pBase = NULL;
                    DPrintf(0, ("[%s] failed to map memory BAR at %I64x\n", __FUNCTION__, pRes->BasePA.QuadPart));
                }
            }
        }
        if (pRes->pBase != NULL && offset < pRes->uLength) {
            if (pRes->bPortSpace) {
                /* use physical address for port I/O */
                return (PUCHAR)(ULONG_PTR)pRes->BasePA.LowPart + offset;
            } else {
                /* use virtual address for memory I/O */
                return (PUCHAR)pRes->pBase + offset;
            }
        } else {
            DPrintf(0, ("[%s] failed to get map BAR %d, offset %x\n", __FUNCTION__, bar, offset));
        }
    } else {
        DPrintf(0, ("[%s] queried invalid BAR %d\n", __FUNCTION__, bar));
    }

    return NULL;
}

pci_read_config_byte()

static int pci_read_config_byte ( void *  context, int  where, u8 *  bVal  )

static

Definition at line 273 of file ParaNdis-VirtIO.c.

{
    return PCIReadConfig((PPARANDIS_ADAPTER)context, where, bVal, sizeof(*bVal));
}

pci_read_config_dword()

static int pci_read_config_dword ( void *  context, int  where, u32 *  dwVal  )

static

Definition at line 283 of file ParaNdis-VirtIO.c.

{
    return PCIReadConfig((PPARANDIS_ADAPTER)context, where, dwVal, sizeof(*dwVal));
}

pci_read_config_word()

static int pci_read_config_word ( void *  context, int  where, u16 *  wVal  )

static

Definition at line 278 of file ParaNdis-VirtIO.c.

{
    return PCIReadConfig((PPARANDIS_ADAPTER)context, where, wVal, sizeof(*wVal));
}

PCIReadConfig()

static int PCIReadConfig ( PPARANDIS_ADAPTER  pContext, int  where, void *  buffer, size_t  length  )

static

Definition at line 250 of file ParaNdis-VirtIO.c.

{
    ULONG read;

    read = NdisReadPciSlotInformation(
        pContext->MiniportHandle,
        0 /* SlotNumber */,
        where,
        buffer,
        (ULONG)length);

    if (read == length) {
        DPrintf(6, ("[%s] read %d bytes at %d\n", __FUNCTION__, read, where));
        return 0;
    } else {
        DPrintf(0, ("[%s] failed to read %d bytes at %d\n", __FUNCTION__, read, where));
        return -1;
    }
}

Referenced by pci_read_config_byte(), pci_read_config_dword(), and pci_read_config_word().

ReadVirtIODeviceByte()

static u8 ReadVirtIODeviceByte ( ULONG_PTR  ulRegister )

static

Definition at line 68 of file ParaNdis-VirtIO.c.

{
    u8 bValue;

    if (ulRegister & ~PORT_MASK) {
        NdisReadRegisterUchar(ulRegister, &bValue);
    } else {
        NdisRawReadPortUchar(ulRegister, &bValue);
    }

    DPrintf(6, ("[%s]R[%x]=%x", __FUNCTION__, (ULONG)ulRegister, bValue));
    return bValue;
}

ReadVirtIODeviceRegister()

static u32 ReadVirtIODeviceRegister ( ULONG_PTR  ulRegister )

static

Definition at line 43 of file ParaNdis-VirtIO.c.

{
    ULONG ulValue;

    if (ulRegister & ~PORT_MASK) {
        NdisReadRegisterUlong(ulRegister, &ulValue);
    } else {
        NdisRawReadPortUlong(ulRegister, &ulValue);
    }

    DPrintf(6, ("[%s]R[%x]=%x", __FUNCTION__, (ULONG)ulRegister, ulValue));
    return ulValue;
}

ReadVirtIODeviceWord()

static u16 ReadVirtIODeviceWord ( ULONG_PTR  ulRegister )

static

Definition at line 93 of file ParaNdis-VirtIO.c.

{
    u16 wValue;

    if (ulRegister & ~PORT_MASK) {
        NdisReadRegisterUshort(ulRegister, &wValue);
    } else {
        NdisRawReadPortUshort(ulRegister, &wValue);
    }

    DPrintf(6, ("[%s]R[%x]=%x\n", __FUNCTION__, (ULONG)ulRegister, wValue));
    return wValue;
}

vdev_get_msix_vector()

static u16 vdev_get_msix_vector ( void *  context, int  queue  )

static

Definition at line 350 of file ParaNdis-VirtIO.c.

{
    PARANDIS_ADAPTER *pContext = (PARANDIS_ADAPTER *)context;
    u16 vector = VIRTIO_MSI_NO_VECTOR;

    /* we don't run on MSI support so this will never be true */
    if (pContext->bUsingMSIX && queue >= 0) {
        vector = (u16)pContext->AdapterResources.Vector;
    }

    return vector;
}

vdev_sleep()

static void vdev_sleep ( void *  context, unsigned int  msecs  )

static

Definition at line 363 of file ParaNdis-VirtIO.c.

{
    UNREFERENCED_PARAMETER(context);

    NdisMSleep(1000 * msecs);
}

WriteVirtIODeviceByte()

static void WriteVirtIODeviceByte ( ULONG_PTR  ulRegister, u8  bValue  )

static

Definition at line 82 of file ParaNdis-VirtIO.c.

{
    DPrintf(6, ("[%s]R[%x]=%x", __FUNCTION__, (ULONG)ulRegister, bValue));

    if (ulRegister & ~PORT_MASK) {
        NdisWriteRegisterUchar((PUCHAR)ulRegister, bValue);
    } else {
        NdisRawWritePortUchar(ulRegister, bValue);
    }
}

Referenced by CheckRunningDpc(), and ParaNdis_CallOnBugCheck().

WriteVirtIODeviceRegister()

static void WriteVirtIODeviceRegister ( ULONG_PTR  ulRegister, u32  ulValue  )

static

Definition at line 57 of file ParaNdis-VirtIO.c.

{
    DPrintf(6, ("[%s]R[%x]=%x", __FUNCTION__, (ULONG)ulRegister, ulValue));

    if (ulRegister & ~PORT_MASK) {
        NdisWriteRegisterUlong((PULONG)ulRegister, ulValue);
    } else {
        NdisRawWritePortUlong(ulRegister, ulValue);
    }
}

WriteVirtIODeviceWord()

static void WriteVirtIODeviceWord ( ULONG_PTR  ulRegister, u16  wValue  )

static

Definition at line 107 of file ParaNdis-VirtIO.c.

{
#if 1
    if (ulRegister & ~PORT_MASK) {
        NdisWriteRegisterUshort((PUSHORT)ulRegister, wValue);
    } else {
        NdisRawWritePortUshort(ulRegister, wValue);
    }
#else
    // test only to cause long TX waiting queue of NDIS packets
    // to recognize it and request for reset via Hang handler
    static int nCounterToFail = 0;
    static const int StartFail = 200, StopFail = 600;
    BOOLEAN bFail = FALSE;
    DPrintf(6, ("%s> R[%x] = %x\n", __FUNCTION__, (ULONG)ulRegister, wValue));
    if ((ulRegister & 0x1F) == 0x10)
    {
        nCounterToFail++;
        bFail = nCounterToFail >= StartFail && nCounterToFail < StopFail;
    }
    if (!bFail) NdisRawWritePortUshort(ulRegister, wValue);
    else
    {
        DPrintf(0, ("%s> FAILING R[%x] = %x\n", __FUNCTION__, (ULONG)ulRegister, wValue));
    }
#endif
}

Variable Documentation

ParaNdisSystemOps

VirtIOSystemOps ParaNdisSystemOps

Initial value:

= {
     ReadVirtIODeviceByte,
     ReadVirtIODeviceWord,
     ReadVirtIODeviceRegister,
     WriteVirtIODeviceByte,
     WriteVirtIODeviceWord,
     WriteVirtIODeviceRegister,
     mem_alloc_contiguous_pages,
     mem_free_contiguous_pages,
     mem_get_physical_address,
     mem_alloc_nonpaged_block,
     mem_free_nonpaged_block,
     pci_read_config_byte,
     pci_read_config_word,
     pci_read_config_dword,
     pci_get_resource_len,
     pci_map_address_range,
     vdev_get_msix_vector,
     vdev_sleep,
}

Definition at line 370 of file ParaNdis-VirtIO.c.

Referenced by ParaNdis_InitializeContext().