lxdream.org :: lxdream/src/sh4/sh4core.c r587:739a3136f269 (annotated)

tree revision 588:978ec0b33545

filename	src/sh4/sh4core.c
changeset	587:739a3136f269
prev	586:2a3ba82cf243
next	617:476a717a54f3
author	nkeynes
date	Wed Jan 16 09:37:08 2008 +0000 (16 years ago)
permissions	-rw-r--r--
last change	Fix vma lookups after itlb exception

file

annotate

diff

log

raw

nkeynes@23	1	/**
nkeynes@586	2	* $Id$
nkeynes@23	3	*
nkeynes@23	4	* SH4 emulation core, and parent module for all the SH4 peripheral
nkeynes@23	5	* modules.
nkeynes@23	6	*
nkeynes@23	7	* Copyright (c) 2005 Nathan Keynes.
nkeynes@23	8	*
nkeynes@23	9	* This program is free software; you can redistribute it and/or modify
nkeynes@23	10	* it under the terms of the GNU General Public License as published by
nkeynes@23	11	* the Free Software Foundation; either version 2 of the License, or
nkeynes@23	12	* (at your option) any later version.
nkeynes@23	13	*
nkeynes@23	14	* This program is distributed in the hope that it will be useful,
nkeynes@23	15	* but WITHOUT ANY WARRANTY; without even the implied warranty of
nkeynes@23	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
nkeynes@23	17	* GNU General Public License for more details.
nkeynes@23	18	*/
nkeynes@23	19
nkeynes@35	20	#define MODULE sh4_module
nkeynes@586	21	#include <assert.h>
nkeynes@1	22	#include <math.h>
nkeynes@1	23	#include "dream.h"
nkeynes@430	24	#include "dreamcast.h"
nkeynes@430	25	#include "eventq.h"
nkeynes@430	26	#include "mem.h"
nkeynes@430	27	#include "clock.h"
nkeynes@430	28	#include "syscall.h"
nkeynes@84	29	#include "sh4/sh4core.h"
nkeynes@84	30	#include "sh4/sh4mmio.h"
nkeynes@84	31	#include "sh4/intc.h"
nkeynes@1	32
nkeynes@157	33	#define SH4_CALLTRACE 1
nkeynes@157	34
nkeynes@123	35	#define MAX_INT 0x7FFFFFFF
nkeynes@123	36	#define MIN_INT 0x80000000
nkeynes@123	37	#define MAX_INTF 2147483647.0
nkeynes@123	38	#define MIN_INTF -2147483648.0
nkeynes@123	39
nkeynes@23	40	/******************** SH4 Module Definition **************************/
nkeynes@23	41
nkeynes@30	42	uint32_t sh4_run_slice( uint32_t nanosecs )
nkeynes@1	43	{
nkeynes@23	44	int i;
nkeynes@265	45	sh4r.slice_cycle = 0;
nkeynes@23	46
nkeynes@27	47	if( sh4r.sh4_state != SH4_STATE_RUNNING ) {
nkeynes@265	48	if( sh4r.event_pending < nanosecs ) {
nkeynes@265	49	sh4r.sh4_state = SH4_STATE_RUNNING;
nkeynes@265	50	sh4r.slice_cycle = sh4r.event_pending;
nkeynes@265	51	}
nkeynes@23	52	}
nkeynes@27	53
nkeynes@235	54	if( sh4_breakpoint_count == 0 ) {
nkeynes@265	55	for( ; sh4r.slice_cycle < nanosecs; sh4r.slice_cycle += sh4_cpu_period ) {
nkeynes@265	56	if( SH4_EVENT_PENDING() ) {
nkeynes@265	57	if( sh4r.event_types & PENDING_EVENT ) {
nkeynes@265	58	event_execute();
nkeynes@265	59	}
nkeynes@265	60	/* Eventq execute may (quite likely) deliver an immediate IRQ */
nkeynes@265	61	if( sh4r.event_types & PENDING_IRQ ) {
nkeynes@265	62	sh4_accept_interrupt();
nkeynes@265	63	}
nkeynes@265	64	}
nkeynes@235	65	if( !sh4_execute_instruction() ) {
nkeynes@43	66	break;
nkeynes@43	67	}
nkeynes@43	68	}
nkeynes@235	69	} else {
nkeynes@265	70	for( ;sh4r.slice_cycle < nanosecs; sh4r.slice_cycle += sh4_cpu_period ) {
nkeynes@265	71	if( SH4_EVENT_PENDING() ) {
nkeynes@265	72	if( sh4r.event_types & PENDING_EVENT ) {
nkeynes@265	73	event_execute();
nkeynes@265	74	}
nkeynes@265	75	/* Eventq execute may (quite likely) deliver an immediate IRQ */
nkeynes@265	76	if( sh4r.event_types & PENDING_IRQ ) {
nkeynes@265	77	sh4_accept_interrupt();
nkeynes@265	78	}
nkeynes@265	79	}
nkeynes@265	80
nkeynes@235	81	if( !sh4_execute_instruction() )
nkeynes@235	82	break;
nkeynes@235	83	#ifdef ENABLE_DEBUG_MODE
nkeynes@235	84	for( i=0; i<sh4_breakpoint_count; i++ ) {
nkeynes@235	85	if( sh4_breakpoints[i].address == sh4r.pc ) {
nkeynes@235	86	break;
nkeynes@235	87	}
nkeynes@235	88	}
nkeynes@235	89	if( i != sh4_breakpoint_count ) {
nkeynes@235	90	dreamcast_stop();
nkeynes@235	91	if( sh4_breakpoints[i].type == BREAK_ONESHOT )
nkeynes@235	92	sh4_clear_breakpoint( sh4r.pc, BREAK_ONESHOT );
nkeynes@235	93	break;
nkeynes@235	94	}
nkeynes@235	95	#endif
nkeynes@43	96	}
nkeynes@27	97	}
nkeynes@30	98
nkeynes@30	99	/* If we aborted early, but the cpu is still technically running,
nkeynes@30	100	* we're doing a hard abort - cut the timeslice back to what we
nkeynes@30	101	* actually executed
nkeynes@30	102	*/
nkeynes@53	103	if( sh4r.slice_cycle != nanosecs && sh4r.sh4_state == SH4_STATE_RUNNING ) {
nkeynes@53	104	nanosecs = sh4r.slice_cycle;
nkeynes@27	105	}
nkeynes@27	106	if( sh4r.sh4_state != SH4_STATE_STANDBY ) {
nkeynes@30	107	TMU_run_slice( nanosecs );
nkeynes@30	108	SCIF_run_slice( nanosecs );
nkeynes@27	109	}
nkeynes@30	110	return nanosecs;
nkeynes@1	111	}
nkeynes@1	112
nkeynes@23	113	/******************** SH4 emulation core **************************/
nkeynes@23	114
nkeynes@246	115	#define UNDEF(ir) return sh4_raise_slot_exception(EXC_ILLEGAL, EXC_SLOT_ILLEGAL)
nkeynes@27	116	#define UNIMP(ir) do{ ERROR( "Halted on unimplemented instruction at %08x, opcode = %04x", sh4r.pc, ir ); dreamcast_stop(); return FALSE; }while(0)
nkeynes@1	117
nkeynes@157	118	#if(SH4_CALLTRACE == 1)
nkeynes@157	119	#define MAX_CALLSTACK 32
nkeynes@157	120	static struct call_stack {
nkeynes@157	121	sh4addr_t call_addr;
nkeynes@157	122	sh4addr_t target_addr;
nkeynes@157	123	sh4addr_t stack_pointer;
nkeynes@157	124	} call_stack[MAX_CALLSTACK];
nkeynes@157	125
nkeynes@157	126	static int call_stack_depth = 0;
nkeynes@157	127	int sh4_call_trace_on = 0;
nkeynes@157	128
nkeynes@430	129	static inline void trace_call( sh4addr_t source, sh4addr_t dest )
nkeynes@157	130	{
nkeynes@157	131	if( call_stack_depth < MAX_CALLSTACK ) {
nkeynes@157	132	call_stack[call_stack_depth].call_addr = source;
nkeynes@157	133	call_stack[call_stack_depth].target_addr = dest;
nkeynes@157	134	call_stack[call_stack_depth].stack_pointer = sh4r.r[15];
nkeynes@157	135	}
nkeynes@157	136	call_stack_depth++;
nkeynes@157	137	}
nkeynes@157	138
nkeynes@430	139	static inline void trace_return( sh4addr_t source, sh4addr_t dest )
nkeynes@157	140	{
nkeynes@157	141	if( call_stack_depth > 0 ) {
nkeynes@157	142	call_stack_depth--;
nkeynes@157	143	}
nkeynes@157	144	}
nkeynes@157	145
nkeynes@157	146	void fprint_stack_trace( FILE *f )
nkeynes@157	147	{
nkeynes@157	148	int i = call_stack_depth -1;
nkeynes@157	149	if( i >= MAX_CALLSTACK )
nkeynes@157	150	i = MAX_CALLSTACK - 1;
nkeynes@157	151	for( ; i >= 0; i-- ) {
nkeynes@157	152	fprintf( f, "%d. Call from %08X => %08X, SP=%08X\n",
nkeynes@157	153	(call_stack_depth - i), call_stack[i].call_addr,
nkeynes@157	154	call_stack[i].target_addr, call_stack[i].stack_pointer );
nkeynes@157	155	}
nkeynes@157	156	}
nkeynes@157	157
nkeynes@157	158	#define TRACE_CALL( source, dest ) trace_call(source, dest)
nkeynes@157	159	#define TRACE_RETURN( source, dest ) trace_return(source, dest)
nkeynes@157	160	#else
nkeynes@157	161	#define TRACE_CALL( dest, rts )
nkeynes@157	162	#define TRACE_RETURN( source, dest )
nkeynes@157	163	#endif
nkeynes@157	164
nkeynes@586	165	#define MEM_READ_BYTE( addr, val ) memtmp = mmu_vma_to_phys_read(addr); if( memtmp == MMU_VMA_ERROR ) { return TRUE; } else { val = sh4_read_byte(memtmp); }
nkeynes@586	166	#define MEM_READ_WORD( addr, val ) memtmp = mmu_vma_to_phys_read(addr); if( memtmp == MMU_VMA_ERROR ) { return TRUE; } else { val = sh4_read_word(memtmp); }
nkeynes@586	167	#define MEM_READ_LONG( addr, val ) memtmp = mmu_vma_to_phys_read(addr); if( memtmp == MMU_VMA_ERROR ) { return TRUE; } else { val = sh4_read_long(memtmp); }
nkeynes@586	168	#define MEM_WRITE_BYTE( addr, val ) memtmp = mmu_vma_to_phys_write(addr); if( memtmp == MMU_VMA_ERROR ) { return TRUE; } else { sh4_write_byte(memtmp, val); }
nkeynes@586	169	#define MEM_WRITE_WORD( addr, val ) memtmp = mmu_vma_to_phys_write(addr); if( memtmp == MMU_VMA_ERROR ) { return TRUE; } else { sh4_write_word(memtmp, val); }
nkeynes@586	170	#define MEM_WRITE_LONG( addr, val ) memtmp = mmu_vma_to_phys_write(addr); if( memtmp == MMU_VMA_ERROR ) { return TRUE; } else { sh4_write_long(memtmp, val); }
nkeynes@1	171
nkeynes@1	172	#define FP_WIDTH (IS_FPU_DOUBLESIZE() ? 8 : 4)
nkeynes@1	173
nkeynes@124	174	#define MEM_FP_READ( addr, reg ) sh4_read_float( addr, reg );
nkeynes@124	175	#define MEM_FP_WRITE( addr, reg ) sh4_write_float( addr, reg );
nkeynes@84	176
nkeynes@246	177	#define CHECKPRIV() if( !IS_SH4_PRIVMODE() ) return sh4_raise_slot_exception( EXC_ILLEGAL, EXC_SLOT_ILLEGAL )
nkeynes@367	178	#define CHECKRALIGN16(addr) if( (addr)&0x01 ) return sh4_raise_exception( EXC_DATA_ADDR_READ )
nkeynes@367	179	#define CHECKRALIGN32(addr) if( (addr)&0x03 ) return sh4_raise_exception( EXC_DATA_ADDR_READ )
nkeynes@367	180	#define CHECKWALIGN16(addr) if( (addr)&0x01 ) return sh4_raise_exception( EXC_DATA_ADDR_WRITE )
nkeynes@367	181	#define CHECKWALIGN32(addr) if( (addr)&0x03 ) return sh4_raise_exception( EXC_DATA_ADDR_WRITE )
nkeynes@208	182
nkeynes@367	183	#define CHECKFPUEN() if( !IS_FPU_ENABLED() ) { if( ir == 0xFFFD ) { UNDEF(ir); } else { return sh4_raise_slot_exception( EXC_FPU_DISABLED, EXC_SLOT_FPU_DISABLED ); } }
nkeynes@84	184	#define CHECKDEST(p) if( (p) == 0 ) { ERROR( "%08X: Branch/jump to NULL, CPU halted", sh4r.pc ); dreamcast_stop(); return FALSE; }
nkeynes@246	185	#define CHECKSLOTILLEGAL() if(sh4r.in_delay_slot) return sh4_raise_exception(EXC_SLOT_ILLEGAL)
nkeynes@1	186
nkeynes@124	187	static void sh4_write_float( uint32_t addr, int reg )
nkeynes@124	188	{
nkeynes@124	189	if( IS_FPU_DOUBLESIZE() ) {
nkeynes@124	190	if( reg & 1 ) {
nkeynes@124	191	sh4_write_long( addr, ((uint32_t )&XF((reg)&0x0E)) );
nkeynes@124	192	sh4_write_long( addr+4, ((uint32_t )&XF(reg)) );
nkeynes@124	193	} else {
nkeynes@124	194	sh4_write_long( addr, ((uint32_t )&FR(reg)) );
nkeynes@124	195	sh4_write_long( addr+4, ((uint32_t )&FR((reg)\|0x01)) );
nkeynes@124	196	}
nkeynes@124	197	} else {
nkeynes@124	198	sh4_write_long( addr, ((uint32_t )&FR((reg))) );
nkeynes@124	199	}
nkeynes@124	200	}
nkeynes@124	201
nkeynes@124	202	static void sh4_read_float( uint32_t addr, int reg )
nkeynes@124	203	{
nkeynes@124	204	if( IS_FPU_DOUBLESIZE() ) {
nkeynes@124	205	if( reg & 1 ) {
nkeynes@124	206	((uint32_t )&XF((reg) & 0x0E)) = sh4_read_long(addr);
nkeynes@124	207	((uint32_t )&XF(reg)) = sh4_read_long(addr+4);
nkeynes@124	208	} else {
nkeynes@124	209	((uint32_t )&FR(reg)) = sh4_read_long(addr);
nkeynes@124	210	((uint32_t )&FR((reg) \| 0x01)) = sh4_read_long(addr+4);
nkeynes@124	211	}
nkeynes@124	212	} else {
nkeynes@124	213	((uint32_t )&FR(reg)) = sh4_read_long(addr);
nkeynes@124	214	}
nkeynes@124	215	}
nkeynes@124	216
nkeynes@27	217	gboolean sh4_execute_instruction( void )
nkeynes@1	218	{
nkeynes@84	219	uint32_t pc;
nkeynes@2	220	unsigned short ir;
nkeynes@1	221	uint32_t tmp;
nkeynes@123	222	float ftmp;
nkeynes@123	223	double dtmp;
nkeynes@586	224	int64_t memtmp; // temporary holder for memory reads
nkeynes@1	225
nkeynes@1	226	#define R0 sh4r.r[0]
nkeynes@2	227	pc = sh4r.pc;
nkeynes@84	228	if( pc > 0xFFFFFF00 ) {
nkeynes@84	229	/* SYSCALL Magic */
nkeynes@102	230	syscall_invoke( pc );
nkeynes@104	231	sh4r.in_delay_slot = 0;
nkeynes@84	232	pc = sh4r.pc = sh4r.pr;
nkeynes@84	233	sh4r.new_pc = sh4r.pc + 2;
nkeynes@84	234	}
nkeynes@208	235	CHECKRALIGN16(pc);
nkeynes@235	236
nkeynes@235	237	/* Read instruction */
nkeynes@586	238	if( !IS_IN_ICACHE(pc) ) {
nkeynes@586	239	if( !mmu_update_icache(pc) ) {
nkeynes@586	240	// Fault - look for the fault handler
nkeynes@586	241	if( !mmu_update_icache(sh4r.pc) ) {
nkeynes@586	242	// double fault - halt
nkeynes@586	243	ERROR( "Double fault - halting" );
nkeynes@586	244	dreamcast_stop();
nkeynes@586	245	return FALSE;
nkeynes@586	246	}
nkeynes@235	247	}
nkeynes@586	248	pc = sh4r.pc;
nkeynes@235	249	}
nkeynes@586	250	assert( IS_IN_ICACHE(pc) );
nkeynes@586	251	ir = (uint16_t )GET_ICACHE_PTR(sh4r.pc);
nkeynes@359	252	switch( (ir&0xF000) >> 12 ) {
nkeynes@359	253	case 0x0:
nkeynes@359	254	switch( ir&0xF ) {
nkeynes@359	255	case 0x2:
nkeynes@359	256	switch( (ir&0x80) >> 7 ) {
nkeynes@359	257	case 0x0:
nkeynes@359	258	switch( (ir&0x70) >> 4 ) {
nkeynes@359	259	case 0x0:
nkeynes@359	260	{ /* STC SR, Rn */
nkeynes@359	261	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	262	CHECKPRIV();
nkeynes@359	263	sh4r.r[Rn] = sh4_read_sr();
nkeynes@359	264	}
nkeynes@359	265	break;
nkeynes@359	266	case 0x1:
nkeynes@359	267	{ /* STC GBR, Rn */
nkeynes@359	268	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	269	CHECKPRIV();
nkeynes@359	270	sh4r.r[Rn] = sh4r.gbr;
nkeynes@359	271	}
nkeynes@359	272	break;
nkeynes@359	273	case 0x2:
nkeynes@359	274	{ /* STC VBR, Rn */
nkeynes@359	275	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	276	CHECKPRIV();
nkeynes@359	277	sh4r.r[Rn] = sh4r.vbr;
nkeynes@359	278	}
nkeynes@359	279	break;
nkeynes@359	280	case 0x3:
nkeynes@359	281	{ /* STC SSR, Rn */
nkeynes@359	282	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	283	CHECKPRIV();
nkeynes@359	284	sh4r.r[Rn] = sh4r.ssr;
nkeynes@359	285	}
nkeynes@359	286	break;
nkeynes@359	287	case 0x4:
nkeynes@359	288	{ /* STC SPC, Rn */
nkeynes@359	289	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	290	CHECKPRIV();
nkeynes@359	291	sh4r.r[Rn] = sh4r.spc;
nkeynes@359	292	}
nkeynes@359	293	break;
nkeynes@359	294	default:
nkeynes@359	295	UNDEF();
nkeynes@359	296	break;
nkeynes@359	297	}
nkeynes@359	298	break;
nkeynes@359	299	case 0x1:
nkeynes@359	300	{ /* STC Rm_BANK, Rn */
nkeynes@359	301	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm_BANK = ((ir>>4)&0x7);
nkeynes@359	302	CHECKPRIV();
nkeynes@359	303	sh4r.r[Rn] = sh4r.r_bank[Rm_BANK];
nkeynes@359	304	}
nkeynes@359	305	break;
nkeynes@359	306	}
nkeynes@359	307	break;
nkeynes@359	308	case 0x3:
nkeynes@359	309	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	310	case 0x0:
nkeynes@359	311	{ /* BSRF Rn */
nkeynes@359	312	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	313	CHECKSLOTILLEGAL();
nkeynes@359	314	CHECKDEST( pc + 4 + sh4r.r[Rn] );
nkeynes@359	315	sh4r.in_delay_slot = 1;
nkeynes@359	316	sh4r.pr = sh4r.pc + 4;
nkeynes@359	317	sh4r.pc = sh4r.new_pc;
nkeynes@359	318	sh4r.new_pc = pc + 4 + sh4r.r[Rn];
nkeynes@359	319	TRACE_CALL( pc, sh4r.new_pc );
nkeynes@359	320	return TRUE;
nkeynes@359	321	}
nkeynes@359	322	break;
nkeynes@359	323	case 0x2:
nkeynes@359	324	{ /* BRAF Rn */
nkeynes@359	325	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	326	CHECKSLOTILLEGAL();
nkeynes@359	327	CHECKDEST( pc + 4 + sh4r.r[Rn] );
nkeynes@359	328	sh4r.in_delay_slot = 1;
nkeynes@359	329	sh4r.pc = sh4r.new_pc;
nkeynes@359	330	sh4r.new_pc = pc + 4 + sh4r.r[Rn];
nkeynes@359	331	return TRUE;
nkeynes@359	332	}
nkeynes@359	333	break;
nkeynes@359	334	case 0x8:
nkeynes@359	335	{ /* PREF @Rn */
nkeynes@359	336	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	337	tmp = sh4r.r[Rn];
nkeynes@359	338	if( (tmp & 0xFC000000) == 0xE0000000 ) {
nkeynes@369	339	sh4_flush_store_queue(tmp);
nkeynes@359	340	}
nkeynes@359	341	}
nkeynes@359	342	break;
nkeynes@359	343	case 0x9:
nkeynes@359	344	{ /* OCBI @Rn */
nkeynes@359	345	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	346	}
nkeynes@359	347	break;
nkeynes@359	348	case 0xA:
nkeynes@359	349	{ /* OCBP @Rn */
nkeynes@359	350	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	351	}
nkeynes@359	352	break;
nkeynes@359	353	case 0xB:
nkeynes@359	354	{ /* OCBWB @Rn */
nkeynes@359	355	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	356	}
nkeynes@359	357	break;
nkeynes@359	358	case 0xC:
nkeynes@359	359	{ /* MOVCA.L R0, @Rn */
nkeynes@359	360	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	361	tmp = sh4r.r[Rn];
nkeynes@359	362	CHECKWALIGN32(tmp);
nkeynes@359	363	MEM_WRITE_LONG( tmp, R0 );
nkeynes@359	364	}
nkeynes@359	365	break;
nkeynes@359	366	default:
nkeynes@359	367	UNDEF();
nkeynes@359	368	break;
nkeynes@359	369	}
nkeynes@359	370	break;
nkeynes@359	371	case 0x4:
nkeynes@359	372	{ /* MOV.B Rm, @(R0, Rn) */
nkeynes@359	373	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	374	MEM_WRITE_BYTE( R0 + sh4r.r[Rn], sh4r.r[Rm] );
nkeynes@359	375	}
nkeynes@359	376	break;
nkeynes@359	377	case 0x5:
nkeynes@359	378	{ /* MOV.W Rm, @(R0, Rn) */
nkeynes@359	379	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	380	CHECKWALIGN16( R0 + sh4r.r[Rn] );
nkeynes@359	381	MEM_WRITE_WORD( R0 + sh4r.r[Rn], sh4r.r[Rm] );
nkeynes@359	382	}
nkeynes@359	383	break;
nkeynes@359	384	case 0x6:
nkeynes@359	385	{ /* MOV.L Rm, @(R0, Rn) */
nkeynes@359	386	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	387	CHECKWALIGN32( R0 + sh4r.r[Rn] );
nkeynes@359	388	MEM_WRITE_LONG( R0 + sh4r.r[Rn], sh4r.r[Rm] );
nkeynes@359	389	}
nkeynes@359	390	break;
nkeynes@359	391	case 0x7:
nkeynes@359	392	{ /* MUL.L Rm, Rn */
nkeynes@359	393	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	394	sh4r.mac = (sh4r.mac&0xFFFFFFFF00000000LL) \|
nkeynes@359	395	(sh4r.r[Rm] * sh4r.r[Rn]);
nkeynes@359	396	}
nkeynes@359	397	break;
nkeynes@359	398	case 0x8:
nkeynes@359	399	switch( (ir&0xFF0) >> 4 ) {
nkeynes@359	400	case 0x0:
nkeynes@359	401	{ /* CLRT */
nkeynes@359	402	sh4r.t = 0;
nkeynes@359	403	}
nkeynes@359	404	break;
nkeynes@359	405	case 0x1:
nkeynes@359	406	{ /* SETT */
nkeynes@359	407	sh4r.t = 1;
nkeynes@359	408	}
nkeynes@359	409	break;
nkeynes@359	410	case 0x2:
nkeynes@359	411	{ /* CLRMAC */
nkeynes@359	412	sh4r.mac = 0;
nkeynes@359	413	}
nkeynes@359	414	break;
nkeynes@359	415	case 0x3:
nkeynes@359	416	{ /* LDTLB */
nkeynes@550	417	MMU_ldtlb();
nkeynes@359	418	}
nkeynes@359	419	break;
nkeynes@359	420	case 0x4:
nkeynes@359	421	{ /* CLRS */
nkeynes@359	422	sh4r.s = 0;
nkeynes@359	423	}
nkeynes@359	424	break;
nkeynes@359	425	case 0x5:
nkeynes@359	426	{ /* SETS */
nkeynes@359	427	sh4r.s = 1;
nkeynes@359	428	}
nkeynes@359	429	break;
nkeynes@359	430	default:
nkeynes@359	431	UNDEF();
nkeynes@359	432	break;
nkeynes@359	433	}
nkeynes@359	434	break;
nkeynes@359	435	case 0x9:
nkeynes@359	436	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	437	case 0x0:
nkeynes@359	438	{ /* NOP */
nkeynes@359	439	/* NOP */
nkeynes@359	440	}
nkeynes@359	441	break;
nkeynes@359	442	case 0x1:
nkeynes@359	443	{ /* DIV0U */
nkeynes@359	444	sh4r.m = sh4r.q = sh4r.t = 0;
nkeynes@359	445	}
nkeynes@359	446	break;
nkeynes@359	447	case 0x2:
nkeynes@359	448	{ /* MOVT Rn */
nkeynes@359	449	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	450	sh4r.r[Rn] = sh4r.t;
nkeynes@359	451	}
nkeynes@359	452	break;
nkeynes@359	453	default:
nkeynes@359	454	UNDEF();
nkeynes@359	455	break;
nkeynes@359	456	}
nkeynes@359	457	break;
nkeynes@359	458	case 0xA:
nkeynes@359	459	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	460	case 0x0:
nkeynes@359	461	{ /* STS MACH, Rn */
nkeynes@359	462	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	463	sh4r.r[Rn] = (sh4r.mac>>32);
nkeynes@359	464	}
nkeynes@359	465	break;
nkeynes@359	466	case 0x1:
nkeynes@359	467	{ /* STS MACL, Rn */
nkeynes@359	468	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	469	sh4r.r[Rn] = (uint32_t)sh4r.mac;
nkeynes@359	470	}
nkeynes@359	471	break;
nkeynes@359	472	case 0x2:
nkeynes@359	473	{ /* STS PR, Rn */
nkeynes@359	474	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	475	sh4r.r[Rn] = sh4r.pr;
nkeynes@359	476	}
nkeynes@359	477	break;
nkeynes@359	478	case 0x3:
nkeynes@359	479	{ /* STC SGR, Rn */
nkeynes@359	480	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	481	CHECKPRIV();
nkeynes@359	482	sh4r.r[Rn] = sh4r.sgr;
nkeynes@359	483	}
nkeynes@359	484	break;
nkeynes@359	485	case 0x5:
nkeynes@359	486	{ /* STS FPUL, Rn */
nkeynes@359	487	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	488	sh4r.r[Rn] = sh4r.fpul;
nkeynes@359	489	}
nkeynes@359	490	break;
nkeynes@359	491	case 0x6:
nkeynes@359	492	{ /* STS FPSCR, Rn */
nkeynes@359	493	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	494	sh4r.r[Rn] = sh4r.fpscr;
nkeynes@359	495	}
nkeynes@359	496	break;
nkeynes@359	497	case 0xF:
nkeynes@359	498	{ /* STC DBR, Rn */
nkeynes@359	499	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	500	CHECKPRIV(); sh4r.r[Rn] = sh4r.dbr;
nkeynes@359	501	}
nkeynes@359	502	break;
nkeynes@359	503	default:
nkeynes@359	504	UNDEF();
nkeynes@359	505	break;
nkeynes@359	506	}
nkeynes@359	507	break;
nkeynes@359	508	case 0xB:
nkeynes@359	509	switch( (ir&0xFF0) >> 4 ) {
nkeynes@359	510	case 0x0:
nkeynes@359	511	{ /* RTS */
nkeynes@359	512	CHECKSLOTILLEGAL();
nkeynes@359	513	CHECKDEST( sh4r.pr );
nkeynes@359	514	sh4r.in_delay_slot = 1;
nkeynes@359	515	sh4r.pc = sh4r.new_pc;
nkeynes@359	516	sh4r.new_pc = sh4r.pr;
nkeynes@359	517	TRACE_RETURN( pc, sh4r.new_pc );
nkeynes@359	518	return TRUE;
nkeynes@359	519	}
nkeynes@359	520	break;
nkeynes@359	521	case 0x1:
nkeynes@359	522	{ /* SLEEP */
nkeynes@359	523	if( MMIO_READ( CPG, STBCR ) & 0x80 ) {
nkeynes@359	524	sh4r.sh4_state = SH4_STATE_STANDBY;
nkeynes@359	525	} else {
nkeynes@359	526	sh4r.sh4_state = SH4_STATE_SLEEP;
nkeynes@359	527	}
nkeynes@359	528	return FALSE; /* Halt CPU */
nkeynes@359	529	}
nkeynes@359	530	break;
nkeynes@359	531	case 0x2:
nkeynes@359	532	{ /* RTE */
nkeynes@359	533	CHECKPRIV();
nkeynes@359	534	CHECKDEST( sh4r.spc );
nkeynes@359	535	CHECKSLOTILLEGAL();
nkeynes@359	536	sh4r.in_delay_slot = 1;
nkeynes@359	537	sh4r.pc = sh4r.new_pc;
nkeynes@359	538	sh4r.new_pc = sh4r.spc;
nkeynes@374	539	sh4_write_sr( sh4r.ssr );
nkeynes@359	540	return TRUE;
nkeynes@359	541	}
nkeynes@359	542	break;
nkeynes@359	543	default:
nkeynes@359	544	UNDEF();
nkeynes@359	545	break;
nkeynes@359	546	}
nkeynes@359	547	break;
nkeynes@359	548	case 0xC:
nkeynes@359	549	{ /* MOV.B @(R0, Rm), Rn */
nkeynes@359	550	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@586	551	MEM_READ_BYTE( R0 + sh4r.r[Rm], sh4r.r[Rn] );
nkeynes@359	552	}
nkeynes@359	553	break;
nkeynes@359	554	case 0xD:
nkeynes@359	555	{ /* MOV.W @(R0, Rm), Rn */
nkeynes@359	556	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	557	CHECKRALIGN16( R0 + sh4r.r[Rm] );
nkeynes@586	558	MEM_READ_WORD( R0 + sh4r.r[Rm], sh4r.r[Rn] );
nkeynes@359	559	}
nkeynes@359	560	break;
nkeynes@359	561	case 0xE:
nkeynes@359	562	{ /* MOV.L @(R0, Rm), Rn */
nkeynes@359	563	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	564	CHECKRALIGN32( R0 + sh4r.r[Rm] );
nkeynes@586	565	MEM_READ_LONG( R0 + sh4r.r[Rm], sh4r.r[Rn] );
nkeynes@359	566	}
nkeynes@359	567	break;
nkeynes@359	568	case 0xF:
nkeynes@359	569	{ /* MAC.L @Rm+, @Rn+ */
nkeynes@359	570	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@587	571	int64_t tmpl;
nkeynes@587	572	if( Rm == Rn ) {
nkeynes@587	573	CHECKRALIGN32( sh4r.r[Rn] );
nkeynes@587	574	MEM_READ_LONG(sh4r.r[Rn], tmp);
nkeynes@587	575	tmpl = SIGNEXT32(tmp);
nkeynes@587	576	MEM_READ_LONG(sh4r.r[Rn]+4, tmp);
nkeynes@587	577	tmpl = tmpl * SIGNEXT32(tmp) + sh4r.mac;
nkeynes@587	578	sh4r.r[Rn] += 8;
nkeynes@587	579	} else {
nkeynes@587	580	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@587	581	CHECKRALIGN32( sh4r.r[Rn] );
nkeynes@587	582	MEM_READ_LONG(sh4r.r[Rn], tmp);
nkeynes@587	583	tmpl = SIGNEXT32(tmp);
nkeynes@587	584	MEM_READ_LONG(sh4r.r[Rm], tmp);
nkeynes@587	585	tmpl = tmpl * SIGNEXT32(tmp) + sh4r.mac;
nkeynes@587	586	sh4r.r[Rn] += 4;
nkeynes@587	587	sh4r.r[Rm] += 4;
nkeynes@587	588	}
nkeynes@359	589	if( sh4r.s ) {
nkeynes@359	590	/* 48-bit Saturation. Yuch */
nkeynes@359	591	if( tmpl < (int64_t)0xFFFF800000000000LL )
nkeynes@359	592	tmpl = 0xFFFF800000000000LL;
nkeynes@359	593	else if( tmpl > (int64_t)0x00007FFFFFFFFFFFLL )
nkeynes@359	594	tmpl = 0x00007FFFFFFFFFFFLL;
nkeynes@359	595	}
nkeynes@359	596	sh4r.mac = tmpl;
nkeynes@359	597	}
nkeynes@359	598	break;
nkeynes@359	599	default:
nkeynes@359	600	UNDEF();
nkeynes@359	601	break;
nkeynes@359	602	}
nkeynes@359	603	break;
nkeynes@359	604	case 0x1:
nkeynes@359	605	{ /* MOV.L Rm, @(disp, Rn) */
nkeynes@359	606	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF); uint32_t disp = (ir&0xF)<<2;
nkeynes@359	607	tmp = sh4r.r[Rn] + disp;
nkeynes@359	608	CHECKWALIGN32( tmp );
nkeynes@359	609	MEM_WRITE_LONG( tmp, sh4r.r[Rm] );
nkeynes@359	610	}
nkeynes@359	611	break;
nkeynes@359	612	case 0x2:
nkeynes@359	613	switch( ir&0xF ) {
nkeynes@359	614	case 0x0:
nkeynes@359	615	{ /* MOV.B Rm, @Rn */
nkeynes@359	616	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	617	MEM_WRITE_BYTE( sh4r.r[Rn], sh4r.r[Rm] );
nkeynes@359	618	}
nkeynes@359	619	break;
nkeynes@359	620	case 0x1:
nkeynes@359	621	{ /* MOV.W Rm, @Rn */
nkeynes@359	622	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	623	CHECKWALIGN16( sh4r.r[Rn] ); MEM_WRITE_WORD( sh4r.r[Rn], sh4r.r[Rm] );
nkeynes@359	624	}
nkeynes@359	625	break;
nkeynes@359	626	case 0x2:
nkeynes@359	627	{ /* MOV.L Rm, @Rn */
nkeynes@359	628	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	629	CHECKWALIGN32( sh4r.r[Rn] ); MEM_WRITE_LONG( sh4r.r[Rn], sh4r.r[Rm] );
nkeynes@359	630	}
nkeynes@359	631	break;
nkeynes@359	632	case 0x4:
nkeynes@359	633	{ /* MOV.B Rm, @-Rn */
nkeynes@359	634	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@587	635	MEM_WRITE_BYTE( sh4r.r[Rn]-1, sh4r.r[Rm] ); sh4r.r[Rn]--;
nkeynes@359	636	}
nkeynes@359	637	break;
nkeynes@359	638	case 0x5:
nkeynes@359	639	{ /* MOV.W Rm, @-Rn */
nkeynes@359	640	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@587	641	CHECKWALIGN16( sh4r.r[Rn] ); MEM_WRITE_WORD( sh4r.r[Rn]-2, sh4r.r[Rm] ); sh4r.r[Rn] -= 2;
nkeynes@359	642	}
nkeynes@359	643	break;
nkeynes@359	644	case 0x6:
nkeynes@359	645	{ /* MOV.L Rm, @-Rn */
nkeynes@359	646	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@587	647	CHECKWALIGN32( sh4r.r[Rn] ); MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.r[Rm] ); sh4r.r[Rn] -= 4;
nkeynes@359	648	}
nkeynes@359	649	break;
nkeynes@359	650	case 0x7:
nkeynes@359	651	{ /* DIV0S Rm, Rn */
nkeynes@359	652	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	653	sh4r.q = sh4r.r[Rn]>>31;
nkeynes@359	654	sh4r.m = sh4r.r[Rm]>>31;
nkeynes@359	655	sh4r.t = sh4r.q ^ sh4r.m;
nkeynes@359	656	}
nkeynes@359	657	break;
nkeynes@359	658	case 0x8:
nkeynes@359	659	{ /* TST Rm, Rn */
nkeynes@359	660	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	661	sh4r.t = (sh4r.r[Rn]&sh4r.r[Rm] ? 0 : 1);
nkeynes@359	662	}
nkeynes@359	663	break;
nkeynes@359	664	case 0x9:
nkeynes@359	665	{ /* AND Rm, Rn */
nkeynes@359	666	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	667	sh4r.r[Rn] &= sh4r.r[Rm];
nkeynes@359	668	}
nkeynes@359	669	break;
nkeynes@359	670	case 0xA:
nkeynes@359	671	{ /* XOR Rm, Rn */
nkeynes@359	672	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	673	sh4r.r[Rn] ^= sh4r.r[Rm];
nkeynes@359	674	}
nkeynes@359	675	break;
nkeynes@359	676	case 0xB:
nkeynes@359	677	{ /* OR Rm, Rn */
nkeynes@359	678	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	679	sh4r.r[Rn] \|= sh4r.r[Rm];
nkeynes@359	680	}
nkeynes@359	681	break;
nkeynes@359	682	case 0xC:
nkeynes@359	683	{ /* CMP/STR Rm, Rn */
nkeynes@359	684	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	685	/* set T = 1 if any byte in RM & RN is the same */
nkeynes@359	686	tmp = sh4r.r[Rm] ^ sh4r.r[Rn];
nkeynes@359	687	sh4r.t = ((tmp&0x000000FF)==0 \|\| (tmp&0x0000FF00)==0 \|\|
nkeynes@359	688	(tmp&0x00FF0000)==0 \|\| (tmp&0xFF000000)==0)?1:0;
nkeynes@359	689	}
nkeynes@359	690	break;
nkeynes@359	691	case 0xD:
nkeynes@359	692	{ /* XTRCT Rm, Rn */
nkeynes@359	693	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	694	sh4r.r[Rn] = (sh4r.r[Rn]>>16) \| (sh4r.r[Rm]<<16);
nkeynes@359	695	}
nkeynes@359	696	break;
nkeynes@359	697	case 0xE:
nkeynes@359	698	{ /* MULU.W Rm, Rn */
nkeynes@359	699	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	700	sh4r.mac = (sh4r.mac&0xFFFFFFFF00000000LL) \|
nkeynes@359	701	(uint32_t)((sh4r.r[Rm]&0xFFFF) * (sh4r.r[Rn]&0xFFFF));
nkeynes@359	702	}
nkeynes@359	703	break;
nkeynes@359	704	case 0xF:
nkeynes@359	705	{ /* MULS.W Rm, Rn */
nkeynes@359	706	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	707	sh4r.mac = (sh4r.mac&0xFFFFFFFF00000000LL) \|
nkeynes@359	708	(uint32_t)(SIGNEXT32(sh4r.r[Rm]&0xFFFF) * SIGNEXT32(sh4r.r[Rn]&0xFFFF));
nkeynes@359	709	}
nkeynes@359	710	break;
nkeynes@359	711	default:
nkeynes@359	712	UNDEF();
nkeynes@359	713	break;
nkeynes@359	714	}
nkeynes@359	715	break;
nkeynes@359	716	case 0x3:
nkeynes@359	717	switch( ir&0xF ) {
nkeynes@359	718	case 0x0:
nkeynes@359	719	{ /* CMP/EQ Rm, Rn */
nkeynes@359	720	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	721	sh4r.t = ( sh4r.r[Rm] == sh4r.r[Rn] ? 1 : 0 );
nkeynes@359	722	}
nkeynes@359	723	break;
nkeynes@359	724	case 0x2:
nkeynes@359	725	{ /* CMP/HS Rm, Rn */
nkeynes@359	726	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	727	sh4r.t = ( sh4r.r[Rn] >= sh4r.r[Rm] ? 1 : 0 );
nkeynes@359	728	}
nkeynes@359	729	break;
nkeynes@359	730	case 0x3:
nkeynes@359	731	{ /* CMP/GE Rm, Rn */
nkeynes@359	732	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	733	sh4r.t = ( ((int32_t)sh4r.r[Rn]) >= ((int32_t)sh4r.r[Rm]) ? 1 : 0 );
nkeynes@359	734	}
nkeynes@359	735	break;
nkeynes@359	736	case 0x4:
nkeynes@359	737	{ /* DIV1 Rm, Rn */
nkeynes@359	738	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@384	739	/* This is derived from the sh4 manual with some simplifications */
nkeynes@359	740	uint32_t tmp0, tmp1, tmp2, dir;
nkeynes@359	741
nkeynes@359	742	dir = sh4r.q ^ sh4r.m;
nkeynes@359	743	sh4r.q = (sh4r.r[Rn] >> 31);
nkeynes@359	744	tmp2 = sh4r.r[Rm];
nkeynes@359	745	sh4r.r[Rn] = (sh4r.r[Rn] << 1) \| sh4r.t;
nkeynes@359	746	tmp0 = sh4r.r[Rn];
nkeynes@359	747	if( dir ) {
nkeynes@359	748	sh4r.r[Rn] += tmp2;
nkeynes@359	749	tmp1 = (sh4r.r[Rn]<tmp0 ? 1 : 0 );
nkeynes@359	750	} else {
nkeynes@359	751	sh4r.r[Rn] -= tmp2;
nkeynes@359	752	tmp1 = (sh4r.r[Rn]>tmp0 ? 1 : 0 );
nkeynes@359	753	}
nkeynes@359	754	sh4r.q ^= sh4r.m ^ tmp1;
nkeynes@359	755	sh4r.t = ( sh4r.q == sh4r.m ? 1 : 0 );
nkeynes@359	756	}
nkeynes@359	757	break;
nkeynes@359	758	case 0x5:
nkeynes@359	759	{ /* DMULU.L Rm, Rn */
nkeynes@359	760	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	761	sh4r.mac = ((uint64_t)sh4r.r[Rm]) * ((uint64_t)sh4r.r[Rn]);
nkeynes@359	762	}
nkeynes@359	763	break;
nkeynes@359	764	case 0x6:
nkeynes@359	765	{ /* CMP/HI Rm, Rn */
nkeynes@359	766	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	767	sh4r.t = ( sh4r.r[Rn] > sh4r.r[Rm] ? 1 : 0 );
nkeynes@359	768	}
nkeynes@359	769	break;
nkeynes@359	770	case 0x7:
nkeynes@359	771	{ /* CMP/GT Rm, Rn */
nkeynes@359	772	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	773	sh4r.t = ( ((int32_t)sh4r.r[Rn]) > ((int32_t)sh4r.r[Rm]) ? 1 : 0 );
nkeynes@359	774	}
nkeynes@359	775	break;
nkeynes@359	776	case 0x8:
nkeynes@359	777	{ /* SUB Rm, Rn */
nkeynes@359	778	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	779	sh4r.r[Rn] -= sh4r.r[Rm];
nkeynes@359	780	}
nkeynes@359	781	break;
nkeynes@359	782	case 0xA:
nkeynes@359	783	{ /* SUBC Rm, Rn */
nkeynes@359	784	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	785	tmp = sh4r.r[Rn];
nkeynes@359	786	sh4r.r[Rn] = sh4r.r[Rn] - sh4r.r[Rm] - sh4r.t;
nkeynes@359	787	sh4r.t = (sh4r.r[Rn] > tmp \|\| (sh4r.r[Rn] == tmp && sh4r.t == 1));
nkeynes@359	788	}
nkeynes@359	789	break;
nkeynes@359	790	case 0xB:
nkeynes@359	791	UNIMP(ir); /* SUBV Rm, Rn */
nkeynes@359	792	break;
nkeynes@359	793	case 0xC:
nkeynes@359	794	{ /* ADD Rm, Rn */
nkeynes@359	795	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	796	sh4r.r[Rn] += sh4r.r[Rm];
nkeynes@359	797	}
nkeynes@359	798	break;
nkeynes@359	799	case 0xD:
nkeynes@359	800	{ /* DMULS.L Rm, Rn */
nkeynes@359	801	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	802	sh4r.mac = SIGNEXT32(sh4r.r[Rm]) * SIGNEXT32(sh4r.r[Rn]);
nkeynes@359	803	}
nkeynes@359	804	break;
nkeynes@359	805	case 0xE:
nkeynes@359	806	{ /* ADDC Rm, Rn */
nkeynes@359	807	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	808	tmp = sh4r.r[Rn];
nkeynes@359	809	sh4r.r[Rn] += sh4r.r[Rm] + sh4r.t;
nkeynes@359	810	sh4r.t = ( sh4r.r[Rn] < tmp \|\| (sh4r.r[Rn] == tmp && sh4r.t != 0) ? 1 : 0 );
nkeynes@359	811	}
nkeynes@359	812	break;
nkeynes@359	813	case 0xF:
nkeynes@359	814	{ /* ADDV Rm, Rn */
nkeynes@359	815	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	816	tmp = sh4r.r[Rn] + sh4r.r[Rm];
nkeynes@359	817	sh4r.t = ( (sh4r.r[Rn]>>31) == (sh4r.r[Rm]>>31) && ((sh4r.r[Rn]>>31) != (tmp>>31)) );
nkeynes@359	818	sh4r.r[Rn] = tmp;
nkeynes@359	819	}
nkeynes@359	820	break;
nkeynes@359	821	default:
nkeynes@359	822	UNDEF();
nkeynes@359	823	break;
nkeynes@359	824	}
nkeynes@359	825	break;
nkeynes@359	826	case 0x4:
nkeynes@359	827	switch( ir&0xF ) {
nkeynes@359	828	case 0x0:
nkeynes@359	829	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	830	case 0x0:
nkeynes@359	831	{ /* SHLL Rn */
nkeynes@359	832	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	833	sh4r.t = sh4r.r[Rn] >> 31; sh4r.r[Rn] <<= 1;
nkeynes@359	834	}
nkeynes@359	835	break;
nkeynes@359	836	case 0x1:
nkeynes@359	837	{ /* DT Rn */
nkeynes@359	838	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	839	sh4r.r[Rn] --;
nkeynes@359	840	sh4r.t = ( sh4r.r[Rn] == 0 ? 1 : 0 );
nkeynes@359	841	}
nkeynes@359	842	break;
nkeynes@359	843	case 0x2:
nkeynes@359	844	{ /* SHAL Rn */
nkeynes@359	845	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	846	sh4r.t = sh4r.r[Rn] >> 31;
nkeynes@359	847	sh4r.r[Rn] <<= 1;
nkeynes@359	848	}
nkeynes@359	849	break;
nkeynes@359	850	default:
nkeynes@359	851	UNDEF();
nkeynes@359	852	break;
nkeynes@359	853	}
nkeynes@359	854	break;
nkeynes@359	855	case 0x1:
nkeynes@359	856	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	857	case 0x0:
nkeynes@359	858	{ /* SHLR Rn */
nkeynes@359	859	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	860	sh4r.t = sh4r.r[Rn] & 0x00000001; sh4r.r[Rn] >>= 1;
nkeynes@359	861	}
nkeynes@359	862	break;
nkeynes@359	863	case 0x1:
nkeynes@359	864	{ /* CMP/PZ Rn */
nkeynes@359	865	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	866	sh4r.t = ( ((int32_t)sh4r.r[Rn]) >= 0 ? 1 : 0 );
nkeynes@359	867	}
nkeynes@359	868	break;
nkeynes@359	869	case 0x2:
nkeynes@359	870	{ /* SHAR Rn */
nkeynes@359	871	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	872	sh4r.t = sh4r.r[Rn] & 0x00000001;
nkeynes@359	873	sh4r.r[Rn] = ((int32_t)sh4r.r[Rn]) >> 1;
nkeynes@359	874	}
nkeynes@359	875	break;
nkeynes@359	876	default:
nkeynes@359	877	UNDEF();
nkeynes@359	878	break;
nkeynes@359	879	}
nkeynes@359	880	break;
nkeynes@359	881	case 0x2:
nkeynes@359	882	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	883	case 0x0:
nkeynes@359	884	{ /* STS.L MACH, @-Rn */
nkeynes@359	885	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@587	886	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	887	MEM_WRITE_LONG( sh4r.r[Rn]-4, (sh4r.mac>>32) );
nkeynes@359	888	sh4r.r[Rn] -= 4;
nkeynes@359	889	}
nkeynes@359	890	break;
nkeynes@359	891	case 0x1:
nkeynes@359	892	{ /* STS.L MACL, @-Rn */
nkeynes@359	893	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@587	894	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	895	MEM_WRITE_LONG( sh4r.r[Rn]-4, (uint32_t)sh4r.mac );
nkeynes@359	896	sh4r.r[Rn] -= 4;
nkeynes@359	897	}
nkeynes@359	898	break;
nkeynes@359	899	case 0x2:
nkeynes@359	900	{ /* STS.L PR, @-Rn */
nkeynes@359	901	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@587	902	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	903	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.pr );
nkeynes@359	904	sh4r.r[Rn] -= 4;
nkeynes@359	905	}
nkeynes@359	906	break;
nkeynes@359	907	case 0x3:
nkeynes@359	908	{ /* STC.L SGR, @-Rn */
nkeynes@359	909	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	910	CHECKPRIV();
nkeynes@587	911	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	912	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.sgr );
nkeynes@359	913	sh4r.r[Rn] -= 4;
nkeynes@359	914	}
nkeynes@359	915	break;
nkeynes@359	916	case 0x5:
nkeynes@359	917	{ /* STS.L FPUL, @-Rn */
nkeynes@359	918	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@587	919	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	920	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.fpul );
nkeynes@359	921	sh4r.r[Rn] -= 4;
nkeynes@359	922	}
nkeynes@359	923	break;
nkeynes@359	924	case 0x6:
nkeynes@359	925	{ /* STS.L FPSCR, @-Rn */
nkeynes@359	926	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@587	927	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	928	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.fpscr );
nkeynes@359	929	sh4r.r[Rn] -= 4;
nkeynes@359	930	}
nkeynes@359	931	break;
nkeynes@359	932	case 0xF:
nkeynes@359	933	{ /* STC.L DBR, @-Rn */
nkeynes@359	934	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	935	CHECKPRIV();
nkeynes@587	936	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	937	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.dbr );
nkeynes@359	938	sh4r.r[Rn] -= 4;
nkeynes@359	939	}
nkeynes@359	940	break;
nkeynes@359	941	default:
nkeynes@359	942	UNDEF();
nkeynes@359	943	break;
nkeynes@359	944	}
nkeynes@359	945	break;
nkeynes@359	946	case 0x3:
nkeynes@359	947	switch( (ir&0x80) >> 7 ) {
nkeynes@359	948	case 0x0:
nkeynes@359	949	switch( (ir&0x70) >> 4 ) {
nkeynes@359	950	case 0x0:
nkeynes@359	951	{ /* STC.L SR, @-Rn */
nkeynes@359	952	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	953	CHECKPRIV();
nkeynes@587	954	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	955	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4_read_sr() );
nkeynes@359	956	sh4r.r[Rn] -= 4;
nkeynes@359	957	}
nkeynes@359	958	break;
nkeynes@359	959	case 0x1:
nkeynes@359	960	{ /* STC.L GBR, @-Rn */
nkeynes@359	961	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@587	962	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	963	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.gbr );
nkeynes@359	964	sh4r.r[Rn] -= 4;
nkeynes@359	965	}
nkeynes@359	966	break;
nkeynes@359	967	case 0x2:
nkeynes@359	968	{ /* STC.L VBR, @-Rn */
nkeynes@359	969	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	970	CHECKPRIV();
nkeynes@587	971	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	972	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.vbr );
nkeynes@359	973	sh4r.r[Rn] -= 4;
nkeynes@359	974	}
nkeynes@359	975	break;
nkeynes@359	976	case 0x3:
nkeynes@359	977	{ /* STC.L SSR, @-Rn */
nkeynes@359	978	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	979	CHECKPRIV();
nkeynes@587	980	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	981	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.ssr );
nkeynes@359	982	sh4r.r[Rn] -= 4;
nkeynes@359	983	}
nkeynes@359	984	break;
nkeynes@359	985	case 0x4:
nkeynes@359	986	{ /* STC.L SPC, @-Rn */
nkeynes@359	987	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	988	CHECKPRIV();
nkeynes@587	989	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	990	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.spc );
nkeynes@359	991	sh4r.r[Rn] -= 4;
nkeynes@359	992	}
nkeynes@359	993	break;
nkeynes@359	994	default:
nkeynes@359	995	UNDEF();
nkeynes@359	996	break;
nkeynes@359	997	}
nkeynes@359	998	break;
nkeynes@359	999	case 0x1:
nkeynes@359	1000	{ /* STC.L Rm_BANK, @-Rn */
nkeynes@359	1001	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm_BANK = ((ir>>4)&0x7);
nkeynes@359	1002	CHECKPRIV();
nkeynes@587	1003	CHECKWALIGN32( sh4r.r[Rn] );
nkeynes@587	1004	MEM_WRITE_LONG( sh4r.r[Rn]-4, sh4r.r_bank[Rm_BANK] );
nkeynes@359	1005	sh4r.r[Rn] -= 4;
nkeynes@359	1006	}
nkeynes@359	1007	break;
nkeynes@359	1008	}
nkeynes@359	1009	break;
nkeynes@359	1010	case 0x4:
nkeynes@359	1011	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1012	case 0x0:
nkeynes@359	1013	{ /* ROTL Rn */
nkeynes@359	1014	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1015	sh4r.t = sh4r.r[Rn] >> 31;
nkeynes@359	1016	sh4r.r[Rn] <<= 1;
nkeynes@359	1017	sh4r.r[Rn] \|= sh4r.t;
nkeynes@359	1018	}
nkeynes@359	1019	break;
nkeynes@359	1020	case 0x2:
nkeynes@359	1021	{ /* ROTCL Rn */
nkeynes@359	1022	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1023	tmp = sh4r.r[Rn] >> 31;
nkeynes@359	1024	sh4r.r[Rn] <<= 1;
nkeynes@359	1025	sh4r.r[Rn] \|= sh4r.t;
nkeynes@359	1026	sh4r.t = tmp;
nkeynes@359	1027	}
nkeynes@359	1028	break;
nkeynes@359	1029	default:
nkeynes@359	1030	UNDEF();
nkeynes@359	1031	break;
nkeynes@359	1032	}
nkeynes@359	1033	break;
nkeynes@359	1034	case 0x5:
nkeynes@359	1035	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1036	case 0x0:
nkeynes@359	1037	{ /* ROTR Rn */
nkeynes@359	1038	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1039	sh4r.t = sh4r.r[Rn] & 0x00000001;
nkeynes@359	1040	sh4r.r[Rn] >>= 1;
nkeynes@359	1041	sh4r.r[Rn] \|= (sh4r.t << 31);
nkeynes@359	1042	}
nkeynes@359	1043	break;
nkeynes@359	1044	case 0x1:
nkeynes@359	1045	{ /* CMP/PL Rn */
nkeynes@359	1046	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1047	sh4r.t = ( ((int32_t)sh4r.r[Rn]) > 0 ? 1 : 0 );
nkeynes@359	1048	}
nkeynes@359	1049	break;
nkeynes@359	1050	case 0x2:
nkeynes@359	1051	{ /* ROTCR Rn */
nkeynes@359	1052	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1053	tmp = sh4r.r[Rn] & 0x00000001;
nkeynes@359	1054	sh4r.r[Rn] >>= 1;
nkeynes@359	1055	sh4r.r[Rn] \|= (sh4r.t << 31 );
nkeynes@359	1056	sh4r.t = tmp;
nkeynes@359	1057	}
nkeynes@359	1058	break;
nkeynes@359	1059	default:
nkeynes@359	1060	UNDEF();
nkeynes@359	1061	break;
nkeynes@359	1062	}
nkeynes@359	1063	break;
nkeynes@359	1064	case 0x6:
nkeynes@359	1065	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1066	case 0x0:
nkeynes@359	1067	{ /* LDS.L @Rm+, MACH */
nkeynes@359	1068	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1069	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1070	MEM_READ_LONG(sh4r.r[Rm], tmp);
nkeynes@359	1071	sh4r.mac = (sh4r.mac & 0x00000000FFFFFFFF) \|
nkeynes@586	1072	(((uint64_t)tmp)<<32);
nkeynes@359	1073	sh4r.r[Rm] += 4;
nkeynes@359	1074	}
nkeynes@359	1075	break;
nkeynes@359	1076	case 0x1:
nkeynes@359	1077	{ /* LDS.L @Rm+, MACL */
nkeynes@359	1078	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1079	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1080	MEM_READ_LONG(sh4r.r[Rm], tmp);
nkeynes@359	1081	sh4r.mac = (sh4r.mac & 0xFFFFFFFF00000000LL) \|
nkeynes@586	1082	(uint64_t)((uint32_t)tmp);
nkeynes@359	1083	sh4r.r[Rm] += 4;
nkeynes@359	1084	}
nkeynes@359	1085	break;
nkeynes@359	1086	case 0x2:
nkeynes@359	1087	{ /* LDS.L @Rm+, PR */
nkeynes@359	1088	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1089	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1090	MEM_READ_LONG( sh4r.r[Rm], sh4r.pr );
nkeynes@359	1091	sh4r.r[Rm] += 4;
nkeynes@359	1092	}
nkeynes@359	1093	break;
nkeynes@359	1094	case 0x3:
nkeynes@359	1095	{ /* LDC.L @Rm+, SGR */
nkeynes@359	1096	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1097	CHECKPRIV();
nkeynes@359	1098	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1099	MEM_READ_LONG(sh4r.r[Rm], sh4r.sgr);
nkeynes@359	1100	sh4r.r[Rm] +=4;
nkeynes@359	1101	}
nkeynes@359	1102	break;
nkeynes@359	1103	case 0x5:
nkeynes@359	1104	{ /* LDS.L @Rm+, FPUL */
nkeynes@359	1105	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1106	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1107	MEM_READ_LONG(sh4r.r[Rm], sh4r.fpul);
nkeynes@359	1108	sh4r.r[Rm] +=4;
nkeynes@359	1109	}
nkeynes@359	1110	break;
nkeynes@359	1111	case 0x6:
nkeynes@359	1112	{ /* LDS.L @Rm+, FPSCR */
nkeynes@359	1113	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1114	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1115	MEM_READ_LONG(sh4r.r[Rm], sh4r.fpscr);
nkeynes@359	1116	sh4r.r[Rm] +=4;
nkeynes@374	1117	sh4r.fr_bank = &sh4r.fr[(sh4r.fpscr&FPSCR_FR)>>21][0];
nkeynes@359	1118	}
nkeynes@359	1119	break;
nkeynes@359	1120	case 0xF:
nkeynes@359	1121	{ /* LDC.L @Rm+, DBR */
nkeynes@359	1122	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1123	CHECKPRIV();
nkeynes@359	1124	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1125	MEM_READ_LONG(sh4r.r[Rm], sh4r.dbr);
nkeynes@359	1126	sh4r.r[Rm] +=4;
nkeynes@359	1127	}
nkeynes@359	1128	break;
nkeynes@359	1129	default:
nkeynes@359	1130	UNDEF();
nkeynes@359	1131	break;
nkeynes@359	1132	}
nkeynes@359	1133	break;
nkeynes@359	1134	case 0x7:
nkeynes@359	1135	switch( (ir&0x80) >> 7 ) {
nkeynes@359	1136	case 0x0:
nkeynes@359	1137	switch( (ir&0x70) >> 4 ) {
nkeynes@359	1138	case 0x0:
nkeynes@359	1139	{ /* LDC.L @Rm+, SR */
nkeynes@359	1140	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1141	CHECKSLOTILLEGAL();
nkeynes@359	1142	CHECKPRIV();
nkeynes@359	1143	CHECKWALIGN32( sh4r.r[Rm] );
nkeynes@586	1144	MEM_READ_LONG(sh4r.r[Rm], tmp);
nkeynes@586	1145	sh4_write_sr( tmp );
nkeynes@359	1146	sh4r.r[Rm] +=4;
nkeynes@359	1147	}
nkeynes@359	1148	break;
nkeynes@359	1149	case 0x1:
nkeynes@359	1150	{ /* LDC.L @Rm+, GBR */
nkeynes@359	1151	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1152	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1153	MEM_READ_LONG(sh4r.r[Rm], sh4r.gbr);
nkeynes@359	1154	sh4r.r[Rm] +=4;
nkeynes@359	1155	}
nkeynes@359	1156	break;
nkeynes@359	1157	case 0x2:
nkeynes@359	1158	{ /* LDC.L @Rm+, VBR */
nkeynes@359	1159	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1160	CHECKPRIV();
nkeynes@359	1161	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1162	MEM_READ_LONG(sh4r.r[Rm], sh4r.vbr);
nkeynes@359	1163	sh4r.r[Rm] +=4;
nkeynes@359	1164	}
nkeynes@359	1165	break;
nkeynes@359	1166	case 0x3:
nkeynes@359	1167	{ /* LDC.L @Rm+, SSR */
nkeynes@359	1168	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1169	CHECKPRIV();
nkeynes@359	1170	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1171	MEM_READ_LONG(sh4r.r[Rm], sh4r.ssr);
nkeynes@359	1172	sh4r.r[Rm] +=4;
nkeynes@359	1173	}
nkeynes@359	1174	break;
nkeynes@359	1175	case 0x4:
nkeynes@359	1176	{ /* LDC.L @Rm+, SPC */
nkeynes@359	1177	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1178	CHECKPRIV();
nkeynes@359	1179	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1180	MEM_READ_LONG(sh4r.r[Rm], sh4r.spc);
nkeynes@359	1181	sh4r.r[Rm] +=4;
nkeynes@359	1182	}
nkeynes@359	1183	break;
nkeynes@359	1184	default:
nkeynes@359	1185	UNDEF();
nkeynes@359	1186	break;
nkeynes@359	1187	}
nkeynes@359	1188	break;
nkeynes@359	1189	case 0x1:
nkeynes@359	1190	{ /* LDC.L @Rm+, Rn_BANK */
nkeynes@359	1191	uint32_t Rm = ((ir>>8)&0xF); uint32_t Rn_BANK = ((ir>>4)&0x7);
nkeynes@359	1192	CHECKPRIV();
nkeynes@359	1193	CHECKRALIGN32( sh4r.r[Rm] );
nkeynes@586	1194	MEM_READ_LONG( sh4r.r[Rm], sh4r.r_bank[Rn_BANK] );
nkeynes@359	1195	sh4r.r[Rm] += 4;
nkeynes@359	1196	}
nkeynes@359	1197	break;
nkeynes@359	1198	}
nkeynes@359	1199	break;
nkeynes@359	1200	case 0x8:
nkeynes@359	1201	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1202	case 0x0:
nkeynes@359	1203	{ /* SHLL2 Rn */
nkeynes@359	1204	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1205	sh4r.r[Rn] <<= 2;
nkeynes@359	1206	}
nkeynes@359	1207	break;
nkeynes@359	1208	case 0x1:
nkeynes@359	1209	{ /* SHLL8 Rn */
nkeynes@359	1210	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1211	sh4r.r[Rn] <<= 8;
nkeynes@359	1212	}
nkeynes@359	1213	break;
nkeynes@359	1214	case 0x2:
nkeynes@359	1215	{ /* SHLL16 Rn */
nkeynes@359	1216	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1217	sh4r.r[Rn] <<= 16;
nkeynes@359	1218	}
nkeynes@359	1219	break;
nkeynes@359	1220	default:
nkeynes@359	1221	UNDEF();
nkeynes@359	1222	break;
nkeynes@359	1223	}
nkeynes@359	1224	break;
nkeynes@359	1225	case 0x9:
nkeynes@359	1226	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1227	case 0x0:
nkeynes@359	1228	{ /* SHLR2 Rn */
nkeynes@359	1229	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1230	sh4r.r[Rn] >>= 2;
nkeynes@359	1231	}
nkeynes@359	1232	break;
nkeynes@359	1233	case 0x1:
nkeynes@359	1234	{ /* SHLR8 Rn */
nkeynes@359	1235	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1236	sh4r.r[Rn] >>= 8;
nkeynes@359	1237	}
nkeynes@359	1238	break;
nkeynes@359	1239	case 0x2:
nkeynes@359	1240	{ /* SHLR16 Rn */
nkeynes@359	1241	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1242	sh4r.r[Rn] >>= 16;
nkeynes@359	1243	}
nkeynes@359	1244	break;
nkeynes@359	1245	default:
nkeynes@359	1246	UNDEF();
nkeynes@359	1247	break;
nkeynes@359	1248	}
nkeynes@359	1249	break;
nkeynes@359	1250	case 0xA:
nkeynes@359	1251	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1252	case 0x0:
nkeynes@359	1253	{ /* LDS Rm, MACH */
nkeynes@359	1254	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1255	sh4r.mac = (sh4r.mac & 0x00000000FFFFFFFF) \|
nkeynes@359	1256	(((uint64_t)sh4r.r[Rm])<<32);
nkeynes@359	1257	}
nkeynes@359	1258	break;
nkeynes@359	1259	case 0x1:
nkeynes@359	1260	{ /* LDS Rm, MACL */
nkeynes@359	1261	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1262	sh4r.mac = (sh4r.mac & 0xFFFFFFFF00000000LL) \|
nkeynes@359	1263	(uint64_t)((uint32_t)(sh4r.r[Rm]));
nkeynes@359	1264	}
nkeynes@359	1265	break;
nkeynes@359	1266	case 0x2:
nkeynes@359	1267	{ /* LDS Rm, PR */
nkeynes@359	1268	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1269	sh4r.pr = sh4r.r[Rm];
nkeynes@359	1270	}
nkeynes@359	1271	break;
nkeynes@359	1272	case 0x3:
nkeynes@359	1273	{ /* LDC Rm, SGR */
nkeynes@359	1274	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1275	CHECKPRIV();
nkeynes@359	1276	sh4r.sgr = sh4r.r[Rm];
nkeynes@359	1277	}
nkeynes@359	1278	break;
nkeynes@359	1279	case 0x5:
nkeynes@359	1280	{ /* LDS Rm, FPUL */
nkeynes@359	1281	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1282	sh4r.fpul = sh4r.r[Rm];
nkeynes@359	1283	}
nkeynes@359	1284	break;
nkeynes@359	1285	case 0x6:
nkeynes@359	1286	{ /* LDS Rm, FPSCR */
nkeynes@359	1287	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@374	1288	sh4r.fpscr = sh4r.r[Rm];
nkeynes@374	1289	sh4r.fr_bank = &sh4r.fr[(sh4r.fpscr&FPSCR_FR)>>21][0];
nkeynes@359	1290	}
nkeynes@359	1291	break;
nkeynes@359	1292	case 0xF:
nkeynes@359	1293	{ /* LDC Rm, DBR */
nkeynes@359	1294	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1295	CHECKPRIV();
nkeynes@359	1296	sh4r.dbr = sh4r.r[Rm];
nkeynes@359	1297	}
nkeynes@359	1298	break;
nkeynes@359	1299	default:
nkeynes@359	1300	UNDEF();
nkeynes@359	1301	break;
nkeynes@359	1302	}
nkeynes@359	1303	break;
nkeynes@359	1304	case 0xB:
nkeynes@359	1305	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1306	case 0x0:
nkeynes@359	1307	{ /* JSR @Rn */
nkeynes@359	1308	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1309	CHECKDEST( sh4r.r[Rn] );
nkeynes@359	1310	CHECKSLOTILLEGAL();
nkeynes@359	1311	sh4r.in_delay_slot = 1;
nkeynes@359	1312	sh4r.pc = sh4r.new_pc;
nkeynes@359	1313	sh4r.new_pc = sh4r.r[Rn];
nkeynes@359	1314	sh4r.pr = pc + 4;
nkeynes@359	1315	TRACE_CALL( pc, sh4r.new_pc );
nkeynes@359	1316	return TRUE;
nkeynes@359	1317	}
nkeynes@359	1318	break;
nkeynes@359	1319	case 0x1:
nkeynes@359	1320	{ /* TAS.B @Rn */
nkeynes@359	1321	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@586	1322	MEM_READ_BYTE( sh4r.r[Rn], tmp );
nkeynes@359	1323	sh4r.t = ( tmp == 0 ? 1 : 0 );
nkeynes@359	1324	MEM_WRITE_BYTE( sh4r.r[Rn], tmp \| 0x80 );
nkeynes@359	1325	}
nkeynes@359	1326	break;
nkeynes@359	1327	case 0x2:
nkeynes@359	1328	{ /* JMP @Rn */
nkeynes@359	1329	uint32_t Rn = ((ir>>8)&0xF);
nkeynes@359	1330	CHECKDEST( sh4r.r[Rn] );
nkeynes@359	1331	CHECKSLOTILLEGAL();
nkeynes@359	1332	sh4r.in_delay_slot = 1;
nkeynes@359	1333	sh4r.pc = sh4r.new_pc;
nkeynes@359	1334	sh4r.new_pc = sh4r.r[Rn];
nkeynes@359	1335	return TRUE;
nkeynes@359	1336	}
nkeynes@359	1337	break;
nkeynes@359	1338	default:
nkeynes@359	1339	UNDEF();
nkeynes@359	1340	break;
nkeynes@359	1341	}
nkeynes@359	1342	break;
nkeynes@359	1343	case 0xC:
nkeynes@359	1344	{ /* SHAD Rm, Rn */
nkeynes@359	1345	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1346	tmp = sh4r.r[Rm];
nkeynes@359	1347	if( (tmp & 0x80000000) == 0 ) sh4r.r[Rn] <<= (tmp&0x1f);
nkeynes@359	1348	else if( (tmp & 0x1F) == 0 )
nkeynes@359	1349	sh4r.r[Rn] = ((int32_t)sh4r.r[Rn]) >> 31;
nkeynes@359	1350	else
nkeynes@359	1351	sh4r.r[Rn] = ((int32_t)sh4r.r[Rn]) >> (((~sh4r.r[Rm]) & 0x1F)+1);
nkeynes@359	1352	}
nkeynes@359	1353	break;
nkeynes@359	1354	case 0xD:
nkeynes@359	1355	{ /* SHLD Rm, Rn */
nkeynes@359	1356	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1357	tmp = sh4r.r[Rm];
nkeynes@359	1358	if( (tmp & 0x80000000) == 0 ) sh4r.r[Rn] <<= (tmp&0x1f);
nkeynes@359	1359	else if( (tmp & 0x1F) == 0 ) sh4r.r[Rn] = 0;
nkeynes@359	1360	else sh4r.r[Rn] >>= (((~tmp) & 0x1F)+1);
nkeynes@359	1361	}
nkeynes@359	1362	break;
nkeynes@359	1363	case 0xE:
nkeynes@359	1364	switch( (ir&0x80) >> 7 ) {
nkeynes@359	1365	case 0x0:
nkeynes@359	1366	switch( (ir&0x70) >> 4 ) {
nkeynes@359	1367	case 0x0:
nkeynes@359	1368	{ /* LDC Rm, SR */
nkeynes@359	1369	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1370	CHECKSLOTILLEGAL();
nkeynes@359	1371	CHECKPRIV();
nkeynes@374	1372	sh4_write_sr( sh4r.r[Rm] );
nkeynes@359	1373	}
nkeynes@359	1374	break;
nkeynes@359	1375	case 0x1:
nkeynes@359	1376	{ /* LDC Rm, GBR */
nkeynes@359	1377	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1378	sh4r.gbr = sh4r.r[Rm];
nkeynes@359	1379	}
nkeynes@359	1380	break;
nkeynes@359	1381	case 0x2:
nkeynes@359	1382	{ /* LDC Rm, VBR */
nkeynes@359	1383	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1384	CHECKPRIV();
nkeynes@359	1385	sh4r.vbr = sh4r.r[Rm];
nkeynes@359	1386	}
nkeynes@359	1387	break;
nkeynes@359	1388	case 0x3:
nkeynes@359	1389	{ /* LDC Rm, SSR */
nkeynes@359	1390	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1391	CHECKPRIV();
nkeynes@359	1392	sh4r.ssr = sh4r.r[Rm];
nkeynes@359	1393	}
nkeynes@359	1394	break;
nkeynes@359	1395	case 0x4:
nkeynes@359	1396	{ /* LDC Rm, SPC */
nkeynes@359	1397	uint32_t Rm = ((ir>>8)&0xF);
nkeynes@359	1398	CHECKPRIV();
nkeynes@359	1399	sh4r.spc = sh4r.r[Rm];
nkeynes@359	1400	}
nkeynes@359	1401	break;
nkeynes@359	1402	default:
nkeynes@359	1403	UNDEF();
nkeynes@359	1404	break;
nkeynes@359	1405	}
nkeynes@359	1406	break;
nkeynes@359	1407	case 0x1:
nkeynes@359	1408	{ /* LDC Rm, Rn_BANK */
nkeynes@359	1409	uint32_t Rm = ((ir>>8)&0xF); uint32_t Rn_BANK = ((ir>>4)&0x7);
nkeynes@359	1410	CHECKPRIV();
nkeynes@359	1411	sh4r.r_bank[Rn_BANK] = sh4r.r[Rm];
nkeynes@359	1412	}
nkeynes@359	1413	break;
nkeynes@359	1414	}
nkeynes@359	1415	break;
nkeynes@359	1416	case 0xF:
nkeynes@359	1417	{ /* MAC.W @Rm+, @Rn+ */
nkeynes@359	1418	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@587	1419	int32_t stmp;
nkeynes@587	1420	if( Rm == Rn ) {
nkeynes@587	1421	CHECKRALIGN16(sh4r.r[Rn]);
nkeynes@587	1422	MEM_READ_WORD( sh4r.r[Rn], tmp );
nkeynes@587	1423	stmp = SIGNEXT16(tmp);
nkeynes@587	1424	MEM_READ_WORD( sh4r.r[Rn]+2, tmp );
nkeynes@587	1425	stmp *= SIGNEXT16(tmp);
nkeynes@587	1426	sh4r.r[Rn] += 4;
nkeynes@587	1427	} else {
nkeynes@587	1428	CHECKRALIGN16( sh4r.r[Rn] );
nkeynes@587	1429	CHECKRALIGN16( sh4r.r[Rm] );
nkeynes@587	1430	MEM_READ_WORD(sh4r.r[Rn], tmp);
nkeynes@587	1431	stmp = SIGNEXT16(tmp);
nkeynes@587	1432	MEM_READ_WORD(sh4r.r[Rm], tmp);
nkeynes@587	1433	stmp = stmp * SIGNEXT16(tmp);
nkeynes@587	1434	sh4r.r[Rn] += 2;
nkeynes@587	1435	sh4r.r[Rm] += 2;
nkeynes@587	1436	}
nkeynes@359	1437	if( sh4r.s ) {
nkeynes@359	1438	int64_t tmpl = (int64_t)((int32_t)sh4r.mac) + (int64_t)stmp;
nkeynes@359	1439	if( tmpl > (int64_t)0x000000007FFFFFFFLL ) {
nkeynes@359	1440	sh4r.mac = 0x000000017FFFFFFFLL;
nkeynes@359	1441	} else if( tmpl < (int64_t)0xFFFFFFFF80000000LL ) {
nkeynes@359	1442	sh4r.mac = 0x0000000180000000LL;
nkeynes@359	1443	} else {
nkeynes@359	1444	sh4r.mac = (sh4r.mac & 0xFFFFFFFF00000000LL) \|
nkeynes@359	1445	((uint32_t)(sh4r.mac + stmp));
nkeynes@359	1446	}
nkeynes@359	1447	} else {
nkeynes@359	1448	sh4r.mac += SIGNEXT32(stmp);
nkeynes@359	1449	}
nkeynes@359	1450	}
nkeynes@359	1451	break;
nkeynes@359	1452	}
nkeynes@359	1453	break;
nkeynes@359	1454	case 0x5:
nkeynes@359	1455	{ /* MOV.L @(disp, Rm), Rn */
nkeynes@359	1456	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF); uint32_t disp = (ir&0xF)<<2;
nkeynes@359	1457	tmp = sh4r.r[Rm] + disp;
nkeynes@359	1458	CHECKRALIGN32( tmp );
nkeynes@586	1459	MEM_READ_LONG( tmp, sh4r.r[Rn] );
nkeynes@359	1460	}
nkeynes@359	1461	break;
nkeynes@359	1462	case 0x6:
nkeynes@359	1463	switch( ir&0xF ) {
nkeynes@359	1464	case 0x0:
nkeynes@359	1465	{ /* MOV.B @Rm, Rn */
nkeynes@359	1466	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@586	1467	MEM_READ_BYTE( sh4r.r[Rm], sh4r.r[Rn] );
nkeynes@359	1468	}
nkeynes@359	1469	break;
nkeynes@359	1470	case 0x1:
nkeynes@359	1471	{ /* MOV.W @Rm, Rn */
nkeynes@359	1472	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@586	1473	CHECKRALIGN16( sh4r.r[Rm] ); MEM_READ_WORD( sh4r.r[Rm], sh4r.r[Rn] );
nkeynes@359	1474	}
nkeynes@359	1475	break;
nkeynes@359	1476	case 0x2:
nkeynes@359	1477	{ /* MOV.L @Rm, Rn */
nkeynes@359	1478	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@586	1479	CHECKRALIGN32( sh4r.r[Rm] ); MEM_READ_LONG( sh4r.r[Rm], sh4r.r[Rn] );
nkeynes@359	1480	}
nkeynes@359	1481	break;
nkeynes@359	1482	case 0x3:
nkeynes@359	1483	{ /* MOV Rm, Rn */
nkeynes@359	1484	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1485	sh4r.r[Rn] = sh4r.r[Rm];
nkeynes@359	1486	}
nkeynes@359	1487	break;
nkeynes@359	1488	case 0x4:
nkeynes@359	1489	{ /* MOV.B @Rm+, Rn */
nkeynes@359	1490	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@586	1491	MEM_READ_BYTE( sh4r.r[Rm], sh4r.r[Rn] ); sh4r.r[Rm] ++;
nkeynes@359	1492	}
nkeynes@359	1493	break;
nkeynes@359	1494	case 0x5:
nkeynes@359	1495	{ /* MOV.W @Rm+, Rn */
nkeynes@359	1496	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@586	1497	CHECKRALIGN16( sh4r.r[Rm] ); MEM_READ_WORD( sh4r.r[Rm], sh4r.r[Rn] ); sh4r.r[Rm] += 2;
nkeynes@359	1498	}
nkeynes@359	1499	break;
nkeynes@359	1500	case 0x6:
nkeynes@359	1501	{ /* MOV.L @Rm+, Rn */
nkeynes@359	1502	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@586	1503	CHECKRALIGN32( sh4r.r[Rm] ); MEM_READ_LONG( sh4r.r[Rm], sh4r.r[Rn] ); sh4r.r[Rm] += 4;
nkeynes@359	1504	}
nkeynes@359	1505	break;
nkeynes@359	1506	case 0x7:
nkeynes@359	1507	{ /* NOT Rm, Rn */
nkeynes@359	1508	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1509	sh4r.r[Rn] = ~sh4r.r[Rm];
nkeynes@359	1510	}
nkeynes@359	1511	break;
nkeynes@359	1512	case 0x8:
nkeynes@359	1513	{ /* SWAP.B Rm, Rn */
nkeynes@359	1514	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1515	sh4r.r[Rn] = (sh4r.r[Rm]&0xFFFF0000) \| ((sh4r.r[Rm]&0x0000FF00)>>8) \| ((sh4r.r[Rm]&0x000000FF)<<8);
nkeynes@359	1516	}
nkeynes@359	1517	break;
nkeynes@359	1518	case 0x9:
nkeynes@359	1519	{ /* SWAP.W Rm, Rn */
nkeynes@359	1520	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1521	sh4r.r[Rn] = (sh4r.r[Rm]>>16) \| (sh4r.r[Rm]<<16);
nkeynes@359	1522	}
nkeynes@359	1523	break;
nkeynes@359	1524	case 0xA:
nkeynes@359	1525	{ /* NEGC Rm, Rn */
nkeynes@359	1526	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1527	tmp = 0 - sh4r.r[Rm];
nkeynes@359	1528	sh4r.r[Rn] = tmp - sh4r.t;
nkeynes@359	1529	sh4r.t = ( 0<tmp \|\| tmp<sh4r.r[Rn] ? 1 : 0 );
nkeynes@359	1530	}
nkeynes@359	1531	break;
nkeynes@359	1532	case 0xB:
nkeynes@359	1533	{ /* NEG Rm, Rn */
nkeynes@359	1534	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1535	sh4r.r[Rn] = 0 - sh4r.r[Rm];
nkeynes@359	1536	}
nkeynes@359	1537	break;
nkeynes@359	1538	case 0xC:
nkeynes@359	1539	{ /* EXTU.B Rm, Rn */
nkeynes@359	1540	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1541	sh4r.r[Rn] = sh4r.r[Rm]&0x000000FF;
nkeynes@359	1542	}
nkeynes@359	1543	break;
nkeynes@359	1544	case 0xD:
nkeynes@359	1545	{ /* EXTU.W Rm, Rn */
nkeynes@359	1546	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1547	sh4r.r[Rn] = sh4r.r[Rm]&0x0000FFFF;
nkeynes@359	1548	}
nkeynes@359	1549	break;
nkeynes@359	1550	case 0xE:
nkeynes@359	1551	{ /* EXTS.B Rm, Rn */
nkeynes@359	1552	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1553	sh4r.r[Rn] = SIGNEXT8( sh4r.r[Rm]&0x000000FF );
nkeynes@359	1554	}
nkeynes@359	1555	break;
nkeynes@359	1556	case 0xF:
nkeynes@359	1557	{ /* EXTS.W Rm, Rn */
nkeynes@359	1558	uint32_t Rn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1559	sh4r.r[Rn] = SIGNEXT16( sh4r.r[Rm]&0x0000FFFF );
nkeynes@359	1560	}
nkeynes@359	1561	break;
nkeynes@359	1562	}
nkeynes@359	1563	break;
nkeynes@359	1564	case 0x7:
nkeynes@359	1565	{ /* ADD #imm, Rn */
nkeynes@359	1566	uint32_t Rn = ((ir>>8)&0xF); int32_t imm = SIGNEXT8(ir&0xFF);
nkeynes@359	1567	sh4r.r[Rn] += imm;
nkeynes@359	1568	}
nkeynes@359	1569	break;
nkeynes@359	1570	case 0x8:
nkeynes@359	1571	switch( (ir&0xF00) >> 8 ) {
nkeynes@359	1572	case 0x0:
nkeynes@359	1573	{ /* MOV.B R0, @(disp, Rn) */
nkeynes@359	1574	uint32_t Rn = ((ir>>4)&0xF); uint32_t disp = (ir&0xF);
nkeynes@359	1575	MEM_WRITE_BYTE( sh4r.r[Rn] + disp, R0 );
nkeynes@359	1576	}
nkeynes@359	1577	break;
nkeynes@359	1578	case 0x1:
nkeynes@359	1579	{ /* MOV.W R0, @(disp, Rn) */
nkeynes@359	1580	uint32_t Rn = ((ir>>4)&0xF); uint32_t disp = (ir&0xF)<<1;
nkeynes@359	1581	tmp = sh4r.r[Rn] + disp;
nkeynes@359	1582	CHECKWALIGN16( tmp );
nkeynes@359	1583	MEM_WRITE_WORD( tmp, R0 );
nkeynes@359	1584	}
nkeynes@359	1585	break;
nkeynes@359	1586	case 0x4:
nkeynes@359	1587	{ /* MOV.B @(disp, Rm), R0 */
nkeynes@359	1588	uint32_t Rm = ((ir>>4)&0xF); uint32_t disp = (ir&0xF);
nkeynes@586	1589	MEM_READ_BYTE( sh4r.r[Rm] + disp, R0 );
nkeynes@359	1590	}
nkeynes@359	1591	break;
nkeynes@359	1592	case 0x5:
nkeynes@359	1593	{ /* MOV.W @(disp, Rm), R0 */
nkeynes@359	1594	uint32_t Rm = ((ir>>4)&0xF); uint32_t disp = (ir&0xF)<<1;
nkeynes@359	1595	tmp = sh4r.r[Rm] + disp;
nkeynes@359	1596	CHECKRALIGN16( tmp );
nkeynes@586	1597	MEM_READ_WORD( tmp, R0 );
nkeynes@359	1598	}
nkeynes@359	1599	break;
nkeynes@359	1600	case 0x8:
nkeynes@359	1601	{ /* CMP/EQ #imm, R0 */
nkeynes@359	1602	int32_t imm = SIGNEXT8(ir&0xFF);
nkeynes@359	1603	sh4r.t = ( R0 == imm ? 1 : 0 );
nkeynes@359	1604	}
nkeynes@359	1605	break;
nkeynes@359	1606	case 0x9:
nkeynes@359	1607	{ /* BT disp */
nkeynes@359	1608	int32_t disp = SIGNEXT8(ir&0xFF)<<1;
nkeynes@359	1609	CHECKSLOTILLEGAL();
nkeynes@359	1610	if( sh4r.t ) {
nkeynes@359	1611	CHECKDEST( sh4r.pc + disp + 4 )
nkeynes@359	1612	sh4r.pc += disp + 4;
nkeynes@359	1613	sh4r.new_pc = sh4r.pc + 2;
nkeynes@27	1614	return TRUE;
nkeynes@359	1615	}
nkeynes@359	1616	}
nkeynes@359	1617	break;
nkeynes@359	1618	case 0xB:
nkeynes@359	1619	{ /* BF disp */
nkeynes@359	1620	int32_t disp = SIGNEXT8(ir&0xFF)<<1;
nkeynes@359	1621	CHECKSLOTILLEGAL();
nkeynes@359	1622	if( !sh4r.t ) {
nkeynes@359	1623	CHECKDEST( sh4r.pc + disp + 4 )
nkeynes@359	1624	sh4r.pc += disp + 4;
nkeynes@359	1625	sh4r.new_pc = sh4r.pc + 2;
nkeynes@359	1626	return TRUE;
nkeynes@359	1627	}
nkeynes@359	1628	}
nkeynes@359	1629	break;
nkeynes@359	1630	case 0xD:
nkeynes@359	1631	{ /* BT/S disp */
nkeynes@359	1632	int32_t disp = SIGNEXT8(ir&0xFF)<<1;
nkeynes@359	1633	CHECKSLOTILLEGAL();
nkeynes@359	1634	if( sh4r.t ) {
nkeynes@359	1635	CHECKDEST( sh4r.pc + disp + 4 )
nkeynes@2	1636	sh4r.in_delay_slot = 1;
nkeynes@1	1637	sh4r.pc = sh4r.new_pc;
nkeynes@359	1638	sh4r.new_pc = pc + disp + 4;
nkeynes@359	1639	sh4r.in_delay_slot = 1;
nkeynes@27	1640	return TRUE;
nkeynes@359	1641	}
nkeynes@359	1642	}
nkeynes@359	1643	break;
nkeynes@359	1644	case 0xF:
nkeynes@359	1645	{ /* BF/S disp */
nkeynes@359	1646	int32_t disp = SIGNEXT8(ir&0xFF)<<1;
nkeynes@359	1647	CHECKSLOTILLEGAL();
nkeynes@359	1648	if( !sh4r.t ) {
nkeynes@359	1649	CHECKDEST( sh4r.pc + disp + 4 )
nkeynes@2	1650	sh4r.in_delay_slot = 1;
nkeynes@1	1651	sh4r.pc = sh4r.new_pc;
nkeynes@359	1652	sh4r.new_pc = pc + disp + 4;
nkeynes@27	1653	return TRUE;
nkeynes@359	1654	}
nkeynes@359	1655	}
nkeynes@359	1656	break;
nkeynes@359	1657	default:
nkeynes@359	1658	UNDEF();
nkeynes@359	1659	break;
nkeynes@359	1660	}
nkeynes@359	1661	break;
nkeynes@359	1662	case 0x9:
nkeynes@359	1663	{ /* MOV.W @(disp, PC), Rn */
nkeynes@359	1664	uint32_t Rn = ((ir>>8)&0xF); uint32_t disp = (ir&0xFF)<<1;
nkeynes@359	1665	CHECKSLOTILLEGAL();
nkeynes@359	1666	tmp = pc + 4 + disp;
nkeynes@586	1667	MEM_READ_WORD( tmp, sh4r.r[Rn] );
nkeynes@359	1668	}
nkeynes@359	1669	break;
nkeynes@359	1670	case 0xA:
nkeynes@359	1671	{ /* BRA disp */
nkeynes@359	1672	int32_t disp = SIGNEXT12(ir&0xFFF)<<1;
nkeynes@359	1673	CHECKSLOTILLEGAL();
nkeynes@359	1674	CHECKDEST( sh4r.pc + disp + 4 );
nkeynes@359	1675	sh4r.in_delay_slot = 1;
nkeynes@359	1676	sh4r.pc = sh4r.new_pc;
nkeynes@359	1677	sh4r.new_pc = pc + 4 + disp;
nkeynes@359	1678	return TRUE;
nkeynes@359	1679	}
nkeynes@359	1680	break;
nkeynes@359	1681	case 0xB:
nkeynes@359	1682	{ /* BSR disp */
nkeynes@359	1683	int32_t disp = SIGNEXT12(ir&0xFFF)<<1;
nkeynes@359	1684	CHECKDEST( sh4r.pc + disp + 4 );
nkeynes@359	1685	CHECKSLOTILLEGAL();
nkeynes@359	1686	sh4r.in_delay_slot = 1;
nkeynes@359	1687	sh4r.pr = pc + 4;
nkeynes@359	1688	sh4r.pc = sh4r.new_pc;
nkeynes@359	1689	sh4r.new_pc = pc + 4 + disp;
nkeynes@359	1690	TRACE_CALL( pc, sh4r.new_pc );
nkeynes@359	1691	return TRUE;
nkeynes@359	1692	}
nkeynes@359	1693	break;
nkeynes@359	1694	case 0xC:
nkeynes@359	1695	switch( (ir&0xF00) >> 8 ) {
nkeynes@359	1696	case 0x0:
nkeynes@359	1697	{ /* MOV.B R0, @(disp, GBR) */
nkeynes@359	1698	uint32_t disp = (ir&0xFF);
nkeynes@359	1699	MEM_WRITE_BYTE( sh4r.gbr + disp, R0 );
nkeynes@359	1700	}
nkeynes@359	1701	break;
nkeynes@359	1702	case 0x1:
nkeynes@359	1703	{ /* MOV.W R0, @(disp, GBR) */
nkeynes@359	1704	uint32_t disp = (ir&0xFF)<<1;
nkeynes@359	1705	tmp = sh4r.gbr + disp;
nkeynes@359	1706	CHECKWALIGN16( tmp );
nkeynes@359	1707	MEM_WRITE_WORD( tmp, R0 );
nkeynes@359	1708	}
nkeynes@359	1709	break;
nkeynes@359	1710	case 0x2:
nkeynes@359	1711	{ /* MOV.L R0, @(disp, GBR) */
nkeynes@359	1712	uint32_t disp = (ir&0xFF)<<2;
nkeynes@359	1713	tmp = sh4r.gbr + disp;
nkeynes@359	1714	CHECKWALIGN32( tmp );
nkeynes@359	1715	MEM_WRITE_LONG( tmp, R0 );
nkeynes@359	1716	}
nkeynes@359	1717	break;
nkeynes@359	1718	case 0x3:
nkeynes@359	1719	{ /* TRAPA #imm */
nkeynes@359	1720	uint32_t imm = (ir&0xFF);
nkeynes@359	1721	CHECKSLOTILLEGAL();
nkeynes@359	1722	sh4r.pc += 2;
nkeynes@586	1723	sh4_raise_trap( imm );
nkeynes@586	1724	return TRUE;
nkeynes@359	1725	}
nkeynes@359	1726	break;
nkeynes@359	1727	case 0x4:
nkeynes@359	1728	{ /* MOV.B @(disp, GBR), R0 */
nkeynes@359	1729	uint32_t disp = (ir&0xFF);
nkeynes@586	1730	MEM_READ_BYTE( sh4r.gbr + disp, R0 );
nkeynes@359	1731	}
nkeynes@359	1732	break;
nkeynes@359	1733	case 0x5:
nkeynes@359	1734	{ /* MOV.W @(disp, GBR), R0 */
nkeynes@359	1735	uint32_t disp = (ir&0xFF)<<1;
nkeynes@359	1736	tmp = sh4r.gbr + disp;
nkeynes@359	1737	CHECKRALIGN16( tmp );
nkeynes@586	1738	MEM_READ_WORD( tmp, R0 );
nkeynes@359	1739	}
nkeynes@359	1740	break;
nkeynes@359	1741	case 0x6:
nkeynes@359	1742	{ /* MOV.L @(disp, GBR), R0 */
nkeynes@359	1743	uint32_t disp = (ir&0xFF)<<2;
nkeynes@359	1744	tmp = sh4r.gbr + disp;
nkeynes@359	1745	CHECKRALIGN32( tmp );
nkeynes@586	1746	MEM_READ_LONG( tmp, R0 );
nkeynes@359	1747	}
nkeynes@359	1748	break;
nkeynes@359	1749	case 0x7:
nkeynes@359	1750	{ /* MOVA @(disp, PC), R0 */
nkeynes@359	1751	uint32_t disp = (ir&0xFF)<<2;
nkeynes@359	1752	CHECKSLOTILLEGAL();
nkeynes@359	1753	R0 = (pc&0xFFFFFFFC) + disp + 4;
nkeynes@359	1754	}
nkeynes@359	1755	break;
nkeynes@359	1756	case 0x8:
nkeynes@359	1757	{ /* TST #imm, R0 */
nkeynes@359	1758	uint32_t imm = (ir&0xFF);
nkeynes@359	1759	sh4r.t = (R0 & imm ? 0 : 1);
nkeynes@359	1760	}
nkeynes@359	1761	break;
nkeynes@359	1762	case 0x9:
nkeynes@359	1763	{ /* AND #imm, R0 */
nkeynes@359	1764	uint32_t imm = (ir&0xFF);
nkeynes@359	1765	R0 &= imm;
nkeynes@359	1766	}
nkeynes@359	1767	break;
nkeynes@359	1768	case 0xA:
nkeynes@359	1769	{ /* XOR #imm, R0 */
nkeynes@359	1770	uint32_t imm = (ir&0xFF);
nkeynes@359	1771	R0 ^= imm;
nkeynes@359	1772	}
nkeynes@359	1773	break;
nkeynes@359	1774	case 0xB:
nkeynes@359	1775	{ /* OR #imm, R0 */
nkeynes@359	1776	uint32_t imm = (ir&0xFF);
nkeynes@359	1777	R0 \|= imm;
nkeynes@359	1778	}
nkeynes@359	1779	break;
nkeynes@359	1780	case 0xC:
nkeynes@359	1781	{ /* TST.B #imm, @(R0, GBR) */
nkeynes@359	1782	uint32_t imm = (ir&0xFF);
nkeynes@586	1783	MEM_READ_BYTE(R0+sh4r.gbr, tmp); sh4r.t = ( tmp & imm ? 0 : 1 );
nkeynes@359	1784	}
nkeynes@359	1785	break;
nkeynes@359	1786	case 0xD:
nkeynes@359	1787	{ /* AND.B #imm, @(R0, GBR) */
nkeynes@359	1788	uint32_t imm = (ir&0xFF);
nkeynes@586	1789	MEM_READ_BYTE(R0+sh4r.gbr, tmp); MEM_WRITE_BYTE( R0 + sh4r.gbr, imm & tmp );
nkeynes@359	1790	}
nkeynes@359	1791	break;
nkeynes@359	1792	case 0xE:
nkeynes@359	1793	{ /* XOR.B #imm, @(R0, GBR) */
nkeynes@359	1794	uint32_t imm = (ir&0xFF);
nkeynes@586	1795	MEM_READ_BYTE(R0+sh4r.gbr, tmp); MEM_WRITE_BYTE( R0 + sh4r.gbr, imm ^ tmp );
nkeynes@359	1796	}
nkeynes@359	1797	break;
nkeynes@359	1798	case 0xF:
nkeynes@359	1799	{ /* OR.B #imm, @(R0, GBR) */
nkeynes@359	1800	uint32_t imm = (ir&0xFF);
nkeynes@586	1801	MEM_READ_BYTE(R0+sh4r.gbr, tmp); MEM_WRITE_BYTE( R0 + sh4r.gbr, imm \| tmp );
nkeynes@359	1802	}
nkeynes@359	1803	break;
nkeynes@359	1804	}
nkeynes@359	1805	break;
nkeynes@359	1806	case 0xD:
nkeynes@359	1807	{ /* MOV.L @(disp, PC), Rn */
nkeynes@359	1808	uint32_t Rn = ((ir>>8)&0xF); uint32_t disp = (ir&0xFF)<<2;
nkeynes@359	1809	CHECKSLOTILLEGAL();
nkeynes@359	1810	tmp = (pc&0xFFFFFFFC) + disp + 4;
nkeynes@586	1811	MEM_READ_LONG( tmp, sh4r.r[Rn] );
nkeynes@359	1812	}
nkeynes@359	1813	break;
nkeynes@359	1814	case 0xE:
nkeynes@359	1815	{ /* MOV #imm, Rn */
nkeynes@359	1816	uint32_t Rn = ((ir>>8)&0xF); int32_t imm = SIGNEXT8(ir&0xFF);
nkeynes@359	1817	sh4r.r[Rn] = imm;
nkeynes@359	1818	}
nkeynes@359	1819	break;
nkeynes@359	1820	case 0xF:
nkeynes@359	1821	switch( ir&0xF ) {
nkeynes@359	1822	case 0x0:
nkeynes@359	1823	{ /* FADD FRm, FRn */
nkeynes@359	1824	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1825	CHECKFPUEN();
nkeynes@359	1826	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	1827	DR(FRn) += DR(FRm);
nkeynes@359	1828	} else {
nkeynes@359	1829	FR(FRn) += FR(FRm);
nkeynes@359	1830	}
nkeynes@359	1831	}
nkeynes@359	1832	break;
nkeynes@359	1833	case 0x1:
nkeynes@359	1834	{ /* FSUB FRm, FRn */
nkeynes@359	1835	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1836	CHECKFPUEN();
nkeynes@359	1837	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	1838	DR(FRn) -= DR(FRm);
nkeynes@359	1839	} else {
nkeynes@359	1840	FR(FRn) -= FR(FRm);
nkeynes@359	1841	}
nkeynes@359	1842	}
nkeynes@359	1843	break;
nkeynes@359	1844	case 0x2:
nkeynes@359	1845	{ /* FMUL FRm, FRn */
nkeynes@359	1846	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1847	CHECKFPUEN();
nkeynes@359	1848	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	1849	DR(FRn) *= DR(FRm);
nkeynes@359	1850	} else {
nkeynes@359	1851	FR(FRn) *= FR(FRm);
nkeynes@359	1852	}
nkeynes@359	1853	}
nkeynes@359	1854	break;
nkeynes@359	1855	case 0x3:
nkeynes@359	1856	{ /* FDIV FRm, FRn */
nkeynes@359	1857	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1858	CHECKFPUEN();
nkeynes@359	1859	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	1860	DR(FRn) /= DR(FRm);
nkeynes@359	1861	} else {
nkeynes@359	1862	FR(FRn) /= FR(FRm);
nkeynes@359	1863	}
nkeynes@359	1864	}
nkeynes@359	1865	break;
nkeynes@359	1866	case 0x4:
nkeynes@359	1867	{ /* FCMP/EQ FRm, FRn */
nkeynes@359	1868	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1869	CHECKFPUEN();
nkeynes@359	1870	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	1871	sh4r.t = ( DR(FRn) == DR(FRm) ? 1 : 0 );
nkeynes@359	1872	} else {
nkeynes@359	1873	sh4r.t = ( FR(FRn) == FR(FRm) ? 1 : 0 );
nkeynes@359	1874	}
nkeynes@359	1875	}
nkeynes@359	1876	break;
nkeynes@359	1877	case 0x5:
nkeynes@359	1878	{ /* FCMP/GT FRm, FRn */
nkeynes@359	1879	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1880	CHECKFPUEN();
nkeynes@359	1881	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	1882	sh4r.t = ( DR(FRn) > DR(FRm) ? 1 : 0 );
nkeynes@359	1883	} else {
nkeynes@359	1884	sh4r.t = ( FR(FRn) > FR(FRm) ? 1 : 0 );
nkeynes@359	1885	}
nkeynes@359	1886	}
nkeynes@359	1887	break;
nkeynes@359	1888	case 0x6:
nkeynes@359	1889	{ /* FMOV @(R0, Rm), FRn */
nkeynes@359	1890	uint32_t FRn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1891	MEM_FP_READ( sh4r.r[Rm] + R0, FRn );
nkeynes@359	1892	}
nkeynes@359	1893	break;
nkeynes@359	1894	case 0x7:
nkeynes@359	1895	{ /* FMOV FRm, @(R0, Rn) */
nkeynes@359	1896	uint32_t Rn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1897	MEM_FP_WRITE( sh4r.r[Rn] + R0, FRm );
nkeynes@359	1898	}
nkeynes@359	1899	break;
nkeynes@359	1900	case 0x8:
nkeynes@359	1901	{ /* FMOV @Rm, FRn */
nkeynes@359	1902	uint32_t FRn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1903	MEM_FP_READ( sh4r.r[Rm], FRn );
nkeynes@359	1904	}
nkeynes@359	1905	break;
nkeynes@359	1906	case 0x9:
nkeynes@359	1907	{ /* FMOV @Rm+, FRn */
nkeynes@359	1908	uint32_t FRn = ((ir>>8)&0xF); uint32_t Rm = ((ir>>4)&0xF);
nkeynes@359	1909	MEM_FP_READ( sh4r.r[Rm], FRn ); sh4r.r[Rm] += FP_WIDTH;
nkeynes@359	1910	}
nkeynes@359	1911	break;
nkeynes@359	1912	case 0xA:
nkeynes@359	1913	{ /* FMOV FRm, @Rn */
nkeynes@359	1914	uint32_t Rn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1915	MEM_FP_WRITE( sh4r.r[Rn], FRm );
nkeynes@359	1916	}
nkeynes@359	1917	break;
nkeynes@359	1918	case 0xB:
nkeynes@359	1919	{ /* FMOV FRm, @-Rn */
nkeynes@359	1920	uint32_t Rn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@587	1921	MEM_FP_WRITE( sh4r.r[Rn] - FP_WIDTH, FRm ); sh4r.r[Rn] -= FP_WIDTH;
nkeynes@359	1922	}
nkeynes@359	1923	break;
nkeynes@359	1924	case 0xC:
nkeynes@359	1925	{ /* FMOV FRm, FRn */
nkeynes@359	1926	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	1927	if( IS_FPU_DOUBLESIZE() )
nkeynes@359	1928	DR(FRn) = DR(FRm);
nkeynes@359	1929	else
nkeynes@359	1930	FR(FRn) = FR(FRm);
nkeynes@359	1931	}
nkeynes@359	1932	break;
nkeynes@359	1933	case 0xD:
nkeynes@359	1934	switch( (ir&0xF0) >> 4 ) {
nkeynes@359	1935	case 0x0:
nkeynes@359	1936	{ /* FSTS FPUL, FRn */
nkeynes@359	1937	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	1938	CHECKFPUEN(); FR(FRn) = FPULf;
nkeynes@359	1939	}
nkeynes@359	1940	break;
nkeynes@359	1941	case 0x1:
nkeynes@359	1942	{ /* FLDS FRm, FPUL */
nkeynes@359	1943	uint32_t FRm = ((ir>>8)&0xF);
nkeynes@359	1944	CHECKFPUEN(); FPULf = FR(FRm);
nkeynes@359	1945	}
nkeynes@359	1946	break;
nkeynes@359	1947	case 0x2:
nkeynes@359	1948	{ /* FLOAT FPUL, FRn */
nkeynes@359	1949	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	1950	CHECKFPUEN();
nkeynes@374	1951	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@374	1952	if( FRn&1 ) { // No, really...
nkeynes@374	1953	dtmp = (double)FPULi;
nkeynes@374	1954	FR(FRn) = (((float )&dtmp)+1);
nkeynes@374	1955	} else {
nkeynes@374	1956	DRF(FRn>>1) = (double)FPULi;
nkeynes@374	1957	}
nkeynes@374	1958	} else {
nkeynes@359	1959	FR(FRn) = (float)FPULi;
nkeynes@359	1960	}
nkeynes@374	1961	}
nkeynes@359	1962	break;
nkeynes@359	1963	case 0x3:
nkeynes@359	1964	{ /* FTRC FRm, FPUL */
nkeynes@359	1965	uint32_t FRm = ((ir>>8)&0xF);
nkeynes@359	1966	CHECKFPUEN();
nkeynes@359	1967	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@374	1968	if( FRm&1 ) {
nkeynes@374	1969	dtmp = 0;
nkeynes@374	1970	(((float )&dtmp)+1) = FR(FRm);
nkeynes@374	1971	} else {
nkeynes@374	1972	dtmp = DRF(FRm>>1);
nkeynes@374	1973	}
nkeynes@359	1974	if( dtmp >= MAX_INTF )
nkeynes@359	1975	FPULi = MAX_INT;
nkeynes@359	1976	else if( dtmp <= MIN_INTF )
nkeynes@359	1977	FPULi = MIN_INT;
nkeynes@359	1978	else
nkeynes@359	1979	FPULi = (int32_t)dtmp;
nkeynes@359	1980	} else {
nkeynes@359	1981	ftmp = FR(FRm);
nkeynes@359	1982	if( ftmp >= MAX_INTF )
nkeynes@359	1983	FPULi = MAX_INT;
nkeynes@359	1984	else if( ftmp <= MIN_INTF )
nkeynes@359	1985	FPULi = MIN_INT;
nkeynes@359	1986	else
nkeynes@359	1987	FPULi = (int32_t)ftmp;
nkeynes@359	1988	}
nkeynes@359	1989	}
nkeynes@359	1990	break;
nkeynes@359	1991	case 0x4:
nkeynes@359	1992	{ /* FNEG FRn */
nkeynes@359	1993	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	1994	CHECKFPUEN();
nkeynes@359	1995	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	1996	DR(FRn) = -DR(FRn);
nkeynes@359	1997	} else {
nkeynes@359	1998	FR(FRn) = -FR(FRn);
nkeynes@359	1999	}
nkeynes@359	2000	}
nkeynes@359	2001	break;
nkeynes@359	2002	case 0x5:
nkeynes@359	2003	{ /* FABS FRn */
nkeynes@359	2004	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	2005	CHECKFPUEN();
nkeynes@359	2006	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	2007	DR(FRn) = fabs(DR(FRn));
nkeynes@359	2008	} else {
nkeynes@359	2009	FR(FRn) = fabsf(FR(FRn));
nkeynes@359	2010	}
nkeynes@359	2011	}
nkeynes@359	2012	break;
nkeynes@359	2013	case 0x6:
nkeynes@359	2014	{ /* FSQRT FRn */
nkeynes@359	2015	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	2016	CHECKFPUEN();
nkeynes@359	2017	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	2018	DR(FRn) = sqrt(DR(FRn));
nkeynes@359	2019	} else {
nkeynes@359	2020	FR(FRn) = sqrtf(FR(FRn));
nkeynes@359	2021	}
nkeynes@359	2022	}
nkeynes@359	2023	break;
nkeynes@359	2024	case 0x7:
nkeynes@359	2025	{ /* FSRRA FRn */
nkeynes@359	2026	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	2027	CHECKFPUEN();
nkeynes@359	2028	if( !IS_FPU_DOUBLEPREC() ) {
nkeynes@359	2029	FR(FRn) = 1.0/sqrtf(FR(FRn));
nkeynes@359	2030	}
nkeynes@359	2031	}
nkeynes@359	2032	break;
nkeynes@359	2033	case 0x8:
nkeynes@359	2034	{ /* FLDI0 FRn */
nkeynes@359	2035	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	2036	CHECKFPUEN();
nkeynes@359	2037	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	2038	DR(FRn) = 0.0;
nkeynes@359	2039	} else {
nkeynes@359	2040	FR(FRn) = 0.0;
nkeynes@359	2041	}
nkeynes@359	2042	}
nkeynes@359	2043	break;
nkeynes@359	2044	case 0x9:
nkeynes@359	2045	{ /* FLDI1 FRn */
nkeynes@359	2046	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	2047	CHECKFPUEN();
nkeynes@359	2048	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	2049	DR(FRn) = 1.0;
nkeynes@359	2050	} else {
nkeynes@359	2051	FR(FRn) = 1.0;
nkeynes@359	2052	}
nkeynes@359	2053	}
nkeynes@359	2054	break;
nkeynes@359	2055	case 0xA:
nkeynes@359	2056	{ /* FCNVSD FPUL, FRn */
nkeynes@359	2057	uint32_t FRn = ((ir>>8)&0xF);
nkeynes@359	2058	CHECKFPUEN();
nkeynes@359	2059	if( IS_FPU_DOUBLEPREC() && !IS_FPU_DOUBLESIZE() ) {
nkeynes@359	2060	DR(FRn) = (double)FPULf;
nkeynes@359	2061	}
nkeynes@359	2062	}
nkeynes@359	2063	break;
nkeynes@359	2064	case 0xB:
nkeynes@359	2065	{ /* FCNVDS FRm, FPUL */
nkeynes@359	2066	uint32_t FRm = ((ir>>8)&0xF);
nkeynes@359	2067	CHECKFPUEN();
nkeynes@359	2068	if( IS_FPU_DOUBLEPREC() && !IS_FPU_DOUBLESIZE() ) {
nkeynes@359	2069	FPULf = (float)DR(FRm);
nkeynes@359	2070	}
nkeynes@359	2071	}
nkeynes@359	2072	break;
nkeynes@359	2073	case 0xE:
nkeynes@359	2074	{ /* FIPR FVm, FVn */
nkeynes@359	2075	uint32_t FVn = ((ir>>10)&0x3); uint32_t FVm = ((ir>>8)&0x3);
nkeynes@359	2076	CHECKFPUEN();
nkeynes@359	2077	if( !IS_FPU_DOUBLEPREC() ) {
nkeynes@359	2078	int tmp2 = FVn<<2;
nkeynes@359	2079	tmp = FVm<<2;
nkeynes@359	2080	FR(tmp2+3) = FR(tmp)*FR(tmp2) +
nkeynes@359	2081	FR(tmp+1)*FR(tmp2+1) +
nkeynes@359	2082	FR(tmp+2)*FR(tmp2+2) +
nkeynes@359	2083	FR(tmp+3)*FR(tmp2+3);
nkeynes@359	2084	}
nkeynes@359	2085	}
nkeynes@359	2086	break;
nkeynes@359	2087	case 0xF:
nkeynes@359	2088	switch( (ir&0x100) >> 8 ) {
nkeynes@359	2089	case 0x0:
nkeynes@359	2090	{ /* FSCA FPUL, FRn */
nkeynes@359	2091	uint32_t FRn = ((ir>>9)&0x7)<<1;
nkeynes@359	2092	CHECKFPUEN();
nkeynes@359	2093	if( !IS_FPU_DOUBLEPREC() ) {
nkeynes@391	2094	sh4_fsca( FPULi, &(DRF(FRn>>1)) );
nkeynes@391	2095	/*
nkeynes@359	2096	float angle = (((float)(FPULi&0xFFFF))/65536.0) * 2 * M_PI;
nkeynes@359	2097	FR(FRn) = sinf(angle);
nkeynes@359	2098	FR((FRn)+1) = cosf(angle);
nkeynes@391	2099	*/
nkeynes@359	2100	}
nkeynes@359	2101	}
nkeynes@359	2102	break;
nkeynes@359	2103	case 0x1:
nkeynes@359	2104	switch( (ir&0x200) >> 9 ) {
nkeynes@359	2105	case 0x0:
nkeynes@359	2106	{ /* FTRV XMTRX, FVn */
nkeynes@359	2107	uint32_t FVn = ((ir>>10)&0x3);
nkeynes@359	2108	CHECKFPUEN();
nkeynes@359	2109	if( !IS_FPU_DOUBLEPREC() ) {
nkeynes@391	2110	sh4_ftrv(&(DRF(FVn<<1)), &sh4r.fr[((~sh4r.fpscr)&FPSCR_FR)>>21][0]);
nkeynes@391	2111	/*
nkeynes@359	2112	tmp = FVn<<2;
nkeynes@374	2113	float *xf = &sh4r.fr[((~sh4r.fpscr)&FPSCR_FR)>>21][0];
nkeynes@359	2114	float fv[4] = { FR(tmp), FR(tmp+1), FR(tmp+2), FR(tmp+3) };
nkeynes@374	2115	FR(tmp) = xf[1] * fv[0] + xf[5]*fv[1] +
nkeynes@374	2116	xf[9]fv[2] + xf[13]fv[3];
nkeynes@374	2117	FR(tmp+1) = xf[0] * fv[0] + xf[4]*fv[1] +
nkeynes@374	2118	xf[8]fv[2] + xf[12]fv[3];
nkeynes@374	2119	FR(tmp+2) = xf[3] * fv[0] + xf[7]*fv[1] +
nkeynes@374	2120	xf[11]fv[2] + xf[15]fv[3];
nkeynes@374	2121	FR(tmp+3) = xf[2] * fv[0] + xf[6]*fv[1] +
nkeynes@374	2122	xf[10]fv[2] + xf[14]fv[3];
nkeynes@391	2123	*/
nkeynes@359	2124	}
nkeynes@359	2125	}
nkeynes@359	2126	break;
nkeynes@359	2127	case 0x1:
nkeynes@359	2128	switch( (ir&0xC00) >> 10 ) {
nkeynes@359	2129	case 0x0:
nkeynes@359	2130	{ /* FSCHG */
nkeynes@359	2131	CHECKFPUEN(); sh4r.fpscr ^= FPSCR_SZ;
nkeynes@359	2132	}
nkeynes@359	2133	break;
nkeynes@359	2134	case 0x2:
nkeynes@359	2135	{ /* FRCHG */
nkeynes@374	2136	CHECKFPUEN();
nkeynes@374	2137	sh4r.fpscr ^= FPSCR_FR;
nkeynes@374	2138	sh4r.fr_bank = &sh4r.fr[(sh4r.fpscr&FPSCR_FR)>>21][0];
nkeynes@359	2139	}
nkeynes@359	2140	break;
nkeynes@359	2141	case 0x3:
nkeynes@359	2142	{ /* UNDEF */
nkeynes@359	2143	UNDEF(ir);
nkeynes@359	2144	}
nkeynes@359	2145	break;
nkeynes@359	2146	default:
nkeynes@359	2147	UNDEF();
nkeynes@359	2148	break;
nkeynes@359	2149	}
nkeynes@359	2150	break;
nkeynes@359	2151	}
nkeynes@359	2152	break;
nkeynes@359	2153	}
nkeynes@359	2154	break;
nkeynes@359	2155	default:
nkeynes@359	2156	UNDEF();
nkeynes@359	2157	break;
nkeynes@359	2158	}
nkeynes@359	2159	break;
nkeynes@359	2160	case 0xE:
nkeynes@359	2161	{ /* FMAC FR0, FRm, FRn */
nkeynes@359	2162	uint32_t FRn = ((ir>>8)&0xF); uint32_t FRm = ((ir>>4)&0xF);
nkeynes@359	2163	CHECKFPUEN();
nkeynes@359	2164	if( IS_FPU_DOUBLEPREC() ) {
nkeynes@359	2165	DR(FRn) += DR(FRm)*DR(0);
nkeynes@359	2166	} else {
nkeynes@359	2167	FR(FRn) += FR(FRm)*FR(0);
nkeynes@359	2168	}
nkeynes@359	2169	}
nkeynes@359	2170	break;
nkeynes@359	2171	default:
nkeynes@359	2172	UNDEF();
nkeynes@359	2173	break;
nkeynes@359	2174	}
nkeynes@359	2175	break;
nkeynes@359	2176	}
nkeynes@1	2177
nkeynes@1	2178	sh4r.pc = sh4r.new_pc;
nkeynes@1	2179	sh4r.new_pc += 2;
nkeynes@2	2180	sh4r.in_delay_slot = 0;
nkeynes@273	2181	return TRUE;
nkeynes@1	2182	}