Loading...
--- xnu/xnu-792.6.76/iokit/Kernel/IOInterruptController.cpp
+++ xnu/xnu-344/iokit/Kernel/IOInterruptController.cpp
@@ -34,7 +34,6 @@
#include <IOKit/IOLib.h>
#include <IOKit/IOService.h>
#include <IOKit/IOPlatformExpert.h>
-#include <IOKit/IODeviceTreeSupport.h>
#include <IOKit/IOInterrupts.h>
#include <IOKit/IOInterruptController.h>
@@ -67,8 +66,6 @@
OSData *vectorData;
IOService *originalNub;
int originalSource;
- IOOptionBits options;
- bool canBeShared, shouldBeShared, wasAlreadyRegisterd;
interruptSources = nub->_interruptSources;
vectorData = interruptSources[source].vectorData;
@@ -78,22 +75,14 @@
// Get the lock for this vector.
IOTakeLock(vector->interruptLock);
- // Check if the interrupt source can/should be shared.
- canBeShared = vectorCanBeShared(vectorNumber, vector);
- IODTGetInterruptOptions(nub, source, &options);
- shouldBeShared = canBeShared && (options & kIODTInterruptShared);
- wasAlreadyRegisterd = vector->interruptRegistered;
-
- // If the vector is registered and can not be shared return error.
- if (wasAlreadyRegisterd && !canBeShared) {
- IOUnlock(vector->interruptLock);
- return kIOReturnNoResources;
- }
-
- // If this vector is already in use, and can be shared (implied),
- // or it is not registered and should be shared,
+ // If this vector is already in use, and can be shared,
// register as a shared interrupt.
- if (wasAlreadyRegisterd || shouldBeShared) {
+ if (vector->interruptRegistered) {
+ if (!vectorCanBeShared(vectorNumber, vector)) {
+ IOUnlock(vector->interruptLock);
+ return kIOReturnNoResources;
+ }
+
// If this vector is not already shared, break it out.
if (vector->sharedController == 0) {
// Make the IOShareInterruptController instance
@@ -103,57 +92,44 @@
return kIOReturnNoMemory;
}
- if (wasAlreadyRegisterd) {
- // Save the nub and source for the original consumer.
- originalNub = vector->nub;
- originalSource = vector->source;
-
- // Physically disable the interrupt, but mark it as being enabled in the hardware.
- // The interruptDisabledSoft now indicates the driver's request for enablement.
- disableVectorHard(vectorNumber, vector);
- vector->interruptDisabledHard = 0;
- }
+ // Save the nub and source for the original consumer.
+ originalNub = vector->nub;
+ originalSource = vector->source;
+
+ // Save the dis/enable state for the original consumer's interrupt.
+ // Then disable the source
+ wasDisabledSoft = vector->interruptDisabledSoft;
+ disableInterrupt(originalNub, originalSource);
// Initialize the new shared interrupt controller.
- error = vector->sharedController->initInterruptController(this, vectorData);
+ error = vector->sharedController->initInterruptController(this,
+ vectorData);
// If the IOSharedInterruptController could not be initalized,
- // if needed, put the original consumer's interrupt back to normal and
+ // put the original consumor's interrupt back to normal and
// get rid of whats left of the shared controller.
if (error != kIOReturnSuccess) {
- if (wasAlreadyRegisterd) enableInterrupt(originalNub, originalSource);
+ enableInterrupt(originalNub, originalSource);
vector->sharedController->release();
vector->sharedController = 0;
IOUnlock(vector->interruptLock);
return error;
}
- // If there was an original consumer try to register it on the shared controller.
- if (wasAlreadyRegisterd) {
- error = vector->sharedController->registerInterrupt(originalNub,
- originalSource,
- vector->target,
- vector->handler,
- vector->refCon);
- // If the original consumer could not be moved to the shared controller,
- // put the original consumor's interrupt back to normal and
- // get rid of whats left of the shared controller.
- if (error != kIOReturnSuccess) {
- // Save the driver's interrupt enablement state.
- wasDisabledSoft = vector->interruptDisabledSoft;
-
- // Make the interrupt really hard disabled.
- vector->interruptDisabledSoft = 1;
- vector->interruptDisabledHard = 1;
-
- // Enable the original consumer's interrupt if needed.
- if (!wasDisabledSoft) originalNub->enableInterrupt(originalSource);
- enableInterrupt(originalNub, originalSource);
-
- vector->sharedController->release();
- vector->sharedController = 0;
- IOUnlock(vector->interruptLock);
- return error;
- }
+ // Try to register the original consumer on the shared controller.
+ error = vector->sharedController->registerInterrupt(originalNub,
+ originalSource,
+ vector->target,
+ vector->handler,
+ vector->refCon);
+ // If the original consumer could not be moved to the shared controller,
+ // put the original consumor's interrupt back to normal and
+ // get rid of whats left of the shared controller.
+ if (error != kIOReturnSuccess) {
+ enableInterrupt(originalNub, originalSource);
+ vector->sharedController->release();
+ vector->sharedController = 0;
+ IOUnlock(vector->interruptLock);
+ return error;
}
// Fill in vector with the shared controller's info.
@@ -162,19 +138,6 @@
vector->source = 0;
vector->target = vector->sharedController;
vector->refCon = 0;
-
- // If the interrupt was already registered,
- // save the driver's interrupt enablement state.
- if (wasAlreadyRegisterd) wasDisabledSoft = vector->interruptDisabledSoft;
- else wasDisabledSoft = true;
-
- // Do any specific initalization for this vector if it has not yet been used.
- if (!wasAlreadyRegisterd) initVector(vectorNumber, vector);
-
- // Make the interrupt really hard disabled.
- vector->interruptDisabledSoft = 1;
- vector->interruptDisabledHard = 1;
- vector->interruptRegistered = 1;
// Enable the original consumer's interrupt if needed.
if (!wasDisabledSoft) originalNub->enableInterrupt(originalSource);
@@ -408,8 +371,6 @@
/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
-#define kIOSharedInterruptControllerDefaultVectors (128)
-
IOReturn IOSharedInterruptController::initInterruptController(IOInterruptController *parentController, OSData *parentSource)
{
int cnt, interruptType;
@@ -438,7 +399,7 @@
}
// Allocate the memory for the vectors
- numVectors = kIOSharedInterruptControllerDefaultVectors; // For now a constant number.
+ numVectors = 8; // For now a constant number.
vectors = (IOInterruptVector *)IOMalloc(numVectors * sizeof(IOInterruptVector));
if (vectors == NULL) {
IOFree(_interruptSources, sizeof(IOInterruptSource));
@@ -462,7 +423,6 @@
}
}
- numVectors = 0; // reset the high water mark for used vectors
vectorsRegistered = 0;
vectorsEnabled = 0;
controllerDisabled = 1;
@@ -485,9 +445,9 @@
interruptSources = nub->_interruptSources;
// Find a free vector.
- vectorNumber = kIOSharedInterruptControllerDefaultVectors;
- while (vectorsRegistered != kIOSharedInterruptControllerDefaultVectors) {
- for (vectorNumber = 0; vectorNumber < kIOSharedInterruptControllerDefaultVectors; vectorNumber++) {
+ vectorNumber = numVectors;
+ while (vectorsRegistered != numVectors) {
+ for (vectorNumber = 0; vectorNumber < numVectors; vectorNumber++) {
vector = &vectors[vectorNumber];
// Get the lock for this vector.
@@ -500,11 +460,11 @@
IOUnlock(vector->interruptLock);
}
- if (vectorNumber != kIOSharedInterruptControllerDefaultVectors) break;
+ if (vectorNumber != numVectors) break;
}
// Could not find a free one, so give up.
- if (vectorNumber == kIOSharedInterruptControllerDefaultVectors) {
+ if (vectorNumber == numVectors) {
return kIOReturnNoResources;
}
@@ -525,13 +485,12 @@
vector->target = target;
vector->refCon = refCon;
- // Get the vector ready. It starts off soft disabled.
+ // Get the vector ready. It start soft disabled.
vector->interruptDisabledSoft = 1;
vector->interruptRegistered = 1;
interruptState = IOSimpleLockLockDisableInterrupt(controllerLock);
- // Move the high water mark if needed
- if (++vectorsRegistered > numVectors) numVectors = vectorsRegistered;
+ vectorsRegistered++;
IOSimpleLockUnlockEnableInterrupt(controllerLock, interruptState);
IOUnlock(vector->interruptLock);
@@ -545,7 +504,7 @@
long vectorNumber;
IOInterruptVector *vector;
OSData *vectorData;
- IOInterruptState interruptState;
+ IOInterruptState interruptState;;
interruptSources = nub->_interruptSources;
vectorData = interruptSources[source].vectorData;
@@ -561,7 +520,7 @@
return kIOReturnSuccess;
}
- // Soft disable the source and the controller too.
+ // Soft disable the source.
disableInterrupt(nub, source);
// Clear all the storage for the vector except for interruptLock.
@@ -580,13 +539,6 @@
IOSimpleLockUnlockEnableInterrupt(controllerLock, interruptState);
IOUnlock(vector->interruptLock);
-
- // Re-enable the controller if all vectors are enabled.
- if (vectorsEnabled == vectorsRegistered) {
- controllerDisabled = 0;
- provider->enableInterrupt(0);
- }
-
return kIOReturnSuccess;
}