NTSTATUS
NICHandleSetOidRequest(
__in PFDO_DATA FdoData,
__in PIRP Irp
)
/*++
Routine Description:
This routine handles ioctl request for Set OIDs. Most of
the IOCTL requests are only if the upper edge is NDIS.
Arguments:
Return Value:
--*/
{
NTSTATUS status = STATUS_SUCCESS;
PNDISPROT_SET_OID pSet;
NDIS_OID Oid;
ULONG PacketFilter;
PVOID InformationBuffer = NULL;
ULONG InformationBufferLength = 0;
KIRQL oldIrql;
PVOID DataBuffer;
ULONG BufferLength, unUsed;
PIO_STACK_LOCATION pIrpSp;
DEVICE_POWER_STATE newDeviceState, oldDeviceState;
pIrpSp = IoGetCurrentIrpStackLocation(Irp);
DataBuffer = Irp->AssociatedIrp.SystemBuffer;
BufferLength = pIrpSp->Parameters.DeviceIoControl.InputBufferLength;
DebugPrint(LOUD, DBG_IOCTLS, "--> HandleSetOIDRequest\n");
Oid = 0;
do
{
if (BufferLength < sizeof(NDISPROT_SET_OID))
{
status = STATUS_BUFFER_OVERFLOW;
break;
}
pSet = (PNDISPROT_SET_OID)DataBuffer;
Oid = pSet->Oid;
InformationBuffer = &pSet->Data[0];
InformationBufferLength = BufferLength - FIELD_OFFSET(NDISPROT_SET_OID, Data);
switch(Oid)
{
case OID_802_3_MULTICAST_LIST:
//
// Verify the length
//
if (InformationBufferLength % ETH_LENGTH_OF_ADDRESS != 0)
{
return(STATUS_INVALID_BUFFER_SIZE);
}
//
// Save the number of MC list size
//
FdoData->MCAddressCount = InformationBufferLength / ETH_LENGTH_OF_ADDRESS;
ASSERT(FdoData->MCAddressCount <= NIC_MAX_MCAST_LIST);
InformationBufferLength = InformationBufferLength > sizeof(FdoData->MCList)
? sizeof(FdoData->MCList):InformationBufferLength;
//
// Save the MC list
//
RtlMoveMemory(
FdoData->MCList,
InformationBuffer,
InformationBufferLength);
KeAcquireSpinLock(&FdoData->Lock, &oldIrql);
KeAcquireSpinLockAtDpcLevel(&FdoData->RcvLock);
status = NICSetMulticastList(FdoData);
KeReleaseSpinLockFromDpcLevel(&FdoData->RcvLock);
KeReleaseSpinLock(&FdoData->Lock, oldIrql);
break;
case OID_GEN_CURRENT_PACKET_FILTER:
//
// Verify the Length
//
if (InformationBufferLength != sizeof(ULONG))
{
return(STATUS_INVALID_BUFFER_SIZE);
}
RtlMoveMemory(&PacketFilter, InformationBuffer, sizeof(ULONG));
//
// any bits not supported?
//
if (PacketFilter & ~NIC_SUPPORTED_FILTERS)
{
return(STATUS_NOT_SUPPORTED);
}
//
// any filtering changes?
//
if (PacketFilter == FdoData->PacketFilter)
{
break;
}
KeAcquireSpinLock(&FdoData->Lock, &oldIrql);
KeAcquireSpinLockAtDpcLevel(&FdoData->RcvLock);
if (MP_TEST_FLAG(FdoData, fMP_ADAPTER_LINK_DETECTION))
{
//
// The device is busy doing link detection. Let us queue
// the IRP. When the link detection is over, the watchdog
// timer DPC will complete this IRP.
//
ASSERT(!FdoData->SetRequest);
status = PciDrvQueueIoctlIrp(FdoData, Irp);
KeReleaseSpinLockFromDpcLevel(&FdoData->RcvLock);
KeReleaseSpinLock(&FdoData->Lock, oldIrql);
break;
}
status = NICSetPacketFilter(
FdoData,
PacketFilter);
KeReleaseSpinLockFromDpcLevel(&FdoData->RcvLock);
KeReleaseSpinLock(&FdoData->Lock, oldIrql);
if (status == STATUS_SUCCESS)
{
FdoData->PacketFilter = PacketFilter;
}
break;
case OID_PNP_SET_POWER:
if (InformationBufferLength != sizeof(NDIS_DEVICE_POWER_STATE ))
{
return(STATUS_BUFFER_TOO_SMALL);
}
newDeviceState = *(PDEVICE_POWER_STATE UNALIGNED)InformationBuffer;
oldDeviceState = FdoData->DevicePowerState;
FdoData->DevicePowerState = newDeviceState;
if (oldDeviceState == PowerDeviceD0) {
status = PciDrvPowerBeginQueuingIrps(
FdoData->Self,
1, // One for current OID request.
FALSE // Do not query for state change.
);
ASSERT(NT_SUCCESS(status));
}
//
// Set the power state - Cannot fail this request
//
status = NICSetPower(FdoData, newDeviceState );
if (status != STATUS_SUCCESS)
{
DebugPrint(ERROR, DBG_IOCTLS, "SET Power: Hardware error !!!\n");
break;
}
if (newDeviceState == PowerDeviceD0) {
//
// Our hardware is now on again. Here we empty our existing queue of
// requests and let in new ones.
//
FdoData->QueueState = AllowRequests;
PciDrvProcessQueuedRequests(FdoData);
}
status = STATUS_SUCCESS;
break;
case OID_PNP_ADD_WAKE_UP_PATTERN:
//
// call a function that would program the adapter's wake
// up pattern, return success
//
DebugPrint(TRACE, DBG_IOCTLS, "--> OID_PNP_ADD_WAKE_UP_PATTERN\n");
if (IsPoMgmtSupported(FdoData) )
{
status = NICAddWakeUpPattern(FdoData,
InformationBuffer,
InformationBufferLength,
&unUsed,
&unUsed);
}
else
{
status = STATUS_NOT_SUPPORTED;
}
break;
case OID_PNP_REMOVE_WAKE_UP_PATTERN:
//
// call a function that would remove the adapter's wake
// up pattern, return success
//
DebugPrint(TRACE, DBG_IOCTLS, "--> OID_PNP_ADD_WAKE_UP_PATTERN\n");
if (IsPoMgmtSupported(FdoData) )
{
status = NICRemoveWakeUpPattern(FdoData,
InformationBuffer,
InformationBufferLength,
&unUsed,
&unUsed);
}
else
{
status = STATUS_NOT_SUPPORTED;
}
break;
case OID_PNP_ENABLE_WAKE_UP:
//
// call a function that would enable wake up on the adapter
// return success
//
DebugPrint(TRACE, DBG_IOCTLS, "--> OID_PNP_ENABLE_WAKE_UP\n");
if (IsPoMgmtSupported(FdoData))
{
ULONG WakeUpEnable;
RtlMoveMemory(&WakeUpEnable, InformationBuffer,sizeof(ULONG));
//
// The WakeUpEable can only be 0, or NDIS_PNP_WAKE_UP_PATTERN_MATCH since the driver only
// supports wake up pattern match
//
if ((WakeUpEnable != 0)
&& ((WakeUpEnable & NDIS_PNP_WAKE_UP_PATTERN_MATCH) != NDIS_PNP_WAKE_UP_PATTERN_MATCH ))
{
status = STATUS_NOT_SUPPORTED;
FdoData->AllowWakeArming = FALSE;
break;
}
//
// When the driver goes to low power state, it would check WakeUpEnable to decide
// which wake up methed it should use to wake up the machine. If WakeUpEnable is 0,
// no wake up method is enabled.
//
FdoData->AllowWakeArming = TRUE;
status = STATUS_SUCCESS;
}
else
{
status = STATUS_NOT_SUPPORTED;
}
break;
default:
status = STATUS_NOT_SUPPORTED;
break;
}
}while (FALSE);
DebugPrint(LOUD, DBG_IOCTLS, "<-- HandleSetOIDRequest\n");
return (status);
}
NTSTATUS
MPSetPowerD0(
PFDO_DATA FdoData
)
/*++
Routine Description:
This routine is called when the adapter receives a SetPower
to D0.
Arguments:
Adapter Pointer to the adapter structure
PowerState NewPowerState
Return Value:
--*/
{
NTSTATUS status;
//KIRQL oldIrql;
//
// MPSetPowerD0Private Initializes the adapte, issues a selective reset.
//
MPSetPowerD0Private (FdoData);
ASSERT(FdoData->DevicePowerState == PowerDeviceD0);
//
// Set up the packet filter
//
WdfSpinLockAcquire(FdoData->Lock);
status = NICSetPacketFilter(
FdoData,
FdoData->OldPacketFilter);
//
// If Set Packet Filter succeeds, restore the old packet filter
//
if (status == STATUS_SUCCESS)
{
FdoData->PacketFilter = FdoData->OldPacketFilter;
}
WdfSpinLockRelease(FdoData->Lock);
//
// Set up the multicast list address
//
WdfSpinLockAcquire(FdoData->RcvLock);
status = NICSetMulticastList(FdoData);
NICStartRecv(FdoData);
WdfSpinLockRelease(FdoData->RcvLock);
return status;
}