X-Git-Url: https://git.saurik.com/apple/xnu.git/blobdiff_plain/21362eb3e66fd2c787aee132bce100a44d71a99c..7e41aa883dd258f888d0470250eead40a53ef1f5:/iokit/Kernel/IOMapper.cpp diff --git a/iokit/Kernel/IOMapper.cpp b/iokit/Kernel/IOMapper.cpp index 5efde78f9..8f2b35992 100644 --- a/iokit/Kernel/IOMapper.cpp +++ b/iokit/Kernel/IOMapper.cpp @@ -27,7 +27,14 @@ */ #include #include +#include #include +#include +#include "IOKitKernelInternal.h" + +__BEGIN_DECLS +extern ppnum_t pmap_find_phys(pmap_t pmap, addr64_t va); +__END_DECLS #define super IOService OSDefineMetaClassAndAbstractStructors(IOMapper, IOService); @@ -67,12 +74,15 @@ static IOMapperLock sMapperLock; bool IOMapper::start(IOService *provider) { + OSObject * obj; if (!super::start(provider)) return false; if (!initHardware(provider)) return false; + fPageSize = getPageSize(); + if (fIsSystem) { sMapperLock.lock(); IOMapper::gSystem = this; @@ -80,25 +90,19 @@ bool IOMapper::start(IOService *provider) sMapperLock.unlock(); } + if (provider) + { + obj = provider->getProperty("iommu-id"); + if (!obj) + obj = provider->getProperty("AAPL,phandle"); + if (obj) + setProperty(gIOMapperIDKey, obj); + } return true; } -bool IOMapper::allocTable(IOByteCount size) -{ - assert(!fTable); - - fTableSize = size; - fTableHandle = NewARTTable(size, &fTable, &fTablePhys); - return fTableHandle != 0; -} - void IOMapper::free() { - if (fTableHandle) { - FreeARTTable(fTableHandle, fTableSize); - fTableHandle = 0; - } - super::free(); } @@ -117,117 +121,58 @@ void IOMapper::setMapperRequired(bool hasMapper) void IOMapper::waitForSystemMapper() { sMapperLock.lock(); - while ((vm_address_t) IOMapper::gSystem & kWaitMask) + while ((uintptr_t) IOMapper::gSystem & kWaitMask) + { + OSReportWithBacktrace("waitForSystemMapper"); sMapperLock.sleep(&IOMapper::gSystem); + } sMapperLock.unlock(); } -void IOMapper::iovmInsert(ppnum_t addr, IOItemCount offset, - ppnum_t *pageList, IOItemCount pageCount) -{ - while (pageCount--) - iovmInsert(addr, offset++, *pageList++); -} - -void IOMapper::iovmInsert(ppnum_t addr, IOItemCount offset, - upl_page_info_t *pageList, IOItemCount pageCount) -{ - for (IOItemCount i = 0; i < pageCount; i++) - iovmInsert(addr, offset + i, pageList[i].phys_addr); -} - -struct ARTTableData { - void *v; - upl_t u[0]; -}; -#define getARTDataP(data) ((ARTTableData *) (data)->getBytesNoCopy()) - -OSData * -IOMapper::NewARTTable(IOByteCount size, - void ** virtAddrP, ppnum_t *physAddrP) +IOMapper * IOMapper::copyMapperForDevice(IOService * device) { - OSData *ret; - kern_return_t kr; - vm_address_t startUpl; - ARTTableData *dataP; - unsigned int dataSize; - upl_page_info_t *pl = 0; - - // Each UPL can deal with about one meg at the moment - size = round_page_32(size); - dataSize = sizeof(ARTTableData) + sizeof(upl_t) * size / (1024 * 1024); - ret = OSData::withCapacity(dataSize); - if (!ret) - return 0; - - // Append 0's to the buffer, in-other-words reset to nulls. - ret->appendBytes(NULL, sizeof(ARTTableData)); - dataP = getARTDataP(ret); - - kr = kmem_alloc_contig(kernel_map, &startUpl, size, PAGE_MASK, 0); - if (kr) - return 0; - - dataP->v = (void *) startUpl; - - do { - upl_t iopl; - int upl_flags = UPL_SET_INTERNAL | UPL_SET_LITE - | UPL_SET_IO_WIRE | UPL_COPYOUT_FROM; - vm_size_t iopl_size = size; - - kr = vm_map_get_upl(kernel_map, - (vm_map_offset_t)startUpl, - &iopl_size, - &iopl, - 0, - 0, - &upl_flags, - 0); - if (kr) { - panic("IOMapper:vm_map_get_upl returned 0x%x\n"); - goto bail; - } - - if (!ret->appendBytes(&iopl, sizeof(upl_t))) - goto bail; - - startUpl += iopl_size; - size -= iopl_size; - } while(size); - - // Need to re-establish the dataP as the OSData may have grown. - dataP = getARTDataP(ret); - - // Now grab the page entry of the first page and get its phys addr - pl = UPL_GET_INTERNAL_PAGE_LIST(dataP->u[0]); - *physAddrP = pl->phys_addr; - *virtAddrP = dataP->v; - - return ret; - -bail: - FreeARTTable(ret, size); - return 0; + return copyMapperForDeviceWithIndex(device, 0); } -void IOMapper::FreeARTTable(OSData *artHandle, IOByteCount size) +IOMapper * IOMapper::copyMapperForDeviceWithIndex(IOService * device, unsigned int index) { - assert(artHandle); - - ARTTableData *dataP = getARTDataP(artHandle); - - int numupls = ((artHandle->getLength() - sizeof(*dataP)) / sizeof(upl_t)); - for (int i = 0; i < numupls; i++) { - upl_abort(dataP->u[i], 0); - upl_deallocate(dataP->u[i]); + OSData *data; + OSObject * obj; + IOMapper * mapper = NULL; + OSDictionary * matching; + + obj = device->copyProperty("iommu-parent"); + if (!obj) + return (NULL); + + if ((mapper = OSDynamicCast(IOMapper, obj))) + return (mapper); + + if ((data = OSDynamicCast(OSData, obj))) + { + if (index >= data->getLength() / sizeof(UInt32)) + goto done; + + data = OSData::withBytesNoCopy((UInt32 *)data->getBytesNoCopy() + index, sizeof(UInt32)); + if (!data) + goto done; + + matching = IOService::propertyMatching(gIOMapperIDKey, data); + data->release(); } + else + matching = IOService::propertyMatching(gIOMapperIDKey, obj); - if (dataP->v) { - size = round_page_32(size); - kmem_free(kernel_map, (vm_address_t) dataP->v, size); + if (matching) + { + mapper = OSDynamicCast(IOMapper, IOService::waitForMatchingService(matching)); + matching->release(); } - artHandle->release(); + +done: + if (obj) + obj->release(); + return (mapper); } __BEGIN_DECLS @@ -235,54 +180,40 @@ __BEGIN_DECLS // These are C accessors to the system mapper for non-IOKit clients ppnum_t IOMapperIOVMAlloc(unsigned pages) { + IOReturn ret; + uint64_t dmaAddress, dmaLength; + IOMapper::checkForSystemMapper(); + ret = kIOReturnUnsupported; if (IOMapper::gSystem) - return IOMapper::gSystem->iovmAlloc((IOItemCount) pages); - else - return 0; + { + ret = IOMapper::gSystem->iovmMapMemory( + NULL, 0, ptoa_64(pages), + (kIODMAMapReadAccess | kIODMAMapWriteAccess), + NULL, NULL, NULL, + &dmaAddress, &dmaLength); + } + + if (kIOReturnSuccess == ret) return (atop_64(dmaAddress)); + return (0); } void IOMapperIOVMFree(ppnum_t addr, unsigned pages) { if (IOMapper::gSystem) - IOMapper::gSystem->iovmFree(addr, (IOItemCount) pages); -} - -ppnum_t IOMapperInsertPage(ppnum_t addr, unsigned offset, ppnum_t page) -{ - if (IOMapper::gSystem) { - IOMapper::gSystem->iovmInsert(addr, (IOItemCount) offset, page); - return addr + offset; + { + IOMapper::gSystem->iovmUnmapMemory(NULL, NULL, ptoa_64(addr), ptoa_64(pages)); } - else - return page; -} - -void IOMapperInsertPPNPages(ppnum_t addr, unsigned offset, - ppnum_t *pageList, unsigned pageCount) -{ - if (!IOMapper::gSystem) - panic("IOMapperInsertPPNPages no system mapper"); - else - assert(!((vm_address_t) IOMapper::gSystem & 3)); - - IOMapper::gSystem-> - iovmInsert(addr, (IOItemCount) offset, pageList, pageCount); } -void IOMapperInsertUPLPages(ppnum_t addr, unsigned offset, - upl_page_info_t *pageList, unsigned pageCount) +ppnum_t IOMapperInsertPage(ppnum_t addr, unsigned offset, ppnum_t page) { - if (!IOMapper::gSystem) - panic("IOMapperInsertUPLPages no system mapper"); - else - assert(!((vm_address_t) IOMapper::gSystem & 3)); - - IOMapper::gSystem->iovmInsert(addr, - (IOItemCount) offset, - pageList, - (IOItemCount) pageCount); + if (!IOMapper::gSystem) return (page); + if (!addr) panic("!addr"); + IOMapper::gSystem->iovmInsert((kIODMAMapReadAccess | kIODMAMapWriteAccess), + ptoa_64(addr), ptoa_64(offset), ptoa_64(page), ptoa_64(1)); + return (addr + offset); } ///////////////////////////////////////////////////////////////////////////// @@ -300,7 +231,7 @@ UInt8 IOMappedRead8(IOPhysicalAddress address) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); return (UInt8) ml_phys_read_byte_64(addr); } else @@ -312,7 +243,7 @@ UInt16 IOMappedRead16(IOPhysicalAddress address) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); return (UInt16) ml_phys_read_half_64(addr); } else @@ -324,7 +255,7 @@ UInt32 IOMappedRead32(IOPhysicalAddress address) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); return (UInt32) ml_phys_read_word_64(addr); } else @@ -336,7 +267,7 @@ UInt64 IOMappedRead64(IOPhysicalAddress address) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); return (UInt64) ml_phys_read_double_64(addr); } else @@ -348,7 +279,7 @@ void IOMappedWrite8(IOPhysicalAddress address, UInt8 value) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); ml_phys_write_byte_64(addr, value); } else @@ -360,7 +291,7 @@ void IOMappedWrite16(IOPhysicalAddress address, UInt16 value) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); ml_phys_write_half_64(addr, value); } else @@ -372,7 +303,7 @@ void IOMappedWrite32(IOPhysicalAddress address, UInt32 value) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); ml_phys_write_word_64(addr, value); } else @@ -384,7 +315,7 @@ void IOMappedWrite64(IOPhysicalAddress address, UInt64 value) IOMapper::checkForSystemMapper(); if (IOMapper::gSystem) { - addr64_t addr = IOMapper::gSystem->mapAddr(address); + addr64_t addr = IOMapper::gSystem->mapToPhysicalAddress(address); ml_phys_write_double_64(addr, value); } else