1 files changed, 1 insertions, 0 deletions
diff --git a/roms/QemuMacDrivers/shared/MacDriverUtils.c b/roms/QemuMacDrivers/shared/MacDriverUtils.c
new file mode 100644
index 000000000..3537dad0d
--- /dev/null
+++ b/roms/QemuMacDrivers/shared/MacDriverUtils.c
@@ -0,0 +1 @@
+/*
+ * Various utilities for writing a MacOS "ndrv" driver, such as device-tree
+ * helpers. These replace the various Apple sample codes whose licences
+ * are dubious and probably not suitable for GPL code
+ */
+//#include "VideoDriverPrivate.h"
+//#include "VideoDriverPrototypes.h"
+#include "logger.h"
+#include "MacDriverUtils.h"
+/* Simplified DT properties accessors */ 
+void *DTGetProp(RegEntryIDPtr		 dtNode,
+				RegPropertyNamePtr	 name,
+				RegPropertyValueSize *outSize)
+{
+	OSStatus err;
+	RegPropertyValue *v;
+	if (!outSize)
+		return NULL;
+	/* Grab size so we can allocate some memory */
+	err = RegistryPropertyGetSize(dtNode, name, outSize);
+	if (err)
+		return NULL;
+	
+	/* Allocate */
+	v = PoolAllocateResident(*outSize, FALSE);
+	if (!v)
+		return NULL;
+	
+	err = RegistryPropertyGet(dtNode, name, v, outSize);
+	if (err)
+		return NULL;
+	
+	return v;
+}
+void DTFreeProp(void *v)
+{
+	if (v)
+		PoolDeallocate(v);
+}
+/* Find a BAR logical address and size */ 
+LogicalAddress GetDeviceBARAddress(RegEntryIDPtr		dtNode,
+								   PCIRegisterNumber	barOffset,
+								   ByteCount			*size,
+								   Boolean				*isIO)
+{
+		RegPropertyValueSize	aasize, lasize;
+		LogicalAddress			*las = NULL;
+		PCIAssignedAddress		*aas = NULL;
+		LogicalAddress			result = 0;
+		UInt32 					i;
+		/* First grab assigned-addresses to find the BAR */
+		aas = DTGetProp(dtNode, kPCIAssignedAddressProperty, &aasize);
+		if (!aas)
+			return NULL;
+		aasize /= sizeof(*aas);
+		/* Then grab AAPL,addresses to get the corresponding logical addresses */
+		las = DTGetProp(dtNode, kAAPLDeviceLogicalAddress, &lasize);
+		if (!las)
+			goto bail;
+		lasize /= sizeof(LogicalAddress);
+		/* Lookup BAR */
+		for (i = 0; i < aasize; i++) {
+			struct PCIAssignedAddress *aa = aas + i;
+			/* Skip config space */
+			if (GetPCIAddressSpaceType(aa) == kPCIConfigSpace)
+				continue;
+			/* Check BAR offset */
+			if (GetPCIRegisterNumber(aa) != barOffset)
+				continue;
+			
+			/* Found it, check that it was assigned */
+			if (aa->size.hi == 0 && aa->size.lo == 0) {
+				lprintf("BAR %02x not assigned !\n");
+				goto bail;	
+			}
+			/* Check we have a logical for it */
+			if (i >= lasize) {
+				lprintf("BAR %02x missing AAPL,address property !\n");
+				goto bail;
+			}
+			/* We don't do 64-bit, sorry... */
+			if (aa->size.hi) {
+				lprintf("BAR %02x too big !\n");
+				goto bail;
+			}
+			/* Gotcha ! */
+			if (size)
+				*size = aa->size.lo;
+			if (isIO)
+				*isIO = GetPCIAddressSpaceType(aa) == kPCIIOSpace;
+			result = las[i];
+			break;
+		}
+		
+bail:
+		DTFreeProp(aas);
+		DTFreeProp(las);
+		return result;
+}
+/* PCI "Command" config register address */
+#define kPCIConfigCommandAddress	0x04
+#define cwCommandEnableMemorySpace	0x0002
+/* Enable access to PCI memory space */
+OSStatus EnablePCIMemorySpace(RegEntryIDPtr dtNode)
+{
+	OSStatus status;
+	UInt16 cmd;
+	lprintf("Reading cmd word...\n");
+	status = ExpMgrConfigReadWord(dtNode, (LogicalAddress)kPCIConfigCommandAddress, &cmd);
+	if( status )
+		return status;
+	lprintf("cmad word is: %04x, writing update...\n", cmd);
+	cmd |= cwCommandEnableMemorySpace;
+ 
+	return ExpMgrConfigWriteWord(dtNode, (LogicalAddress)kPCIConfigCommandAddress, cmd);
+}
+OSStatus SetupPCIInterrupt(RegEntryID *dtNode, IRQInfo *info,
+						   InterruptHandler handler, void *refCon)
+{
+	ISTProperty *ist;
+	RegPropertyValueSize istSize;
+	OSStatus err;
+	ist = DTGetProp(dtNode, kISTPropertyName, &istSize);
+	if (!ist) {
+		lprintf("SetupPCIInterrupt: No %s property\n", kISTPropertyName);
+		return paramErr;
+	}
+	info->interruptSetMember = (*ist)[kISTChipInterruptSource];
+	DTFreeProp(ist);
+	err = GetInterruptFunctions(info->interruptSetMember.setID,
+							    info->interruptSetMember.member,
+								&info->refCon,
+								&info->handlerFunction,
+								&info->enableFunction,
+								&info->disableFunction);
+	if (err) {
+		lprintf("SetupPCIInterrupt: Error %d getting interrupt functions\n");
+		return err;
+	}
+	err = InstallInterruptFunctions(info->interruptSetMember.setID, 
+									info->interruptSetMember.member, 
+									refCon, handler, NULL, NULL);
+	if (err) {
+		lprintf("SetupPCIInterrupt: Error %d setting interrupt functions\n");
+		return err;
+	}
+	return noErr;
+}
+\ No newline at end of file