ViewVC Help
View File | Revision Log | Show Annotations | Revision Graph | Root Listing
root/cebix/BasiliskII/src/AmigaOS/main_amiga.cpp
Revision: 1.19
Committed: 2001-10-07T19:50:19Z (23 years, 1 month ago) by cebix
Branch: MAIN
Changes since 1.18: +4 -4 lines
Log Message:
prepared XPRAM code for PowerMac emulation (8192 bytes NVRAM)

File Contents

# Content
1 /*
2 * main_amiga.cpp - Startup code for AmigaOS
3 *
4 * Basilisk II (C) 1997-2001 Christian Bauer
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 #include <exec/types.h>
22 #include <exec/execbase.h>
23 #include <exec/memory.h>
24 #include <exec/tasks.h>
25 #include <dos/dostags.h>
26 #include <intuition/intuition.h>
27 #include <devices/timer.h>
28 #include <devices/ahi.h>
29 #include <proto/exec.h>
30 #include <proto/dos.h>
31 #include <proto/intuition.h>
32
33 #include "sysdeps.h"
34 #include "cpu_emulation.h"
35 #include "main.h"
36 #include "xpram.h"
37 #include "timer.h"
38 #include "sony.h"
39 #include "disk.h"
40 #include "cdrom.h"
41 #include "scsi.h"
42 #include "audio.h"
43 #include "video.h"
44 #include "serial.h"
45 #include "ether.h"
46 #include "clip.h"
47 #include "emul_op.h"
48 #include "rom_patches.h"
49 #include "prefs.h"
50 #include "prefs_editor.h"
51 #include "sys.h"
52 #include "user_strings.h"
53 #include "version.h"
54
55 #define DEBUG 0
56 #include "debug.h"
57
58
59 // Options for libnix
60 unsigned long __stack = 0x4000; // Stack requirement
61 int __nocommandline = 1; // Disable command line parsing
62
63
64 // Constants
65 static const char ROM_FILE_NAME[] = "ROM";
66 static const char __ver[] = "$VER: " VERSION_STRING " " __DATE__;
67 static const int SCRATCH_MEM_SIZE = 65536;
68
69
70 // RAM and ROM pointers
71 uint32 RAMBaseMac; // RAM base (Mac address space)
72 uint8 *RAMBaseHost; // RAM base (host address space)
73 uint32 RAMSize; // Size of RAM
74 uint32 ROMBaseMac; // ROM base (Mac address space)
75 uint8 *ROMBaseHost; // ROM base (host address space)
76 uint32 ROMSize; // Size of ROM
77
78
79 // CPU and FPU type, addressing mode
80 int CPUType;
81 bool CPUIs68060;
82 int FPUType;
83 bool TwentyFourBitAddressing;
84
85
86 // Global variables
87 extern ExecBase *SysBase;
88 struct Library *GfxBase = NULL;
89 struct IntuitionBase *IntuitionBase = NULL;
90 struct Library *GadToolsBase = NULL;
91 struct Library *IFFParseBase = NULL;
92 struct Library *AslBase = NULL;
93 struct Library *P96Base = NULL;
94 struct Library *CyberGfxBase = NULL;
95 struct Library *TimerBase = NULL;
96 struct Library *AHIBase = NULL;
97 struct Library *DiskBase = NULL;
98
99 struct Task *MainTask; // Our task
100 uint8 *ScratchMem = NULL; // Scratch memory for Mac ROM writes
101 APTR OldTrapHandler = NULL; // Old trap handler
102 APTR OldExceptionHandler = NULL; // Old exception handler
103 BYTE IRQSig = -1; // "Interrupt" signal number
104 ULONG IRQSigMask = 0; // "Interrupt" signal mask
105
106 static struct timerequest *timereq = NULL; // IORequest for timer
107
108 static struct MsgPort *ahi_port = NULL; // Port for AHI
109 static struct AHIRequest *ahi_io = NULL; // IORequest for AHI
110
111 static struct Process *xpram_proc = NULL; // XPRAM watchdog
112 static volatile bool xpram_proc_active = true; // Flag for quitting the XPRAM watchdog
113
114 static struct Process *tick_proc = NULL; // 60Hz process
115 static volatile bool tick_proc_active = true; // Flag for quitting the 60Hz process
116
117 static bool stack_swapped = false; // Stack swapping
118 static StackSwapStruct stack_swap;
119
120
121 // Assembly functions
122 struct trap_regs;
123 extern "C" void AtomicAnd(uint32 *p, uint32 val);
124 extern "C" void AtomicOr(uint32 *p, uint32 val);
125 extern "C" void MoveVBR(void);
126 extern "C" void DisableSuperBypass(void);
127 extern "C" void TrapHandlerAsm(void);
128 extern "C" void ExceptionHandlerAsm(void);
129 extern "C" void IllInstrHandler(trap_regs *regs);
130 extern "C" void PrivViolHandler(trap_regs *regs);
131 extern "C" void quit_emulator(void);
132 extern "C" void AsmTriggerNMI(void);
133 uint16 EmulatedSR; // Emulated SR (supervisor bit and interrupt mask)
134
135
136 // Prototypes
137 static void jump_to_rom(void);
138 static void xpram_func(void);
139 static void tick_func(void);
140
141
142 /*
143 * Main program
144 */
145
146 int main(int argc, char **argv)
147 {
148 // Initialize variables
149 RAMBaseHost = NULL;
150 ROMBaseHost = NULL;
151 MainTask = FindTask(NULL);
152 struct DateStamp ds;
153 DateStamp(&ds);
154 srand(ds.ds_Tick);
155
156 // Print some info
157 printf(GetString(STR_ABOUT_TEXT1), VERSION_MAJOR, VERSION_MINOR);
158 printf(" %s\n", GetString(STR_ABOUT_TEXT2));
159
160 // Open libraries
161 GfxBase = OpenLibrary((UBYTE *)"graphics.library", 39);
162 if (GfxBase == NULL) {
163 printf("Cannot open graphics.library V39.\n");
164 exit(1);
165 }
166 IntuitionBase = (struct IntuitionBase *)OpenLibrary((UBYTE *)"intuition.library", 39);
167 if (IntuitionBase == NULL) {
168 printf("Cannot open intuition.library V39.\n");
169 CloseLibrary(GfxBase);
170 exit(1);
171 }
172 DiskBase = (struct Library *)OpenResource((UBYTE *)"disk.resource");
173 if (DiskBase == NULL)
174 QuitEmulator();
175 GadToolsBase = OpenLibrary((UBYTE *)"gadtools.library", 39);
176 if (GadToolsBase == NULL) {
177 ErrorAlert(STR_NO_GADTOOLS_LIB_ERR);
178 QuitEmulator();
179 }
180 IFFParseBase = OpenLibrary((UBYTE *)"iffparse.library", 39);
181 if (IFFParseBase == NULL) {
182 ErrorAlert(STR_NO_IFFPARSE_LIB_ERR);
183 QuitEmulator();
184 }
185 AslBase = OpenLibrary((UBYTE *)"asl.library", 36);
186 if (AslBase == NULL) {
187 ErrorAlert(STR_NO_ASL_LIB_ERR);
188 QuitEmulator();
189 }
190
191 // These two can fail (the respective gfx support won't be available, then)
192 P96Base = OpenLibrary((UBYTE *)"Picasso96API.library", 2);
193 CyberGfxBase = OpenLibrary((UBYTE *)"cybergraphics.library", 2);
194
195 // Read preferences
196 PrefsInit(argc, argv);
197
198 // Open AHI
199 ahi_port = CreateMsgPort();
200 if (ahi_port) {
201 ahi_io = (struct AHIRequest *)CreateIORequest(ahi_port, sizeof(struct AHIRequest));
202 if (ahi_io) {
203 ahi_io->ahir_Version = 2;
204 if (OpenDevice((UBYTE *)AHINAME, AHI_NO_UNIT, (struct IORequest *)ahi_io, 0) == 0) {
205 AHIBase = (struct Library *)ahi_io->ahir_Std.io_Device;
206 }
207 }
208 }
209
210 // Init system routines
211 SysInit();
212
213 // Show preferences editor
214 if (!PrefsFindBool("nogui"))
215 if (!PrefsEditor())
216 QuitEmulator();
217
218 // Check start of Chip memory (because we need access to 0x0000..0x2000)
219 if ((uint32)FindName(&SysBase->MemList, (UBYTE *)"chip memory") < 0x2000) {
220 ErrorAlert(STR_NO_PREPARE_EMUL_ERR);
221 QuitEmulator();
222 }
223
224 // Open timer.device
225 timereq = (struct timerequest *)AllocVec(sizeof(timerequest), MEMF_PUBLIC | MEMF_CLEAR);
226 if (timereq == NULL) {
227 ErrorAlert(STR_NO_MEM_ERR);
228 QuitEmulator();
229 }
230 if (OpenDevice((UBYTE *)TIMERNAME, UNIT_MICROHZ, (struct IORequest *)timereq, 0)) {
231 ErrorAlert(STR_NO_TIMER_DEV_ERR);
232 QuitEmulator();
233 }
234 TimerBase = (struct Library *)timereq->tr_node.io_Device;
235
236 // Allocate scratch memory
237 ScratchMem = (uint8 *)AllocMem(SCRATCH_MEM_SIZE, MEMF_PUBLIC);
238 if (ScratchMem == NULL) {
239 ErrorAlert(STR_NO_MEM_ERR);
240 QuitEmulator();
241 }
242 ScratchMem += SCRATCH_MEM_SIZE/2; // ScratchMem points to middle of block
243
244 // Create area for Mac RAM and ROM (ROM must be higher in memory,
245 // so we allocate one big chunk and put the ROM at the top of it)
246 RAMSize = PrefsFindInt32("ramsize") & 0xfff00000; // Round down to 1MB boundary
247 if (RAMSize < 1024*1024) {
248 WarningAlert(GetString(STR_SMALL_RAM_WARN));
249 RAMSize = 1024*1024;
250 }
251 RAMBaseHost = (uint8 *)AllocVec(RAMSize + 0x100000, MEMF_PUBLIC);
252 if (RAMBaseHost == NULL) {
253 uint32 newRAMSize = AvailMem(MEMF_LARGEST) - 0x100000;
254 char xText[120];
255
256 sprintf(xText, GetString(STR_NOT_ENOUGH_MEM_WARN), RAMSize, newRAMSize);
257
258 if (ChoiceAlert(xText, "Use", "Quit") != 1)
259 QuitEmulator();
260
261 RAMSize = newRAMSize;
262 RAMBaseHost = (uint8 *)AllocVec(RAMSize + 0x100000, MEMF_PUBLIC);
263 if (RAMBaseHost == NULL) {
264 ErrorAlert(STR_NO_MEM_ERR);
265 QuitEmulator();
266 }
267 }
268 RAMBaseMac = (uint32)RAMBaseHost;
269 D(bug("Mac RAM starts at %08lx\n", RAMBaseHost));
270 ROMBaseHost = RAMBaseHost + RAMSize;
271 ROMBaseMac = (uint32)ROMBaseHost;
272 D(bug("Mac ROM starts at %08lx\n", ROMBaseHost));
273
274 // Get rom file path from preferences
275 const char *rom_path = PrefsFindString("rom");
276
277 // Load Mac ROM
278 BPTR rom_fh = Open(rom_path ? (char *)rom_path : (char *)ROM_FILE_NAME, MODE_OLDFILE);
279 if (rom_fh == 0) {
280 ErrorAlert(STR_NO_ROM_FILE_ERR);
281 QuitEmulator();
282 }
283 printf(GetString(STR_READING_ROM_FILE));
284 Seek(rom_fh, 0, OFFSET_END);
285 ROMSize = Seek(rom_fh, 0, OFFSET_CURRENT);
286 if (ROMSize != 512*1024 && ROMSize != 1024*1024) {
287 ErrorAlert(STR_ROM_SIZE_ERR);
288 Close(rom_fh);
289 QuitEmulator();
290 }
291 Seek(rom_fh, 0, OFFSET_BEGINNING);
292 if (Read(rom_fh, ROMBaseHost, ROMSize) != ROMSize) {
293 ErrorAlert(STR_ROM_FILE_READ_ERR);
294 Close(rom_fh);
295 QuitEmulator();
296 }
297
298 // Set CPU and FPU type
299 UWORD attn = SysBase->AttnFlags;
300 CPUType = attn & AFF_68040 ? 4 : (attn & AFF_68030 ? 3 : 2);
301 CPUIs68060 = attn & AFF_68060;
302 FPUType = attn & AFF_68881 ? 1 : 0;
303
304 // Initialize everything
305 if (!InitAll())
306 QuitEmulator();
307
308 // Move VBR away from 0 if neccessary
309 MoveVBR();
310
311 // On 68060, disable Super Bypass mode because of a CPU bug that is triggered by MacOS 8
312 if (CPUIs68060)
313 DisableSuperBypass();
314
315 // Install trap handler
316 EmulatedSR = 0x2700;
317 OldTrapHandler = MainTask->tc_TrapCode;
318 MainTask->tc_TrapCode = (APTR)TrapHandlerAsm;
319
320 // Allocate signal for interrupt emulation and install exception handler
321 IRQSig = AllocSignal(-1);
322 IRQSigMask = 1 << IRQSig;
323 OldExceptionHandler = MainTask->tc_ExceptCode;
324 MainTask->tc_ExceptCode = (APTR)ExceptionHandlerAsm;
325 SetExcept(SIGBREAKF_CTRL_C | IRQSigMask, SIGBREAKF_CTRL_C | IRQSigMask);
326
327 // Start XPRAM watchdog process
328 xpram_proc = CreateNewProcTags(
329 NP_Entry, (ULONG)xpram_func,
330 NP_Name, (ULONG)"Basilisk II XPRAM Watchdog",
331 NP_Priority, 0,
332 TAG_END
333 );
334
335 // Start 60Hz process
336 tick_proc = CreateNewProcTags(
337 NP_Entry, (ULONG)tick_func,
338 NP_Name, (ULONG)"Basilisk II 60Hz",
339 NP_Priority, 5,
340 TAG_END
341 );
342
343 // Set task priority to -1 so we don't use all processing time
344 SetTaskPri(MainTask, -1);
345
346 WriteMacInt32(0xbff, 0); // MacsBugFlags
347
348 // Swap stack to Mac RAM area
349 stack_swap.stk_Lower = RAMBaseHost;
350 stack_swap.stk_Upper = (ULONG)RAMBaseHost + RAMSize;
351 stack_swap.stk_Pointer = RAMBaseHost + 0x8000;
352 StackSwap(&stack_swap);
353 stack_swapped = true;
354
355 // Jump to ROM boot routine
356 Start680x0();
357
358 QuitEmulator();
359 return 0;
360 }
361
362 void Start680x0(void)
363 {
364 typedef void (*rom_func)(void);
365 rom_func fp = (rom_func)(ROMBaseHost + 0x2a);
366 fp();
367 }
368
369
370 /*
371 * Quit emulator (__saveds because it might be called from an exception)
372 */
373
374 // Assembly entry point
375 void __saveds quit_emulator(void)
376 {
377 QuitEmulator();
378 }
379
380 void QuitEmulator(void)
381 {
382 // Stop 60Hz process
383 if (tick_proc) {
384 SetSignal(0, SIGF_SINGLE);
385 tick_proc_active = false;
386 Wait(SIGF_SINGLE);
387 }
388
389 // Stop XPRAM watchdog process
390 if (xpram_proc) {
391 SetSignal(0, SIGF_SINGLE);
392 xpram_proc_active = false;
393 Wait(SIGF_SINGLE);
394 }
395
396 // Restore stack
397 if (stack_swapped) {
398 stack_swapped = false;
399 StackSwap(&stack_swap);
400 }
401
402 // Remove exception handler
403 if (IRQSig >= 0) {
404 SetExcept(0, SIGBREAKF_CTRL_C | IRQSigMask);
405 MainTask->tc_ExceptCode = OldExceptionHandler;
406 FreeSignal(IRQSig);
407 }
408
409 // Remove trap handler
410 MainTask->tc_TrapCode = OldTrapHandler;
411
412 // Deinitialize everything
413 ExitAll();
414
415 // Delete RAM/ROM area
416 if (RAMBaseHost)
417 FreeVec(RAMBaseHost);
418
419 // Delete scratch memory area
420 if (ScratchMem)
421 FreeMem((void *)(ScratchMem - SCRATCH_MEM_SIZE/2), SCRATCH_MEM_SIZE);
422
423 // Close timer.device
424 if (TimerBase)
425 CloseDevice((struct IORequest *)timereq);
426 if (timereq)
427 FreeVec(timereq);
428
429 // Exit system routines
430 SysExit();
431
432 // Close AHI
433 if (AHIBase)
434 CloseDevice((struct IORequest *)ahi_io);
435 if (ahi_io)
436 DeleteIORequest((struct IORequest *)ahi_io);
437 if (ahi_port)
438 DeleteMsgPort(ahi_port);
439
440 // Exit preferences
441 PrefsExit();
442
443 // Close libraries
444 if (CyberGfxBase)
445 CloseLibrary(CyberGfxBase);
446 if (P96Base)
447 CloseLibrary(P96Base);
448 if (AslBase)
449 CloseLibrary(AslBase);
450 if (IFFParseBase)
451 CloseLibrary(IFFParseBase);
452 if (GadToolsBase)
453 CloseLibrary(GadToolsBase);
454 if (IntuitionBase)
455 CloseLibrary((struct Library *)IntuitionBase);
456 if (GfxBase)
457 CloseLibrary(GfxBase);
458
459 exit(0);
460 }
461
462
463 /*
464 * Code was patched, flush caches if neccessary (i.e. when using a real 680x0
465 * or a dynamically recompiling emulator)
466 */
467
468 void FlushCodeCache(void *start, uint32 size)
469 {
470 CacheClearE(start, size, CACRF_ClearI | CACRF_ClearD);
471 }
472
473
474 /*
475 * Mutexes
476 */
477
478 struct B2_mutex {
479 int dummy; //!!
480 };
481
482 B2_mutex *B2_create_mutex(void)
483 {
484 return new B2_mutex;
485 }
486
487 void B2_lock_mutex(B2_mutex *mutex)
488 {
489 }
490
491 void B2_unlock_mutex(B2_mutex *mutex)
492 {
493 }
494
495 void B2_delete_mutex(B2_mutex *mutex)
496 {
497 delete mutex;
498 }
499
500
501 /*
502 * Interrupt flags (must be handled atomically!)
503 */
504
505 uint32 InterruptFlags;
506
507 void SetInterruptFlag(uint32 flag)
508 {
509 AtomicOr(&InterruptFlags, flag);
510 }
511
512 void ClearInterruptFlag(uint32 flag)
513 {
514 AtomicAnd(&InterruptFlags, ~flag);
515 }
516
517 void TriggerInterrupt(void)
518 {
519 Signal(MainTask, IRQSigMask);
520 }
521
522 void TriggerNMI(void)
523 {
524 AsmTriggerNMI();
525 }
526
527
528 /*
529 * 60Hz thread (really 60.15Hz)
530 */
531
532 static __saveds void tick_func(void)
533 {
534 int tick_counter = 0;
535 struct MsgPort *timer_port = NULL;
536 struct timerequest *timer_io = NULL;
537 ULONG timer_mask = 0;
538
539 // Start 60Hz timer
540 timer_port = CreateMsgPort();
541 if (timer_port) {
542 timer_io = (struct timerequest *)CreateIORequest(timer_port, sizeof(struct timerequest));
543 if (timer_io) {
544 if (!OpenDevice((UBYTE *)TIMERNAME, UNIT_MICROHZ, (struct IORequest *)timer_io, 0)) {
545 timer_mask = 1 << timer_port->mp_SigBit;
546 timer_io->tr_node.io_Command = TR_ADDREQUEST;
547 timer_io->tr_time.tv_secs = 0;
548 timer_io->tr_time.tv_micro = 16625;
549 SendIO((struct IORequest *)timer_io);
550 }
551 }
552 }
553
554 while (tick_proc_active) {
555
556 // Wait for timer tick
557 Wait(timer_mask);
558
559 // Restart timer
560 timer_io->tr_node.io_Command = TR_ADDREQUEST;
561 timer_io->tr_time.tv_secs = 0;
562 timer_io->tr_time.tv_micro = 16625;
563 SendIO((struct IORequest *)timer_io);
564
565 // Pseudo Mac 1Hz interrupt, update local time
566 if (++tick_counter > 60) {
567 tick_counter = 0;
568 WriteMacInt32(0x20c, TimerDateTime());
569 SetInterruptFlag(INTFLAG_1HZ);
570 TriggerInterrupt();
571 }
572
573 // Trigger 60Hz interrupt
574 SetInterruptFlag(INTFLAG_60HZ);
575 TriggerInterrupt();
576 }
577
578 // Stop timer
579 if (timer_io) {
580 if (!CheckIO((struct IORequest *)timer_io))
581 AbortIO((struct IORequest *)timer_io);
582 WaitIO((struct IORequest *)timer_io);
583 CloseDevice((struct IORequest *)timer_io);
584 DeleteIORequest(timer_io);
585 }
586 if (timer_port)
587 DeleteMsgPort(timer_port);
588
589 // Main task asked for termination, send signal
590 Forbid();
591 Signal(MainTask, SIGF_SINGLE);
592 }
593
594
595 /*
596 * XPRAM watchdog thread (saves XPRAM every minute)
597 */
598
599 static __saveds void xpram_func(void)
600 {
601 uint8 last_xpram[XPRAM_SIZE];
602 memcpy(last_xpram, XPRAM, XPRAM_SIZE);
603
604 while (xpram_proc_active) {
605 for (int i=0; i<60 && xpram_proc_active; i++)
606 Delay(50); // Only wait 1 second so we quit promptly when xpram_proc_active becomes false
607 if (memcmp(last_xpram, XPRAM, XPRAM_SIZE)) {
608 memcpy(last_xpram, XPRAM, XPRAM_SIZE);
609 SaveXPRAM();
610 }
611 }
612
613 // Main task asked for termination, send signal
614 Forbid();
615 Signal(MainTask, SIGF_SINGLE);
616 }
617
618
619 /*
620 * Display error alert
621 */
622
623 void ErrorAlert(const char *text)
624 {
625 if (PrefsFindBool("nogui")) {
626 printf(GetString(STR_SHELL_ERROR_PREFIX), text);
627 return;
628 }
629 EasyStruct req;
630 req.es_StructSize = sizeof(EasyStruct);
631 req.es_Flags = 0;
632 req.es_Title = (UBYTE *)GetString(STR_ERROR_ALERT_TITLE);
633 req.es_TextFormat = (UBYTE *)GetString(STR_GUI_ERROR_PREFIX);
634 req.es_GadgetFormat = (UBYTE *)GetString(STR_QUIT_BUTTON);
635 EasyRequest(NULL, &req, NULL, (ULONG)text);
636 }
637
638
639 /*
640 * Display warning alert
641 */
642
643 void WarningAlert(const char *text)
644 {
645 if (PrefsFindBool("nogui")) {
646 printf(GetString(STR_SHELL_WARNING_PREFIX), text);
647 return;
648 }
649 EasyStruct req;
650 req.es_StructSize = sizeof(EasyStruct);
651 req.es_Flags = 0;
652 req.es_Title = (UBYTE *)GetString(STR_WARNING_ALERT_TITLE);
653 req.es_TextFormat = (UBYTE *)GetString(STR_GUI_WARNING_PREFIX);
654 req.es_GadgetFormat = (UBYTE *)GetString(STR_OK_BUTTON);
655 EasyRequest(NULL, &req, NULL, (ULONG)text);
656 }
657
658
659 /*
660 * Display choice alert
661 */
662
663 bool ChoiceAlert(const char *text, const char *pos, const char *neg)
664 {
665 char str[256];
666 sprintf(str, "%s|%s", pos, neg);
667 EasyStruct req;
668 req.es_StructSize = sizeof(EasyStruct);
669 req.es_Flags = 0;
670 req.es_Title = (UBYTE *)GetString(STR_WARNING_ALERT_TITLE);
671 req.es_TextFormat = (UBYTE *)GetString(STR_GUI_WARNING_PREFIX);
672 req.es_GadgetFormat = (UBYTE *)str;
673 return EasyRequest(NULL, &req, NULL, (ULONG)text);
674 }
675
676
677 /*
678 * Illegal Instruction and Privilege Violation trap handlers
679 */
680
681 struct trap_regs { // This must match the layout of M68kRegisters
682 uint32 d[8];
683 uint32 a[8];
684 uint16 sr;
685 uint32 pc;
686 };
687
688 void __saveds IllInstrHandler(trap_regs *r)
689 {
690 uint16 opcode = *(uint16 *)(r->pc);
691 if ((opcode & 0xff00) != 0x7100) {
692 printf("Illegal Instruction %04x at %08lx\n", *(uint16 *)(r->pc), r->pc);
693 printf("d0 %08lx d1 %08lx d2 %08lx d3 %08lx\n"
694 "d4 %08lx d5 %08lx d6 %08lx d7 %08lx\n"
695 "a0 %08lx a1 %08lx a2 %08lx a3 %08lx\n"
696 "a4 %08lx a5 %08lx a6 %08lx a7 %08lx\n"
697 "sr %04x\n",
698 r->d[0], r->d[1], r->d[2], r->d[3], r->d[4], r->d[5], r->d[6], r->d[7],
699 r->a[0], r->a[1], r->a[2], r->a[3], r->a[4], r->a[5], r->a[6], r->a[7],
700 r->sr);
701 QuitEmulator();
702 } else {
703 // Disable interrupts
704 uint16 sr = EmulatedSR;
705 EmulatedSR |= 0x0700;
706
707 // Call opcode routine
708 EmulOp(opcode, (M68kRegisters *)r);
709 r->pc += 2;
710
711 // Restore interrupts
712 EmulatedSR = sr;
713 if ((EmulatedSR & 0x0700) == 0 && InterruptFlags)
714 Signal(MainTask, IRQSigMask);
715 }
716 }
717
718 void __saveds PrivViolHandler(trap_regs *r)
719 {
720 printf("Privileged instruction %04x %04x at %08lx\n", *(uint16 *)(r->pc), *(uint16 *)(r->pc + 2), r->pc);
721 printf("d0 %08lx d1 %08lx d2 %08lx d3 %08lx\n"
722 "d4 %08lx d5 %08lx d6 %08lx d7 %08lx\n"
723 "a0 %08lx a1 %08lx a2 %08lx a3 %08lx\n"
724 "a4 %08lx a5 %08lx a6 %08lx a7 %08lx\n"
725 "sr %04x\n",
726 r->d[0], r->d[1], r->d[2], r->d[3], r->d[4], r->d[5], r->d[6], r->d[7],
727 r->a[0], r->a[1], r->a[2], r->a[3], r->a[4], r->a[5], r->a[6], r->a[7],
728 r->sr);
729 QuitEmulator();
730 }