IOPMPowerStateQueue.cpp [plain text]
#include "IOPMPowerStateQueue.h"
#include "IOKit/IOLocks.h"
#undef super
#define super IOEventSource
OSDefineMetaClassAndStructors(IOPMPowerStateQueue, IOEventSource);
#ifdef __i386__
static
void * OSDequeueAtomic(void ** inList, SInt32 inOffset)
{
void * oldListHead;
void * newListHead;
do {
oldListHead = *inList;
if (oldListHead == NULL) {
break;
}
newListHead = *(void **) (((char *) oldListHead) + inOffset);
} while (! OSCompareAndSwap((UInt32)oldListHead,
(UInt32)newListHead, (UInt32 *)inList));
return oldListHead;
}
static
void OSEnqueueAtomic(void ** inList, void * inNewLink, SInt32 inOffset)
{
void * oldListHead;
void * newListHead = inNewLink;
void ** newLinkNextPtr = (void **) (((char *) inNewLink) + inOffset);
do {
oldListHead = *inList;
*newLinkNextPtr = oldListHead;
} while (! OSCompareAndSwap((UInt32)oldListHead, (UInt32)newListHead,
(UInt32 *)inList));
}
#endif
IOPMPowerStateQueue *IOPMPowerStateQueue::PMPowerStateQueue(OSObject *inOwner)
{
IOPMPowerStateQueue *me = new IOPMPowerStateQueue;
if(me && !me->init(inOwner, 0) )
{
me->release();
return NULL;
}
return me;
}
bool IOPMPowerStateQueue::init(OSObject *owner, Action action)
{
if(!(super::init(owner, (IOEventSource::Action) action))) return false;
changes = NULL;
#ifdef __i386__
if (!(tmpLock = IOLockAlloc())) panic("IOPMPowerStateQueue::init can't alloc lock");
#endif
return true;
}
bool IOPMPowerStateQueue::unIdleOccurred(IOService *inTarget, unsigned long inState)
{
PowerChangeEntry *new_one = NULL;
new_one = (PowerChangeEntry *)IOMalloc(sizeof(PowerChangeEntry));
if(!new_one) return false;
new_one->actionType = IOPMPowerStateQueue::kUnIdle;
new_one->state = inState;
new_one->target = inTarget;
#ifdef __i386__
IOLockLock(tmpLock);
#endif
OSEnqueueAtomic((void **)&changes, (void *)new_one, 0);
#ifdef __i386__
IOLockUnlock(tmpLock);
#endif
signalWorkAvailable();
return true;
}
bool IOPMPowerStateQueue::checkForWork()
{
PowerChangeEntry *theNode;
int theState;
IOService *theTarget;
UInt16 theAction;
#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
if(changes) return true;
else return false;
}