IOPMPowerStateQueue.cpp [plain text]
#include "IOPMPowerStateQueue.h"
#include "IOKit/IOLocks.h"
#undef super
#define super IOEventSource
OSDefineMetaClassAndStructors(IOPMPowerStateQueue, IOEventSource);
#ifndef __ppc__
static
void * OSDequeueAtomic(void * volatile * inList, SInt32 inOffset)
{
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)
{
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
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;
#ifndef __ppc__
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;
#ifndef __ppc__
IOLockLock(tmpLock);
#endif
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;
#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;
uint32_t theState;
IOService *theTarget;
uint16_t theAction;
#ifndef __ppc__
IOLockLock(tmpLock);
#endif
if((theNode = (PowerChangeEntry *)OSDequeueAtomic((void **)&changes, 0)))
{
#ifndef __ppc__
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;
case kPMFeatureChange:
theTarget->messageClients(theState, theTarget);
break;
}
}
#ifndef __ppc__
else {
IOLockUnlock(tmpLock);
}
#endif
if(changes) return true;
else return false;
}