ViewVC Help
View File | Revision Log | Show Annotations | Revision Graph | Root Listing
root/cebix/SheepShaver/src/rom_patches.cpp
Revision: 1.19
Committed: 2003-12-05T12:37:14Z (20 years, 5 months ago) by gbeauche
Branch: MAIN
Changes since 1.18: +11 -2 lines
Log Message:
Fake reading from [HpChk]+4 (FIXME: the callchain reports some function
from DriverServicesLib). Also make fake SCSIGlobals map to zero page.

File Contents

# User Rev Content
1 cebix 1.1 /*
2     * rom_patches.cpp - ROM patches
3     *
4     * SheepShaver (C) 1997-2002 Christian Bauer and Marc Hellwig
5     *
6     * This program is free software; you can redistribute it and/or modify
7     * it under the terms of the GNU General Public License as published by
8     * the Free Software Foundation; either version 2 of the License, or
9     * (at your option) any later version.
10     *
11     * This program is distributed in the hope that it will be useful,
12     * but WITHOUT ANY WARRANTY; without even the implied warranty of
13     * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14     * GNU General Public License for more details.
15     *
16     * You should have received a copy of the GNU General Public License
17     * along with this program; if not, write to the Free Software
18     * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19     */
20    
21     /*
22     * TODO:
23     * IRQ_NEST must be handled atomically
24     * Don't use r1 in extra routines
25     */
26    
27     #include <string.h>
28    
29     #include "sysdeps.h"
30     #include "rom_patches.h"
31     #include "main.h"
32     #include "prefs.h"
33     #include "cpu_emulation.h"
34     #include "emul_op.h"
35     #include "xlowmem.h"
36     #include "sony.h"
37     #include "disk.h"
38     #include "cdrom.h"
39     #include "audio.h"
40     #include "audio_defs.h"
41     #include "serial.h"
42     #include "macos_util.h"
43 gbeauche 1.18 #include "thunks.h"
44 cebix 1.1
45     #define DEBUG 0
46     #include "debug.h"
47    
48    
49     // 68k breakpoint address
50     //#define M68K_BREAK_POINT 0x29e0 // BootMe
51     //#define M68K_BREAK_POINT 0x2a1e // Boot block code returned
52     //#define M68K_BREAK_POINT 0x3150 // CritError
53     //#define M68K_BREAK_POINT 0x187ce // Unimplemented trap
54    
55     // PowerPC breakpoint address
56     //#define POWERPC_BREAK_POINT 0x36e6c0 // 68k emulator start
57    
58     #define DISABLE_SCSI 1
59    
60    
61     // Other ROM addresses
62 gbeauche 1.17 const uint32 CHECK_LOAD_PATCH_SPACE = 0x2fcf00;
63     const uint32 PUT_SCRAP_PATCH_SPACE = 0x2fcf80;
64     const uint32 GET_SCRAP_PATCH_SPACE = 0x2fcfc0;
65     const uint32 ADDR_MAP_PATCH_SPACE = 0x2fd000;
66 cebix 1.1
67     // Global variables
68     int ROMType; // ROM type
69     static uint32 sony_offset; // Offset of .Sony driver resource
70    
71     // Prototypes
72     static bool patch_nanokernel_boot(void);
73     static bool patch_68k_emul(void);
74     static bool patch_nanokernel(void);
75     static bool patch_68k(void);
76    
77    
78 gbeauche 1.2 // Decode LZSS data
79     static void decode_lzss(const uint8 *src, uint8 *dest, int size)
80     {
81     char dict[0x1000];
82     int run_mask = 0, dict_idx = 0xfee;
83     for (;;) {
84     if (run_mask < 0x100) {
85     // Start new run
86     if (--size < 0)
87     break;
88     run_mask = *src++ | 0xff00;
89     }
90     bool bit = run_mask & 1;
91     run_mask >>= 1;
92     if (bit) {
93     // Verbatim copy
94     if (--size < 0)
95     break;
96     int c = *src++;
97     dict[dict_idx++] = c;
98     *dest++ = c;
99     dict_idx &= 0xfff;
100     } else {
101     // Copy from dictionary
102     if (--size < 0)
103     break;
104     int idx = *src++;
105     if (--size < 0)
106     break;
107     int cnt = *src++;
108     idx |= (cnt << 4) & 0xf00;
109     cnt = (cnt & 0x0f) + 3;
110     while (cnt--) {
111     char c = dict[idx++];
112     dict[dict_idx++] = c;
113     *dest++ = c;
114     idx &= 0xfff;
115     dict_idx &= 0xfff;
116     }
117     }
118     }
119     }
120    
121     // Decode parcels of ROM image (MacOS 9.X and even earlier)
122     void decode_parcels(const uint8 *src, uint8 *dest, int size)
123     {
124     uint32 parcel_offset = 0x14;
125     D(bug("Offset Type Name\n"));
126     while (parcel_offset != 0) {
127     const uint32 *parcel_data = (uint32 *)(src + parcel_offset);
128 gbeauche 1.3 uint32 next_offset = ntohl(parcel_data[0]);
129 gbeauche 1.2 uint32 parcel_type = ntohl(parcel_data[1]);
130     D(bug("%08x %c%c%c%c %s\n", parcel_offset,
131     (parcel_type >> 24) & 0xff, (parcel_type >> 16) & 0xff,
132     (parcel_type >> 8) & 0xff, parcel_type & 0xff, &parcel_data[6]));
133     if (parcel_type == FOURCC('r','o','m',' ')) {
134     uint32 lzss_offset = ntohl(parcel_data[2]);
135 gbeauche 1.16 uint32 lzss_size = ((uintptr)src + next_offset) - ((uintptr)parcel_data + lzss_offset);
136 gbeauche 1.2 decode_lzss((uint8 *)parcel_data + lzss_offset, dest, lzss_size);
137     }
138 gbeauche 1.3 parcel_offset = next_offset;
139 gbeauche 1.2 }
140     }
141    
142    
143     /*
144     * Decode ROM image, 4 MB plain images or NewWorld images
145     */
146    
147     bool DecodeROM(uint8 *data, uint32 size)
148     {
149     if (size == ROM_SIZE) {
150     // Plain ROM image
151     memcpy((void *)ROM_BASE, data, ROM_SIZE);
152     return true;
153     }
154     else if (strncmp((char *)data, "<CHRP-BOOT>", 11) == 0) {
155     // CHRP compressed ROM image
156     uint32 image_offset, image_size;
157     bool decode_info_ok = false;
158    
159     char *s = strstr((char *)data, "constant lzss-offset");
160     if (s != NULL) {
161     // Probably a plain LZSS compressed ROM image
162     if (sscanf(s - 7, "%06x", &image_offset) == 1) {
163     s = strstr((char *)data, "constant lzss-size");
164     if (s != NULL && (sscanf(s - 7, "%06x", &image_size) == 1))
165     decode_info_ok = true;
166     }
167     }
168     else {
169     // Probably a MacOS 9.2.x ROM image
170     s = strstr((char *)data, "constant parcels-offset");
171     if (s != NULL) {
172     if (sscanf(s - 7, "%06x", &image_offset) == 1) {
173     s = strstr((char *)data, "constant parcels-size");
174     if (s != NULL && (sscanf(s - 7, "%06x", &image_size) == 1))
175     decode_info_ok = true;
176     }
177     }
178     }
179    
180     // No valid information to decode the ROM found?
181     if (!decode_info_ok)
182     return false;
183    
184     // Check signature, this could be a parcels-based ROM image
185     uint32 rom_signature = ntohl(*(uint32 *)(data + image_offset));
186     if (rom_signature == FOURCC('p','r','c','l')) {
187     D(bug("Offset of parcels data: %08x\n", image_offset));
188     D(bug("Size of parcels data: %08x\n", image_size));
189     decode_parcels(data + image_offset, (uint8 *)ROM_BASE, image_size);
190     }
191     else {
192     D(bug("Offset of compressed data: %08x\n", image_offset));
193     D(bug("Size of compressed data: %08x\n", image_size));
194     decode_lzss(data + image_offset, (uint8 *)ROM_BASE, image_size);
195     }
196     return true;
197     }
198     return false;
199     }
200    
201    
202 cebix 1.1 /*
203     * Search ROM for byte string, return ROM offset (or 0)
204     */
205    
206     static uint32 find_rom_data(uint32 start, uint32 end, const uint8 *data, uint32 data_len)
207     {
208     uint32 ofs = start;
209     while (ofs < end) {
210     if (!memcmp((void *)(ROM_BASE + ofs), data, data_len))
211     return ofs;
212     ofs++;
213     }
214     return 0;
215     }
216    
217    
218     /*
219     * Search ROM resource by type/ID, return ROM offset of resource data
220     */
221    
222     static uint32 rsrc_ptr = 0;
223    
224     // id = 4711 means "find any ID"
225     static uint32 find_rom_resource(uint32 s_type, int16 s_id = 4711, bool cont = false)
226     {
227     uint32 *lp = (uint32 *)(ROM_BASE + 0x1a);
228     uint32 x = ntohl(*lp);
229     uint8 *bp = (uint8 *)(ROM_BASE + x + 5);
230     uint32 header_size = *bp;
231    
232     if (!cont)
233     rsrc_ptr = x;
234     else if (rsrc_ptr == 0)
235     return 0;
236    
237     for (;;) {
238     lp = (uint32 *)(ROM_BASE + rsrc_ptr);
239     rsrc_ptr = ntohl(*lp);
240     if (rsrc_ptr == 0)
241     break;
242    
243     rsrc_ptr += header_size;
244    
245     lp = (uint32 *)(ROM_BASE + rsrc_ptr + 4);
246     uint32 data = ntohl(*lp); lp++;
247     uint32 type = ntohl(*lp); lp++;
248     int16 id = ntohs(*(int16 *)lp);
249     if (type == s_type && (id == s_id || s_id == 4711))
250     return data;
251     }
252     return 0;
253     }
254    
255    
256     /*
257     * Search offset of A-Trap routine in ROM
258     */
259    
260     static uint32 find_rom_trap(uint16 trap)
261     {
262     uint32 *lp = (uint32 *)(ROM_BASE + 0x22);
263     lp = (uint32 *)(ROM_BASE + ntohl(*lp));
264    
265     if (trap > 0xa800)
266     return ntohl(lp[trap & 0x3ff]);
267     else
268     return ntohl(lp[(trap & 0xff) + 0x400]);
269     }
270    
271    
272     /*
273     * List of audio sifters installed in ROM and System file
274     */
275    
276     struct sift_entry {
277     uint32 type;
278     int16 id;
279     };
280     static sift_entry sifter_list[32];
281     static int num_sifters;
282    
283     void AddSifter(uint32 type, int16 id)
284     {
285     if (FindSifter(type, id))
286     return;
287     D(bug(" adding sifter type %c%c%c%c (%08x), id %d\n", type >> 24, (type >> 16) & 0xff, (type >> 8) & 0xff, type & 0xff, type, id));
288     sifter_list[num_sifters].type = type;
289     sifter_list[num_sifters].id = id;
290     num_sifters++;
291     }
292    
293     bool FindSifter(uint32 type, int16 id)
294     {
295     for (int i=0; i<num_sifters; i++) {
296     if (sifter_list[i].type == type && sifter_list[i].id == id)
297     return true;
298     }
299     return false;
300     }
301    
302    
303     /*
304     * Driver stubs
305     */
306    
307     static const uint8 sony_driver[] = { // Replacement for .Sony driver
308     // Driver header
309     SonyDriverFlags >> 8, SonyDriverFlags & 0xff, 0, 0, 0, 0, 0, 0,
310     0x00, 0x18, // Open() offset
311     0x00, 0x1c, // Prime() offset
312     0x00, 0x20, // Control() offset
313     0x00, 0x2c, // Status() offset
314     0x00, 0x52, // Close() offset
315     0x05, 0x2e, 0x53, 0x6f, 0x6e, 0x79, // ".Sony"
316    
317     // Open()
318     M68K_EMUL_OP_SONY_OPEN >> 8, M68K_EMUL_OP_SONY_OPEN & 0xff,
319     0x4e, 0x75, // rts
320    
321     // Prime()
322     M68K_EMUL_OP_SONY_PRIME >> 8, M68K_EMUL_OP_SONY_PRIME & 0xff,
323     0x60, 0x0e, // bra IOReturn
324    
325     // Control()
326     M68K_EMUL_OP_SONY_CONTROL >> 8, M68K_EMUL_OP_SONY_CONTROL & 0xff,
327     0x0c, 0x68, 0x00, 0x01, 0x00, 0x1a, // cmp.w #1,$1a(a0)
328     0x66, 0x04, // bne IOReturn
329     0x4e, 0x75, // rts
330    
331     // Status()
332     M68K_EMUL_OP_SONY_STATUS >> 8, M68K_EMUL_OP_SONY_STATUS & 0xff,
333    
334     // IOReturn
335     0x32, 0x28, 0x00, 0x06, // move.w 6(a0),d1
336     0x08, 0x01, 0x00, 0x09, // btst #9,d1
337     0x67, 0x0c, // beq 1
338     0x4a, 0x40, // tst.w d0
339     0x6f, 0x02, // ble 2
340     0x42, 0x40, // clr.w d0
341     0x31, 0x40, 0x00, 0x10, //2 move.w d0,$10(a0)
342     0x4e, 0x75, // rts
343     0x4a, 0x40, //1 tst.w d0
344     0x6f, 0x04, // ble 3
345     0x42, 0x40, // clr.w d0
346     0x4e, 0x75, // rts
347     0x2f, 0x38, 0x08, 0xfc, //3 move.l $8fc,-(sp)
348     0x4e, 0x75, // rts
349    
350     // Close()
351     0x70, 0xe8, // moveq #-24,d0
352     0x4e, 0x75 // rts
353     };
354    
355     static const uint8 disk_driver[] = { // Generic disk driver
356     // Driver header
357     DiskDriverFlags >> 8, DiskDriverFlags & 0xff, 0, 0, 0, 0, 0, 0,
358     0x00, 0x18, // Open() offset
359     0x00, 0x1c, // Prime() offset
360     0x00, 0x20, // Control() offset
361     0x00, 0x2c, // Status() offset
362     0x00, 0x52, // Close() offset
363     0x05, 0x2e, 0x44, 0x69, 0x73, 0x6b, // ".Disk"
364    
365     // Open()
366     M68K_EMUL_OP_DISK_OPEN >> 8, M68K_EMUL_OP_DISK_OPEN & 0xff,
367     0x4e, 0x75, // rts
368    
369     // Prime()
370     M68K_EMUL_OP_DISK_PRIME >> 8, M68K_EMUL_OP_DISK_PRIME & 0xff,
371     0x60, 0x0e, // bra IOReturn
372    
373     // Control()
374     M68K_EMUL_OP_DISK_CONTROL >> 8, M68K_EMUL_OP_DISK_CONTROL & 0xff,
375     0x0c, 0x68, 0x00, 0x01, 0x00, 0x1a, // cmp.w #1,$1a(a0)
376     0x66, 0x04, // bne IOReturn
377     0x4e, 0x75, // rts
378    
379     // Status()
380     M68K_EMUL_OP_DISK_STATUS >> 8, M68K_EMUL_OP_DISK_STATUS & 0xff,
381    
382     // IOReturn
383     0x32, 0x28, 0x00, 0x06, // move.w 6(a0),d1
384     0x08, 0x01, 0x00, 0x09, // btst #9,d1
385     0x67, 0x0c, // beq 1
386     0x4a, 0x40, // tst.w d0
387     0x6f, 0x02, // ble 2
388     0x42, 0x40, // clr.w d0
389     0x31, 0x40, 0x00, 0x10, //2 move.w d0,$10(a0)
390     0x4e, 0x75, // rts
391     0x4a, 0x40, //1 tst.w d0
392     0x6f, 0x04, // ble 3
393     0x42, 0x40, // clr.w d0
394     0x4e, 0x75, // rts
395     0x2f, 0x38, 0x08, 0xfc, //3 move.l $8fc,-(sp)
396     0x4e, 0x75, // rts
397    
398     // Close()
399     0x70, 0xe8, // moveq #-24,d0
400     0x4e, 0x75 // rts
401     };
402    
403     static const uint8 cdrom_driver[] = { // CD-ROM driver
404     // Driver header
405     CDROMDriverFlags >> 8, CDROMDriverFlags & 0xff, 0, 0, 0, 0, 0, 0,
406     0x00, 0x1c, // Open() offset
407     0x00, 0x20, // Prime() offset
408     0x00, 0x24, // Control() offset
409     0x00, 0x30, // Status() offset
410     0x00, 0x56, // Close() offset
411     0x08, 0x2e, 0x41, 0x70, 0x70, 0x6c, 0x65, 0x43, 0x44, 0x00, // ".AppleCD"
412    
413     // Open()
414     M68K_EMUL_OP_CDROM_OPEN >> 8, M68K_EMUL_OP_CDROM_OPEN & 0xff,
415     0x4e, 0x75, // rts
416    
417     // Prime()
418     M68K_EMUL_OP_CDROM_PRIME >> 8, M68K_EMUL_OP_CDROM_PRIME & 0xff,
419     0x60, 0x0e, // bra IOReturn
420    
421     // Control()
422     M68K_EMUL_OP_CDROM_CONTROL >> 8, M68K_EMUL_OP_CDROM_CONTROL & 0xff,
423     0x0c, 0x68, 0x00, 0x01, 0x00, 0x1a, // cmp.w #1,$1a(a0)
424     0x66, 0x04, // bne IOReturn
425     0x4e, 0x75, // rts
426    
427     // Status()
428     M68K_EMUL_OP_CDROM_STATUS >> 8, M68K_EMUL_OP_CDROM_STATUS & 0xff,
429    
430     // IOReturn
431     0x32, 0x28, 0x00, 0x06, // move.w 6(a0),d1
432     0x08, 0x01, 0x00, 0x09, // btst #9,d1
433     0x67, 0x0c, // beq 1
434     0x4a, 0x40, // tst.w d0
435     0x6f, 0x02, // ble 2
436     0x42, 0x40, // clr.w d0
437     0x31, 0x40, 0x00, 0x10, //2 move.w d0,$10(a0)
438     0x4e, 0x75, // rts
439     0x4a, 0x40, //1 tst.w d0
440     0x6f, 0x04, // ble 3
441     0x42, 0x40, // clr.w d0
442     0x4e, 0x75, // rts
443     0x2f, 0x38, 0x08, 0xfc, //3 move.l $8fc,-(sp)
444     0x4e, 0x75, // rts
445    
446     // Close()
447     0x70, 0xe8, // moveq #-24,d0
448     0x4e, 0x75 // rts
449     };
450    
451 gbeauche 1.18 static uint32 long_ptr;
452    
453     static void SetLongBase(uint32 addr)
454     {
455     long_ptr = addr;
456     }
457    
458     static void Long(uint32 value)
459     {
460     WriteMacInt32(long_ptr, value);
461     long_ptr += 4;
462     }
463    
464     static void gen_ain_driver(uintptr addr)
465     {
466     SetLongBase(addr);
467 cebix 1.1
468 gbeauche 1.18 // .AIn driver header
469     Long(0x4d000000); Long(0x00000000);
470     Long(0x00200040); Long(0x00600080);
471     Long(0x00a0042e); Long(0x41496e00);
472     Long(0x00000000); Long(0x00000000);
473     Long(0xaafe0700); Long(0x00000000);
474     Long(0x00000000); Long(0x00179822);
475     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_NOTHING));
476     Long(0x00000000); Long(0x00000000);
477     Long(0xaafe0700); Long(0x00000000);
478     Long(0x00000000); Long(0x00179822);
479     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_PRIME_IN));
480     Long(0x00000000); Long(0x00000000);
481     Long(0xaafe0700); Long(0x00000000);
482     Long(0x00000000); Long(0x00179822);
483     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_CONTROL));
484     Long(0x00000000); Long(0x00000000);
485     Long(0xaafe0700); Long(0x00000000);
486     Long(0x00000000); Long(0x00179822);
487     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_STATUS));
488     Long(0x00000000); Long(0x00000000);
489     Long(0xaafe0700); Long(0x00000000);
490     Long(0x00000000); Long(0x00179822);
491     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_NOTHING));
492     Long(0x00000000); Long(0x00000000);
493 cebix 1.1 };
494    
495 gbeauche 1.18 static void gen_aout_driver(uintptr addr)
496     {
497     SetLongBase(addr);
498    
499     // .AOut driver header
500     Long(0x4d000000); Long(0x00000000);
501     Long(0x00200040); Long(0x00600080);
502     Long(0x00a0052e); Long(0x414f7574);
503     Long(0x00000000); Long(0x00000000);
504     Long(0xaafe0700); Long(0x00000000);
505     Long(0x00000000); Long(0x00179822);
506     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_OPEN));
507     Long(0x00000000); Long(0x00000000);
508     Long(0xaafe0700); Long(0x00000000);
509     Long(0x00000000); Long(0x00179822);
510     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_PRIME_OUT));
511     Long(0x00000000); Long(0x00000000);
512     Long(0xaafe0700); Long(0x00000000);
513     Long(0x00000000); Long(0x00179822);
514     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_CONTROL));
515     Long(0x00000000); Long(0x00000000);
516     Long(0xaafe0700); Long(0x00000000);
517     Long(0x00000000); Long(0x00179822);
518     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_STATUS));
519     Long(0x00000000); Long(0x00000000);
520     Long(0xaafe0700); Long(0x00000000);
521     Long(0x00000000); Long(0x00179822);
522     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_CLOSE));
523     Long(0x00000000); Long(0x00000000);
524 cebix 1.1 };
525    
526 gbeauche 1.18 static void gen_bin_driver(uintptr addr)
527     {
528     SetLongBase(addr);
529    
530     // .BIn driver header
531     Long(0x4d000000); Long(0x00000000);
532     Long(0x00200040); Long(0x00600080);
533     Long(0x00a0042e); Long(0x42496e00);
534     Long(0x00000000); Long(0x00000000);
535     Long(0xaafe0700); Long(0x00000000);
536     Long(0x00000000); Long(0x00179822);
537     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_NOTHING));
538     Long(0x00000000); Long(0x00000000);
539     Long(0xaafe0700); Long(0x00000000);
540     Long(0x00000000); Long(0x00179822);
541     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_PRIME_IN));
542     Long(0x00000000); Long(0x00000000);
543     Long(0xaafe0700); Long(0x00000000);
544     Long(0x00000000); Long(0x00179822);
545     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_CONTROL));
546     Long(0x00000000); Long(0x00000000);
547     Long(0xaafe0700); Long(0x00000000);
548     Long(0x00000000); Long(0x00179822);
549     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_STATUS));
550     Long(0x00000000); Long(0x00000000);
551     Long(0xaafe0700); Long(0x00000000);
552     Long(0x00000000); Long(0x00179822);
553     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_NOTHING));
554     Long(0x00000000); Long(0x00000000);
555 cebix 1.1 };
556    
557 gbeauche 1.18 static void gen_bout_driver(uintptr addr)
558     {
559     SetLongBase(addr);
560    
561     // .BOut driver header
562     Long(0x4d000000); Long(0x00000000);
563     Long(0x00200040); Long(0x00600080);
564     Long(0x00a0052e); Long(0x424f7574);
565     Long(0x00000000); Long(0x00000000);
566     Long(0xaafe0700); Long(0x00000000);
567     Long(0x00000000); Long(0x00179822);
568     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_OPEN));
569     Long(0x00000000); Long(0x00000000);
570     Long(0xaafe0700); Long(0x00000000);
571     Long(0x00000000); Long(0x00179822);
572     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_PRIME_OUT));
573     Long(0x00000000); Long(0x00000000);
574     Long(0xaafe0700); Long(0x00000000);
575     Long(0x00000000); Long(0x00179822);
576     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_CONTROL));
577     Long(0x00000000); Long(0x00000000);
578     Long(0xaafe0700); Long(0x00000000);
579     Long(0x00000000); Long(0x00179822);
580     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_STATUS));
581     Long(0x00000000); Long(0x00000000);
582     Long(0xaafe0700); Long(0x00000000);
583     Long(0x00000000); Long(0x00179822);
584     Long(0x00010004); Long(NativeTVECT(NATIVE_SERIAL_CLOSE));
585     Long(0x00000000); Long(0x00000000);
586 cebix 1.1 };
587    
588     static const uint8 adbop_patch[] = { // Call ADBOp() completion procedure
589     // The completion procedure may call ADBOp() again!
590     0x40, 0xe7, // move sr,-(sp)
591     0x00, 0x7c, 0x07, 0x00, // ori #$0700,sr
592     M68K_EMUL_OP_ADBOP >> 8, M68K_EMUL_OP_ADBOP & 0xff,
593     0x48, 0xe7, 0x70, 0xf0, // movem.l d1-d3/a0-a3,-(sp)
594     0x26, 0x48, // move.l a0,a3
595     0x4a, 0xab, 0x00, 0x04, // tst.l 4(a3)
596     0x67, 0x00, 0x00, 0x18, // beq 1
597     0x20, 0x53, // move.l (a3),a0
598     0x22, 0x6b, 0x00, 0x04, // move.l 4(a3),a1
599     0x24, 0x6b, 0x00, 0x08, // move.l 8(a3),a2
600     0x26, 0x78, 0x0c, 0xf8, // move.l $cf8,a3
601     0x4e, 0x91, // jsr (a1)
602     0x70, 0x00, // moveq #0,d0
603     0x60, 0x00, 0x00, 0x04, // bra 2
604     0x70, 0xff, //1 moveq #-1,d0
605     0x4c, 0xdf, 0x0f, 0x0e, //2 movem.l (sp)+,d1-d3/a0-a3
606     0x46, 0xdf, // move (sp)+,sr
607     0x4e, 0x75 // rts
608     };
609    
610    
611     /*
612 gbeauche 1.9 * Copy PowerPC code to ROM image and reverse bytes if necessary
613     */
614    
615     static inline void memcpy_powerpc_code(void *dst, const void *src, size_t len)
616     {
617     #ifdef WORDS_BIGENDIAN
618     (void)memcpy(dst, src, len);
619     #else
620     uint32 *d = (uint32 *)dst;
621     uint32 *s = (uint32 *)src;
622     for (int i = 0; i < len/4; i++)
623     d[i] = htonl(s[i]);
624     #endif
625     }
626    
627    
628     /*
629 cebix 1.1 * Install ROM patches (RAMBase and KernelDataAddr must be set)
630     */
631    
632     bool PatchROM(void)
633     {
634     // Print ROM info
635     D(bug("Checksum: %08lx\n", ntohl(*(uint32 *)ROM_BASE)));
636     D(bug("Version: %04x\n", ntohs(*(uint16 *)(ROM_BASE + 8))));
637     D(bug("Sub Version: %04x\n", ntohs(*(uint16 *)(ROM_BASE + 18))));
638     D(bug("Nanokernel ID: %s\n", (char *)ROM_BASE + 0x30d064));
639     D(bug("Resource Map at %08lx\n", ntohl(*(uint32 *)(ROM_BASE + 26))));
640     D(bug("Trap Tables at %08lx\n\n", ntohl(*(uint32 *)(ROM_BASE + 34))));
641    
642     // Detect ROM type
643     if (!memcmp((void *)(ROM_BASE + 0x30d064), "Boot TNT", 8))
644     ROMType = ROMTYPE_TNT;
645     else if (!memcmp((void *)(ROM_BASE + 0x30d064), "Boot Alchemy", 12))
646     ROMType = ROMTYPE_ALCHEMY;
647     else if (!memcmp((void *)(ROM_BASE + 0x30d064), "Boot Zanzibar", 13))
648     ROMType = ROMTYPE_ZANZIBAR;
649     else if (!memcmp((void *)(ROM_BASE + 0x30d064), "Boot Gazelle", 12))
650     ROMType = ROMTYPE_GAZELLE;
651 gbeauche 1.11 else if (!memcmp((void *)(ROM_BASE + 0x30d064), "Boot Gossamer", 13))
652     ROMType = ROMTYPE_GOSSAMER;
653 cebix 1.1 else if (!memcmp((void *)(ROM_BASE + 0x30d064), "NewWorld", 8))
654     ROMType = ROMTYPE_NEWWORLD;
655     else
656     return false;
657    
658 gbeauche 1.14 // Check that other ROM addresses point to really free regions
659     if (ntohl(*(uint32 *)(ROM_BASE + CHECK_LOAD_PATCH_SPACE)) != 0x6b636b63)
660     return false;
661     if (ntohl(*(uint32 *)(ROM_BASE + PUT_SCRAP_PATCH_SPACE)) != 0x6b636b63)
662     return false;
663     if (ntohl(*(uint32 *)(ROM_BASE + GET_SCRAP_PATCH_SPACE)) != 0x6b636b63)
664     return false;
665     if (ntohl(*(uint32 *)(ROM_BASE + ADDR_MAP_PATCH_SPACE)) != 0x6b636b63)
666     return false;
667    
668 cebix 1.1 // Apply patches
669     if (!patch_nanokernel_boot()) return false;
670     if (!patch_68k_emul()) return false;
671     if (!patch_nanokernel()) return false;
672     if (!patch_68k()) return false;
673    
674     #ifdef M68K_BREAK_POINT
675     // Install 68k breakpoint
676     uint16 *wp = (uint16 *)(ROM_BASE + M68K_BREAK_POINT);
677     *wp++ = htons(M68K_EMUL_BREAK);
678     *wp = htons(M68K_EMUL_RETURN);
679     #endif
680    
681     #ifdef POWERPC_BREAK_POINT
682     // Install PowerPC breakpoint
683     uint32 *lp = (uint32 *)(ROM_BASE + POWERPC_BREAK_POINT);
684     *lp = htonl(0);
685     #endif
686    
687     // Copy 68k emulator to 2MB boundary
688     memcpy((void *)(ROM_BASE + ROM_SIZE), (void *)(ROM_BASE + ROM_SIZE - 0x100000), 0x100000);
689     return true;
690     }
691    
692    
693     /*
694     * Nanokernel boot routine patches
695     */
696    
697     static bool patch_nanokernel_boot(void)
698     {
699     uint32 *lp;
700    
701     // ROM boot structure patches
702     lp = (uint32 *)(ROM_BASE + 0x30d000);
703     lp[0x9c >> 2] = htonl(KernelDataAddr); // LA_InfoRecord
704     lp[0xa0 >> 2] = htonl(KernelDataAddr); // LA_KernelData
705     lp[0xa4 >> 2] = htonl(KernelDataAddr + 0x1000); // LA_EmulatorData
706     lp[0xa8 >> 2] = htonl(ROM_BASE + 0x480000); // LA_DispatchTable
707     lp[0xac >> 2] = htonl(ROM_BASE + 0x460000); // LA_EmulatorCode
708     lp[0x360 >> 2] = htonl(0); // Physical RAM base (? on NewWorld ROM, this contains -1)
709     lp[0xfd8 >> 2] = htonl(ROM_BASE + 0x2a); // 68k reset vector
710    
711     // Skip SR/BAT/SDR init
712 gbeauche 1.11 if (ROMType == ROMTYPE_GAZELLE || ROMType == ROMTYPE_GOSSAMER || ROMType == ROMTYPE_NEWWORLD) {
713 cebix 1.1 lp = (uint32 *)(ROM_BASE + 0x310000);
714     *lp++ = htonl(POWERPC_NOP);
715     *lp = htonl(0x38000000);
716     }
717 gbeauche 1.11 static const uint32 sr_init_loc[] = {0x3101b0, 0x3101b0, 0x3101b0, 0x3101ec, 0x3101fc, 0x310200};
718 cebix 1.1 lp = (uint32 *)(ROM_BASE + 0x310008);
719     *lp = htonl(0x48000000 | (sr_init_loc[ROMType] - 8) & 0xffff); // b ROM_BASE+0x3101b0
720     lp = (uint32 *)(ROM_BASE + sr_init_loc[ROMType]);
721     *lp++ = htonl(0x80200000 + XLM_KERNEL_DATA); // lwz r1,(pointer to Kernel Data)
722     *lp++ = htonl(0x3da0dead); // lis r13,0xdead (start of kernel memory)
723     *lp++ = htonl(0x3dc00010); // lis r14,0x0010 (size of page table)
724     *lp = htonl(0x3de00010); // lis r15,0x0010 (size of kernel memory)
725    
726     // Don't read PVR
727 gbeauche 1.11 static const uint32 pvr_loc[] = {0x3103b0, 0x3103b4, 0x3103b4, 0x310400, 0x310430, 0x310438};
728 cebix 1.1 lp = (uint32 *)(ROM_BASE + pvr_loc[ROMType]);
729     *lp = htonl(0x81800000 + XLM_PVR); // lwz r12,(theoretical PVR)
730    
731     // Set CPU specific data (even if ROM doesn't have support for that CPU)
732     lp = (uint32 *)(ROM_BASE + pvr_loc[ROMType]);
733     if (ntohl(lp[6]) != 0x2c0c0001)
734     return false;
735     uint32 ofs = ntohl(lp[7]) & 0xffff;
736     D(bug("ofs %08lx\n", ofs));
737     lp[8] = htonl((ntohl(lp[8]) & 0xffff) | 0x48000000); // beq -> b
738     uint32 loc = (ntohl(lp[8]) & 0xffff) + (uint32)(lp+8) - ROM_BASE;
739     D(bug("loc %08lx\n", loc));
740     lp = (uint32 *)(ROM_BASE + ofs + 0x310000);
741     switch (PVR >> 16) {
742     case 1: // 601
743     lp[0] = htonl(0x1000); // Page size
744     lp[1] = htonl(0x8000); // Data cache size
745     lp[2] = htonl(0x8000); // Inst cache size
746     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
747     lp[4] = htonl(0x00010040); // Unified caches/Inst cache line size
748     lp[5] = htonl(0x00400020); // Data cache line size/Data cache block size touch
749     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
750     lp[7] = htonl(0x00080008); // Inst cache assoc/Data cache assoc
751     lp[8] = htonl(0x01000002); // TLB total size/TLB assoc
752     break;
753     case 3: // 603
754     lp[0] = htonl(0x1000); // Page size
755     lp[1] = htonl(0x2000); // Data cache size
756     lp[2] = htonl(0x2000); // Inst cache size
757     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
758     lp[4] = htonl(0x00000020); // Unified caches/Inst cache line size
759     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
760     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
761     lp[7] = htonl(0x00020002); // Inst cache assoc/Data cache assoc
762     lp[8] = htonl(0x00400002); // TLB total size/TLB assoc
763     break;
764     case 4: // 604
765     lp[0] = htonl(0x1000); // Page size
766     lp[1] = htonl(0x4000); // Data cache size
767     lp[2] = htonl(0x4000); // Inst cache size
768     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
769     lp[4] = htonl(0x00000020); // Unified caches/Inst cache line size
770     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
771     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
772     lp[7] = htonl(0x00040004); // Inst cache assoc/Data cache assoc
773     lp[8] = htonl(0x00800002); // TLB total size/TLB assoc
774     break;
775     // case 5: // 740?
776     case 6: // 603e
777     case 7: // 603ev
778     lp[0] = htonl(0x1000); // Page size
779     lp[1] = htonl(0x4000); // Data cache size
780     lp[2] = htonl(0x4000); // Inst cache size
781     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
782     lp[4] = htonl(0x00000020); // Unified caches/Inst cache line size
783     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
784     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
785     lp[7] = htonl(0x00040004); // Inst cache assoc/Data cache assoc
786     lp[8] = htonl(0x00400002); // TLB total size/TLB assoc
787     break;
788     case 8: // 750
789     lp[0] = htonl(0x1000); // Page size
790     lp[1] = htonl(0x8000); // Data cache size
791     lp[2] = htonl(0x8000); // Inst cache size
792     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
793     lp[4] = htonl(0x00000020); // Unified caches/Inst cache line size
794     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
795     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
796     lp[7] = htonl(0x00080008); // Inst cache assoc/Data cache assoc
797     lp[8] = htonl(0x00800002); // TLB total size/TLB assoc
798     break;
799     case 9: // 604e
800     case 10: // 604ev5
801     lp[0] = htonl(0x1000); // Page size
802     lp[1] = htonl(0x8000); // Data cache size
803     lp[2] = htonl(0x8000); // Inst cache size
804     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
805     lp[4] = htonl(0x00000020); // Unified caches/Inst cache line size
806     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
807     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
808     lp[7] = htonl(0x00040004); // Inst cache assoc/Data cache assoc
809     lp[8] = htonl(0x00800002); // TLB total size/TLB assoc
810     break;
811     // case 11: // X704?
812     case 12: // ???
813     lp[0] = htonl(0x1000); // Page size
814     lp[1] = htonl(0x8000); // Data cache size
815     lp[2] = htonl(0x8000); // Inst cache size
816     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
817     lp[4] = htonl(0x00000020); // Unified caches/Inst cache line size
818     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
819     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
820     lp[7] = htonl(0x00080008); // Inst cache assoc/Data cache assoc
821     lp[8] = htonl(0x00800002); // TLB total size/TLB assoc
822     break;
823     case 13: // ???
824     lp[0] = htonl(0x1000); // Page size
825     lp[1] = htonl(0x8000); // Data cache size
826     lp[2] = htonl(0x8000); // Inst cache size
827     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
828     lp[4] = htonl(0x00000020); // Unified caches/Inst cache line size
829     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
830     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
831     lp[7] = htonl(0x00080008); // Inst cache assoc/Data cache assoc
832     lp[8] = htonl(0x01000004); // TLB total size/TLB assoc
833     break;
834     // case 50: // 821
835     // case 80: // 860
836     case 96: // ???
837     lp[0] = htonl(0x1000); // Page size
838     lp[1] = htonl(0x8000); // Data cache size
839     lp[2] = htonl(0x8000); // Inst cache size
840     lp[3] = htonl(0x00200020); // Coherency block size/Reservation granule size
841     lp[4] = htonl(0x00010020); // Unified caches/Inst cache line size
842     lp[5] = htonl(0x00200020); // Data cache line size/Data cache block size touch
843     lp[6] = htonl(0x00200020); // Inst cache block size/Data cache block size
844     lp[7] = htonl(0x00080008); // Inst cache assoc/Data cache assoc
845     lp[8] = htonl(0x00800004); // TLB total size/TLB assoc
846     break;
847     default:
848     printf("WARNING: Unknown CPU type\n");
849     break;
850     }
851    
852     // Don't set SPRG3, don't test MQ
853     lp = (uint32 *)(ROM_BASE + loc + 0x20);
854     *lp++ = htonl(POWERPC_NOP);
855     lp++;
856     *lp++ = htonl(POWERPC_NOP);
857     lp++;
858     *lp = htonl(POWERPC_NOP);
859    
860     // Don't read MSR
861     lp = (uint32 *)(ROM_BASE + loc + 0x40);
862     *lp = htonl(0x39c00000); // li r14,0
863    
864     // Don't write to DEC
865     lp = (uint32 *)(ROM_BASE + loc + 0x70);
866     *lp++ = htonl(POWERPC_NOP);
867     loc = (ntohl(lp[0]) & 0xffff) + (uint32)lp - ROM_BASE;
868     D(bug("loc %08lx\n", loc));
869    
870     // Don't set SPRG3
871     lp = (uint32 *)(ROM_BASE + loc + 0x2c);
872     *lp = htonl(POWERPC_NOP);
873    
874     // Don't read PVR
875 gbeauche 1.11 static const uint32 pvr_ofs[] = {0x138, 0x138, 0x138, 0x140, 0x148, 0x148};
876 cebix 1.1 lp = (uint32 *)(ROM_BASE + loc + pvr_ofs[ROMType]);
877     *lp = htonl(0x82e00000 + XLM_PVR); // lwz r23,(theoretical PVR)
878     lp = (uint32 *)(ROM_BASE + loc + 0x170);
879 gbeauche 1.11 if (ntohl(*lp) == 0x7eff42a6) // NewWorld or Gossamer ROM
880 cebix 1.1 *lp = htonl(0x82e00000 + XLM_PVR); // lwz r23,(theoretical PVR)
881     lp = (uint32 *)(ROM_BASE + 0x313134);
882     if (ntohl(*lp) == 0x7e5f42a6)
883     *lp = htonl(0x82400000 + XLM_PVR); // lwz r18,(theoretical PVR)
884     lp = (uint32 *)(ROM_BASE + 0x3131f4);
885     if (ntohl(*lp) == 0x7e5f42a6) // NewWorld ROM
886     *lp = htonl(0x82400000 + XLM_PVR); // lwz r18,(theoretical PVR)
887 gbeauche 1.4 lp = (uint32 *)(ROM_BASE + 0x314600);
888     if (ntohl(*lp) == 0x7d3f42a6)
889     *lp = htonl(0x81200000 + XLM_PVR); // lzw r9,(theoritical PVR)
890 cebix 1.1
891     // Don't read SDR1
892 gbeauche 1.11 static const uint32 sdr1_ofs[] = {0x174, 0x174, 0x174, 0x17c, 0x19c, 0x19c};
893 cebix 1.1 lp = (uint32 *)(ROM_BASE + loc + sdr1_ofs[ROMType]);
894     *lp++ = htonl(0x3d00dead); // lis r8,0xdead (pointer to page table)
895     *lp++ = htonl(0x3ec0001f); // lis r22,0x001f (size of page table)
896     *lp = htonl(POWERPC_NOP);
897    
898     // Don't clear page table
899 gbeauche 1.11 static const uint32 pgtb_ofs[] = {0x198, 0x198, 0x198, 0x1a0, 0x1c0, 0x1c4};
900 cebix 1.1 lp = (uint32 *)(ROM_BASE + loc + pgtb_ofs[ROMType]);
901     *lp = htonl(POWERPC_NOP);
902    
903     // Don't invalidate TLB
904 gbeauche 1.11 static const uint32 tlb_ofs[] = {0x1a0, 0x1a0, 0x1a0, 0x1a8, 0x1c8, 0x1cc};
905 cebix 1.1 lp = (uint32 *)(ROM_BASE + loc + tlb_ofs[ROMType]);
906     *lp = htonl(POWERPC_NOP);
907    
908     // Don't create RAM descriptor table
909 gbeauche 1.11 static const uint32 desc_ofs[] = {0x350, 0x350, 0x350, 0x358, 0x378, 0x37c};
910 cebix 1.1 lp = (uint32 *)(ROM_BASE + loc + desc_ofs[ROMType]);
911     *lp = htonl(POWERPC_NOP);
912    
913     // Don't load SRs and BATs
914 gbeauche 1.11 static const uint32 sr_ofs[] = {0x3d8, 0x3d8, 0x3d8, 0x3e0, 0x400, 0x404};
915 cebix 1.1 lp = (uint32 *)(ROM_BASE + loc + sr_ofs[ROMType]);
916     *lp = htonl(POWERPC_NOP);
917    
918     // Don't mess with SRs
919 gbeauche 1.11 static const uint32 sr2_ofs[] = {0x312118, 0x312118, 0x312118, 0x312118, 0x312118, 0x3121b4};
920 cebix 1.1 lp = (uint32 *)(ROM_BASE + sr2_ofs[ROMType]);
921     *lp = htonl(POWERPC_BLR);
922    
923     // Don't check performance monitor
924 gbeauche 1.11 static const uint32 pm_ofs[] = {0x313148, 0x313148, 0x313148, 0x313148, 0x313158, 0x313218};
925 cebix 1.1 lp = (uint32 *)(ROM_BASE + pm_ofs[ROMType]);
926     while (ntohl(*lp) != 0x7e58eba6) lp++;
927     *lp++ = htonl(POWERPC_NOP);
928     while (ntohl(*lp) != 0x7e78eaa6) lp++;
929     *lp++ = htonl(POWERPC_NOP);
930     while (ntohl(*lp) != 0x7e59eba6) lp++;
931     *lp++ = htonl(POWERPC_NOP);
932     while (ntohl(*lp) != 0x7e79eaa6) lp++;
933     *lp++ = htonl(POWERPC_NOP);
934     while (ntohl(*lp) != 0x7e5aeba6) lp++;
935     *lp++ = htonl(POWERPC_NOP);
936     while (ntohl(*lp) != 0x7e7aeaa6) lp++;
937     *lp++ = htonl(POWERPC_NOP);
938     while (ntohl(*lp) != 0x7e5beba6) lp++;
939     *lp++ = htonl(POWERPC_NOP);
940     while (ntohl(*lp) != 0x7e7beaa6) lp++;
941     *lp++ = htonl(POWERPC_NOP);
942     while (ntohl(*lp) != 0x7e5feba6) lp++;
943     *lp++ = htonl(POWERPC_NOP);
944     while (ntohl(*lp) != 0x7e7feaa6) lp++;
945     *lp++ = htonl(POWERPC_NOP);
946     while (ntohl(*lp) != 0x7e5ceba6) lp++;
947     *lp++ = htonl(POWERPC_NOP);
948     while (ntohl(*lp) != 0x7e7ceaa6) lp++;
949     *lp++ = htonl(POWERPC_NOP);
950     while (ntohl(*lp) != 0x7e5deba6) lp++;
951     *lp++ = htonl(POWERPC_NOP);
952     while (ntohl(*lp) != 0x7e7deaa6) lp++;
953     *lp++ = htonl(POWERPC_NOP);
954     while (ntohl(*lp) != 0x7e5eeba6) lp++;
955     *lp++ = htonl(POWERPC_NOP);
956     while (ntohl(*lp) != 0x7e7eeaa6) lp++;
957     *lp++ = htonl(POWERPC_NOP);
958    
959     // Jump to 68k emulator
960 gbeauche 1.11 static const uint32 jump68k_ofs[] = {0x40c, 0x40c, 0x40c, 0x414, 0x434, 0x438};
961 cebix 1.1 lp = (uint32 *)(ROM_BASE + loc + jump68k_ofs[ROMType]);
962     *lp++ = htonl(0x80610634); // lwz r3,0x0634(r1) (pointer to Emulator Data)
963     *lp++ = htonl(0x8081119c); // lwz r4,0x119c(r1) (pointer to opcode table)
964     *lp++ = htonl(0x80011184); // lwz r0,0x1184(r1) (pointer to emulator init routine)
965     *lp++ = htonl(0x7c0903a6); // mtctr r0
966     *lp = htonl(POWERPC_BCTR);
967     return true;
968     }
969    
970    
971     /*
972     * 68k emulator patches
973     */
974    
975     static bool patch_68k_emul(void)
976     {
977     uint32 *lp;
978     uint32 base;
979    
980     // Overwrite twi instructions
981 gbeauche 1.11 static const uint32 twi_loc[] = {0x36e680, 0x36e6c0, 0x36e6c0, 0x36e6c0, 0x36e740, 0x36e740};
982 cebix 1.1 base = twi_loc[ROMType];
983     lp = (uint32 *)(ROM_BASE + base);
984     *lp++ = htonl(0x48000000 + 0x36f900 - base); // b 0x36f900 (Emulator start)
985     *lp++ = htonl(0x48000000 + 0x36fa00 - base - 4); // b 0x36fa00 (Mixed mode)
986     *lp++ = htonl(0x48000000 + 0x36fb00 - base - 8); // b 0x36fb00 (Reset/FC1E opcode)
987     *lp++ = htonl(0x48000000 + 0x36fc00 - base - 12); // FE0A opcode
988     *lp++ = htonl(POWERPC_ILLEGAL); // Interrupt
989     *lp++ = htonl(POWERPC_ILLEGAL); // ?
990     *lp++ = htonl(POWERPC_ILLEGAL);
991     *lp++ = htonl(POWERPC_ILLEGAL);
992     *lp++ = htonl(POWERPC_ILLEGAL);
993     *lp++ = htonl(POWERPC_ILLEGAL);
994     *lp++ = htonl(POWERPC_ILLEGAL);
995     *lp++ = htonl(POWERPC_ILLEGAL);
996     *lp++ = htonl(POWERPC_ILLEGAL);
997     *lp++ = htonl(POWERPC_ILLEGAL);
998     *lp++ = htonl(POWERPC_ILLEGAL);
999     *lp = htonl(POWERPC_ILLEGAL);
1000    
1001     #if EMULATED_PPC
1002 gbeauche 1.7 // Install EMUL_RETURN, EXEC_RETURN, EXEC_NATIVE and EMUL_OP opcodes
1003 cebix 1.1 lp = (uint32 *)(ROM_BASE + 0x380000 + (M68K_EMUL_RETURN << 3));
1004     *lp++ = htonl(POWERPC_EMUL_OP);
1005     *lp++ = htonl(0x4bf66e80); // b 0x366084
1006     *lp++ = htonl(POWERPC_EMUL_OP | 1);
1007     *lp++ = htonl(0x4bf66e78); // b 0x366084
1008 gbeauche 1.7 *lp++ = htonl(POWERPC_EMUL_OP | 2);
1009     *lp++ = htonl(0x4bf66e70); // b 0x366084
1010 cebix 1.1 for (int i=0; i<OP_MAX; i++) {
1011 gbeauche 1.7 *lp++ = htonl(POWERPC_EMUL_OP | (i + 3));
1012     *lp++ = htonl(0x4bf66e68 - i*8); // b 0x366084
1013 cebix 1.1 }
1014     #else
1015     // Install EMUL_RETURN, EXEC_RETURN and EMUL_OP opcodes
1016     lp = (uint32 *)(ROM_BASE + 0x380000 + (M68K_EMUL_RETURN << 3));
1017     *lp++ = htonl(0x80000000 + XLM_EMUL_RETURN_PROC); // lwz r0,XLM_EMUL_RETURN_PROC
1018     *lp++ = htonl(0x4bf705fc); // b 0x36f800
1019     *lp++ = htonl(0x80000000 + XLM_EXEC_RETURN_PROC); // lwz r0,XLM_EXEC_RETURN_PROC
1020     *lp++ = htonl(0x4bf705f4); // b 0x36f800
1021 gbeauche 1.7 *lp++ = htonl(0x00dead00); // Let SheepShaver crash, since
1022     *lp++ = htonl(0x00beef00); // no native opcode is available
1023 cebix 1.1 for (int i=0; i<OP_MAX; i++) {
1024     *lp++ = htonl(0x38a00000 + i); // li r5,OP_*
1025 gbeauche 1.7 *lp++ = htonl(0x4bf705ec - i*8); // b 0x36f808
1026 cebix 1.1 }
1027    
1028     // Extra routines for EMUL_RETURN/EXEC_RETURN/EMUL_OP
1029     lp = (uint32 *)(ROM_BASE + 0x36f800);
1030     *lp++ = htonl(0x7c0803a6); // mtlr r0
1031     *lp++ = htonl(0x4e800020); // blr
1032    
1033     *lp++ = htonl(0x80000000 + XLM_EMUL_OP_PROC); // lwz r0,XLM_EMUL_OP_PROC
1034     *lp++ = htonl(0x7c0803a6); // mtlr r0
1035     *lp = htonl(0x4e800020); // blr
1036     #endif
1037    
1038     // Extra routine for 68k emulator start
1039     lp = (uint32 *)(ROM_BASE + 0x36f900);
1040     *lp++ = htonl(0x7c2903a6); // mtctr r1
1041 gbeauche 1.8 #if EMULATED_PPC
1042 gbeauche 1.18 *lp++ = htonl(NativeOpcode(NATIVE_DISABLE_INTERRUPT));
1043 gbeauche 1.8 #else
1044 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_IRQ_NEST); // lwz r1,XLM_IRQ_NEST
1045     *lp++ = htonl(0x38210001); // addi r1,r1,1
1046     *lp++ = htonl(0x90200000 + XLM_IRQ_NEST); // stw r1,XLM_IRQ_NEST
1047 gbeauche 1.8 #endif
1048 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_KERNEL_DATA);// lwz r1,XLM_KERNEL_DATA
1049     *lp++ = htonl(0x90c10018); // stw r6,0x18(r1)
1050     *lp++ = htonl(0x7cc902a6); // mfctr r6
1051     *lp++ = htonl(0x90c10004); // stw r6,$0004(r1)
1052     *lp++ = htonl(0x80c1065c); // lwz r6,$065c(r1)
1053     *lp++ = htonl(0x90e6013c); // stw r7,$013c(r6)
1054     *lp++ = htonl(0x91060144); // stw r8,$0144(r6)
1055     *lp++ = htonl(0x9126014c); // stw r9,$014c(r6)
1056     *lp++ = htonl(0x91460154); // stw r10,$0154(r6)
1057     *lp++ = htonl(0x9166015c); // stw r11,$015c(r6)
1058     *lp++ = htonl(0x91860164); // stw r12,$0164(r6)
1059     *lp++ = htonl(0x91a6016c); // stw r13,$016c(r6)
1060     *lp++ = htonl(0x7da00026); // mfcr r13
1061     *lp++ = htonl(0x80e10660); // lwz r7,$0660(r1)
1062     *lp++ = htonl(0x7d8802a6); // mflr r12
1063     *lp++ = htonl(0x50e74001); // rlwimi. r7,r7,8,$80000000
1064     *lp++ = htonl(0x814105f0); // lwz r10,0x05f0(r1)
1065     *lp++ = htonl(0x7d4803a6); // mtlr r10
1066     *lp++ = htonl(0x7d8a6378); // mr r10,r12
1067     *lp++ = htonl(0x3d600002); // lis r11,0x0002
1068     *lp++ = htonl(0x616bf072); // ori r11,r11,0xf072 (MSR)
1069     *lp++ = htonl(0x50e7deb4); // rlwimi r7,r7,27,$00000020
1070     *lp = htonl(0x4e800020); // blr
1071    
1072     // Extra routine for Mixed Mode
1073     lp = (uint32 *)(ROM_BASE + 0x36fa00);
1074     *lp++ = htonl(0x7c2903a6); // mtctr r1
1075 gbeauche 1.8 #if EMULATED_PPC
1076 gbeauche 1.18 *lp++ = htonl(NativeOpcode(NATIVE_DISABLE_INTERRUPT));
1077 gbeauche 1.8 #else
1078 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_IRQ_NEST); // lwz r1,XLM_IRQ_NEST
1079     *lp++ = htonl(0x38210001); // addi r1,r1,1
1080     *lp++ = htonl(0x90200000 + XLM_IRQ_NEST); // stw r1,XLM_IRQ_NEST
1081 gbeauche 1.8 #endif
1082 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_KERNEL_DATA);// lwz r1,XLM_KERNEL_DATA
1083     *lp++ = htonl(0x90c10018); // stw r6,0x18(r1)
1084     *lp++ = htonl(0x7cc902a6); // mfctr r6
1085     *lp++ = htonl(0x90c10004); // stw r6,$0004(r1)
1086     *lp++ = htonl(0x80c1065c); // lwz r6,$065c(r1)
1087     *lp++ = htonl(0x90e6013c); // stw r7,$013c(r6)
1088     *lp++ = htonl(0x91060144); // stw r8,$0144(r6)
1089     *lp++ = htonl(0x9126014c); // stw r9,$014c(r6)
1090     *lp++ = htonl(0x91460154); // stw r10,$0154(r6)
1091     *lp++ = htonl(0x9166015c); // stw r11,$015c(r6)
1092     *lp++ = htonl(0x91860164); // stw r12,$0164(r6)
1093     *lp++ = htonl(0x91a6016c); // stw r13,$016c(r6)
1094     *lp++ = htonl(0x7da00026); // mfcr r13
1095     *lp++ = htonl(0x80e10660); // lwz r7,$0660(r1)
1096     *lp++ = htonl(0x7d8802a6); // mflr r12
1097     *lp++ = htonl(0x50e74001); // rlwimi. r7,r7,8,$80000000
1098     *lp++ = htonl(0x814105f4); // lwz r10,0x05f4(r1)
1099     *lp++ = htonl(0x7d4803a6); // mtlr r10
1100     *lp++ = htonl(0x7d8a6378); // mr r10,r12
1101     *lp++ = htonl(0x3d600002); // lis r11,0x0002
1102     *lp++ = htonl(0x616bf072); // ori r11,r11,0xf072 (MSR)
1103     *lp++ = htonl(0x50e7deb4); // rlwimi r7,r7,27,$00000020
1104     *lp = htonl(0x4e800020); // blr
1105    
1106     // Extra routine for Reset/FC1E opcode
1107 gbeauche 1.4 lp = (uint32 *)(ROM_BASE + 0x36fb00);
1108 cebix 1.1 *lp++ = htonl(0x7c2903a6); // mtctr r1
1109 gbeauche 1.8 #if EMULATED_PPC
1110 gbeauche 1.18 *lp++ = htonl(NativeOpcode(NATIVE_DISABLE_INTERRUPT));
1111 gbeauche 1.8 #else
1112 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_IRQ_NEST); // lwz r1,XLM_IRQ_NEST
1113     *lp++ = htonl(0x38210001); // addi r1,r1,1
1114     *lp++ = htonl(0x90200000 + XLM_IRQ_NEST); // stw r1,XLM_IRQ_NEST
1115 gbeauche 1.8 #endif
1116 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_KERNEL_DATA);// lwz r1,XLM_KERNEL_DATA
1117     *lp++ = htonl(0x90c10018); // stw r6,0x18(r1)
1118     *lp++ = htonl(0x7cc902a6); // mfctr r6
1119     *lp++ = htonl(0x90c10004); // stw r6,$0004(r1)
1120     *lp++ = htonl(0x80c1065c); // lwz r6,$065c(r1)
1121     *lp++ = htonl(0x90e6013c); // stw r7,$013c(r6)
1122     *lp++ = htonl(0x91060144); // stw r8,$0144(r6)
1123     *lp++ = htonl(0x9126014c); // stw r9,$014c(r6)
1124     *lp++ = htonl(0x91460154); // stw r10,$0154(r6)
1125     *lp++ = htonl(0x9166015c); // stw r11,$015c(r6)
1126     *lp++ = htonl(0x91860164); // stw r12,$0164(r6)
1127     *lp++ = htonl(0x91a6016c); // stw r13,$016c(r6)
1128     *lp++ = htonl(0x7da00026); // mfcr r13
1129     *lp++ = htonl(0x80e10660); // lwz r7,$0660(r1)
1130     *lp++ = htonl(0x7d8802a6); // mflr r12
1131     *lp++ = htonl(0x50e74001); // rlwimi. r7,r7,8,$80000000
1132 gbeauche 1.4 *lp++ = htonl(0x814105f8); // lwz r10,0x05f8(r1)
1133 cebix 1.1 *lp++ = htonl(0x7d4803a6); // mtlr r10
1134     *lp++ = htonl(0x7d8a6378); // mr r10,r12
1135     *lp++ = htonl(0x3d600002); // lis r11,0x0002
1136     *lp++ = htonl(0x616bf072); // ori r11,r11,0xf072 (MSR)
1137     *lp++ = htonl(0x50e7deb4); // rlwimi r7,r7,27,$00000020
1138     *lp = htonl(0x4e800020); // blr
1139    
1140     // Extra routine for FE0A opcode (QuickDraw 3D needs this)
1141     lp = (uint32 *)(ROM_BASE + 0x36fc00);
1142     *lp++ = htonl(0x7c2903a6); // mtctr r1
1143 gbeauche 1.8 #if EMULATED_PPC
1144 gbeauche 1.18 *lp++ = htonl(NativeOpcode(NATIVE_DISABLE_INTERRUPT));
1145 gbeauche 1.8 #else
1146 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_IRQ_NEST); // lwz r1,XLM_IRQ_NEST
1147     *lp++ = htonl(0x38210001); // addi r1,r1,1
1148     *lp++ = htonl(0x90200000 + XLM_IRQ_NEST); // stw r1,XLM_IRQ_NEST
1149 gbeauche 1.8 #endif
1150 cebix 1.1 *lp++ = htonl(0x80200000 + XLM_KERNEL_DATA);// lwz r1,XLM_KERNEL_DATA
1151     *lp++ = htonl(0x90c10018); // stw r6,0x18(r1)
1152     *lp++ = htonl(0x7cc902a6); // mfctr r6
1153     *lp++ = htonl(0x90c10004); // stw r6,$0004(r1)
1154     *lp++ = htonl(0x80c1065c); // lwz r6,$065c(r1)
1155     *lp++ = htonl(0x90e6013c); // stw r7,$013c(r6)
1156     *lp++ = htonl(0x91060144); // stw r8,$0144(r6)
1157     *lp++ = htonl(0x9126014c); // stw r9,$014c(r6)
1158     *lp++ = htonl(0x91460154); // stw r10,$0154(r6)
1159     *lp++ = htonl(0x9166015c); // stw r11,$015c(r6)
1160     *lp++ = htonl(0x91860164); // stw r12,$0164(r6)
1161     *lp++ = htonl(0x91a6016c); // stw r13,$016c(r6)
1162     *lp++ = htonl(0x7da00026); // mfcr r13
1163     *lp++ = htonl(0x80e10660); // lwz r7,$0660(r1)
1164     *lp++ = htonl(0x7d8802a6); // mflr r12
1165     *lp++ = htonl(0x50e74001); // rlwimi. r7,r7,8,$80000000
1166 gbeauche 1.4 *lp++ = htonl(0x814105fc); // lwz r10,0x05fc(r1)
1167 cebix 1.1 *lp++ = htonl(0x7d4803a6); // mtlr r10
1168     *lp++ = htonl(0x7d8a6378); // mr r10,r12
1169     *lp++ = htonl(0x3d600002); // lis r11,0x0002
1170     *lp++ = htonl(0x616bf072); // ori r11,r11,0xf072 (MSR)
1171     *lp++ = htonl(0x50e7deb4); // rlwimi r7,r7,27,$00000020
1172     *lp = htonl(0x4e800020); // blr
1173    
1174     // Patch DR emulator to jump to right address when an interrupt occurs
1175     lp = (uint32 *)(ROM_BASE + 0x370000);
1176     while (lp < (uint32 *)(ROM_BASE + 0x380000)) {
1177     if (ntohl(*lp) == 0x4ca80020) // bclr 5,8
1178     goto dr_found;
1179     lp++;
1180     }
1181     D(bug("DR emulator patch location not found\n"));
1182     return false;
1183     dr_found:
1184     lp++;
1185     *lp = htonl(0x48000000 + 0xf000 - (((uint32)lp - ROM_BASE) & 0xffff)); // b DR_CACHE_BASE+0x1f000
1186     lp = (uint32 *)(ROM_BASE + 0x37f000);
1187     *lp++ = htonl(0x3c000000 + ((ROM_BASE + 0x46d0a4) >> 16)); // lis r0,xxx
1188     *lp++ = htonl(0x60000000 + ((ROM_BASE + 0x46d0a4) & 0xffff)); // ori r0,r0,xxx
1189     *lp++ = htonl(0x7c0903a6); // mtctr r0
1190     *lp = htonl(POWERPC_BCTR); // bctr
1191     return true;
1192     }
1193    
1194    
1195     /*
1196     * Nanokernel patches
1197     */
1198    
1199     static bool patch_nanokernel(void)
1200     {
1201     uint32 *lp;
1202    
1203     // Patch Mixed Mode trap
1204     lp = (uint32 *)(ROM_BASE + 0x313c90); // Don't translate virtual->physical
1205     while (ntohl(*lp) != 0x3ba10320) lp++;
1206     lp++;
1207     *lp++ = htonl(0x7f7fdb78); // mr r31,r27
1208     lp++;
1209     *lp = htonl(POWERPC_NOP);
1210    
1211     lp = (uint32 *)(ROM_BASE + 0x313c3c); // Don't activate PPC exception table
1212     while (ntohl(*lp) != 0x39010420) lp++;
1213     *lp++ = htonl(0x39000000 + MODE_NATIVE); // li r8,MODE_NATIVE
1214     *lp = htonl(0x91000000 + XLM_RUN_MODE); // stw r8,XLM_RUN_MODE
1215    
1216     lp = (uint32 *)(ROM_BASE + 0x312e88); // Don't modify MSR to turn on FPU
1217     while (ntohl(*lp) != 0x556b04e2) lp++;
1218     lp -= 4;
1219     *lp++ = htonl(POWERPC_NOP);
1220     lp++;
1221     *lp++ = htonl(POWERPC_NOP);
1222     lp++;
1223     *lp = htonl(POWERPC_NOP);
1224    
1225     lp = (uint32 *)(ROM_BASE + 0x312b3c); // Always save FPU state
1226     while (ntohl(*lp) != 0x81010668) lp++;
1227     lp--;
1228     *lp = htonl(0x48000000 | (ntohl(*lp) & 0xffff)); // bl 0x00312e88
1229    
1230     lp = (uint32 *)(ROM_BASE + 0x312b44); // Don't read DEC
1231     while (ntohl(*lp) != 0x7ff602a6) lp++;
1232     *lp = htonl(0x3be00000); // li r31,0
1233    
1234     lp = (uint32 *)(ROM_BASE + 0x312b50); // Don't write DEC
1235     while (ntohl(*lp) != 0x7d1603a6) lp++;
1236     #if 1
1237     *lp++ = htonl(POWERPC_NOP);
1238     *lp = htonl(POWERPC_NOP);
1239     #else
1240     *lp++ = htonl(0x39000040); // li r8,0x40
1241     *lp = htonl(0x990600e4); // stb r8,0xe4(r6)
1242     #endif
1243    
1244     lp = (uint32 *)(ROM_BASE + 0x312b9c); // Always restore FPU state
1245     while (ntohl(*lp) != 0x7c00092d) lp++;
1246     lp--;
1247     *lp = htonl(0x48000000 | (ntohl(*lp) & 0xffff)); // bl 0x00312ddc
1248    
1249     lp = (uint32 *)(ROM_BASE + 0x312a68); // Don't activate 68k exception table
1250     while (ntohl(*lp) != 0x39010360) lp++;
1251     *lp++ = htonl(0x39000000 + MODE_68K); // li r8,MODE_68K
1252     *lp = htonl(0x91000000 + XLM_RUN_MODE); // stw r8,XLM_RUN_MODE
1253    
1254     // Patch 68k emulator trap routine
1255     lp = (uint32 *)(ROM_BASE + 0x312994); // Always restore FPU state
1256     while (ntohl(*lp) != 0x39260040) lp++;
1257     lp--;
1258     *lp = htonl(0x48000000 | (ntohl(*lp) & 0xffff)); // bl 0x00312dd4
1259    
1260     lp = (uint32 *)(ROM_BASE + 0x312dd8); // Don't modify MSR to turn on FPU
1261     while (ntohl(*lp) != 0x810600e4) lp++;
1262     lp--;
1263     *lp++ = htonl(POWERPC_NOP);
1264     lp += 2;
1265     *lp++ = htonl(POWERPC_NOP);
1266     lp++;
1267     *lp++ = htonl(POWERPC_NOP);
1268     *lp++ = htonl(POWERPC_NOP);
1269     *lp = htonl(POWERPC_NOP);
1270    
1271     // Patch trap return routine
1272     lp = (uint32 *)(ROM_BASE + 0x312c20);
1273     while (ntohl(*lp) != 0x7d5a03a6) lp++;
1274     *lp++ = htonl(0x7d4903a6); // mtctr r10
1275     *lp++ = htonl(0x7daff120); // mtcr r13
1276     *lp = htonl(0x48000000 + 0x8000 - (((uint32)lp - ROM_BASE) & 0xffff)); // b ROM_BASE+0x318000
1277     uint32 xlp = ((uint32)(lp+1) - ROM_BASE) & 0xffff;
1278    
1279     lp = (uint32 *)(ROM_BASE + 0x312c50); // Replace rfi
1280     while (ntohl(*lp) != 0x4c000064) lp++;
1281     *lp = htonl(POWERPC_BCTR);
1282    
1283     lp = (uint32 *)(ROM_BASE + 0x318000);
1284 gbeauche 1.8 #if EMULATED_PPC
1285 gbeauche 1.18 *lp++ = htonl(NativeOpcode(NATIVE_ENABLE_INTERRUPT));
1286 gbeauche 1.8 *lp = htonl(0x48000000 + ((xlp - 0x8004) & 0x03fffffc)); // b ROM_BASE+0x312c2c
1287     #else
1288 cebix 1.1 *lp++ = htonl(0x81400000 + XLM_IRQ_NEST); // lwz r10,XLM_IRQ_NEST
1289     *lp++ = htonl(0x394affff); // subi r10,r10,1
1290     *lp++ = htonl(0x91400000 + XLM_IRQ_NEST); // stw r10,XLM_IRQ_NEST
1291     *lp = htonl(0x48000000 + ((xlp - 0x800c) & 0x03fffffc)); // b ROM_BASE+0x312c2c
1292 gbeauche 1.8 #endif
1293    
1294 cebix 1.1 /*
1295     // Disable FE0A/FE06 opcodes
1296     lp = (uint32 *)(ROM_BASE + 0x3144ac);
1297     *lp++ = htonl(POWERPC_NOP);
1298     *lp += 8;
1299     */
1300     return true;
1301     }
1302    
1303    
1304     /*
1305     * 68k boot routine patches
1306     */
1307    
1308     static bool patch_68k(void)
1309     {
1310     uint32 *lp;
1311     uint16 *wp;
1312     uint8 *bp;
1313     uint32 base;
1314    
1315     // Remove 68k RESET instruction
1316     static const uint8 reset_dat[] = {0x4e, 0x70};
1317     if ((base = find_rom_data(0xc8, 0x120, reset_dat, sizeof(reset_dat))) == 0) return false;
1318     D(bug("reset %08lx\n", base));
1319     wp = (uint16 *)(ROM_BASE + base);
1320     *wp = htons(M68K_NOP);
1321    
1322     // Fake reading PowerMac ID (via Universal)
1323     static const uint8 powermac_id_dat[] = {0x45, 0xf9, 0x5f, 0xff, 0xff, 0xfc, 0x20, 0x12, 0x72, 0x00};
1324     if ((base = find_rom_data(0xe000, 0x15000, powermac_id_dat, sizeof(powermac_id_dat))) == 0) return false;
1325     D(bug("powermac_id %08lx\n", base));
1326     wp = (uint16 *)(ROM_BASE + base);
1327     *wp++ = htons(0x203c); // move.l #id,d0
1328     *wp++ = htons(0);
1329     // if (ROMType == ROMTYPE_NEWWORLD)
1330     // *wp++ = htons(0x3035); // (PowerMac 9500 ID)
1331     // else
1332     *wp++ = htons(0x3020); // (PowerMac 9500 ID)
1333     *wp++ = htons(0xb040); // cmp.w d0,d0
1334     *wp = htons(0x4ed6); // jmp (a6)
1335    
1336     // Patch UniversalInfo
1337     if (ROMType == ROMTYPE_NEWWORLD) {
1338     static const uint8 univ_info_dat[] = {0x3f, 0xff, 0x04, 0x00};
1339 gbeauche 1.4 if ((base = find_rom_data(0x14000, 0x18000, univ_info_dat, sizeof(univ_info_dat))) == 0) return false;
1340 cebix 1.1 D(bug("universal_info %08lx\n", base));
1341     lp = (uint32 *)(ROM_BASE + base - 0x14);
1342     lp[0x00 >> 2] = htonl(ADDR_MAP_PATCH_SPACE - (base - 0x14));
1343     lp[0x10 >> 2] = htonl(0xcc003d11); // Make it like the PowerMac 9500 UniversalInfo
1344     lp[0x14 >> 2] = htonl(0x3fff0401);
1345     lp[0x18 >> 2] = htonl(0x0300001c);
1346     lp[0x1c >> 2] = htonl(0x000108c4);
1347     lp[0x24 >> 2] = htonl(0xc301bf26);
1348     lp[0x28 >> 2] = htonl(0x00000861);
1349     lp[0x58 >> 2] = htonl(0x30200000);
1350     lp[0x60 >> 2] = htonl(0x0000003d);
1351     } else if (ROMType == ROMTYPE_ZANZIBAR) {
1352     base = 0x12b70;
1353     lp = (uint32 *)(ROM_BASE + base - 0x14);
1354     lp[0x00 >> 2] = htonl(ADDR_MAP_PATCH_SPACE - (base - 0x14));
1355     lp[0x10 >> 2] = htonl(0xcc003d11); // Make it like the PowerMac 9500 UniversalInfo
1356     lp[0x14 >> 2] = htonl(0x3fff0401);
1357     lp[0x18 >> 2] = htonl(0x0300001c);
1358     lp[0x1c >> 2] = htonl(0x000108c4);
1359     lp[0x24 >> 2] = htonl(0xc301bf26);
1360     lp[0x28 >> 2] = htonl(0x00000861);
1361     lp[0x58 >> 2] = htonl(0x30200000);
1362     lp[0x60 >> 2] = htonl(0x0000003d);
1363 gbeauche 1.11 } else if (ROMType == ROMTYPE_GOSSAMER) {
1364     base = 0x12d20;
1365     lp = (uint32 *)(ROM_BASE + base - 0x14);
1366     lp[0x00 >> 2] = htonl(ADDR_MAP_PATCH_SPACE - (base - 0x14));
1367     lp[0x10 >> 2] = htonl(0xcc003d11); // Make it like the PowerMac 9500 UniversalInfo
1368     lp[0x14 >> 2] = htonl(0x3fff0401);
1369     lp[0x18 >> 2] = htonl(0x0300001c);
1370     lp[0x1c >> 2] = htonl(0x000108c4);
1371     lp[0x24 >> 2] = htonl(0xc301bf26);
1372     lp[0x28 >> 2] = htonl(0x00000861);
1373     lp[0x58 >> 2] = htonl(0x30410000);
1374     lp[0x60 >> 2] = htonl(0x0000003d);
1375 cebix 1.1 }
1376    
1377     // Construct AddrMap for NewWorld ROM
1378 gbeauche 1.11 if (ROMType == ROMTYPE_NEWWORLD || ROMType == ROMTYPE_ZANZIBAR || ROMType == ROMTYPE_GOSSAMER) {
1379 cebix 1.1 lp = (uint32 *)(ROM_BASE + ADDR_MAP_PATCH_SPACE);
1380     memset(lp - 10, 0, 0x128);
1381     lp[-10] = htonl(0x0300001c);
1382     lp[-9] = htonl(0x000108c4);
1383     lp[-4] = htonl(0x00300000);
1384     lp[-2] = htonl(0x11010000);
1385     lp[-1] = htonl(0xf8000000);
1386     lp[0] = htonl(0xffc00000);
1387     lp[2] = htonl(0xf3016000);
1388     lp[3] = htonl(0xf3012000);
1389     lp[4] = htonl(0xf3012000);
1390     lp[24] = htonl(0xf3018000);
1391     lp[25] = htonl(0xf3010000);
1392     lp[34] = htonl(0xf3011000);
1393     lp[38] = htonl(0xf3015000);
1394     lp[39] = htonl(0xf3014000);
1395     lp[43] = htonl(0xf3000000);
1396     lp[48] = htonl(0xf8000000);
1397     }
1398    
1399     // Don't initialize VIA (via Universal)
1400     static const uint8 via_init_dat[] = {0x08, 0x00, 0x00, 0x02, 0x67, 0x00, 0x00, 0x2c, 0x24, 0x68, 0x00, 0x08};
1401     if ((base = find_rom_data(0xe000, 0x15000, via_init_dat, sizeof(via_init_dat))) == 0) return false;
1402     D(bug("via_init %08lx\n", base));
1403     wp = (uint16 *)(ROM_BASE + base + 4);
1404     *wp = htons(0x6000); // bra
1405    
1406     static const uint8 via_init2_dat[] = {0x24, 0x68, 0x00, 0x08, 0x00, 0x12, 0x00, 0x30, 0x4e, 0x71};
1407     if ((base = find_rom_data(0xa000, 0x10000, via_init2_dat, sizeof(via_init2_dat))) == 0) return false;
1408     D(bug("via_init2 %08lx\n", base));
1409     wp = (uint16 *)(ROM_BASE + base);
1410     *wp = htons(0x4ed6); // jmp (a6)
1411    
1412     static const uint8 via_init3_dat[] = {0x22, 0x68, 0x00, 0x08, 0x28, 0x3c, 0x20, 0x00, 0x01, 0x00};
1413     if ((base = find_rom_data(0xa000, 0x10000, via_init3_dat, sizeof(via_init3_dat))) == 0) return false;
1414     D(bug("via_init3 %08lx\n", base));
1415     wp = (uint16 *)(ROM_BASE + base);
1416     *wp = htons(0x4ed6); // jmp (a6)
1417    
1418     // Don't RunDiags, get BootGlobs pointer directly
1419     if (ROMType == ROMTYPE_NEWWORLD) {
1420     static const uint8 run_diags_dat[] = {0x60, 0xff, 0x00, 0x0c};
1421     if ((base = find_rom_data(0x110, 0x128, run_diags_dat, sizeof(run_diags_dat))) == 0) return false;
1422     D(bug("run_diags %08lx\n", base));
1423     wp = (uint16 *)(ROM_BASE + base);
1424     *wp++ = htons(0x4df9); // lea xxx,a6
1425     *wp++ = htons((RAMBase + RAMSize - 0x1c) >> 16);
1426     *wp = htons((RAMBase + RAMSize - 0x1c) & 0xffff);
1427     } else {
1428     static const uint8 run_diags_dat[] = {0x74, 0x00, 0x2f, 0x0e};
1429     if ((base = find_rom_data(0xd0, 0xf0, run_diags_dat, sizeof(run_diags_dat))) == 0) return false;
1430     D(bug("run_diags %08lx\n", base));
1431     wp = (uint16 *)(ROM_BASE + base - 6);
1432     *wp++ = htons(0x4df9); // lea xxx,a6
1433     *wp++ = htons((RAMBase + RAMSize - 0x1c) >> 16);
1434     *wp = htons((RAMBase + RAMSize - 0x1c) & 0xffff);
1435     }
1436    
1437     // Replace NVRAM routines
1438     static const uint8 nvram1_dat[] = {0x48, 0xe7, 0x01, 0x0e, 0x24, 0x68, 0x00, 0x08, 0x08, 0x83, 0x00, 0x1f};
1439     if ((base = find_rom_data(0x7000, 0xc000, nvram1_dat, sizeof(nvram1_dat))) == 0) return false;
1440     D(bug("nvram1 %08lx\n", base));
1441     wp = (uint16 *)(ROM_BASE + base);
1442     *wp++ = htons(M68K_EMUL_OP_XPRAM1);
1443     *wp = htons(M68K_RTS);
1444    
1445     if (ROMType == ROMTYPE_NEWWORLD) {
1446     static const uint8 nvram2_dat[] = {0x48, 0xe7, 0x1c, 0xe0, 0x4f, 0xef, 0xff, 0xb4};
1447     if ((base = find_rom_data(0xa000, 0xd000, nvram2_dat, sizeof(nvram2_dat))) == 0) return false;
1448     D(bug("nvram2 %08lx\n", base));
1449     wp = (uint16 *)(ROM_BASE + base);
1450     *wp++ = htons(M68K_EMUL_OP_XPRAM2);
1451     *wp = htons(0x4ed3); // jmp (a3)
1452    
1453     static const uint8 nvram3_dat[] = {0x48, 0xe7, 0xdc, 0xe0, 0x4f, 0xef, 0xff, 0xb4};
1454     if ((base = find_rom_data(0xa000, 0xd000, nvram3_dat, sizeof(nvram3_dat))) == 0) return false;
1455     D(bug("nvram3 %08lx\n", base));
1456     wp = (uint16 *)(ROM_BASE + base);
1457     *wp++ = htons(M68K_EMUL_OP_XPRAM3);
1458     *wp = htons(0x4ed3); // jmp (a3)
1459    
1460     static const uint8 nvram4_dat[] = {0x4e, 0x56, 0xff, 0xa8, 0x48, 0xe7, 0x1f, 0x38, 0x16, 0x2e, 0x00, 0x13};
1461     if ((base = find_rom_data(0xa000, 0xd000, nvram4_dat, sizeof(nvram4_dat))) == 0) return false;
1462     D(bug("nvram4 %08lx\n", base));
1463     wp = (uint16 *)(ROM_BASE + base + 16);
1464     *wp++ = htons(0x1a2e); // move.b ($000f,a6),d5
1465     *wp++ = htons(0x000f);
1466     *wp++ = htons(M68K_EMUL_OP_NVRAM3);
1467     *wp++ = htons(0x4cee); // movem.l ($ff88,a6),d3-d7/a2-a4
1468     *wp++ = htons(0x1cf8);
1469     *wp++ = htons(0xff88);
1470     *wp++ = htons(0x4e5e); // unlk a6
1471     *wp = htons(M68K_RTS);
1472    
1473     static const uint8 nvram5_dat[] = {0x0c, 0x80, 0x03, 0x00, 0x00, 0x00, 0x66, 0x0a, 0x70, 0x00, 0x21, 0xf8, 0x02, 0x0c, 0x01, 0xe4};
1474     if ((base = find_rom_data(0xa000, 0xd000, nvram5_dat, sizeof(nvram5_dat))) == 0) return false;
1475     D(bug("nvram5 %08lx\n", base));
1476     wp = (uint16 *)(ROM_BASE + base + 6);
1477     *wp = htons(M68K_NOP);
1478    
1479     static const uint8 nvram6_dat[] = {0x2f, 0x0a, 0x24, 0x48, 0x4f, 0xef, 0xff, 0xa0, 0x20, 0x0f};
1480     if ((base = find_rom_data(0x9000, 0xb000, nvram6_dat, sizeof(nvram6_dat))) == 0) return false;
1481     D(bug("nvram6 %08lx\n", base));
1482     wp = (uint16 *)(ROM_BASE + base);
1483     *wp++ = htons(0x7000); // moveq #0,d0
1484     *wp++ = htons(0x2080); // move.l d0,(a0)
1485     *wp++ = htons(0x4228); // clr.b 4(a0)
1486     *wp++ = htons(0x0004);
1487     *wp = htons(M68K_RTS);
1488    
1489     static const uint8 nvram7_dat[] = {0x42, 0x2a, 0x00, 0x04, 0x4f, 0xef, 0x00, 0x60, 0x24, 0x5f, 0x4e, 0x75, 0x4f, 0xef, 0xff, 0xa0, 0x20, 0x0f};
1490     base = find_rom_data(0x9000, 0xb000, nvram7_dat, sizeof(nvram7_dat));
1491     if (base) {
1492     D(bug("nvram7 %08lx\n", base));
1493     wp = (uint16 *)(ROM_BASE + base + 12);
1494     *wp = htons(M68K_RTS);
1495     }
1496     } else {
1497     static const uint8 nvram2_dat[] = {0x4e, 0xd6, 0x06, 0x41, 0x13, 0x00};
1498     if ((base = find_rom_data(0x7000, 0xb000, nvram2_dat, sizeof(nvram2_dat))) == 0) return false;
1499     D(bug("nvram2 %08lx\n", base));
1500     wp = (uint16 *)(ROM_BASE + base + 2);
1501     *wp++ = htons(M68K_EMUL_OP_XPRAM2);
1502     *wp = htons(0x4ed3); // jmp (a3)
1503    
1504 gbeauche 1.11 static const uint8 nvram3_dat[] = {0x4e, 0xd3, 0x06, 0x41, 0x13, 0x00};
1505     if ((base = find_rom_data(0x7000, 0xb000, nvram3_dat, sizeof(nvram3_dat))) == 0) return false;
1506     D(bug("nvram3 %08lx\n", base));
1507     wp = (uint16 *)(ROM_BASE + base + 2);
1508     *wp++ = htons(M68K_EMUL_OP_XPRAM3);
1509     *wp = htons(0x4ed3); // jmp (a3)
1510    
1511     static const uint32 nvram4_loc[] = {0x582f0, 0xa0a0, 0x7e50, 0xa1d0, 0x538d0, 0};
1512     wp = (uint16 *)(ROM_BASE + nvram4_loc[ROMType]);
1513 cebix 1.1 *wp++ = htons(0x202f); // move.l 4(sp),d0
1514     *wp++ = htons(0x0004);
1515     *wp++ = htons(M68K_EMUL_OP_NVRAM1);
1516     if (ROMType == ROMTYPE_ZANZIBAR || ROMType == ROMTYPE_GAZELLE)
1517     *wp = htons(M68K_RTS);
1518     else {
1519     *wp++ = htons(0x1f40); // move.b d0,8(sp)
1520     *wp++ = htons(0x0008);
1521     *wp++ = htons(0x4e74); // rtd #4
1522     *wp = htons(0x0004);
1523     }
1524    
1525 gbeauche 1.11 static const uint32 nvram5_loc[] = {0x58460, 0xa0f0, 0x7f40, 0xa220, 0x53a20, 0};
1526     wp = (uint16 *)(ROM_BASE + nvram5_loc[ROMType]);
1527 cebix 1.1 if (ROMType == ROMTYPE_ZANZIBAR || ROMType == ROMTYPE_GAZELLE) {
1528     *wp++ = htons(0x202f); // move.l 4(sp),d0
1529     *wp++ = htons(0x0004);
1530     *wp++ = htons(0x122f); // move.b 11(sp),d1
1531     *wp++ = htons(0x000b);
1532     *wp++ = htons(M68K_EMUL_OP_NVRAM2);
1533     *wp = htons(M68K_RTS);
1534     } else {
1535     *wp++ = htons(0x202f); // move.l 6(sp),d0
1536     *wp++ = htons(0x0006);
1537     *wp++ = htons(0x122f); // move.b 4(sp),d1
1538     *wp++ = htons(0x0004);
1539     *wp++ = htons(M68K_EMUL_OP_NVRAM2);
1540     *wp++ = htons(0x4e74); // rtd #6
1541     *wp = htons(0x0006);
1542     }
1543     }
1544    
1545     // Fix MemTop/BootGlobs during system startup
1546     static const uint8 mem_top_dat[] = {0x2c, 0x6c, 0xff, 0xec, 0x2a, 0x4c, 0xdb, 0xec, 0xff, 0xf4};
1547     if ((base = find_rom_data(0x120, 0x180, mem_top_dat, sizeof(mem_top_dat))) == 0) return false;
1548     D(bug("mem_top %08lx\n", base));
1549     wp = (uint16 *)(ROM_BASE + base);
1550     *wp++ = htons(M68K_EMUL_OP_FIX_MEMTOP);
1551     *wp = htons(M68K_NOP);
1552    
1553     // Don't initialize SCC (via 0x1ac)
1554     static const uint8 scc_init_dat[] = {0x48, 0xe7, 0x38, 0xfe};
1555     if ((base = find_rom_data(0x190, 0x1f0, scc_init_dat, sizeof(scc_init_dat))) == 0) return false;
1556     D(bug("scc_init %08lx\n", base));
1557     wp = (uint16 *)(ROM_BASE + base - 2);
1558     wp = (uint16 *)(ROM_BASE + ntohs(*wp) + base - 2);
1559     *wp++ = htons(M68K_EMUL_OP_RESET);
1560     *wp = htons(M68K_RTS);
1561    
1562     // Don't EnableExtCache (via 0x1f6) and don't DisableIntSources(via 0x1fc)
1563     static const uint8 ext_cache_dat[] = {0x4e, 0x7b, 0x00, 0x02};
1564     if ((base = find_rom_data(0x1d0, 0x230, ext_cache_dat, sizeof(ext_cache_dat))) == 0) return false;
1565     D(bug("ext_cache %08lx\n", base));
1566     lp = (uint32 *)(ROM_BASE + base + 6);
1567     wp = (uint16 *)(ROM_BASE + ntohl(*lp) + base + 6);
1568     *wp = htons(M68K_RTS);
1569     lp = (uint32 *)(ROM_BASE + base + 12);
1570     wp = (uint16 *)(ROM_BASE + ntohl(*lp) + base + 12);
1571     *wp = htons(M68K_RTS);
1572    
1573     // Fake CPU speed test (SetupTimeK)
1574     static const uint8 timek_dat[] = {0x0c, 0x38, 0x00, 0x04, 0x01, 0x2f, 0x6d, 0x3c};
1575     if ((base = find_rom_data(0x400, 0x500, timek_dat, sizeof(timek_dat))) == 0) return false;
1576     D(bug("timek %08lx\n", base));
1577     wp = (uint16 *)(ROM_BASE + base);
1578     *wp++ = htons(0x31fc); // move.w #xxx,TimeDBRA
1579     *wp++ = htons(100);
1580     *wp++ = htons(0x0d00);
1581     *wp++ = htons(0x31fc); // move.w #xxx,TimeSCCDBRA
1582     *wp++ = htons(100);
1583     *wp++ = htons(0x0d02);
1584     *wp++ = htons(0x31fc); // move.w #xxx,TimeSCSIDBRA
1585     *wp++ = htons(100);
1586     *wp++ = htons(0x0b24);
1587     *wp++ = htons(0x31fc); // move.w #xxx,TimeRAMDBRA
1588     *wp++ = htons(100);
1589     *wp++ = htons(0x0cea);
1590     *wp = htons(M68K_RTS);
1591    
1592     // Relocate jump tables ($2000..)
1593     static const uint8 jump_tab_dat[] = {0x41, 0xfa, 0x00, 0x0e, 0x21, 0xc8, 0x20, 0x10, 0x4e, 0x75};
1594     if ((base = find_rom_data(0x3000, 0x6000, jump_tab_dat, sizeof(jump_tab_dat))) == 0) return false;
1595     D(bug("jump_tab %08lx\n", base));
1596     lp = (uint32 *)(ROM_BASE + base + 16);
1597     for (;;) {
1598     D(bug(" %08lx\n", (uint32)lp - ROM_BASE));
1599     while ((ntohl(*lp) & 0xff000000) == 0xff000000) {
1600     *lp = htonl((ntohl(*lp) & (ROM_SIZE-1)) + ROM_BASE);
1601     lp++;
1602     }
1603     while (!ntohl(*lp)) lp++;
1604     if (ntohl(*lp) != 0x41fa000e)
1605     break;
1606     lp += 4;
1607     }
1608    
1609     // Create SysZone at start of Mac RAM (SetSysAppZone, via 0x22a)
1610     static const uint8 sys_zone_dat[] = {0x00, 0x00, 0x28, 0x00, 0x00, 0x00, 0x40, 0x00};
1611     if ((base = find_rom_data(0x600, 0x900, sys_zone_dat, sizeof(sys_zone_dat))) == 0) return false;
1612     D(bug("sys_zone %08lx\n", base));
1613     lp = (uint32 *)(ROM_BASE + base);
1614     *lp++ = htonl(RAMBase ? RAMBase : 0x3000);
1615     *lp = htonl(RAMBase ? RAMBase + 0x1800 : 0x4800);
1616    
1617     // Set boot stack at RAMBase+4MB and fix logical/physical RAM size (CompBootStack)
1618     // The RAM size fix must be done after InitMemMgr!
1619     static const uint8 boot_stack_dat[] = {0x08, 0x38, 0x00, 0x06, 0x24, 0x0b};
1620     if ((base = find_rom_data(0x580, 0x800, boot_stack_dat, sizeof(boot_stack_dat))) == 0) return false;
1621     D(bug("boot_stack %08lx\n", base));
1622     wp = (uint16 *)(ROM_BASE + base);
1623     *wp++ = htons(0x207c); // move.l #RAMBase+0x3ffffe,a0
1624     *wp++ = htons((RAMBase + 0x3ffffe) >> 16);
1625     *wp++ = htons((RAMBase + 0x3ffffe) & 0xffff);
1626     *wp++ = htons(M68K_EMUL_OP_FIX_MEMSIZE);
1627     *wp = htons(M68K_RTS);
1628    
1629     // Get PowerPC page size (InitVMemMgr, via 0x240)
1630     static const uint8 page_size_dat[] = {0x20, 0x30, 0x81, 0xf2, 0x5f, 0xff, 0xef, 0xd8, 0x00, 0x10};
1631     if ((base = find_rom_data(0xb000, 0x12000, page_size_dat, sizeof(page_size_dat))) == 0) return false;
1632     D(bug("page_size %08lx\n", base));
1633     wp = (uint16 *)(ROM_BASE + base);
1634     *wp++ = htons(0x203c); // move.l #$1000,d0
1635     *wp++ = htons(0);
1636     *wp++ = htons(0x1000);
1637     *wp++ = htons(M68K_NOP);
1638     *wp = htons(M68K_NOP);
1639    
1640     // Gestalt PowerPC page size, RAM size (InitGestalt, via 0x25c)
1641     static const uint8 page_size2_dat[] = {0x26, 0x79, 0x5f, 0xff, 0xef, 0xd8, 0x25, 0x6b, 0x00, 0x10, 0x00, 0x1e};
1642     if ((base = find_rom_data(0x50000, 0x70000, page_size2_dat, sizeof(page_size2_dat))) == 0) return false;
1643     D(bug("page_size2 %08lx\n", base));
1644     wp = (uint16 *)(ROM_BASE + base);
1645     *wp++ = htons(0x257c); // move.l #$1000,$1e(a2)
1646     *wp++ = htons(0);
1647     *wp++ = htons(0x1000);
1648     *wp++ = htons(0x001e);
1649     *wp++ = htons(0x157c); // move.b #PVR,$1d(a2)
1650     *wp++ = htons(PVR >> 16);
1651     *wp++ = htons(0x001d);
1652     *wp++ = htons(0x263c); // move.l #RAMSize,d3
1653     *wp++ = htons(RAMSize >> 16);
1654     *wp++ = htons(RAMSize & 0xffff);
1655     *wp++ = htons(M68K_NOP);
1656     *wp++ = htons(M68K_NOP);
1657     *wp = htons(M68K_NOP);
1658     if (ROMType == ROMTYPE_NEWWORLD)
1659     wp = (uint16 *)(ROM_BASE + base + 0x4a);
1660     else
1661     wp = (uint16 *)(ROM_BASE + base + 0x28);
1662     *wp++ = htons(M68K_NOP);
1663     *wp = htons(M68K_NOP);
1664    
1665     // Gestalt CPU/bus clock speed (InitGestalt, via 0x25c)
1666     if (ROMType == ROMTYPE_ZANZIBAR) {
1667     wp = (uint16 *)(ROM_BASE + 0x5d87a);
1668     *wp++ = htons(0x203c); // move.l #Hz,d0
1669     *wp++ = htons(BusClockSpeed >> 16);
1670     *wp++ = htons(BusClockSpeed & 0xffff);
1671     *wp++ = htons(M68K_NOP);
1672     *wp = htons(M68K_NOP);
1673     wp = (uint16 *)(ROM_BASE + 0x5d888);
1674     *wp++ = htons(0x203c); // move.l #Hz,d0
1675     *wp++ = htons(CPUClockSpeed >> 16);
1676     *wp++ = htons(CPUClockSpeed & 0xffff);
1677     *wp++ = htons(M68K_NOP);
1678     *wp = htons(M68K_NOP);
1679     }
1680    
1681     // Don't write to GC interrupt mask register (via 0x262)
1682     if (ROMType != ROMTYPE_NEWWORLD) {
1683     static const uint8 gc_mask_dat[] = {0x83, 0xa8, 0x00, 0x24, 0x4e, 0x71};
1684     if ((base = find_rom_data(0x13000, 0x20000, gc_mask_dat, sizeof(gc_mask_dat))) == 0) return false;
1685     D(bug("gc_mask %08lx\n", base));
1686     wp = (uint16 *)(ROM_BASE + base);
1687     *wp++ = htons(M68K_NOP);
1688     *wp = htons(M68K_NOP);
1689     wp = (uint16 *)(ROM_BASE + base + 0x40);
1690     *wp++ = htons(M68K_NOP);
1691     *wp = htons(M68K_NOP);
1692     wp = (uint16 *)(ROM_BASE + base + 0x78);
1693     *wp++ = htons(M68K_NOP);
1694     *wp = htons(M68K_NOP);
1695     wp = (uint16 *)(ROM_BASE + base + 0x96);
1696     *wp++ = htons(M68K_NOP);
1697     *wp = htons(M68K_NOP);
1698    
1699     static const uint8 gc_mask2_dat[] = {0x02, 0xa8, 0x00, 0x00, 0x00, 0x80, 0x00, 0x24};
1700     if ((base = find_rom_data(0x13000, 0x20000, gc_mask2_dat, sizeof(gc_mask2_dat))) == 0) return false;
1701     D(bug("gc_mask2 %08lx\n", base));
1702     wp = (uint16 *)(ROM_BASE + base);
1703 gbeauche 1.11 if (ROMType == ROMTYPE_GOSSAMER)
1704     *wp++ = htons(M68K_NOP);
1705 cebix 1.1 for (int i=0; i<5; i++) {
1706     *wp++ = htons(M68K_NOP);
1707     *wp++ = htons(M68K_NOP);
1708     *wp++ = htons(M68K_NOP);
1709     *wp++ = htons(M68K_NOP);
1710     wp += 2;
1711     }
1712 gbeauche 1.11 if (ROMType == ROMTYPE_ZANZIBAR || ROMType == ROMTYPE_GOSSAMER) {
1713 cebix 1.1 for (int i=0; i<6; i++) {
1714     *wp++ = htons(M68K_NOP);
1715     *wp++ = htons(M68K_NOP);
1716     *wp++ = htons(M68K_NOP);
1717     *wp++ = htons(M68K_NOP);
1718     wp += 2;
1719     }
1720     }
1721     }
1722    
1723     // Don't initialize Cuda (via 0x274)
1724     static const uint8 cuda_init_dat[] = {0x08, 0xa9, 0x00, 0x04, 0x16, 0x00, 0x4e, 0x71, 0x13, 0x7c, 0x00, 0x84, 0x1c, 0x00, 0x4e, 0x71};
1725     if ((base = find_rom_data(0xa000, 0x12000, cuda_init_dat, sizeof(cuda_init_dat))) == 0) return false;
1726     D(bug("cuda_init %08lx\n", base));
1727     wp = (uint16 *)(ROM_BASE + base);
1728     *wp++ = htons(M68K_NOP);
1729     *wp++ = htons(M68K_NOP);
1730     *wp++ = htons(M68K_NOP);
1731     *wp++ = htons(M68K_NOP);
1732     *wp++ = htons(M68K_NOP);
1733     *wp++ = htons(M68K_NOP);
1734     *wp = htons(M68K_NOP);
1735    
1736     // Patch GetCPUSpeed (via 0x27a) (some ROMs have two of them)
1737     static const uint8 cpu_speed_dat[] = {0x20, 0x30, 0x81, 0xf2, 0x5f, 0xff, 0xef, 0xd8, 0x00, 0x04, 0x4c, 0x7c};
1738 gbeauche 1.4 if ((base = find_rom_data(0x6000, 0xa000, cpu_speed_dat, sizeof(cpu_speed_dat))) == 0) return false;
1739 cebix 1.1 D(bug("cpu_speed %08lx\n", base));
1740     wp = (uint16 *)(ROM_BASE + base);
1741     *wp++ = htons(0x203c); // move.l #(MHz<<16)|MHz,d0
1742     *wp++ = htons(CPUClockSpeed / 1000000);
1743     *wp++ = htons(CPUClockSpeed / 1000000);
1744     *wp = htons(M68K_RTS);
1745 gbeauche 1.4 if ((base = find_rom_data(base, 0xa000, cpu_speed_dat, sizeof(cpu_speed_dat))) != 0) {
1746 cebix 1.1 D(bug("cpu_speed2 %08lx\n", base));
1747     wp = (uint16 *)(ROM_BASE + base);
1748     *wp++ = htons(0x203c); // move.l #(MHz<<16)|MHz,d0
1749     *wp++ = htons(CPUClockSpeed / 1000000);
1750     *wp++ = htons(CPUClockSpeed / 1000000);
1751     *wp = htons(M68K_RTS);
1752     }
1753    
1754     // Don't poke VIA in InitTimeMgr (via 0x298)
1755     static const uint8 time_via_dat[] = {0x40, 0xe7, 0x00, 0x7c, 0x07, 0x00, 0x28, 0x78, 0x01, 0xd4, 0x43, 0xec, 0x10, 0x00};
1756     if ((base = find_rom_data(0x30000, 0x40000, time_via_dat, sizeof(time_via_dat))) == 0) return false;
1757     D(bug("time_via %08lx\n", base));
1758     wp = (uint16 *)(ROM_BASE + base);
1759     *wp++ = htons(0x4cdf); // movem.l (sp)+,d0-d5/a0-a4
1760     *wp++ = htons(0x1f3f);
1761     *wp = htons(M68K_RTS);
1762    
1763     // Don't read from 0xff800000 (Name Registry, Open Firmware?) (via 0x2a2)
1764     // Remove this if FE03 works!!
1765     static const uint8 open_firmware_dat[] = {0x2f, 0x79, 0xff, 0x80, 0x00, 0x00, 0x00, 0xfc};
1766     if ((base = find_rom_data(0x48000, 0x58000, open_firmware_dat, sizeof(open_firmware_dat))) == 0) return false;
1767     D(bug("open_firmware %08lx\n", base));
1768     wp = (uint16 *)(ROM_BASE + base);
1769     *wp++ = htons(0x2f7c); // move.l #deadbeef,0xfc(a7)
1770     *wp++ = htons(0xdead);
1771     *wp++ = htons(0xbeef);
1772     *wp = htons(0x00fc);
1773     wp = (uint16 *)(ROM_BASE + base + 0x1a);
1774     *wp++ = htons(M68K_NOP); // (FE03 opcode, tries to jump to 0xdeadbeef)
1775     *wp = htons(M68K_NOP);
1776    
1777     // Don't EnableExtCache (via 0x2b2)
1778     static const uint8 ext_cache2_dat[] = {0x4f, 0xef, 0xff, 0xec, 0x20, 0x4f, 0x10, 0xbc, 0x00, 0x01, 0x11, 0x7c, 0x00, 0x1b};
1779     if ((base = find_rom_data(0x13000, 0x20000, ext_cache2_dat, sizeof(ext_cache2_dat))) == 0) return false;
1780     D(bug("ext_cache2 %08lx\n", base));
1781     wp = (uint16 *)(ROM_BASE + base);
1782     *wp = htons(M68K_RTS);
1783    
1784     // Don't install Time Manager task for 60Hz interrupt (Enable60HzInts, via 0x2b8)
1785 gbeauche 1.13 if (ROMType == ROMTYPE_NEWWORLD || ROMType == ROMTYPE_GOSSAMER) {
1786 cebix 1.1 static const uint8 tm_task_dat[] = {0x30, 0x3c, 0x4e, 0x2b, 0xa9, 0xc9};
1787 gbeauche 1.13 if ((base = find_rom_data(0x2a0, 0x320, tm_task_dat, sizeof(tm_task_dat))) == 0) return false;
1788 cebix 1.1 D(bug("tm_task %08lx\n", base));
1789 gbeauche 1.13 wp = (uint16 *)(ROM_BASE + base + 28);
1790 cebix 1.1 *wp++ = htons(M68K_NOP);
1791     *wp++ = htons(M68K_NOP);
1792     *wp++ = htons(M68K_NOP);
1793     *wp++ = htons(M68K_NOP);
1794     *wp++ = htons(M68K_NOP);
1795     *wp = htons(M68K_NOP);
1796     } else {
1797     static const uint8 tm_task_dat[] = {0x20, 0x3c, 0x73, 0x79, 0x73, 0x61};
1798     if ((base = find_rom_data(0x280, 0x300, tm_task_dat, sizeof(tm_task_dat))) == 0) return false;
1799     D(bug("tm_task %08lx\n", base));
1800     wp = (uint16 *)(ROM_BASE + base - 6);
1801     *wp++ = htons(M68K_NOP);
1802     *wp++ = htons(M68K_NOP);
1803     *wp = htons(M68K_NOP);
1804     }
1805    
1806     // Don't read PVR from 0x5fffef80 in DriverServicesLib (via 0x316)
1807 gbeauche 1.11 if (ROMType != ROMTYPE_NEWWORLD && ROMType != ROMTYPE_GOSSAMER) {
1808 cebix 1.1 uint32 dsl_offset = find_rom_resource(FOURCC('n','l','i','b'), -16401);
1809     if (ROMType == ROMTYPE_ZANZIBAR) {
1810     static const uint8 dsl_pvr_dat[] = {0x40, 0x82, 0x00, 0x40, 0x38, 0x60, 0xef, 0x80, 0x3c, 0x63, 0x60, 0x00, 0x80, 0x83, 0x00, 0x00, 0x54, 0x84, 0x84, 0x3e};
1811     if ((base = find_rom_data(dsl_offset, dsl_offset + 0x6000, dsl_pvr_dat, sizeof(dsl_pvr_dat))) == 0) return false;
1812     } else {
1813     static const uint8 dsl_pvr_dat[] = {0x3b, 0xc3, 0x00, 0x00, 0x30, 0x84, 0xff, 0xa0, 0x40, 0x82, 0x00, 0x44, 0x80, 0x84, 0xef, 0xe0, 0x54, 0x84, 0x84, 0x3e};
1814     if ((base = find_rom_data(dsl_offset, dsl_offset + 0x6000, dsl_pvr_dat, sizeof(dsl_pvr_dat))) == 0) return false;
1815     }
1816     D(bug("dsl_pvr %08lx\n", base));
1817     lp = (uint32 *)(ROM_BASE + base + 12);
1818     *lp = htonl(0x3c800000 | (PVR >> 16)); // lis r4,PVR
1819    
1820     // Don't read bus clock from 0x5fffef88 in DriverServicesLib (via 0x316)
1821     if (ROMType == ROMTYPE_ZANZIBAR) {
1822     static const uint8 dsl_bus_dat[] = {0x81, 0x07, 0x00, 0x00, 0x39, 0x20, 0x42, 0x40, 0x81, 0x62, 0xff, 0x20};
1823     if ((base = find_rom_data(dsl_offset, dsl_offset + 0x6000, dsl_bus_dat, sizeof(dsl_bus_dat))) == 0) return false;
1824     D(bug("dsl_bus %08lx\n", base));
1825     lp = (uint32 *)(ROM_BASE + base);
1826     *lp = htonl(0x81000000 + XLM_BUS_CLOCK); // lwz r8,(bus clock speed)
1827     } else {
1828     static const uint8 dsl_bus_dat[] = {0x80, 0x83, 0xef, 0xe8, 0x80, 0x62, 0x00, 0x10, 0x7c, 0x04, 0x03, 0x96};
1829     if ((base = find_rom_data(dsl_offset, dsl_offset + 0x6000, dsl_bus_dat, sizeof(dsl_bus_dat))) == 0) return false;
1830     D(bug("dsl_bus %08lx\n", base));
1831     lp = (uint32 *)(ROM_BASE + base);
1832     *lp = htonl(0x80800000 + XLM_BUS_CLOCK); // lwz r4,(bus clock speed)
1833     }
1834     }
1835    
1836     // Don't open InterruptTreeTNT in MotherBoardHAL init in DriverServicesLib init
1837     if (ROMType == ROMTYPE_ZANZIBAR) {
1838     lp = (uint32 *)(ROM_BASE + find_rom_resource(FOURCC('n','l','i','b'), -16408) + 0x16c);
1839     *lp = htonl(0x38600000); // li r3,0
1840     }
1841    
1842 gbeauche 1.19 // FIXME: Fake reading from [HpChk]+4 (the callchain reports some function from DriverServicesLib)
1843     if (1) {
1844     uint32 hpchk_offset = find_rom_resource(FOURCC('n','l','i','b'), 10);
1845     static const uint8 hpchk_dat[] = {0x80, 0x80, 0x03, 0x16, 0x94, 0x21, 0xff, 0xb0, 0x83, 0xc4, 0x00, 0x04};
1846     if ((base = find_rom_data(hpchk_offset, hpchk_offset + 0x3000, hpchk_dat, sizeof(hpchk_dat))) == 0) return false;
1847     D(bug("hpchk %08lx\n", base));
1848     lp = (uint32 *)(ROM_BASE + base);
1849     *lp = htonl(0x80800000 + XLM_ZERO_PAGE); // lwz r4,(zero page)
1850     }
1851    
1852 cebix 1.1 // Patch Name Registry
1853     static const uint8 name_reg_dat[] = {0x70, 0xff, 0xab, 0xeb};
1854     if ((base = find_rom_data(0x300, 0x380, name_reg_dat, sizeof(name_reg_dat))) == 0) return false;
1855     D(bug("name_reg %08lx\n", base));
1856     wp = (uint16 *)(ROM_BASE + base);
1857     *wp = htons(M68K_EMUL_OP_NAME_REGISTRY);
1858    
1859     #if DISABLE_SCSI
1860     // Fake SCSI Manager
1861     // Remove this if SCSI Manager works!!
1862     static const uint8 scsi_mgr_a_dat[] = {0x4e, 0x56, 0x00, 0x00, 0x20, 0x3c, 0x00, 0x00, 0x04, 0x0c, 0xa7, 0x1e};
1863     static const uint8 scsi_mgr_b_dat[] = {0x4e, 0x56, 0x00, 0x00, 0x2f, 0x0c, 0x20, 0x3c, 0x00, 0x00, 0x04, 0x0c, 0xa7, 0x1e};
1864     if ((base = find_rom_data(0x1c000, 0x28000, scsi_mgr_a_dat, sizeof(scsi_mgr_a_dat))) == 0) {
1865     if ((base = find_rom_data(0x1c000, 0x28000, scsi_mgr_b_dat, sizeof(scsi_mgr_b_dat))) == 0) return false;
1866     }
1867     D(bug("scsi_mgr %08lx\n", base));
1868     wp = (uint16 *)(ROM_BASE + base);
1869     *wp++ = htons(0x21fc); // move.l #xxx,0x624 (SCSIAtomic)
1870     *wp++ = htons((ROM_BASE + base + 18) >> 16);
1871     *wp++ = htons((ROM_BASE + base + 18) & 0xffff);
1872     *wp++ = htons(0x0624);
1873     *wp++ = htons(0x21fc); // move.l #xxx,0xe54 (SCSIDispatch)
1874     *wp++ = htons((ROM_BASE + base + 22) >> 16);
1875     *wp++ = htons((ROM_BASE + base + 22) & 0xffff);
1876     *wp++ = htons(0x0e54);
1877     *wp++ = htons(M68K_RTS);
1878     *wp++ = htons(M68K_EMUL_OP_SCSI_ATOMIC);
1879     *wp++ = htons(M68K_RTS);
1880     *wp++ = htons(M68K_EMUL_OP_SCSI_DISPATCH);
1881     *wp = htons(0x4ed0); // jmp (a0)
1882     wp = (uint16 *)(ROM_BASE + base + 0x20);
1883     *wp++ = htons(0x7000); // moveq #0,d0
1884     *wp = htons(M68K_RTS);
1885     #endif
1886    
1887     #if DISABLE_SCSI
1888     // Don't access SCSI variables
1889     // Remove this if SCSI Manager works!!
1890     if (ROMType == ROMTYPE_NEWWORLD) {
1891     static const uint8 scsi_var_dat[] = {0x70, 0x01, 0xa0, 0x89, 0x4a, 0x6e, 0xfe, 0xac, 0x4f, 0xef, 0x00, 0x10, 0x66, 0x00};
1892     if ((base = find_rom_data(0x1f500, 0x1f600, scsi_var_dat, sizeof(scsi_var_dat))) != 0) {
1893     D(bug("scsi_var %08lx\n", base));
1894     wp = (uint16 *)(ROM_BASE + base + 12);
1895     *wp = htons(0x6000); // bra
1896     }
1897    
1898     static const uint8 scsi_var2_dat[] = {0x4e, 0x56, 0xfc, 0x58, 0x48, 0xe7, 0x1f, 0x38};
1899     if ((base = find_rom_data(0x1f700, 0x1f800, scsi_var2_dat, sizeof(scsi_var2_dat))) != 0) {
1900     D(bug("scsi_var2 %08lx\n", base));
1901     wp = (uint16 *)(ROM_BASE + base);
1902     *wp++ = htons(0x7000); // moveq #0,d0
1903 gbeauche 1.11 *wp = htons(M68K_RTS);
1904     }
1905     }
1906     else if (ROMType == ROMTYPE_GOSSAMER) {
1907     static const uint8 scsi_var_dat[] = {0x70, 0x01, 0xa0, 0x89, 0x4a, 0x6e, 0xfe, 0xac, 0x4f, 0xef, 0x00, 0x10, 0x66, 0x00};
1908     if ((base = find_rom_data(0x1d700, 0x1d800, scsi_var_dat, sizeof(scsi_var_dat))) != 0) {
1909     D(bug("scsi_var %08lx\n", base));
1910     wp = (uint16 *)(ROM_BASE + base + 12);
1911     *wp = htons(0x6000); // bra
1912     }
1913    
1914     static const uint8 scsi_var2_dat[] = {0x4e, 0x56, 0xfc, 0x5a, 0x48, 0xe7, 0x1f, 0x38};
1915     if ((base = find_rom_data(0x1d900, 0x1da00, scsi_var2_dat, sizeof(scsi_var2_dat))) != 0) {
1916     D(bug("scsi_var2 %08lx\n", base));
1917     wp = (uint16 *)(ROM_BASE + base);
1918     *wp++ = htons(0x7000); // moveq #0,d0
1919     *wp = htons(M68K_RTS);
1920 cebix 1.1 }
1921     }
1922     #endif
1923    
1924     // Don't wait in ADBInit (via 0x36c)
1925     static const uint8 adb_init_dat[] = {0x08, 0x2b, 0x00, 0x05, 0x01, 0x5d, 0x66, 0xf8};
1926     if ((base = find_rom_data(0x31000, 0x3d000, adb_init_dat, sizeof(adb_init_dat))) == 0) return false;
1927     D(bug("adb_init %08lx\n", base));
1928     wp = (uint16 *)(ROM_BASE + base + 6);
1929     *wp = htons(M68K_NOP);
1930    
1931     // Modify check in InitResources() so that addresses >0x80000000 work
1932     static const uint8 init_res_dat[] = {0x4a, 0xb8, 0x0a, 0x50, 0x6e, 0x20};
1933     if ((base = find_rom_data(0x78000, 0x8c000, init_res_dat, sizeof(init_res_dat))) == 0) return false;
1934     D(bug("init_res %08lx\n", base));
1935     bp = (uint8 *)(ROM_BASE + base + 4);
1936     *bp = 0x66;
1937    
1938     // Modify vCheckLoad() so that we can patch resources (68k Resource Manager)
1939     static const uint8 check_load_dat[] = {0x20, 0x78, 0x07, 0xf0, 0x4e, 0xd0};
1940     if ((base = find_rom_data(0x78000, 0x8c000, check_load_dat, sizeof(check_load_dat))) == 0) return false;
1941     D(bug("check_load %08lx\n", base));
1942     wp = (uint16 *)(ROM_BASE + base);
1943     *wp++ = htons(M68K_JMP);
1944     *wp++ = htons((ROM_BASE + CHECK_LOAD_PATCH_SPACE) >> 16);
1945     *wp = htons((ROM_BASE + CHECK_LOAD_PATCH_SPACE) & 0xffff);
1946     wp = (uint16 *)(ROM_BASE + CHECK_LOAD_PATCH_SPACE);
1947     *wp++ = htons(0x2f03); // move.l d3,-(a7)
1948     *wp++ = htons(0x2078); // move.l $07f0,a0
1949     *wp++ = htons(0x07f0);
1950     *wp++ = htons(M68K_JSR_A0);
1951     *wp++ = htons(M68K_EMUL_OP_CHECKLOAD);
1952     *wp = htons(M68K_RTS);
1953    
1954     // Replace .Sony driver
1955     sony_offset = find_rom_resource(FOURCC('D','R','V','R'), 4);
1956     if (ROMType == ROMTYPE_ZANZIBAR || ROMType == ROMTYPE_NEWWORLD)
1957     sony_offset = find_rom_resource(FOURCC('D','R','V','R'), 4, true); // First DRVR 4 is .MFMFloppy
1958     if (sony_offset == 0) {
1959     sony_offset = find_rom_resource(FOURCC('n','d','r','v'), -20196); // NewWorld 1.6 has "PCFloppy" ndrv
1960     if (sony_offset == 0)
1961     return false;
1962     lp = (uint32 *)(ROM_BASE + rsrc_ptr + 8);
1963     *lp = htonl(FOURCC('D','R','V','R'));
1964     wp = (uint16 *)(ROM_BASE + rsrc_ptr + 12);
1965     *wp = htons(4);
1966     }
1967     D(bug("sony_offset %08lx\n", sony_offset));
1968     memcpy((void *)(ROM_BASE + sony_offset), sony_driver, sizeof(sony_driver));
1969    
1970     // Install .Disk and .AppleCD drivers
1971     memcpy((void *)(ROM_BASE + sony_offset + 0x100), disk_driver, sizeof(disk_driver));
1972     memcpy((void *)(ROM_BASE + sony_offset + 0x200), cdrom_driver, sizeof(cdrom_driver));
1973    
1974     // Install serial drivers
1975 gbeauche 1.18 gen_ain_driver( ROM_BASE + sony_offset + 0x300);
1976     gen_aout_driver(ROM_BASE + sony_offset + 0x400);
1977     gen_bin_driver( ROM_BASE + sony_offset + 0x500);
1978     gen_bout_driver(ROM_BASE + sony_offset + 0x600);
1979 cebix 1.1
1980     // Copy icons to ROM
1981     SonyDiskIconAddr = ROM_BASE + sony_offset + 0x800;
1982     memcpy((void *)(ROM_BASE + sony_offset + 0x800), SonyDiskIcon, sizeof(SonyDiskIcon));
1983     SonyDriveIconAddr = ROM_BASE + sony_offset + 0xa00;
1984     memcpy((void *)(ROM_BASE + sony_offset + 0xa00), SonyDriveIcon, sizeof(SonyDriveIcon));
1985     DiskIconAddr = ROM_BASE + sony_offset + 0xc00;
1986     memcpy((void *)(ROM_BASE + sony_offset + 0xc00), DiskIcon, sizeof(DiskIcon));
1987     CDROMIconAddr = ROM_BASE + sony_offset + 0xe00;
1988     memcpy((void *)(ROM_BASE + sony_offset + 0xe00), CDROMIcon, sizeof(CDROMIcon));
1989    
1990     // Patch driver install routine
1991     static const uint8 drvr_install_dat[] = {0xa7, 0x1e, 0x21, 0xc8, 0x01, 0x1c, 0x4e, 0x75};
1992     if ((base = find_rom_data(0xb00, 0xd00, drvr_install_dat, sizeof(drvr_install_dat))) == 0) return false;
1993     D(bug("drvr_install %08lx\n", base));
1994     wp = (uint16 *)(ROM_BASE + base + 8);
1995     *wp++ = htons(M68K_EMUL_OP_INSTALL_DRIVERS);
1996     *wp = htons(M68K_RTS);
1997    
1998     // Don't install serial drivers from ROM
1999 gbeauche 1.11 if (ROMType == ROMTYPE_ZANZIBAR || ROMType == ROMTYPE_NEWWORLD || ROMType == ROMTYPE_GOSSAMER) {
2000 cebix 1.1 wp = (uint16 *)(ROM_BASE + find_rom_resource(FOURCC('S','E','R','D'), 0));
2001     *wp = htons(M68K_RTS);
2002     } else {
2003     wp = (uint16 *)(ROM_BASE + find_rom_resource(FOURCC('s','l','0','5'), 2) + 0xc4);
2004     *wp++ = htons(M68K_NOP);
2005     *wp++ = htons(M68K_NOP);
2006     *wp++ = htons(M68K_NOP);
2007     *wp++ = htons(M68K_NOP);
2008     *wp = htons(0x7000); // moveq #0,d0
2009     wp = (uint16 *)(ROM_BASE + find_rom_resource(FOURCC('s','l','0','5'), 2) + 0x8ee);
2010     *wp = htons(M68K_NOP);
2011     }
2012     uint32 nsrd_offset = find_rom_resource(FOURCC('n','s','r','d'), 1);
2013     if (nsrd_offset) {
2014     lp = (uint32 *)(ROM_BASE + rsrc_ptr + 8);
2015     *lp = htonl(FOURCC('x','s','r','d'));
2016     }
2017    
2018     // Replace ADBOp()
2019     memcpy((void *)(ROM_BASE + find_rom_trap(0xa07c)), adbop_patch, sizeof(adbop_patch));
2020    
2021     // Replace Time Manager
2022     wp = (uint16 *)(ROM_BASE + find_rom_trap(0xa058));
2023     *wp++ = htons(M68K_EMUL_OP_INSTIME);
2024     *wp = htons(M68K_RTS);
2025     wp = (uint16 *)(ROM_BASE + find_rom_trap(0xa059));
2026     *wp++ = htons(0x40e7); // move sr,-(sp)
2027     *wp++ = htons(0x007c); // ori #$0700,sr
2028     *wp++ = htons(0x0700);
2029     *wp++ = htons(M68K_EMUL_OP_RMVTIME);
2030     *wp++ = htons(0x46df); // move (sp)+,sr
2031     *wp = htons(M68K_RTS);
2032     wp = (uint16 *)(ROM_BASE + find_rom_trap(0xa05a));
2033     *wp++ = htons(0x40e7); // move sr,-(sp)
2034     *wp++ = htons(0x007c); // ori #$0700,sr
2035     *wp++ = htons(0x0700);
2036     *wp++ = htons(M68K_EMUL_OP_PRIMETIME);
2037     *wp++ = htons(0x46df); // move (sp)+,sr
2038     *wp = htons(M68K_RTS);
2039     wp = (uint16 *)(ROM_BASE + find_rom_trap(0xa093));
2040     *wp++ = htons(M68K_EMUL_OP_MICROSECONDS);
2041     *wp = htons(M68K_RTS);
2042    
2043     // Disable Egret Manager
2044     static const uint8 egret_dat[] = {0x2f, 0x30, 0x81, 0xe2, 0x20, 0x10, 0x00, 0x18};
2045     if ((base = find_rom_data(0xa000, 0x10000, egret_dat, sizeof(egret_dat))) == 0) return false;
2046     D(bug("egret %08lx\n", base));
2047     wp = (uint16 *)(ROM_BASE + base);
2048     *wp++ = htons(0x7000);
2049     *wp = htons(M68K_RTS);
2050    
2051     // Don't call FE0A opcode in Shutdown Manager
2052     static const uint8 shutdown_dat[] = {0x40, 0xe7, 0x00, 0x7c, 0x07, 0x00, 0x48, 0xe7, 0x3f, 0x00, 0x2c, 0x00, 0x2e, 0x01};
2053     if ((base = find_rom_data(0x30000, 0x40000, shutdown_dat, sizeof(shutdown_dat))) == 0) return false;
2054     D(bug("shutdown %08lx\n", base));
2055     wp = (uint16 *)(ROM_BASE + base);
2056     if (ROMType == ROMTYPE_ZANZIBAR)
2057     *wp = htons(M68K_RTS);
2058 gbeauche 1.6 else if (ntohs(wp[-4]) == 0x61ff)
2059     *wp = htons(M68K_RTS);
2060     else if (ntohs(wp[-2]) == 0x6700)
2061 cebix 1.1 wp[-2] = htons(0x6000); // bra
2062    
2063     // Patch PowerOff()
2064     wp = (uint16 *)(ROM_BASE + find_rom_trap(0xa05b)); // PowerOff()
2065     *wp = htons(M68K_EMUL_RETURN);
2066    
2067     // Patch VIA interrupt handler
2068     static const uint8 via_int_dat[] = {0x70, 0x7f, 0xc0, 0x29, 0x1a, 0x00, 0xc0, 0x29, 0x1c, 0x00};
2069     if ((base = find_rom_data(0x13000, 0x1c000, via_int_dat, sizeof(via_int_dat))) == 0) return false;
2070     D(bug("via_int %08lx\n", base));
2071     uint32 level1_int = ROM_BASE + base;
2072     wp = (uint16 *)level1_int; // Level 1 handler
2073     *wp++ = htons(0x7002); // moveq #2,d0 (60Hz interrupt)
2074     *wp++ = htons(M68K_NOP);
2075     *wp++ = htons(M68K_NOP);
2076     *wp++ = htons(M68K_NOP);
2077     *wp = htons(M68K_NOP);
2078    
2079     static const uint8 via_int2_dat[] = {0x13, 0x7c, 0x00, 0x02, 0x1a, 0x00, 0x4e, 0x71, 0x52, 0xb8, 0x01, 0x6a};
2080     if ((base = find_rom_data(0x10000, 0x18000, via_int2_dat, sizeof(via_int2_dat))) == 0) return false;
2081     D(bug("via_int2 %08lx\n", base));
2082     wp = (uint16 *)(ROM_BASE + base); // 60Hz handler
2083     *wp++ = htons(M68K_EMUL_OP_IRQ);
2084     *wp++ = htons(0x4a80); // tst.l d0
2085     *wp++ = htons(0x6700); // beq xxx
2086     *wp = htons(0xffe8);
2087    
2088     if (ROMType == ROMTYPE_NEWWORLD) {
2089     static const uint8 via_int3_dat[] = {0x48, 0xe7, 0xf0, 0xf0, 0x76, 0x01, 0x60, 0x26};
2090 gbeauche 1.4 if ((base = find_rom_data(0x15000, 0x19000, via_int3_dat, sizeof(via_int3_dat))) == 0) return false;
2091 cebix 1.1 D(bug("via_int3 %08lx\n", base));
2092     wp = (uint16 *)(ROM_BASE + base); // CHRP level 1 handler
2093     *wp++ = htons(M68K_JMP);
2094     *wp++ = htons((level1_int - 12) >> 16);
2095     *wp = htons((level1_int - 12) & 0xffff);
2096     }
2097    
2098     // Patch PutScrap() for clipboard exchange with host OS
2099     uint32 put_scrap = find_rom_trap(0xa9fe); // PutScrap()
2100     wp = (uint16 *)(ROM_BASE + PUT_SCRAP_PATCH_SPACE);
2101     *wp++ = htons(M68K_EMUL_OP_PUT_SCRAP);
2102     *wp++ = htons(M68K_JMP);
2103     *wp++ = htons((ROM_BASE + put_scrap) >> 16);
2104     *wp++ = htons((ROM_BASE + put_scrap) & 0xffff);
2105     lp = (uint32 *)(ROM_BASE + 0x22);
2106     lp = (uint32 *)(ROM_BASE + ntohl(*lp));
2107     lp[0xa9fe & 0x3ff] = htonl(PUT_SCRAP_PATCH_SPACE);
2108    
2109     // Patch GetScrap() for clipboard exchange with host OS
2110     uint32 get_scrap = find_rom_trap(0xa9fd); // GetScrap()
2111     wp = (uint16 *)(ROM_BASE + GET_SCRAP_PATCH_SPACE);
2112     *wp++ = htons(M68K_EMUL_OP_GET_SCRAP);
2113     *wp++ = htons(M68K_JMP);
2114     *wp++ = htons((ROM_BASE + get_scrap) >> 16);
2115     *wp++ = htons((ROM_BASE + get_scrap) & 0xffff);
2116     lp = (uint32 *)(ROM_BASE + 0x22);
2117     lp = (uint32 *)(ROM_BASE + ntohl(*lp));
2118     lp[0xa9fd & 0x3ff] = htonl(GET_SCRAP_PATCH_SPACE);
2119    
2120     #if __BEOS__
2121     // Patch SynchIdleTime()
2122     if (PrefsFindBool("idlewait")) {
2123     wp = (uint16 *)(ROM_BASE + find_rom_trap(0xabf7) + 4); // SynchIdleTime()
2124     D(bug("SynchIdleTime at %08lx\n", wp));
2125     if (ntohs(*wp) == 0x2078) {
2126     *wp++ = htons(M68K_EMUL_OP_IDLE_TIME);
2127     *wp = htons(M68K_NOP);
2128     } else {
2129     D(bug("SynchIdleTime patch not installed\n"));
2130     }
2131     }
2132     #endif
2133    
2134     // Construct list of all sifters used by sound components in ROM
2135     D(bug("Searching for sound components with type sdev in ROM\n"));
2136     uint32 thing = find_rom_resource(FOURCC('t','h','n','g'));
2137     while (thing) {
2138     thing += ROM_BASE;
2139     D(bug(" found %c%c%c%c %c%c%c%c\n", ReadMacInt8(thing), ReadMacInt8(thing + 1), ReadMacInt8(thing + 2), ReadMacInt8(thing + 3), ReadMacInt8(thing + 4), ReadMacInt8(thing + 5), ReadMacInt8(thing + 6), ReadMacInt8(thing + 7)));
2140     if (ReadMacInt32(thing) == FOURCC('s','d','e','v') && ReadMacInt32(thing + 4) == FOURCC('s','i','n','g')) {
2141     WriteMacInt32(thing + 4, FOURCC('a','w','g','c'));
2142     D(bug(" found sdev component at offset %08x in ROM\n", thing));
2143     AddSifter(ReadMacInt32(thing + componentResType), ReadMacInt16(thing + componentResID));
2144     if (ReadMacInt32(thing + componentPFCount))
2145     AddSifter(ReadMacInt32(thing + componentPFResType), ReadMacInt16(thing + componentPFResID));
2146     }
2147     thing = find_rom_resource(FOURCC('t','h','n','g'), 4711, true);
2148     }
2149    
2150     // Patch component code
2151     D(bug("Patching sifters in ROM\n"));
2152     for (int i=0; i<num_sifters; i++) {
2153     if ((thing = find_rom_resource(sifter_list[i].type, sifter_list[i].id)) != 0) {
2154     D(bug(" patching type %08x, id %d\n", sifter_list[i].type, sifter_list[i].id));
2155     // Install 68k glue code
2156     uint16 *wp = (uint16 *)(ROM_BASE + thing);
2157     *wp++ = htons(0x4e56); *wp++ = htons(0x0000); // link a6,#0
2158     *wp++ = htons(0x48e7); *wp++ = htons(0x8018); // movem.l d0/a3-a4,-(a7)
2159     *wp++ = htons(0x266e); *wp++ = htons(0x000c); // movea.l $c(a6),a3
2160     *wp++ = htons(0x286e); *wp++ = htons(0x0008); // movea.l $8(a6),a4
2161     *wp++ = htons(M68K_EMUL_OP_AUDIO_DISPATCH);
2162     *wp++ = htons(0x2d40); *wp++ = htons(0x0010); // move.l d0,$10(a6)
2163     *wp++ = htons(0x4cdf); *wp++ = htons(0x1801); // movem.l (a7)+,d0/a3-a4
2164     *wp++ = htons(0x4e5e); // unlk a6
2165     *wp++ = htons(0x4e74); *wp++ = htons(0x0008); // rtd #8
2166     }
2167     }
2168     return true;
2169     }
2170    
2171    
2172     /*
2173     * Install .Sony, disk and CD-ROM drivers
2174     */
2175    
2176     void InstallDrivers(void)
2177     {
2178     D(bug("Installing drivers...\n"));
2179     M68kRegisters r;
2180 gbeauche 1.18 SheepArray<SIZEOF_IOParam> pb_var;
2181     const uintptr pb = pb_var.addr();
2182 gbeauche 1.7
2183 gbeauche 1.5 // Install floppy driver
2184 gbeauche 1.14 if (ROMType == ROMTYPE_NEWWORLD || ROMType == ROMTYPE_GOSSAMER) {
2185 gbeauche 1.5
2186 gbeauche 1.14 // Force installation of floppy driver with NewWorld and Gossamer ROMs
2187 gbeauche 1.5 r.a[0] = ROM_BASE + sony_offset;
2188     r.d[0] = (uint32)SonyRefNum;
2189     Execute68kTrap(0xa43d, &r); // DrvrInstallRsrvMem()
2190     r.a[0] = ReadMacInt32(ReadMacInt32(0x11c) + ~SonyRefNum * 4); // Get driver handle from Unit Table
2191     Execute68kTrap(0xa029, &r); // HLock()
2192     uint32 dce = ReadMacInt32(r.a[0]);
2193     WriteMacInt32(dce + dCtlDriver, ROM_BASE + sony_offset);
2194     WriteMacInt16(dce + dCtlFlags, SonyDriverFlags);
2195     }
2196 gbeauche 1.8
2197     #if DISABLE_SCSI && 0
2198     // Fake SCSIGlobals
2199 gbeauche 1.19 WriteMacInt32(0xc0c, SheepMem::ZeroPage());
2200 gbeauche 1.8 #endif
2201 gbeauche 1.5
2202 cebix 1.1 // Open .Sony driver
2203 gbeauche 1.18 SheepString sony_str("\005.Sony");
2204     WriteMacInt8(pb + ioPermssn, 0);
2205     WriteMacInt32(pb + ioNamePtr, sony_str.addr());
2206     r.a[0] = pb;
2207 cebix 1.1 Execute68kTrap(0xa000, &r); // Open()
2208    
2209     // Install disk driver
2210     r.a[0] = ROM_BASE + sony_offset + 0x100;
2211     r.d[0] = (uint32)DiskRefNum;
2212     Execute68kTrap(0xa43d, &r); // DrvrInstallRsrvMem()
2213     r.a[0] = ReadMacInt32(ReadMacInt32(0x11c) + ~DiskRefNum * 4); // Get driver handle from Unit Table
2214     Execute68kTrap(0xa029, &r); // HLock()
2215     uint32 dce = ReadMacInt32(r.a[0]);
2216     WriteMacInt32(dce + dCtlDriver, ROM_BASE + sony_offset + 0x100);
2217     WriteMacInt16(dce + dCtlFlags, DiskDriverFlags);
2218    
2219     // Open disk driver
2220 gbeauche 1.18 SheepString disk_str("\005.Disk");
2221     WriteMacInt32(pb + ioNamePtr, disk_str.addr());
2222     r.a[0] = pb;
2223 cebix 1.1 Execute68kTrap(0xa000, &r); // Open()
2224    
2225     // Install CD-ROM driver unless nocdrom option given
2226     if (!PrefsFindBool("nocdrom")) {
2227    
2228     // Install CD-ROM driver
2229     r.a[0] = ROM_BASE + sony_offset + 0x200;
2230     r.d[0] = (uint32)CDROMRefNum;
2231     Execute68kTrap(0xa43d, &r); // DrvrInstallRsrvMem()
2232     r.a[0] = ReadMacInt32(ReadMacInt32(0x11c) + ~CDROMRefNum * 4); // Get driver handle from Unit Table
2233     Execute68kTrap(0xa029, &r); // HLock()
2234     dce = ReadMacInt32(r.a[0]);
2235     WriteMacInt32(dce + dCtlDriver, ROM_BASE + sony_offset + 0x200);
2236     WriteMacInt16(dce + dCtlFlags, CDROMDriverFlags);
2237    
2238     // Open CD-ROM driver
2239 gbeauche 1.18 SheepString apple_cd("\010.AppleCD");
2240     WriteMacInt32(pb + ioNamePtr, apple_cd.addr());
2241     r.a[0] = pb;
2242 cebix 1.1 Execute68kTrap(0xa000, &r); // Open()
2243     }
2244    
2245     // Install serial drivers
2246     r.a[0] = ROM_BASE + sony_offset + 0x300;
2247     r.d[0] = (uint32)-6;
2248     Execute68kTrap(0xa43d, &r); // DrvrInstallRsrvMem()
2249     r.a[0] = ReadMacInt32(ReadMacInt32(0x11c) + ~(-6) * 4); // Get driver handle from Unit Table
2250     Execute68kTrap(0xa029, &r); // HLock()
2251     dce = ReadMacInt32(r.a[0]);
2252     WriteMacInt32(dce + dCtlDriver, ROM_BASE + sony_offset + 0x300);
2253     WriteMacInt16(dce + dCtlFlags, 0x4d00);
2254    
2255     r.a[0] = ROM_BASE + sony_offset + 0x400;
2256     r.d[0] = (uint32)-7;
2257     Execute68kTrap(0xa43d, &r); // DrvrInstallRsrvMem()
2258     r.a[0] = ReadMacInt32(ReadMacInt32(0x11c) + ~(-7) * 4); // Get driver handle from Unit Table
2259     Execute68kTrap(0xa029, &r); // HLock()
2260     dce = ReadMacInt32(r.a[0]);
2261     WriteMacInt32(dce + dCtlDriver, ROM_BASE + sony_offset + 0x400);
2262     WriteMacInt16(dce + dCtlFlags, 0x4e00);
2263    
2264     r.a[0] = ROM_BASE + sony_offset + 0x500;
2265     r.d[0] = (uint32)-8;
2266     Execute68kTrap(0xa43d, &r); // DrvrInstallRsrvMem()
2267     r.a[0] = ReadMacInt32(ReadMacInt32(0x11c) + ~(-8) * 4); // Get driver handle from Unit Table
2268     Execute68kTrap(0xa029, &r); // HLock()
2269     dce = ReadMacInt32(r.a[0]);
2270     WriteMacInt32(dce + dCtlDriver, ROM_BASE + sony_offset + 0x500);
2271     WriteMacInt16(dce + dCtlFlags, 0x4d00);
2272    
2273     r.a[0] = ROM_BASE + sony_offset + 0x600;
2274     r.d[0] = (uint32)-9;
2275     Execute68kTrap(0xa43d, &r); // DrvrInstallRsrvMem()
2276     r.a[0] = ReadMacInt32(ReadMacInt32(0x11c) + ~(-9) * 4); // Get driver handle from Unit Table
2277     Execute68kTrap(0xa029, &r); // HLock()
2278     dce = ReadMacInt32(r.a[0]);
2279     WriteMacInt32(dce + dCtlDriver, ROM_BASE + sony_offset + 0x600);
2280     WriteMacInt16(dce + dCtlFlags, 0x4e00);
2281     }