/*
- * Copyright (c) 1998-2000 Apple Computer, Inc. All rights reserved.
+ * Copyright (c) 1998-2000, 2009-2010 Apple Inc. All rights reserved.
*
* @APPLE_OSREFERENCE_LICENSE_HEADER_START@
*
*
* @APPLE_OSREFERENCE_LICENSE_HEADER_END@
*/
+#include <libkern/OSDebug.h>
+
#include <IOKit/IOCommandGate.h>
#include <IOKit/IOWorkLoop.h>
#include <IOKit/IOReturn.h>
#include <IOKit/IOTimeStamp.h>
+#include <IOKit/IOKitDebug.h>
#define super IOEventSource
OSDefineMetaClassAndStructors(IOCommandGate, IOEventSource)
+#if __LP64__
OSMetaClassDefineReservedUnused(IOCommandGate, 0);
+#else
+OSMetaClassDefineReservedUsed(IOCommandGate, 0);
+#endif
OSMetaClassDefineReservedUnused(IOCommandGate, 1);
OSMetaClassDefineReservedUnused(IOCommandGate, 2);
OSMetaClassDefineReservedUnused(IOCommandGate, 3);
OSMetaClassDefineReservedUnused(IOCommandGate, 6);
OSMetaClassDefineReservedUnused(IOCommandGate, 7);
-bool IOCommandGate::checkForWork() { return false; }
+#if IOKITSTATS
+
+#define IOStatisticsInitializeCounter() \
+do { \
+ IOStatistics::setCounterType(IOEventSource::reserved->counter, kIOStatisticsCommandGateCounter); \
+} while (0)
+
+#define IOStatisticsActionCall() \
+do { \
+ IOStatistics::countCommandGateActionCall(IOEventSource::reserved->counter); \
+} while (0)
+
+#else
+
+#define IOStatisticsInitializeCounter()
+#define IOStatisticsActionCall()
+
+#endif /* IOKITSTATS */
bool IOCommandGate::init(OSObject *inOwner, Action inAction)
{
- return super::init(inOwner, (IOEventSource::Action) inAction);
+ bool res = super::init(inOwner, (IOEventSource::Action) inAction);
+ if (res) {
+ IOStatisticsInitializeCounter();
+ }
+
+ return res;
}
IOCommandGate *
return me;
}
-IOReturn IOCommandGate::runCommand(void *arg0, void *arg1,
- void *arg2, void *arg3)
+/* virtual */ void IOCommandGate::disable()
{
- IOReturn res;
+ if (workLoop && !workLoop->inGate())
+ OSReportWithBacktrace("IOCommandGate::disable() called when not gated");
- if (!enabled)
- return kIOReturnNotPermitted;
+ super::disable();
+}
- if (!action)
- return kIOReturnNoResources;
+/* virtual */ void IOCommandGate::enable()
+{
+ if (workLoop) {
+ closeGate();
+ super::enable();
+ wakeupGate(&enabled, /* oneThread */ false); // Unblock sleeping threads
+ openGate();
+ }
+}
+
+/* virtual */ void IOCommandGate::free()
+{
+ if (workLoop) setWorkLoop(0);
+ super::free();
+}
- // closeGate is recursive so don't worry if we already hold the lock.
- IOTimeStampConstant(IODBG_CMDQ(IOCMDQ_ACTION),
- (unsigned int) action, (unsigned int) owner);
+enum
+{
+ kSleepersRemoved = 0x00000001,
+ kSleepersWaitEnabled = 0x00000002,
+ kSleepersActions = 0x00000100,
+ kSleepersActionsMask = 0xffffff00,
+};
- closeGate();
- res = (*(Action) action)(owner, arg0, arg1, arg2, arg3);
- openGate();
+/* virtual */ void IOCommandGate::setWorkLoop(IOWorkLoop *inWorkLoop)
+{
+ IOWorkLoop * wl;
+ uintptr_t * sleepersP = (uintptr_t *) &reserved;
+ bool defer;
+
+ if (!inWorkLoop && (wl = workLoop)) { // tearing down
+ wl->closeGate();
+ *sleepersP |= kSleepersRemoved;
+ while (*sleepersP & kSleepersWaitEnabled) {
+ thread_wakeup_with_result(&enabled, THREAD_INTERRUPTED);
+ sleepGate(sleepersP, THREAD_UNINT);
+ }
+ *sleepersP &= ~kSleepersWaitEnabled;
+ defer = (0 != (kSleepersActionsMask & *sleepersP));
+ if (!defer)
+ {
+ super::setWorkLoop(0);
+ *sleepersP &= ~kSleepersRemoved;
+ }
+ wl->openGate();
+ return;
+ }
- return res;
+ super::setWorkLoop(inWorkLoop);
+}
+
+IOReturn IOCommandGate::runCommand(void *arg0, void *arg1,
+ void *arg2, void *arg3)
+{
+ return runAction((Action) action, arg0, arg1, arg2, arg3);
+}
+
+IOReturn IOCommandGate::attemptCommand(void *arg0, void *arg1,
+ void *arg2, void *arg3)
+{
+ return attemptAction((Action) action, arg0, arg1, arg2, arg3);
}
IOReturn IOCommandGate::runAction(Action inAction,
void *arg0, void *arg1,
void *arg2, void *arg3)
{
- IOReturn res;
-
- if (!enabled)
- return kIOReturnNotPermitted;
+ IOWorkLoop * wl;
+ uintptr_t * sleepersP;
if (!inAction)
return kIOReturnBadArgument;
+ if (!(wl = workLoop))
+ return kIOReturnNotReady;
- IOTimeStampConstant(IODBG_CMDQ(IOCMDQ_ACTION),
- (unsigned int) inAction, (unsigned int) owner);
-
- // closeGate is recursive so don't worry if we already hold the lock.
- closeGate();
- res = (*inAction)(owner, arg0, arg1, arg2, arg3);
- openGate();
-
- return res;
-}
+ // closeGate is recursive needn't worry if we already hold the lock.
+ wl->closeGate();
+ sleepersP = (uintptr_t *) &reserved;
-IOReturn IOCommandGate::attemptCommand(void *arg0, void *arg1,
- void *arg2, void *arg3)
-{
+ // If the command gate is disabled and we aren't on the workloop thread
+ // itself then sleep until we get enabled.
IOReturn res;
+ if (!wl->onThread())
+ {
+ while (!enabled)
+ {
+ IOReturn sleepResult = kIOReturnSuccess;
+ if (workLoop)
+ {
+ *sleepersP |= kSleepersWaitEnabled;
+ sleepResult = wl->sleepGate(&enabled, THREAD_ABORTSAFE);
+ *sleepersP &= ~kSleepersWaitEnabled;
+ }
+ bool wakeupTearDown = (!workLoop || (0 != (*sleepersP & kSleepersRemoved)));
+ if ((kIOReturnSuccess != sleepResult) || wakeupTearDown) {
+ wl->openGate();
+
+ if (wakeupTearDown)
+ wl->wakeupGate(sleepersP, false); // No further resources used
+
+ return kIOReturnAborted;
+ }
+ }
+ }
- if (!enabled)
- return kIOReturnNotPermitted;
-
- if (!action)
- return kIOReturnNoResources;
-
- // Try to hold the lock if can't get return immediately.
- if (!tryCloseGate())
- return kIOReturnCannotLock;
+ bool trace = ( gIOKitTrace & kIOTraceCommandGates ) ? true : false;
+
+ if (trace) IOTimeStampStartConstant(IODBG_CMDQ(IOCMDQ_ACTION),
+ VM_KERNEL_UNSLIDE(inAction), (uintptr_t) owner);
+
+ IOStatisticsActionCall();
+
+ // Must be gated and on the work loop or enabled
- // closeGate is recursive so don't worry if we already hold the lock.
- IOTimeStampConstant(IODBG_CMDQ(IOCMDQ_ACTION),
- (unsigned int) action, (unsigned int) owner);
+ *sleepersP += kSleepersActions;
+ res = (*inAction)(owner, arg0, arg1, arg2, arg3);
+ *sleepersP -= kSleepersActions;
- res = (*(Action) action)(owner, arg0, arg1, arg2, arg3);
- openGate();
+ if (trace) IOTimeStampEndConstant(IODBG_CMDQ(IOCMDQ_ACTION),
+ VM_KERNEL_UNSLIDE(inAction), (uintptr_t) owner);
+ if (kSleepersRemoved == ((kSleepersActionsMask|kSleepersRemoved) & *sleepersP))
+ {
+ // no actions outstanding
+ *sleepersP &= ~kSleepersRemoved;
+ super::setWorkLoop(0);
+ }
+
+ wl->openGate();
+
return res;
}
void *arg2, void *arg3)
{
IOReturn res;
-
- if (!enabled)
- return kIOReturnNotPermitted;
+ IOWorkLoop * wl;
if (!inAction)
return kIOReturnBadArgument;
+ if (!(wl = workLoop))
+ return kIOReturnNotReady;
// Try to close the gate if can't get return immediately.
- if (!tryCloseGate())
+ if (!wl->tryCloseGate())
return kIOReturnCannotLock;
- IOTimeStampConstant(IODBG_CMDQ(IOCMDQ_ACTION),
- (unsigned int) inAction, (unsigned int) owner);
+ // If the command gate is disabled then sleep until we get a wakeup
+ if (!wl->onThread() && !enabled)
+ res = kIOReturnNotPermitted;
+ else {
+
+ bool trace = ( gIOKitTrace & kIOTraceCommandGates ) ? true : false;
+
+ if (trace)
+ IOTimeStampStartConstant(IODBG_CMDQ(IOCMDQ_ACTION),
+ VM_KERNEL_UNSLIDE(inAction), (uintptr_t) owner);
+
+ IOStatisticsActionCall();
+
+ res = (*inAction)(owner, arg0, arg1, arg2, arg3);
+
+ if (trace)
+ IOTimeStampEndConstant(IODBG_CMDQ(IOCMDQ_ACTION),
+ VM_KERNEL_UNSLIDE(inAction), (uintptr_t) owner);
+ }
- res = (*inAction)(owner, arg0, arg1, arg2, arg3);
- openGate();
+ wl->openGate();
return res;
}
return sleepGate(event, interruptible);
}
+IOReturn IOCommandGate::commandSleep(void *event, AbsoluteTime deadline, UInt32 interruptible)
+{
+ if (!workLoop->inGate())
+ return kIOReturnNotPermitted;
+
+ return sleepGate(event, deadline, interruptible);
+}
+
void IOCommandGate::commandWakeup(void *event, bool oneThread)
{
wakeupGate(event, oneThread);