--- xnu/xnu-12377.101.15/iokit/Kernel/IOPMPowerStateQueue.cpp
+++ xnu/xnu-792.13.8/iokit/Kernel/IOPMPowerStateQueue.cpp
@@ -1,105 +1,159 @@
 /*
  * Copyright (c) 2001-2002 Apple Computer, Inc. All rights reserved.
  *
- * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
+ * @APPLE_LICENSE_OSREFERENCE_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.
  *
- * 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.
  *
- * 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,
- * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
- * Please see the License for the specific language governing rights and
+ * 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, 
+ * 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@
+ * @APPLE_LICENSE_OSREFERENCE_HEADER_END@
  */
+ 
+#include "IOPMPowerStateQueue.h"
+#include "IOKit/IOLocks.h"
+#undef super
+#define super IOEventSource
+OSDefineMetaClassAndStructors(IOPMPowerStateQueue, IOEventSource);
 
-#include "IOPMPowerStateQueue.h"
+#ifdef __i386__ /* ppc does this right and doesn't need these routines */
+static
+void *	OSDequeueAtomic(void ** inList, SInt32 inOffset)
+{
+	void *	oldListHead;
+	void *	newListHead;
 
-#define super IOEventSource
-OSDefineMetaClassAndStructors( IOPMPowerStateQueue, IOEventSource )
-
-IOPMPowerStateQueue * IOPMPowerStateQueue::PMPowerStateQueue(
-	OSObject * inOwner, Action inAction )
-{
-	IOPMPowerStateQueue * me = new IOPMPowerStateQueue;
-
-	if (me && !me->init(inOwner, inAction)) {
-		me->release();
-		return NULL;
-	}
-
-	return me;
+	do {
+		oldListHead = *inList;
+		if (oldListHead == NULL) {
+			break;
+		}
+		
+		newListHead = *(void **) (((char *) oldListHead) + inOffset);
+	} while (! OSCompareAndSwap((UInt32)oldListHead,
+					(UInt32)newListHead, (UInt32 *)inList));
+	return oldListHead;
 }
 
-bool
-IOPMPowerStateQueue::init( OSObject * inOwner, Action inAction )
+static
+void	OSEnqueueAtomic(void ** inList, void * inNewLink, SInt32 inOffset)
 {
-	if (!inAction || !(super::init(inOwner, inAction))) {
-		return false;
-	}
+	void *	oldListHead;
+	void *	newListHead = inNewLink;
+	void **	newLinkNextPtr = (void **) (((char *) inNewLink) + inOffset);
 
-	queue_init( &queueHead );
+	do {
+		oldListHead = *inList;
+		*newLinkNextPtr = oldListHead;
+	} while (! OSCompareAndSwap((UInt32)oldListHead, (UInt32)newListHead,
+					(UInt32 *)inList));
+}
+#endif /* __i386__ */
 
-	queueLock = IOLockAlloc();
-	if (!queueLock) {
-		return false;
-	}
 
-	return true;
+IOPMPowerStateQueue *IOPMPowerStateQueue::PMPowerStateQueue(OSObject *inOwner)
+{
+    IOPMPowerStateQueue     *me = new IOPMPowerStateQueue;
+
+    if(me && !me->init(inOwner, 0) )
+    {
+        me->release();
+        return NULL;
+    }
+
+    return me;
 }
 
-bool
-IOPMPowerStateQueue::submitPowerEvent(
-	uint32_t eventType,
-	void *   arg0,
-	uint64_t arg1 )
+bool IOPMPowerStateQueue::init(OSObject *owner, Action action)
 {
-	PowerEventEntry * entry;
+    if(!(super::init(owner, (IOEventSource::Action) action))) return false;
 
-	entry = IOMallocType(PowerEventEntry);
-
-	entry->eventType = eventType;
-	entry->arg0 = arg0;
-	entry->arg1 = arg1;
-
-	IOLockLock(queueLock);
-	queue_enter(&queueHead, entry, PowerEventEntry *, chain);
-	IOLockUnlock(queueLock);
-	signalWorkAvailable();
-
-	return true;
+    // Queue of powerstate changes
+    changes = NULL;
+#ifdef __i386__
+    if (!(tmpLock = IOLockAlloc()))  panic("IOPMPowerStateQueue::init can't alloc lock");
+#endif
+    return true;
 }
 
-bool
-IOPMPowerStateQueue::checkForWork( void )
+
+bool IOPMPowerStateQueue::unIdleOccurred(IOService *inTarget, unsigned long inState)
 {
-	IOPMPowerStateQueueAction queueAction = (IOPMPowerStateQueueAction) action;
-	PowerEventEntry * entry;
+    PowerChangeEntry             *new_one = NULL;
 
-	IOLockLock(queueLock);
-	while (!queue_empty(&queueHead)) {
-		queue_remove_first(&queueHead, entry, PowerEventEntry *, chain);
-		IOLockUnlock(queueLock);
+    new_one = (PowerChangeEntry *)IOMalloc(sizeof(PowerChangeEntry));
+    if(!new_one) return false;
+    
+    new_one->actionType = IOPMPowerStateQueue::kUnIdle;
+    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();
 
-		(*queueAction)(owner, entry->eventType, entry->arg0, entry->arg1);
-		IOFreeType(entry, PowerEventEntry);
+    return true;
+}
 
-		IOLockLock(queueLock);
-	}
-	IOLockUnlock(queueLock);
-
-	return false;
+// checkForWork() is called in a gated context
+bool IOPMPowerStateQueue::checkForWork()
+{
+    PowerChangeEntry            *theNode;
+    int                         theState;
+    IOService                   *theTarget;
+    UInt16                      theAction;
+    
+    // Dequeue and process the state change request
+#ifdef __i386__
+    IOLockLock(tmpLock);
+#endif
+    if((theNode = (PowerChangeEntry *)OSDequeueAtomic((void **)&changes, 0)))
+    {
+#ifdef __i386__
+      IOLockUnlock(tmpLock);
+#endif
+        theState = theNode->state;
+        theTarget = theNode->target;
+        theAction = theNode->actionType;
+        IOFree((void *)theNode, sizeof(PowerChangeEntry));
+        
+        switch (theAction)
+        {
+            case kUnIdle:
+                theTarget->command_received((void *)theState, 0, 0, 0);
+                break;
+        }
+    }
+#ifdef __i386__
+    else {
+      IOLockUnlock(tmpLock);
+    }
+#endif
+    // Return true if there's more work to be done
+    if(changes) return true;
+    else return false;
 }