buffer.c File Reference

#include "precomp.h"

Include dependency graph for buffer.c:

Go to the source code of this file.

Functions
static INT	SkipToOffset (PNDIS_BUFFER Buffer, UINT Offset, PCHAR *Data, PUINT Size)
UINT	CopyBufferToBufferChain (PNDIS_BUFFER DstBuffer, UINT DstOffset, PCHAR SrcData, UINT Length)
UINT	CopyBufferChainToBuffer (PCHAR DstData, PNDIS_BUFFER SrcBuffer, UINT SrcOffset, UINT Length)
UINT	CopyPacketToBuffer (PCHAR DstData, PNDIS_PACKET SrcPacket, UINT SrcOffset, UINT Length)
UINT	CopyPacketToBufferChain (PNDIS_BUFFER DstBuffer, UINT DstOffset, PNDIS_PACKET SrcPacket, UINT SrcOffset, UINT Length)
UINT	ResizePacket (PNDIS_PACKET Packet, UINT Size)
void	GetDataPtr (PNDIS_PACKET Packet, UINT Offset, PCHAR *DataOut, PUINT Size)
NDIS_STATUS	AllocatePacketWithBuffer (PNDIS_PACKET *NdisPacket, PCHAR Data, UINT Len)
VOID	FreeNdisPacket (PNDIS_PACKET Packet)

Function Documentation

AllocatePacketWithBuffer()

NDIS_STATUS AllocatePacketWithBuffer	(	PNDIS_PACKET *	NdisPacket,
		PCHAR	Data,
		UINT	Len
	)

Definition at line 326 of file buffer.c.

                                             {
    PNDIS_PACKET Packet;
    PNDIS_BUFFER Buffer;
    NDIS_STATUS Status;
    PCHAR NewData;
 
    NewData = ExAllocatePoolWithTag( NonPagedPool, Len, PACKET_BUFFER_TAG );
    if( !NewData ) return NDIS_STATUS_RESOURCES;
 
    if( Data ) RtlCopyMemory(NewData, Data, Len);
 
    NdisAllocatePacket( &Status, &Packet, GlobalPacketPool );
    if( Status != NDIS_STATUS_SUCCESS ) {
    ExFreePoolWithTag( NewData, PACKET_BUFFER_TAG );
    return Status;
    }
 
    NdisAllocateBuffer( &Status, &Buffer, GlobalBufferPool, NewData, Len );
    if( Status != NDIS_STATUS_SUCCESS ) {
    ExFreePoolWithTag( NewData, PACKET_BUFFER_TAG );
    FreeNdisPacket( Packet );
    return Status;
    }
 
    NdisChainBufferAtFront( Packet, Buffer );
    *NdisPacket = Packet;
 
    return NDIS_STATUS_SUCCESS;
}

CopyBufferChainToBuffer()

UINT CopyBufferChainToBuffer	(	PCHAR	DstData,
		PNDIS_BUFFER	SrcBuffer,
		UINT	SrcOffset,
		UINT	Length
	)

Definition at line 113 of file buffer.c.

{
    UINT BytesCopied, BytesToCopy, SrcSize;
    PCHAR SrcData;
 
    TI_DbgPrint(DEBUG_PBUFFER, ("DstData 0x%X  SrcBuffer 0x%X  SrcOffset 0x%X  Length %d\n",DstData,SrcBuffer, SrcOffset, Length));
 
    /* Skip SrcOffset bytes in the source buffer chain */
    if (SkipToOffset(SrcBuffer, SrcOffset, &SrcData, &SrcSize) == -1)
        return 0;
 
    /* Start copying the data */
    BytesCopied = 0;
    for (;;) {
        BytesToCopy = MIN(SrcSize, Length);
 
        TI_DbgPrint(DEBUG_PBUFFER, ("Copying (%d) bytes from 0x%X to 0x%X\n", BytesToCopy, SrcData, DstData));
 
        RtlCopyMemory((PVOID)DstData, (PVOID)SrcData, BytesToCopy);
        BytesCopied += BytesToCopy;
        DstData      = (PCHAR)((ULONG_PTR)DstData + BytesToCopy);
 
        Length -= BytesToCopy;
        if (Length == 0)
            break;
 
        SrcSize -= BytesToCopy;
        if (SrcSize == 0) {
            /* No more bytes in source buffer. Proceed to
               the next buffer in the source buffer chain */
            NdisGetNextBuffer(SrcBuffer, &SrcBuffer);
            if (!SrcBuffer)
                break;
 
            NdisQueryBuffer(SrcBuffer, (PVOID)&SrcData, &SrcSize);
        }
    }
 
    return BytesCopied;
}

CopyBufferToBufferChain()

UINT CopyBufferToBufferChain	(	PNDIS_BUFFER	DstBuffer,
		UINT	DstOffset,
		PCHAR	SrcData,
		UINT	Length
	)

Definition at line 56 of file buffer.c.

{
    UINT BytesCopied, BytesToCopy, DstSize;
    PCHAR DstData;
 
    TI_DbgPrint(DEBUG_PBUFFER, ("DstBuffer (0x%X)  DstOffset (0x%X)  SrcData (0x%X)  Length (%d)\n", DstBuffer, DstOffset, SrcData, Length));
 
    /* Skip DstOffset bytes in the destination buffer chain */
    if (SkipToOffset(DstBuffer, DstOffset, &DstData, &DstSize) == -1)
        return 0;
 
    /* Start copying the data */
    BytesCopied = 0;
    for (;;) {
        BytesToCopy = MIN(DstSize, Length);
 
        RtlCopyMemory((PVOID)DstData, (PVOID)SrcData, BytesToCopy);
        BytesCopied += BytesToCopy;
        SrcData      = (PCHAR)((ULONG_PTR)SrcData + BytesToCopy);
 
        Length -= BytesToCopy;
        if (Length == 0)
            break;
 
        DstSize -= BytesToCopy;
        if (DstSize == 0) {
            /* No more bytes in destination buffer. Proceed to
               the next buffer in the destination buffer chain */
            NdisGetNextBuffer(DstBuffer, &DstBuffer);
            if (!DstBuffer)
                break;
 
            NdisQueryBuffer(DstBuffer, (PVOID)&DstData, &DstSize);
        }
    }
 
    return BytesCopied;
}

CopyPacketToBuffer()

UINT CopyPacketToBuffer	(	PCHAR	DstData,
		PNDIS_PACKET	SrcPacket,
		UINT	SrcOffset,
		UINT	Length
	)

Definition at line 172 of file buffer.c.

{
    PNDIS_BUFFER FirstBuffer;
    PVOID Address;
    UINT FirstLength;
    UINT TotalLength;
 
    TI_DbgPrint(DEBUG_PBUFFER, ("DstData (0x%X)  SrcPacket (0x%X)  SrcOffset (0x%X)  Length (%d)\n", DstData, SrcPacket, SrcOffset, Length));
 
    NdisGetFirstBufferFromPacket(SrcPacket,
                                 &FirstBuffer,
                                 &Address,
                                 &FirstLength,
                                 &TotalLength);
 
    return CopyBufferChainToBuffer(DstData, FirstBuffer, SrcOffset, Length);
}

CopyPacketToBufferChain()

UINT CopyPacketToBufferChain	(	PNDIS_BUFFER	DstBuffer,
		UINT	DstOffset,
		PNDIS_PACKET	SrcPacket,
		UINT	SrcOffset,
		UINT	Length
	)

Definition at line 208 of file buffer.c.

{
    PNDIS_BUFFER SrcBuffer;
    PCHAR DstData, SrcData;
    UINT DstSize, SrcSize;
    UINT Count, Total;
 
    TI_DbgPrint(DEBUG_PBUFFER, ("DstBuffer (0x%X)  DstOffset (0x%X)  SrcPacket (0x%X)  SrcOffset (0x%X)  Length (%d)\n", DstBuffer, DstOffset, SrcPacket, SrcOffset, Length));
 
    /* Skip DstOffset bytes in the destination buffer chain */
    NdisQueryBuffer(DstBuffer, (PVOID)&DstData, &DstSize);
    if (SkipToOffset(DstBuffer, DstOffset, &DstData, &DstSize) == -1)
        return 0;
 
    /* Skip SrcOffset bytes in the source packet */
    NdisGetFirstBufferFromPacket(SrcPacket, &SrcBuffer, (PVOID)&SrcData, &SrcSize, &Total);
    if (SkipToOffset(SrcBuffer, SrcOffset, &SrcData, &SrcSize) == -1)
        return 0;
 
    /* Copy the data */
    for (Total = 0;;) {
        /* Find out how many bytes we can copy at one time */
        if (Length < SrcSize)
            Count = Length;
        else
            Count = SrcSize;
        if (DstSize < Count)
            Count = DstSize;
 
        RtlCopyMemory((PVOID)DstData, (PVOID)SrcData, Count);
 
        Total  += Count;
        Length -= Count;
        if (Length == 0)
            break;
 
        DstSize -= Count;
        if (DstSize == 0) {
            /* No more bytes in destination buffer. Proceed to
               the next buffer in the destination buffer chain */
            NdisGetNextBuffer(DstBuffer, &DstBuffer);
            if (!DstBuffer)
                break;
 
            NdisQueryBuffer(DstBuffer, (PVOID)&DstData, &DstSize);
        }
 
        SrcSize -= Count;
        if (SrcSize == 0) {
            /* No more bytes in source buffer. Proceed to
               the next buffer in the source buffer chain */
            NdisGetNextBuffer(SrcBuffer, &SrcBuffer);
            if (!SrcBuffer)
                break;
 
            NdisQueryBuffer(SrcBuffer, (PVOID)&SrcData, &SrcSize);
        }
    }
 
    return Total;
}

FreeNdisPacket()

VOID FreeNdisPacket

(

PNDIS_PACKET

Packet

)

Definition at line 358 of file buffer.c.

{
    PNDIS_BUFFER Buffer, NextBuffer;
 
    TI_DbgPrint(DEBUG_PBUFFER, ("Packet (0x%X)\n", Packet));
 
    /* Free all the buffers in the packet first */
    NdisQueryPacket(Packet, NULL, NULL, &Buffer, NULL);
    for (; Buffer != NULL; Buffer = NextBuffer) {
        PVOID Data;
        UINT Length;
 
        NdisGetNextBuffer(Buffer, &NextBuffer);
        NdisQueryBuffer(Buffer, &Data, &Length);
    TI_DbgPrint(DEBUG_PBUFFER, ("Freeing ndis buffer (0x%X)\n", Buffer));
        NdisFreeBuffer(Buffer);
    TI_DbgPrint(DEBUG_PBUFFER, ("Freeing exal buffer (0x%X)\n", Data));
        ExFreePoolWithTag(Data, PACKET_BUFFER_TAG);
    }
 
    /* Finally free the NDIS packet descriptor */
    NdisFreePacket(Packet);
}

GetDataPtr()

void GetDataPtr	(	PNDIS_PACKET	Packet,
		UINT	Offset,
		PCHAR *	DataOut,
		PUINT	Size
	)

Definition at line 315 of file buffer.c.

                      {
    PNDIS_BUFFER Buffer;
 
    NdisQueryPacket(Packet, NULL, NULL, &Buffer, NULL);
    if( !Buffer ) return;
    SkipToOffset( Buffer, Offset, DataOut, Size );
}

ResizePacket()

UINT ResizePacket	(	PNDIS_PACKET	Packet,
		UINT	Size
	)

Definition at line 290 of file buffer.c.

{
    PNDIS_BUFFER NdisBuffer;
    UINT OldSize;
 
    NdisQueryPacket(Packet, NULL, NULL, &NdisBuffer, NULL);
 
    OldSize = NdisBuffer->ByteCount;
 
    if (Size != OldSize)
        NdisBuffer->ByteCount = Size;
 
    return OldSize;
}

SkipToOffset()

static INT SkipToOffset ( PNDIS_BUFFER  Buffer, UINT  Offset, PCHAR *  Data, PUINT  Size  )

inlinestatic

Definition at line 14 of file buffer.c.

{
    for (;;) {
 
        if (!Buffer)
            return -1;
 
        NdisQueryBuffer(Buffer, (PVOID)Data, Size);
 
        if (Offset < *Size) {
            *Data = (PCHAR)((ULONG_PTR) *Data + Offset);
            *Size              -= Offset;
            break;
        }
 
        Offset -= *Size;
 
        NdisGetNextBuffer(Buffer, &Buffer);
    }
 
    return Offset;
}