nkeynes@10: /**
nkeynes@70:  * $Id: sh4mem.c,v 1.4 2006-01-10 13:59:19 nkeynes Exp $
nkeynes@10:  * sh4mem.c is responsible for the SH4's access to memory (including memory
nkeynes@10:  * mapped I/O), using the page maps created in mem.c
nkeynes@10:  *
nkeynes@10:  * Copyright (c) 2005 Nathan Keynes.
nkeynes@10:  *
nkeynes@10:  * This program is free software; you can redistribute it and/or modify
nkeynes@10:  * it under the terms of the GNU General Public License as published by
nkeynes@10:  * the Free Software Foundation; either version 2 of the License, or
nkeynes@10:  * (at your option) any later version.
nkeynes@10:  *
nkeynes@10:  * This program is distributed in the hope that it will be useful,
nkeynes@10:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
nkeynes@10:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
nkeynes@10:  * GNU General Public License for more details.
nkeynes@10:  */
nkeynes@10: 
nkeynes@35: #define MODULE sh4_module
nkeynes@35: 
nkeynes@10: #include <string.h>
nkeynes@10: #include <zlib.h>
nkeynes@10: #include "dream.h"
nkeynes@10: #include "mem.h"
nkeynes@10: #include "mmio.h"
nkeynes@70: #include "sh4core.h"
nkeynes@10: #include "sh4mmio.h"
nkeynes@10: #include "dreamcast.h"
nkeynes@10: 
nkeynes@10: #define OC_BASE 0x1C000000
nkeynes@10: #define OC_TOP  0x20000000
nkeynes@10: 
nkeynes@10: #define TRANSLATE_VIDEO_64BIT_ADDRESS(a)  ( (((a)&0x00FFFFF8)>>1)|(((a)&0x00000004)<<20)|((a)&0x03)|0x05000000 );
nkeynes@10: 
nkeynes@10: #ifdef ENABLE_WATCH
nkeynes@10: #define CHECK_READ_WATCH( addr, size ) \
nkeynes@10:     if( mem_is_watched(addr,size,WATCH_READ) != NULL ) { \
nkeynes@10:         WARN( "Watch triggered at %08X by %d byte read", addr, size ); \
nkeynes@10:         dreamcast_stop(); \
nkeynes@10:     }
nkeynes@10: #define CHECK_WRITE_WATCH( addr, size, val )                  \
nkeynes@10:     if( mem_is_watched(addr,size,WATCH_WRITE) != NULL ) { \
nkeynes@10:         WARN( "Watch triggered at %08X by %d byte write <= %0*X", addr, size, size*2, val ); \
nkeynes@10:         dreamcast_stop(); \
nkeynes@10:     }
nkeynes@10: #else
nkeynes@10: #define CHECK_READ_WATCH( addr, size )
nkeynes@10: #define CHECK_WRITE_WATCH( addr, size )
nkeynes@10: #endif
nkeynes@10: 
nkeynes@10: #define TRACE_IO( str, p, r, ... ) if(io_rgn[(uint32_t)p]->trace_flag) \
nkeynes@10: TRACE( str " [%s.%s: %s]", __VA_ARGS__, \
nkeynes@10:     MMIO_NAME_BYNUM((uint32_t)p), MMIO_REGID_BYNUM((uint32_t)p, r), \
nkeynes@10:     MMIO_REGDESC_BYNUM((uint32_t)p, r) )
nkeynes@10: 
nkeynes@10: extern struct mem_region mem_rgn[];
nkeynes@10: extern struct mmio_region *P4_io[];
nkeynes@10: 
nkeynes@10: int32_t sh4_read_p4( uint32_t addr )
nkeynes@10: {
nkeynes@10:     struct mmio_region *io = P4_io[(addr&0x1FFFFFFF)>>19];
nkeynes@10:     if( !io ) {
nkeynes@10:         ERROR( "Attempted read from unknown P4 region: %08X", addr );
nkeynes@10:         return 0;
nkeynes@10:     } else {
nkeynes@10:         return io->io_read( addr&0xFFF );
nkeynes@10:     }    
nkeynes@10: }
nkeynes@10: 
nkeynes@10: void sh4_write_p4( uint32_t addr, int32_t val )
nkeynes@10: {
nkeynes@10:     struct mmio_region *io = P4_io[(addr&0x1FFFFFFF)>>19];
nkeynes@10:     if( !io ) {
nkeynes@10:         if( (addr & 0xFC000000) == 0xE0000000 ) {
nkeynes@10:             /* Store queue */
nkeynes@10:             SH4_WRITE_STORE_QUEUE( addr, val );
nkeynes@38:         } else if( (addr & 0xFF000000) != 0xF4000000 ) {
nkeynes@38: 	    /* OC address cache isn't implemented, but don't complain about it.
nkeynes@38: 	     * Complain about anything else though */
nkeynes@10:             ERROR( "Attempted write to unknown P4 region: %08X", addr );
nkeynes@10:         }
nkeynes@10:     } else {
nkeynes@10:         io->io_write( addr&0xFFF, val );
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: int32_t sh4_read_phys_word( uint32_t addr )
nkeynes@10: {
nkeynes@10:     char *page;
nkeynes@10:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@10:         return SIGNEXT16(sh4_read_p4( addr ));
nkeynes@10:     
nkeynes@10:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@10:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@10:     }
nkeynes@10: 
nkeynes@10:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@10:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@10:         if( page == NULL ) {
nkeynes@10:             ERROR( "Attempted word read to missing page: %08X",
nkeynes@10:                    addr );
nkeynes@10:             return 0;
nkeynes@10:         }
nkeynes@10:         return SIGNEXT16(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
nkeynes@10:     } else {
nkeynes@10:         return SIGNEXT16(*(int16_t *)(page+(addr&0xFFF)));
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: int32_t sh4_read_long( uint32_t addr )
nkeynes@10: {
nkeynes@10:     char *page;
nkeynes@10:     
nkeynes@10:     CHECK_READ_WATCH(addr,4);
nkeynes@10: 
nkeynes@10:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@10:         return sh4_read_p4( addr );
nkeynes@10:     
nkeynes@10:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@10:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@10:     }
nkeynes@10: 
nkeynes@10:     if( IS_MMU_ENABLED() ) {
nkeynes@10:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@10:         sh4_stop();
nkeynes@10:         return 0;
nkeynes@10:     }
nkeynes@10: 
nkeynes@10:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@10:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@10:         int32_t val;
nkeynes@10:         if( page == NULL ) {
nkeynes@10:             ERROR( "Attempted long read to missing page: %08X", addr );
nkeynes@10:             return 0;
nkeynes@10:         }
nkeynes@10:         val = io_rgn[(uint32_t)page]->io_read(addr&0xFFF);
nkeynes@10:         TRACE_IO( "Long read %08X <= %08X", page, (addr&0xFFF), val, addr );
nkeynes@10:         return val;
nkeynes@10:     } else {
nkeynes@10:         return *(int32_t *)(page+(addr&0xFFF));
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: int32_t sh4_read_word( uint32_t addr )
nkeynes@10: {
nkeynes@10:     char *page;
nkeynes@10: 
nkeynes@10:     CHECK_READ_WATCH(addr,2);
nkeynes@10: 
nkeynes@10:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@10:         return SIGNEXT16(sh4_read_p4( addr ));
nkeynes@10:     
nkeynes@10:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@10:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@10:     }
nkeynes@10: 
nkeynes@10:     if( IS_MMU_ENABLED() ) {
nkeynes@10:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@10:         sh4_stop();
nkeynes@10:         return 0;
nkeynes@10:     }
nkeynes@10: 
nkeynes@10:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@10:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@10:         int32_t val;
nkeynes@10:         if( page == NULL ) {
nkeynes@10:             ERROR( "Attempted word read to missing page: %08X", addr );
nkeynes@10:             return 0;
nkeynes@10:         }
nkeynes@10:         val = SIGNEXT16(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
nkeynes@10:         TRACE_IO( "Word read %04X <= %08X", page, (addr&0xFFF), val&0xFFFF, addr );
nkeynes@10:         return val;
nkeynes@10:     } else {
nkeynes@10:         return SIGNEXT16(*(int16_t *)(page+(addr&0xFFF)));
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: int32_t sh4_read_byte( uint32_t addr )
nkeynes@10: {
nkeynes@10:     char *page;
nkeynes@10: 
nkeynes@10:     CHECK_READ_WATCH(addr,1);
nkeynes@10: 
nkeynes@10:     if( addr > 0xE0000000 ) /* P4 Area, handled specially */
nkeynes@10:         return SIGNEXT8(sh4_read_p4( addr ));
nkeynes@10:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@10:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@10:     }
nkeynes@10:     
nkeynes@10:     if( IS_MMU_ENABLED() ) {
nkeynes@10:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@10:         sh4_stop();
nkeynes@10:         return 0;
nkeynes@10:     }
nkeynes@10: 
nkeynes@10:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@10:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@10:         int32_t val;
nkeynes@10:         if( page == NULL ) {
nkeynes@10:             ERROR( "Attempted byte read to missing page: %08X", addr );
nkeynes@10:             return 0;
nkeynes@10:         }
nkeynes@10:         val = SIGNEXT8(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
nkeynes@10:         TRACE_IO( "Byte read %02X <= %08X", page, (addr&0xFFF), val&0xFF, addr );
nkeynes@10:         return val;
nkeynes@10:     } else {
nkeynes@10:         return SIGNEXT8(*(int8_t *)(page+(addr&0xFFF)));
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: void sh4_write_long( uint32_t addr, uint32_t val )
nkeynes@10: {
nkeynes@10:     char *page;
nkeynes@10:     
nkeynes@10:     CHECK_WRITE_WATCH(addr,4,val);
nkeynes@10: 
nkeynes@10:     if( addr > 0xE0000000 ) {
nkeynes@10:         sh4_write_p4( addr, val );
nkeynes@10:         return;
nkeynes@10:     }
nkeynes@10:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@10:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@10:     }
nkeynes@10: 
nkeynes@10:     if( IS_MMU_ENABLED() ) {
nkeynes@10:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@10:         sh4_stop();
nkeynes@10:         return;
nkeynes@10:     }
nkeynes@10:     if( (addr&0x1FFFFFFF) < 0x200000 ) {
nkeynes@10:         ERROR( "Attempted write to read-only memory: %08X => %08X", val, addr);
nkeynes@10:         sh4_stop();
nkeynes@10:         return;
nkeynes@10:     }
nkeynes@10:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@10:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@10:         if( page == NULL ) {
nkeynes@10:             ERROR( "Long write to missing page: %08X => %08X", val, addr );
nkeynes@10:             return;
nkeynes@10:         }
nkeynes@10:         TRACE_IO( "Long write %08X => %08X", page, (addr&0xFFF), val, addr );
nkeynes@10:         io_rgn[(uint32_t)page]->io_write(addr&0xFFF, val);
nkeynes@10:     } else {
nkeynes@10:         *(uint32_t *)(page+(addr&0xFFF)) = val;
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: void sh4_write_word( uint32_t addr, uint32_t val )
nkeynes@10: {
nkeynes@10:     char *page;
nkeynes@10: 
nkeynes@10:     CHECK_WRITE_WATCH(addr,2,val);
nkeynes@10: 
nkeynes@10:     if( addr > 0xE0000000 ) {
nkeynes@10:         sh4_write_p4( addr, (int16_t)val );
nkeynes@10:         return;
nkeynes@10:     }
nkeynes@10:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@10:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@10:     }
nkeynes@10:     if( IS_MMU_ENABLED() ) {
nkeynes@10:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@10:         sh4_stop();
nkeynes@10:         return;
nkeynes@10:     }
nkeynes@10:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@10:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@10:         if( page == NULL ) {
nkeynes@10:             ERROR( "Attempted word write to missing page: %08X", addr );
nkeynes@10:             return;
nkeynes@10:         }
nkeynes@10:         TRACE_IO( "Word write %04X => %08X", page, (addr&0xFFF), val&0xFFFF, addr );
nkeynes@10:         io_rgn[(uint32_t)page]->io_write(addr&0xFFF, val);
nkeynes@10:     } else {
nkeynes@10:         *(uint16_t *)(page+(addr&0xFFF)) = val;
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: void sh4_write_byte( uint32_t addr, uint32_t val )
nkeynes@10: {
nkeynes@10:     char *page;
nkeynes@10:     
nkeynes@10:     CHECK_WRITE_WATCH(addr,1,val);
nkeynes@10: 
nkeynes@10:     if( addr > 0xE0000000 ) {
nkeynes@10:         sh4_write_p4( addr, (int8_t)val );
nkeynes@10:         return;
nkeynes@10:     }
nkeynes@10:     if( (addr&0x1F800000) == 0x04000000 ) {
nkeynes@10:         addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
nkeynes@10:     }
nkeynes@10:     
nkeynes@10:     if( IS_MMU_ENABLED() ) {
nkeynes@10:         ERROR( "user-mode & mmu translation not implemented, aborting", NULL );
nkeynes@10:         sh4_stop();
nkeynes@10:         return;
nkeynes@10:     }
nkeynes@10:     page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
nkeynes@10:     if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
nkeynes@10:         if( page == NULL ) {
nkeynes@10:             ERROR( "Attempted byte write to missing page: %08X", addr );
nkeynes@10:             return;
nkeynes@10:         }
nkeynes@10:         TRACE_IO( "Byte write %02X => %08X", page, (addr&0xFFF), val&0xFF, addr );
nkeynes@10:         io_rgn[(uint32_t)page]->io_write( (addr&0xFFF), val);
nkeynes@10:     } else {
nkeynes@10:         *(uint8_t *)(page+(addr&0xFFF)) = val;
nkeynes@10:     }
nkeynes@10: }
nkeynes@10: 
nkeynes@10: 
nkeynes@10: 
nkeynes@10: /* FIXME: Handle all the many special cases when the range doesn't fall cleanly
nkeynes@10:  * into the same memory black
nkeynes@10:  */
nkeynes@10: void mem_copy_from_sh4( char *dest, uint32_t srcaddr, size_t count ) {
nkeynes@10:     char *src = mem_get_region(srcaddr);
nkeynes@10:     memcpy( dest, src, count );
nkeynes@10: }
nkeynes@10: 
nkeynes@10: void mem_copy_to_sh4( uint32_t destaddr, char *src, size_t count ) {
nkeynes@10:     char *dest = mem_get_region(destaddr);
nkeynes@10:     memcpy( dest, src, count );
nkeynes@10: }