ViewVC Help
View File | Revision Log | Show Annotations | Revision Graph | Root Listing
root/cebix/SheepShaver/src/kpx_cpu/sheepshaver_glue.cpp
(Generate patch)

Comparing SheepShaver/src/kpx_cpu/sheepshaver_glue.cpp (file contents):
Revision 1.34 by gbeauche, 2004-04-22T21:45:18Z vs.
Revision 1.42 by gbeauche, 2004-05-23T05:28:12Z

# Line 38 | Line 38
38   #include "name_registry.h"
39   #include "serial.h"
40   #include "ether.h"
41 + #include "timer.h"
42  
43   #include <stdio.h>
44   #include <stdlib.h>
# Line 83 | Line 84 | extern "C" void check_load_invoc(uint32
84   // PowerPC EmulOp to exit from emulation looop
85   const uint32 POWERPC_EXEC_RETURN = POWERPC_EMUL_OP | 1;
86  
87 < // Enable multicore (main/interrupts) cpu emulation?
88 < #define MULTICORE_CPU (ASYNC_IRQ ? 1 : 0)
87 > // Enable interrupt routine safety checks?
88 > #define SAFE_INTERRUPT_PPC 1
89  
90   // Enable Execute68k() safety checks?
91   #define SAFE_EXEC_68K 1
# Line 98 | Line 99 | const uint32 POWERPC_EXEC_RETURN = POWER
99   // Interrupts in native mode?
100   #define INTERRUPTS_IN_NATIVE_MODE 1
101  
102 + // Enable native EMUL_OPs to be run without a mode switch
103 + #define ENABLE_NATIVE_EMUL_OP 1
104 +
105   // Pointer to Kernel Data
106   static KernelData * const kernel_data = (KernelData *)KERNEL_DATA_BASE;
107  
108   // SIGSEGV handler
109   static sigsegv_return_t sigsegv_handler(sigsegv_address_t, sigsegv_address_t);
110  
111 + #if PPC_ENABLE_JIT && PPC_REENTRANT_JIT
112 + // Special trampolines for EmulOp and NativeOp
113 + static uint8 *emul_op_trampoline;
114 + static uint8 *native_op_trampoline;
115 + #endif
116 +
117   // JIT Compiler enabled?
118   static inline bool enable_jit_p()
119   {
# Line 126 | Line 136 | class sheepshaver_cpu
136          void init_decoder();
137          void execute_sheep(uint32 opcode);
138  
139 +        // Filter out EMUL_OP routines that only call native code
140 +        bool filter_execute_emul_op(uint32 emul_op);
141 +
142 +        // "Native" EMUL_OP routines
143 +        void execute_emul_op_microseconds();
144 +        void execute_emul_op_idle_time_1();
145 +        void execute_emul_op_idle_time_2();
146 +
147 +        // CPU context to preserve on interrupt
148 +        class interrupt_context {
149 +                uint32 gpr[32];
150 +                uint32 pc;
151 +                uint32 lr;
152 +                uint32 ctr;
153 +                uint32 cr;
154 +                uint32 xer;
155 +                sheepshaver_cpu *cpu;
156 +                const char *where;
157 +        public:
158 +                interrupt_context(sheepshaver_cpu *_cpu, const char *_where);
159 +                ~interrupt_context();
160 +        };
161 +
162   public:
163  
164          // Constructor
# Line 137 | Line 170 | public:
170          uint32 get_xer() const          { return xer().get(); }
171          void set_xer(uint32 v)          { xer().set(v); }
172  
173 +        // Execute NATIVE_OP routine
174 +        void execute_native_op(uint32 native_op);
175 +
176          // Execute EMUL_OP routine
177          void execute_emul_op(uint32 emul_op);
178  
# Line 150 | Line 186 | public:
186          uint32 execute_macos_code(uint32 tvect, int nargs, uint32 const *args);
187  
188          // Compile one instruction
189 <        virtual bool compile1(codegen_context_t & cg_context);
189 >        virtual int compile1(codegen_context_t & cg_context);
190  
191          // Resource manager thunk
192          void get_resource(uint32 old_get_resource);
# Line 221 | Line 257 | void sheepshaver_cpu::init_decoder()
257          }
258   }
259  
224 // Forward declaration for native opcode handler
225 static void NativeOp(int selector);
226
260   /*              NativeOp instruction format:
261 <                +------------+--------------------------+--+----------+------------+
262 <                |      6     |                          |FN|    OP    |      2     |
263 <                +------------+--------------------------+--+----------+------------+
264 <                 0         5 |6                       19 20 21      25 26        31
261 >                +------------+-------------------------+--+-----------+------------+
262 >                |      6     |                         |FN|    OP     |      2     |
263 >                +------------+-------------------------+--+-----------+------------+
264 >                 0         5 |6                      18 19 20      25 26        31
265   */
266  
267 < typedef bit_field< 20, 20 > FN_field;
268 < typedef bit_field< 21, 25 > NATIVE_OP_field;
267 > typedef bit_field< 19, 19 > FN_field;
268 > typedef bit_field< 20, 25 > NATIVE_OP_field;
269   typedef bit_field< 26, 31 > EMUL_OP_field;
270  
271 + // "Native" EMUL_OP routines
272 + #define GPR_A(REG) gpr(16 + (REG))
273 + #define GPR_D(REG) gpr( 8 + (REG))
274 +
275 + void sheepshaver_cpu::execute_emul_op_microseconds()
276 + {
277 +        Microseconds(GPR_A(0), GPR_D(0));
278 + }
279 +
280 + void sheepshaver_cpu::execute_emul_op_idle_time_1()
281 + {
282 +        // Sleep if no events pending
283 +        if (ReadMacInt32(0x14c) == 0)
284 +                Delay_usec(16667);
285 +        GPR_A(0) = ReadMacInt32(0x2b6);
286 + }
287 +
288 + void sheepshaver_cpu::execute_emul_op_idle_time_2()
289 + {
290 +        // Sleep if no events pending
291 +        if (ReadMacInt32(0x14c) == 0)
292 +                Delay_usec(16667);
293 +        GPR_D(0) = (uint32)-2;
294 + }
295 +
296 + // Filter out EMUL_OP routines that only call native code
297 + bool sheepshaver_cpu::filter_execute_emul_op(uint32 emul_op)
298 + {
299 +        switch (emul_op) {
300 +        case OP_MICROSECONDS:
301 +                execute_emul_op_microseconds();
302 +                return true;
303 +        case OP_IDLE_TIME:
304 +                execute_emul_op_idle_time_1();
305 +                return true;
306 +        case OP_IDLE_TIME_2:
307 +                execute_emul_op_idle_time_2();
308 +                return true;
309 +        }
310 +        return false;
311 + }
312 +
313   // Execute EMUL_OP routine
314   void sheepshaver_cpu::execute_emul_op(uint32 emul_op)
315   {
316 + #if ENABLE_NATIVE_EMUL_OP
317 +        // First, filter out EMUL_OPs that can be executed without a mode switch
318 +        if (filter_execute_emul_op(emul_op))
319 +                return;
320 + #endif
321 +
322          M68kRegisters r68;
323          WriteMacInt32(XLM_68K_R25, gpr(25));
324          WriteMacInt32(XLM_RUN_MODE, MODE_EMUL_OP);
# Line 275 | Line 356 | void sheepshaver_cpu::execute_sheep(uint
356                  break;
357  
358          case 2:         // EXEC_NATIVE
359 <                NativeOp(NATIVE_OP_field::extract(opcode));
359 >                execute_native_op(NATIVE_OP_field::extract(opcode));
360                  if (FN_field::test(opcode))
361                          pc() = lr();
362                  else
# Line 290 | Line 371 | void sheepshaver_cpu::execute_sheep(uint
371   }
372  
373   // Compile one instruction
374 < bool sheepshaver_cpu::compile1(codegen_context_t & cg_context)
374 > int sheepshaver_cpu::compile1(codegen_context_t & cg_context)
375   {
376   #if PPC_ENABLE_JIT
377          const instr_info_t *ii = cg_context.instr_info;
378          if (ii->mnemo != PPC_I(SHEEP))
379 <                return false;
379 >                return COMPILE_FAILURE;
380  
381 <        bool compiled = false;
381 >        int status = COMPILE_FAILURE;
382          powerpc_dyngen & dg = cg_context.codegen;
383          uint32 opcode = cg_context.opcode;
384  
385          switch (opcode & 0x3f) {
386          case 0:         // EMUL_RETURN
387                  dg.gen_invoke(QuitEmulator);
388 <                compiled = true;
388 >                status = COMPILE_CODE_OK;
389                  break;
390  
391          case 1:         // EXEC_RETURN
392                  dg.gen_spcflags_set(SPCFLAG_CPU_EXEC_RETURN);
393 <                compiled = true;
393 >                // Don't check for pending interrupts, we do know we have to
394 >                // get out of this block ASAP
395 >                dg.gen_exec_return();
396 >                status = COMPILE_EPILOGUE_OK;
397                  break;
398  
399          case 2: {       // EXEC_NATIVE
400                  uint32 selector = NATIVE_OP_field::extract(opcode);
401                  switch (selector) {
402 + #if !PPC_REENTRANT_JIT
403 +                // Filter out functions that may invoke Execute68k() or
404 +                // CallMacOS(), this would break reentrancy as they could
405 +                // invalidate the translation cache and even overwrite
406 +                // continuation code when we are done with them.
407                  case NATIVE_PATCH_NAME_REGISTRY:
408                          dg.gen_invoke(DoPatchNameRegistry);
409 <                        compiled = true;
409 >                        status = COMPILE_CODE_OK;
410                          break;
411                  case NATIVE_VIDEO_INSTALL_ACCEL:
412                          dg.gen_invoke(VideoInstallAccel);
413 <                        compiled = true;
413 >                        status = COMPILE_CODE_OK;
414                          break;
415                  case NATIVE_VIDEO_VBL:
416                          dg.gen_invoke(VideoVBL);
417 <                        compiled = true;
417 >                        status = COMPILE_CODE_OK;
418                          break;
419                  case NATIVE_GET_RESOURCE:
420                  case NATIVE_GET_1_RESOURCE:
# Line 343 | Line 432 | bool sheepshaver_cpu::compile1(codegen_c
432                          typedef void (*func_t)(dyngen_cpu_base, uint32);
433                          func_t func = (func_t)nv_mem_fun(&sheepshaver_cpu::get_resource).ptr();
434                          dg.gen_invoke_CPU_im(func, old_get_resource);
435 <                        compiled = true;
435 >                        status = COMPILE_CODE_OK;
436                          break;
437                  }
438 +                case NATIVE_CHECK_LOAD_INVOC:
439 +                        dg.gen_load_T0_GPR(3);
440 +                        dg.gen_load_T1_GPR(4);
441 +                        dg.gen_se_16_32_T1();
442 +                        dg.gen_load_T2_GPR(5);
443 +                        dg.gen_invoke_T0_T1_T2((void (*)(uint32, uint32, uint32))check_load_invoc);
444 +                        status = COMPILE_CODE_OK;
445 +                        break;
446 + #endif
447                  case NATIVE_DISABLE_INTERRUPT:
448                          dg.gen_invoke(DisableInterrupt);
449 <                        compiled = true;
449 >                        status = COMPILE_CODE_OK;
450                          break;
451                  case NATIVE_ENABLE_INTERRUPT:
452                          dg.gen_invoke(EnableInterrupt);
453 <                        compiled = true;
453 >                        status = COMPILE_CODE_OK;
454                          break;
455 <                case NATIVE_CHECK_LOAD_INVOC:
455 >                case NATIVE_BITBLT:
456                          dg.gen_load_T0_GPR(3);
457 <                        dg.gen_load_T1_GPR(4);
458 <                        dg.gen_se_16_32_T1();
459 <                        dg.gen_load_T2_GPR(5);
460 <                        dg.gen_invoke_T0_T1_T2((void (*)(uint32, uint32, uint32))check_load_invoc);
461 <                        compiled = true;
457 >                        dg.gen_invoke_T0((void (*)(uint32))NQD_bitblt);
458 >                        status = COMPILE_CODE_OK;
459 >                        break;
460 >                case NATIVE_INVRECT:
461 >                        dg.gen_load_T0_GPR(3);
462 >                        dg.gen_invoke_T0((void (*)(uint32))NQD_invrect);
463 >                        status = COMPILE_CODE_OK;
464 >                        break;
465 >                case NATIVE_FILLRECT:
466 >                        dg.gen_load_T0_GPR(3);
467 >                        dg.gen_invoke_T0((void (*)(uint32))NQD_fillrect);
468 >                        status = COMPILE_CODE_OK;
469                          break;
470                  }
471 <                if (FN_field::test(opcode)) {
472 <                        if (compiled) {
471 >                // Could we fully translate this NativeOp?
472 >                if (status == COMPILE_CODE_OK) {
473 >                        if (!FN_field::test(opcode))
474 >                                cg_context.done_compile = false;
475 >                        else {
476                                  dg.gen_load_A0_LR();
477                                  dg.gen_set_PC_A0();
478 +                                cg_context.done_compile = true;
479                          }
480 <                        cg_context.done_compile = true;
480 >                        break;
481                  }
482 <                else
482 > #if PPC_REENTRANT_JIT
483 >                // Try to execute NativeOp trampoline
484 >                if (!FN_field::test(opcode))
485 >                        dg.gen_set_PC_im(cg_context.pc + 4);
486 >                else {
487 >                        dg.gen_load_A0_LR();
488 >                        dg.gen_set_PC_A0();
489 >                }
490 >                dg.gen_mov_32_T0_im(selector);
491 >                dg.gen_jmp(native_op_trampoline);
492 >                cg_context.done_compile = true;
493 >                status = COMPILE_EPILOGUE_OK;
494 >                break;
495 > #endif
496 >                // Invoke NativeOp handler
497 >                if (!FN_field::test(opcode)) {
498 >                        typedef void (*func_t)(dyngen_cpu_base, uint32);
499 >                        func_t func = (func_t)nv_mem_fun(&sheepshaver_cpu::execute_native_op).ptr();
500 >                        dg.gen_invoke_CPU_im(func, selector);
501                          cg_context.done_compile = false;
502 +                        status = COMPILE_CODE_OK;
503 +                }
504 +                // Otherwise, let it generate a call to execute_sheep() which
505 +                // will cause necessary updates to the program counter
506                  break;
507          }
508  
509          default: {      // EMUL_OP
510 +                uint32 emul_op = EMUL_OP_field::extract(opcode) - 3;
511 + #if ENABLE_NATIVE_EMUL_OP
512 +                typedef void (*emul_op_func_t)(dyngen_cpu_base);
513 +                emul_op_func_t emul_op_func = 0;
514 +                switch (emul_op) {
515 +                case OP_MICROSECONDS:
516 +                        emul_op_func = (emul_op_func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op_microseconds).ptr();
517 +                        break;
518 +                case OP_IDLE_TIME:
519 +                        emul_op_func = (emul_op_func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op_idle_time_1).ptr();
520 +                        break;
521 +                case OP_IDLE_TIME_2:
522 +                        emul_op_func = (emul_op_func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op_idle_time_2).ptr();
523 +                        break;
524 +                }
525 +                if (emul_op_func) {
526 +                        dg.gen_invoke_CPU(emul_op_func);
527 +                        cg_context.done_compile = false;
528 +                        status = COMPILE_CODE_OK;
529 +                        break;
530 +                }
531 + #endif
532 + #if PPC_REENTRANT_JIT
533 +                // Try to execute EmulOp trampoline
534 +                dg.gen_set_PC_im(cg_context.pc + 4);
535 +                dg.gen_mov_32_T0_im(emul_op);
536 +                dg.gen_jmp(emul_op_trampoline);
537 +                cg_context.done_compile = true;
538 +                status = COMPILE_EPILOGUE_OK;
539 +                break;
540 + #endif
541 +                // Invoke EmulOp handler
542                  typedef void (*func_t)(dyngen_cpu_base, uint32);
543                  func_t func = (func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op).ptr();
544 <                dg.gen_invoke_CPU_im(func, EMUL_OP_field::extract(opcode) - 3);
544 >                dg.gen_invoke_CPU_im(func, emul_op);
545                  cg_context.done_compile = false;
546 <                compiled = true;
546 >                status = COMPILE_CODE_OK;
547                  break;
548          }
549          }
550 <        return compiled;
550 >        return status;
551 > #endif
552 >        return COMPILE_FAILURE;
553 > }
554 >
555 > // CPU context to preserve on interrupt
556 > sheepshaver_cpu::interrupt_context::interrupt_context(sheepshaver_cpu *_cpu, const char *_where)
557 > {
558 > #if SAFE_INTERRUPT_PPC >= 2
559 >        cpu = _cpu;
560 >        where = _where;
561 >
562 >        // Save interrupt context
563 >        memcpy(&gpr[0], &cpu->gpr(0), sizeof(gpr));
564 >        pc = cpu->pc();
565 >        lr = cpu->lr();
566 >        ctr = cpu->ctr();
567 >        cr = cpu->get_cr();
568 >        xer = cpu->get_xer();
569 > #endif
570 > }
571 >
572 > sheepshaver_cpu::interrupt_context::~interrupt_context()
573 > {
574 > #if SAFE_INTERRUPT_PPC >= 2
575 >        // Check whether CPU context was preserved by interrupt
576 >        if (memcmp(&gpr[0], &cpu->gpr(0), sizeof(gpr)) != 0) {
577 >                printf("FATAL: %s: interrupt clobbers registers\n", where);
578 >                for (int i = 0; i < 32; i++)
579 >                        if (gpr[i] != cpu->gpr(i))
580 >                                printf(" r%d: %08x -> %08x\n", i, gpr[i], cpu->gpr(i));
581 >        }
582 >        if (pc != cpu->pc())
583 >                printf("FATAL: %s: interrupt clobbers PC\n", where);
584 >        if (lr != cpu->lr())
585 >                printf("FATAL: %s: interrupt clobbers LR\n", where);
586 >        if (ctr != cpu->ctr())
587 >                printf("FATAL: %s: interrupt clobbers CTR\n", where);
588 >        if (cr != cpu->get_cr())
589 >                printf("FATAL: %s: interrupt clobbers CR\n", where);
590 >        if (xer != cpu->get_xer())
591 >                printf("FATAL: %s: interrupt clobbers XER\n", where);
592   #endif
389        return false;
593   }
594  
595   // Handle MacOS interrupt
# Line 397 | Line 600 | void sheepshaver_cpu::interrupt(uint32 e
600          const clock_t interrupt_start = clock();
601   #endif
602  
603 < #if !MULTICORE_CPU
603 > #if SAFE_INTERRUPT_PPC
604 >        static int depth = 0;
605 >        if (depth != 0)
606 >                printf("FATAL: sheepshaver_cpu::interrupt() called more than once: %d\n", depth);
607 >        depth++;
608 > #endif
609 >
610          // Save program counters and branch registers
611          uint32 saved_pc = pc();
612          uint32 saved_lr = lr();
613          uint32 saved_ctr= ctr();
614          uint32 saved_sp = gpr(1);
406 #endif
615  
616          // Initialize stack pointer to SheepShaver alternate stack base
617          gpr(1) = SignalStackBase() - 64;
# Line 443 | Line 651 | void sheepshaver_cpu::interrupt(uint32 e
651          // Enter nanokernel
652          execute(entry);
653  
446 #if !MULTICORE_CPU
654          // Restore program counters and branch registers
655          pc() = saved_pc;
656          lr() = saved_lr;
657          ctr()= saved_ctr;
658          gpr(1) = saved_sp;
452 #endif
659  
660   #if EMUL_TIME_STATS
661          interrupt_time += (clock() - interrupt_start);
662   #endif
663 +
664 + #if SAFE_INTERRUPT_PPC
665 +        depth--;
666 + #endif
667   }
668  
669   // Execute 68k routine
# Line 647 | Line 857 | inline void sheepshaver_cpu::get_resourc
857   *              SheepShaver CPU engine interface
858   **/
859  
860 < static sheepshaver_cpu *main_cpu = NULL;                // CPU emulator to handle usual control flow
861 < static sheepshaver_cpu *interrupt_cpu = NULL;   // CPU emulator to handle interrupts
652 < static sheepshaver_cpu *current_cpu = NULL;             // Current CPU emulator context
860 > // PowerPC CPU emulator
861 > static sheepshaver_cpu *ppc_cpu = NULL;
862  
863   void FlushCodeCache(uintptr start, uintptr end)
864   {
865          D(bug("FlushCodeCache(%08x, %08x)\n", start, end));
866 <        main_cpu->invalidate_cache_range(start, end);
658 < #if MULTICORE_CPU
659 <        interrupt_cpu->invalidate_cache_range(start, end);
660 < #endif
661 < }
662 <
663 < static inline void cpu_push(sheepshaver_cpu *new_cpu)
664 < {
665 < #if MULTICORE_CPU
666 <        current_cpu = new_cpu;
667 < #endif
668 < }
669 <
670 < static inline void cpu_pop()
671 < {
672 < #if MULTICORE_CPU
673 <        current_cpu = main_cpu;
674 < #endif
866 >        ppc_cpu->invalidate_cache_range(start, end);
867   }
868  
869   // Dump PPC registers
870   static void dump_registers(void)
871   {
872 <        current_cpu->dump_registers();
872 >        ppc_cpu->dump_registers();
873   }
874  
875   // Dump log
876   static void dump_log(void)
877   {
878 <        current_cpu->dump_log();
878 >        ppc_cpu->dump_log();
879   }
880  
881   /*
# Line 706 | Line 898 | static sigsegv_return_t sigsegv_handler(
898                  return SIGSEGV_RETURN_SKIP_INSTRUCTION;
899  
900          // Get program counter of target CPU
901 <        sheepshaver_cpu * const cpu = current_cpu;
901 >        sheepshaver_cpu * const cpu = ppc_cpu;
902          const uint32 pc = cpu->pc();
903          
904          // Fault in Mac ROM or RAM?
# Line 746 | Line 938 | static sigsegv_return_t sigsegv_handler(
938          printf("SIGSEGV\n");
939          printf("  pc %p\n", fault_instruction);
940          printf("  ea %p\n", fault_address);
749        printf(" cpu %s\n", current_cpu == main_cpu ? "main" : "interrupts");
941          dump_registers();
942 <        current_cpu->dump_log();
942 >        ppc_cpu->dump_log();
943          enter_mon();
944          QuitEmulator();
945  
# Line 758 | Line 949 | static sigsegv_return_t sigsegv_handler(
949   void init_emul_ppc(void)
950   {
951          // Initialize main CPU emulator
952 <        main_cpu = new sheepshaver_cpu();
953 <        main_cpu->set_register(powerpc_registers::GPR(3), any_register((uint32)ROM_BASE + 0x30d000));
954 <        main_cpu->set_register(powerpc_registers::GPR(4), any_register(KernelDataAddr + 0x1000));
952 >        ppc_cpu = new sheepshaver_cpu();
953 >        ppc_cpu->set_register(powerpc_registers::GPR(3), any_register((uint32)ROM_BASE + 0x30d000));
954 >        ppc_cpu->set_register(powerpc_registers::GPR(4), any_register(KernelDataAddr + 0x1000));
955          WriteMacInt32(XLM_RUN_MODE, MODE_68K);
956  
766 #if MULTICORE_CPU
767        // Initialize alternate CPU emulator to handle interrupts
768        interrupt_cpu = new sheepshaver_cpu();
769 #endif
770
957          // Install the handler for SIGSEGV
958          sigsegv_install_handler(sigsegv_handler);
959  
# Line 812 | Line 998 | void exit_emul_ppc(void)
998          printf("\n");
999   #endif
1000  
1001 <        delete main_cpu;
816 < #if MULTICORE_CPU
817 <        delete interrupt_cpu;
818 < #endif
1001 >        delete ppc_cpu;
1002   }
1003  
1004 + #if PPC_ENABLE_JIT && PPC_REENTRANT_JIT
1005 + // Initialize EmulOp trampolines
1006 + void init_emul_op_trampolines(basic_dyngen & dg)
1007 + {
1008 +        typedef void (*func_t)(dyngen_cpu_base, uint32);
1009 +        func_t func;
1010 +
1011 +        // EmulOp
1012 +        emul_op_trampoline = dg.gen_start();
1013 +        func = (func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op).ptr();
1014 +        dg.gen_invoke_CPU_T0(func);
1015 +        dg.gen_exec_return();
1016 +        dg.gen_end();
1017 +
1018 +        // NativeOp
1019 +        native_op_trampoline = dg.gen_start();
1020 +        func = (func_t)nv_mem_fun(&sheepshaver_cpu::execute_native_op).ptr();
1021 +        dg.gen_invoke_CPU_T0(func);    
1022 +        dg.gen_exec_return();
1023 +        dg.gen_end();
1024 +
1025 +        D(bug("EmulOp trampoline:   %p\n", emul_op_trampoline));
1026 +        D(bug("NativeOp trampoline: %p\n", native_op_trampoline));
1027 + }
1028 + #endif
1029 +
1030   /*
1031   *  Emulation loop
1032   */
1033  
1034   void emul_ppc(uint32 entry)
1035   {
827        current_cpu = main_cpu;
1036   #if 0
1037 <        current_cpu->start_log();
1037 >        ppc_cpu->start_log();
1038   #endif
1039          // start emulation loop and enable code translation or caching
1040 <        current_cpu->execute(entry);
1040 >        ppc_cpu->execute(entry);
1041   }
1042  
1043   /*
1044   *  Handle PowerPC interrupt
1045   */
1046  
839 #if ASYNC_IRQ
840 void HandleInterrupt(void)
841 {
842        main_cpu->handle_interrupt();
843 }
844 #else
1047   void TriggerInterrupt(void)
1048   {
1049   #if 0
1050    WriteMacInt32(0x16a, ReadMacInt32(0x16a) + 1);
1051   #else
1052    // Trigger interrupt to main cpu only
1053 <  if (main_cpu)
1054 <          main_cpu->trigger_interrupt();
1053 >  if (ppc_cpu)
1054 >          ppc_cpu->trigger_interrupt();
1055   #endif
1056   }
855 #endif
1057  
1058   void sheepshaver_cpu::handle_interrupt(void)
1059   {
# Line 864 | Line 1065 | void sheepshaver_cpu::handle_interrupt(v
1065          if (InterruptFlags == 0)
1066                  return;
1067  
1068 +        // Current interrupt nest level
1069 +        static int interrupt_depth = 0;
1070 +        ++interrupt_depth;
1071 +
1072          // Disable MacOS stack sniffer
1073          WriteMacInt32(0x110, 0);
1074  
# Line 871 | Line 1076 | void sheepshaver_cpu::handle_interrupt(v
1076          switch (ReadMacInt32(XLM_RUN_MODE)) {
1077          case MODE_68K:
1078                  // 68k emulator active, trigger 68k interrupt level 1
874                assert(current_cpu == main_cpu);
1079                  WriteMacInt16(tswap32(kernel_data->v[0x67c >> 2]), 1);
1080                  set_cr(get_cr() | tswap32(kernel_data->v[0x674 >> 2]));
1081                  break;
# Line 879 | Line 1083 | void sheepshaver_cpu::handle_interrupt(v
1083   #if INTERRUPTS_IN_NATIVE_MODE
1084          case MODE_NATIVE:
1085                  // 68k emulator inactive, in nanokernel?
1086 <                assert(current_cpu == main_cpu);
1087 <                if (gpr(1) != KernelDataAddr) {
1086 >                if (gpr(1) != KernelDataAddr && interrupt_depth == 1) {
1087 >                        interrupt_context ctx(this, "PowerPC mode");
1088 >
1089                          // Prepare for 68k interrupt level 1
1090                          WriteMacInt16(tswap32(kernel_data->v[0x67c >> 2]), 1);
1091                          WriteMacInt32(tswap32(kernel_data->v[0x658 >> 2]) + 0xdc,
# Line 889 | Line 1094 | void sheepshaver_cpu::handle_interrupt(v
1094        
1095                          // Execute nanokernel interrupt routine (this will activate the 68k emulator)
1096                          DisableInterrupt();
892                        cpu_push(interrupt_cpu);
1097                          if (ROMType == ROMTYPE_NEWWORLD)
1098 <                                current_cpu->interrupt(ROM_BASE + 0x312b1c);
1098 >                                ppc_cpu->interrupt(ROM_BASE + 0x312b1c);
1099                          else
1100 <                                current_cpu->interrupt(ROM_BASE + 0x312a3c);
897 <                        cpu_pop();
1100 >                                ppc_cpu->interrupt(ROM_BASE + 0x312a3c);
1101                  }
1102                  break;
1103   #endif
# Line 903 | Line 1106 | void sheepshaver_cpu::handle_interrupt(v
1106          case MODE_EMUL_OP:
1107                  // 68k emulator active, within EMUL_OP routine, execute 68k interrupt routine directly when interrupt level is 0
1108                  if ((ReadMacInt32(XLM_68K_R25) & 7) == 0) {
1109 +                        interrupt_context ctx(this, "68k mode");
1110   #if 1
1111                          // Execute full 68k interrupt routine
1112                          M68kRegisters r;
# Line 932 | Line 1136 | void sheepshaver_cpu::handle_interrupt(v
1136                  break;
1137   #endif
1138          }
1139 +
1140 +        // We are done with this interrupt
1141 +        --interrupt_depth;
1142   }
1143  
1144   static void get_resource(void);
# Line 940 | Line 1147 | static void get_ind_resource(void);
1147   static void get_1_ind_resource(void);
1148   static void r_get_resource(void);
1149  
1150 < #define GPR(REG) current_cpu->gpr(REG)
1151 <
945 < static void NativeOp(int selector)
1150 > // Execute NATIVE_OP routine
1151 > void sheepshaver_cpu::execute_native_op(uint32 selector)
1152   {
1153   #if EMUL_TIME_STATS
1154          native_exec_count++;
# Line 960 | Line 1166 | static void NativeOp(int selector)
1166                  VideoVBL();
1167                  break;
1168          case NATIVE_VIDEO_DO_DRIVER_IO:
1169 <                GPR(3) = (int32)(int16)VideoDoDriverIO((void *)GPR(3), (void *)GPR(4),
1170 <                                                                                           (void *)GPR(5), GPR(6), GPR(7));
1169 >                gpr(3) = (int32)(int16)VideoDoDriverIO((void *)gpr(3), (void *)gpr(4),
1170 >                                                                                           (void *)gpr(5), gpr(6), gpr(7));
1171                  break;
1172   #ifdef WORDS_BIGENDIAN
1173          case NATIVE_ETHER_IRQ:
1174                  EtherIRQ();
1175                  break;
1176          case NATIVE_ETHER_INIT:
1177 <                GPR(3) = InitStreamModule((void *)GPR(3));
1177 >                gpr(3) = InitStreamModule((void *)gpr(3));
1178                  break;
1179          case NATIVE_ETHER_TERM:
1180                  TerminateStreamModule();
1181                  break;
1182          case NATIVE_ETHER_OPEN:
1183 <                GPR(3) = ether_open((queue_t *)GPR(3), (void *)GPR(4), GPR(5), GPR(6), (void*)GPR(7));
1183 >                gpr(3) = ether_open((queue_t *)gpr(3), (void *)gpr(4), gpr(5), gpr(6), (void*)gpr(7));
1184                  break;
1185          case NATIVE_ETHER_CLOSE:
1186 <                GPR(3) = ether_close((queue_t *)GPR(3), GPR(4), (void *)GPR(5));
1186 >                gpr(3) = ether_close((queue_t *)gpr(3), gpr(4), (void *)gpr(5));
1187                  break;
1188          case NATIVE_ETHER_WPUT:
1189 <                GPR(3) = ether_wput((queue_t *)GPR(3), (mblk_t *)GPR(4));
1189 >                gpr(3) = ether_wput((queue_t *)gpr(3), (mblk_t *)gpr(4));
1190                  break;
1191          case NATIVE_ETHER_RSRV:
1192 <                GPR(3) = ether_rsrv((queue_t *)GPR(3));
1192 >                gpr(3) = ether_rsrv((queue_t *)gpr(3));
1193                  break;
1194   #else
1195          case NATIVE_ETHER_INIT:
1196                  // FIXME: needs more complicated thunks
1197 <                GPR(3) = false;
1197 >                gpr(3) = false;
1198                  break;
1199   #endif
1200          case NATIVE_SYNC_HOOK:
1201 <                GPR(3) = NQD_sync_hook(GPR(3));
1201 >                gpr(3) = NQD_sync_hook(gpr(3));
1202                  break;
1203          case NATIVE_BITBLT_HOOK:
1204 <                GPR(3) = NQD_bitblt_hook(GPR(3));
1204 >                gpr(3) = NQD_bitblt_hook(gpr(3));
1205                  break;
1206          case NATIVE_BITBLT:
1207 <                NQD_bitblt(GPR(3));
1207 >                NQD_bitblt(gpr(3));
1208                  break;
1209          case NATIVE_FILLRECT_HOOK:
1210 <                GPR(3) = NQD_fillrect_hook(GPR(3));
1210 >                gpr(3) = NQD_fillrect_hook(gpr(3));
1211                  break;
1212          case NATIVE_INVRECT:
1213 <                NQD_invrect(GPR(3));
1213 >                NQD_invrect(gpr(3));
1214                  break;
1215          case NATIVE_FILLRECT:
1216 <                NQD_fillrect(GPR(3));
1216 >                NQD_fillrect(gpr(3));
1217                  break;
1218          case NATIVE_SERIAL_NOTHING:
1219          case NATIVE_SERIAL_OPEN:
# Line 1026 | Line 1232 | static void NativeOp(int selector)
1232                          SerialStatus,
1233                          SerialClose
1234                  };
1235 <                GPR(3) = serial_callbacks[selector - NATIVE_SERIAL_NOTHING](GPR(3), GPR(4));
1235 >                gpr(3) = serial_callbacks[selector - NATIVE_SERIAL_NOTHING](gpr(3), gpr(4));
1236                  break;
1237          }
1238          case NATIVE_GET_RESOURCE:
# Line 1036 | Line 1242 | static void NativeOp(int selector)
1242          case NATIVE_R_GET_RESOURCE: {
1243                  typedef void (*GetResourceCallback)(void);
1244                  static const GetResourceCallback get_resource_callbacks[] = {
1245 <                        get_resource,
1246 <                        get_1_resource,
1247 <                        get_ind_resource,
1248 <                        get_1_ind_resource,
1249 <                        r_get_resource
1245 >                        ::get_resource,
1246 >                        ::get_1_resource,
1247 >                        ::get_ind_resource,
1248 >                        ::get_1_ind_resource,
1249 >                        ::r_get_resource
1250                  };
1251                  get_resource_callbacks[selector - NATIVE_GET_RESOURCE]();
1252                  break;
# Line 1052 | Line 1258 | static void NativeOp(int selector)
1258                  EnableInterrupt();
1259                  break;
1260          case NATIVE_MAKE_EXECUTABLE:
1261 <                MakeExecutable(0, (void *)GPR(4), GPR(5));
1261 >                MakeExecutable(0, (void *)gpr(4), gpr(5));
1262                  break;
1263          case NATIVE_CHECK_LOAD_INVOC:
1264 <                check_load_invoc(GPR(3), GPR(4), GPR(5));
1264 >                check_load_invoc(gpr(3), gpr(4), gpr(5));
1265                  break;
1266          default:
1267                  printf("FATAL: NATIVE_OP called with bogus selector %d\n", selector);
# Line 1076 | Line 1282 | static void NativeOp(int selector)
1282  
1283   void Execute68k(uint32 pc, M68kRegisters *r)
1284   {
1285 <        current_cpu->execute_68k(pc, r);
1285 >        ppc_cpu->execute_68k(pc, r);
1286   }
1287  
1288   /*
# Line 1099 | Line 1305 | void Execute68kTrap(uint16 trap, M68kReg
1305  
1306   uint32 call_macos(uint32 tvect)
1307   {
1308 <        return current_cpu->execute_macos_code(tvect, 0, NULL);
1308 >        return ppc_cpu->execute_macos_code(tvect, 0, NULL);
1309   }
1310  
1311   uint32 call_macos1(uint32 tvect, uint32 arg1)
1312   {
1313          const uint32 args[] = { arg1 };
1314 <        return current_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1314 >        return ppc_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1315   }
1316  
1317   uint32 call_macos2(uint32 tvect, uint32 arg1, uint32 arg2)
1318   {
1319          const uint32 args[] = { arg1, arg2 };
1320 <        return current_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1320 >        return ppc_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1321   }
1322  
1323   uint32 call_macos3(uint32 tvect, uint32 arg1, uint32 arg2, uint32 arg3)
1324   {
1325          const uint32 args[] = { arg1, arg2, arg3 };
1326 <        return current_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1326 >        return ppc_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1327   }
1328  
1329   uint32 call_macos4(uint32 tvect, uint32 arg1, uint32 arg2, uint32 arg3, uint32 arg4)
1330   {
1331          const uint32 args[] = { arg1, arg2, arg3, arg4 };
1332 <        return current_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1332 >        return ppc_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1333   }
1334  
1335   uint32 call_macos5(uint32 tvect, uint32 arg1, uint32 arg2, uint32 arg3, uint32 arg4, uint32 arg5)
1336   {
1337          const uint32 args[] = { arg1, arg2, arg3, arg4, arg5 };
1338 <        return current_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1338 >        return ppc_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1339   }
1340  
1341   uint32 call_macos6(uint32 tvect, uint32 arg1, uint32 arg2, uint32 arg3, uint32 arg4, uint32 arg5, uint32 arg6)
1342   {
1343          const uint32 args[] = { arg1, arg2, arg3, arg4, arg5, arg6 };
1344 <        return current_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1344 >        return ppc_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1345   }
1346  
1347   uint32 call_macos7(uint32 tvect, uint32 arg1, uint32 arg2, uint32 arg3, uint32 arg4, uint32 arg5, uint32 arg6, uint32 arg7)
1348   {
1349          const uint32 args[] = { arg1, arg2, arg3, arg4, arg5, arg6, arg7 };
1350 <        return current_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1350 >        return ppc_cpu->execute_macos_code(tvect, sizeof(args)/sizeof(args[0]), args);
1351   }
1352  
1353   /*
# Line 1150 | Line 1356 | uint32 call_macos7(uint32 tvect, uint32
1356  
1357   void get_resource(void)
1358   {
1359 <        current_cpu->get_resource(ReadMacInt32(XLM_GET_RESOURCE));
1359 >        ppc_cpu->get_resource(ReadMacInt32(XLM_GET_RESOURCE));
1360   }
1361  
1362   void get_1_resource(void)
1363   {
1364 <        current_cpu->get_resource(ReadMacInt32(XLM_GET_1_RESOURCE));
1364 >        ppc_cpu->get_resource(ReadMacInt32(XLM_GET_1_RESOURCE));
1365   }
1366  
1367   void get_ind_resource(void)
1368   {
1369 <        current_cpu->get_resource(ReadMacInt32(XLM_GET_IND_RESOURCE));
1369 >        ppc_cpu->get_resource(ReadMacInt32(XLM_GET_IND_RESOURCE));
1370   }
1371  
1372   void get_1_ind_resource(void)
1373   {
1374 <        current_cpu->get_resource(ReadMacInt32(XLM_GET_1_IND_RESOURCE));
1374 >        ppc_cpu->get_resource(ReadMacInt32(XLM_GET_1_IND_RESOURCE));
1375   }
1376  
1377   void r_get_resource(void)
1378   {
1379 <        current_cpu->get_resource(ReadMacInt32(XLM_R_GET_RESOURCE));
1379 >        ppc_cpu->get_resource(ReadMacInt32(XLM_R_GET_RESOURCE));
1380   }

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines