archive
/
windows-server-2003
mirror of https://github.com/selfrender/Windows-Server-2003
2
0
Fork 0
Code Issues Projects Releases Wiki Activity
Leaked source code of windows server 2003
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
4 Commits
1 Branch
0 Tags
1.5 GiB
 
 
 
 
 
 
Tree: 5c6fe3db62
Branches Tags
${ item.name }
Create tag ${ searchTerm }
Create branch ${ searchTerm }
from '5c6fe3db62'
${ noResults }
windows-server-2003/drivers/serial/mps/cyclades/z/cyzport/cyzutils.c

1630 lines
44 KiB
Raw Blame History

/*--------------------------------------------------------------------------
*
* Copyright (C) Cyclades Corporation, 1997-2001.
* All rights reserved.
*
* Cyclades-Z Port Driver
*
* This file: cyzutils.c
*
* Description: This module contains the code related to queueing
* and completion manipulation on requests.
*
* Notes: This code supports Windows 2000 and Windows XP,
* x86 and IA64 processors.
*
* Complies with Cyclades SW Coding Standard rev 1.3.
*
*--------------------------------------------------------------------------
*/
/*-------------------------------------------------------------------------
*
* Change History
*
*--------------------------------------------------------------------------
*
*
*--------------------------------------------------------------------------
*/
#include "precomp.h"
VOID
CyzRundownIrpRefs(
IN PIRP *CurrentOpIrp,
IN PKTIMER IntervalTimer,
IN PKTIMER TotalTimer,
IN PCYZ_DEVICE_EXTENSION PDevExt
);
#ifdef ALLOC_PRAGMA
#pragma alloc_text(PAGESER,CyzGetNextIrp)
#pragma alloc_text(PAGESER, CyzGetNextIrpLocked)
#pragma alloc_text(PAGESER,CyzTryToCompleteCurrent)
#pragma alloc_text(PAGESER,CyzStartOrQueue)
#pragma alloc_text(PAGESER,CyzCancelQueued)
#pragma alloc_text(PAGESER,CyzCompleteIfError)
#pragma alloc_text(PAGESER,CyzRundownIrpRefs)
//#pragma alloc_text(PAGESRP0, CyzLogError) //It can be called at raised IRQL
#pragma alloc_text(PAGESRP0, CyzMarkHardwareBroken)
#endif
static const PHYSICAL_ADDRESS CyzPhysicalZero = {0};
VOID
CyzKillAllReadsOrWrites(
IN PDEVICE_OBJECT DeviceObject,
IN PLIST_ENTRY QueueToClean,
IN PIRP *CurrentOpIrp
)
/*--------------------------------------------------------------------------
CyzKillAllReadsOrWrites()
Routine Description: This function is used to cancel all queued and
the current irps for reads or for writes.
Arguments:
DeviceObject - A pointer to the serial device object.
QueueToClean - A pointer to the queue which we're going to clean out.
CurrentOpIrp - Pointer to a pointer to the current irp.
Return Value: None.
--------------------------------------------------------------------------*/
{
KIRQL cancelIrql;
PDRIVER_CANCEL cancelRoutine;
// Acquire cancel spin lock to prevent irps from moving around.
IoAcquireCancelSpinLock(&cancelIrql);
// Clean the list from back to front.
while (!IsListEmpty(QueueToClean)) {
PIRP currentLastIrp = CONTAINING_RECORD(QueueToClean->Blink,
IRP,Tail.Overlay.ListEntry);
RemoveEntryList(QueueToClean->Blink);
cancelRoutine = currentLastIrp->CancelRoutine;
currentLastIrp->CancelIrql = cancelIrql;
currentLastIrp->CancelRoutine = NULL;
currentLastIrp->Cancel = TRUE;
cancelRoutine(DeviceObject,currentLastIrp);
IoAcquireCancelSpinLock(&cancelIrql);
}
// The queue is clean. Now go after the current if it's there.
if (*CurrentOpIrp) {
cancelRoutine = (*CurrentOpIrp)->CancelRoutine;
(*CurrentOpIrp)->Cancel = TRUE;
// If the current irp is not in a cancelable state
// then it *will* try to enter one and the above
// assignment will kill it. If it already is in
// a cancelable state then the following will kill it.
if (cancelRoutine) {
(*CurrentOpIrp)->CancelRoutine = NULL;
(*CurrentOpIrp)->CancelIrql = cancelIrql;
// mark it as canceled and call the cancel routine for it
cancelRoutine(DeviceObject,*CurrentOpIrp);
} else {
IoReleaseCancelSpinLock(cancelIrql);
}
} else {
IoReleaseCancelSpinLock(cancelIrql);
}
}
VOID
CyzGetNextIrp(
IN PIRP *CurrentOpIrp,
IN PLIST_ENTRY QueueToProcess,
OUT PIRP *NextIrp,
IN BOOLEAN CompleteCurrent,
IN PCYZ_DEVICE_EXTENSION extension
)
/*--------------------------------------------------------------------------
CyzGetNextIrp()
Routine Description: This function is used to make the head of the
particular queue the current irp. It also completes the what
was the old current irp if desired.
Arguments:
CurrentOpIrp - Pointer to a pointer to the currently active
irp for the particular work list. Note that
this item is not actually part of the list.
QueueToProcess - The list to pull the new item off of.
NextIrp - The next Irp to process. Note that CurrentOpIrp
will be set to this value under protection of the
cancel spin lock. However, if *NextIrp is NULL when
this routine returns, it is not necessaryly true the
what is pointed to by CurrentOpIrp will also be NULL.
The reason for this is that if the queue is empty
when we hold the cancel spin lock, a new irp may come
in immediately after we release the lock.
CompleteCurrent - If TRUE then this routine will complete the
irp pointed to by the pointer argument
CurrentOpIrp.
Return Value: None.
--------------------------------------------------------------------------*/
{
KIRQL oldIrql;
CYZ_LOCKED_PAGED_CODE();
IoAcquireCancelSpinLock(&oldIrql);
CyzGetNextIrpLocked(CurrentOpIrp, QueueToProcess, NextIrp,
CompleteCurrent, extension, oldIrql);
//TODO FANNY: CHECK IF REPLACING CODE THAT WAS HERE BY
//CyzGetNextIrpLocked MY FIX FOR THE BUG FOUND IN MODEM SHARE
//WAS OVERWRITTEN.
}
VOID
CyzGetNextIrpLocked(
IN PIRP *CurrentOpIrp,
IN PLIST_ENTRY QueueToProcess,
OUT PIRP *NextIrp,
IN BOOLEAN CompleteCurrent,
IN PCYZ_DEVICE_EXTENSION extension,
IN KIRQL OldIrql
)
/*++
Routine Description:
This function is used to make the head of the particular
queue the current irp. It also completes the what
was the old current irp if desired. The difference between
this and CyzGetNextIrp() is that for this we assume the caller
holds the cancel spinlock and we should release it when we're done.
Arguments:
CurrentOpIrp - Pointer to a pointer to the currently active
irp for the particular work list. Note that
this item is not actually part of the list.
QueueToProcess - The list to pull the new item off of.
NextIrp - The next Irp to process. Note that CurrentOpIrp
will be set to this value under protection of the
cancel spin lock. However, if *NextIrp is NULL when
this routine returns, it is not necessaryly true the
what is pointed to by CurrentOpIrp will also be NULL.
The reason for this is that if the queue is empty
when we hold the cancel spin lock, a new irp may come
in immediately after we release the lock.
CompleteCurrent - If TRUE then this routine will complete the
irp pointed to by the pointer argument
CurrentOpIrp.
OldIrql - IRQL which the cancel spinlock was acquired at and what we
should restore it to.
Return Value:
None.
--*/
{
PIRP oldIrp;
CYZ_LOCKED_PAGED_CODE();
oldIrp = *CurrentOpIrp;
#if DBG
if (oldIrp) {
if (CompleteCurrent) {
ASSERT(!oldIrp->CancelRoutine);
#if 0
//FANNY_DEBUG
if (IoGetCurrentIrpStackLocation(oldIrp)->MajorFunction == IRP_MJ_READ) {
ULONG DbgBufferLength;
DbgBufferLength = oldIrp->IoStatus.Information;
//if (DbgBufferLength) {
CyzDump(CYZDIAG2, ("ReadComplete Port %d %d\n",
extension->PortIndex+1,
DbgBufferLength,
0));
DbgPrint("ReadComplete %d\n", DbgBufferLength);
//}
}
#endif
}
}
#endif
//
// Check to see if there is a new irp to start up.
//
if (!IsListEmpty(QueueToProcess)) {
PLIST_ENTRY headOfList;
headOfList = RemoveHeadList(QueueToProcess);
*CurrentOpIrp = CONTAINING_RECORD(
headOfList,
IRP,
Tail.Overlay.ListEntry
);
IoSetCancelRoutine(
*CurrentOpIrp,
NULL
);
} else {
*CurrentOpIrp = NULL;
}
*NextIrp = *CurrentOpIrp;
IoReleaseCancelSpinLock(OldIrql);
if (CompleteCurrent) {
if (oldIrp) {
CyzCompleteRequest(extension, oldIrp, IO_SERIAL_INCREMENT);
}
}
}
VOID
CyzTryToCompleteCurrent(
IN PCYZ_DEVICE_EXTENSION Extension,
IN PKSYNCHRONIZE_ROUTINE SynchRoutine OPTIONAL,
IN KIRQL IrqlForRelease,
IN NTSTATUS StatusToUse,
IN PIRP *CurrentOpIrp,
IN PLIST_ENTRY QueueToProcess OPTIONAL,
IN PKTIMER IntervalTimer OPTIONAL,
IN PKTIMER TotalTimer OPTIONAL,
IN PSERIAL_START_ROUTINE Starter OPTIONAL,
IN PSERIAL_GET_NEXT_ROUTINE GetNextIrp OPTIONAL,
IN LONG RefType
)
/*--------------------------------------------------------------------------
CyzTryToCompleteCurrent()
Routine Description: This routine attempts to kill all of the reasons
there are references on the current read/write. If everything can be
killed it will complete this read/write and try to start another.
NOTE: This routine assumes that the cancel spinlock is being held.
Arguments:
Extension - Simply a pointer to the device extension.
SynchRoutine - A routine that will synchronize with the isr
and attempt to remove the knowledge of the
current irp from the isr. NOTE: This pointer
can be null.
IrqlForRelease - This routine is called with the cancel spinlock held.
This is the irql that was current when the cancel
spinlock was acquired.
StatusToUse - The irp's status field will be set to this value, if
this routine can complete the irp.
Return Value: None.
--------------------------------------------------------------------------*/
{
CYZ_LOCKED_PAGED_CODE();
// We can decrement the reference to "remove" the fact
// that the caller no longer will be accessing this irp.
SERIAL_CLEAR_REFERENCE(*CurrentOpIrp,RefType);
if (SynchRoutine) {
#ifdef POLL
KIRQL pollIrql;
KeAcquireSpinLock(&Extension->PollLock,&pollIrql);
SynchRoutine(Extension);
KeReleaseSpinLock(&Extension->PollLock,pollIrql);
#else
KeSynchronizeExecution(Extension->Interrupt,SynchRoutine,Extension);
#endif
}
// Try to run down all other references to this irp.
CyzRundownIrpRefs(CurrentOpIrp,IntervalTimer,TotalTimer,Extension);
// See if the ref count is zero after trying to kill everybody else.
if (!SERIAL_REFERENCE_COUNT(*CurrentOpIrp)) {
PIRP newIrp;
// The ref count was zero so we should complete this request.
// The following call will also cause the current irp to be
// completed.
(*CurrentOpIrp)->IoStatus.Status = StatusToUse;
if (StatusToUse == STATUS_CANCELLED) {
(*CurrentOpIrp)->IoStatus.Information = 0;
}
if (GetNextIrp) {
IoReleaseCancelSpinLock(IrqlForRelease);
GetNextIrp(CurrentOpIrp,QueueToProcess,&newIrp,TRUE
,Extension
);
if (newIrp) {
Starter(Extension);
}
} else {
PIRP oldIrp = *CurrentOpIrp;
#if 0
//FANNY_DEBUG
if (IoGetCurrentIrpStackLocation(oldIrp)->MajorFunction == IRP_MJ_READ) {
ULONG DbgBufferLength;
DbgBufferLength = oldIrp->IoStatus.Information;
//if (DbgBufferLength) {
CyzDump(CYZDIAG2, ("ReadComplete Port %d %d\n",
Extension->PortIndex+1,
DbgBufferLength,
0));
DbgPrint("ReadComplete %d\n", DbgBufferLength);
//}
}
#endif
// There was no get next routine. We will simply complete
// the irp. We should make sure that we null out the
// pointer to the pointer to this irp.
*CurrentOpIrp = NULL;
IoReleaseCancelSpinLock(IrqlForRelease);
CyzCompleteRequest(Extension, oldIrp, IO_SERIAL_INCREMENT);
}
} else {
IoReleaseCancelSpinLock(IrqlForRelease);
}
}
VOID
CyzRundownIrpRefs(
IN PIRP *CurrentOpIrp,
IN PKTIMER IntervalTimer OPTIONAL,
IN PKTIMER TotalTimer OPTIONAL,
IN PCYZ_DEVICE_EXTENSION PDevExt
)
/*++
Routine Description:
This routine runs through the various items that *could*
have a reference to the current read/write. It try's to kill
the reason. If it does succeed in killing the reason it
will decrement the reference count on the irp.
NOTE: This routine assumes that it is called with the cancel
spin lock held.
Arguments:
CurrentOpIrp - Pointer to a pointer to current irp for the
particular operation.
IntervalTimer - Pointer to the interval timer for the operation.
NOTE: This could be null.
TotalTimer - Pointer to the total timer for the operation.
NOTE: This could be null.
PDevExt - Pointer to device extension
Return Value:
None.
--*/
{
CYZ_LOCKED_PAGED_CODE();
//
// This routine is called with the cancel spin lock held
// so we know only one thread of execution can be in here
// at one time.
//
//
// First we see if there is still a cancel routine. If
// so then we can decrement the count by one.
//
if ((*CurrentOpIrp)->CancelRoutine) {
SERIAL_CLEAR_REFERENCE(
*CurrentOpIrp,
SERIAL_REF_CANCEL
);
IoSetCancelRoutine(
*CurrentOpIrp,
NULL
);
}
if (IntervalTimer) {
//
// Try to cancel the operations interval timer. If the operation
// returns true then the timer did have a reference to the
// irp. Since we've canceled this timer that reference is
// no longer valid and we can decrement the reference count.
//
// If the cancel returns false then this means either of two things:
//
// a) The timer has already fired.
//
// b) There never was an interval timer.
//
// In the case of "b" there is no need to decrement the reference
// count since the "timer" never had a reference to it.
//
// In the case of "a", then the timer itself will be coming
// along and decrement it's reference. Note that the caller
// of this routine might actually be the this timer, but it
// has already decremented the reference.
//
if (CyzCancelTimer(IntervalTimer, PDevExt)) {
SERIAL_CLEAR_REFERENCE(
*CurrentOpIrp,
SERIAL_REF_INT_TIMER
);
}
}
if (TotalTimer) {
//
// Try to cancel the operations total timer. If the operation
// returns true then the timer did have a reference to the
// irp. Since we've canceled this timer that reference is
// no longer valid and we can decrement the reference count.
//
// If the cancel returns false then this means either of two things:
//
// a) The timer has already fired.
//
// b) There never was an total timer.
//
// In the case of "b" there is no need to decrement the reference
// count since the "timer" never had a reference to it.
//
// In the case of "a", then the timer itself will be coming
// along and decrement it's reference. Note that the caller
// of this routine might actually be the this timer, but it
// has already decremented the reference.
//
if (CyzCancelTimer(TotalTimer, PDevExt)) {
SERIAL_CLEAR_REFERENCE(
*CurrentOpIrp,
SERIAL_REF_TOTAL_TIMER
);
}
}
}
NTSTATUS
CyzStartOrQueue(
IN PCYZ_DEVICE_EXTENSION Extension,
IN PIRP Irp,
IN PLIST_ENTRY QueueToExamine,
IN PIRP *CurrentOpIrp,
IN PSERIAL_START_ROUTINE Starter
)
/*--------------------------------------------------------------------------
CyzStartOrQueue()
Routine Description: This routine either starts or queues requests to
the driver.
Arguments:
Extension - Points to the serial device extension.
Irp - The irp. The irp will be marked pending.
QueueToExamine - The queue the irp will be placed on.
CurrentOpIrp - Pointer to a pointer to the irp that is current
for the queue. The pointer pointed to will be set with to Irp if
what CurrentOpIrp points to is NULL.
Starter - The routine to call if the queue is empty.
Return Value:
This routine will return STATUS_PENDING if the queue is
not empty. Otherwise, it will return the status returned
from the starter routine (or cancel, if the cancel bit is
on in the irp).
--------------------------------------------------------------------------*/
{
KIRQL oldIrql;
CYZ_LOCKED_PAGED_CODE();
IoAcquireCancelSpinLock(&oldIrql);
// If this is a write irp then take the amount of characters
// to write and add it to the count of characters to write.
if (IoGetCurrentIrpStackLocation(Irp)->MajorFunction == IRP_MJ_WRITE) {
Extension->TotalCharsQueued += IoGetCurrentIrpStackLocation(Irp)->
Parameters.Write.Length;
} else {
if ((IoGetCurrentIrpStackLocation(Irp)->MajorFunction
== IRP_MJ_DEVICE_CONTROL) &&
((IoGetCurrentIrpStackLocation(Irp)
->Parameters.DeviceIoControl.IoControlCode ==
IOCTL_SERIAL_IMMEDIATE_CHAR) ||
(IoGetCurrentIrpStackLocation(Irp)
->Parameters.DeviceIoControl.IoControlCode ==
IOCTL_SERIAL_XOFF_COUNTER))) {
Extension->TotalCharsQueued++;
}
}
if ((IsListEmpty(QueueToExamine)) && !(*CurrentOpIrp)) {
// no current operation. Mark this one as current and start it up.
*CurrentOpIrp = Irp;
IoReleaseCancelSpinLock(oldIrql);
return Starter(Extension);
} else {
// We don't know how long the irp will be in the queue.
if (Irp->Cancel) {
PIO_STACK_LOCATION irpSp = IoGetCurrentIrpStackLocation(Irp);
IoReleaseCancelSpinLock(oldIrql);
if (irpSp->Parameters.DeviceIoControl.IoControlCode ==
IOCTL_SERIAL_SET_QUEUE_SIZE) {
//
// We shoved the pointer to the memory into the
// the type 3 buffer pointer which we KNOW we
// never use.
//
ASSERT(irpSp->Parameters.DeviceIoControl.Type3InputBuffer);
ExFreePool(irpSp->Parameters.DeviceIoControl.Type3InputBuffer);
irpSp->Parameters.DeviceIoControl.Type3InputBuffer = NULL;
}
Irp->IoStatus.Status = STATUS_CANCELLED;
CyzCompleteRequest(Extension, Irp, 0);
return STATUS_CANCELLED;
} else {
Irp->IoStatus.Status = STATUS_PENDING;
IoMarkIrpPending(Irp);
InsertTailList(QueueToExamine,&Irp->Tail.Overlay.ListEntry);
IoSetCancelRoutine(Irp,CyzCancelQueued);
IoReleaseCancelSpinLock(oldIrql);
return STATUS_PENDING;
}
}
}
VOID
CyzCancelQueued(
PDEVICE_OBJECT DeviceObject,
PIRP Irp
)
/*--------------------------------------------------------------------------
CyzCancelQueued()
Routine Description: This routine is used to cancel Irps that currently
reside on a queue.
Arguments:
DeviceObject - Pointer to the device object for this device
Irp - Pointer to the IRP to be canceled.
Return Value: None.
--------------------------------------------------------------------------*/
{
PCYZ_DEVICE_EXTENSION extension = DeviceObject->DeviceExtension;
PIO_STACK_LOCATION irpSp = IoGetCurrentIrpStackLocation(Irp);
CYZ_LOCKED_PAGED_CODE();
Irp->IoStatus.Status = STATUS_CANCELLED;
Irp->IoStatus.Information = 0;
RemoveEntryList(&Irp->Tail.Overlay.ListEntry);
if (irpSp->MajorFunction == IRP_MJ_WRITE) {
// write. subtract from the count of characters to write.
extension->TotalCharsQueued -= irpSp->Parameters.Write.Length;
} else if (irpSp->MajorFunction == IRP_MJ_DEVICE_CONTROL) {
if ((irpSp->Parameters.DeviceIoControl.IoControlCode ==
IOCTL_SERIAL_IMMEDIATE_CHAR) ||
(irpSp->Parameters.DeviceIoControl.IoControlCode ==
IOCTL_SERIAL_XOFF_COUNTER)) {
// immediate. Decrement the count of chars queued.
extension->TotalCharsQueued--;
} else if (irpSp->Parameters.DeviceIoControl.IoControlCode ==
IOCTL_SERIAL_SET_QUEUE_SIZE) {
// resize. Deallocate the pool passed "resizing" routine.
// We shoved the pointer to the memory into the
// the type 3 buffer pointer which we KNOW we never use.
ASSERT(irpSp->Parameters.DeviceIoControl.Type3InputBuffer);
ExFreePool(irpSp->Parameters.DeviceIoControl.Type3InputBuffer);
irpSp->Parameters.DeviceIoControl.Type3InputBuffer = NULL;
}
}
IoReleaseCancelSpinLock(Irp->CancelIrql);
CyzCompleteRequest(extension, Irp, IO_SERIAL_INCREMENT);
}
NTSTATUS
CyzCompleteIfError(
PDEVICE_OBJECT DeviceObject,
PIRP Irp
)
/*--------------------------------------------------------------------------
CyzCompleteIfError()
Routine Description: If the current irp is not an
IOCTL_SERIAL_GET_COMMSTATUS request and there is an error and the
application requested abort on errors, then cancel the irp.
Arguments:
DeviceObject - Pointer to the device object for this device
Irp - Pointer to the IRP to test.
Return Value:
STATUS_SUCCESS or STATUS_CANCELLED.
--------------------------------------------------------------------------*/
{
PCYZ_DEVICE_EXTENSION extension = DeviceObject->DeviceExtension;
NTSTATUS status = STATUS_SUCCESS;
CYZ_LOCKED_PAGED_CODE();
if ((extension->HandFlow.ControlHandShake &
SERIAL_ERROR_ABORT) && extension->ErrorWord) {
PIO_STACK_LOCATION irpSp = IoGetCurrentIrpStackLocation(Irp);
// There is a current error in the driver. No requests should
// come through except for the GET_COMMSTATUS.
if ((irpSp->MajorFunction != IRP_MJ_DEVICE_CONTROL) ||
(irpSp->Parameters.DeviceIoControl.IoControlCode !=
IOCTL_SERIAL_GET_COMMSTATUS)) {
status = STATUS_CANCELLED;
Irp->IoStatus.Status = STATUS_CANCELLED;
Irp->IoStatus.Information = 0;
CyzCompleteRequest(extension, Irp, 0);
}
}
return status;
}
VOID
CyzFilterCancelQueued(IN PDEVICE_OBJECT PDevObj, IN PIRP PIrp)
/*++
Routine Description:
This routine will be used cancel irps on the stalled queue.
Arguments:
PDevObj - Pointer to the device object.
PIrp - Pointer to the Irp to cancel
Return Value:
None.
--*/
{
PCYZ_DEVICE_EXTENSION pDevExt = PDevObj->DeviceExtension;
PIO_STACK_LOCATION pIrpSp = IoGetCurrentIrpStackLocation(PIrp);
PIrp->IoStatus.Status = STATUS_CANCELLED;
PIrp->IoStatus.Information = 0;
RemoveEntryList(&PIrp->Tail.Overlay.ListEntry);
IoReleaseCancelSpinLock(PIrp->CancelIrql);
}
VOID
CyzKillAllStalled(IN PDEVICE_OBJECT PDevObj)
{
KIRQL cancelIrql;
PDRIVER_CANCEL cancelRoutine;
PCYZ_DEVICE_EXTENSION pDevExt = PDevObj->DeviceExtension;
IoAcquireCancelSpinLock(&cancelIrql);
while (!IsListEmpty(&pDevExt->StalledIrpQueue)) {
PIRP currentLastIrp = CONTAINING_RECORD(pDevExt->StalledIrpQueue.Blink,
IRP, Tail.Overlay.ListEntry);
RemoveEntryList(pDevExt->StalledIrpQueue.Blink);
cancelRoutine = currentLastIrp->CancelRoutine;
currentLastIrp->CancelIrql = cancelIrql;
currentLastIrp->CancelRoutine = NULL;
currentLastIrp->Cancel = TRUE;
cancelRoutine(PDevObj, currentLastIrp);
IoAcquireCancelSpinLock(&cancelIrql);
}
IoReleaseCancelSpinLock(cancelIrql);
}
NTSTATUS
CyzFilterIrps(IN PIRP PIrp, IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
This routine will be used to approve irps for processing.
If an irp is approved, success will be returned. If not,
the irp will be queued or rejected outright. The IoStatus struct
and return value will appropriately reflect the actions taken.
Arguments:
PIrp - Pointer to the Irp to cancel
PDevExt - Pointer to the device extension
Return Value:
None.
--*/
{
PIO_STACK_LOCATION pIrpStack;
KIRQL oldIrqlFlags;
pIrpStack = IoGetCurrentIrpStackLocation(PIrp);
KeAcquireSpinLock(&PDevExt->FlagsLock, &oldIrqlFlags);
if ((PDevExt->DevicePNPAccept == CYZ_PNPACCEPT_OK)
&& ((PDevExt->Flags & CYZ_FLAGS_BROKENHW) == 0)) {
KeReleaseSpinLock(&PDevExt->FlagsLock, oldIrqlFlags);
return STATUS_SUCCESS;
}
if ((PDevExt->DevicePNPAccept & CYZ_PNPACCEPT_REMOVING)
|| (PDevExt->Flags & CYZ_FLAGS_BROKENHW)
|| (PDevExt->DevicePNPAccept & CYZ_PNPACCEPT_SURPRISE_REMOVING)) {
KeReleaseSpinLock(&PDevExt->FlagsLock, oldIrqlFlags);
//
// Accept all PNP IRP's -- we assume PNP can synchronize itself
//
if (pIrpStack->MajorFunction == IRP_MJ_PNP) {
return STATUS_SUCCESS;
}
PIrp->IoStatus.Status = STATUS_DELETE_PENDING;
return STATUS_DELETE_PENDING;
}
if (PDevExt->DevicePNPAccept & CYZ_PNPACCEPT_STOPPING) {
KIRQL oldIrql;
KeReleaseSpinLock(&PDevExt->FlagsLock, oldIrqlFlags);
//
// Accept all PNP IRP's -- we assume PNP can synchronize itself
//
if (pIrpStack->MajorFunction == IRP_MJ_PNP) {
return STATUS_SUCCESS;
}
IoAcquireCancelSpinLock(&oldIrql);
if (PIrp->Cancel) {
IoReleaseCancelSpinLock(oldIrql);
PIrp->IoStatus.Status = STATUS_CANCELLED;
return STATUS_CANCELLED;
} else {
//
// Mark the Irp as pending
//
PIrp->IoStatus.Status = STATUS_PENDING;
IoMarkIrpPending(PIrp);
//
// Queue up the IRP
//
InsertTailList(&PDevExt->StalledIrpQueue,
&PIrp->Tail.Overlay.ListEntry);
IoSetCancelRoutine(PIrp, CyzFilterCancelQueued);
IoReleaseCancelSpinLock(oldIrql);
return STATUS_PENDING;
}
}
KeReleaseSpinLock(&PDevExt->FlagsLock, oldIrqlFlags);
return STATUS_SUCCESS;
}
VOID
CyzUnstallIrps(IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
This routine will be used to restart irps temporarily stalled on
the stall queue due to a stop or some such nonsense.
Arguments:
PDevExt - Pointer to the device extension
Return Value:
None.
--*/
{
PLIST_ENTRY pIrpLink;
PIRP pIrp;
PIO_STACK_LOCATION pIrpStack;
PDEVICE_OBJECT pDevObj;
PDRIVER_OBJECT pDrvObj;
KIRQL oldIrql;
CyzDbgPrintEx(DPFLTR_TRACE_LEVEL, ">CyzUnstallIrps(%X)\n", PDevExt);
IoAcquireCancelSpinLock(&oldIrql);
pIrpLink = PDevExt->StalledIrpQueue.Flink;
while (pIrpLink != &PDevExt->StalledIrpQueue) {
pIrp = CONTAINING_RECORD(pIrpLink, IRP, Tail.Overlay.ListEntry);
RemoveEntryList(&pIrp->Tail.Overlay.ListEntry);
pIrpStack = IoGetCurrentIrpStackLocation(pIrp);
pDevObj = pIrpStack->DeviceObject;
pDrvObj = pDevObj->DriverObject;
IoSetCancelRoutine(pIrp, NULL);
IoReleaseCancelSpinLock(oldIrql);
CyzDbgPrintEx(CYZPNPPOWER, "Unstalling Irp 0x%x with 0x%x\n",
pIrp, pIrpStack->MajorFunction);
pDrvObj->MajorFunction[pIrpStack->MajorFunction](pDevObj, pIrp);
IoAcquireCancelSpinLock(&oldIrql);
pIrpLink = PDevExt->StalledIrpQueue.Flink;
}
IoReleaseCancelSpinLock(oldIrql);
CyzDbgPrintEx(DPFLTR_TRACE_LEVEL, "<CyzUnstallIrps\n");
}
NTSTATUS
CyzIRPPrologue(IN PIRP PIrp, IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
This function must be called at any IRP dispatch entry point. It,
with CyzIRPEpilogue(), keeps track of all pending IRP's for the given
PDevObj.
Arguments:
PDevObj - Pointer to the device object we are tracking pending IRP's for.
Return Value:
Tentative status of the Irp.
--*/
{
InterlockedIncrement(&PDevExt->PendingIRPCnt);
return CyzFilterIrps(PIrp, PDevExt);
}
VOID
CyzIRPEpilogue(IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
This function must be called at any IRP dispatch entry point. It,
with CyzIRPPrologue(), keeps track of all pending IRP's for the given
PDevObj.
Arguments:
PDevObj - Pointer to the device object we are tracking pending IRP's for.
Return Value:
None.
--*/
{
LONG pendingCnt;
pendingCnt = InterlockedDecrement(&PDevExt->PendingIRPCnt);
ASSERT(pendingCnt >= 0);
if (pendingCnt == 0) {
KeSetEvent(&PDevExt->PendingIRPEvent, IO_NO_INCREMENT, FALSE);
}
}
BOOLEAN
CyzInsertQueueDpc(IN PRKDPC PDpc, IN PVOID Sarg1, IN PVOID Sarg2,
IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
This function must be called to queue DPC's for the serial driver.
Arguments:
PDpc thru Sarg2 - Standard args to KeInsertQueueDpc()
PDevExt - Pointer to the device extension for the device that needs to
queue a DPC
Return Value:
Kicks up return value from KeInsertQueueDpc()
--*/
{
BOOLEAN queued;
InterlockedIncrement(&PDevExt->DpcCount);
LOGENTRY(LOG_CNT, 'DpI1', PDpc, PDevExt->DpcCount, 0); // Added in build 2128
queued = KeInsertQueueDpc(PDpc, Sarg1, Sarg2);
if (!queued) {
ULONG pendingCnt;
pendingCnt = InterlockedDecrement(&PDevExt->DpcCount);
// LOGENTRY(LOG_CNT, 'DpD1', PDpc, PDevExt->DpcCount, 0); Added in build 2128
if (pendingCnt == 0) {
KeSetEvent(&PDevExt->PendingDpcEvent, IO_NO_INCREMENT, FALSE);
LOGENTRY(LOG_CNT, 'DpF1', PDpc, PDevExt->DpcCount, 0); // Added in build 2128
}
}
#if 0 // DBG
if (queued) {
int i;
for (i = 0; i < MAX_DPC_QUEUE; i++) {
if (PDevExt->DpcQueued[i].Dpc == PDpc) {
PDevExt->DpcQueued[i].QueuedCount++;
break;
}
}
ASSERT(i < MAX_DPC_QUEUE);
}
#endif
return queued;
}
BOOLEAN
CyzSetTimer(IN PKTIMER Timer, IN LARGE_INTEGER DueTime,
IN PKDPC Dpc OPTIONAL, IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
This function must be called to set timers for the serial driver.
Arguments:
Timer - pointer to timer dispatcher object
DueTime - time at which the timer should expire
Dpc - option Dpc
PDevExt - Pointer to the device extension for the device that needs to
set a timer
Return Value:
Kicks up return value from KeSetTimer()
--*/
{
BOOLEAN set;
InterlockedIncrement(&PDevExt->DpcCount);
LOGENTRY(LOG_CNT, 'DpI2', Dpc, PDevExt->DpcCount, 0); // Added in build 2128
set = KeSetTimer(Timer, DueTime, Dpc);
if (set) {
InterlockedDecrement(&PDevExt->DpcCount);
// LOGENTRY(LOG_CNT, 'DpD2', Dpc, PDevExt->DpcCount, 0); // Added in build 2128
}
#if 0 // DBG
if (set) {
int i;
for (i = 0; i < MAX_DPC_QUEUE; i++) {
if (PDevExt->DpcQueued[i].Dpc == Dpc) {
PDevExt->DpcQueued[i].QueuedCount++;
break;
}
}
ASSERT(i < MAX_DPC_QUEUE);
}
#endif
return set;
}
BOOLEAN
CyzCancelTimer(IN PKTIMER Timer, IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
This function must be called to cancel timers for the serial driver.
Arguments:
Timer - pointer to timer dispatcher object
PDevExt - Pointer to the device extension for the device that needs to
set a timer
Return Value:
True if timer was cancelled
--*/
{
BOOLEAN cancelled;
cancelled = KeCancelTimer(Timer);
if (cancelled) {
CyzDpcEpilogue(PDevExt, Timer->Dpc);
}
return cancelled;
}
VOID
CyzDpcEpilogue(IN PCYZ_DEVICE_EXTENSION PDevExt, PKDPC PDpc)
/*++
Routine Description:
This function must be called at the end of every dpc function.
Arguments:
PDevObj - Pointer to the device object we are tracking dpc's for.
Return Value:
None.
--*/
{
LONG pendingCnt;
#if 1 // !DBG
UNREFERENCED_PARAMETER(PDpc);
#endif
pendingCnt = InterlockedDecrement(&PDevExt->DpcCount);
// LOGENTRY(LOG_CNT, 'DpD3', PDpc, PDevExt->DpcCount, 0); Added in build 2128
ASSERT(pendingCnt >= 0);
#if 0 //DBG
{
int i;
for (i = 0; i < MAX_DPC_QUEUE; i++) {
if (PDevExt->DpcQueued[i].Dpc == PDpc) {
PDevExt->DpcQueued[i].FlushCount++;
ASSERT(PDevExt->DpcQueued[i].QueuedCount >=
PDevExt->DpcQueued[i].FlushCount);
break;
}
}
ASSERT(i < MAX_DPC_QUEUE);
}
#endif
if (pendingCnt == 0) {
KeSetEvent(&PDevExt->PendingDpcEvent, IO_NO_INCREMENT, FALSE);
LOGENTRY(LOG_CNT, 'DpF2', PDpc, PDevExt->DpcCount, 0); // Added in build 2128
}
}
VOID
CyzUnlockPages(IN PKDPC PDpc, IN PVOID PDeferredContext,
IN PVOID PSysContext1, IN PVOID PSysContext2)
/*++
Routine Description:
This function is a DPC routine queue from the ISR if he released the
last lock on pending DPC's.
Arguments:
PDpdc, PSysContext1, PSysContext2 -- not used
PDeferredContext -- Really the device extension
Return Value:
None.
--*/
{
PCYZ_DEVICE_EXTENSION pDevExt
= (PCYZ_DEVICE_EXTENSION)PDeferredContext;
UNREFERENCED_PARAMETER(PDpc);
UNREFERENCED_PARAMETER(PSysContext1);
UNREFERENCED_PARAMETER(PSysContext2);
KeSetEvent(&pDevExt->PendingDpcEvent, IO_NO_INCREMENT, FALSE);
}
NTSTATUS
CyzIoCallDriver(PCYZ_DEVICE_EXTENSION PDevExt, PDEVICE_OBJECT PDevObj,
PIRP PIrp)
/*++
Routine Description:
This function must be called instead of IoCallDriver. It automatically
updates Irp tracking for PDevObj.
Arguments:
PDevExt - Device extension attached to PDevObj
PDevObj - Pointer to the device object we are tracking pending IRP's for.
PIrp - Pointer to the Irp we are passing to the next driver.
Return Value:
None.
--*/
{
NTSTATUS status;
status = IoCallDriver(PDevObj, PIrp);
CyzIRPEpilogue(PDevExt);
return status;
}
NTSTATUS
CyzPoCallDriver(PCYZ_DEVICE_EXTENSION PDevExt, PDEVICE_OBJECT PDevObj,
PIRP PIrp)
/*++
Routine Description:
This function must be called instead of PoCallDriver. It automatically
updates Irp tracking for PDevObj.
Arguments:
PDevExt - Device extension attached to PDevObj
PDevObj - Pointer to the device object we are tracking pending IRP's for.
PIrp - Pointer to the Irp we are passing to the next driver.
Return Value:
None.
--*/
{
NTSTATUS status;
status = PoCallDriver(PDevObj, PIrp);
CyzIRPEpilogue(PDevExt);
return status;
}
VOID
CyzLogError(
IN PDRIVER_OBJECT DriverObject,
IN PDEVICE_OBJECT DeviceObject OPTIONAL,
IN PHYSICAL_ADDRESS P1,
IN PHYSICAL_ADDRESS P2,
IN ULONG SequenceNumber,
IN UCHAR MajorFunctionCode,
IN UCHAR RetryCount,
IN ULONG UniqueErrorValue,
IN NTSTATUS FinalStatus,
IN NTSTATUS SpecificIOStatus,
IN ULONG LengthOfInsert1,
IN PWCHAR Insert1,
IN ULONG LengthOfInsert2,
IN PWCHAR Insert2
)
/*++
Routine Description:
This routine allocates an error log entry, copies the supplied data
to it, and requests that it be written to the error log file.
Arguments:
DriverObject - A pointer to the driver object for the device.
DeviceObject - A pointer to the device object associated with the
device that had the error, early in initialization, one may not
yet exist.
P1,P2 - If phyical addresses for the controller ports involved
with the error are available, put them through as dump data.
SequenceNumber - A ulong value that is unique to an IRP over the
life of the irp in this driver - 0 generally means an error not
associated with an irp.
MajorFunctionCode - If there is an error associated with the irp,
this is the major function code of that irp.
RetryCount - The number of times a particular operation has been
retried.
UniqueErrorValue - A unique long word that identifies the particular
call to this function.
FinalStatus - The final status given to the irp that was associated
with this error. If this log entry is being made during one of
the retries this value will be STATUS_SUCCESS.
SpecificIOStatus - The IO status for a particular error.
LengthOfInsert1 - The length in bytes (including the terminating NULL)
of the first insertion string.
Insert1 - The first insertion string.
LengthOfInsert2 - The length in bytes (including the terminating NULL)
of the second insertion string. NOTE, there must
be a first insertion string for their to be
a second insertion string.
Insert2 - The second insertion string.
Return Value:
None.
--*/
{
PIO_ERROR_LOG_PACKET errorLogEntry;
PVOID objectToUse;
SHORT dumpToAllocate = 0;
PUCHAR ptrToFirstInsert;
PUCHAR ptrToSecondInsert;
//PAGED_CODE(); It can be called at raised IRQL.
if (Insert1 == NULL) {
LengthOfInsert1 = 0;
}
if (Insert2 == NULL) {
LengthOfInsert2 = 0;
}
if (ARGUMENT_PRESENT(DeviceObject)) {
objectToUse = DeviceObject;
} else {
objectToUse = DriverObject;
}
if (CyzMemCompare(
P1,
(ULONG)1,
CyzPhysicalZero,
(ULONG)1
) != AddressesAreEqual) {
dumpToAllocate = (SHORT)sizeof(PHYSICAL_ADDRESS);
}
if (CyzMemCompare(
P2,
(ULONG)1,
CyzPhysicalZero,
(ULONG)1
) != AddressesAreEqual) {
dumpToAllocate += (SHORT)sizeof(PHYSICAL_ADDRESS);
}
errorLogEntry = IoAllocateErrorLogEntry(
objectToUse,
(UCHAR)(sizeof(IO_ERROR_LOG_PACKET) +
dumpToAllocate
+ LengthOfInsert1 +
LengthOfInsert2)
);
if ( errorLogEntry != NULL ) {
errorLogEntry->ErrorCode = SpecificIOStatus;
errorLogEntry->SequenceNumber = SequenceNumber;
errorLogEntry->MajorFunctionCode = MajorFunctionCode;
errorLogEntry->RetryCount = RetryCount;
errorLogEntry->UniqueErrorValue = UniqueErrorValue;
errorLogEntry->FinalStatus = FinalStatus;
errorLogEntry->DumpDataSize = dumpToAllocate;
if (dumpToAllocate) {
RtlCopyMemory(
&errorLogEntry->DumpData[0],
&P1,
sizeof(PHYSICAL_ADDRESS)
);
if (dumpToAllocate > sizeof(PHYSICAL_ADDRESS)) {
RtlCopyMemory(
((PUCHAR)&errorLogEntry->DumpData[0])
+sizeof(PHYSICAL_ADDRESS),
&P2,
sizeof(PHYSICAL_ADDRESS)
);
ptrToFirstInsert =
((PUCHAR)&errorLogEntry->DumpData[0])+(2*sizeof(PHYSICAL_ADDRESS));
} else {
ptrToFirstInsert =
((PUCHAR)&errorLogEntry->DumpData[0])+sizeof(PHYSICAL_ADDRESS);
}
} else {
ptrToFirstInsert = (PUCHAR)&errorLogEntry->DumpData[0];
}
ptrToSecondInsert = ptrToFirstInsert + LengthOfInsert1;
if (LengthOfInsert1) {
errorLogEntry->NumberOfStrings = 1;
errorLogEntry->StringOffset = (USHORT)(ptrToFirstInsert -
(PUCHAR)errorLogEntry);
RtlCopyMemory(
ptrToFirstInsert,
Insert1,
LengthOfInsert1
);
if (LengthOfInsert2) {
errorLogEntry->NumberOfStrings = 2;
RtlCopyMemory(
ptrToSecondInsert,
Insert2,
LengthOfInsert2
);
}
}
IoWriteErrorLogEntry(errorLogEntry);
}
}
VOID
CyzMarkHardwareBroken(IN PCYZ_DEVICE_EXTENSION PDevExt)
/*++
Routine Description:
Marks a UART as broken. This causes the driver stack to stop accepting
requests and eventually be removed.
Arguments:
PDevExt - Device extension attached to PDevObj
Return Value:
None.
--*/
{
PAGED_CODE();
//
// Mark as damaged goods
//
CyzSetFlags(PDevExt, CYZ_FLAGS_BROKENHW);
//
// Write a log entry
//
CyzLogError(PDevExt->DriverObject, NULL, CyzPhysicalZero,
CyzPhysicalZero, 0, 0, 0, PDevExt->PortIndex+1, STATUS_SUCCESS,
CYZ_HARDWARE_FAILURE, PDevExt->DeviceName.Length
+ sizeof(WCHAR), PDevExt->DeviceName.Buffer, 0, NULL);
//
// Invalidate the device
//
IoInvalidateDeviceState(PDevExt->Pdo);
}
VOID
CyzSetDeviceFlags(IN PCYZ_DEVICE_EXTENSION PDevExt, OUT PULONG PFlags,
IN ULONG Value, IN BOOLEAN Set)
/*++
Routine Description:
Sets flags in a value protected by the flags spinlock. This is used
to set values that would stop IRP's from being accepted.
Arguments:
PDevExt - Device extension attached to PDevObj
PFlags - Pointer to the flags variable that needs changing
Value - Value to modify flags variable with
Set - TRUE if |= , FALSE if &=
Return Value:
None.
--*/
{
KIRQL oldIrql;
KeAcquireSpinLock(&PDevExt->FlagsLock, &oldIrql);
if (Set) {
*PFlags |= Value;
} else {
*PFlags &= ~Value;
}
KeReleaseSpinLock(&PDevExt->FlagsLock, oldIrql);
}