#include <sys/cdefs.h>
__BEGIN_DECLS
#include <ppc/proc_reg.h>
#include <ppc/machine_routines.h>
__END_DECLS
#include <IOKit/IODeviceTreeSupport.h>
#include <IOKit/IOPlatformExpert.h>
#include <IOKit/IOCPU.h>
#include <IOKit/pci/IOPCIBridge.h>
#include <IOKit/pwr_mgt/RootDomain.h>
#include "MacRISC2CPU.h"
#define kMacRISC_GPIO_DIRECTION_BIT 2
#define super IOCPU
OSDefineMetaClassAndStructors(MacRISC2CPU, IOCPU);
static IOCPUInterruptController *gCPUIC;
bool MacRISC2CPU::start(IOService *provider)
{
kern_return_t result;
IORegistryEntry *cpusRegEntry, *uniNRegEntry, *mpicRegEntry, *devicetreeRegEntry;
OSIterator *cpusIterator;
OSData *tmpData;
IOService *service;
const OSSymbol *interruptControllerName;
OSData *interruptData;
OSArray *tmpArray;
UInt32 maxCPUs, uniNVersion, physCPU;
ml_processor_info_t processor_info;
mpic_getProvider = OSSymbol::withCString("mpic_getProvider");
mpic_getIPIVector= OSSymbol::withCString("mpic_getIPIVector");
mpic_setCurrentTaskPriority = OSSymbol::withCString("mpic_setCurrentTaskPriority");
mpic_setUpForSleep = OSSymbol::withCString("mpic_setUpForSleep");
mpic_dispatchIPI = OSSymbol::withCString("mpic_dispatchIPI");
keyLargo_restoreRegisterState = OSSymbol::withCString("keyLargo_restoreRegisterState");
keyLargo_syncTimeBase = OSSymbol::withCString("keyLargo_syncTimeBase");
keyLargo_saveRegisterState = OSSymbol::withCString("keyLargo_saveRegisterState");
keyLargo_turnOffIO = OSSymbol::withCString("keyLargo_turnOffIO");
keyLargo_writeRegUInt8 = OSSymbol::withCString("keyLargo_writeRegUInt8");
keyLargo_getHostKeyLargo = OSSymbol::withCString("keyLargo_getHostKeyLargo");
keyLargo_setPowerSupply = OSSymbol::withCString("setPowerSupply");
UniNSetPowerState = OSSymbol::withCString(kUniNSetPowerState);
macRISC2PE = OSDynamicCast(MacRISC2PE, getPlatform());
if (macRISC2PE == 0) return false;
if (!super::start(provider)) return false;
uniNRegEntry = fromPath("/uni-n", gIODTPlane);
if (uniNRegEntry == 0) return false;
tmpData = OSDynamicCast(OSData, uniNRegEntry->getProperty("device-rev"));
if (tmpData == 0) return false;
uniNVersion = *(long *)tmpData->getBytesNoCopy();
numCPUs = 0;
cpusRegEntry = fromPath("/cpus", gIODTPlane);
if (cpusRegEntry == 0) return false;
cpusIterator = cpusRegEntry->getChildIterator(gIODTPlane);
while (cpusIterator->getNextObject()) numCPUs++;
cpusIterator->release();
if (uniNVersion < kUniNVersion107) numCPUs = 1;
if (PE_parse_boot_arg("cpus", &maxCPUs))
{
if (numCPUs > maxCPUs) numCPUs = maxCPUs;
}
doSleep = false;
flushOnLock = false;
cpusRegEntry = fromPath("/cpus/@0", gIODTPlane);
if (cpusRegEntry == 0) return false;
if (cpusRegEntry->getProperty("flush-on-lock") != 0) flushOnLock = true;
if (numCPUs != 1) flushOnLock = true;
devicetreeRegEntry = fromPath("/", gIODTPlane);
tmpData = OSDynamicCast(OSData, devicetreeRegEntry->getProperty("model"));
if (tmpData == 0) return false;
#if 0
if(!strcmp((char *)tmpData->getBytesNoCopy(), "PowerMac3,5"))
flushOnLock = true;
#endif
tmpData = OSDynamicCast(OSData, provider->getProperty("reg"));
if (tmpData == 0) return false;
physCPU = *(long *)tmpData->getBytesNoCopy();
setCPUNumber(physCPU);
tmpData = OSDynamicCast(OSData, provider->getProperty("soft-reset"));
if (tmpData == 0)
{
if (physCPU == 0)
soft_reset_offset = 0x5B;
else
soft_reset_offset = 0x5C;
}
else
soft_reset_offset = *(long *)tmpData->getBytesNoCopy();
tmpData = OSDynamicCast(OSData, provider->getProperty("timebase-enable"));
if (tmpData == 0)
timebase_enable_offset = 0x73;
else
timebase_enable_offset = *(long *)tmpData->getBytesNoCopy();
needVSetting = (provider->getProperty( "vmin" ) != 0);
bootCPU = false;
tmpData = OSDynamicCast(OSData, provider->getProperty("state"));
if (tmpData == 0) return false;
if (!strcmp((char *)tmpData->getBytesNoCopy(), "running")) bootCPU = true;
if (bootCPU)
{
gCPUIC = new IOCPUInterruptController;
if (gCPUIC == 0) return false;
if (gCPUIC->initCPUInterruptController(numCPUs) != kIOReturnSuccess)
return false;
gCPUIC->attach(this);
gCPUIC->registerCPUInterruptController();
}
tmpData = OSDynamicCast(OSData, provider->getProperty("l2cr"));
if (tmpData != 0)
{
l2crValue = *(long *)tmpData->getBytesNoCopy() & 0x7FFFFFFF;
}
else
{
l2crValue = mfl2cr() & 0x7FFFFFFF;
}
keyLargo = waitForService(serviceMatching("KeyLargo"));
if (keyLargo == 0) return false;
keyLargo->callPlatformFunction (keyLargo_getHostKeyLargo, false, &keyLargo, 0, 0, 0);
if (keyLargo == 0)
{
kprintf ("MacRISC2CPU::start - getHostKeyLargo returned nil\n");
return false;
}
mpic = waitForService(serviceMatching("AppleMPICInterruptController"));
if (mpic == 0) return false;
mpic->callPlatformFunction(mpic_getProvider, false, (void *)&mpicRegEntry, 0, 0, 0);
interruptControllerName = IODTInterruptControllerName(mpicRegEntry);
mpic->callPlatformFunction(mpic_getIPIVector, false, (void *)&physCPU, (void *)&interruptData, 0, 0);
if ((interruptControllerName == 0) || (interruptData == 0)) return false;
tmpArray = OSArray::withCapacity(1);
tmpArray->setObject(interruptControllerName);
cpuNub->setProperty(gIOInterruptControllersKey, tmpArray);
tmpArray->release();
tmpArray = OSArray::withCapacity(1);
tmpArray->setObject(interruptData);
cpuNub->setProperty(gIOInterruptSpecifiersKey, tmpArray);
tmpArray->release();
setCPUState(kIOCPUStateUninitalized);
if (physCPU < numCPUs)
{
processor_info.cpu_id = (cpu_id_t)this;
processor_info.boot_cpu = bootCPU;
processor_info.start_paddr = 0x0100;
processor_info.l2cr_value = l2crValue;
processor_info.supports_nap = !flushOnLock;
processor_info.time_base_enable =
(time_base_enable_t)&MacRISC2CPU::enableCPUTimeBase;
result = ml_processor_register(&processor_info, &machProcessor, &ipi_handler);
if (result == KERN_FAILURE) return false;
processor_start(machProcessor);
}
service = waitForService(serviceMatching("IOPMrootDomain"));
pmRootDomain = OSDynamicCast(IOPMrootDomain, service);
if (pmRootDomain != 0)
{
kprintf("Register MacRISC2CPU %d to acknowledge power changes\n", getCPUNumber());
pmRootDomain->registerInterestedDriver(this);
PMinit();
provider->joinPMtree(this);
}
if (macRISC2PE->ioPMonNub) {
service = waitForService(resourceMatching("IOPlatformMonitor"));
ioPMon = OSDynamicCast (IOPlatformMonitor, service->getProperty("IOPlatformMonitor"));
if (!ioPMon)
return false;
ioPMonDict = OSDictionary::withCapacity(2);
if (!ioPMonDict) {
ioPMon = NULL;
} else {
ioPMonDict->setObject (kIOPMonTypeKey, OSSymbol::withCString (kIOPMonTypeCPUCon));
ioPMonDict->setObject (kIOPMonCPUIDKey, OSNumber::withNumber ((long long)getCPUNumber(), 32));
if (messageClient (kIOPMonMessageRegister, ioPMon, (void *)ioPMonDict) != kIOReturnSuccess) {
IOLog ("MacRISC2CPU::start - failed to register cpu with IOPlatformMonitor\n");
ioPMonDict->release();
ioPMon = NULL;
}
}
}
registerService();
pmu = waitForService(serviceMatching("ApplePMU"));
uniN = waitForService(serviceMatching("AppleUniN"));
if ((pmu == 0) || (uniN == 0)) return false;
uniN->callPlatformFunction ("setupUATAforSleep", false, (void *)0, (void *)0, (void *)0, (void *)0);
return true;
}
IOReturn MacRISC2CPU::powerStateWillChangeTo ( IOPMPowerFlags theFlags, unsigned long, IOService*)
{
if ( ! (theFlags & IOPMPowerOn) ) {
kprintf("MacRISC2CPU %d powerStateWillChangeTo to acknowledge power changes (DOWN) we set napping %d\n", getCPUNumber(), false);
rememberNap = ml_enable_nap(getCPUNumber(), false);
if (macRISC2PE->processorSpeedChangeFlags & kProcessorBasedSpeedChange &&
!(macRISC2PE->processorSpeedChangeFlags & kProcessorFast)) {
setAggressiveness (kPMSetProcessorSpeed, 0); macRISC2PE->processorSpeedChangeFlags &= ~kProcessorFast; }
} else {
kprintf("MacRISC2CPU %d powerStateWillChangeTo to acknowledge power changes (UP) we set napping %d\n", getCPUNumber(), rememberNap);
ml_enable_nap(getCPUNumber(), rememberNap);
if (!ioPMon && (macRISC2PE->processorSpeedChangeFlags & kEnvironmentalSpeedChange)) {
if (macRISC2PE->processorSpeedChangeFlags & kProcessorFast) {
macRISC2PE->processorSpeedChangeFlags &= ~kProcessorFast; setAggressiveness (kPMSetProcessorSpeed, 0); } else
doSleep = true; }
if (macRISC2PE->processorSpeedChangeFlags & kProcessorBasedSpeedChange &&
!(macRISC2PE->processorSpeedChangeFlags & kProcessorFast)) {
macRISC2PE->processorSpeedChangeFlags |= kProcessorFast; setAggressiveness (kPMSetProcessorSpeed, 1); }
}
return IOPMAckImplied;
}
IOReturn MacRISC2CPU::setAggressiveness(UInt32 selector, UInt32 newLevel)
{
bool doChange = false;
IOReturn result;
result = super::setAggressiveness(selector, newLevel);
if ((selector == kPMSetProcessorSpeed) && (macRISC2PE->processorSpeedChangeFlags != kNoSpeedChange)) {
if (ioPMon) {
if (newLevel < 2)
return result;
newLevel -= 2;
doChange = true; }
if (doSleep) {
IOSleep (1000);
doSleep = false;
}
if (macRISC2PE->processorSpeedChangeFlags & kDisableL2SpeedChange) {
if (!(macRISC2PE->processorSpeedChangeFlags & kClamshellClosedSpeedChange)) {
if (!newLevel) {
if (!(macRISC2PE->processorSpeedChangeFlags & kL2CacheEnabled)) {
ml_enable_cache_level(2, !newLevel);
macRISC2PE->processorSpeedChangeFlags |= kL2CacheEnabled;
}
} else if (macRISC2PE->processorSpeedChangeFlags & kL2CacheEnabled) {
ml_enable_cache_level(2, !newLevel);
macRISC2PE->processorSpeedChangeFlags &= ~kL2CacheEnabled;
}
}
}
if (macRISC2PE->processorSpeedChangeFlags & kDisableL3SpeedChange) {
if (!(macRISC2PE->processorSpeedChangeFlags & kClamshellClosedSpeedChange)) {
if (!newLevel) {
if (!(macRISC2PE->processorSpeedChangeFlags & kL3CacheEnabled)) {
ml_enable_cache_level(3, !newLevel);
macRISC2PE->processorSpeedChangeFlags |= kL3CacheEnabled;
}
} else if (macRISC2PE->processorSpeedChangeFlags & kL3CacheEnabled) {
ml_enable_cache_level(3, !newLevel);
macRISC2PE->processorSpeedChangeFlags &= ~kL3CacheEnabled;
}
}
}
if (!newLevel) {
if (!(macRISC2PE->processorSpeedChangeFlags & kProcessorFast)) {
doChange = true;
macRISC2PE->processorSpeedChangeFlags |= kProcessorFast;
}
} else if (macRISC2PE->processorSpeedChangeFlags & kProcessorFast) {
doChange = true;
macRISC2PE->processorSpeedChangeFlags &= ~kProcessorFast;
}
if (macRISC2PE->processorSpeedChangeFlags & kPMUBasedSpeedChange) {
if (doChange)
performPMUSpeedChange (newLevel);
}
if (macRISC2PE->processorSpeedChangeFlags & kProcessorBasedSpeedChange && doChange) {
IOReturn cpfResult = kIOReturnSuccess;
if (newLevel == 0)
cpfResult = keyLargo->callPlatformFunction (keyLargo_setPowerSupply, false,
(void *)1, (void *)0, (void *)0, (void *)0);
if (cpfResult == kIOReturnSuccess) {
if (needVSetting && (newLevel == 0))
ml_set_processor_voltage(0);
ml_set_processor_speed(newLevel ? 1 : 0);
if (needVSetting && (newLevel != 0))
ml_set_processor_voltage(1);
if (newLevel != 0)
cpfResult = keyLargo->callPlatformFunction (keyLargo_setPowerSupply, false,
(void *)0, (void *)0, (void *)0, (void *)0);
}
}
}
return result;
}
void MacRISC2CPU::performPMUSpeedChange (UInt32 newLevel)
{
bool tempRememberNap;
currentProcessorSpeed = newLevel;
tempRememberNap = ml_enable_nap(getCPUNumber(), false);
processorSpeedChange = true;
pmRootDomain->receivePowerNotification(kIOPMProcessorSpeedChange);
processorSpeedChange = false;
ml_enable_nap(getCPUNumber(), tempRememberNap);
return;
}
void MacRISC2CPU::initCPU(bool boot)
{
OSIterator *childIterator;
IORegistryEntry *childEntry, *childDriver;
IOPCIBridge *pciDriver;
OSData *deviceTypeString;
if (!boot && bootCPU) {
uniN->callPlatformFunction (UniNSetPowerState, false, (void *)kUniNNormal,
(void *)0, (void *)0, (void *)0);
if (!processorSpeedChange) {
if ((childIterator = macRISC2PE->getChildIterator (gIOServicePlane)) != NULL) {
while ((childEntry = (IORegistryEntry *)(childIterator->getNextObject ())) != NULL) {
deviceTypeString = OSDynamicCast( OSData, childEntry->getProperty( "device_type" ));
if (deviceTypeString) {
if (!strcmp((const char *)deviceTypeString->getBytesNoCopy(), "pci")) {
childDriver = childEntry->copyChildEntry(gIOServicePlane);
if (childDriver) {
pciDriver = OSDynamicCast( IOPCIBridge, childDriver );
if (pciDriver)
pciDriver->setDevicePowerState (NULL, 3);
childDriver->release();
}
}
}
}
childIterator->release();
}
keyLargo->callPlatformFunction(keyLargo_restoreRegisterState, false, 0, 0, 0, 0);
if (macRISC2PE->getMachineType() == kMacRISC2TypePowerMac)
{
kprintf("MacRISC2CPU::initCPU %d -> mpic->setUpForSleep on", getCPUNumber());
mpic->callPlatformFunction(mpic_setUpForSleep, false, (void *)false, (void *)getCPUNumber(), 0, 0);
}
}
}
kprintf("MacRISC2CPU::initCPU %d Here!\n", getCPUNumber());
if (bootCPU)
keyLargo->callPlatformFunction(keyLargo_syncTimeBase, false, 0, 0, 0, 0);
if (boot)
{
gCPUIC->enableCPUInterrupt(this);
cpuNub->registerInterrupt(0, this, (IOInterruptAction)&MacRISC2CPU::ipiHandler, 0);
cpuNub->enableInterrupt(0);
}
else
{
long priority = 0;
mpic->callPlatformFunction(mpic_setCurrentTaskPriority, false, (void *)&priority, 0, 0, 0);
}
setCPUState(kIOCPUStateRunning);
}
void MacRISC2CPU::quiesceCPU(void)
{
if (bootCPU)
{
if (processorSpeedChange) {
pmu->callPlatformFunction("setSpeedNow", false, (void *)currentProcessorSpeed, 0, 0, 0);
} else {
pmu->callPlatformFunction("sleepNow", false, 0, 0, 0, 0);
if (macRISC2PE->getMachineType() == kMacRISC2TypePowerMac)
{
kprintf("MacRISC2CPU::quiesceCPU %d -> mpic->setUpForSleep off", getCPUNumber());
mpic->callPlatformFunction(mpic_setUpForSleep, false, (void *)true, (void *)getCPUNumber(), 0, 0);
}
kprintf("MacRISC2CPU::quiesceCPU %d -> keyLargo->saveRegisterState()\n", getCPUNumber());
keyLargo->callPlatformFunction(keyLargo_saveRegisterState, false, 0, 0, 0, 0);
kprintf("MacRISC2CPU::quiesceCPU %d -> keyLargo->turnOffIO", getCPUNumber());
keyLargo->callPlatformFunction(keyLargo_turnOffIO, false, (void *)false, 0, 0, 0);
}
kprintf("MacRISC2CPU::quiesceCPU %d -> here\n", getCPUNumber());
ml_phys_write(0x0080, 0x100);
uniN->callPlatformFunction (UniNSetPowerState, false,
(void *)(processorSpeedChange ? kUniNIdle2 : kUniNSleep),
(void *)0, (void *)0, (void *)0);
}
ml_ppc_sleep();
}
kern_return_t MacRISC2CPU::startCPU(vm_offset_t , vm_offset_t )
{
long gpioOffset = soft_reset_offset;
unsigned long strobe_value;
strobe_value = ( 1 << kMacRISC_GPIO_DIRECTION_BIT );
keyLargo->callPlatformFunction(keyLargo_writeRegUInt8, false,
(void *)&gpioOffset, (void *)strobe_value, 0, 0);
strobe_value = ( 0 << kMacRISC_GPIO_DIRECTION_BIT );
keyLargo->callPlatformFunction(keyLargo_writeRegUInt8, false,
(void *)&gpioOffset, (void *)strobe_value, 0, 0);
return KERN_SUCCESS;
}
void MacRISC2CPU::haltCPU(void)
{
OSIterator *childIterator;
IORegistryEntry *childEntry, *childDriver;
IOPCIBridge *pciDriver;
OSData *deviceTypeString;
setCPUState(kIOCPUStateStopped);
if (bootCPU)
{
if ((childIterator = macRISC2PE->getChildIterator (gIOServicePlane)) != NULL) {
while ((childEntry = (IORegistryEntry *)(childIterator->getNextObject ())) != NULL) {
deviceTypeString = OSDynamicCast( OSData, childEntry->getProperty( "device_type" ));
if (deviceTypeString) {
if (!strcmp((const char *)deviceTypeString->getBytesNoCopy(), "pci")) {
childDriver = childEntry->copyChildEntry(gIOServicePlane);
if (childDriver) {
pciDriver = OSDynamicCast( IOPCIBridge, childDriver );
if (pciDriver)
pciDriver->setDevicePowerState (NULL, 2);
childDriver->release();
}
}
}
}
childIterator->release();
}
}
kprintf("MacRISC2CPU::haltCPU %d Here!\n", getCPUNumber());
processor_exit(machProcessor);
}
void MacRISC2CPU::signalCPU(IOCPU *target)
{
UInt32 physCPU = getCPUNumber();
MacRISC2CPU *targetCPU = OSDynamicCast(MacRISC2CPU, target);
if (targetCPU == 0) return;
mpic->callPlatformFunction(mpic_dispatchIPI, false, (void *)&physCPU, (void *)(1 << targetCPU->getCPUNumber()), 0, 0);
}
void MacRISC2CPU::enableCPUTimeBase(bool enable)
{
long gpioOffset = timebase_enable_offset;
unsigned long value;
#if 0
if ( enable )
{
keyLargo->callPlatformFunction(keyLargo_safeReadRegUInt8, false, (void *)&gpioOffset, (void *)&value,
(void *)0, (void *)0);
value = ( 0 << kMacRISC_GPIO_DIRECTION_BIT ); keyLargo->callPlatformFunction(keyLargo_writeRegUInt8, false, (void *)&gpioOffset, (void *)value,
(void *)0, (void *)0);
}
else {
keyLargo->callPlatformFunction(keyLargo_safeReadRegUInt8, false,
(void *)&gpioOffset, (void *)&value, (void *)0, (void *)0);
value &= ~ 0x01; keyLargo->callPlatformFunction(keyLargo_writeRegUInt8, false, (void *)&gpioOffset, (void *)value,
(void *)0, (void *)0);
value |= ( 1 << kMacRISC_GPIO_DIRECTION_BIT ); keyLargo->callPlatformFunction(keyLargo_writeRegUInt8, false, (void *)&gpioOffset, (void *)value,
(void *)0, (void *)0);
sync();
}
#endif
value = ( enable )? ( 0 << kMacRISC_GPIO_DIRECTION_BIT ) : ( 1 << kMacRISC_GPIO_DIRECTION_BIT ); keyLargo->callPlatformFunction( keyLargo_writeRegUInt8, false,
(void *)&gpioOffset, (void *)value, (void *)0, (void *)0);
if ( ! enable ) sync();
}
void MacRISC2CPU::ipiHandler(void *refCon, void *nub, int source)
{
if (ipi_handler) ipi_handler();
}
const OSSymbol *MacRISC2CPU::getCPUName(void)
{
char tmpStr[256];
sprintf(tmpStr, "Primary%ld", getCPUNumber());
return OSSymbol::withCString(tmpStr);
}