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.44 by gbeauche, 2004-06-05T07:09:38Z vs.
Revision 1.56 by gbeauche, 2005-01-30T21:12:07Z

# Line 42 | Line 42
42  
43   #include <stdio.h>
44   #include <stdlib.h>
45 + #ifdef HAVE_MALLOC_H
46 + #include <malloc.h>
47 + #endif
48 +
49 + #ifdef USE_SDL_VIDEO
50 + #include <SDL_events.h>
51 + #endif
52  
53   #if ENABLE_MON
54   #include "mon.h"
# Line 101 | Line 108 | const uint32 POWERPC_EXEC_RETURN = POWER
108   // Interrupts in native mode?
109   #define INTERRUPTS_IN_NATIVE_MODE 1
110  
104 // Enable native EMUL_OPs to be run without a mode switch
105 #define ENABLE_NATIVE_EMUL_OP 1
106
111   // Pointer to Kernel Data
112 < static KernelData * const kernel_data = (KernelData *)KERNEL_DATA_BASE;
112 > static KernelData * kernel_data;
113  
114   // SIGSEGV handler
115 < static sigsegv_return_t sigsegv_handler(sigsegv_address_t, sigsegv_address_t);
115 > sigsegv_return_t sigsegv_handler(sigsegv_address_t, sigsegv_address_t);
116  
117   #if PPC_ENABLE_JIT && PPC_REENTRANT_JIT
118   // Special trampolines for EmulOp and NativeOp
# Line 138 | Line 142 | class sheepshaver_cpu
142          void init_decoder();
143          void execute_sheep(uint32 opcode);
144  
141        // Filter out EMUL_OP routines that only call native code
142        bool filter_execute_emul_op(uint32 emul_op);
143
144        // "Native" EMUL_OP routines
145        void execute_emul_op_microseconds();
146        void execute_emul_op_idle_time_1();
147        void execute_emul_op_idle_time_2();
148
145          // CPU context to preserve on interrupt
146          class interrupt_context {
147                  uint32 gpr[32];
148 +                double fpr[32];
149                  uint32 pc;
150                  uint32 lr;
151                  uint32 ctr;
152                  uint32 cr;
153                  uint32 xer;
154 +                uint32 fpscr;
155                  sheepshaver_cpu *cpu;
156                  const char *where;
157          public:
# Line 187 | Line 185 | public:
185          // Execute MacOS/PPC code
186          uint32 execute_macos_code(uint32 tvect, int nargs, uint32 const *args);
187  
188 + #if PPC_ENABLE_JIT
189          // Compile one instruction
190          virtual int compile1(codegen_context_t & cg_context);
191 <
191 > #endif
192          // Resource manager thunk
193          void get_resource(uint32 old_get_resource);
194  
# Line 199 | Line 198 | public:
198  
199          // Make sure the SIGSEGV handler can access CPU registers
200          friend sigsegv_return_t sigsegv_handler(sigsegv_address_t, sigsegv_address_t);
201 +
202 +        // Memory allocator returning areas aligned on 16-byte boundaries
203 +        void *operator new(size_t size);
204 +        void operator delete(void *p);
205   };
206  
207   // Memory allocator returning areas aligned on 16-byte boundaries
208 < void *operator new(size_t size)
208 > void *sheepshaver_cpu::operator new(size_t size)
209   {
210          void *p;
211  
# Line 221 | Line 224 | void *operator new(size_t size)
224          return p;
225   }
226  
227 < void operator delete(void *p)
227 > void sheepshaver_cpu::operator delete(void *p)
228   {
229   #if defined(HAVE_MEMALIGN) || defined(HAVE_VALLOC)
230   #if defined(__GLIBC__)
# Line 270 | Line 273 | typedef bit_field< 19, 19 > FN_field;
273   typedef bit_field< 20, 25 > NATIVE_OP_field;
274   typedef bit_field< 26, 31 > EMUL_OP_field;
275  
273 // "Native" EMUL_OP routines
274 #define GPR_A(REG) gpr(16 + (REG))
275 #define GPR_D(REG) gpr( 8 + (REG))
276
277 void sheepshaver_cpu::execute_emul_op_microseconds()
278 {
279        Microseconds(GPR_A(0), GPR_D(0));
280 }
281
282 void sheepshaver_cpu::execute_emul_op_idle_time_1()
283 {
284        // Sleep if no events pending
285        if (ReadMacInt32(0x14c) == 0)
286                Delay_usec(16667);
287        GPR_A(0) = ReadMacInt32(0x2b6);
288 }
289
290 void sheepshaver_cpu::execute_emul_op_idle_time_2()
291 {
292        // Sleep if no events pending
293        if (ReadMacInt32(0x14c) == 0)
294                Delay_usec(16667);
295        GPR_D(0) = (uint32)-2;
296 }
297
298 // Filter out EMUL_OP routines that only call native code
299 bool sheepshaver_cpu::filter_execute_emul_op(uint32 emul_op)
300 {
301        switch (emul_op) {
302        case OP_MICROSECONDS:
303                execute_emul_op_microseconds();
304                return true;
305        case OP_IDLE_TIME:
306                execute_emul_op_idle_time_1();
307                return true;
308        case OP_IDLE_TIME_2:
309                execute_emul_op_idle_time_2();
310                return true;
311        }
312        return false;
313 }
314
276   // Execute EMUL_OP routine
277   void sheepshaver_cpu::execute_emul_op(uint32 emul_op)
278   {
318 #if ENABLE_NATIVE_EMUL_OP
319        // First, filter out EMUL_OPs that can be executed without a mode switch
320        if (filter_execute_emul_op(emul_op))
321                return;
322 #endif
323
279          M68kRegisters r68;
280          WriteMacInt32(XLM_68K_R25, gpr(25));
281          WriteMacInt32(XLM_RUN_MODE, MODE_EMUL_OP);
# Line 373 | Line 328 | void sheepshaver_cpu::execute_sheep(uint
328   }
329  
330   // Compile one instruction
331 + #if PPC_ENABLE_JIT
332   int sheepshaver_cpu::compile1(codegen_context_t & cg_context)
333   {
378 #if PPC_ENABLE_JIT
334          const instr_info_t *ii = cg_context.instr_info;
335          if (ii->mnemo != PPC_I(SHEEP))
336                  return COMPILE_FAILURE;
# Line 446 | Line 401 | int sheepshaver_cpu::compile1(codegen_co
401                          status = COMPILE_CODE_OK;
402                          break;
403   #endif
449                case NATIVE_DISABLE_INTERRUPT:
450                        dg.gen_invoke(DisableInterrupt);
451                        status = COMPILE_CODE_OK;
452                        break;
453                case NATIVE_ENABLE_INTERRUPT:
454                        dg.gen_invoke(EnableInterrupt);
455                        status = COMPILE_CODE_OK;
456                        break;
404                  case NATIVE_BITBLT:
405                          dg.gen_load_T0_GPR(3);
406                          dg.gen_invoke_T0((void (*)(uint32))NQD_bitblt);
# Line 510 | Line 457 | int sheepshaver_cpu::compile1(codegen_co
457  
458          default: {      // EMUL_OP
459                  uint32 emul_op = EMUL_OP_field::extract(opcode) - 3;
513 #if ENABLE_NATIVE_EMUL_OP
514                typedef void (*emul_op_func_t)(dyngen_cpu_base);
515                emul_op_func_t emul_op_func = 0;
516                switch (emul_op) {
517                case OP_MICROSECONDS:
518                        emul_op_func = (emul_op_func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op_microseconds).ptr();
519                        break;
520                case OP_IDLE_TIME:
521                        emul_op_func = (emul_op_func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op_idle_time_1).ptr();
522                        break;
523                case OP_IDLE_TIME_2:
524                        emul_op_func = (emul_op_func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op_idle_time_2).ptr();
525                        break;
526                }
527                if (emul_op_func) {
528                        dg.gen_invoke_CPU(emul_op_func);
529                        cg_context.done_compile = false;
530                        status = COMPILE_CODE_OK;
531                        break;
532                }
533 #endif
460   #if PPC_REENTRANT_JIT
461                  // Try to execute EmulOp trampoline
462                  dg.gen_set_PC_im(cg_context.pc + 4);
# Line 550 | Line 476 | int sheepshaver_cpu::compile1(codegen_co
476          }
477          }
478          return status;
553 #endif
554        return COMPILE_FAILURE;
479   }
480 + #endif
481  
482   // CPU context to preserve on interrupt
483   sheepshaver_cpu::interrupt_context::interrupt_context(sheepshaver_cpu *_cpu, const char *_where)
# Line 563 | Line 488 | sheepshaver_cpu::interrupt_context::inte
488  
489          // Save interrupt context
490          memcpy(&gpr[0], &cpu->gpr(0), sizeof(gpr));
491 +        memcpy(&fpr[0], &cpu->fpr(0), sizeof(fpr));
492          pc = cpu->pc();
493          lr = cpu->lr();
494          ctr = cpu->ctr();
495          cr = cpu->get_cr();
496          xer = cpu->get_xer();
497 +        fpscr = cpu->fpscr();
498   #endif
499   }
500  
# Line 581 | Line 508 | sheepshaver_cpu::interrupt_context::~int
508                          if (gpr[i] != cpu->gpr(i))
509                                  printf(" r%d: %08x -> %08x\n", i, gpr[i], cpu->gpr(i));
510          }
511 +        if (memcmp(&fpr[0], &cpu->fpr(0), sizeof(fpr)) != 0) {
512 +                printf("FATAL: %s: interrupt clobbers registers\n", where);
513 +                for (int i = 0; i < 32; i++)
514 +                        if (fpr[i] != cpu->fpr(i))
515 +                                printf(" r%d: %f -> %f\n", i, fpr[i], cpu->fpr(i));
516 +        }
517          if (pc != cpu->pc())
518                  printf("FATAL: %s: interrupt clobbers PC\n", where);
519          if (lr != cpu->lr())
# Line 591 | Line 524 | sheepshaver_cpu::interrupt_context::~int
524                  printf("FATAL: %s: interrupt clobbers CR\n", where);
525          if (xer != cpu->get_xer())
526                  printf("FATAL: %s: interrupt clobbers XER\n", where);
527 +        if (fpscr != cpu->fpscr())
528 +                printf("FATAL: %s: interrupt clobbers FPSCR\n", where);
529   #endif
530   }
531  
# Line 884 | Line 819 | static void dump_log(void)
819   *  Initialize CPU emulation
820   */
821  
822 < static sigsegv_return_t sigsegv_handler(sigsegv_address_t fault_address, sigsegv_address_t fault_instruction)
822 > sigsegv_return_t sigsegv_handler(sigsegv_address_t fault_address, sigsegv_address_t fault_instruction)
823   {
824   #if ENABLE_VOSF
825          // Handle screen fault
# Line 896 | Line 831 | static sigsegv_return_t sigsegv_handler(
831          const uintptr addr = (uintptr)fault_address;
832   #if HAVE_SIGSEGV_SKIP_INSTRUCTION
833          // Ignore writes to ROM
834 <        if ((addr - ROM_BASE) < ROM_SIZE)
834 >        if ((addr - (uintptr)ROMBaseHost) < ROM_SIZE)
835                  return SIGSEGV_RETURN_SKIP_INSTRUCTION;
836  
837          // Get program counter of target CPU
# Line 956 | Line 891 | static sigsegv_return_t sigsegv_handler(
891  
892   void init_emul_ppc(void)
893   {
894 +        // Get pointer to KernelData in host address space
895 +        kernel_data = (KernelData *)Mac2HostAddr(KERNEL_DATA_BASE);
896 +
897          // Initialize main CPU emulator
898          ppc_cpu = new sheepshaver_cpu();
899          ppc_cpu->set_register(powerpc_registers::GPR(3), any_register((uint32)ROM_BASE + 0x30d000));
900          ppc_cpu->set_register(powerpc_registers::GPR(4), any_register(KernelDataAddr + 0x1000));
901          WriteMacInt32(XLM_RUN_MODE, MODE_68K);
902  
965        // Install the handler for SIGSEGV
966        sigsegv_install_handler(sigsegv_handler);
967
903   #if ENABLE_MON
904          // Install "regs" command in cxmon
905          mon_add_command("regs", dump_registers, "regs                     Dump PowerPC registers\n");
# Line 1067 | Line 1002 | void TriggerInterrupt(void)
1002  
1003   void sheepshaver_cpu::handle_interrupt(void)
1004   {
1005 <        // Do nothing if interrupts are disabled
1006 <        if (*(int32 *)XLM_IRQ_NEST > 0)
1007 <                return;
1005 > #ifdef USE_SDL_VIDEO
1006 >        // We must fill in the events queue in the same thread that did call SDL_SetVideoMode()
1007 >        SDL_PumpEvents();
1008 > #endif
1009  
1010 <        // Do nothing if there is no interrupt pending
1011 <        if (InterruptFlags == 0)
1010 >        // Do nothing if interrupts are disabled
1011 >        if (int32(ReadMacInt32(XLM_IRQ_NEST)) > 0)
1012                  return;
1013  
1014          // Current interrupt nest level
# Line 1128 | Line 1064 | void sheepshaver_cpu::handle_interrupt(v
1064                          M68kRegisters r;
1065                          uint32 old_r25 = ReadMacInt32(XLM_68K_R25);     // Save interrupt level
1066                          WriteMacInt32(XLM_68K_R25, 0x21);                       // Execute with interrupt level 1
1067 <                        static const uint8 proc[] = {
1067 >                        static const uint8 proc_template[] = {
1068                                  0x3f, 0x3c, 0x00, 0x00,                 // move.w       #$0000,-(sp)    (fake format word)
1069                                  0x48, 0x7a, 0x00, 0x0a,                 // pea          @1(pc)                  (return address)
1070                                  0x40, 0xe7,                                             // move         sr,-(sp)                (saved SR)
# Line 1136 | Line 1072 | void sheepshaver_cpu::handle_interrupt(v
1072                                  0x4e, 0xd0,                                             // jmp          (a0)
1073                                  M68K_RTS >> 8, M68K_RTS & 0xff  // @1
1074                          };
1075 <                        Execute68k((uint32)proc, &r);
1075 >                        BUILD_SHEEPSHAVER_PROCEDURE(proc);
1076 >                        Execute68k(proc, &r);
1077                          WriteMacInt32(XLM_68K_R25, old_r25);            // Restore interrupt level
1078   #else
1079                          // Only update cursor
# Line 1185 | Line 1122 | void sheepshaver_cpu::execute_native_op(
1122                  VideoVBL();
1123                  break;
1124          case NATIVE_VIDEO_DO_DRIVER_IO:
1125 <                gpr(3) = (int32)(int16)VideoDoDriverIO((void *)gpr(3), (void *)gpr(4),
1189 <                                                                                           (void *)gpr(5), gpr(6), gpr(7));
1125 >                gpr(3) = (int32)(int16)VideoDoDriverIO(gpr(3), gpr(4), gpr(5), gpr(6), gpr(7));
1126                  break;
1191 #ifdef WORDS_BIGENDIAN
1127          case NATIVE_ETHER_IRQ:
1128                  EtherIRQ();
1129                  break;
# Line 1210 | Line 1145 | void sheepshaver_cpu::execute_native_op(
1145          case NATIVE_ETHER_RSRV:
1146                  gpr(3) = ether_rsrv((queue_t *)gpr(3));
1147                  break;
1213 #else
1214        case NATIVE_ETHER_INIT:
1215                // FIXME: needs more complicated thunks
1216                gpr(3) = false;
1217                break;
1218 #endif
1148          case NATIVE_SYNC_HOOK:
1149                  gpr(3) = NQD_sync_hook(gpr(3));
1150                  break;
# Line 1270 | Line 1199 | void sheepshaver_cpu::execute_native_op(
1199                  get_resource_callbacks[selector - NATIVE_GET_RESOURCE]();
1200                  break;
1201          }
1273        case NATIVE_DISABLE_INTERRUPT:
1274                DisableInterrupt();
1275                break;
1276        case NATIVE_ENABLE_INTERRUPT:
1277                EnableInterrupt();
1278                break;
1202          case NATIVE_MAKE_EXECUTABLE:
1203 <                MakeExecutable(0, (void *)gpr(4), gpr(5));
1203 >                MakeExecutable(0, gpr(4), gpr(5));
1204                  break;
1205          case NATIVE_CHECK_LOAD_INVOC:
1206                  check_load_invoc(gpr(3), gpr(4), gpr(5));

Diff Legend

Removed lines
+ Added lines
< Changed lines
> Changed lines