Loading...
--- xnu/xnu-3248.50.21/iokit/Kernel/IODeviceTreeSupport.cpp
+++ xnu/xnu-1228.0.2/iokit/Kernel/IODeviceTreeSupport.cpp
@@ -37,16 +37,12 @@
#include <pexpert/device_tree.h>
-typedef UInt32 dtptr_t;
-
-#include <machine/machine_routines.h>
-
extern "C" {
-
-int IODTGetLoaderInfo( const char *key, void **infoAddr, int *infosize );
-void IODTFreeLoaderInfo( const char *key, void *infoAddr, int infoSize );
-int IODTGetDefault(const char *key, void *infoAddr, unsigned int infoSize );
-
+ #include <machine/machine_routines.h>
+ void DTInit( void * data );
+
+ int IODTGetLoaderInfo( char *key, void **infoAddr, int *infosize );
+ void IODTFreeLoaderInfo( char *key, void *infoAddr, int infoSize );
}
#include <IOKit/assert.h>
@@ -63,7 +59,6 @@
const OSSymbol * gIODTCompatibleKey;
const OSSymbol * gIODTTypeKey;
const OSSymbol * gIODTModelKey;
-const OSSymbol * gIODTTargetTypeKey;
const OSSymbol * gIODTSizeCellKey;
const OSSymbol * gIODTAddressCellKey;
@@ -96,6 +91,7 @@
DTEntry mapEntry;
OSArray * stack;
OSData * prop;
+ OSObject * obj;
OSDictionary * allInts;
vm_offset_t * dtMap;
unsigned int propSize;
@@ -109,7 +105,6 @@
gIODTCompatibleKey = OSSymbol::withCStringNoCopy( "compatible" );
gIODTTypeKey = OSSymbol::withCStringNoCopy( "device_type" );
gIODTModelKey = OSSymbol::withCStringNoCopy( "model" );
- gIODTTargetTypeKey = OSSymbol::withCStringNoCopy( "target-type" );
gIODTSizeCellKey = OSSymbol::withCStringNoCopy( "#size-cells" );
gIODTAddressCellKey = OSSymbol::withCStringNoCopy( "#address-cells" );
gIODTRangeKey = OSSymbol::withCStringNoCopy( "ranges" );
@@ -149,7 +144,7 @@
freeDT = (kSuccess == DTLookupEntry( 0, "/chosen/memory-map", &mapEntry ))
&& (kSuccess == DTGetProperty( mapEntry,
"DeviceTree", (void **) &dtMap, &propSize ))
- && ((2 * sizeof(uint32_t)) == propSize);
+ && ((2 * sizeof(vm_offset_t)) == propSize);
parent = MakeReferenceTable( (DTEntry)dtTop, freeDT );
@@ -198,7 +193,7 @@
// free original device tree
DTInit(0);
IODTFreeLoaderInfo( "DeviceTree",
- (void *)dtMap[0], (int) round_page(dtMap[1]) );
+ (void *)dtMap[0], round_page_32(dtMap[1]) );
}
// adjust tree
@@ -215,6 +210,22 @@
if( !intMap && child->getProperty( gIODTInterruptParentKey))
intMap = true;
+ // Look for a "driver,AAPL,MacOSX,PowerPC" property.
+ if( (obj = child->getProperty( "driver,AAPL,MacOSX,PowerPC"))) {
+ gIOCatalogue->addExtensionsFromArchive((OSData *)obj);
+ child->removeProperty( "driver,AAPL,MacOSX,PowerPC");
+ }
+
+ // some gross pruning
+ child->removeProperty( "lanLib,AAPL,MacOS,PowerPC");
+
+ if( (obj = child->getProperty( "driver,AAPL,MacOS,PowerPC"))) {
+
+ if( (0 == (prop = (OSData *)child->getProperty( gIODTTypeKey )))
+ || (strncmp("display", (char *)prop->getBytesNoCopy(), sizeof("display"))) ) {
+ child->removeProperty( "driver,AAPL,MacOS,PowerPC");
+ }
+ }
}
regIter->release();
}
@@ -251,11 +262,11 @@
return( parent);
}
-int IODTGetLoaderInfo( const char *key, void **infoAddr, int *infoSize )
+int IODTGetLoaderInfo( char *key, void **infoAddr, int *infoSize )
{
IORegistryEntry *chosen;
OSData *propObj;
- dtptr_t *propPtr;
+ unsigned int *propPtr;
unsigned int propSize;
chosen = IORegistryEntry::fromPath( "/chosen/memory-map", gIODTPlane );
@@ -265,18 +276,18 @@
if ( propObj == 0 ) return -1;
propSize = propObj->getLength();
- if ( propSize != (2 * sizeof(dtptr_t)) ) return -1;
+ if ( propSize != (2 * sizeof(UInt32)) ) return -1;
- propPtr = (dtptr_t *)propObj->getBytesNoCopy();
+ propPtr = (unsigned int *)propObj->getBytesNoCopy();
if ( propPtr == 0 ) return -1;
- *infoAddr = (void *)(uintptr_t) (propPtr[0]);
- *infoSize = (int) (propPtr[1]);
+ *infoAddr = (void *)propPtr[0] ;
+ *infoSize = (int) propPtr[1];
return 0;
}
-void IODTFreeLoaderInfo( const char *key, void *infoAddr, int infoSize )
+void IODTFreeLoaderInfo( char *key, void *infoAddr, int infoSize )
{
vm_offset_t range[2];
IORegistryEntry *chosen;
@@ -293,31 +304,15 @@
}
}
-int IODTGetDefault(const char *key, void *infoAddr, unsigned int infoSize )
-{
- IORegistryEntry *defaults;
- OSData *defaultObj;
- unsigned int defaultSize;
-
- defaults = IORegistryEntry::fromPath( "/defaults", gIODTPlane );
- if ( defaults == 0 ) return -1;
-
- defaultObj = OSDynamicCast( OSData, defaults->getProperty(key) );
- if ( defaultObj == 0 ) return -1;
-
- defaultSize = defaultObj->getLength();
- if ( defaultSize > infoSize) return -1;
-
- memcpy( infoAddr, defaultObj->getBytesNoCopy(), defaultSize );
-
- return 0;
-}
-
static void FreePhysicalMemory( vm_offset_t * range )
{
vm_offset_t virt;
+#if defined (__i386__)
+ virt = ml_boot_ptovirt( range[0] );
+#else
virt = ml_static_ptovirt( range[0] );
+#endif
if( virt) {
ml_static_mfree( virt, range[1] );
}
@@ -388,7 +383,7 @@
} else if(noLocation && (!strncmp(name, "reg", sizeof("reg")))) {
// default location - override later
- snprintf(location, sizeof(location), "%X", *((uint32_t *) prop));
+ snprintf(location, sizeof(location), "%lX", *((UInt32 *) prop));
regEntry->setLocation( location );
}
}
@@ -440,21 +435,15 @@
return( false );
}
-static IORegistryEntry * IODTFindInterruptParent( IORegistryEntry * regEntry, IOItemCount index )
+IORegistryEntry * IODTFindInterruptParent( IORegistryEntry * regEntry )
{
IORegistryEntry * parent;
UInt32 phandle;
- OSData * data;
- unsigned int len;
-
- if( (data = OSDynamicCast( OSData, regEntry->getProperty( gIODTInterruptParentKey )))
- && (sizeof(UInt32) <= (len = data->getLength()))) {
- if (((index + 1) * sizeof(UInt32)) > len)
- index = 0;
- phandle = ((UInt32 *) data->getBytesNoCopy())[index];
- parent = FindPHandle( phandle );
-
- } else if( 0 == regEntry->getProperty( "interrupt-controller"))
+
+ if( GetUInt32( regEntry, gIODTInterruptParentKey, &phandle))
+ parent = FindPHandle( phandle );
+
+ else if( 0 == regEntry->getProperty( "interrupt-controller"))
parent = regEntry->getParentEntry( gIODTPlane);
else
parent = 0;
@@ -473,7 +462,7 @@
assert( ok );
if( ok) {
- snprintf(buf, sizeof(buf), "IOInterruptController%08X", (uint32_t)phandle);
+ snprintf(buf, sizeof(buf), "IOInterruptController%08lX", phandle);
sym = OSSymbol::withCString( buf );
} else
sym = 0;
@@ -492,8 +481,8 @@
*aCellCount = 0;
}
-static UInt32 IODTMapOneInterrupt( IORegistryEntry * regEntry, UInt32 * intSpec, UInt32 index,
- OSData ** spec, const OSSymbol ** controller )
+UInt32 IODTMapOneInterrupt( IORegistryEntry * regEntry, UInt32 * intSpec,
+ OSData ** spec, const OSSymbol ** controller )
{
IORegistryEntry *parent = 0;
OSData *data;
@@ -505,7 +494,7 @@
UInt32 i, original_icells;
bool cmp, ok = false;
- parent = IODTFindInterruptParent( regEntry, index );
+ parent = IODTFindInterruptParent( regEntry );
IODTGetICellCounts( parent, &icells, &acells );
addrCmp = 0;
if( acells) {
@@ -651,12 +640,11 @@
OSData * local2;
UInt32 * localBits;
UInt32 * localEnd;
- IOItemCount index;
OSData * map;
OSObject * oneMap;
OSArray * mapped;
OSArray * controllerInts;
- const OSSymbol * controller = 0;
+ const OSSymbol * controller;
OSArray * controllers;
UInt32 skip = 1;
bool ok, nw;
@@ -678,7 +666,6 @@
localBits = (UInt32 *) local->getBytesNoCopy();
localEnd = localBits + (local->getLength() / sizeof(UInt32));
- index = 0;
mapped = OSArray::withCapacity( 1 );
controllers = OSArray::withCapacity( 1 );
@@ -686,7 +673,7 @@
if( ok) do {
if( nw) {
- skip = IODTMapOneInterrupt( regEntry, localBits, index, &map, &controller );
+ skip = IODTMapOneInterrupt( regEntry, localBits, &map, &controller );
if( 0 == skip) {
IOLog("%s: error mapping interrupt[%d]\n",
regEntry->getName(), mapped->getCount());
@@ -699,7 +686,6 @@
controller->retain();
}
- index++;
localBits += skip;
mapped->setObject( map );
controllers->setObject( controller );
@@ -780,7 +766,6 @@
OSString *string;
const char *ckey;
UInt32 keyLen;
- UInt32 nlen;
const char *names;
const char *lastName;
bool wild;
@@ -805,16 +790,16 @@
do {
// for each name in the property
- nlen = strnlen(names, lastName - names);
if( wild)
- matched = ((nlen >= (keyLen - 1)) && (0 == strncmp(ckey, names, keyLen - 1)));
+ matched = (0 == strncmp( ckey, names, keyLen - 1 ));
else
- matched = (keyLen == nlen) && (0 == strncmp(ckey, names, keyLen));
+ matched = (keyLen == strlen( names ))
+ && (0 == strncmp( ckey, names, keyLen ));
if( matched)
result = names;
- names = names + nlen + 1;
+ names = names + strlen( names) + 1;
} while( (names < lastName) && (false == matched));
@@ -851,7 +836,7 @@
result = regEntry->compareNames( obj );
obj->release();
}
-#if DEBUG
+#ifdef DEBUG
else IOLog("Couldn't unserialize %s\n", keys );
#endif
@@ -902,7 +887,7 @@
}
cIter = OSCollectionIterator::withCollection( result);
- if (result) result->release();
+ result->release();
return( cIter);
}
@@ -926,44 +911,15 @@
if( !prop)
return;
- prop->setSerializable(false);
regEntry->setProperty( gIODTPersistKey, prop);
prop->release();
return;
}
-#if defined(__arm__) || defined(__i386__) || defined(__x86_64__)
static SInt32 DefaultCompare( UInt32 cellCount, UInt32 left[], UInt32 right[] )
{
- cellCount--;
- return( left[ cellCount ] - right[ cellCount ] );
-}
-#else
-#error Unknown architecture.
-#endif
-
-static void AddLengthToCells( UInt32 numCells, UInt32 *cells, UInt64 offset)
-{
- if (numCells == 1)
- {
- cells[0] += (UInt32)offset;
- }
- else {
- UInt64 sum = cells[numCells - 1] + offset;
- cells[numCells - 1] = (UInt32)sum;
- if (sum > UINT32_MAX) {
- cells[numCells - 2] += (UInt32)(sum >> 32);
- }
- }
-}
-
-static IOPhysicalAddress CellsValue( UInt32 numCells, UInt32 *cells)
-{
- if (numCells == 1) {
- return IOPhysical32( 0, cells[0] );
- } else {
- return IOPhysical32( cells[numCells - 2], cells[numCells - 1] );
- }
+ cellCount--;
+ return( left[ cellCount ] - right[ cellCount ] );
}
void IODTGetCellCounts( IORegistryEntry * regEntry,
@@ -984,7 +940,7 @@
bool IODTResolveAddressCell( IORegistryEntry * regEntry,
UInt32 cellsIn[],
- IOPhysicalAddress * phys, IOPhysicalLength * lenOut )
+ IOPhysicalAddress * phys, IOPhysicalLength * len )
{
IORegistryEntry *parent;
OSData *prop;
@@ -993,16 +949,14 @@
// cells in addresses below regEntry
UInt32 childSizeCells, childAddressCells;
UInt32 childCells;
- UInt32 cell[ 8 ], propLen;
- UInt64 offset = 0;
- UInt32 endCell[ 8 ];
+ UInt32 cell[ 5 ], offset = 0, length;
+ UInt32 endCell[ 5 ];
UInt32 *range;
UInt32 *lookRange;
UInt32 *startRange;
UInt32 *endRanges;
bool ok = true;
- SInt64 diff, diff2, endDiff;
- UInt64 len, rangeLen;
+ SInt32 diff, diff2, endDiff;
IODTPersistent *persist;
IODTCompareAddressCellFunc compare;
@@ -1010,109 +964,91 @@
IODTGetCellCounts( regEntry, &childSizeCells, &childAddressCells );
childCells = childAddressCells + childSizeCells;
- if (childCells > sizeof(cell)/sizeof(cell[0]))
- panic("IODTResolveAddressCell: Invalid device tree (%u,%u)", (uint32_t)childAddressCells, (uint32_t)childSizeCells);
-
bcopy( cellsIn, cell, sizeof(UInt32) * childCells );
- *lenOut = CellsValue( childSizeCells, cellsIn + childAddressCells );
+ if( childSizeCells > 1)
+ *len = IOPhysical32( cellsIn[ childAddressCells ],
+ cellsIn[ childAddressCells + 1 ] );
+ else
+ *len = IOPhysical32( 0, cellsIn[ childAddressCells ] );
do
{
- prop = OSDynamicCast( OSData, regEntry->getProperty( gIODTRangeKey ));
- if( 0 == prop) {
- /* end of the road */
- *phys = CellsValue( childAddressCells, cell );
- *phys += offset;
- break;
- }
-
- parent = regEntry->getParentEntry( gIODTPlane );
- IODTGetCellCounts( parent, &sizeCells, &addressCells );
-
- if( (propLen = prop->getLength())) {
- // search
- startRange = (UInt32 *) prop->getBytesNoCopy();
- range = startRange;
- endRanges = range + (propLen / sizeof(UInt32));
-
- prop = (OSData *) regEntry->getProperty( gIODTPersistKey );
- if( prop) {
- persist = (IODTPersistent *) prop->getBytesNoCopy();
- compare = persist->compareFunc;
- } else if (addressCells == childAddressCells) {
- compare = DefaultCompare;
- } else {
- panic("There is no mixed comparison function yet...");
- }
-
- for( ok = false;
- range < endRanges;
- range += (childCells + addressCells) ) {
-
- // is cell start within range?
- diff = (*compare)( childAddressCells, cell, range );
-
- if (childAddressCells > sizeof(endCell)/sizeof(endCell[0]))
- panic("IODTResolveAddressCell: Invalid device tree (%u)", (uint32_t)childAddressCells);
-
- bcopy(range, endCell, childAddressCells * sizeof(UInt32));
-
- rangeLen = CellsValue(childSizeCells, range + childAddressCells + addressCells);
- AddLengthToCells(childAddressCells, endCell, rangeLen);
-
- diff2 = (*compare)( childAddressCells, cell, endCell );
-
- // if start of cell < start of range, or end of range >= start of cell, skip
- if ((diff < 0) || (diff2 >= 0))
- continue;
-
- len = CellsValue(childSizeCells, cell + childAddressCells);
- ok = (0 == len);
-
- if (!ok)
- {
- // search for cell end
- bcopy(cell, endCell, childAddressCells * sizeof(UInt32));
-
- AddLengthToCells(childAddressCells, endCell, len - 1);
-
- for( lookRange = startRange;
- lookRange < endRanges;
- lookRange += (childCells + addressCells) )
- {
- // make sure end of cell >= range start
- endDiff = (*compare)( childAddressCells, endCell, lookRange );
- if( endDiff < 0)
- continue;
-
- UInt64 rangeStart = CellsValue(addressCells, range + childAddressCells);
- UInt64 lookRangeStart = CellsValue(addressCells, lookRange + childAddressCells);
- if ((endDiff - len + 1 + lookRangeStart) == (diff + rangeStart))
- {
- ok = true;
- break;
- }
- }
- if (!ok)
- continue;
- }
- offset += diff;
- break;
- }
-
- if (addressCells + sizeCells > sizeof(cell)/sizeof(cell[0]))
- panic("IODTResolveAddressCell: Invalid device tree (%u, %u)", (uint32_t)addressCells, (uint32_t)sizeCells);
-
- // Get the physical start of the range from our parent
- bcopy( range + childAddressCells, cell, sizeof(UInt32) * addressCells );
- bzero( cell + addressCells, sizeof(UInt32) * sizeCells );
-
- } /* else zero length range => pass thru to parent */
-
- regEntry = parent;
- childSizeCells = sizeCells;
- childAddressCells = addressCells;
- childCells = childAddressCells + childSizeCells;
+ prop = OSDynamicCast( OSData, regEntry->getProperty( gIODTRangeKey ));
+ if( 0 == prop) {
+ /* end of the road */
+ *phys = IOPhysical32( 0, cell[ childAddressCells - 1 ] + offset);
+ break;
+ }
+
+ parent = regEntry->getParentEntry( gIODTPlane );
+ IODTGetCellCounts( parent, &sizeCells, &addressCells );
+
+ if( (length = prop->getLength())) {
+ // search
+ startRange = (UInt32 *) prop->getBytesNoCopy();
+ range = startRange;
+ endRanges = range + (length / sizeof(UInt32));
+
+ prop = (OSData *) regEntry->getProperty( gIODTPersistKey );
+ if( prop) {
+ persist = (IODTPersistent *) prop->getBytesNoCopy();
+ compare = persist->compareFunc;
+ } else
+ compare = DefaultCompare;
+
+ for( ok = false;
+ range < endRanges;
+ range += (childCells + addressCells) ) {
+
+ // is cell start within range?
+ diff = (*compare)( childAddressCells, cell, range );
+
+ bcopy(range, endCell, childAddressCells * sizeof(UInt32));
+ endCell[childAddressCells - 1] += range[childCells + addressCells - 1];
+ diff2 = (*compare)( childAddressCells, cell, endCell );
+
+ if ((diff < 0) || (diff2 >= 0))
+ continue;
+
+ ok = (0 == cell[childCells - 1]);
+ if (!ok)
+ {
+ // search for cell end
+ bcopy(cell, endCell, childAddressCells * sizeof(UInt32));
+ endCell[childAddressCells - 1] += cell[childCells - 1] - 1;
+ lookRange = startRange;
+ for( ;
+ lookRange < endRanges;
+ lookRange += (childCells + addressCells) )
+ {
+ // is cell >= range start?
+ endDiff = (*compare)( childAddressCells, endCell, lookRange );
+ if( endDiff < 0)
+ continue;
+ if ((endDiff - cell[childCells - 1] + 1 + lookRange[childAddressCells + addressCells - 1])
+ == (diff + range[childAddressCells + addressCells - 1]))
+ {
+ ok = true;
+ break;
+ }
+ }
+ if (!ok)
+ continue;
+ }
+ offset += diff;
+ break;
+ }
+
+ // Get the physical start of the range from our parent
+ bcopy( range + childAddressCells, cell, sizeof(UInt32) * addressCells );
+ bzero( cell + addressCells, sizeof(UInt32) * sizeCells );
+
+ } /* else zero length range => pass thru to parent */
+
+ regEntry = parent;
+ childSizeCells = sizeCells;
+ childAddressCells = addressCells;
+ childCells = childAddressCells + childSizeCells;
}
while( ok && regEntry);
@@ -1156,7 +1092,7 @@
range = 0;
if( parent)
range = IODeviceMemory::withSubRange( parent,
- phys - parent->getPhysicalSegment(0, 0, kIOMemoryMapperNone), len );
+ phys - parent->getPhysicalAddress(), len );
if( 0 == range)
range = IODeviceMemory::withRange( phys, len );
if( range)
@@ -1244,7 +1180,6 @@
OSData *ret = 0;
UInt32 *bits;
UInt32 i;
- size_t nlen;
char *names;
char *lastName;
UInt32 mask;
@@ -1272,16 +1207,15 @@
for( i = 0; (i <= deviceNumber) && (names < lastName); i++ ) {
if( mask & (1 << i)) {
- nlen = 1 + strnlen(names, lastName - names);
if( i == deviceNumber) {
- data = OSData::withBytesNoCopy(names, nlen);
+ data = OSData::withBytesNoCopy( names, 1 + strlen( names));
if( data) {
regEntry->setProperty("AAPL,slot-name", data);
ret = data;
data->release();
}
} else
- names += nlen;
+ names += 1 + strlen( names);
}
}