1495 lines
34 KiB
C
1495 lines
34 KiB
C
/*++
|
||
|
||
Copyright (c) 1989-1993 Microsoft Corporation
|
||
|
||
Module Name:
|
||
|
||
packet.c
|
||
|
||
Abstract:
|
||
|
||
This module contains code that implements the SEND_PACKET and
|
||
RECEIVE_PACKET objects, which describe NDIS packets used
|
||
by the transport.
|
||
|
||
Environment:
|
||
|
||
Kernel mode
|
||
|
||
Revision History:
|
||
|
||
--*/
|
||
|
||
#include "precomp.h"
|
||
#pragma hdrstop
|
||
|
||
//
|
||
// Local Function Protos
|
||
//
|
||
#if defined(_PNP_POWER)
|
||
#if !defined(DBG)
|
||
__inline
|
||
#endif
|
||
VOID
|
||
NbiFreeReceiveBufferPool (
|
||
IN PNB_RECEIVE_BUFFER_POOL ReceiveBufferPool
|
||
);
|
||
#endif _PNP_POWER
|
||
|
||
|
||
NTSTATUS
|
||
NbiInitializeSendPacket(
|
||
IN PDEVICE Device,
|
||
IN NDIS_HANDLE PoolHandle OPTIONAL,
|
||
IN PNB_SEND_PACKET Packet,
|
||
IN PUCHAR Header,
|
||
IN ULONG HeaderLength
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine initializes a send packet by chaining the
|
||
buffer for the header on it.
|
||
|
||
NOTE: THIS ROUTINE IS CALLED WITH THE DEVICE LOCK HELD,
|
||
AND RETURNS WITH IT HELD.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
PoolHandle - Ndis packet pool handle if !NB_OWN_PACKETS
|
||
|
||
Packet - The packet to initialize.
|
||
|
||
Header - Points to storage for the header.
|
||
|
||
HeaderLength - The length of the header.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
|
||
NDIS_STATUS NdisStatus;
|
||
NTSTATUS Status;
|
||
PNDIS_BUFFER NdisBuffer;
|
||
PNDIS_BUFFER NdisNbBuffer;
|
||
PNB_SEND_RESERVED Reserved;
|
||
ULONG MacHeaderNeeded = NbiDevice->Bind.MacHeaderNeeded;
|
||
|
||
NbiAllocateSendPacket (Device, PoolHandle, Packet, &Status);
|
||
|
||
if (Status != STATUS_SUCCESS) {
|
||
// ERROR LOG
|
||
return Status;
|
||
}
|
||
// DbgPrint("NbiInitializeSendPacket: PACKET is (%x)\n", PACKET(Packet));
|
||
|
||
//
|
||
// allocate the mac header.
|
||
//
|
||
NdisAllocateBuffer(
|
||
&NdisStatus,
|
||
&NdisBuffer,
|
||
Device->NdisBufferPoolHandle,
|
||
Header,
|
||
MacHeaderNeeded);
|
||
|
||
if (NdisStatus != NDIS_STATUS_SUCCESS) {
|
||
NbiFreeSendPacket (Device, Packet);
|
||
// ERROR LOG
|
||
return STATUS_INSUFFICIENT_RESOURCES;
|
||
}
|
||
|
||
NdisChainBufferAtFront (PACKET(Packet), NdisBuffer);
|
||
|
||
// DbgPrint("NbiInitializeSendPacket: MAC header address is (%x)\n", NdisBuffer);
|
||
//
|
||
// Allocate the nb header
|
||
//
|
||
NdisAllocateBuffer(
|
||
&NdisStatus,
|
||
&NdisNbBuffer,
|
||
Device->NdisBufferPoolHandle,
|
||
Header + MacHeaderNeeded,
|
||
HeaderLength - MacHeaderNeeded);
|
||
|
||
if (NdisStatus != NDIS_STATUS_SUCCESS) {
|
||
NdisBuffer = NULL;
|
||
NdisUnchainBufferAtFront (PACKET(Packet), &NdisBuffer);
|
||
CTEAssert (NdisBuffer);
|
||
|
||
if (NdisBuffer)
|
||
{
|
||
NdisAdjustBufferLength (NdisBuffer, MacHeaderNeeded);
|
||
NdisFreeBuffer (NdisBuffer);
|
||
}
|
||
NbiFreeSendPacket (Device, Packet);
|
||
// ERROR LOG
|
||
return STATUS_INSUFFICIENT_RESOURCES;
|
||
}
|
||
|
||
// DbgPrint("NbiInitializeSendPacket: IPX header address is (%x)\n", NdisNbBuffer);
|
||
NdisChainBufferAtBack (PACKET(Packet), NdisNbBuffer);
|
||
|
||
Reserved = SEND_RESERVED(Packet);
|
||
Reserved->Identifier = IDENTIFIER_NB;
|
||
Reserved->SendInProgress = FALSE;
|
||
Reserved->OwnedByConnection = FALSE;
|
||
Reserved->Header = Header;
|
||
Reserved->HeaderBuffer = NdisBuffer;
|
||
|
||
Reserved->Reserved[0] = NULL;
|
||
Reserved->Reserved[1] = NULL;
|
||
|
||
InsertHeadList(
|
||
&Device->GlobalSendPacketList,
|
||
&Reserved->GlobalLinkage);
|
||
|
||
return STATUS_SUCCESS;
|
||
|
||
} /* NbiInitializeSendPacket */
|
||
|
||
|
||
NTSTATUS
|
||
NbiInitializeReceivePacket(
|
||
IN PDEVICE Device,
|
||
IN NDIS_HANDLE PoolHandle OPTIONAL,
|
||
IN PNB_RECEIVE_PACKET Packet
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine initializes a receive packet.
|
||
|
||
NOTE: THIS ROUTINE IS CALLED WITH THE DEVICE LOCK HELD,
|
||
AND RETURNS WITH IT HELD.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
PoolHandle - Ndis packet pool handle if !NB_OWN_PACKETS
|
||
|
||
Packet - The packet to initialize.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
|
||
NTSTATUS Status;
|
||
PNB_RECEIVE_RESERVED Reserved;
|
||
|
||
NbiAllocateReceivePacket (Device, PoolHandle, Packet, &Status);
|
||
|
||
if (Status != STATUS_SUCCESS) {
|
||
// ERROR LOG
|
||
return Status;
|
||
}
|
||
|
||
Reserved = RECEIVE_RESERVED(Packet);
|
||
Reserved->Identifier = IDENTIFIER_NB;
|
||
Reserved->TransferInProgress = FALSE;
|
||
|
||
InsertHeadList(
|
||
&Device->GlobalReceivePacketList,
|
||
&Reserved->GlobalLinkage);
|
||
|
||
return STATUS_SUCCESS;
|
||
|
||
} /* NbiInitializeReceivePacket */
|
||
|
||
|
||
NTSTATUS
|
||
NbiInitializeReceiveBuffer(
|
||
IN PDEVICE Device,
|
||
IN PNB_RECEIVE_BUFFER ReceiveBuffer,
|
||
IN PUCHAR DataBuffer,
|
||
IN ULONG DataBufferLength
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine initializes a receive buffer by allocating
|
||
an NDIS_BUFFER to describe the data buffer.
|
||
|
||
NOTE: THIS ROUTINE IS CALLED WITH THE DEVICE LOCK HELD,
|
||
AND RETURNS WITH IT HELD.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
ReceiveBuffer - The receive buffer to initialize.
|
||
|
||
DataBuffer - The data buffer.
|
||
|
||
DataBufferLength - The length of the data buffer.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
|
||
NDIS_STATUS NdisStatus;
|
||
PNDIS_BUFFER NdisBuffer;
|
||
|
||
|
||
NdisAllocateBuffer(
|
||
&NdisStatus,
|
||
&NdisBuffer,
|
||
Device->NdisBufferPoolHandle,
|
||
DataBuffer,
|
||
DataBufferLength);
|
||
|
||
if (NdisStatus != NDIS_STATUS_SUCCESS) {
|
||
// ERROR LOG
|
||
return STATUS_INSUFFICIENT_RESOURCES;
|
||
}
|
||
|
||
ReceiveBuffer->NdisBuffer = NdisBuffer;
|
||
ReceiveBuffer->Data = DataBuffer;
|
||
ReceiveBuffer->DataLength = 0;
|
||
|
||
InsertHeadList(
|
||
&Device->GlobalReceiveBufferList,
|
||
&ReceiveBuffer->GlobalLinkage);
|
||
|
||
return STATUS_SUCCESS;
|
||
|
||
} /* NbiInitializeReceiveBuffer */
|
||
|
||
|
||
|
||
VOID
|
||
NbiDeinitializeSendPacket(
|
||
IN PDEVICE Device,
|
||
IN PNB_SEND_PACKET Packet,
|
||
IN ULONG HeaderLength
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine deinitializes a send packet.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
Packet - The packet to deinitialize.
|
||
|
||
HeaderLength - The length of the first buffer on the packet.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
PNDIS_BUFFER NdisBuffer = NULL;
|
||
PNB_SEND_RESERVED Reserved;
|
||
CTELockHandle LockHandle;
|
||
ULONG MacHeaderNeeded = NbiDevice->Bind.MacHeaderNeeded;
|
||
|
||
CTEAssert(HeaderLength > MacHeaderNeeded);
|
||
Reserved = SEND_RESERVED(Packet);
|
||
|
||
NB_GET_LOCK (&Device->Lock, &LockHandle);
|
||
RemoveEntryList (&Reserved->GlobalLinkage);
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
|
||
//
|
||
// Free the mac header
|
||
//
|
||
// DbgPrint("NbiDeinitializeSendPacket: PACKET is (%x)\n", PACKET(Packet));
|
||
NdisUnchainBufferAtFront (PACKET(Packet), &NdisBuffer);
|
||
CTEAssert (NdisBuffer);
|
||
// DbgPrint("NbiDeinitializeSendPacket: MAC header address is (%x)\n", NdisBuffer);
|
||
|
||
if (NdisBuffer)
|
||
{
|
||
NdisAdjustBufferLength (NdisBuffer, MacHeaderNeeded);
|
||
NdisFreeBuffer (NdisBuffer);
|
||
}
|
||
|
||
//
|
||
// Free the nb header
|
||
//
|
||
NdisBuffer = NULL;
|
||
NdisUnchainBufferAtFront (PACKET(Packet), &NdisBuffer);
|
||
// DbgPrint("NbiDeinitializeSendPacket: IPX header address is (%x)\n", NdisBuffer);
|
||
CTEAssert (NdisBuffer);
|
||
|
||
if (NdisBuffer)
|
||
{
|
||
NdisAdjustBufferLength (NdisBuffer, HeaderLength - MacHeaderNeeded);
|
||
NdisFreeBuffer (NdisBuffer);
|
||
}
|
||
|
||
//
|
||
// free the packet
|
||
//
|
||
NbiFreeSendPacket (Device, Packet);
|
||
|
||
} /* NbiDeinitializeSendPacket */
|
||
|
||
|
||
VOID
|
||
NbiDeinitializeReceivePacket(
|
||
IN PDEVICE Device,
|
||
IN PNB_RECEIVE_PACKET Packet
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine initializes a receive packet.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
Packet - The packet to initialize.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
|
||
PNB_RECEIVE_RESERVED Reserved;
|
||
CTELockHandle LockHandle;
|
||
|
||
Reserved = RECEIVE_RESERVED(Packet);
|
||
|
||
NB_GET_LOCK (&Device->Lock, &LockHandle);
|
||
RemoveEntryList (&Reserved->GlobalLinkage);
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
|
||
NbiFreeReceivePacket (Device, Packet);
|
||
|
||
} /* NbiDeinitializeReceivePacket */
|
||
|
||
|
||
|
||
VOID
|
||
NbiDeinitializeReceiveBuffer(
|
||
IN PDEVICE Device,
|
||
IN PNB_RECEIVE_BUFFER ReceiveBuffer
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine deinitializes a receive buffer.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
ReceiveBuffer - The receive buffer.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
THIS ROUTINE SHOULD BE CALLED WITH THE DEVICE LOCK HELD. If this
|
||
routine also called from the DestroyDevice routine, it is not
|
||
necessary to call this with the lock.
|
||
|
||
--*/
|
||
|
||
{
|
||
#if defined(_PNP_POWER)
|
||
RemoveEntryList (&ReceiveBuffer->GlobalLinkage);
|
||
#else
|
||
CTELockHandle LockHandle;
|
||
|
||
NB_GET_LOCK (&Device->Lock, &LockHandle);
|
||
RemoveEntryList (&ReceiveBuffer->GlobalLinkage);
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
#endif _PNP_POWER
|
||
|
||
NdisFreeBuffer (ReceiveBuffer->NdisBuffer);
|
||
|
||
} /* NbiDeinitializeReceiveBuffer */
|
||
|
||
|
||
|
||
VOID
|
||
NbiAllocateSendPool(
|
||
IN PDEVICE Device
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine adds 10 packets to the pool for this device.
|
||
|
||
NOTE: THIS ROUTINE IS CALLED WITH THE DEVICE LOCK HELD AND
|
||
RETURNS WITH IT HELD.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
PNB_SEND_POOL SendPool;
|
||
UINT SendPoolSize;
|
||
UINT PacketNum;
|
||
PNB_SEND_PACKET Packet;
|
||
PNB_SEND_RESERVED Reserved;
|
||
PUCHAR Header;
|
||
ULONG HeaderLength;
|
||
NTSTATUS Status;
|
||
|
||
HeaderLength = Device->Bind.MacHeaderNeeded + sizeof(NB_CONNECTIONLESS);
|
||
SendPoolSize = FIELD_OFFSET (NB_SEND_POOL, Packets[0]) +
|
||
(sizeof(NB_SEND_PACKET) * Device->InitPackets) +
|
||
(HeaderLength * Device->InitPackets);
|
||
|
||
SendPool = (PNB_SEND_POOL)NbiAllocateMemory (SendPoolSize, MEMORY_PACKET, "SendPool");
|
||
if (SendPool == NULL) {
|
||
NB_DEBUG (PACKET, ("Could not allocate send pool memory\n"));
|
||
return;
|
||
}
|
||
|
||
RtlZeroMemory (SendPool, SendPoolSize);
|
||
|
||
|
||
#if !defined(NB_OWN_PACKETS)
|
||
//
|
||
// Now allocate the ndis packet pool
|
||
//
|
||
SendPool->PoolHandle = (NDIS_HANDLE) NDIS_PACKET_POOL_TAG_FOR_NWLNKNB; // Dbg info for Ndis!
|
||
NdisAllocatePacketPoolEx (&Status, &SendPool->PoolHandle, Device->InitPackets, 0, sizeof(NB_SEND_RESERVED));
|
||
if (!NT_SUCCESS(Status)){
|
||
NB_DEBUG (PACKET, ("Could not allocate Ndis Packet Pool memory\n"));
|
||
NbiFreeMemory( SendPool, SendPoolSize, MEMORY_PACKET, "Send Pool Freed");
|
||
return;
|
||
}
|
||
|
||
NdisSetPacketPoolProtocolId (SendPool->PoolHandle, NDIS_PROTOCOL_ID_IPX);
|
||
#endif
|
||
|
||
NB_DEBUG2 (PACKET, ("Initializing send pool %lx, %d packets, header %d\n",
|
||
SendPool, Device->InitPackets, HeaderLength));
|
||
|
||
Header = (PUCHAR)(&SendPool->Packets[Device->InitPackets]);
|
||
|
||
for (PacketNum = 0; PacketNum < Device->InitPackets; PacketNum++) {
|
||
|
||
Packet = &SendPool->Packets[PacketNum];
|
||
|
||
if (NbiInitializeSendPacket (
|
||
Device,
|
||
#ifdef NB_OWN_PACKETS
|
||
NULL,
|
||
#else
|
||
SendPool->PoolHandle,
|
||
#endif
|
||
Packet,
|
||
Header,
|
||
HeaderLength) != STATUS_SUCCESS) {
|
||
NB_DEBUG (PACKET, ("Could not initialize packet %lx\n", Packet));
|
||
break;
|
||
}
|
||
|
||
Reserved = SEND_RESERVED(Packet);
|
||
Reserved->u.SR_NF.Address = NULL;
|
||
#ifdef NB_TRACK_POOL
|
||
Reserved->Pool = SendPool;
|
||
#endif
|
||
|
||
Header += HeaderLength;
|
||
|
||
}
|
||
|
||
SendPool->PacketCount = PacketNum;
|
||
SendPool->PacketFree = PacketNum;
|
||
|
||
for (PacketNum = 0; PacketNum < SendPool->PacketCount; PacketNum++) {
|
||
|
||
Packet = &SendPool->Packets[PacketNum];
|
||
Reserved = SEND_RESERVED(Packet);
|
||
ExInterlockedPushEntrySList(
|
||
&Device->SendPacketList,
|
||
&Reserved->PoolLinkage,
|
||
&NbiGlobalPoolInterlock);
|
||
|
||
}
|
||
|
||
InsertTailList (&Device->SendPoolList, &SendPool->Linkage);
|
||
|
||
Device->AllocatedSendPackets += SendPool->PacketCount;
|
||
|
||
} /* NbiAllocateSendPool */
|
||
|
||
|
||
VOID
|
||
NbiAllocateReceivePool(
|
||
IN PDEVICE Device
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine adds 5 receive packets to the pool for this device.
|
||
|
||
NOTE: THIS ROUTINE IS CALLED WITH THE DEVICE LOCK HELD AND
|
||
RETURNS WITH IT HELD.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
PNB_RECEIVE_POOL ReceivePool;
|
||
UINT ReceivePoolSize;
|
||
UINT PacketNum;
|
||
PNB_RECEIVE_PACKET Packet;
|
||
PNB_RECEIVE_RESERVED Reserved;
|
||
NTSTATUS Status;
|
||
|
||
ReceivePoolSize = FIELD_OFFSET (NB_RECEIVE_POOL, Packets[0]) +
|
||
(sizeof(NB_RECEIVE_PACKET) * Device->InitPackets);
|
||
|
||
ReceivePool = (PNB_RECEIVE_POOL)NbiAllocateMemory (ReceivePoolSize, MEMORY_PACKET, "ReceivePool");
|
||
if (ReceivePool == NULL) {
|
||
NB_DEBUG (PACKET, ("Could not allocate receive pool memory\n"));
|
||
return;
|
||
}
|
||
|
||
RtlZeroMemory (ReceivePool, ReceivePoolSize);
|
||
|
||
#if !defined(NB_OWN_PACKETS)
|
||
//
|
||
// Now allocate the ndis packet pool
|
||
//
|
||
ReceivePool->PoolHandle = (NDIS_HANDLE) NDIS_PACKET_POOL_TAG_FOR_NWLNKNB; // Dbg info for Ndis!
|
||
NdisAllocatePacketPoolEx (&Status, &ReceivePool->PoolHandle, Device->InitPackets, 0, sizeof(NB_RECEIVE_RESERVED));
|
||
if (!NT_SUCCESS(Status)){
|
||
NB_DEBUG (PACKET, ("Could not allocate Ndis Packet Pool memory\n"));
|
||
NbiFreeMemory( ReceivePool, ReceivePoolSize, MEMORY_PACKET, "Receive Pool Freed");
|
||
return;
|
||
}
|
||
|
||
NdisSetPacketPoolProtocolId (ReceivePool->PoolHandle, NDIS_PROTOCOL_ID_IPX);
|
||
#endif NB_OWN_PACKETS
|
||
|
||
NB_DEBUG2 (PACKET, ("Initializing receive pool %lx, %d packets\n",
|
||
ReceivePool, Device->InitPackets));
|
||
|
||
for (PacketNum = 0; PacketNum < Device->InitPackets; PacketNum++) {
|
||
|
||
Packet = &ReceivePool->Packets[PacketNum];
|
||
|
||
if (NbiInitializeReceivePacket (
|
||
Device,
|
||
#ifdef NB_OWN_PACKETS
|
||
NULL,
|
||
#else
|
||
ReceivePool->PoolHandle,
|
||
#endif
|
||
Packet) != STATUS_SUCCESS) {
|
||
NB_DEBUG (PACKET, ("Could not initialize packet %lx\n", Packet));
|
||
break;
|
||
}
|
||
|
||
Reserved = RECEIVE_RESERVED(Packet);
|
||
#ifdef NB_TRACK_POOL
|
||
Reserved->Pool = ReceivePool;
|
||
#endif
|
||
|
||
}
|
||
|
||
ReceivePool->PacketCount = PacketNum;
|
||
ReceivePool->PacketFree = PacketNum;
|
||
|
||
for (PacketNum = 0; PacketNum < ReceivePool->PacketCount; PacketNum++) {
|
||
|
||
Packet = &ReceivePool->Packets[PacketNum];
|
||
Reserved = RECEIVE_RESERVED(Packet);
|
||
ExInterlockedPushEntrySList(
|
||
&Device->ReceivePacketList,
|
||
&Reserved->PoolLinkage,
|
||
&NbiGlobalPoolInterlock);
|
||
// PushEntryList (&Device->ReceivePacketList, &Reserved->PoolLinkage);
|
||
|
||
}
|
||
|
||
InsertTailList (&Device->ReceivePoolList, &ReceivePool->Linkage);
|
||
|
||
Device->AllocatedReceivePackets += ReceivePool->PacketCount;
|
||
|
||
} /* NbiAllocateReceivePool */
|
||
|
||
|
||
#if defined(_PNP_POWER)
|
||
|
||
VOID
|
||
NbiAllocateReceiveBufferPool(
|
||
IN PDEVICE Device,
|
||
IN UINT DataLength
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine adds receive buffers to the pool for this device.
|
||
|
||
NOTE: THIS ROUTINE IS CALLED WITH THE DEVICE LOCK HELD AND
|
||
RETURNS WITH IT HELD.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
DataLength - Max length of the data in each buffer.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
PNB_RECEIVE_BUFFER ReceiveBuffer;
|
||
UINT ReceiveBufferPoolSize;
|
||
UINT BufferNum;
|
||
PNB_RECEIVE_BUFFER_POOL ReceiveBufferPool;
|
||
PUCHAR Data;
|
||
|
||
|
||
ReceiveBufferPoolSize = FIELD_OFFSET (NB_RECEIVE_BUFFER_POOL, Buffers[0]) +
|
||
(sizeof(NB_RECEIVE_BUFFER) * Device->InitPackets) +
|
||
(DataLength * Device->InitPackets);
|
||
|
||
ReceiveBufferPool = (PNB_RECEIVE_BUFFER_POOL)NbiAllocateMemory (ReceiveBufferPoolSize, MEMORY_PACKET, "ReceiveBufferPool");
|
||
if (ReceiveBufferPool == NULL) {
|
||
NB_DEBUG (PACKET, ("Could not allocate receive buffer pool memory\n"));
|
||
return;
|
||
}
|
||
|
||
RtlZeroMemory (ReceiveBufferPool, ReceiveBufferPoolSize);
|
||
|
||
NB_DEBUG2 (PACKET, ("Initializing receive buffer pool %lx, %d buffers, data %d\n",
|
||
ReceiveBufferPool, Device->InitPackets, DataLength));
|
||
|
||
Data = (PUCHAR)(&ReceiveBufferPool->Buffers[Device->InitPackets]);
|
||
|
||
for (BufferNum = 0; BufferNum < Device->InitPackets; BufferNum++) {
|
||
|
||
ReceiveBuffer = &ReceiveBufferPool->Buffers[BufferNum];
|
||
|
||
if (NbiInitializeReceiveBuffer (Device, ReceiveBuffer, Data, DataLength) != STATUS_SUCCESS) {
|
||
NB_DEBUG (PACKET, ("Could not initialize buffer %lx\n", ReceiveBuffer));
|
||
break;
|
||
}
|
||
|
||
ReceiveBuffer->Pool = ReceiveBufferPool;
|
||
|
||
Data += DataLength;
|
||
|
||
}
|
||
|
||
ReceiveBufferPool->BufferCount = BufferNum;
|
||
ReceiveBufferPool->BufferFree = BufferNum;
|
||
ReceiveBufferPool->BufferDataSize = DataLength;
|
||
|
||
for (BufferNum = 0; BufferNum < ReceiveBufferPool->BufferCount; BufferNum++) {
|
||
|
||
ReceiveBuffer = &ReceiveBufferPool->Buffers[BufferNum];
|
||
PushEntryList (&Device->ReceiveBufferList, &ReceiveBuffer->PoolLinkage);
|
||
|
||
}
|
||
|
||
InsertTailList (&Device->ReceiveBufferPoolList, &ReceiveBufferPool->Linkage);
|
||
|
||
Device->AllocatedReceiveBuffers += ReceiveBufferPool->BufferCount;
|
||
Device->CurMaxReceiveBufferSize = DataLength;
|
||
|
||
} /* NbiAllocateReceiveBufferPool */
|
||
#else
|
||
|
||
VOID
|
||
NbiAllocateReceiveBufferPool(
|
||
IN PDEVICE Device
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine adds receive buffers to the pool for this device.
|
||
|
||
NOTE: THIS ROUTINE IS CALLED WITH THE DEVICE LOCK HELD AND
|
||
RETURNS WITH IT HELD.
|
||
|
||
Arguments:
|
||
|
||
Device - The device.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
|
||
{
|
||
PNB_RECEIVE_BUFFER ReceiveBuffer;
|
||
UINT ReceiveBufferPoolSize;
|
||
UINT BufferNum;
|
||
PNB_RECEIVE_BUFFER_POOL ReceiveBufferPool;
|
||
UINT DataLength;
|
||
PUCHAR Data;
|
||
|
||
DataLength = Device->Bind.LineInfo.MaximumPacketSize;
|
||
|
||
ReceiveBufferPoolSize = FIELD_OFFSET (NB_RECEIVE_BUFFER_POOL, Buffers[0]) +
|
||
(sizeof(NB_RECEIVE_BUFFER) * Device->InitPackets) +
|
||
(DataLength * Device->InitPackets);
|
||
|
||
ReceiveBufferPool = (PNB_RECEIVE_BUFFER_POOL)NbiAllocateMemory (ReceiveBufferPoolSize, MEMORY_PACKET, "ReceiveBufferPool");
|
||
if (ReceiveBufferPool == NULL) {
|
||
NB_DEBUG (PACKET, ("Could not allocate receive buffer pool memory\n"));
|
||
return;
|
||
}
|
||
|
||
RtlZeroMemory (ReceiveBufferPool, ReceiveBufferPoolSize);
|
||
|
||
NB_DEBUG2 (PACKET, ("Initializing receive buffer pool %lx, %d buffers, data %d\n",
|
||
ReceiveBufferPool, Device->InitPackets, DataLength));
|
||
|
||
Data = (PUCHAR)(&ReceiveBufferPool->Buffers[Device->InitPackets]);
|
||
|
||
for (BufferNum = 0; BufferNum < Device->InitPackets; BufferNum++) {
|
||
|
||
ReceiveBuffer = &ReceiveBufferPool->Buffers[BufferNum];
|
||
|
||
if (NbiInitializeReceiveBuffer (Device, ReceiveBuffer, Data, DataLength) != STATUS_SUCCESS) {
|
||
NB_DEBUG (PACKET, ("Could not initialize buffer %lx\n", ReceiveBuffer));
|
||
break;
|
||
}
|
||
|
||
#ifdef NB_TRACK_POOL
|
||
ReceiveBuffer->Pool = ReceiveBufferPool;
|
||
#endif
|
||
|
||
Data += DataLength;
|
||
|
||
}
|
||
|
||
ReceiveBufferPool->BufferCount = BufferNum;
|
||
ReceiveBufferPool->BufferFree = BufferNum;
|
||
|
||
for (BufferNum = 0; BufferNum < ReceiveBufferPool->BufferCount; BufferNum++) {
|
||
|
||
ReceiveBuffer = &ReceiveBufferPool->Buffers[BufferNum];
|
||
PushEntryList (&Device->ReceiveBufferList, &ReceiveBuffer->PoolLinkage);
|
||
|
||
}
|
||
|
||
InsertTailList (&Device->ReceiveBufferPoolList, &ReceiveBufferPool->Linkage);
|
||
|
||
Device->AllocatedReceiveBuffers += ReceiveBufferPool->BufferCount;
|
||
|
||
} /* NbiAllocateReceiveBufferPool */
|
||
#endif _PNP_POWER
|
||
|
||
#if defined(_PNP_POWER)
|
||
|
||
VOID
|
||
NbiReAllocateReceiveBufferPool(
|
||
IN PWORK_QUEUE_ITEM WorkItem
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routines destroys all the existing Buffer Pools and creates
|
||
new one using the larger packet size given to us by IPX because
|
||
a new card was inserted with a larger packet size.
|
||
|
||
Arguments:
|
||
|
||
WorkItem - The work item that was allocated for this.
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
--*/
|
||
{
|
||
PDEVICE Device = NbiDevice;
|
||
CTELockHandle LockHandle;
|
||
|
||
NB_GET_LOCK ( &Device->Lock, &LockHandle );
|
||
|
||
if ( Device->Bind.LineInfo.MaximumPacketSize > Device->CurMaxReceiveBufferSize ) {
|
||
|
||
#if DBG
|
||
DbgPrint("Reallocating new pools due to new maxpacketsize\n");
|
||
#endif
|
||
NbiDestroyReceiveBufferPools( Device );
|
||
NbiAllocateReceiveBufferPool( Device, Device->Bind.LineInfo.MaximumPacketSize );
|
||
|
||
}
|
||
|
||
NB_FREE_LOCK( &Device->Lock, LockHandle );
|
||
|
||
NbiFreeMemory( WorkItem, sizeof(WORK_QUEUE_ITEM), MEMORY_WORK_ITEM, "Alloc Rcv Buff Work Item freed");
|
||
}
|
||
|
||
#if !defined(DBG)
|
||
__inline
|
||
#endif
|
||
VOID
|
||
NbiFreeReceiveBufferPool (
|
||
IN PNB_RECEIVE_BUFFER_POOL ReceiveBufferPool
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine frees the
|
||
Arguments:
|
||
|
||
Device - Pointer to our device to charge the packet to.
|
||
|
||
Return Value:
|
||
|
||
The pointer to the Linkage field in the allocated packet.
|
||
|
||
--*/
|
||
{
|
||
PDEVICE Device = NbiDevice;
|
||
PNB_RECEIVE_BUFFER ReceiveBuffer;
|
||
UINT ReceiveBufferPoolSize,i;
|
||
|
||
CTEAssert( ReceiveBufferPool->BufferDataSize );
|
||
|
||
ReceiveBufferPoolSize = FIELD_OFFSET (NB_RECEIVE_BUFFER_POOL, Buffers[0]) +
|
||
(sizeof(NB_RECEIVE_BUFFER) * Device->InitPackets) +
|
||
(ReceiveBufferPool->BufferDataSize * Device->InitPackets);
|
||
|
||
//
|
||
// Check if we can free this pool
|
||
//
|
||
CTEAssert(ReceiveBufferPool->BufferCount == ReceiveBufferPool->BufferFree );
|
||
|
||
for (i = 0; i < ReceiveBufferPool->BufferCount; i++) {
|
||
|
||
ReceiveBuffer = &ReceiveBufferPool->Buffers[i];
|
||
NbiDeinitializeReceiveBuffer (Device, ReceiveBuffer);
|
||
|
||
}
|
||
|
||
RemoveEntryList( &ReceiveBufferPool->Linkage );
|
||
|
||
NB_DEBUG2 (PACKET, ("Free buffer pool %lx\n", ReceiveBufferPool));
|
||
|
||
NbiFreeMemory (ReceiveBufferPool, ReceiveBufferPoolSize, MEMORY_PACKET, "ReceiveBufferPool");
|
||
|
||
}
|
||
|
||
|
||
VOID
|
||
NbiDestroyReceiveBufferPools(
|
||
IN PDEVICE Device
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routines walks the ReceiveBufferPoolList and destroys the
|
||
pool which does not have any buffer in use.
|
||
|
||
Arguments:
|
||
|
||
Return Value:
|
||
|
||
None.
|
||
|
||
THIS ROUTINE COULD BE CALLED WITH THE DEVICE LOCK HELD. If this
|
||
routine is also called from the DestroyDevice routine, it is not
|
||
necessary to call this with the lock.
|
||
|
||
--*/
|
||
{
|
||
PNB_RECEIVE_BUFFER_POOL ReceiveBufferPool;
|
||
PLIST_ENTRY p;
|
||
PSINGLE_LIST_ENTRY Unused;
|
||
|
||
|
||
//
|
||
// Clean up this list before we call NbiFreeReceiveBufferPool bcoz that will
|
||
// simply destroy all the buffer which might be queue here on this list.
|
||
// At the end of this routine we must start with a fresh ReceiveBufferList.
|
||
//
|
||
do {
|
||
Unused = PopEntryList( &Device->ReceiveBufferList );
|
||
} while( Unused );
|
||
|
||
//
|
||
// Now destroy each individual ReceiveBufferPool.
|
||
//
|
||
for ( p = Device->ReceiveBufferPoolList.Flink;
|
||
p != &Device->ReceiveBufferPoolList;
|
||
) {
|
||
|
||
|
||
ReceiveBufferPool = CONTAINING_RECORD (p, NB_RECEIVE_BUFFER_POOL, Linkage);
|
||
p = p->Flink;
|
||
|
||
//
|
||
// This will destroy and unlink this Pool if none of its buffer is
|
||
// in use currently.
|
||
//
|
||
|
||
if ( ReceiveBufferPool->BufferCount == ReceiveBufferPool->BufferFree ) {
|
||
NbiFreeReceiveBufferPool( ReceiveBufferPool );
|
||
} else {
|
||
//
|
||
// When the device is stopping we must succeed in freeing the pool.
|
||
CTEAssert( Device->State != DEVICE_STATE_STOPPING );
|
||
}
|
||
|
||
}
|
||
|
||
}
|
||
|
||
|
||
VOID
|
||
NbiPushReceiveBuffer (
|
||
IN PNB_RECEIVE_BUFFER ReceiveBuffer
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine returns the receive buffer back to the free list.
|
||
It checks the size of this buffer. If it is smaller than the
|
||
the CurMaxReceiveBufferSize, then it does not return this back
|
||
to the free list, instead it destroys it and possibly also
|
||
destroys the pool associated with it. O/w it simply returns this
|
||
to the free list.
|
||
|
||
Arguments:
|
||
|
||
ReceiveBuffer - Pointer to the buffer to be returned to the free list.
|
||
|
||
Return Value:
|
||
|
||
The pointer to the Linkage field in the allocated packet.
|
||
|
||
--*/
|
||
|
||
{
|
||
|
||
PNB_RECEIVE_BUFFER_POOL ReceiveBufferPool = (PNB_RECEIVE_BUFFER_POOL)ReceiveBuffer->Pool;
|
||
PDEVICE Device = NbiDevice;
|
||
CTELockHandle LockHandle;
|
||
#if defined(DBG)
|
||
ULONG BufLen = 0;
|
||
#endif
|
||
|
||
NB_GET_LOCK( &Device->Lock, &LockHandle );
|
||
|
||
#if defined(DBG)
|
||
NdisQueryBufferSafe (ReceiveBuffer->NdisBuffer, NULL, &BufLen, HighPagePriority);
|
||
CTEAssert( BufLen == ReceiveBufferPool->BufferDataSize );
|
||
#endif
|
||
|
||
//
|
||
// This is an old buffer which was in use when we changed
|
||
// the CurMaxReceiveBufferSize due to new adapter. We must not
|
||
// return this buffer back to free list. Infact, if the pool
|
||
// associated with this buffer does not have any other buffers
|
||
// in use, we should free the pool also.
|
||
CTEAssert( ReceiveBufferPool->BufferFree < ReceiveBufferPool->BufferCount );
|
||
ReceiveBufferPool->BufferFree++;
|
||
|
||
if ( ReceiveBufferPool->BufferDataSize < Device->CurMaxReceiveBufferSize ) {
|
||
|
||
#if DBG
|
||
DbgPrint("ReceiveBuffer %lx, not returned to pool %lx( Free %d)\n", ReceiveBuffer, ReceiveBufferPool, ReceiveBufferPool->BufferFree);
|
||
#endif
|
||
|
||
|
||
if ( ReceiveBufferPool->BufferFree == ReceiveBufferPool->BufferCount ) {
|
||
NbiFreeReceiveBufferPool( ReceiveBufferPool );
|
||
}
|
||
} else {
|
||
|
||
PushEntryList( &Device->ReceiveBufferList, &ReceiveBuffer->PoolLinkage );
|
||
|
||
|
||
}
|
||
|
||
NB_FREE_LOCK( &Device->Lock, LockHandle );
|
||
}
|
||
#endif _PNP_POWER
|
||
|
||
|
||
PSINGLE_LIST_ENTRY
|
||
NbiPopSendPacket(
|
||
IN PDEVICE Device,
|
||
IN BOOLEAN LockAcquired
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine allocates a packet from the device context's pool.
|
||
If there are no packets in the pool, it allocates one up to
|
||
the configured limit.
|
||
|
||
Arguments:
|
||
|
||
Device - Pointer to our device to charge the packet to.
|
||
|
||
LockAcquired - TRUE if Device->Lock is acquired.
|
||
|
||
Return Value:
|
||
|
||
The pointer to the Linkage field in the allocated packet.
|
||
|
||
--*/
|
||
|
||
{
|
||
PSINGLE_LIST_ENTRY s;
|
||
CTELockHandle LockHandle;
|
||
|
||
s = ExInterlockedPopEntrySList(
|
||
&Device->SendPacketList,
|
||
&NbiGlobalPoolInterlock);
|
||
|
||
if (s != NULL) {
|
||
return s;
|
||
}
|
||
|
||
//
|
||
// No packets in the pool, see if we can allocate more.
|
||
//
|
||
|
||
if (!LockAcquired) {
|
||
NB_GET_LOCK (&Device->Lock, &LockHandle);
|
||
}
|
||
|
||
if (Device->AllocatedSendPackets < Device->MaxPackets) {
|
||
|
||
//
|
||
// Allocate a pool and try again.
|
||
//
|
||
|
||
|
||
NbiAllocateSendPool (Device);
|
||
|
||
|
||
if (!LockAcquired) {
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
}
|
||
|
||
s = ExInterlockedPopEntrySList(
|
||
&Device->SendPacketList,
|
||
&NbiGlobalPoolInterlock);
|
||
|
||
return s;
|
||
} else {
|
||
|
||
if (!LockAcquired) {
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
}
|
||
return NULL;
|
||
}
|
||
|
||
} /* NbiPopSendPacket */
|
||
|
||
|
||
VOID
|
||
NbiPushSendPacket(
|
||
IN PNB_SEND_RESERVED Reserved
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine frees a packet back to the device context's pool.
|
||
If there are connections waiting for packets, it removes
|
||
one from the list and inserts it on the packetize queue.
|
||
|
||
Arguments:
|
||
|
||
Device - Pointer to our device to charge the packet to.
|
||
|
||
Return Value:
|
||
|
||
The pointer to the Linkage field in the allocated packet.
|
||
|
||
--*/
|
||
|
||
{
|
||
PDEVICE Device = NbiDevice;
|
||
PLIST_ENTRY p;
|
||
PCONNECTION Connection;
|
||
NB_DEFINE_LOCK_HANDLE (LockHandle)
|
||
NB_DEFINE_LOCK_HANDLE (LockHandle1)
|
||
|
||
Reserved->CurrentSendIteration = 0; // Re-initialize this field for next Send Request
|
||
|
||
ExInterlockedPushEntrySList(
|
||
&Device->SendPacketList,
|
||
&Reserved->PoolLinkage,
|
||
&NbiGlobalPoolInterlock);
|
||
|
||
if (!IsListEmpty (&Device->WaitPacketConnections)) {
|
||
|
||
NB_SYNC_GET_LOCK (&Device->Lock, &LockHandle);
|
||
|
||
p = RemoveHeadList (&Device->WaitPacketConnections);
|
||
|
||
//
|
||
// Take a connection off the WaitPacketQueue and put it
|
||
// on the PacketizeQueue. We don't worry about if the
|
||
// connection has stopped, that will get checked when
|
||
// the PacketizeQueue is run down.
|
||
//
|
||
// Since this is in send completion, we may not get
|
||
// a receive complete. We guard against this by calling
|
||
// NbiReceiveComplete from the long timer timeout.
|
||
//
|
||
|
||
if (p != &Device->WaitPacketConnections) {
|
||
|
||
Connection = CONTAINING_RECORD (p, CONNECTION, WaitPacketLinkage);
|
||
|
||
CTEAssert (Connection->OnWaitPacketQueue);
|
||
Connection->OnWaitPacketQueue = FALSE;
|
||
|
||
NB_SYNC_FREE_LOCK (&Device->Lock, LockHandle);
|
||
|
||
NB_SYNC_GET_LOCK (&Connection->Lock, &LockHandle1);
|
||
|
||
|
||
if (Connection->SubState == CONNECTION_SUBSTATE_A_W_PACKET) {
|
||
|
||
CTEAssert (!Connection->OnPacketizeQueue);
|
||
Connection->OnPacketizeQueue = TRUE;
|
||
|
||
NbiTransferReferenceConnection (Connection, CREF_W_PACKET, CREF_PACKETIZE);
|
||
|
||
NB_INSERT_TAIL_LIST(
|
||
&Device->PacketizeConnections,
|
||
&Connection->PacketizeLinkage,
|
||
&Device->Lock);
|
||
|
||
Connection->SubState = CONNECTION_SUBSTATE_A_PACKETIZE;
|
||
|
||
} else {
|
||
|
||
NbiDereferenceConnection (Connection, CREF_W_PACKET);
|
||
|
||
}
|
||
|
||
NB_SYNC_FREE_LOCK (&Connection->Lock, LockHandle1);
|
||
|
||
} else {
|
||
|
||
NB_SYNC_FREE_LOCK (&Device->Lock, LockHandle);
|
||
|
||
}
|
||
|
||
}
|
||
|
||
} /* NbiPushSendPacket */
|
||
|
||
|
||
VOID
|
||
NbiCheckForWaitPacket(
|
||
IN PCONNECTION Connection
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine checks if a connection is on the wait packet
|
||
queue and if so takes it off and queues it to be packetized.
|
||
It is meant to be called when the connection's packet has
|
||
been freed.
|
||
|
||
Arguments:
|
||
|
||
Connection - The connection to check.
|
||
|
||
Return Value:
|
||
|
||
The pointer to the Linkage field in the allocated packet.
|
||
|
||
--*/
|
||
|
||
{
|
||
PDEVICE Device = NbiDevice;
|
||
NB_DEFINE_LOCK_HANDLE (LockHandle)
|
||
NB_DEFINE_LOCK_HANDLE (LockHandle1)
|
||
|
||
NB_SYNC_GET_LOCK (&Connection->Lock, &LockHandle);
|
||
NB_SYNC_GET_LOCK (&Device->Lock, &LockHandle1);
|
||
|
||
if (Connection->OnWaitPacketQueue) {
|
||
|
||
Connection->OnWaitPacketQueue = FALSE;
|
||
RemoveEntryList (&Connection->WaitPacketLinkage);
|
||
|
||
if (Connection->SubState == CONNECTION_SUBSTATE_A_W_PACKET) {
|
||
|
||
CTEAssert (!Connection->OnPacketizeQueue);
|
||
Connection->OnPacketizeQueue = TRUE;
|
||
|
||
NbiTransferReferenceConnection (Connection, CREF_W_PACKET, CREF_PACKETIZE);
|
||
|
||
InsertTailList(
|
||
&Device->PacketizeConnections,
|
||
&Connection->PacketizeLinkage);
|
||
Connection->SubState = CONNECTION_SUBSTATE_A_PACKETIZE;
|
||
|
||
} else {
|
||
|
||
NB_SYNC_FREE_LOCK (&Device->Lock, LockHandle1);
|
||
NB_SYNC_FREE_LOCK (&Connection->Lock, LockHandle);
|
||
|
||
NbiDereferenceConnection (Connection, CREF_W_PACKET);
|
||
|
||
return;
|
||
}
|
||
}
|
||
|
||
NB_SYNC_FREE_LOCK (&Device->Lock, LockHandle1);
|
||
NB_SYNC_FREE_LOCK (&Connection->Lock, LockHandle);
|
||
|
||
} /* NbiCheckForWaitPacket */
|
||
|
||
|
||
PSINGLE_LIST_ENTRY
|
||
NbiPopReceivePacket(
|
||
IN PDEVICE Device
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine allocates a packet from the device context's pool.
|
||
If there are no packets in the pool, it allocates one up to
|
||
the configured limit.
|
||
|
||
Arguments:
|
||
|
||
Device - Pointer to our device to charge the packet to.
|
||
|
||
Return Value:
|
||
|
||
The pointer to the Linkage field in the allocated packet.
|
||
|
||
--*/
|
||
|
||
{
|
||
PSINGLE_LIST_ENTRY s;
|
||
CTELockHandle LockHandle;
|
||
|
||
s = ExInterlockedPopEntrySList(
|
||
&Device->ReceivePacketList,
|
||
&NbiGlobalPoolInterlock);
|
||
|
||
if (s != NULL) {
|
||
return s;
|
||
}
|
||
|
||
//
|
||
// No packets in the pool, see if we can allocate more.
|
||
//
|
||
|
||
if (Device->AllocatedReceivePackets < Device->MaxPackets) {
|
||
|
||
//
|
||
// Allocate a pool and try again.
|
||
//
|
||
|
||
NB_GET_LOCK (&Device->Lock, &LockHandle);
|
||
|
||
NbiAllocateReceivePool (Device);
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
s = ExInterlockedPopEntrySList(
|
||
&Device->ReceivePacketList,
|
||
&NbiGlobalPoolInterlock);
|
||
|
||
|
||
return s;
|
||
|
||
} else {
|
||
|
||
return NULL;
|
||
|
||
}
|
||
|
||
} /* NbiPopReceivePacket */
|
||
|
||
|
||
PSINGLE_LIST_ENTRY
|
||
NbiPopReceiveBuffer(
|
||
IN PDEVICE Device
|
||
)
|
||
|
||
/*++
|
||
|
||
Routine Description:
|
||
|
||
This routine allocates a receive buffer from the device context's pool.
|
||
If there are no buffers in the pool, it allocates one up to
|
||
the configured limit.
|
||
|
||
Arguments:
|
||
|
||
Device - Pointer to our device to charge the buffer to.
|
||
|
||
Return Value:
|
||
|
||
The pointer to the Linkage field in the allocated receive buffer.
|
||
|
||
--*/
|
||
|
||
{
|
||
#if defined(_PNP_POWER)
|
||
PSINGLE_LIST_ENTRY s;
|
||
PNB_RECEIVE_BUFFER ReceiveBuffer;
|
||
PNB_RECEIVE_BUFFER_POOL ReceiveBufferPool;
|
||
CTELockHandle LockHandle;
|
||
|
||
NB_GET_LOCK( &Device->Lock, &LockHandle );
|
||
|
||
s = PopEntryList( &Device->ReceiveBufferList );
|
||
|
||
|
||
if ( !s ) {
|
||
|
||
//
|
||
// No buffer in the pool, see if we can allocate more.
|
||
//
|
||
if (Device->AllocatedReceiveBuffers < Device->MaxReceiveBuffers) {
|
||
|
||
//
|
||
// Allocate a pool and try again.
|
||
//
|
||
|
||
|
||
NbiAllocateReceiveBufferPool (Device, Device->CurMaxReceiveBufferSize );
|
||
s = PopEntryList(&Device->ReceiveBufferList);
|
||
}
|
||
}
|
||
|
||
if ( s ) {
|
||
|
||
|
||
//
|
||
// Decrement the BufferFree count on the corresponding ReceiveBufferPool.
|
||
// so that we know that
|
||
ReceiveBuffer = CONTAINING_RECORD( s, NB_RECEIVE_BUFFER, PoolLinkage );
|
||
|
||
|
||
ReceiveBufferPool = (PNB_RECEIVE_BUFFER_POOL)ReceiveBuffer->Pool;
|
||
|
||
CTEAssert( ReceiveBufferPool->BufferFree && ( ReceiveBufferPool->BufferFree <= ReceiveBufferPool->BufferCount ) );
|
||
CTEAssert( ReceiveBufferPool->BufferDataSize == Device->CurMaxReceiveBufferSize );
|
||
|
||
ReceiveBufferPool->BufferFree--;
|
||
|
||
}
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
|
||
return s;
|
||
#else
|
||
PSINGLE_LIST_ENTRY s;
|
||
CTELockHandle LockHandle;
|
||
|
||
s = ExInterlockedPopEntryList(
|
||
&Device->ReceiveBufferList,
|
||
&Device->Lock.Lock);
|
||
|
||
if (s != NULL) {
|
||
return s;
|
||
}
|
||
|
||
//
|
||
// No buffer in the pool, see if we can allocate more.
|
||
//
|
||
|
||
if (Device->AllocatedReceiveBuffers < Device->MaxReceiveBuffers) {
|
||
|
||
//
|
||
// Allocate a pool and try again.
|
||
//
|
||
|
||
NB_GET_LOCK (&Device->Lock, &LockHandle);
|
||
|
||
NbiAllocateReceiveBufferPool (Device);
|
||
s = PopEntryList(&Device->ReceiveBufferList);
|
||
|
||
NB_FREE_LOCK (&Device->Lock, LockHandle);
|
||
|
||
return s;
|
||
|
||
} else {
|
||
|
||
return NULL;
|
||
|
||
}
|
||
#endif _PNP_POWER
|
||
} /* NbiPopReceiveBuffer */
|
||
|