1.1 --- a/src/sh4/sh4x86.in	Tue Aug 28 08:46:14 2007 +0000
     1.2 +++ b/src/sh4/sh4x86.in	Sat Sep 08 04:05:35 2007 +0000
     1.3 @@ -1,5 +1,5 @@
     1.4  /**
     1.5 - * $Id: sh4x86.in,v 1.2 2007-08-28 08:46:14 nkeynes Exp $
     1.6 + * $Id: sh4x86.in,v 1.3 2007-09-04 08:40:23 nkeynes Exp $
     1.7   * 
     1.8   * SH4 => x86 translation. This version does no real optimization, it just
     1.9   * outputs straight-line x86 code - it mainly exists to provide a baseline
    1.10 @@ -18,9 +18,73 @@
    1.11   * GNU General Public License for more details.
    1.12   */
    1.13  
    1.14 -#include "sh4core.h"
    1.15 -#include "sh4trans.h"
    1.16 -#include "x86op.h"
    1.17 +#include <assert.h>
    1.18 +
    1.19 +#include "sh4/sh4core.h"
    1.20 +#include "sh4/sh4trans.h"
    1.21 +#include "sh4/x86op.h"
    1.22 +#include "clock.h"
    1.23 +
    1.24 +#define DEFAULT_BACKPATCH_SIZE 4096
    1.25 +
    1.26 +/** 
    1.27 + * Struct to manage internal translation state. This state is not saved -
    1.28 + * it is only valid between calls to sh4_translate_begin_block() and
    1.29 + * sh4_translate_end_block()
    1.30 + */
    1.31 +struct sh4_x86_state {
    1.32 +    gboolean in_delay_slot;
    1.33 +    gboolean priv_checked; /* true if we've already checked the cpu mode. */
    1.34 +    gboolean fpuen_checked; /* true if we've already checked fpu enabled. */
    1.35 +
    1.36 +    /* Allocated memory for the (block-wide) back-patch list */
    1.37 +    uint32_t **backpatch_list;
    1.38 +    uint32_t backpatch_posn;
    1.39 +    uint32_t backpatch_size;
    1.40 +};
    1.41 +
    1.42 +#define EXIT_DATA_ADDR_READ 0
    1.43 +#define EXIT_DATA_ADDR_WRITE 7
    1.44 +#define EXIT_ILLEGAL 14
    1.45 +#define EXIT_SLOT_ILLEGAL 21
    1.46 +#define EXIT_FPU_DISABLED 28
    1.47 +#define EXIT_SLOT_FPU_DISABLED 35
    1.48 +
    1.49 +static struct sh4_x86_state sh4_x86;
    1.50 +
    1.51 +void sh4_x86_init()
    1.52 +{
    1.53 +    sh4_x86.backpatch_list = malloc(DEFAULT_BACKPATCH_SIZE);
    1.54 +    sh4_x86.backpatch_size = DEFAULT_BACKPATCH_SIZE / sizeof(uint32_t *);
    1.55 +}
    1.56 +
    1.57 +
    1.58 +static void sh4_x86_add_backpatch( uint8_t *ptr )
    1.59 +{
    1.60 +    if( sh4_x86.backpatch_posn == sh4_x86.backpatch_size ) {
    1.61 +	sh4_x86.backpatch_size <<= 1;
    1.62 +	sh4_x86.backpatch_list = realloc( sh4_x86.backpatch_list, sh4_x86.backpatch_size * sizeof(uint32_t *) );
    1.63 +	assert( sh4_x86.backpatch_list != NULL );
    1.64 +    }
    1.65 +    sh4_x86.backpatch_list[sh4_x86.backpatch_posn++] = (uint32_t *)ptr;
    1.66 +}
    1.67 +
    1.68 +static void sh4_x86_do_backpatch( uint8_t *reloc_base )
    1.69 +{
    1.70 +    unsigned int i;
    1.71 +    for( i=0; i<sh4_x86.backpatch_posn; i++ ) {
    1.72 +	*sh4_x86.backpatch_list[i] += (reloc_base - ((uint8_t *)sh4_x86.backpatch_list[i]));
    1.73 +    }
    1.74 +}
    1.75 +
    1.76 +#ifndef NDEBUG
    1.77 +#define MARK_JMP(x,n) uint8_t *_mark_jmp_##x = xlat_output + n
    1.78 +#define CHECK_JMP(x) assert( _mark_jmp_##x == xlat_output )
    1.79 +#else
    1.80 +#define MARK_JMP(x,n)
    1.81 +#define CHECK_JMP(x)
    1.82 +#endif
    1.83 +
    1.84  
    1.85  /**
    1.86   * Emit an instruction to load an SH4 reg into a real register
    1.87 @@ -33,6 +97,36 @@
    1.88      OP(REG_OFFSET(r[sh4reg]));
    1.89  }
    1.90  
    1.91 +/**
    1.92 + * Load the SR register into an x86 register
    1.93 + */
    1.94 +static inline void read_sr( int x86reg )
    1.95 +{
    1.96 +    MOV_ebp_r32( R_M, x86reg );
    1.97 +    SHL1_r32( x86reg );
    1.98 +    OR_ebp_r32( R_Q, x86reg );
    1.99 +    SHL_imm8_r32( 7, x86reg );
   1.100 +    OR_ebp_r32( R_S, x86reg );
   1.101 +    SHL1_r32( x86reg );
   1.102 +    OR_ebp_r32( R_T, x86reg );
   1.103 +    OR_ebp_r32( R_SR, x86reg );
   1.104 +}
   1.105 +
   1.106 +static inline void write_sr( int x86reg )
   1.107 +{
   1.108 +    TEST_imm32_r32( SR_M, x86reg );
   1.109 +    SETNE_ebp(R_M);
   1.110 +    TEST_imm32_r32( SR_Q, x86reg );
   1.111 +    SETNE_ebp(R_Q);
   1.112 +    TEST_imm32_r32( SR_S, x86reg );
   1.113 +    SETNE_ebp(R_S);
   1.114 +    TEST_imm32_r32( SR_T, x86reg );
   1.115 +    SETNE_ebp(R_T);
   1.116 +    AND_imm32_r32( SR_MQSTMASK, x86reg );
   1.117 +    MOV_r32_ebp( x86reg, R_SR );
   1.118 +}
   1.119 +    
   1.120 +
   1.121  static inline void load_spreg( int x86reg, int regoffset )
   1.122  {
   1.123      /* mov [bp+n], reg */
   1.124 @@ -73,8 +167,7 @@
   1.125  static inline void call_func0( void *ptr )
   1.126  {
   1.127      load_imm32(R_EAX, (uint32_t)ptr);
   1.128 -    OP(0xFF);
   1.129 -    MODRM_rm32_r32(R_EAX, 2);
   1.130 +    CALL_r32(R_EAX);
   1.131  }
   1.132  
   1.133  static inline void call_func1( void *ptr, int arg1 )
   1.134 @@ -92,6 +185,59 @@
   1.135      ADD_imm8s_r32( -4, R_ESP );
   1.136  }
   1.137  
   1.138 +/* Exception checks - Note that all exception checks will clobber EAX */
   1.139 +static void check_priv( )
   1.140 +{
   1.141 +    if( !sh4_x86.priv_checked ) {
   1.142 +	sh4_x86.priv_checked = TRUE;
   1.143 +	load_spreg( R_EAX, R_SR );
   1.144 +	AND_imm32_r32( SR_MD, R_EAX );
   1.145 +	if( sh4_x86.in_delay_slot ) {
   1.146 +	    JE_exit( EXIT_SLOT_ILLEGAL );
   1.147 +	} else {
   1.148 +	    JE_exit( EXIT_ILLEGAL );
   1.149 +	}
   1.150 +    }
   1.151 +}
   1.152 +
   1.153 +static void check_fpuen( )
   1.154 +{
   1.155 +    if( !sh4_x86.fpuen_checked ) {
   1.156 +	sh4_x86.fpuen_checked = TRUE;
   1.157 +	load_spreg( R_EAX, R_SR );
   1.158 +	AND_imm32_r32( SR_FD, R_EAX );
   1.159 +	if( sh4_x86.in_delay_slot ) {
   1.160 +	    JNE_exit(EXIT_SLOT_FPU_DISABLED);
   1.161 +	} else {
   1.162 +	    JNE_exit(EXIT_FPU_DISABLED);
   1.163 +	}
   1.164 +    }
   1.165 +}
   1.166 +
   1.167 +static void check_ralign16( int x86reg )
   1.168 +{
   1.169 +    TEST_imm32_r32( 0x00000001, x86reg );
   1.170 +    JNE_exit(EXIT_DATA_ADDR_READ);
   1.171 +}
   1.172 +
   1.173 +static void check_walign16( int x86reg )
   1.174 +{
   1.175 +    TEST_imm32_r32( 0x00000001, x86reg );
   1.176 +    JNE_exit(EXIT_DATA_ADDR_WRITE);
   1.177 +}
   1.178 +
   1.179 +static void check_ralign32( int x86reg )
   1.180 +{
   1.181 +    TEST_imm32_r32( 0x00000003, x86reg );
   1.182 +    JNE_exit(EXIT_DATA_ADDR_READ);
   1.183 +}
   1.184 +static void check_walign32( int x86reg )
   1.185 +{
   1.186 +    TEST_imm32_r32( 0x00000003, x86reg );
   1.187 +    JNE_exit(EXIT_DATA_ADDR_WRITE);
   1.188 +}
   1.189 +
   1.190 +
   1.191  #define UNDEF()
   1.192  #define MEM_RESULT(value_reg) if(value_reg != R_EAX) { MOV_r32_r32(R_EAX,value_reg); }
   1.193  #define MEM_READ_BYTE( addr_reg, value_reg ) call_func1(sh4_read_byte, addr_reg ); MEM_RESULT(value_reg)
   1.194 @@ -101,30 +247,83 @@
   1.195  #define MEM_WRITE_WORD( addr_reg, value_reg ) call_func2(sh4_write_word, addr_reg, value_reg)
   1.196  #define MEM_WRITE_LONG( addr_reg, value_reg ) call_func2(sh4_write_long, addr_reg, value_reg)
   1.197  
   1.198 +#define RAISE_EXCEPTION( exc ) call_func1(sh4_raise_exception, exc);
   1.199 +#define CHECKSLOTILLEGAL() if(sh4_x86.in_delay_slot) RAISE_EXCEPTION(EXC_SLOT_ILLEGAL)
   1.200 +
   1.201 +
   1.202  
   1.203  /**
   1.204   * Emit the 'start of block' assembly. Sets up the stack frame and save
   1.205   * SI/DI as required
   1.206   */
   1.207 -void sh4_translate_begin_block() {
   1.208 -    /* push ebp */
   1.209 -    *xlat_output++ = 0x50 + R_EBP;
   1.210 -
   1.211 +void sh4_translate_begin_block() 
   1.212 +{
   1.213 +    PUSH_r32(R_EBP);
   1.214 +    PUSH_r32(R_ESI);
   1.215      /* mov &sh4r, ebp */
   1.216      load_imm32( R_EBP, (uint32_t)&sh4r );
   1.217 +    PUSH_r32(R_ESI);
   1.218 +    
   1.219 +    sh4_x86.in_delay_slot = FALSE;
   1.220 +    sh4_x86.priv_checked = FALSE;
   1.221 +    sh4_x86.fpuen_checked = FALSE;
   1.222 +    sh4_x86.backpatch_posn = 0;
   1.223 +}
   1.224  
   1.225 -    /* load carry from SR */
   1.226 +/**
   1.227 + * Exit the block early (ie branch out), conditionally or otherwise
   1.228 + */
   1.229 +void exit_block( uint32_t pc )
   1.230 +{
   1.231 +    load_imm32( R_ECX, pc );
   1.232 +    store_spreg( R_ECX, REG_OFFSET(pc) );
   1.233 +    MOV_moff32_EAX( (uint32_t)&sh4_cpu_period );
   1.234 +    load_spreg( R_ECX, REG_OFFSET(slice_cycle) );
   1.235 +    MUL_r32( R_ESI );
   1.236 +    ADD_r32_r32( R_EAX, R_ECX );
   1.237 +    store_spreg( R_ECX, REG_OFFSET(slice_cycle) );
   1.238 +    XOR_r32_r32( R_EAX, R_EAX );
   1.239 +    RET();
   1.240  }
   1.241  
   1.242  /**
   1.243   * Flush any open regs back to memory, restore SI/DI/, update PC, etc
   1.244   */
   1.245  void sh4_translate_end_block( sh4addr_t pc ) {
   1.246 -    /* pop ebp */
   1.247 -    *xlat_output++ = 0x58 + R_EBP;
   1.248 +    assert( !sh4_x86.in_delay_slot ); // should never stop here
   1.249 +    // Normal termination - save PC, cycle count
   1.250 +    exit_block( pc );
   1.251  
   1.252 -    /* ret */
   1.253 -    *xlat_output++ = 0xC3;
   1.254 +    uint8_t *end_ptr = xlat_output;
   1.255 +    // Exception termination. Jump block for various exception codes:
   1.256 +    PUSH_imm32( EXC_DATA_ADDR_READ );
   1.257 +    JMP_rel8( 33 );
   1.258 +    PUSH_imm32( EXC_DATA_ADDR_WRITE );
   1.259 +    JMP_rel8( 26 );
   1.260 +    PUSH_imm32( EXC_ILLEGAL );
   1.261 +    JMP_rel8( 19 );
   1.262 +    PUSH_imm32( EXC_SLOT_ILLEGAL ); 
   1.263 +    JMP_rel8( 12 );
   1.264 +    PUSH_imm32( EXC_FPU_DISABLED ); 
   1.265 +    JMP_rel8( 5 );                 
   1.266 +    PUSH_imm32( EXC_SLOT_FPU_DISABLED );
   1.267 +    // target
   1.268 +    load_spreg( R_ECX, REG_OFFSET(pc) );
   1.269 +    ADD_r32_r32( R_ESI, R_ECX );
   1.270 +    ADD_r32_r32( R_ESI, R_ECX );
   1.271 +    store_spreg( R_ECX, REG_OFFSET(pc) );
   1.272 +    MOV_moff32_EAX( (uint32_t)&sh4_cpu_period );
   1.273 +    load_spreg( R_ECX, REG_OFFSET(slice_cycle) );
   1.274 +    MUL_r32( R_ESI );
   1.275 +    ADD_r32_r32( R_EAX, R_ECX );
   1.276 +    store_spreg( R_ECX, REG_OFFSET(slice_cycle) );
   1.277 +
   1.278 +    load_imm32( R_EAX, (uint32_t)sh4_raise_exception ); // 6
   1.279 +    CALL_r32( R_EAX ); // 2
   1.280 +    POP_r32(R_EBP);
   1.281 +    RET();
   1.282 +
   1.283 +    sh4_x86_do_backpatch( end_ptr );
   1.284  }
   1.285  
   1.286  /**
   1.287 @@ -138,7 +337,7 @@
   1.288  uint32_t sh4_x86_translate_instruction( uint32_t pc )
   1.289  {
   1.290      uint16_t ir = sh4_read_word( pc );
   1.291 -
   1.292 +    
   1.293  %%
   1.294  /* ALU operations */
   1.295  ADD Rm, Rn {:
   1.296 @@ -232,6 +431,18 @@
   1.297      SETGE_t();
   1.298  :}
   1.299  CMP/STR Rm, Rn {:  
   1.300 +    load_reg( R_EAX, Rm );
   1.301 +    load_reg( R_ECX, Rn );
   1.302 +    XOR_r32_r32( R_ECX, R_EAX );
   1.303 +    TEST_r8_r8( R_AL, R_AL );
   1.304 +    JE_rel8(13);
   1.305 +    TEST_r8_r8( R_AH, R_AH ); // 2
   1.306 +    JE_rel8(9);
   1.307 +    SHR_imm8_r32( 16, R_EAX ); // 3
   1.308 +    TEST_r8_r8( R_AL, R_AL ); // 2
   1.309 +    JE_rel8(2);
   1.310 +    TEST_r8_r8( R_AH, R_AH ); // 2
   1.311 +    SETE_t();
   1.312  :}
   1.313  DIV0S Rm, Rn {:
   1.314      load_reg( R_EAX, Rm );
   1.315 @@ -379,6 +590,16 @@
   1.316      store_reg( R_EAX, Rn );
   1.317  :}
   1.318  SHLD Rm, Rn {:  
   1.319 +    load_reg( R_EAX, Rn );
   1.320 +    load_reg( R_ECX, Rm );
   1.321 +
   1.322 +    MOV_r32_r32( R_EAX, R_EDX );
   1.323 +    SHL_r32_CL( R_EAX );
   1.324 +    NEG_r32( R_ECX );
   1.325 +    SHR_r32_CL( R_EDX );
   1.326 +    CMP_imm8s_r32( 0, R_ECX );
   1.327 +    CMOVAE_r32_r32( R_EDX,  R_EAX );
   1.328 +    store_reg( R_EAX, Rn );
   1.329  :}
   1.330  SHAL Rn {: 
   1.331      load_reg( R_EAX, Rn );
   1.332 @@ -477,8 +698,19 @@
   1.333      TEST_r32_r32( R_EAX, R_ECX );
   1.334      SETE_t();
   1.335  :}
   1.336 -TST #imm, R0 {:  :}
   1.337 -TST.B #imm, @(R0, GBR) {:  :}
   1.338 +TST #imm, R0 {:  
   1.339 +    load_reg( R_EAX, 0 );
   1.340 +    TEST_imm32_r32( imm, R_EAX );
   1.341 +    SETE_t();
   1.342 +:}
   1.343 +TST.B #imm, @(R0, GBR) {:  
   1.344 +    load_reg( R_EAX, 0);
   1.345 +    load_reg( R_ECX, R_GBR);
   1.346 +    ADD_r32_r32( R_EAX, R_ECX );
   1.347 +    MEM_READ_BYTE( R_ECX, R_EAX );
   1.348 +    TEST_imm8_r8( imm, R_EAX );
   1.349 +    SETE_t();
   1.350 +:}
   1.351  XOR Rm, Rn {:  
   1.352      load_reg( R_EAX, Rm );
   1.353      load_reg( R_ECX, Rn );
   1.354 @@ -725,9 +957,21 @@
   1.355  :}
   1.356  
   1.357  /* Control transfer instructions */
   1.358 -BF disp {:  :}
   1.359 -BF/S disp {:  :}
   1.360 -BRA disp {:  :}
   1.361 +BF disp {:  
   1.362 +    CMP_imm8s_ebp( 0, R_T );
   1.363 +    JNE_rel8( 1 );
   1.364 +    exit_block( disp + pc + 4 );
   1.365 +    return 1;
   1.366 +:}
   1.367 +BF/S disp {:  
   1.368 +    CMP_imm8s_ebp( 0, R_T );
   1.369 +    JNE_rel8( 1 );
   1.370 +    exit_block( disp + pc + 4 );
   1.371 +    sh4_x86.in_delay_slot = TRUE;
   1.372 +:}
   1.373 +BRA disp {:  
   1.374 +    exit_block( disp + pc + 4 );
   1.375 +:}
   1.376  BRAF Rn {:  :}
   1.377  BSR disp {:  :}
   1.378  BSRF Rn {:  :}
   1.379 @@ -785,7 +1029,10 @@
   1.380  FTRV XMTRX, FVn {:  :}
   1.381  
   1.382  /* Processor control instructions */
   1.383 -LDC Rm, SR {: /* We need to be a little careful about SR */ :}
   1.384 +LDC Rm, SR {:
   1.385 +    load_reg( R_EAX, Rm );
   1.386 +    write_sr( R_EAX );
   1.387 +:}
   1.388  LDC Rm, GBR {: 
   1.389      load_reg( R_EAX, Rm );
   1.390      store_spreg( R_EAX, R_GBR );
   1.391 @@ -819,7 +1066,13 @@
   1.392      MEM_READ_LONG( R_ECX, R_EAX );
   1.393      store_spreg( R_EAX, R_GBR );
   1.394  :}
   1.395 -LDC.L @Rm+, SR {:  
   1.396 +LDC.L @Rm+, SR {:
   1.397 +    load_reg( R_EAX, Rm );
   1.398 +    MOV_r32_r32( R_EAX, R_ECX );
   1.399 +    ADD_imm8s_r32( 4, R_EAX );
   1.400 +    store_reg( R_EAX, Rm );
   1.401 +    MEM_READ_LONG( R_ECX, R_EAX );
   1.402 +    write_sr( R_EAX );
   1.403  :}
   1.404  LDC.L @Rm+, VBR {:  
   1.405      load_reg( R_EAX, Rm );
   1.406 @@ -929,7 +1182,9 @@
   1.407  OCBWB @Rn {:  :}
   1.408  PREF @Rn {:  :}
   1.409  SLEEP {:  :}
   1.410 - STC SR, Rn {:  /* TODO */
   1.411 + STC SR, Rn {:
   1.412 +     read_sr( R_EAX );
   1.413 +     store_reg( R_EAX, Rn );
   1.414  :}
   1.415  STC GBR, Rn {:  
   1.416      load_spreg( R_EAX, R_GBR );
   1.417 @@ -955,9 +1210,14 @@
   1.418      load_spreg( R_EAX, R_DBR );
   1.419      store_reg( R_EAX, Rn );
   1.420  :}
   1.421 - STC Rm_BANK, Rn {: /* TODO */ 
   1.422 +STC Rm_BANK, Rn {: /* TODO */ 
   1.423  :}
   1.424 - STC.L SR, @-Rn {:  /* TODO */
   1.425 +STC.L SR, @-Rn {:  /* TODO */
   1.426 +    load_reg( R_ECX, Rn );
   1.427 +    ADD_imm8s_r32( -4, Rn );
   1.428 +    store_reg( R_ECX, Rn );
   1.429 +    read_sr( R_EAX );
   1.430 +    MEM_WRITE_LONG( R_ECX, R_EAX );
   1.431  :}
   1.432  STC.L VBR, @-Rn {:  
   1.433      load_reg( R_ECX, Rn );
   1.434 @@ -1060,6 +1320,7 @@
   1.435  
   1.436  NOP {: /* Do nothing. Well, we could emit an 0x90, but what would really be the point? */ :}
   1.437  %%
   1.438 +    INC_r32(R_ESI);
   1.439  
   1.440      return 0;
   1.441  }