xnu-344.tar.gz

[apple/xnu.git] / iokit / Kernel / IOWorkLoop.cpp

diff --git a/iokit/Kernel/IOWorkLoop.cpp b/iokit/Kernel/IOWorkLoop.cpp
index 99205ee243f0bdb5bcf64450e6ce932f67aa3793..197a095126cc47ca6e8bec16d2f6ab3ec5c29bb5 100644 (file)
--- a/iokit/Kernel/IOWorkLoop.cpp
+++ b/iokit/Kernel/IOWorkLoop.cpp
@@ -37,7 +37,8 @@ HISTORY
 OSDefineMetaClassAndStructors(IOWorkLoop, OSObject);
 
 // Block of unused functions intended for future use
 OSDefineMetaClassAndStructors(IOWorkLoop, OSObject);
 
 // Block of unused functions intended for future use

-OSMetaClassDefineReservedUnused(IOWorkLoop, 0);
+OSMetaClassDefineReservedUsed(IOWorkLoop, 0);
+

 OSMetaClassDefineReservedUnused(IOWorkLoop, 1);
 OSMetaClassDefineReservedUnused(IOWorkLoop, 2);
 OSMetaClassDefineReservedUnused(IOWorkLoop, 3);
 OSMetaClassDefineReservedUnused(IOWorkLoop, 1);
 OSMetaClassDefineReservedUnused(IOWorkLoop, 2);
 OSMetaClassDefineReservedUnused(IOWorkLoop, 3);


@@ -56,6 +57,8 @@ static inline bool ISSETP(void *addr, unsigned int flag)
 
 #define fFlags loopRestart
 
 
 #define fFlags loopRestart
 

+extern "C" extern void stack_privilege( thread_t thread);
+

 void IOWorkLoop::launchThreadMain(void *self)
 {
     register thread_t mythread = current_thread();
 void IOWorkLoop::launchThreadMain(void *self)
 {
     register thread_t mythread = current_thread();


@@ -297,13 +300,8 @@ void IOWorkLoop::threadMain()
            assert_wait((void *) &workToDo, false);
            IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
 
            assert_wait((void *) &workToDo, false);
            IOSimpleLockUnlockEnableInterrupt(workToDoLock, is);
 

-#if defined (__i386__)
-           thread_block(0);
-           continue;
-#else

            thread_set_cont_arg((int) this);
            thread_block(&threadMainContinuation);
            thread_set_cont_arg((int) this);
            thread_block(&threadMainContinuation);

-#endif

            /* NOTREACHED */
        }
 
            /* NOTREACHED */
        }
 


@@ -320,7 +318,7 @@ void IOWorkLoop::threadMain()
 exitThread:
     workThread = 0;    // Say we don't have a loop and free ourselves
     free();
 exitThread:
     workThread = 0;    // Say we don't have a loop and free ourselves
     free();

-    IOExitThread(0);
+    IOExitThread();

 }
 
 IOThread IOWorkLoop::getThread() const
 }
 
 IOThread IOWorkLoop::getThread() const


@@ -374,6 +372,20 @@ void IOWorkLoop::wakeupGate(void *event, bool oneThread)
     IORecursiveLockWakeup(gateLock, event, 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;
 IOReturn IOWorkLoop::_maintRequest(void *inC, void *inD, void *, void *)
 {
     maintCommandEnum command = (maintCommandEnum) (vm_address_t) inC;


@@ -383,43 +395,48 @@ IOReturn IOWorkLoop::_maintRequest(void *inC, void *inD, void *, void *)
     switch (command)
     {
     case mAddEvent:
     switch (command)
     {
     case mAddEvent:

-       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);
+        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:
         }
         break;
 
     case mRemoveEvent:

-        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;
+        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());

             }
             }

-            event->setNext(inEvent->getNext());
+    
+            inEvent->setWorkLoop(0);
+            inEvent->setNext(0);
+            inEvent->release();
+            SETP(&fFlags, kLoopRestart);

         }
         }

-
-        inEvent->setWorkLoop(0);
-        inEvent->setNext(0);
-        inEvent->release();
-       SETP(&fFlags, kLoopRestart);

         break;
 
     default:
         break;
 
     default: