Loading...
--- xnu/xnu-12377.101.15/iokit/Kernel/IOWorkLoop.cpp
+++ xnu/xnu-344.32/iokit/Kernel/IOWorkLoop.cpp
@@ -1,56 +1,46 @@
/*
- * Copyright (c) 1998-2010 Apple Inc. All rights reserved.
+ * Copyright (c) 1998-2000 Apple Computer, Inc. All rights reserved.
*
- * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
- *
- * This file contains Original Code and/or Modifications of Original Code
- * as defined in and that are subject to the Apple Public Source License
- * Version 2.0 (the 'License'). You may not use this file except in
- * compliance with the License. The rights granted to you under the License
- * may not be used to create, or enable the creation or redistribution of,
- * unlawful or unlicensed copies of an Apple operating system, or to
- * circumvent, violate, or enable the circumvention or violation of, any
- * terms of an Apple operating system software license agreement.
- *
- * Please obtain a copy of the License at
- * http://www.opensource.apple.com/apsl/ and read it before using this file.
- *
- * The Original Code and all software distributed under the License are
- * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
+ * @APPLE_LICENSE_HEADER_START@
+ *
+ * The contents of this file constitute Original Code as defined in and
+ * are subject to the Apple Public Source License Version 1.1 (the
+ * "License"). You may not use this file except in compliance with the
+ * License. Please obtain a copy of the License at
+ * http://www.apple.com/publicsource and read it before using this file.
+ *
+ * This Original Code and all software distributed under the License are
+ * distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, EITHER
* EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
* INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
- * Please see the License for the specific language governing rights and
- * limitations under the License.
- *
- * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
+ * FITNESS FOR A PARTICULAR PURPOSE OR NON-INFRINGEMENT. Please see the
+ * License for the specific language governing rights and limitations
+ * under the License.
+ *
+ * @APPLE_LICENSE_HEADER_END@
*/
-
-#include <pexpert/pexpert.h>
+/*
+Copyright (c) 1998 Apple Computer, Inc. All rights reserved.
+
+HISTORY
+ 1998-7-13 Godfrey van der Linden(gvdl)
+ Created.
+*/
#include <IOKit/IOWorkLoop.h>
#include <IOKit/IOEventSource.h>
#include <IOKit/IOInterruptEventSource.h>
#include <IOKit/IOCommandGate.h>
-#include <IOKit/IOCommandPool.h>
#include <IOKit/IOTimeStamp.h>
-#include <IOKit/IOKitDebug.h>
-#include <libkern/OSDebug.h>
-#include <kern/thread.h>
#define super OSObject
OSDefineMetaClassAndStructors(IOWorkLoop, OSObject);
// Block of unused functions intended for future use
-#if __LP64__
-OSMetaClassDefineReservedUnused(IOWorkLoop, 0);
+OSMetaClassDefineReservedUsed(IOWorkLoop, 0);
+
OSMetaClassDefineReservedUnused(IOWorkLoop, 1);
OSMetaClassDefineReservedUnused(IOWorkLoop, 2);
-#else
-OSMetaClassDefineReservedUsedX86(IOWorkLoop, 0);
-OSMetaClassDefineReservedUsedX86(IOWorkLoop, 1);
-OSMetaClassDefineReservedUsedX86(IOWorkLoop, 2);
-#endif
OSMetaClassDefineReservedUnused(IOWorkLoop, 3);
OSMetaClassDefineReservedUnused(IOWorkLoop, 4);
OSMetaClassDefineReservedUnused(IOWorkLoop, 5);
@@ -58,689 +48,400 @@
OSMetaClassDefineReservedUnused(IOWorkLoop, 7);
enum IOWorkLoopState { kLoopRestart = 0x1, kLoopTerminate = 0x2 };
-static inline void
-SETP(void *addr, unsigned int flag)
-{
- unsigned char *num = (unsigned char *) addr; *num |= flag;
-}
-static inline void
-CLRP(void *addr, unsigned int flag)
-{
- unsigned char *num = (unsigned char *) addr; *num &= ~flag;
-}
-static inline bool
-ISSETP(void *addr, unsigned int flag)
-{
- unsigned char *num = (unsigned char *) addr; return (*num & flag) != 0;
-}
+static inline void SETP(void *addr, unsigned int flag)
+ { unsigned int *num = (unsigned int *) addr; *num |= flag; }
+static inline void CLRP(void *addr, unsigned int flag)
+ { unsigned int *num = (unsigned int *) addr; *num &= ~flag; }
+static inline bool ISSETP(void *addr, unsigned int flag)
+ { unsigned int *num = (unsigned int *) addr; return (*num & flag) != 0; }
#define fFlags loopRestart
-#define passiveEventChain reserved->passiveEventChain
-
-#if IOKITSTATS
-
-#define IOStatisticsRegisterCounter() \
-do { \
- reserved->counter = IOStatistics::registerWorkLoop(this); \
-} while(0)
-
-#define IOStatisticsUnregisterCounter() \
-do { \
- if (reserved) \
- IOStatistics::unregisterWorkLoop(reserved->counter); \
-} while(0)
-
-#define IOStatisticsOpenGate() \
-do { \
- IOStatistics::countWorkLoopOpenGate(reserved->counter); \
- if (reserved->lockInterval) lockTime(); \
-} while(0)
-#define IOStatisticsCloseGate() \
-do { \
- IOStatistics::countWorkLoopCloseGate(reserved->counter); \
- if (reserved->lockInterval) reserved->lockTime = mach_absolute_time(); \
-} while(0)
-
-#define IOStatisticsAttachEventSource() \
-do { \
- IOStatistics::attachWorkLoopEventSource(reserved->counter, inEvent->reserved->counter); \
-} while(0)
-
-#define IOStatisticsDetachEventSource() \
-do { \
- IOStatistics::detachWorkLoopEventSource(reserved->counter, inEvent->reserved->counter); \
-} while(0)
-
-#else
-
-#define IOStatisticsRegisterCounter()
-#define IOStatisticsUnregisterCounter()
-#define IOStatisticsOpenGate()
-#define IOStatisticsCloseGate()
-#define IOStatisticsAttachEventSource()
-#define IOStatisticsDetachEventSource()
-
-#endif /* IOKITSTATS */
-
-bool
-IOWorkLoop::init()
-{
- // The super init and gateLock allocation MUST be done first.
- if (!super::init()) {
- return false;
- }
-
- // Allocate our ExpansionData if it hasn't been allocated already.
- if (!reserved) {
- reserved = IOMallocType(ExpansionData);
- }
-
- if (gateLock == NULL) {
- if (!(gateLock = IORecursiveLockAlloc())) {
- return false;
- }
- }
-
- if (workToDoLock == NULL) {
- if (!(workToDoLock = IOSimpleLockAlloc())) {
- return false;
- }
- IOSimpleLockInit(workToDoLock);
- workToDo = false;
- }
-
- IOStatisticsRegisterCounter();
-
- if (controlG == NULL) {
- controlG = IOCommandGate::commandGate(
- this,
- OSMemberFunctionCast(
- IOCommandGate::Action,
- this,
- &IOWorkLoop::_maintRequest));
-
- if (!controlG) {
- return false;
- }
- // Point the controlGate at the workLoop. Usually addEventSource
- // does this automatically. The problem is in this case addEventSource
- // uses the control gate and it has to be bootstrapped.
- controlG->setWorkLoop(this);
- if (addEventSource(controlG) != kIOReturnSuccess) {
- return false;
- }
- }
-
- if (workThread == NULL) {
- thread_continue_t cptr = OSMemberFunctionCast(
- thread_continue_t,
- this,
- &IOWorkLoop::threadMain);
- if (KERN_SUCCESS != kernel_thread_start(cptr, this, &workThread)) {
- return false;
- }
- }
-
- (void) thread_set_tag(workThread, THREAD_TAG_IOWORKLOOP);
- return true;
+extern "C" extern void stack_privilege( thread_t thread);
+
+void IOWorkLoop::launchThreadMain(void *self)
+{
+ register thread_t mythread = current_thread();
+
+ // Make sure that this thread always has a kernel stack
+ stack_privilege(mythread);
+ thread_set_cont_arg((int) self);
+ threadMainContinuation();
+}
+
+bool IOWorkLoop::init()
+{
+ // The super init and gateLock allocation MUST be done first
+ if ( !super::init() )
+ return false;
+
+ if ( !(gateLock = IORecursiveLockAlloc()) )
+ return false;
+
+ if ( !(workToDoLock = IOSimpleLockAlloc()) )
+ return false;
+
+ controlG = IOCommandGate::
+ commandGate(this, (IOCommandGate::Action) &IOWorkLoop::_maintRequest);
+ if ( !controlG )
+ return false;
+
+ IOSimpleLockInit(workToDoLock);
+ workToDo = false;
+
+ // Point the controlGate at the workLoop. Usually addEventSource
+ // does this automatically. The problem is in this case addEventSource
+ // uses the control gate and it has to be bootstrapped.
+ controlG->setWorkLoop(this);
+ if (addEventSource(controlG) != kIOReturnSuccess)
+ return false;
+
+ workThread = IOCreateThread(launchThreadMain, (void *) this);
+ if (!workThread)
+ return false;
+
+ return true;
}
IOWorkLoop *
IOWorkLoop::workLoop()
{
- return IOWorkLoop::workLoopWithOptions(0);
-}
-
-IOWorkLoop *
-IOWorkLoop::workLoopWithOptions(IOOptionBits options)
-{
- IOWorkLoop *me = new IOWorkLoop;
-
- if (me && options) {
- me->reserved = IOMallocType(ExpansionData);
- me->reserved->options = options;
- }
-
- if (me && !me->init()) {
- me->release();
- return NULL;
- }
-
- return me;
-}
-
-void
-IOWorkLoop::releaseEventChain(LIBKERN_CONSUMED IOEventSource *eventChain)
-{
- IOEventSource *event, *next;
- for (event = eventChain; event; event = next) {
- next = event->getNext();
-#ifdef __clang_analyzer__
- // Unlike the usual IOKit memory management convention, IOWorkLoop
- // manages the retain count for the IOEventSource instances in the
- // the chain rather than have IOEventSource do that itself. This means
- // it is safe to call release() on the result of getNext() while the
- // chain is being torn down. However, the analyzer doesn't
- // realize this. We add an extra retain under analysis to suppress
- // an analyzer diagnostic about violations of the memory management rules.
- if (next) {
- next->retain();
- }
-#endif
- event->setWorkLoop(NULL);
- event->setNext(NULL);
- event->release();
- }
-}
+ IOWorkLoop *me = new IOWorkLoop;
+
+ if (me && !me->init()) {
+ me->free();
+ return 0;
+ }
+
+ return me;
+}
+
// Free is called twice:
// First when the atomic retainCount transitions from 1 -> 0
// Secondly when the work loop itself is commiting hari kari
// Hence the each leg of the free must be single threaded.
-void
-IOWorkLoop::free()
-{
- if (workThread) {
- IOInterruptState is;
-
- // If we are here then we must be trying to shut down this work loop
- // in this case disable all of the event source, mark the loop
- // as terminating and wakeup the work thread itself and return
- // Note: we hold the gate across the entire operation mainly for the
- // benefit of our event sources so we can disable them cleanly.
- closeGate();
-
- disableAllEventSources();
-
- is = IOSimpleLockLockDisableInterrupt(workToDoLock);
- SETP(&fFlags, kLoopTerminate);
- thread_wakeup_thread((void *) &workToDo, workThread);
- IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
-
- openGate();
- } else { /* !workThread */
- releaseEventChain(eventChain);
- eventChain = NULL;
-
- releaseEventChain(passiveEventChain);
- passiveEventChain = NULL;
-
- // Either we have a partial initialization to clean up
- // or the workThread itself is performing hari-kari.
- // Either way clean up all of our resources and return.
-
- if (controlG) {
- controlG->workLoop = NULL;
- controlG->release();
- controlG = NULL;
- }
-
- if (workToDoLock) {
- IOSimpleLockFree(workToDoLock);
- workToDoLock = NULL;
- }
-
- if (gateLock) {
- IORecursiveLockFree(gateLock);
- gateLock = NULL;
- }
-
- IOStatisticsUnregisterCounter();
-
- if (reserved) {
- IOFreeType(reserved, ExpansionData);
- reserved = NULL;
- }
-
- super::free();
+void IOWorkLoop::free()
+{
+ if (workThread) {
+ IOInterruptState is;
+
+ // If we are here then we must be trying to shut down this work loop
+ // in this case disable all of the event source, mark the loop for
+ // as terminating and wakeup the work thread itself and return
+ // Note: we hold the gate across the entire operation mainly for the
+ // benefit of our event sources so we can disable them cleanly.
+ closeGate();
+
+ disableAllEventSources();
+
+ is = IOSimpleLockLockDisableInterrupt(workToDoLock);
+ SETP(&fFlags, kLoopTerminate);
+ thread_wakeup_one((void *) &workToDo);
+ IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
+
+ openGate();
+ }
+ else /* !workThread */ {
+ IOEventSource *event, *next;
+
+ for (event = eventChain; event; event = next) {
+ next = event->getNext();
+ event->setWorkLoop(0);
+ event->setNext(0);
+ event->release();
+ }
+ eventChain = 0;
+
+ // Either we have a partial initialisation to clean up
+ // or we the workThread itself is performing hari-kari.
+ // either way clean up all of our resources and return.
+
+ if (controlG) {
+ controlG->release();
+ controlG = 0;
}
-}
-
-IOReturn
-IOWorkLoop::addEventSource(IOEventSource *newEvent)
-{
- if ((workThread)
- && !thread_has_thread_name(workThread)
- && (newEvent->owner)
- && !OSDynamicCast(IOCommandPool, newEvent->owner)) {
- thread_set_thread_name(workThread, newEvent->owner->getMetaClass()->getClassName());
+
+ if (workToDoLock) {
+ IOSimpleLockFree(workToDoLock);
+ workToDoLock = 0;
}
- return controlG->runCommand((void *) mAddEvent, (void *) newEvent);
-}
-
-IOReturn
-IOWorkLoop::removeEventSource(IOEventSource *toRemove)
-{
- return controlG->runCommand((void *) mRemoveEvent, (void *) toRemove);
-}
-
-void
-IOWorkLoop::enableAllEventSources() const
-{
- IOEventSource *event;
-
- for (event = eventChain; event; event = event->getNext()) {
- event->enable();
+ if (gateLock) {
+ IORecursiveLockFree(gateLock);
+ gateLock = 0;
}
- for (event = passiveEventChain; event; event = event->getNext()) {
- event->enable();
+ super::free();
+ }
+}
+
+IOReturn IOWorkLoop::addEventSource(IOEventSource *newEvent)
+{
+ return controlG->runCommand((void *) mAddEvent, (void *) newEvent);
+}
+
+IOReturn IOWorkLoop::removeEventSource(IOEventSource *toRemove)
+{
+ return controlG->runCommand((void *) mRemoveEvent, (void *) toRemove);
+}
+
+void IOWorkLoop::enableAllEventSources() const
+{
+ IOEventSource *event;
+
+ for (event = eventChain; event; event = event->getNext())
+ event->enable();
+}
+
+void IOWorkLoop::disableAllEventSources() const
+{
+ IOEventSource *event;
+
+ for (event = eventChain; event; event = event->getNext())
+ if (event != controlG) // Don't disable the control gate
+ event->disable();
+}
+
+void IOWorkLoop::enableAllInterrupts() const
+{
+ IOEventSource *event;
+
+ for (event = eventChain; event; event = event->getNext())
+ if (OSDynamicCast(IOInterruptEventSource, event))
+ event->enable();
+}
+
+void IOWorkLoop::disableAllInterrupts() const
+{
+ IOEventSource *event;
+
+ for (event = eventChain; event; event = event->getNext())
+ if (OSDynamicCast(IOInterruptEventSource, event))
+ event->disable();
+}
+
+#if KDEBUG
+#define IOTimeClientS() \
+do { \
+ IOTimeStampStart(IODBG_WORKLOOP(IOWL_CLIENT), \
+ (unsigned int) this, (unsigned int) event); \
+} while(0)
+
+#define IOTimeClientE() \
+do { \
+ IOTimeStampEnd(IODBG_WORKLOOP(IOWL_CLIENT), \
+ (unsigned int) this, (unsigned int) event); \
+} while(0)
+
+#define IOTimeWorkS() \
+do { \
+ IOTimeStampStart(IODBG_WORKLOOP(IOWL_WORK), (unsigned int) this); \
+} while(0)
+
+#define IOTimeWorkE() \
+do { \
+ IOTimeStampEnd(IODBG_WORKLOOP(IOWL_WORK),(unsigned int) this); \
+} while(0)
+
+#else /* !KDEBUG */
+
+#define IOTimeClientS()
+#define IOTimeClientE()
+#define IOTimeWorkS()
+#define IOTimeWorkE()
+
+#endif /* KDEBUG */
+
+void IOWorkLoop::threadMainContinuation()
+{
+ IOWorkLoop* self;
+ self = (IOWorkLoop *) thread_get_cont_arg();
+
+ self->threadMain();
+}
+
+void IOWorkLoop::threadMain()
+{
+ CLRP(&fFlags, kLoopRestart);
+
+ for (;;) {
+ bool more;
+ IOInterruptState is;
+
+ IOTimeWorkS();
+
+ closeGate();
+ if (ISSETP(&fFlags, kLoopTerminate))
+ goto exitThread;
+
+ do {
+ workToDo = more = false;
+ for (IOEventSource *event = eventChain; event; event = event->getNext()) {
+
+ IOTimeClientS();
+ more |= event->checkForWork();
+ IOTimeClientE();
+
+ if (ISSETP(&fFlags, kLoopTerminate))
+ goto exitThread;
+ else if (fFlags & kLoopRestart) {
+ CLRP(&fFlags, kLoopRestart);
+ continue;
+ }
+ }
+ } while (more);
+
+ IOTimeWorkE();
+
+ openGate();
+
+ is = IOSimpleLockLockDisableInterrupt(workToDoLock);
+ if ( !ISSETP(&fFlags, kLoopTerminate) && !workToDo) {
+ assert_wait((void *) &workToDo, false);
+ IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
+
+ thread_set_cont_arg((int) this);
+ thread_block(&threadMainContinuation);
+ /* NOTREACHED */
}
-}
-
-void
-IOWorkLoop::disableAllEventSources() const
-{
- IOEventSource *event;
-
- for (event = eventChain; event; event = event->getNext()) {
- event->disable();
- }
-
- /* NOTE: controlG is in passiveEventChain since it's an IOCommandGate */
- for (event = passiveEventChain; event; event = event->getNext()) {
- if (event != controlG) { // Don't disable the control gate
- event->disable();
- }
- }
-}
-
-void
-IOWorkLoop::enableAllInterrupts() const
-{
- IOEventSource *event;
-
- for (event = eventChain; event; event = event->getNext()) {
- if (OSDynamicCast(IOInterruptEventSource, event)) {
- event->enable();
- }
- }
-}
-
-void
-IOWorkLoop::disableAllInterrupts() const
-{
- IOEventSource *event;
-
- for (event = eventChain; event; event = event->getNext()) {
- if (OSDynamicCast(IOInterruptEventSource, event)) {
- event->disable();
- }
- }
-}
-
-
-/* virtual */ bool
-IOWorkLoop::runEventSources()
-{
- bool res = false;
- bool traceWL = (gIOKitTrace & kIOTraceWorkLoops) ? true : false;
- bool traceES = (gIOKitTrace & kIOTraceEventSources) ? true : false;
-
- closeGate();
- if (ISSETP(&fFlags, kLoopTerminate)) {
- goto abort;
- }
-
- if (traceWL) {
- IOTimeStampStartConstant(IODBG_WORKLOOP(IOWL_WORK), VM_KERNEL_ADDRHIDE(this));
- }
-
- bool more;
- do {
- CLRP(&fFlags, kLoopRestart);
- more = false;
- IOInterruptState is = IOSimpleLockLockDisableInterrupt(workToDoLock);
- workToDo = false;
- IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
- /* NOTE: only loop over event sources in eventChain. Bypass "passive" event sources for performance */
- for (IOEventSource *evnt = eventChain; evnt; evnt = evnt->getNext()) {
- if (traceES) {
- IOTimeStampStartConstant(IODBG_WORKLOOP(IOWL_CLIENT), VM_KERNEL_ADDRHIDE(this), VM_KERNEL_ADDRHIDE(evnt));
- }
-
- more |= evnt->checkForWork();
-
- if (traceES) {
- IOTimeStampEndConstant(IODBG_WORKLOOP(IOWL_CLIENT), VM_KERNEL_ADDRHIDE(this), VM_KERNEL_ADDRHIDE(evnt));
- }
-
- if (ISSETP(&fFlags, kLoopTerminate)) {
- goto abort;
- } else if (fFlags & kLoopRestart) {
- more = true;
- break;
- }
- }
- } while (more);
-
- res = true;
-
- if (traceWL) {
- IOTimeStampEndConstant(IODBG_WORKLOOP(IOWL_WORK), VM_KERNEL_ADDRHIDE(this));
- }
-
-abort:
- openGate();
- return res;
-}
-
-/* virtual */ void
-IOWorkLoop::threadMain()
-{
-restartThread:
- do {
- if (!runEventSources()) {
- goto exitThread;
- }
-
- IOInterruptState is = IOSimpleLockLockDisableInterrupt(workToDoLock);
- if (!ISSETP(&fFlags, kLoopTerminate) && !workToDo) {
- assert_wait((void *) &workToDo, false);
- IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
- thread_continue_t cptr = NULL;
- if (!reserved || !(kPreciousStack & reserved->options)) {
- cptr = OSMemberFunctionCast(
- thread_continue_t, this, &IOWorkLoop::threadMain);
- }
- thread_block_parameter(cptr, this);
- goto restartThread;
- /* NOTREACHED */
- }
-
- // At this point we either have work to do or we need
- // to commit suicide. But no matter
- // Clear the simple lock and retore the interrupt state
- IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
- } while (workToDo);
+
+ // At this point we either have work to do or we need
+ // to commit suicide. But no matter
+ // Clear the simple lock and retore the interrupt state
+ IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
+ if (workToDo)
+ continue;
+ else
+ break;
+ }
exitThread:
- closeGate();
- thread_t thread = workThread;
- workThread = NULL; // Say we don't have a loop and free ourselves
- openGate();
-
- free();
-
- thread_deallocate(thread);
- (void) thread_terminate(thread);
-}
-
-IOThread
-IOWorkLoop::getThread() const
-{
- return workThread;
-}
-
-bool
-IOWorkLoop::onThread() const
-{
- return IOThreadSelf() == workThread;
-}
-
-bool
-IOWorkLoop::inGate() const
-{
- return IORecursiveLockHaveLock(gateLock);
+ workThread = 0; // Say we don't have a loop and free ourselves
+ free();
+ IOExitThread();
+}
+
+IOThread IOWorkLoop::getThread() const
+{
+ return workThread;
+}
+
+bool IOWorkLoop::onThread() const
+{
+ return (IOThreadSelf() == workThread);
+}
+
+bool IOWorkLoop::inGate() const
+{
+ return IORecursiveLockHaveLock(gateLock);
}
// Internal APIs used by event sources to control the thread
-void
-IOWorkLoop::signalWorkAvailable()
-{
- if (workToDoLock) {
- IOInterruptState is = IOSimpleLockLockDisableInterrupt(workToDoLock);
- workToDo = true;
- thread_wakeup_thread((void *) &workToDo, workThread);
- IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
- }
-}
-
-void
-IOWorkLoop::openGate()
-{
- IOStatisticsOpenGate();
- IORecursiveLockUnlock(gateLock);
-}
-
-void
-IOWorkLoop::closeGate()
-{
- IORecursiveLockLock(gateLock);
- IOStatisticsCloseGate();
-}
-
-bool
-IOWorkLoop::tryCloseGate()
-{
- bool res = (IORecursiveLockTryLock(gateLock) != 0);
- if (res) {
- IOStatisticsCloseGate();
- }
- return res;
-}
-
-int
-IOWorkLoop::sleepGate(void *event, UInt32 interuptibleType)
-{
- int res;
- IOStatisticsOpenGate();
- res = IORecursiveLockSleep(gateLock, event, interuptibleType);
- IOStatisticsCloseGate();
- return res;
-}
-
-int
-IOWorkLoop::sleepGate(void *event, AbsoluteTime deadline, UInt32 interuptibleType)
-{
- int res;
- IOStatisticsOpenGate();
- res = IORecursiveLockSleepDeadline(gateLock, event, deadline, interuptibleType);
- IOStatisticsCloseGate();
- return res;
-}
-
-void
-IOWorkLoop::wakeupGate(void *event, bool oneThread)
-{
- IORecursiveLockWakeup(gateLock, event, oneThread);
-}
-
-static IOReturn
-IOWorkLoopActionToBlock(OSObject *owner,
- void *arg0, void *arg1,
- void *arg2, void *arg3)
-{
- return ((IOWorkLoop::ActionBlock) arg0)();
-}
-
-IOReturn
-IOWorkLoop::runActionBlock(ActionBlock action)
-{
- return runAction(&IOWorkLoopActionToBlock, this, action);
-}
-
-IOReturn
-IOWorkLoop::runAction(Action inAction, OSObject *target,
- void *arg0, void *arg1,
- void *arg2, void *arg3)
-{
- IOReturn res;
-
- // closeGate is recursive so don't worry if we already hold the lock.
- closeGate();
- res = (*inAction)(target, arg0, arg1, arg2, arg3);
- openGate();
-
- return res;
-}
-
-IOReturn
-IOWorkLoop::_maintRequest(void *inC, void *inD, void *, void *)
-{
- maintCommandEnum command = (maintCommandEnum) (uintptr_t) inC;
- IOEventSource *inEvent = (IOEventSource *) inD;
- IOReturn res = kIOReturnSuccess;
-
- switch (command) {
- case mAddEvent:
- if (!inEvent->getWorkLoop()) {
- SETP(&fFlags, kLoopRestart);
-
- inEvent->retain();
- inEvent->setWorkLoop(this);
- inEvent->setNext(NULL);
-
- /* Check if this is a passive or active event source being added */
- if (eventSourcePerformsWork(inEvent)) {
- if (!eventChain) {
- eventChain = inEvent;
- } else {
- IOEventSource *event, *next;
-
- for (event = eventChain; (next = event->getNext()); event = next) {
- ;
- }
- event->setNext(inEvent);
- }
- } else {
- if (!passiveEventChain) {
- passiveEventChain = inEvent;
- } else {
- IOEventSource *event, *next;
-
- for (event = passiveEventChain; (next = event->getNext()); event = next) {
- ;
- }
- event->setNext(inEvent);
- }
- }
- IOStatisticsAttachEventSource();
- }
- break;
-
- case mRemoveEvent:
- if (inEvent->getWorkLoop()) {
- IOStatisticsDetachEventSource();
-
- if (eventSourcePerformsWork(inEvent)) {
- if (eventChain == inEvent) {
- eventChain = inEvent->getNext();
- } else {
- IOEventSource *event, *next = NULL;
-
- event = eventChain;
- if (event) {
- while ((next = event->getNext()) && (next != inEvent)) {
- event = next;
- }
- }
-
- if (!next) {
- res = kIOReturnBadArgument;
- break;
- }
- event->setNext(inEvent->getNext());
- }
- } else {
- if (passiveEventChain == inEvent) {
- passiveEventChain = inEvent->getNext();
- } else {
- IOEventSource *event, *next = NULL;
-
- event = passiveEventChain;
- if (event) {
- while ((next = event->getNext()) && (next != inEvent)) {
- event = next;
- }
- }
-
- if (!next) {
- res = kIOReturnBadArgument;
- break;
- }
- event->setNext(inEvent->getNext());
- }
- }
-
- inEvent->setWorkLoop(NULL);
- inEvent->setNext(NULL);
- inEvent->release();
- SETP(&fFlags, kLoopRestart);
- }
- break;
-
- default:
- return kIOReturnUnsupported;
- }
-
- return res;
-}
-
-bool
-IOWorkLoop::eventSourcePerformsWork(IOEventSource *inEventSource)
-{
- bool result = true;
-
- /*
- * The idea here is to see if the subclass of IOEventSource has overridden checkForWork().
- * The assumption is that if you override checkForWork(), you need to be
- * active and not passive.
- *
- * We picked a known quantity controlG that does not override
- * IOEventSource::checkForWork(), namely the IOCommandGate associated with
- * the workloop to which this event source is getting attached.
- *
- * We do a pointer comparison on the offset in the vtable for inNewEvent against
- * the offset in the vtable for inReferenceEvent. This works because
- * IOCommandGate's slot for checkForWork() has the address of
- * IOEventSource::checkForWork() in it.
- *
- * Think of OSMemberFunctionCast yielding the value at the vtable offset for
- * checkForWork() here. We're just testing to see if it's the same or not.
- *
- */
-
- if (IOEventSource::kPassive & inEventSource->flags) {
- result = false;
- } else if (IOEventSource::kActive & inEventSource->flags) {
- result = true;
- } else if (controlG) {
- void * ptr1;
- void * ptr2;
-
- ptr1 = OSMemberFunctionCast(void*, inEventSource, &IOEventSource::checkForWork);
- ptr2 = OSMemberFunctionCast(void*, controlG, &IOEventSource::checkForWork);
-
- if (ptr1 == ptr2) {
- result = false;
- }
- }
-
- return result;
-}
-
-void
-IOWorkLoop::lockTime(void)
-{
- uint64_t time;
- time = mach_absolute_time() - reserved->lockTime;
- if (time > reserved->lockInterval) {
- absolutetime_to_nanoseconds(time, &time);
- if (kTimeLockPanics & reserved->options) {
- panic("IOWorkLoop %p lock time %qd us", this, time / 1000ULL);
- } else {
- OSReportWithBacktrace("IOWorkLoop %p lock time %qd us", this, time / 1000ULL);
- }
- }
-}
-
-void
-IOWorkLoop::setMaximumLockTime(uint64_t interval, uint32_t options)
-{
- IORecursiveLockLock(gateLock);
- reserved->lockInterval = interval;
- reserved->options = (reserved->options & ~kTimeLockPanics) | (options & kTimeLockPanics);
- IORecursiveLockUnlock(gateLock);
-}
+void IOWorkLoop::signalWorkAvailable()
+{
+ if (workToDoLock) {
+ IOInterruptState is = IOSimpleLockLockDisableInterrupt(workToDoLock);
+ workToDo = true;
+ thread_wakeup_one((void *) &workToDo);
+ IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
+ }
+}
+
+void IOWorkLoop::openGate()
+{
+ IORecursiveLockUnlock(gateLock);
+}
+
+void IOWorkLoop::closeGate()
+{
+ IORecursiveLockLock(gateLock);
+}
+
+bool IOWorkLoop::tryCloseGate()
+{
+ return IORecursiveLockTryLock(gateLock) != 0;
+}
+
+int IOWorkLoop::sleepGate(void *event, UInt32 interuptibleType)
+{
+ return IORecursiveLockSleep(gateLock, event, interuptibleType);
+}
+
+void IOWorkLoop::wakeupGate(void *event, bool oneThread)
+{
+ IORecursiveLockWakeup(gateLock, event, oneThread);
+}
+
+IOReturn IOWorkLoop::runAction(Action inAction, OSObject *target,
+ void *arg0 = 0, void *arg1 = 0,
+ void *arg2 = 0, void *arg3 = 0)
+{
+ IOReturn res;
+
+ // closeGate is recursive so don't worry if we already hold the lock.
+ closeGate();
+ res = (*inAction)(target, arg0, arg1, arg2, arg3);
+ openGate();
+
+ return res;
+}
+
+IOReturn IOWorkLoop::_maintRequest(void *inC, void *inD, void *, void *)
+{
+ maintCommandEnum command = (maintCommandEnum) (vm_address_t) inC;
+ IOEventSource *inEvent = (IOEventSource *) inD;
+ IOReturn res = kIOReturnSuccess;
+
+ switch (command)
+ {
+ case mAddEvent:
+ if (!inEvent->getWorkLoop()) {
+ SETP(&fFlags, kLoopRestart);
+
+ inEvent->retain();
+ inEvent->setWorkLoop(this);
+ inEvent->setNext(0);
+
+ if (!eventChain)
+ eventChain = inEvent;
+ else {
+ IOEventSource *event, *next;
+
+ for (event = eventChain; (next = event->getNext()); event = next)
+ ;
+ event->setNext(inEvent);
+ }
+ }
+ break;
+
+ case mRemoveEvent:
+ if (inEvent->getWorkLoop()) {
+ if (eventChain == inEvent)
+ eventChain = inEvent->getNext();
+ else {
+ IOEventSource *event, *next;
+
+ event = eventChain;
+ while ((next = event->getNext()) && next != inEvent)
+ event = next;
+
+ if (!next) {
+ res = kIOReturnBadArgument;
+ break;
+ }
+ event->setNext(inEvent->getNext());
+ }
+
+ inEvent->setWorkLoop(0);
+ inEvent->setNext(0);
+ inEvent->release();
+ SETP(&fFlags, kLoopRestart);
+ }
+ break;
+
+ default:
+ return kIOReturnUnsupported;
+ }
+
+ return res;
+}