--- SheepShaver/src/rom_patches.cpp	2004/12/16 22:59:38	1.38
+++ SheepShaver/src/rom_patches.cpp	2006/05/06 10:30:00	1.43
@@ -1,7 +1,7 @@
 /*
  *  rom_patches.cpp - ROM patches
  *
- *  SheepShaver (C) 1997-2004 Christian Bauer and Marc Hellwig
+ *  SheepShaver (C) 1997-2005 Christian Bauer and Marc Hellwig
  *
  *  This program is free software; you can redistribute it and/or modify
  *  it under the terms of the GNU General Public License as published by
@@ -224,10 +224,9 @@ static uint32 rsrc_ptr = 0;
 // id = 4711 means "find any ID"
 static uint32 find_rom_resource(uint32 s_type, int16 s_id = 4711, bool cont = false)
 {
-	uint32 *lp = (uint32 *)(ROMBaseHost + 0x1a);
-	uint32 x = ntohl(*lp);
-	uint8 *bp = (uint8 *)(ROMBaseHost + x + 5);
-	uint32 header_size = *bp;
+	uint32 lp = ROM_BASE + 0x1a;
+	uint32 x = ReadMacInt32(lp);
+	uint32 header_size = ReadMacInt8(ROM_BASE + x + 5);
 
 	if (!cont)
 		rsrc_ptr = x;
@@ -235,17 +234,17 @@ static uint32 find_rom_resource(uint32 s
 		return 0;
 
 	for (;;) {
-		lp = (uint32 *)(ROMBaseHost + rsrc_ptr);
-		rsrc_ptr = ntohl(*lp);
+		lp = ROM_BASE + rsrc_ptr;
+		rsrc_ptr = ReadMacInt32(lp);
 		if (rsrc_ptr == 0)
 			break;
 
 		rsrc_ptr += header_size;
 
-		lp = (uint32 *)(ROMBaseHost + rsrc_ptr + 4);
-		uint32 data = ntohl(*lp); lp++;
-		uint32 type = ntohl(*lp); lp++;
-		int16 id = ntohs(*(int16 *)lp);
+		lp = ROM_BASE + rsrc_ptr + 4;
+		uint32 data = ReadMacInt32(lp);
+		uint32 type = ReadMacInt32(lp + 4);
+		int16 id = ReadMacInt16(lp + 8);
 		if (type == s_type && (id == s_id || s_id == 4711))
 			return data;
 	}
@@ -259,13 +258,12 @@ static uint32 find_rom_resource(uint32 s
 
 static uint32 find_rom_trap(uint16 trap)
 {
-	uint32 *lp = (uint32 *)(ROMBaseHost + 0x22);
-	lp = (uint32 *)(ROMBaseHost + ntohl(*lp));
+	uint32 lp = ROM_BASE + ReadMacInt32(ROM_BASE + 0x22);
 
 	if (trap > 0xa800)
-		return ntohl(lp[trap & 0x3ff]);
+		return ReadMacInt32(lp + 4 * (trap & 0x3ff));
 	else
-		return ntohl(lp[(trap & 0xff) + 0x400]);
+		return ReadMacInt32(lp + 4 * ((trap & 0xff) + 0x400));
 }
 
 
@@ -1413,11 +1411,11 @@ static bool patch_nanokernel(void)
 	*lp = htonl(POWERPC_NOP);
 
 	// Disable suspend (FE0F opcode)
-	// TODO: really suspend SheepShaver
+	// TODO: really suspend SheepShaver?
 	static const uint8 suspend_dat[] = {0x7c, 0x88, 0x68, 0x39, 0x41, 0x9d};
 	if ((base = find_rom_data(0x315000, 0x316000, suspend_dat, sizeof(suspend_dat))) == 0) return false;
 	D(bug("suspend %08lx\n", base));
-	lp = (uint32 *)(ROMBaseHost + base + 8);
+	lp = (uint32 *)(ROMBaseHost + base + 4);
 	*lp = htonl((ntohl(*lp) & 0xffff) | 0x48000000);	// bgt -> b
 
 	// Patch trap return routine
@@ -1439,6 +1437,47 @@ static bool patch_nanokernel(void)
 	*lp++ = htonl(0x91400000 + XLM_IRQ_NEST);	// stw	r10,XLM_IRQ_NEST
 	*lp = htonl(0x48000000 + ((npc - 0x31800c) & 0x03fffffc));	// b		ROM_BASE+0x312c2c
 
+	// Patch FEOA opcode, selector 0x0A (virtual->physical page index)
+	static const uint8 fe0a_0a_dat[] = {0x55, 0x23, 0xa3, 0x3e, 0x4b};
+	if ((base = find_rom_data(0x314000, 0x318000, fe0a_0a_dat, sizeof(fe0a_0a_dat))) == 0) return false;
+	loc = rom_powerpc_branch_target(base - 8);
+	static const uint8 fe0a_dat[] = {0x7e, 0x04, 0x48, 0x40, 0x81, 0xe1, 0x06, 0xb0, 0x54, 0x88, 0x10, 0x3a, 0x40, 0x90};
+	if (find_rom_data(loc, 0x318000, fe0a_dat, sizeof(fe0a_dat)) != loc) return false;
+	D(bug("fe0a_0a %08lx\n", base - 8));
+	lp = (uint32 *)(ROMBaseHost + base - 8);
+	*lp++ = htonl(0x7c832378);					// mr	r3,r4
+	*lp++ = htonl(POWERPC_NOP);
+	*lp = htonl(POWERPC_NOP);
+
+	// Disable FE0A opcode, selector 0x11 (init page tables?)
+	static const uint8 fe0a_11_dat[] = {0x56, 0x07, 0x06, 0x74, 0x2c, 0x07, 0x00, 0x60, 0x40};
+	if ((base = find_rom_data(0x314000, 0x318000, fe0a_11_dat, sizeof(fe0a_11_dat))) == 0) return false;
+	loc = rom_powerpc_branch_target(base - 4);
+	if (find_rom_data(0x314000, 0x318000, fe0a_dat, sizeof(fe0a_dat)) != loc) return false;
+	D(bug("fe0a_11 %08lx\n", base - 4));
+	lp = (uint32 *)(ROMBaseHost + base - 4);
+	*lp++ = htonl(POWERPC_NOP);
+	*lp++ = htonl(POWERPC_NOP);
+	*lp++ = htonl(POWERPC_NOP);
+	*lp = htonl(ntohl(*lp) | 0x02800000);		// bf => ba
+
+	// Patch FE0A opcode to fake a page table entry so that V=P for RAM and ROM
+	static const uint8 pg_lookup_dat[] = {0x7e, 0x0f, 0x40, 0x6e, 0x81, 0xc1, 0x06, 0xa4, 0x7e, 0x00, 0x71, 0x20};
+	if ((base = find_rom_data(0x310000, 0x320000, pg_lookup_dat, sizeof(pg_lookup_dat))) == 0) return false;
+	D(bug("fe0a_pgtb_lookup %08lx\n", base - 12));
+	lp = (uint32 *)(ROM_BASE + base - 12);
+	if (ntohl(lp[0]) != 0x81e106b0)				// lwz	r15,$06b0(r1)
+		return false;
+	lp[0] = htonl(0x54906026);					// slwi	r16,r4,12
+	lp[3] = htonl(0x62100121);					// ori	r16,r16,0x121
+
+	// Patch FE0A opcode to not write to kernel memory
+	static const uint8 krnl_write_dat[] = {0x38, 0xe0, 0x00, 0x01, 0x7e, 0x10, 0x38, 0x78, 0x92, 0x0f, 0x00, 0x00};
+	if ((base = find_rom_data(0x310000, 0x320000, krnl_write_dat, sizeof(krnl_write_dat))) == 0) return false;
+	D(bug("fe0a_krnl_write %08lx\n", base));
+	lp = (uint32 *)(ROM_BASE + base);
+	lp[2] = htonl(POWERPC_NOP);
+
 /*
 	// Disable FE0A/FE06 opcodes
 	lp = (uint32 *)(ROM_BASE + 0x3144ac);
@@ -1715,11 +1754,11 @@ static bool patch_68k(void)
 	static const uint8 ext_cache_dat[] = {0x4e, 0x7b, 0x00, 0x02};
 	if ((base = find_rom_data(0x1d0, 0x230, ext_cache_dat, sizeof(ext_cache_dat))) == 0) return false;
 	D(bug("ext_cache %08lx\n", base));
-	lp = (uint32 *)(ROMBaseHost + base + 6);
-	wp = (uint16 *)(ROMBaseHost + ntohl(*lp) + base + 6);
+	loc = ReadMacInt32(ROM_BASE + base + 6);
+	wp = (uint16 *)(ROMBaseHost + loc + base + 6);
 	*wp = htons(M68K_RTS);
-	lp = (uint32 *)(ROMBaseHost + base + 12);
-	wp = (uint16 *)(ROMBaseHost + ntohl(*lp) + base + 12);
+	loc = ReadMacInt32(ROM_BASE + base + 12);
+	wp = (uint16 *)(ROMBaseHost + loc + base + 12);
 	*wp = htons(M68K_RTS);
 
 	// Fake CPU speed test (SetupTimeK)
@@ -2001,12 +2040,12 @@ static bool patch_68k(void)
 		*lp = htonl(0x38600000);		// li	r3,0
 	}
 
-	// FIXME: Fake reading from [HpChk]+4 (the callchain reports some function from DriverServicesLib)
+	// Don't read from MacPgm in WipeOutMACPGMINFOProcPtrs (StdCLib)
 	if (1) {
 		uint32 hpchk_offset = find_rom_resource(FOURCC('n','l','i','b'), 10);
 		static const uint8 hpchk_dat[] = {0x80, 0x80, 0x03, 0x16, 0x94, 0x21, 0xff, 0xb0, 0x83, 0xc4, 0x00, 0x04};
 		if ((base = find_rom_data(hpchk_offset, hpchk_offset + 0x3000, hpchk_dat, sizeof(hpchk_dat))) == 0) return false;
-		D(bug("hpchk %08lx\n", base));
+		D(bug("macpgm %08lx\n", base));
 		lp = (uint32 *)(ROMBaseHost + base);
 		*lp = htonl(0x80800000 + XLM_ZERO_PAGE);		// lwz	r4,(zero page)
 	}
@@ -2264,9 +2303,8 @@ static bool patch_68k(void)
 	*wp++ = htons(M68K_JMP);
 	*wp++ = htons((ROM_BASE + put_scrap) >> 16);
 	*wp++ = htons((ROM_BASE + put_scrap) & 0xffff);
-	lp = (uint32 *)(ROMBaseHost + 0x22);
-	lp = (uint32 *)(ROMBaseHost + ntohl(*lp));
-	lp[0xa9fe & 0x3ff] = htonl(PUT_SCRAP_PATCH_SPACE);
+	base = ROM_BASE + ReadMacInt32(ROM_BASE + 0x22);
+	WriteMacInt32(base + 4 * (0xa9fe & 0x3ff), PUT_SCRAP_PATCH_SPACE);
 
 	// Patch GetScrap() for clipboard exchange with host OS
 	uint32 get_scrap = find_rom_trap(0xa9fd);	// GetScrap()
@@ -2275,9 +2313,8 @@ static bool patch_68k(void)
 	*wp++ = htons(M68K_JMP);
 	*wp++ = htons((ROM_BASE + get_scrap) >> 16);
 	*wp++ = htons((ROM_BASE + get_scrap) & 0xffff);
-	lp = (uint32 *)(ROMBaseHost + 0x22);
-	lp = (uint32 *)(ROMBaseHost + ntohl(*lp));
-	lp[0xa9fd & 0x3ff] = htonl(GET_SCRAP_PATCH_SPACE);
+	base = ROM_BASE + ReadMacInt32(ROM_BASE + 0x22);
+	WriteMacInt32(base + 4 * (0xa9fd & 0x3ff), GET_SCRAP_PATCH_SPACE);
 
 	// Patch SynchIdleTime()
 	if (PrefsFindBool("idlewait")) {
@@ -2344,6 +2381,15 @@ void InstallDrivers(void)
 	SheepArray<SIZEOF_IOParam> pb_var;
 	const uintptr pb = pb_var.addr();
 
+#if DISABLE_SCSI
+	// Setup fake SCSI Globals
+	r.d[0] = 0x1000;
+	Execute68kTrap(0xa71e, &r);		// NewPtrSysClear()
+	uint32 scsi_globals = r.a[0];
+	D(bug("Fake SCSI globals at %08lx\n", scsi_globals));
+	WriteMacInt32(0xc0c, scsi_globals);	// Set SCSIGlobals
+#endif
+
 	// Install floppy driver
 	if (ROMType == ROMTYPE_NEWWORLD || ROMType == ROMTYPE_GOSSAMER) {
 
@@ -2358,11 +2404,6 @@ void InstallDrivers(void)
 		WriteMacInt16(dce + dCtlFlags, SonyDriverFlags);
 	}
 
-#if DISABLE_SCSI && HAVE_SIGSEGV_SKIP_INSTRUCTION
-	// Fake SCSIGlobals
-	WriteMacInt32(0xc0c, SheepMem::ZeroPage());
-#endif
-
 	// Open .Sony driver
 	SheepString sony_str("\005.Sony");
 	WriteMacInt8(pb + ioPermssn, 0);