nkeynes@1: #include <sys/mman.h>
nkeynes@1: #include <assert.h>
nkeynes@1: #include <stdint.h>
nkeynes@1: #include <stdlib.h>
nkeynes@1: #include <stdio.h>
nkeynes@1: #include <unistd.h>
nkeynes@1: #include <fcntl.h>
nkeynes@1: #include <errno.h>
nkeynes@1: #include <string.h>
nkeynes@1: #include <zlib.h>
nkeynes@1: #include "dream.h"
nkeynes@1: #include "sh4core.h"
nkeynes@1: #include "mem.h"
nkeynes@2: #include "dreamcast.h"
nkeynes@1: 
nkeynes@1: #define OC_BASE 0x1C000000
nkeynes@1: #define OC_TOP  0x20000000
nkeynes@1: 
nkeynes@2: #ifdef ENABLE_WATCH
nkeynes@2: #define CHECK_READ_WATCH( addr, size ) \
nkeynes@2:     if( mem_is_watched(addr,size,WATCH_READ) != NULL ) { \
nkeynes@2:         WARN( "Watch triggered at %08X by %d byte read", addr, size ); \
nkeynes@2:         dreamcast_stop(); \
nkeynes@2:     }
nkeynes@2: #define CHECK_WRITE_WATCH( addr, size, val )                  \
nkeynes@2:     if( mem_is_watched(addr,size,WATCH_WRITE) != NULL ) { \
nkeynes@2:         WARN( "Watch triggered at %08X by %d byte write <= %0*X", addr, size, size*2, val ); \
nkeynes@2:         dreamcast_stop(); \
nkeynes@2:     }
nkeynes@2: #else
nkeynes@2: #define CHECK_READ_WATCH( addr, size )
nkeynes@2: #define CHECK_WRITE_WATCH( addr, size )
nkeynes@2: #endif
nkeynes@2: 
nkeynes@2: #define TRANSLATE_VIDEO_64BIT_ADDRESS(a)  ( (((a)&0x00FFFFF8)>>1)|(((a)&0x00000004)<<20)|((a)&0x03)|0x05000000 );
nkeynes@2: 
nkeynes@1: static char **page_map = NULL;
nkeynes@1: static char *cache = NULL;
nkeynes@1: 
nkeynes@1: struct mem_region mem_rgn[MAX_MEM_REGIONS];
nkeynes@1: struct mmio_region *io_rgn[MAX_IO_REGIONS];
nkeynes@1: struct mmio_region *P4_io[4096];
nkeynes@1: 
nkeynes@1: int num_io_rgns = 1, num_mem_rgns = 0;
nkeynes@1: 
nkeynes@1: void *mem_alloc_pages( int n )
nkeynes@1: {
nkeynes@1:     void *mem = mmap( NULL, n * 4096,
nkeynes@1:                       PROT_READ|PROT_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, -1, 0 );
nkeynes@1:     if( mem == MAP_FAILED ) {
nkeynes@1:         ERROR( "Memory allocation failure! (%s)", strerror(errno) );
nkeynes@1:         return NULL;
nkeynes@1:     }
nkeynes@1:     return mem;
nkeynes@1: }
nkeynes@1: 
nkeynes@1: 
nkeynes@1: void mem_init( void )
nkeynes@1: {
nkeynes@1:     page_map = mmap( NULL, sizeof(char *) * PAGE_TABLE_ENTRIES,
nkeynes@1:                      PROT_READ|PROT_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, -1, 0 );
nkeynes@1:     if( page_map == MAP_FAILED ) {
nkeynes@1:         ERROR( "Unable to allocate page map! (%s)", strerror(errno) );
nkeynes@1:         page_map = NULL;
nkeynes@1:         return;
nkeynes@1:     }
nkeynes@1: 
nkeynes@1:     memset( page_map, 0, sizeof(uint32_t) * PAGE_TABLE_ENTRIES );
nkeynes@1:     cache = mem_alloc_pages(2);
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void mem_reset( void )
nkeynes@1: {
nkeynes@1:     /* Restore all mmio registers to their initial settings */
nkeynes@1:     int i, j;
nkeynes@1:     for( i=1; i<num_io_rgns; i++ ) {
nkeynes@1:         for( j=0; io_rgn[i]->ports[j].id != NULL; j++ ) {
nkeynes@1:             if( io_rgn[i]->ports[j].def_val != UNDEFINED &&
nkeynes@1:                 io_rgn[i]->ports[j].def_val != *io_rgn[i]->ports[j].val ) {
nkeynes@1:                 io_rgn[i]->io_write( io_rgn[i]->ports[j].offset,
nkeynes@1:                                     io_rgn[i]->ports[j].def_val );
nkeynes@1:             }
nkeynes@1:         }
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: struct mem_region *mem_map_region( void *mem, uint32_t base, uint32_t size,
nkeynes@1:                                    char *name, int flags )
nkeynes@1: {
nkeynes@1:     int i;
nkeynes@1:     mem_rgn[num_mem_rgns].base = base;
nkeynes@1:     mem_rgn[num_mem_rgns].size = size;
nkeynes@1:     mem_rgn[num_mem_rgns].flags = flags;
nkeynes@1:     mem_rgn[num_mem_rgns].name = name;
nkeynes@1:     mem_rgn[num_mem_rgns].mem = mem;
nkeynes@1:     num_mem_rgns++;
nkeynes@1: 
nkeynes@1:     for( i=0; i<size>>PAGE_BITS; i++ )
nkeynes@1:         page_map[(base>>PAGE_BITS)+i] = mem + (i<<PAGE_BITS);
nkeynes@1: 
nkeynes@1:     return &mem_rgn[num_mem_rgns-1];
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void *mem_create_ram_region( uint32_t base, uint32_t size, char *name )
nkeynes@1: {
nkeynes@1:     char *mem;
nkeynes@1:     
nkeynes@1:     assert( (base&0xFFFFF000) == base ); /* must be page aligned */
nkeynes@1:     assert( (size&0x00000FFF) == 0 );
nkeynes@1:     assert( num_mem_rgns < MAX_MEM_REGIONS );
nkeynes@1:     assert( page_map != NULL );
nkeynes@1: 
nkeynes@1:     mem = mem_alloc_pages( size>>PAGE_BITS );
nkeynes@1: 
nkeynes@1:     mem_map_region( mem, base, size, name, 6 );
nkeynes@1:     return mem;
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void *mem_load_rom( char *file, uint32_t base, uint32_t size, uint32_t crc )
nkeynes@1: {
nkeynes@1:     char buf[512], *mem;
nkeynes@1:     int fd;
nkeynes@1:     uint32_t calc_crc;
nkeynes@1:     snprintf( buf, 512, "%s/%s",BIOS_PATH, file );
nkeynes@1:     fd = open( buf, O_RDONLY );
nkeynes@1:     if( fd == -1 ) {
nkeynes@1:         ERROR( "Bios file not found: %s", buf );
nkeynes@1:         return NULL;
nkeynes@1:     }
nkeynes@1:     mem = mmap( NULL, size, PROT_READ, MAP_PRIVATE, fd, 0 );
nkeynes@1:     if( mem == MAP_FAILED ) {
nkeynes@1:         ERROR( "Unable to map bios file: %s (%s)", file, strerror(errno) );
nkeynes@1:         close(fd);
nkeynes@1:         return NULL;
nkeynes@1:     }
nkeynes@1:     mem_map_region( mem, base, size, file, 4 );
nkeynes@1: 
nkeynes@1:     /* CRC check */
nkeynes@1:     calc_crc = crc32(0L, mem, size);
nkeynes@1:     if( calc_crc != crc ) {
nkeynes@1:         WARN( "Bios CRC Mismatch in %s: %08X (expected %08X)",
nkeynes@1:               file, calc_crc, crc);
nkeynes@1:     }
nkeynes@1:     return mem;
nkeynes@1: }
nkeynes@1: 
nkeynes@1: char *mem_get_region_by_name( char *name )
nkeynes@1: {
nkeynes@1:     int i;
nkeynes@1:     for( i=0; i<num_mem_rgns; i++ ) {
nkeynes@1:         if( strcmp( mem_rgn[i].name, name ) == 0 )
nkeynes@1:             return mem_rgn[i].mem;
nkeynes@1:     }
nkeynes@1:     return NULL;
nkeynes@1: }
nkeynes@1: 
nkeynes@1: #define OCRAM_START (0x1C000000>>PAGE_BITS)
nkeynes@1: #define OCRAM_END   (0x20000000>>PAGE_BITS)
nkeynes@1: 
nkeynes@1: void mem_set_cache_mode( int mode )
nkeynes@1: {
nkeynes@1:     uint32_t i;
nkeynes@1:     switch( mode ) {
nkeynes@1:         case MEM_OC_INDEX0: /* OIX=0 */
nkeynes@1:             for( i=OCRAM_START; i<OCRAM_END; i++ )
nkeynes@1:                 page_map[i] = cache + ((i&0x02)<<(PAGE_BITS-1));
nkeynes@1:             break;
nkeynes@1:         case MEM_OC_INDEX1: /* OIX=1 */
nkeynes@1:             for( i=OCRAM_START; i<OCRAM_END; i++ )
nkeynes@1:                 page_map[i] = cache + ((i&0x02000000)>>(25-PAGE_BITS));
nkeynes@1:             break;
nkeynes@1:         default: /* disabled */
nkeynes@1:             for( i=OCRAM_START; i<OCRAM_END; i++ )
nkeynes@1:                 page_map[i] = NULL;
nkeynes@1:             break;
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void register_io_region( struct mmio_region *io )
nkeynes@1: {
nkeynes@1:     int i;
nkeynes@1:     
nkeynes@1:     assert(io);
nkeynes@1:     io->mem = mem_alloc_pages(2);
nkeynes@1:     io->save_mem = io->mem + PAGE_SIZE;
nkeynes@1:     io->index = (struct mmio_port **)malloc(1024*sizeof(struct mmio_port *));
nkeynes@1:     io->trace_flag = 1;
nkeynes@1:     memset( io->index, 0, 1024*sizeof(struct mmio_port *) );
nkeynes@1:     for( i=0; io->ports[i].id != NULL; i++ ) {
nkeynes@1:         io->ports[i].val = (uint32_t *)(io->mem + io->ports[i].offset);
nkeynes@1:         *io->ports[i].val = io->ports[i].def_val;
nkeynes@1:         io->index[io->ports[i].offset>>2] = &io->ports[i];
nkeynes@1:     }
nkeynes@1:     memcpy( io->save_mem, io->mem, PAGE_SIZE );
nkeynes@1:     if( (io->base & 0xFF000000) == 0xFF000000 ) {
nkeynes@1:         /* P4 area (on-chip I/O channels */
nkeynes@1:         P4_io[(io->base&0x1FFFFFFF)>>19] = io;
nkeynes@1:     } else {
nkeynes@1:         page_map[io->base>>12] = (char *)num_io_rgns;
nkeynes@1:     }
nkeynes@1:     io_rgn[num_io_rgns] = io;
nkeynes@1:     num_io_rgns++;
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void register_io_regions( struct mmio_region **io )
nkeynes@1: {
nkeynes@1:     while( *io ) register_io_region( *io++ );
nkeynes@1: }
nkeynes@1: 
nkeynes@1: #define TRACE_IO( str, p, r, ... ) if(io_rgn[(uint32_t)p]->trace_flag) \
nkeynes@1: TRACE( str " [%s.%s: %s]", __VA_ARGS__, \
nkeynes@1:     MMIO_NAME_BYNUM((uint32_t)p), MMIO_REGID_BYNUM((uint32_t)p, r), \
nkeynes@1:     MMIO_REGDESC_BYNUM((uint32_t)p, r) )
nkeynes@1: 
nkeynes@1: 
nkeynes@1: int32_t mem_read_p4( uint32_t addr )
nkeynes@1: {
nkeynes@1:     struct mmio_region *io = P4_io[(addr&0x1FFFFFFF)>>19];
nkeynes@1:     if( !io ) {
nkeynes@1:         ERROR( "Attempted read from unknown P4 region: %08X", addr );
nkeynes@1:         return 0;
nkeynes@1:     } else {
nkeynes@1:         return io->io_read( addr&0xFFF );
nkeynes@1:     }    
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void mem_write_p4( uint32_t addr, int32_t val )
nkeynes@1: {
nkeynes@1:     struct mmio_region *io = P4_io[(addr&0x1FFFFFFF)>>19];
nkeynes@1:     if( !io ) {
nkeynes@2:         if( (addr & 0xFC000000) == 0xE0000000 ) {
nkeynes@2:             /* Store queue */
nkeynes@2:             SH4_WRITE_STORE_QUEUE( addr, val );
nkeynes@2:         } else {
nkeynes@2:             ERROR( "Attempted write to unknown P4 region: %08X", addr );
nkeynes@2:         }
nkeynes@1:     } else {
nkeynes@1:         io->io_write( addr&0xFFF, val );
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: int mem_has_page( uint32_t addr )
nkeynes@1: {
nkeynes@1:     char *page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     return page != NULL;
nkeynes@1: }
nkeynes@1: 
nkeynes@1: int32_t mem_read_phys_word( uint32_t addr )
nkeynes@1: {
nkeynes@1:     char *page;
nkeynes@1:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@1:         return SIGNEXT16(mem_read_p4( addr ));
nkeynes@1:     
nkeynes@2:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@2:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@2:     }
nkeynes@2: 
nkeynes@1:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         if( page == NULL ) {
nkeynes@1:             ERROR( "Attempted word read to missing page: %08X",
nkeynes@1:                    addr );
nkeynes@1:             return 0;
nkeynes@1:         }
nkeynes@1:         return SIGNEXT16(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
nkeynes@1:     } else {
nkeynes@1:         return SIGNEXT16(*(int16_t *)(page+(addr&0xFFF)));
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: int32_t mem_read_long( uint32_t addr )
nkeynes@1: {
nkeynes@1:     char *page;
nkeynes@2:     
nkeynes@2:     CHECK_READ_WATCH(addr,4);
nkeynes@2: 
nkeynes@1:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@1:         return mem_read_p4( addr );
nkeynes@1:     
nkeynes@2:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@2:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@2:     }
nkeynes@2: 
nkeynes@1:     if( IS_MMU_ENABLED() ) {
nkeynes@1:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@1:         sh4_stop();
nkeynes@1:         return 0;
nkeynes@1:     }
nkeynes@1: 
nkeynes@1:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         int32_t val;
nkeynes@1:         if( page == NULL ) {
nkeynes@1:             ERROR( "Attempted long read to missing page: %08X", addr );
nkeynes@1:             return 0;
nkeynes@1:         }
nkeynes@1:         val = io_rgn[(uint32_t)page]->io_read(addr&0xFFF);
nkeynes@1:         TRACE_IO( "Long read %08X <= %08X", page, (addr&0xFFF), val, addr );
nkeynes@1:         return val;
nkeynes@1:     } else {
nkeynes@1:         return *(int32_t *)(page+(addr&0xFFF));
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: int32_t mem_read_word( uint32_t addr )
nkeynes@1: {
nkeynes@1:     char *page;
nkeynes@2: 
nkeynes@2:     CHECK_READ_WATCH(addr,2);
nkeynes@2: 
nkeynes@1:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@1:         return SIGNEXT16(mem_read_p4( addr ));
nkeynes@1:     
nkeynes@2:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@2:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@2:     }
nkeynes@2: 
nkeynes@1:     if( IS_MMU_ENABLED() ) {
nkeynes@1:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@1:         sh4_stop();
nkeynes@1:         return 0;
nkeynes@1:     }
nkeynes@1: 
nkeynes@1:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         int32_t val;
nkeynes@1:         if( page == NULL ) {
nkeynes@1:             ERROR( "Attempted word read to missing page: %08X", addr );
nkeynes@1:             return 0;
nkeynes@1:         }
nkeynes@1:         val = SIGNEXT16(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
nkeynes@1:         TRACE_IO( "Word read %04X <= %08X", page, (addr&0xFFF), val&0xFFFF, addr );
nkeynes@1:         return val;
nkeynes@1:     } else {
nkeynes@1:         return SIGNEXT16(*(int16_t *)(page+(addr&0xFFF)));
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: int32_t mem_read_byte( uint32_t addr )
nkeynes@1: {
nkeynes@1:     char *page;
nkeynes@2: 
nkeynes@2:     CHECK_READ_WATCH(addr,1);
nkeynes@2: 
nkeynes@1:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@1:         return SIGNEXT8(mem_read_p4( addr ));
nkeynes@2:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@2:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@2:     }
nkeynes@1:     
nkeynes@1:     if( IS_MMU_ENABLED() ) {
nkeynes@1:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@1:         sh4_stop();
nkeynes@1:         return 0;
nkeynes@1:     }
nkeynes@1: 
nkeynes@1:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         int32_t val;
nkeynes@1:         if( page == NULL ) {
nkeynes@1:             ERROR( "Attempted byte read to missing page: %08X", addr );
nkeynes@1:             return 0;
nkeynes@1:         }
nkeynes@1:         val = SIGNEXT8(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
nkeynes@1:         TRACE_IO( "Byte read %02X <= %08X", page, (addr&0xFFF), val&0xFF, addr );
nkeynes@1:         return val;
nkeynes@1:     } else {
nkeynes@1:         return SIGNEXT8(*(int8_t *)(page+(addr&0xFFF)));
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void mem_write_long( uint32_t addr, uint32_t val )
nkeynes@1: {
nkeynes@1:     char *page;
nkeynes@1:     
nkeynes@2:     CHECK_WRITE_WATCH(addr,4,val);
nkeynes@2: 
nkeynes@1:     if( addr > 0xE0000000 ) {
nkeynes@1:         mem_write_p4( addr, val );
nkeynes@1:         return;
nkeynes@1:     }
nkeynes@2:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@2:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@1:     }
nkeynes@1: 
nkeynes@1:     if( IS_MMU_ENABLED() ) {
nkeynes@1:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@1:         sh4_stop();
nkeynes@1:         return;
nkeynes@1:     }
nkeynes@2:     if( (addr&0x1FFFFFFF) < 0x200000 ) {
nkeynes@2:         ERROR( "Attempted write to read-only memory: %08X => %08X", val, addr);
nkeynes@2:         sh4_stop();
nkeynes@2:         return;
nkeynes@2:     }
nkeynes@1:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         if( page == NULL ) {
nkeynes@1:             ERROR( "Long write to missing page: %08X => %08X", val, addr );
nkeynes@1:             return;
nkeynes@1:         }
nkeynes@1:         TRACE_IO( "Long write %08X => %08X", page, (addr&0xFFF), val, addr );
nkeynes@1:         io_rgn[(uint32_t)page]->io_write(addr&0xFFF, val);
nkeynes@1:     } else {
nkeynes@1:         *(uint32_t *)(page+(addr&0xFFF)) = val;
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void mem_write_word( uint32_t addr, uint32_t val )
nkeynes@1: {
nkeynes@1:     char *page;
nkeynes@1: 
nkeynes@2:     CHECK_WRITE_WATCH(addr,2,val);
nkeynes@2: 
nkeynes@1:     if( addr > 0xE0000000 ) {
nkeynes@1:         mem_write_p4( addr, (int16_t)val );
nkeynes@1:         return;
nkeynes@1:     }
nkeynes@2:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@2:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@2:     }
nkeynes@1:     if( IS_MMU_ENABLED() ) {
nkeynes@1:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@1:         sh4_stop();
nkeynes@1:         return;
nkeynes@1:     }
nkeynes@1:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         if( page == NULL ) {
nkeynes@1:             ERROR( "Attempted word write to missing page: %08X", addr );
nkeynes@1:             return;
nkeynes@1:         }
nkeynes@1:         TRACE_IO( "Word write %04X => %08X", page, (addr&0xFFF), val&0xFFFF, addr );
nkeynes@1:         io_rgn[(uint32_t)page]->io_write(addr&0xFFF, val);
nkeynes@1:     } else {
nkeynes@1:         *(uint16_t *)(page+(addr&0xFFF)) = val;
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: void mem_write_byte( uint32_t addr, uint32_t val )
nkeynes@1: {
nkeynes@1:     char *page;
nkeynes@1:     
nkeynes@2:     CHECK_WRITE_WATCH(addr,1,val);
nkeynes@2: 
nkeynes@1:     if( addr > 0xE0000000 ) {
nkeynes@1:         mem_write_p4( addr, (int8_t)val );
nkeynes@1:         return;
nkeynes@1:     }
nkeynes@2:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@2:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@2:     }
nkeynes@2:     
nkeynes@1:     if( IS_MMU_ENABLED() ) {
nkeynes@1:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@1:         sh4_stop();
nkeynes@1:         return;
nkeynes@1:     }
nkeynes@1:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         if( page == NULL ) {
nkeynes@1:             ERROR( "Attempted byte write to missing page: %08X", addr );
nkeynes@1:             return;
nkeynes@1:         }
nkeynes@1:         TRACE_IO( "Byte write %02X => %08X", page, (addr&0xFFF), val&0xFF, addr );
nkeynes@1:         io_rgn[(uint32_t)page]->io_write( (addr&0xFFF), val);
nkeynes@1:     } else {
nkeynes@1:         *(uint8_t *)(page+(addr&0xFFF)) = val;
nkeynes@1:     }
nkeynes@1: }
nkeynes@1: 
nkeynes@1: char *mem_get_region( uint32_t addr )
nkeynes@1: {
nkeynes@1:     char *page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@1:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@1:         return NULL;
nkeynes@1:     } else {
nkeynes@1:         return page+(addr&0xFFF);
nkeynes@1:     }
nkeynes@1: }
nkeynes@2: 
nkeynes@2: /* FIXME: Handle all the many special cases when the range doesn't fall cleanly
nkeynes@2:  * into the same memory black
nkeynes@2:  */
nkeynes@2: 
nkeynes@2: void mem_copy_from_sh4( char *dest, uint32_t srcaddr, size_t count ) {
nkeynes@2:     char *src = mem_get_region(srcaddr);
nkeynes@2:     memcpy( dest, src, count );
nkeynes@2: }
nkeynes@2: 
nkeynes@2: void mem_copy_to_sh4( uint32_t destaddr, char *src, size_t count ) {
nkeynes@2:     char *dest = mem_get_region(destaddr);
nkeynes@2:     memcpy( dest, src, count );
nkeynes@2: }