xnu-1228.5.20.tar.gz

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

diff --git a/iokit/Kernel/IOPMPowerStateQueue.cpp b/iokit/Kernel/IOPMPowerStateQueue.cpp
index 8f976a9dbcb20384b80bedebd691c36b48dedeb5..dee1aff49e092f487b985a07428d8a0c1bf9946a 100644 (file)
--- a/iokit/Kernel/IOPMPowerStateQueue.cpp
+++ b/iokit/Kernel/IOPMPowerStateQueue.cpp
@@ -1,30 +1,74 @@
 /*
  * Copyright (c) 2001-2002 Apple Computer, Inc. All rights reserved.
  *
 /*
  * Copyright (c) 2001-2002 Apple Computer, Inc. All rights reserved.
  *

- * @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
+ * @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

  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,

- * 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@
+ * 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@

  */
  
 #include "IOPMPowerStateQueue.h"
  */
  
 #include "IOPMPowerStateQueue.h"

+#include "IOKit/IOLocks.h"

 #undef super
 #define super IOEventSource
 OSDefineMetaClassAndStructors(IOPMPowerStateQueue, IOEventSource);
 
 #undef super
 #define super IOEventSource
 OSDefineMetaClassAndStructors(IOPMPowerStateQueue, IOEventSource);
 

+#ifndef __ppc__ /* ppc does this right and doesn't need these routines */
+static
+void * OSDequeueAtomic(void * volatile * inList, SInt32 inOffset)
+{      
+       /* The _pointer_ is volatile, not the listhead itself */
+       void * volatile oldListHead;
+       void * volatile newListHead;
+
+       do {
+               oldListHead = *inList;
+               if (oldListHead == NULL) {
+                       break;
+               }
+               
+               newListHead = *(void * volatile *) (((char *) oldListHead) + inOffset);
+       } while (! OSCompareAndSwap((UInt32)oldListHead,
+                                       (UInt32)newListHead, (volatile UInt32 *)inList));
+       return oldListHead;
+}
+
+static
+void   OSEnqueueAtomic(void * volatile * inList, void * inNewLink, SInt32 inOffset)
+{
+       /* The _pointer_ is volatile, not the listhead itself */
+       void *  volatile oldListHead;
+       void *  volatile newListHead = inNewLink;
+       void * volatile *       newLinkNextPtr = (void * volatile *) (((char *) inNewLink) + inOffset);
+
+       do {
+               oldListHead = *inList;
+               *newLinkNextPtr = oldListHead;
+       } while (! OSCompareAndSwap((UInt32)oldListHead, (UInt32)newListHead,
+                                       (volatile UInt32 *)inList));
+}
+#endif /* ! __ppc__ */
+
+

 IOPMPowerStateQueue *IOPMPowerStateQueue::PMPowerStateQueue(OSObject *inOwner)
 {
     IOPMPowerStateQueue     *me = new IOPMPowerStateQueue;
 IOPMPowerStateQueue *IOPMPowerStateQueue::PMPowerStateQueue(OSObject *inOwner)
 {
     IOPMPowerStateQueue     *me = new IOPMPowerStateQueue;


@@ -44,7 +88,9 @@ bool IOPMPowerStateQueue::init(OSObject *owner, Action action)
 
     // Queue of powerstate changes
     changes = NULL;
 
     // Queue of powerstate changes
     changes = NULL;

-
+#ifndef __ppc__
+    if (!(tmpLock = IOLockAlloc()))  panic("IOPMPowerStateQueue::init can't alloc lock");
+#endif

     return true;
 }
 
     return true;
 }
 


@@ -61,24 +107,62 @@ bool IOPMPowerStateQueue::unIdleOccurred(IOService *inTarget, unsigned long inSt
     new_one->target = inTarget;
     
     // Change to queue
     new_one->target = inTarget;
     
     // Change to queue

+#ifndef __ppc__
+    IOLockLock(tmpLock);
+#endif

     OSEnqueueAtomic((void **)&changes, (void *)new_one, 0);
     OSEnqueueAtomic((void **)&changes, (void *)new_one, 0);

+#ifndef __ppc__
+    IOLockUnlock(tmpLock);
+#endif
+    signalWorkAvailable();
+
+    return true;
+}
+
+bool IOPMPowerStateQueue::featureChangeOccurred(
+    uint32_t inState, 
+    IOService *inTarget)
+{
+    PowerChangeEntry             *new_one = NULL;
+
+    new_one = (PowerChangeEntry *)IOMalloc(sizeof(PowerChangeEntry));
+    if(!new_one) return false;

     
     

+    new_one->actionType = IOPMPowerStateQueue::kPMFeatureChange;
+    new_one->state = inState;
+    new_one->target = inTarget;
+    
+    // Change to queue
+#ifdef __i386__
+    IOLockLock(tmpLock);
+#endif
+    OSEnqueueAtomic((void **)&changes, (void *)new_one, 0);
+#ifdef __i386__
+    IOLockUnlock(tmpLock);
+#endif

     signalWorkAvailable();
 
     return true;
 }
 
     signalWorkAvailable();
 
     return true;
 }
 

+

 // checkForWork() is called in a gated context
 bool IOPMPowerStateQueue::checkForWork()
 {
     PowerChangeEntry            *theNode;
 // checkForWork() is called in a gated context
 bool IOPMPowerStateQueue::checkForWork()
 {
     PowerChangeEntry            *theNode;

-    int                         theState;
+    uint32_t                    theState;

     IOService                   *theTarget;
     IOService                   *theTarget;

-    UInt16                      theAction;
+    uint16_t                    theAction;

     
     // Dequeue and process the state change request
     
     // Dequeue and process the state change request

+#ifndef __ppc__
+    IOLockLock(tmpLock);
+#endif

     if((theNode = (PowerChangeEntry *)OSDequeueAtomic((void **)&changes, 0)))
     {
     if((theNode = (PowerChangeEntry *)OSDequeueAtomic((void **)&changes, 0)))
     {

+#ifndef __ppc__
+      IOLockUnlock(tmpLock);
+#endif

         theState = theNode->state;
         theTarget = theNode->target;
         theAction = theNode->actionType;
         theState = theNode->state;
         theTarget = theNode->target;
         theAction = theNode->actionType;


@@ -87,11 +171,19 @@ bool IOPMPowerStateQueue::checkForWork()
         switch (theAction)
         {
             case kUnIdle:
         switch (theAction)
         {
             case kUnIdle:

-                theTarget->command_received(theState, 0, 0, 0);
+                theTarget->command_received((void *)theState, 0, 0, 0);
+                break;
+                
+            case kPMFeatureChange:
+                theTarget->messageClients(theState, theTarget);

                 break;
         }
     }
                 break;
         }
     }

-
+#ifndef __ppc__
+    else {
+      IOLockUnlock(tmpLock);
+    }
+#endif

     // Return true if there's more work to be done
     if(changes) return true;
     else return false;
     // Return true if there's more work to be done
     if(changes) return true;
     else return false;