453 lines
14 KiB
C
453 lines
14 KiB
C
|
/*++
|
|||
|
|
|
|||
|
|
Copyright (c) 1990 Microsoft Corporation
|
|||
|
|
|
|||
|
|
Module Name:
|
|||
|
|
|
|||
|
|
intobj.c
|
|||
|
|
|
|||
|
|
Abstract:
|
|||
|
|
|
|||
|
|
This module implements the kernel interrupt object. Functions are provided
|
|||
|
|
to initialize, connect, and disconnect interrupt objects.
|
|||
|
|
|
|||
|
|
Author:
|
|||
|
|
|
|||
|
|
David N. Cutler (davec) 3-Apr-1990
|
|||
|
|
|
|||
|
|
Environment:
|
|||
|
|
|
|||
|
|
Kernel mode only.
|
|||
|
|
|
|||
|
|
Revision History:
|
|||
|
|
|
|||
|
|
|
|||
|
|
--*/
|
|||
|
|
|
|||
|
|
#include "ki.h"
|
|||
|
|
|
|||
|
|
VOID
|
|||
|
|
KeInitializeInterrupt (
|
|||
|
|
IN PKINTERRUPT Interrupt,
|
|||
|
|
IN PKSERVICE_ROUTINE ServiceRoutine,
|
|||
|
|
IN PVOID ServiceContext,
|
|||
|
|
IN PKSPIN_LOCK SpinLock OPTIONAL,
|
|||
|
|
IN ULONG Vector,
|
|||
|
|
IN KIRQL Irql,
|
|||
|
|
IN KIRQL SynchronizeIrql,
|
|||
|
|
IN KINTERRUPT_MODE InterruptMode,
|
|||
|
|
IN BOOLEAN ShareVector,
|
|||
|
|
IN CCHAR ProcessorNumber,
|
|||
|
|
IN BOOLEAN FloatingSave
|
|||
|
|
)
|
|||
|
|
|
|||
|
|
/*++
|
|||
|
|
|
|||
|
|
Routine Description:
|
|||
|
|
|
|||
|
|
This function initializes a kernel interrupt object. The service routine,
|
|||
|
|
service context, spin lock, vector, IRQL, Synchronized IRQL, and floating
|
|||
|
|
context save flag are initialized.
|
|||
|
|
|
|||
|
|
Arguments:
|
|||
|
|
|
|||
|
|
Interrupt - Supplies a pointer to a control object of type interrupt.
|
|||
|
|
|
|||
|
|
ServiceRoutine - Supplies a pointer to a function that is to be
|
|||
|
|
executed when an interrupt occurs via the specified interrupt
|
|||
|
|
vector.
|
|||
|
|
|
|||
|
|
ServiceContext - Supplies a pointer to an arbitrary data structure which is
|
|||
|
|
to be passed to the function specified by the ServiceRoutine parameter.
|
|||
|
|
|
|||
|
|
SpinLock - Supplies an optional pointer to an executive spin lock.
|
|||
|
|
|
|||
|
|
Vector - Supplies the index of the entry in the Interrupt Dispatch Table
|
|||
|
|
that is to be associated with the ServiceRoutine function.
|
|||
|
|
|
|||
|
|
Irql - Supplies the request priority of the interrupting source.
|
|||
|
|
|
|||
|
|
SynchronizeIrql - The request priority that the interrupt should be
|
|||
|
|
synchronized with.
|
|||
|
|
|
|||
|
|
InterruptMode - Supplies the mode of the interrupt; LevelSensitive or
|
|||
|
|
Latched.
|
|||
|
|
|
|||
|
|
ShareVector - Supplies a boolean value that specifies whether the
|
|||
|
|
vector can be shared with other interrupt objects or not. If FALSE
|
|||
|
|
then the vector may not be shared, if TRUE it may be.
|
|||
|
|
Latched.
|
|||
|
|
|
|||
|
|
ProcessorNumber - Supplies the number of the processor to which the
|
|||
|
|
interrupt will be connected.
|
|||
|
|
|
|||
|
|
FloatingSave - Supplies a boolean value that determines whether the
|
|||
|
|
floating point registers and pipe line are to be saved before calling
|
|||
|
|
the ServiceRoutine function.
|
|||
|
|
|
|||
|
|
Return Value:
|
|||
|
|
|
|||
|
|
None.
|
|||
|
|
|
|||
|
|
--*/
|
|||
|
|
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
LONG Index;
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Initialize standard control object header.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
Interrupt->Type = InterruptObject;
|
|||
|
|
Interrupt->Size = sizeof(KINTERRUPT);
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Initialize the address of the service routine, the service context,
|
|||
|
|
// the address of the spin lock, the address of the actual spin lock
|
|||
|
|
// that will be used, the vector number, the IRQL of the interrupting
|
|||
|
|
// source, the Synchronized IRQL of the interrupt object, the interrupt
|
|||
|
|
// mode, the processor number, and the floating context save flag.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
Interrupt->ServiceRoutine = ServiceRoutine; // function pointer
|
|||
|
|
Interrupt->ServiceContext = ServiceContext;
|
|||
|
|
|
|||
|
|
if (ARGUMENT_PRESENT(SpinLock)) {
|
|||
|
|
Interrupt->ActualLock = SpinLock;
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
Interrupt->SpinLock = 0;
|
|||
|
|
Interrupt->ActualLock = &Interrupt->SpinLock;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
Interrupt->Vector = Vector;
|
|||
|
|
Interrupt->Irql = Irql;
|
|||
|
|
Interrupt->SynchronizeIrql = SynchronizeIrql;
|
|||
|
|
Interrupt->Mode = InterruptMode;
|
|||
|
|
Interrupt->ShareVector = ShareVector;
|
|||
|
|
Interrupt->Number = ProcessorNumber;
|
|||
|
|
Interrupt->FloatingSave = FloatingSave;
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Set the connected state of the interrupt object to FALSE.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
Interrupt->Connected = FALSE;
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
BOOLEAN
|
|||
|
|
KeConnectInterrupt (
|
|||
|
|
IN PKINTERRUPT Interrupt
|
|||
|
|
)
|
|||
|
|
|
|||
|
|
/*++
|
|||
|
|
|
|||
|
|
Routine Description:
|
|||
|
|
|
|||
|
|
This function connects an interrupt object to the interrupt vector
|
|||
|
|
specified by the interrupt object. If the interrupt object is already
|
|||
|
|
connected, or an attempt is made to connect to an interrupt that cannot
|
|||
|
|
be connected, then a value of FALSE is returned. Else the specified
|
|||
|
|
interrupt object is connected to the interrupt vector, the connected
|
|||
|
|
state is set to TRUE, and TRUE is returned as the function value.
|
|||
|
|
|
|||
|
|
Arguments:
|
|||
|
|
|
|||
|
|
Interrupt - Supplies a pointer to a control object of type interrupt.
|
|||
|
|
|
|||
|
|
Return Value:
|
|||
|
|
|
|||
|
|
If the interrupt object is already connected or an attempt is made to
|
|||
|
|
connect to an interrupt vector that cannot be connected, then a value
|
|||
|
|
of FALSE is returned. Else a value of TRUE is returned.
|
|||
|
|
|
|||
|
|
--*/
|
|||
|
|
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
BOOLEAN Connected;
|
|||
|
|
PKINTERRUPT Interruptx;
|
|||
|
|
KIRQL Irql;
|
|||
|
|
CHAR Number;
|
|||
|
|
KIRQL OldIrql;
|
|||
|
|
ULONG Vector;
|
|||
|
|
UCHAR IDTEntry;
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// If the interrupt object is already connected, the interrupt vector
|
|||
|
|
// number is invalid, an attempt is being made to connect to a vector
|
|||
|
|
// that cannot be connected, the interrupt request level is invalid,
|
|||
|
|
// the processor number is invalid, of the interrupt vector is less
|
|||
|
|
// than or equal to the highest level and it not equal to the specified
|
|||
|
|
// IRQL, then do not connect the interrupt object. Else connect interrupt
|
|||
|
|
// object to the specified vector and establish the proper interrupt
|
|||
|
|
// dispatcher.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
Connected = FALSE;
|
|||
|
|
Irql = Interrupt->Irql;
|
|||
|
|
Number = Interrupt->Number;
|
|||
|
|
Vector = Interrupt->Vector;
|
|||
|
|
IDTEntry = HalVectorToIDTEntry(Vector);
|
|||
|
|
|
|||
|
|
if ((((IDTEntry >= MAXIMUM_VECTOR) || (Irql > HIGH_LEVEL) ||
|
|||
|
|
((IDTEntry <= HIGH_LEVEL) &&
|
|||
|
|
((((1 << IDTEntry) & PCR->ReservedVectors) != 0) || (IDTEntry != Irql))) ||
|
|||
|
|
(Number >= KeNumberProcessors))) == FALSE) {
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Set system affinity to the specified processor.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KeSetSystemAffinityThread(AFFINITY_MASK(Number));
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Raise IRQL to dispatcher level and lock dispatcher database.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KiLockDispatcherDatabase(&OldIrql);
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// If the specified interrupt vector is not connected, then
|
|||
|
|
// connect the interrupt vector to the interrupt object dispatch
|
|||
|
|
// code, establish the dispatcher address, and set the new
|
|||
|
|
// interrupt mode and enable masks. Else if the interrupt is
|
|||
|
|
// already chained, then add the new interrupt object at the end
|
|||
|
|
// of the chain. If the interrupt vector is not chained, then
|
|||
|
|
// start a chain with the previous interrupt object at the front
|
|||
|
|
// of the chain. The interrupt mode of all interrupt objects in
|
|||
|
|
// a chain must be the same.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
if (Interrupt->Connected == FALSE) {
|
|||
|
|
if (PCR->InterruptRoutine[IDTEntry] ==
|
|||
|
|
(PKINTERRUPT_ROUTINE)(&KxUnexpectedInterrupt.DispatchCode)) {
|
|||
|
|
Connected = TRUE;
|
|||
|
|
Interrupt->Connected = TRUE;
|
|||
|
|
if (Interrupt->FloatingSave != FALSE) {
|
|||
|
|
Interrupt->DispatchAddress = KiFloatingDispatch;
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
if (Interrupt->Irql == Interrupt->SynchronizeIrql) {
|
|||
|
|
Interrupt->DispatchAddress =
|
|||
|
|
(PKINTERRUPT_ROUTINE)KiInterruptDispatchSame;
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
Interrupt->DispatchAddress =
|
|||
|
|
(PKINTERRUPT_ROUTINE)KiInterruptDispatchRaise;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Copy the plabel for the Dispatch routine into DispatchCode.
|
|||
|
|
// This will be used by KiExternalInterruptHandler to
|
|||
|
|
// dispatch the interrupt.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
|
|||
|
|
RtlMoveMemory(Interrupt->DispatchCode,
|
|||
|
|
Interrupt->DispatchAddress,
|
|||
|
|
DISPATCH_LENGTH*4);
|
|||
|
|
|
|||
|
|
PCR->InterruptRoutine[IDTEntry] =
|
|||
|
|
(PKINTERRUPT_ROUTINE)(&Interrupt->DispatchCode);
|
|||
|
|
|
|||
|
|
HalEnableSystemInterrupt(Vector, Irql, Interrupt->Mode);
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
Interruptx = CONTAINING_RECORD(PCR->InterruptRoutine[IDTEntry],
|
|||
|
|
KINTERRUPT,
|
|||
|
|
DispatchCode[0]);
|
|||
|
|
|
|||
|
|
if (Interrupt->Mode == Interruptx->Mode) {
|
|||
|
|
Connected = TRUE;
|
|||
|
|
Interrupt->Connected = TRUE;
|
|||
|
|
ASSERT (Irql <= KiSynchIrql);
|
|||
|
|
if (Interruptx->DispatchAddress != KiChainedDispatch) {
|
|||
|
|
InitializeListHead(&Interruptx->InterruptListEntry);
|
|||
|
|
Interruptx->DispatchAddress = KiChainedDispatch;
|
|||
|
|
|
|||
|
|
RtlMoveMemory(Interruptx->DispatchCode,
|
|||
|
|
Interruptx->DispatchAddress,
|
|||
|
|
DISPATCH_LENGTH*4);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
InsertTailList(&Interruptx->InterruptListEntry,
|
|||
|
|
&Interrupt->InterruptListEntry);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Unlock dispatcher database and lower IRQL to its previous value.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KiUnlockDispatcherDatabase(OldIrql);
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Set system affinity back to the original value.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KeRevertToUserAffinityThread();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Return whether interrupt was connected to the specified vector.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
return Connected;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
BOOLEAN
|
|||
|
|
KeDisconnectInterrupt (
|
|||
|
|
IN PKINTERRUPT Interrupt
|
|||
|
|
)
|
|||
|
|
|
|||
|
|
/*++
|
|||
|
|
|
|||
|
|
Routine Description:
|
|||
|
|
|
|||
|
|
This function disconnects an interrupt object from the interrupt vector
|
|||
|
|
specified by the interrupt object. If the interrupt object is not
|
|||
|
|
connected, then a value of FALSE is returned. Else the specified interrupt
|
|||
|
|
object is disconnected from the interrupt vector, the connected state is
|
|||
|
|
set to FALSE, and TRUE is returned as the function value.
|
|||
|
|
|
|||
|
|
Arguments:
|
|||
|
|
|
|||
|
|
Interrupt - Supplies a pointer to a control object of type interrupt.
|
|||
|
|
|
|||
|
|
Return Value:
|
|||
|
|
|
|||
|
|
If the interrupt object is not connected, then a value of FALSE is
|
|||
|
|
returned. Else a value of TRUE is returned.
|
|||
|
|
|
|||
|
|
--*/
|
|||
|
|
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
BOOLEAN Connected;
|
|||
|
|
PKINTERRUPT Interruptx;
|
|||
|
|
PKINTERRUPT Interrupty;
|
|||
|
|
KIRQL Irql;
|
|||
|
|
KIRQL OldIrql;
|
|||
|
|
ULONG Vector;
|
|||
|
|
UCHAR IDTEntry;
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Set system affinity to the specified processor.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KeSetSystemAffinityThread(AFFINITY_MASK(Interrupt->Number));
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Raise IRQL to dispatcher level and lock dispatcher database.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KiLockDispatcherDatabase(&OldIrql);
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// If the interrupt object is connected, then disconnect it from the
|
|||
|
|
// specified vector.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
Connected = Interrupt->Connected;
|
|||
|
|
if (Connected != FALSE) {
|
|||
|
|
Irql = Interrupt->Irql;
|
|||
|
|
Vector = Interrupt->Vector;
|
|||
|
|
IDTEntry = HalVectorToIDTEntry(Vector);
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// If the specified interrupt vector is not connected to the chained
|
|||
|
|
// interrupt dispatcher, then disconnect it by setting its dispatch
|
|||
|
|
// address to the unexpected interrupt routine. Else remove the
|
|||
|
|
// interrupt object from the interrupt chain. If there is only
|
|||
|
|
// one entry remaining in the list, then reestablish the dispatch
|
|||
|
|
// address.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
Interruptx = CONTAINING_RECORD(PCR->InterruptRoutine[IDTEntry],
|
|||
|
|
KINTERRUPT,
|
|||
|
|
DispatchCode[0]);
|
|||
|
|
|
|||
|
|
if (Interruptx->DispatchAddress ==
|
|||
|
|
(PKINTERRUPT_ROUTINE)KiChainedDispatch) {
|
|||
|
|
ASSERT (Irql <= KiSynchIrql);
|
|||
|
|
if (Interrupt == Interruptx) {
|
|||
|
|
Interruptx = CONTAINING_RECORD(Interruptx->InterruptListEntry.Flink,
|
|||
|
|
KINTERRUPT, InterruptListEntry);
|
|||
|
|
Interruptx->DispatchAddress =
|
|||
|
|
(PKINTERRUPT_ROUTINE)KiChainedDispatch;
|
|||
|
|
|
|||
|
|
RtlMoveMemory(Interruptx->DispatchCode,
|
|||
|
|
Interruptx->DispatchAddress,
|
|||
|
|
DISPATCH_LENGTH*4);
|
|||
|
|
|
|||
|
|
PCR->InterruptRoutine[IDTEntry] =
|
|||
|
|
(PKINTERRUPT_ROUTINE)(&Interruptx->DispatchCode);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
RemoveEntryList(&Interrupt->InterruptListEntry);
|
|||
|
|
Interrupty = CONTAINING_RECORD(Interruptx->InterruptListEntry.Flink,
|
|||
|
|
KINTERRUPT,
|
|||
|
|
InterruptListEntry);
|
|||
|
|
|
|||
|
|
if (Interruptx == Interrupty) {
|
|||
|
|
if (Interrupty->FloatingSave != FALSE) {
|
|||
|
|
Interrupty->DispatchAddress = KiFloatingDispatch;
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
if (Interrupty->Irql == Interrupty->SynchronizeIrql) {
|
|||
|
|
Interrupty->DispatchAddress =
|
|||
|
|
(PKINTERRUPT_ROUTINE)KiInterruptDispatchSame;
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
Interrupty->DispatchAddress =
|
|||
|
|
(PKINTERRUPT_ROUTINE)KiInterruptDispatchRaise;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Copy the plabel for the Dispatch routine into DispatchCode.
|
|||
|
|
// This will be used by KiExternalInterruptHandler to
|
|||
|
|
// dispatch the interrupt.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
RtlMoveMemory(Interrupty->DispatchCode,
|
|||
|
|
Interrupty->DispatchAddress,
|
|||
|
|
DISPATCH_LENGTH*4);
|
|||
|
|
|
|||
|
|
PCR->InterruptRoutine[IDTEntry] =
|
|||
|
|
(PKINTERRUPT_ROUTINE)(&Interrupty->DispatchCode);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
} else {
|
|||
|
|
HalDisableSystemInterrupt(Vector, Irql);
|
|||
|
|
PCR->InterruptRoutine[IDTEntry] =
|
|||
|
|
(PKINTERRUPT_ROUTINE)(&KxUnexpectedInterrupt.DispatchCode);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
Interrupt->Connected = FALSE;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Unlock dispatcher database and lower IRQL to its previous value.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KiUnlockDispatcherDatabase(OldIrql);
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Set system affinity back to the original value.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
KeRevertToUserAffinityThread();
|
|||
|
|
|
|||
|
|
//
|
|||
|
|
// Return whether interrupt was disconnected from the specified vector.
|
|||
|
|
//
|
|||
|
|
|
|||
|
|
return Connected;
|
|||
|
|
}
|