ViewVC Help

View File | Revision Log | Show Annotations | Revision Graph | Root Listing

root/cebix/SheepShaver/src/kpx_cpu/sheepshaver_glue.cpp

Comparing SheepShaver/src/kpx_cpu/sheepshaver_glue.cpp (file contents):
Revision 1.7 by gbeauche, 2003-10-12T05:44:15Z vs.
Revision 1.27 by gbeauche, 2004-02-15T17:17:36Z

#	Line 1 | Line 1
1		/*
2		*  sheepshaver_glue.cpp - Glue Kheperix CPU to SheepShaver CPU engine interface
3		*
4	<	*  SheepShaver (C) 1997-2002 Christian Bauer and Marc Hellwig
4	>	*  SheepShaver (C) 1997-2004 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
#	Line 28 | Line 28
28		#include "macos_util.h"
29		#include "block-alloc.hpp"
30		#include "sigsegv.h"
31	–	#include "spcflags.h"
31		#include "cpu/ppc/ppc-cpu.hpp"
32		#include "cpu/ppc/ppc-operations.hpp"
33	+	#include "cpu/ppc/ppc-instructions.hpp"
34	+	#include "thunks.h"
35
36		// Used for NativeOp trampolines
37		#include "video.h"
38		#include "name_registry.h"
39		#include "serial.h"
40	+	#include "ether.h"
41
42		#include <stdio.h>
43
#	Line 44 | Line 46
46		#include "mon_disass.h"
47		#endif
48
49	<	#define DEBUG 1
49	>	#define DEBUG 0
50		#include "debug.h"
51
52	+	// Emulation time statistics
53	+	#define EMUL_TIME_STATS 1
54	+
55	+	#if EMUL_TIME_STATS
56	+	static clock_t emul_start_time;
57	+	static uint32 interrupt_count = 0;
58	+	static clock_t interrupt_time = 0;
59	+	static uint32 exec68k_count = 0;
60	+	static clock_t exec68k_time = 0;
61	+	static uint32 native_exec_count = 0;
62	+	static clock_t native_exec_time = 0;
63	+	static uint32 macos_exec_count = 0;
64	+	static clock_t macos_exec_time = 0;
65	+	#endif
66	+
67		static void enter_mon(void)
68		{
69		// Start up mon in real-mode
#	Line 56 | Line 73 | static void enter_mon(void)
73		#endif
74		}
75
76	+	// From main_*.cpp
77	+	extern uintptr SignalStackBase();
78	+
79	+	// From rsrc_patches.cpp
80	+	extern "C" void check_load_invoc(uint32 type, int16 id, uint32 h);
81	+
82	+	// PowerPC EmulOp to exit from emulation looop
83	+	const uint32 POWERPC_EXEC_RETURN = POWERPC_EMUL_OP | 1;
84	+
85		// Enable multicore (main/interrupts) cpu emulation?
86	<	#define MULTICORE_CPU 0
86	>	#define MULTICORE_CPU (ASYNC_IRQ ? 1 : 0)
87
88		// Enable Execute68k() safety checks?
89		#define SAFE_EXEC_68K 1
#	Line 74 | Line 100 | static void enter_mon(void)
100		// Pointer to Kernel Data
101		static KernelData * const kernel_data = (KernelData *)KERNEL_DATA_BASE;
102
103	+	// SIGSEGV handler
104	+	static sigsegv_return_t sigsegv_handler(sigsegv_address_t, sigsegv_address_t);
105	+
106	+	// JIT Compiler enabled?
107	+	static inline bool enable_jit_p()
108	+	{
109	+	return PrefsFindBool("jit");
110	+	}
111	+
112
113		/**
114		*              PowerPC emulator glue with special 'sheep' opcodes
115		**/
116
117	<	struct sheepshaver_exec_return { };
117	>	enum {
118	>	PPC_I(SHEEP) = PPC_I(MAX),
119	>	PPC_I(SHEEP_MAX)
120	>	};
121
122		class sheepshaver_cpu
123		: public powerpc_cpu
#	Line 89 | Line 127 | class sheepshaver_cpu
127
128		public:
129
130	<	sheepshaver_cpu()
131	<	: powerpc_cpu()
94	<	{ init_decoder(); }
130	>	// Constructor
131	>	sheepshaver_cpu();
132
133	<	// Condition Register accessors
133	>	// CR & XER accessors
134		uint32 get_cr() const           { return cr().get(); }
135		void set_cr(uint32 v)           { cr().set(v); }
136	+	uint32 get_xer() const          { return xer().get(); }
137	+	void set_xer(uint32 v)          { xer().set(v); }
138
139	<	// Execution loop
140	<	void execute(uint32 pc);
139	>	// Execute EMUL_OP routine
140	>	void execute_emul_op(uint32 emul_op);
141
142		// Execute 68k routine
143		void execute_68k(uint32 entry, M68kRegisters *r);
#	Line 109 | Line 148 | public:
148		// Execute MacOS/PPC code
149		uint32 execute_macos_code(uint32 tvect, int nargs, uint32 const *args);
150
151	+	// Compile one instruction
152	+	virtual bool compile1(codegen_context_t & cg_context);
153	+
154		// Resource manager thunk
155		void get_resource(uint32 old_get_resource);
156
157		// Handle MacOS interrupt
158		void interrupt(uint32 entry);
159	<
118	<	// spcflags for interrupts handling
119	<	static uint32 spcflags;
159	>	void handle_interrupt();
160
161		// Lazy memory allocator (one item at a time)
162		void *operator new(size_t size)
#	Line 126 | Line 166 | public:
166		// FIXME: really make surre array allocation fail at link time?
167		void *operator new[](size_t);
168		void operator delete[](void *p);
169	+
170	+	// Make sure the SIGSEGV handler can access CPU registers
171	+	friend sigsegv_return_t sigsegv_handler(sigsegv_address_t, sigsegv_address_t);
172		};
173
131	–	uint32 sheepshaver_cpu::spcflags = 0;
174		lazy_allocator< sheepshaver_cpu > allocator_helper< sheepshaver_cpu, lazy_allocator >::allocator;
175
176	<	void sheepshaver_cpu::init_decoder()
176	>	sheepshaver_cpu::sheepshaver_cpu()
177	>	: powerpc_cpu(enable_jit_p())
178		{
179	<	#ifndef PPC_NO_STATIC_II_INDEX_TABLE
180	<	static bool initialized = false;
138	<	if (initialized)
139	<	return;
140	<	initialized = true;
141	<	#endif
179	>	init_decoder();
180	>	}
181
182	+	void sheepshaver_cpu::init_decoder()
183	+	{
184		static const instr_info_t sheep_ii_table[] = {
185		{ "sheep",
186	<	(execute_fn)&sheepshaver_cpu::execute_sheep,
186	>	(execute_pmf)&sheepshaver_cpu::execute_sheep,
187		NULL,
188	+	PPC_I(SHEEP),
189		D_form, 6, 0, CFLOW_JUMP | CFLOW_TRAP
190		}
191		};
#	Line 171 | Line 213 | typedef bit_field< 20, 20 > FN_field;
213		typedef bit_field< 21, 25 > NATIVE_OP_field;
214		typedef bit_field< 26, 31 > EMUL_OP_field;
215
216	+	// Execute EMUL_OP routine
217	+	void sheepshaver_cpu::execute_emul_op(uint32 emul_op)
218	+	{
219	+	M68kRegisters r68;
220	+	WriteMacInt32(XLM_68K_R25, gpr(25));
221	+	WriteMacInt32(XLM_RUN_MODE, MODE_EMUL_OP);
222	+	for (int i = 0; i < 8; i++)
223	+	r68.d[i] = gpr(8 + i);
224	+	for (int i = 0; i < 7; i++)
225	+	r68.a[i] = gpr(16 + i);
226	+	r68.a[7] = gpr(1);
227	+	uint32 saved_cr = get_cr() & CR_field<2>::mask();
228	+	uint32 saved_xer = get_xer();
229	+	EmulOp(&r68, gpr(24), emul_op);
230	+	set_cr(saved_cr);
231	+	set_xer(saved_xer);
232	+	for (int i = 0; i < 8; i++)
233	+	gpr(8 + i) = r68.d[i];
234	+	for (int i = 0; i < 7; i++)
235	+	gpr(16 + i) = r68.a[i];
236	+	gpr(1) = r68.a[7];
237	+	WriteMacInt32(XLM_RUN_MODE, MODE_68K);
238	+	}
239	+
240		// Execute SheepShaver instruction
241		void sheepshaver_cpu::execute_sheep(uint32 opcode)
242		{
#	Line 181 | Line 247 | void sheepshaver_cpu::execute_sheep(uint
247		case 0:         // EMUL_RETURN
248		QuitEmulator();
249		break;
250	<
250	>
251		case 1:         // EXEC_RETURN
252	<	throw sheepshaver_exec_return();
252	>	spcflags().set(SPCFLAG_CPU_EXEC_RETURN);
253		break;
254
255		case 2:         // EXEC_NATIVE
#	Line 194 | Line 260 | void sheepshaver_cpu::execute_sheep(uint
260		pc() += 4;
261		break;
262
263	<	default: {      // EMUL_OP
264	<	M68kRegisters r68;
199	<	WriteMacInt32(XLM_68K_R25, gpr(25));
200	<	WriteMacInt32(XLM_RUN_MODE, MODE_EMUL_OP);
201	<	for (int i = 0; i < 8; i++)
202	<	r68.d[i] = gpr(8 + i);
203	<	for (int i = 0; i < 7; i++)
204	<	r68.a[i] = gpr(16 + i);
205	<	r68.a[7] = gpr(1);
206	<	EmulOp(&r68, gpr(24), EMUL_OP_field::extract(opcode) - 3);
207	<	for (int i = 0; i < 8; i++)
208	<	gpr(8 + i) = r68.d[i];
209	<	for (int i = 0; i < 7; i++)
210	<	gpr(16 + i) = r68.a[i];
211	<	gpr(1) = r68.a[7];
212	<	WriteMacInt32(XLM_RUN_MODE, MODE_68K);
263	>	default:        // EMUL_OP
264	>	execute_emul_op(EMUL_OP_field::extract(opcode) - 3);
265		pc() += 4;
266		break;
267		}
216	–	}
268		}
269
270	<	// Checks for pending interrupts
271	<	struct execute_nothing {
272	<	static inline void execute(powerpc_cpu *) { }
273	<	};
270	>	// Compile one instruction
271	>	bool sheepshaver_cpu::compile1(codegen_context_t & cg_context)
272	>	{
273	>	#if PPC_ENABLE_JIT
274	>	const instr_info_t *ii = cg_context.instr_info;
275	>	if (ii->mnemo != PPC_I(SHEEP))
276	>	return false;
277	>
278	>	bool compiled = false;
279	>	powerpc_dyngen & dg = cg_context.codegen;
280	>	uint32 opcode = cg_context.opcode;
281
282	<	struct execute_spcflags_check {
283	<	static inline void execute(powerpc_cpu *cpu) {
284	<	#if !ASYNC_IRQ
285	<	if (SPCFLAGS_TEST(SPCFLAG_ALL_BUT_EXEC_RETURN)) {
286	<	if (SPCFLAGS_TEST( SPCFLAG_ENTER_MON )) {
287	<	SPCFLAGS_CLEAR( SPCFLAG_ENTER_MON );
288	<	enter_mon();
289	<	}
290	<	if (SPCFLAGS_TEST( SPCFLAG_DOINT )) {
291	<	SPCFLAGS_CLEAR( SPCFLAG_DOINT );
292	<	HandleInterrupt();
293	<	}
294	<	if (SPCFLAGS_TEST( SPCFLAG_INT )) {
295	<	SPCFLAGS_CLEAR( SPCFLAG_INT );
296	<	SPCFLAGS_SET( SPCFLAG_DOINT );
282	>	switch (opcode & 0x3f) {
283	>	case 0:         // EMUL_RETURN
284	>	dg.gen_invoke(QuitEmulator);
285	>	compiled = true;
286	>	break;
287	>
288	>	case 1:         // EXEC_RETURN
289	>	dg.gen_spcflags_set(SPCFLAG_CPU_EXEC_RETURN);
290	>	compiled = true;
291	>	break;
292	>
293	>	case 2: {       // EXEC_NATIVE
294	>	uint32 selector = NATIVE_OP_field::extract(opcode);
295	>	switch (selector) {
296	>	case NATIVE_PATCH_NAME_REGISTRY:
297	>	dg.gen_invoke(DoPatchNameRegistry);
298	>	compiled = true;
299	>	break;
300	>	case NATIVE_VIDEO_INSTALL_ACCEL:
301	>	dg.gen_invoke(VideoInstallAccel);
302	>	compiled = true;
303	>	break;
304	>	case NATIVE_VIDEO_VBL:
305	>	dg.gen_invoke(VideoVBL);
306	>	compiled = true;
307	>	break;
308	>	case NATIVE_GET_RESOURCE:
309	>	case NATIVE_GET_1_RESOURCE:
310	>	case NATIVE_GET_IND_RESOURCE:
311	>	case NATIVE_GET_1_IND_RESOURCE:
312	>	case NATIVE_R_GET_RESOURCE: {
313	>	static const uint32 get_resource_ptr[] = {
314	>	XLM_GET_RESOURCE,
315	>	XLM_GET_1_RESOURCE,
316	>	XLM_GET_IND_RESOURCE,
317	>	XLM_GET_1_IND_RESOURCE,
318	>	XLM_R_GET_RESOURCE
319	>	};
320	>	uint32 old_get_resource = ReadMacInt32(get_resource_ptr[selector - NATIVE_GET_RESOURCE]);
321	>	typedef void (*func_t)(dyngen_cpu_base, uint32);
322	>	func_t func = (func_t)nv_mem_fun(&sheepshaver_cpu::get_resource).ptr();
323	>	dg.gen_invoke_CPU_im(func, old_get_resource);
324	>	compiled = true;
325	>	break;
326	>	}
327	>	case NATIVE_DISABLE_INTERRUPT:
328	>	dg.gen_invoke(DisableInterrupt);
329	>	compiled = true;
330	>	break;
331	>	case NATIVE_ENABLE_INTERRUPT:
332	>	dg.gen_invoke(EnableInterrupt);
333	>	compiled = true;
334	>	break;
335	>	case NATIVE_CHECK_LOAD_INVOC:
336	>	dg.gen_load_T0_GPR(3);
337	>	dg.gen_load_T1_GPR(4);
338	>	dg.gen_se_16_32_T1();
339	>	dg.gen_load_T2_GPR(5);
340	>	dg.gen_invoke_T0_T1_T2((void (*)(uint32, uint32, uint32))check_load_invoc);
341	>	compiled = true;
342	>	break;
343	>	}
344	>	if (FN_field::test(opcode)) {
345	>	if (compiled) {
346	>	dg.gen_load_A0_LR();
347	>	dg.gen_set_PC_A0();
348		}
349	+	cg_context.done_compile = true;
350		}
351	<	#endif
351	>	else
352	>	cg_context.done_compile = false;
353	>	break;
354		}
243	–	};
355
356	<	// Execution loop
357	<	void sheepshaver_cpu::execute(uint32 entry)
358	<	{
359	<	try {
360	<	pc() = entry;
361	<	powerpc_cpu::do_execute<execute_nothing, execute_spcflags_check>();
362	<	}
252	<	catch (sheepshaver_exec_return const &) {
253	<	// Nothing, simply return
356	>	default: {      // EMUL_OP
357	>	typedef void (*func_t)(dyngen_cpu_base, uint32);
358	>	func_t func = (func_t)nv_mem_fun(&sheepshaver_cpu::execute_emul_op).ptr();
359	>	dg.gen_invoke_CPU_im(func, EMUL_OP_field::extract(opcode) - 3);
360	>	cg_context.done_compile = false;
361	>	compiled = true;
362	>	break;
363		}
255	–	catch (...) {
256	–	printf("ERROR: execute() received an unknown exception!\n");
257	–	QuitEmulator();
364		}
365	+	return compiled;
366	+	#endif
367	+	return false;
368		}
369
370		// Handle MacOS interrupt
371		void sheepshaver_cpu::interrupt(uint32 entry)
372		{
373	+	#if EMUL_TIME_STATS
374	+	interrupt_count++;
375	+	const clock_t interrupt_start = clock();
376	+	#endif
377	+
378		#if !MULTICORE_CPU
379		// Save program counters and branch registers
380		uint32 saved_pc = pc();
#	Line 270 | Line 384 | void sheepshaver_cpu::interrupt(uint32 e
384		#endif
385
386		// Initialize stack pointer to SheepShaver alternate stack base
387	<	gpr(1) = SheepStack1Base - 64;
387	>	gpr(1) = SignalStackBase() - 64;
388
389		// Build trampoline to return from interrupt
390	<	uint32 trampoline[] = { htonl(POWERPC_EMUL_OP | 1) };
390	>	SheepVar32 trampoline = POWERPC_EXEC_RETURN;
391
392		// Prepare registers for nanokernel interrupt routine
393		kernel_data->v[0x004 >> 2] = htonl(gpr(1));
#	Line 292 | Line 406 | void sheepshaver_cpu::interrupt(uint32 e
406		gpr(1)  = KernelDataAddr;
407		gpr(7)  = ntohl(kernel_data->v[0x660 >> 2]);
408		gpr(8)  = 0;
409	<	gpr(10) = (uint32)trampoline;
410	<	gpr(12) = (uint32)trampoline;
411	<	gpr(13) = cr().get();
409	>	gpr(10) = trampoline.addr();
410	>	gpr(12) = trampoline.addr();
411	>	gpr(13) = get_cr();
412
413		// rlwimi. r7,r7,8,0,0
414		uint32 result = op_ppc_rlwimi::apply(gpr(7), 8, 0x80000000, gpr(7));
#	Line 302 | Line 416 | void sheepshaver_cpu::interrupt(uint32 e
416		gpr(7) = result;
417
418		gpr(11) = 0xf072; // MSR (SRR1)
419	<	cr().set((gpr(11) & 0x0fff0000) | (cr().get() & ~0x0fff0000));
419	>	cr().set((gpr(11) & 0x0fff0000) | (get_cr() & ~0x0fff0000));
420
421		// Enter nanokernel
422		execute(entry);
#	Line 314 | Line 428 | void sheepshaver_cpu::interrupt(uint32 e
428		ctr()= saved_ctr;
429		gpr(1) = saved_sp;
430		#endif
431	+
432	+	#if EMUL_TIME_STATS
433	+	interrupt_time += (clock() - interrupt_start);
434	+	#endif
435		}
436
437		// Execute 68k routine
438		void sheepshaver_cpu::execute_68k(uint32 entry, M68kRegisters *r)
439		{
440	+	#if EMUL_TIME_STATS
441	+	exec68k_count++;
442	+	const clock_t exec68k_start = clock();
443	+	#endif
444	+
445		#if SAFE_EXEC_68K
446		if (ReadMacInt32(XLM_RUN_MODE) != MODE_EMUL_OP)
447		printf("FATAL: Execute68k() not called from EMUL_OP mode\n");
#	Line 328 | Line 451 | void sheepshaver_cpu::execute_68k(uint32
451		uint32 saved_pc = pc();
452		uint32 saved_lr = lr();
453		uint32 saved_ctr= ctr();
454	+	uint32 saved_cr = get_cr();
455
456		// Create MacOS stack frame
457		// FIXME: make sure MacOS doesn't expect PPC registers to live on top
#	Line 399 | Line 523 | void sheepshaver_cpu::execute_68k(uint32
523		pc() = saved_pc;
524		lr() = saved_lr;
525		ctr()= saved_ctr;
526	+	set_cr(saved_cr);
527	+
528	+	#if EMUL_TIME_STATS
529	+	exec68k_time += (clock() - exec68k_start);
530	+	#endif
531		}
532
533		// Call MacOS PPC code
534		uint32 sheepshaver_cpu::execute_macos_code(uint32 tvect, int nargs, uint32 const *args)
535		{
536	+	#if EMUL_TIME_STATS
537	+	macos_exec_count++;
538	+	const clock_t macos_exec_start = clock();
539	+	#endif
540	+
541		// Save program counters and branch registers
542		uint32 saved_pc = pc();
543		uint32 saved_lr = lr();
544		uint32 saved_ctr= ctr();
545
546		// Build trampoline with EXEC_RETURN
547	<	uint32 trampoline[] = { htonl(POWERPC_EMUL_OP | 1) };
548	<	lr() = (uint32)trampoline;
547	>	SheepVar32 trampoline = POWERPC_EXEC_RETURN;
548	>	lr() = trampoline.addr();
549
550		gpr(1) -= 64;                                                           // Create stack frame
551		uint32 proc = ReadMacInt32(tvect);                      // Get routine address
#	Line 442 | Line 576 | uint32 sheepshaver_cpu::execute_macos_co
576		lr() = saved_lr;
577		ctr()= saved_ctr;
578
579	+	#if EMUL_TIME_STATS
580	+	macos_exec_time += (clock() - macos_exec_start);
581	+	#endif
582	+
583		return retval;
584		}
585
#	Line 451 | Line 589 | inline void sheepshaver_cpu::execute_ppc
589		// Save branch registers
590		uint32 saved_lr = lr();
591
592	<	const uint32 trampoline[] = { htonl(POWERPC_EMUL_OP | 1) };
593	<	lr() = (uint32)trampoline;
592	>	SheepVar32 trampoline = POWERPC_EXEC_RETURN;
593	>	WriteMacInt32(trampoline.addr(), POWERPC_EXEC_RETURN);
594	>	lr() = trampoline.addr();
595
596		execute(entry);
597
#	Line 461 | Line 600 | inline void sheepshaver_cpu::execute_ppc
600		}
601
602		// Resource Manager thunk
464	–	extern "C" void check_load_invoc(uint32 type, int16 id, uint32 h);
465	–
603		inline void sheepshaver_cpu::get_resource(uint32 old_get_resource)
604		{
605		uint32 type = gpr(3);
#	Line 546 | Line 683 | static sigsegv_return_t sigsegv_handler(
683		if ((addr - ROM_BASE) < ROM_SIZE)
684		return SIGSEGV_RETURN_SKIP_INSTRUCTION;
685
686	<	// Ignore all other faults, if requested
687	<	if (PrefsFindBool("ignoresegv"))
688	<	return SIGSEGV_RETURN_FAILURE;
686	>	// Get program counter of target CPU
687	>	sheepshaver_cpu * const cpu = current_cpu;
688	>	const uint32 pc = cpu->pc();
689	>
690	>	// Fault in Mac ROM or RAM?
691	>	bool mac_fault = (pc >= ROM_BASE) && (pc < (ROM_BASE + ROM_AREA_SIZE)) || (pc >= RAMBase) && (pc < (RAMBase + RAMSize));
692	>	if (mac_fault) {
693	>
694	>	// "VM settings" during MacOS 8 installation
695	>	if (pc == ROM_BASE + 0x488160 && cpu->gpr(20) == 0xf8000000)
696	>	return SIGSEGV_RETURN_SKIP_INSTRUCTION;
697	>
698	>	// MacOS 8.5 installation
699	>	else if (pc == ROM_BASE + 0x488140 && cpu->gpr(16) == 0xf8000000)
700	>	return SIGSEGV_RETURN_SKIP_INSTRUCTION;
701	>
702	>	// MacOS 8 serial drivers on startup
703	>	else if (pc == ROM_BASE + 0x48e080 && (cpu->gpr(8) == 0xf3012002 || cpu->gpr(8) == 0xf3012000))
704	>	return SIGSEGV_RETURN_SKIP_INSTRUCTION;
705	>
706	>	// MacOS 8.1 serial drivers on startup
707	>	else if (pc == ROM_BASE + 0x48c5e0 && (cpu->gpr(20) == 0xf3012002 || cpu->gpr(20) == 0xf3012000))
708	>	return SIGSEGV_RETURN_SKIP_INSTRUCTION;
709	>	else if (pc == ROM_BASE + 0x4a10a0 && (cpu->gpr(20) == 0xf3012002 || cpu->gpr(20) == 0xf3012000))
710	>	return SIGSEGV_RETURN_SKIP_INSTRUCTION;
711	>
712	>	// Ignore all other faults, if requested
713	>	if (PrefsFindBool("ignoresegv"))
714	>	return SIGSEGV_RETURN_SKIP_INSTRUCTION;
715	>	}
716		#else
717		#error "FIXME: You don't have the capability to skip instruction within signal handlers"
718		#endif
#	Line 570 | Line 734 | void init_emul_ppc(void)
734		// Initialize main CPU emulator
735		main_cpu = new sheepshaver_cpu();
736		main_cpu->set_register(powerpc_registers::GPR(3), any_register((uint32)ROM_BASE + 0x30d000));
737	+	main_cpu->set_register(powerpc_registers::GPR(4), any_register(KernelDataAddr + 0x1000));
738		WriteMacInt32(XLM_RUN_MODE, MODE_68K);
739
740		#if MULTICORE_CPU
#	Line 585 | Line 750 | void init_emul_ppc(void)
750		mon_add_command("regs", dump_registers, "regs                     Dump PowerPC registers\n");
751		mon_add_command("log", dump_log, "log                      Dump PowerPC emulation log\n");
752		#endif
753	+
754	+	#if EMUL_TIME_STATS
755	+	emul_start_time = clock();
756	+	#endif
757	+	}
758	+
759	+	/*
760	+	*  Deinitialize emulation
761	+	*/
762	+
763	+	void exit_emul_ppc(void)
764	+	{
765	+	#if EMUL_TIME_STATS
766	+	clock_t emul_end_time = clock();
767	+
768	+	printf("### Statistics for SheepShaver emulation parts\n");
769	+	const clock_t emul_time = emul_end_time - emul_start_time;
770	+	printf("Total emulation time : %.1f sec\n", double(emul_time) / double(CLOCKS_PER_SEC));
771	+	printf("Total interrupt count: %d (%2.1f Hz)\n", interrupt_count,
772	+	(double(interrupt_count) * CLOCKS_PER_SEC) / double(emul_time));
773	+
774	+	#define PRINT_STATS(LABEL, VAR_PREFIX) do {                                                             \
775	+	printf("Total " LABEL " count : %d\n", VAR_PREFIX##_count);             \
776	+	printf("Total " LABEL " time  : %.1f sec (%.1f%%)\n",                   \
777	+	double(VAR_PREFIX##_time) / double(CLOCKS_PER_SEC),          \
778	+	100.0 * double(VAR_PREFIX##_time) / double(emul_time));      \
779	+	} while (0)
780	+
781	+	PRINT_STATS("Execute68k[Trap] execution", exec68k);
782	+	PRINT_STATS("NativeOp execution", native_exec);
783	+	PRINT_STATS("MacOS routine execution", macos_exec);
784	+
785	+	#undef PRINT_STATS
786	+	printf("\n");
787	+	#endif
788	+
789	+	delete main_cpu;
790	+	#if MULTICORE_CPU
791	+	delete interrupt_cpu;
792	+	#endif
793		}
794
795		/*
#	Line 594 | Line 799 | void init_emul_ppc(void)
799		void emul_ppc(uint32 entry)
800		{
801		current_cpu = main_cpu;
802	+	#if 0
803		current_cpu->start_log();
804	+	#endif
805	+	// start emulation loop and enable code translation or caching
806		current_cpu->execute(entry);
807		}
808
#	Line 602 | Line 810 | void emul_ppc(uint32 entry)
810		*  Handle PowerPC interrupt
811		*/
812
813	<	// Atomic operations
814	<	extern int atomic_add(int *var, int v);
815	<	extern int atomic_and(int *var, int v);
816	<	extern int atomic_or(int *var, int v);
817	<
818	<	#if !ASYNC_IRQ
813	>	#if ASYNC_IRQ
814	>	void HandleInterrupt(void)
815	>	{
816	>	main_cpu->handle_interrupt();
817	>	}
818	>	#else
819		void TriggerInterrupt(void)
820		{
821		#if 0
822		WriteMacInt32(0x16a, ReadMacInt32(0x16a) + 1);
823		#else
824	<	SPCFLAGS_SET( SPCFLAG_INT );
824	>	// Trigger interrupt to main cpu only
825	>	if (main_cpu)
826	>	main_cpu->trigger_interrupt();
827		#endif
828		}
829		#endif
830
831	<	void HandleInterrupt(void)
831	>	void sheepshaver_cpu::handle_interrupt(void)
832		{
833		// Do nothing if interrupts are disabled
834	<	if (int32(ReadMacInt32(XLM_IRQ_NEST)) > 0)
834	>	if (*(int32 *)XLM_IRQ_NEST > 0)
835		return;
836
837		// Do nothing if there is no interrupt pending
#	Line 637 | Line 847 | void HandleInterrupt(void)
847		// 68k emulator active, trigger 68k interrupt level 1
848		assert(current_cpu == main_cpu);
849		WriteMacInt16(tswap32(kernel_data->v[0x67c >> 2]), 1);
850	<	main_cpu->set_cr(main_cpu->get_cr() | tswap32(kernel_data->v[0x674 >> 2]));
850	>	set_cr(get_cr() | tswap32(kernel_data->v[0x674 >> 2]));
851		break;
852
853		#if INTERRUPTS_IN_NATIVE_MODE
854		case MODE_NATIVE:
855		// 68k emulator inactive, in nanokernel?
856		assert(current_cpu == main_cpu);
857	<	if (main_cpu->gpr(1) != KernelDataAddr) {
857	>	if (gpr(1) != KernelDataAddr) {
858		// Prepare for 68k interrupt level 1
859		WriteMacInt16(tswap32(kernel_data->v[0x67c >> 2]), 1);
860		WriteMacInt32(tswap32(kernel_data->v[0x658 >> 2]) + 0xdc,
#	Line 688 | Line 898 | void HandleInterrupt(void)
898		if (InterruptFlags & INTFLAG_VIA) {
899		ClearInterruptFlag(INTFLAG_VIA);
900		ADBInterrupt();
901	<	ExecutePPC(VideoVBL);
901	>	ExecuteNative(NATIVE_VIDEO_VBL);
902		}
903		}
904		#endif
#	Line 698 | Line 908 | void HandleInterrupt(void)
908		}
909		}
910
701	–	/*
702	–	*  Execute NATIVE_OP opcode (called by PowerPC emulator)
703	–	*/
704	–
705	–	#define POWERPC_NATIVE_OP_INIT(LR, OP) \
706	–	tswap32(POWERPC_EMUL_OP | ((LR) << 11) | (((uint32)OP) << 6) | 2)
707	–
708	–	// FIXME: Make sure 32-bit relocations are used
709	–	const uint32 NativeOpTable[NATIVE_OP_MAX] = {
710	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_PATCH_NAME_REGISTRY),
711	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_VIDEO_INSTALL_ACCEL),
712	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_VIDEO_VBL),
713	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_VIDEO_DO_DRIVER_IO),
714	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_ETHER_IRQ),
715	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_ETHER_INIT),
716	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_ETHER_TERM),
717	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_ETHER_OPEN),
718	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_ETHER_CLOSE),
719	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_ETHER_WPUT),
720	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_ETHER_RSRV),
721	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_SERIAL_NOTHING),
722	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_SERIAL_OPEN),
723	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_SERIAL_PRIME_IN),
724	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_SERIAL_PRIME_OUT),
725	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_SERIAL_CONTROL),
726	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_SERIAL_STATUS),
727	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_SERIAL_CLOSE),
728	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_GET_RESOURCE),
729	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_GET_1_RESOURCE),
730	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_GET_IND_RESOURCE),
731	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_GET_1_IND_RESOURCE),
732	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_R_GET_RESOURCE),
733	–	POWERPC_NATIVE_OP_INIT(0, NATIVE_DISABLE_INTERRUPT),
734	–	POWERPC_NATIVE_OP_INIT(0, NATIVE_ENABLE_INTERRUPT),
735	–	POWERPC_NATIVE_OP_INIT(1, NATIVE_MAKE_EXECUTABLE),
736	–	};
737	–
911		static void get_resource(void);
912		static void get_1_resource(void);
913		static void get_ind_resource(void);
#	Line 745 | Line 918 | static void r_get_resource(void);
918
919		static void NativeOp(int selector)
920		{
921	+	#if EMUL_TIME_STATS
922	+	native_exec_count++;
923	+	const clock_t native_exec_start = clock();
924	+	#endif
925	+
926		switch (selector) {
927		case NATIVE_PATCH_NAME_REGISTRY:
928		DoPatchNameRegistry();
#	Line 759 | Line 937 | static void NativeOp(int selector)
937		GPR(3) = (int32)(int16)VideoDoDriverIO((void *)GPR(3), (void *)GPR(4),
938		(void *)GPR(5), GPR(6), GPR(7));
939		break;
940	<	case NATIVE_GET_RESOURCE:
941	<	get_resource();
940	>	#ifdef WORDS_BIGENDIAN
941	>	case NATIVE_ETHER_IRQ:
942	>	EtherIRQ();
943		break;
944	<	case NATIVE_GET_1_RESOURCE:
945	<	get_1_resource();
944	>	case NATIVE_ETHER_INIT:
945	>	GPR(3) = InitStreamModule((void *)GPR(3));
946		break;
947	<	case NATIVE_GET_IND_RESOURCE:
948	<	get_ind_resource();
947	>	case NATIVE_ETHER_TERM:
948	>	TerminateStreamModule();
949		break;
950	<	case NATIVE_GET_1_IND_RESOURCE:
951	<	get_1_ind_resource();
950	>	case NATIVE_ETHER_OPEN:
951	>	GPR(3) = ether_open((queue_t *)GPR(3), (void *)GPR(4), GPR(5), GPR(6), (void*)GPR(7));
952	>	break;
953	>	case NATIVE_ETHER_CLOSE:
954	>	GPR(3) = ether_close((queue_t *)GPR(3), GPR(4), (void *)GPR(5));
955		break;
956	<	case NATIVE_R_GET_RESOURCE:
957	<	r_get_resource();
956	>	case NATIVE_ETHER_WPUT:
957	>	GPR(3) = ether_wput((queue_t *)GPR(3), (mblk_t *)GPR(4));
958		break;
959	+	case NATIVE_ETHER_RSRV:
960	+	GPR(3) = ether_rsrv((queue_t *)GPR(3));
961	+	break;
962	+	#else
963	+	case NATIVE_ETHER_INIT:
964	+	// FIXME: needs more complicated thunks
965	+	GPR(3) = false;
966	+	break;
967	+	#endif
968		case NATIVE_SERIAL_NOTHING:
969		case NATIVE_SERIAL_OPEN:
970		case NATIVE_SERIAL_PRIME_IN:
#	Line 794 | Line 985 | static void NativeOp(int selector)
985		GPR(3) = serial_callbacks[selector - NATIVE_SERIAL_NOTHING](GPR(3), GPR(4));
986		break;
987		}
988	+	case NATIVE_GET_RESOURCE:
989	+	case NATIVE_GET_1_RESOURCE:
990	+	case NATIVE_GET_IND_RESOURCE:
991	+	case NATIVE_GET_1_IND_RESOURCE:
992	+	case NATIVE_R_GET_RESOURCE: {
993	+	typedef void (*GetResourceCallback)(void);
994	+	static const GetResourceCallback get_resource_callbacks[] = {
995	+	get_resource,
996	+	get_1_resource,
997	+	get_ind_resource,
998	+	get_1_ind_resource,
999	+	r_get_resource
1000	+	};
1001	+	get_resource_callbacks[selector - NATIVE_GET_RESOURCE]();
1002	+	break;
1003	+	}
1004		case NATIVE_DISABLE_INTERRUPT:
1005		DisableInterrupt();
1006		break;
#	Line 803 | Line 1010 | static void NativeOp(int selector)
1010		case NATIVE_MAKE_EXECUTABLE:
1011		MakeExecutable(0, (void *)GPR(4), GPR(5));
1012		break;
1013	+	case NATIVE_CHECK_LOAD_INVOC:
1014	+	check_load_invoc(GPR(3), GPR(4), GPR(5));
1015	+	break;
1016		default:
1017		printf("FATAL: NATIVE_OP called with bogus selector %d\n", selector);
1018		QuitEmulator();
1019		break;
1020		}
811	–	}
1021
1022	<	/*
1023	<	*  Execute native subroutine (LR must contain return address)
1024	<	*/
816	<
817	<	void ExecuteNative(int selector)
818	<	{
819	<	uint32 tvect[2];
820	<	tvect[0] = tswap32(POWERPC_NATIVE_OP_FUNC(selector));
821	<	tvect[1] = 0; // Fake TVECT
822	<	RoutineDescriptor desc = BUILD_PPC_ROUTINE_DESCRIPTOR(0, tvect);
823	<	M68kRegisters r;
824	<	Execute68k((uint32)&desc, &r);
1022	>	#if EMUL_TIME_STATS
1023	>	native_exec_time += (clock() - native_exec_start);
1024	>	#endif
1025		}
1026
1027		/*
#	Line 842 | Line 1042 | void Execute68k(uint32 pc, M68kRegisters
1042
1043		void Execute68kTrap(uint16 trap, M68kRegisters *r)
1044		{
1045	<	uint16 proc[2];
1046	<	proc[0] = htons(trap);
1047	<	proc[1] = htons(M68K_RTS);
1048	<	Execute68k((uint32)proc, r);
1045	>	SheepVar proc_var(4);
1046	>	uint32 proc = proc_var.addr();
1047	>	WriteMacInt16(proc, trap);
1048	>	WriteMacInt16(proc + 2, M68K_RTS);
1049	>	Execute68k(proc, r);
1050		}
1051
1052		/*
#	Line 900 | Line 1101 | uint32 call_macos7(uint32 tvect, uint32
1101		}
1102
1103		/*
903	–	*  Atomic operations
904	–	*/
905	–
906	–	int atomic_add(int *var, int v)
907	–	{
908	–	int ret = *var;
909	–	*var += v;
910	–	return ret;
911	–	}
912	–
913	–	int atomic_and(int *var, int v)
914	–	{
915	–	int ret = *var;
916	–	*var &= v;
917	–	return ret;
918	–	}
919	–
920	–	int atomic_or(int *var, int v)
921	–	{
922	–	int ret = *var;
923	–	*var |= v;
924	–	return ret;
925	–	}
926	–
927	–	/*
1104		*  Resource Manager thunks
1105		*/
1106

Diff Legend

–	Removed lines
+	Added lines
<	Changed lines
>	Changed lines