/**

  * $Id$

  *

  * SH4 shadow execution core - runs xlat + emu together and checks that the

  * results are the same.

  *

  * Copyright (c) 2010 Nathan Keynes.

  *

  * This program is free software; you can redistribute it and/or modify

  * it under the terms of the GNU General Public License as published by

  * the Free Software Foundation; either version 2 of the License, or

  * (at your option) any later version.

  *

  * This program is distributed in the hope that it will be useful,

  * but WITHOUT ANY WARRANTY; without even the implied warranty of

  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

  * GNU General Public License for more details.

  */

 #include <stdlib.h>

 #include <string.h>

 #include <assert.h>

 #include "clock.h"

 #include "mem.h"

 #include "sh4/sh4.h"

 #include "sh4/sh4trans.h"

 #include "sh4/mmu.h"

 typedef enum {

     READ_LONG,

     WRITE_LONG,

     READ_WORD,

     WRITE_WORD,

     READ_BYTE,

     WRITE_BYTE,

     PREFETCH,

     READ_BYTE_FOR_WRITE

 } MemOp;

 char *memOpNames[] = { "read_long", "write_long", "read_word", "write_word",

         "read_byte", "write_byte", "prefetch", "read_byte_for_write" };

 struct mem_log_entry {

     MemOp op;

     sh4addr_t addr;

     uint32_t value;

 };

 static struct sh4_registers shadow_sh4r;

 static struct mem_region_fn **log_address_space;

 static struct mem_region_fn **check_address_space;

 static struct mem_region_fn **real_address_space;

 #define MEM_LOG_SIZE 4096

 static struct mem_log_entry *mem_log;

 static uint32_t mem_log_posn, mem_log_size;

 static uint32_t mem_check_posn;

 #define IS_STORE_QUEUE(X) (((X)&0xFC000000) == 0xE0000000)

 static void log_mem_op( MemOp op, sh4addr_t addr, uint32_t value )

 {

     if( mem_log_posn == mem_log_size ) {

         struct mem_log_entry *tmp = realloc(mem_log, mem_log_size * sizeof(struct mem_log_entry) * 2);

         assert( tmp != NULL );

         mem_log_size *= 2;

         mem_log = tmp;

     }

     mem_log[mem_log_posn].op = op;

     mem_log[mem_log_posn].addr = addr;

     mem_log[mem_log_posn].value = value;

     mem_log_posn++;

 }

 static void print_mem_op( FILE *f, MemOp op, sh4addr_t addr, uint32_t value )

 {

     if( op == WRITE_LONG || op == WRITE_WORD || op == WRITE_BYTE ) {

         fprintf( f, "%s( %08X, %08X )\n", memOpNames[op], addr, value );

     } else {

         fprintf( f, "%s( %08X )\n", memOpNames[op], addr );

     }

 }

 static void dump_mem_ops()

 {

     for( unsigned i=0; i<mem_log_posn; i++ ) {

         print_mem_op( stderr, mem_log[i].op, mem_log[i].addr, mem_log[i].value );

     }

 }

 static int32_t check_mem_op( MemOp op, sh4addr_t addr, uint32_t value )

 {

     if( mem_check_posn >= mem_log_posn ) {

         fprintf( stderr, "Unexpected interpreter memory operation: " );

         print_mem_op(stderr, op, addr, value );

         abort();

     }

     if( mem_log[mem_check_posn].op != op ||

         mem_log[mem_check_posn].addr != addr ||

         (( op == WRITE_LONG || op == WRITE_WORD || op == WRITE_BYTE ) &&

            mem_log[mem_check_posn].value != value ) ) {

         fprintf(stderr, "Memory operation mismatch. Translator: " );

         print_mem_op(stderr, mem_log[mem_check_posn].op,

                 mem_log[mem_check_posn].addr, mem_log[mem_check_posn].value );

         fprintf(stderr, "Emulator: ");

         print_mem_op(stderr, op, addr, value );

         abort();

     }

     return mem_log[mem_check_posn++].value;

 }

 #define CHECK_REG(sym, name) if( xsh4r->sym != esh4r->sym ) { \

     isgood = FALSE; fprintf( stderr, name "  Xlt = %08X, Emu = %08X\n", xsh4r->sym, esh4r->sym ); }

 static gboolean check_registers( struct sh4_registers *xsh4r, struct sh4_registers *esh4r )

 {

     gboolean isgood = TRUE;

     for( unsigned i=0; i<16; i++ ) {

         if( xsh4r->r[i] != esh4r->r[i] ) {

             isgood = FALSE;

             fprintf( stderr, "R%d  Xlt = %08X, Emu = %08X\n", i, xsh4r->r[i], esh4r->r[i] );

         }

     }

     for( unsigned i=0; i<8; i++ ) {

         if( xsh4r->r_bank[i] != esh4r->r_bank[i] ) {

             isgood = FALSE;

             fprintf( stderr, "R_BANK%d  Xlt = %08X, Emu = %08X\n", i, xsh4r->r_bank[i], esh4r->r_bank[i] );

         }

     }

     for( unsigned i=0; i<16; i++ ) {

         if( *((uint32_t *)&xsh4r->fr[0][i]) != *((uint32_t *)&esh4r->fr[0][i]) ) {

             isgood = FALSE;

             fprintf( stderr, "FR%d  Xlt = %f (0x%08X), Emu = %f (0x%08X)\n", i, xsh4r->fr[0][i],

                     *((uint32_t *)&xsh4r->fr[0][i]),

                     esh4r->fr[0][i],

                     *((uint32_t *)&esh4r->fr[0][i])

                     );

         }

     }

     for( unsigned i=0; i<16; i++ ) {

         if( *((uint32_t *)&xsh4r->fr[1][i]) != *((uint32_t *)&esh4r->fr[1][i]) ) {

             isgood = FALSE;

             fprintf( stderr, "XF%d  Xlt = %f (0x%08X), Emu = %f (0x%08X)\n", i, xsh4r->fr[1][i],

                     *((uint32_t *)&xsh4r->fr[1][i]),

                     esh4r->fr[1][i],

                     *((uint32_t *)&esh4r->fr[1][i])

                     );

         }

     }

     CHECK_REG(t, "T");

     CHECK_REG(m, "M");

     CHECK_REG(s, "S");

     CHECK_REG(q, "Q");

     CHECK_REG(pc, "PC");

     CHECK_REG(pr, "PR");

     CHECK_REG(sr, "SR");

     CHECK_REG(fpscr, "FPSCR");

     CHECK_REG(fpul.i, "FPUL");

     if( xsh4r->mac != esh4r->mac ) {

         isgood = FALSE;

         fprintf( stderr, "MAC  Xlt = %016llX, Emu = %016llX\n", xsh4r->mac, esh4r->mac );

     }

     CHECK_REG(gbr, "GBR");

     CHECK_REG(ssr, "SSR");

     CHECK_REG(spc, "SPC");

     CHECK_REG(sgr, "SGR");

     CHECK_REG(dbr, "DBR");

     CHECK_REG(vbr, "VBR");

     CHECK_REG(sh4_state, "STATE");

     if( memcmp( xsh4r->store_queue, esh4r->store_queue, sizeof(xsh4r->store_queue) ) != 0 ) {

         isgood = FALSE;

         fprintf( stderr, "Store queue  Xlt =\n" );

         fwrite_dump( xsh4r->store_queue, sizeof(xsh4r->store_queue), stderr );

         fprintf( stderr, "             Emu =\n" );

         fwrite_dump( esh4r->store_queue, sizeof(esh4r->store_queue), stderr );

     }

     return isgood;

 }

 static FASTCALL int32_t log_read_long( sh4addr_t addr )

 {

     int32_t rv = real_address_space[addr>>12]->read_long(addr);

     log_mem_op( READ_LONG, addr, rv );

     return rv;

 }

 static FASTCALL int32_t log_read_word( sh4addr_t addr )

 {

     int32_t rv = real_address_space[addr>>12]->read_word(addr);

     log_mem_op( READ_WORD, addr, rv );

     return rv;

 }

 static FASTCALL int32_t log_read_byte( sh4addr_t addr )

 {

     int32_t rv = real_address_space[addr>>12]->read_byte(addr);

     log_mem_op( READ_BYTE, addr, rv );

     return rv;

 }

 static FASTCALL int32_t log_read_byte_for_write( sh4addr_t addr )

 {

     int32_t rv = real_address_space[addr>>12]->read_byte_for_write(addr);

     log_mem_op( READ_BYTE_FOR_WRITE, addr, rv );

     return rv;

 }

 static FASTCALL void log_write_long( sh4addr_t addr, uint32_t val )

 {

     if( !IS_STORE_QUEUE(addr) )

         log_mem_op( WRITE_LONG, addr, val );

     real_address_space[addr>>12]->write_long(addr, val);

 }

 static FASTCALL void log_write_word( sh4addr_t addr, uint32_t val )

 {

     if( !IS_STORE_QUEUE(addr) )

         log_mem_op( WRITE_WORD, addr, val );

     real_address_space[addr>>12]->write_word(addr, val);

 }

 static FASTCALL void log_write_byte( sh4addr_t addr, uint32_t val )

 {

     if( !IS_STORE_QUEUE(addr) )

         log_mem_op( WRITE_BYTE, addr, val );

     real_address_space[addr>>12]->write_byte(addr, val);

 }

 static FASTCALL void log_prefetch( sh4addr_t addr )

 {

     log_mem_op( PREFETCH, addr, 0 );

     real_address_space[addr>>12]->prefetch(addr);

 }

 static FASTCALL int32_t check_read_long( sh4addr_t addr )

 {

     return check_mem_op( READ_LONG, addr, 0 );

 }

 static FASTCALL int32_t check_read_word( sh4addr_t addr )

 {

     return check_mem_op( READ_WORD, addr, 0 );

 }

 static FASTCALL int32_t check_read_byte( sh4addr_t addr )

 {

     return check_mem_op( READ_BYTE, addr, 0 );

 }

 static FASTCALL int32_t check_read_byte_for_write( sh4addr_t addr )

 {

     return check_mem_op( READ_BYTE_FOR_WRITE, addr, 0 );

 }

 static FASTCALL void check_write_long( sh4addr_t addr, uint32_t value )

 {

     if( !IS_STORE_QUEUE(addr) )

         check_mem_op( WRITE_LONG, addr, value );

 }

 static FASTCALL void check_write_word( sh4addr_t addr, uint32_t value )

 {

     if( !IS_STORE_QUEUE(addr) )

         check_mem_op( WRITE_WORD, addr, value );

 }

 static FASTCALL void check_write_byte( sh4addr_t addr, uint32_t value )

 {

     if( !IS_STORE_QUEUE(addr) )

         check_mem_op( WRITE_BYTE, addr, value );

 }

 static FASTCALL void check_prefetch( sh4addr_t addr )

 {

     check_mem_op( PREFETCH, addr, 0 );

 }

 struct mem_region_fn log_fns = { log_read_long, log_write_long,

         log_read_word, log_write_word,

         log_read_byte, log_write_byte,

         NULL, NULL, log_prefetch, log_read_byte_for_write };

 struct mem_region_fn check_fns = { check_read_long, check_write_long,

         check_read_word, check_write_word,

         check_read_byte, check_write_byte,

         NULL, NULL, check_prefetch, check_read_byte_for_write };

 void sh4_shadow_block_begin()

 {

     memcpy( &shadow_sh4r, &sh4r, sizeof(struct sh4_registers) );

     mem_log_posn = 0;

 }

 void sh4_shadow_block_end()

 {

     struct sh4_registers temp_sh4r;

     /* Save the end registers, and restore the state back to the start */

     memcpy( &temp_sh4r, &sh4r, sizeof(struct sh4_registers) );

     memcpy( &sh4r, &shadow_sh4r, sizeof(struct sh4_registers) );

     sh4_address_space = check_address_space;

     mem_check_posn = 0;

     sh4r.new_pc = sh4r.pc + 2;

     while( sh4r.slice_cycle < temp_sh4r.slice_cycle ) {

         sh4_execute_instruction();

         sh4r.slice_cycle += sh4_cpu_period;

     }

     if( !check_registers( &temp_sh4r, &sh4r ) ) {

         fprintf( stderr, "After executing block at %08X\n", shadow_sh4r.pc );

         fprintf( stderr, "Translated block was:\n" );

         sh4_translate_dump_block(shadow_sh4r.pc);

         abort();

     }

     if( mem_check_posn < mem_log_posn ) {

         fprintf( stderr, "Additional translator memory operations:\n" );

         while( mem_check_posn < mem_log_posn ) {

             print_mem_op( stderr, mem_log[mem_check_posn].op, mem_log[mem_check_posn].addr, mem_log[mem_check_posn].value );

             mem_check_posn++;

         }

         abort();

     }

     sh4_address_space = real_address_space;

 }

 void sh4_shadow_init()

 {

     real_address_space = sh4_address_space;

     log_address_space = mem_alloc_pages( sizeof(mem_region_fn_t) * 256 );

     check_address_space = mem_alloc_pages( sizeof(mem_region_fn_t) * 256 );

     for( unsigned i=0; i < (256 * 4096); i++ ) {

         log_address_space[i] = &log_fns;

         check_address_space[i] = &check_fns;

     }

     mem_log_size = MEM_LOG_SIZE;

     mem_log = malloc( mem_log_size * sizeof(struct mem_log_entry) );

     assert( mem_log != NULL );

     sh4_translate_set_callbacks( sh4_shadow_block_begin, sh4_shadow_block_end );

     sh4_translate_set_fastmem( FALSE );

     sh4_translate_set_address_space( log_address_space, log_address_space );

 }