nkeynes@10 | 1 | /**
|
nkeynes@406 | 2 | * $Id: sh4mem.c,v 1.24 2007-09-28 07:25:22 nkeynes Exp $
|
nkeynes@10 | 3 | * sh4mem.c is responsible for the SH4's access to memory (including memory
|
nkeynes@10 | 4 | * mapped I/O), using the page maps created in mem.c
|
nkeynes@10 | 5 | *
|
nkeynes@10 | 6 | * Copyright (c) 2005 Nathan Keynes.
|
nkeynes@10 | 7 | *
|
nkeynes@10 | 8 | * This program is free software; you can redistribute it and/or modify
|
nkeynes@10 | 9 | * it under the terms of the GNU General Public License as published by
|
nkeynes@10 | 10 | * the Free Software Foundation; either version 2 of the License, or
|
nkeynes@10 | 11 | * (at your option) any later version.
|
nkeynes@10 | 12 | *
|
nkeynes@10 | 13 | * This program is distributed in the hope that it will be useful,
|
nkeynes@10 | 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
nkeynes@10 | 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
nkeynes@10 | 16 | * GNU General Public License for more details.
|
nkeynes@10 | 17 | */
|
nkeynes@10 | 18 |
|
nkeynes@35 | 19 | #define MODULE sh4_module
|
nkeynes@35 | 20 |
|
nkeynes@10 | 21 | #include <string.h>
|
nkeynes@10 | 22 | #include <zlib.h>
|
nkeynes@10 | 23 | #include "dream.h"
|
nkeynes@10 | 24 | #include "mem.h"
|
nkeynes@10 | 25 | #include "mmio.h"
|
nkeynes@70 | 26 | #include "sh4core.h"
|
nkeynes@10 | 27 | #include "sh4mmio.h"
|
nkeynes@10 | 28 | #include "dreamcast.h"
|
nkeynes@100 | 29 | #include "pvr2/pvr2.h"
|
nkeynes@10 | 30 |
|
nkeynes@10 | 31 | #define OC_BASE 0x1C000000
|
nkeynes@10 | 32 | #define OC_TOP 0x20000000
|
nkeynes@10 | 33 |
|
nkeynes@90 | 34 | #define TRANSLATE_VIDEO_64BIT_ADDRESS(a) ( (((a)&0x00FFFFF8)>>1)|(((a)&0x00000004)<<20)|((a)&0x03)|0x05000000 )
|
nkeynes@10 | 35 |
|
nkeynes@10 | 36 | #ifdef ENABLE_WATCH
|
nkeynes@10 | 37 | #define CHECK_READ_WATCH( addr, size ) \
|
nkeynes@10 | 38 | if( mem_is_watched(addr,size,WATCH_READ) != NULL ) { \
|
nkeynes@10 | 39 | WARN( "Watch triggered at %08X by %d byte read", addr, size ); \
|
nkeynes@10 | 40 | dreamcast_stop(); \
|
nkeynes@10 | 41 | }
|
nkeynes@10 | 42 | #define CHECK_WRITE_WATCH( addr, size, val ) \
|
nkeynes@10 | 43 | if( mem_is_watched(addr,size,WATCH_WRITE) != NULL ) { \
|
nkeynes@10 | 44 | WARN( "Watch triggered at %08X by %d byte write <= %0*X", addr, size, size*2, val ); \
|
nkeynes@10 | 45 | dreamcast_stop(); \
|
nkeynes@10 | 46 | }
|
nkeynes@10 | 47 | #else
|
nkeynes@10 | 48 | #define CHECK_READ_WATCH( addr, size )
|
nkeynes@234 | 49 | #define CHECK_WRITE_WATCH( addr, size, val )
|
nkeynes@10 | 50 | #endif
|
nkeynes@10 | 51 |
|
nkeynes@406 | 52 | #ifdef ENABLE_TRACE_IO
|
nkeynes@172 | 53 | #define TRACE_IO( str, p, r, ... ) if(io_rgn[(uint32_t)p]->trace_flag && !MMIO_NOTRACE_BYNUM((uint32_t)p,r)) \
|
nkeynes@172 | 54 | TRACE( str " [%s.%s: %s]", __VA_ARGS__, \
|
nkeynes@10 | 55 | MMIO_NAME_BYNUM((uint32_t)p), MMIO_REGID_BYNUM((uint32_t)p, r), \
|
nkeynes@10 | 56 | MMIO_REGDESC_BYNUM((uint32_t)p, r) )
|
nkeynes@172 | 57 | #define TRACE_P4IO( str, io, r, ... ) if(io->trace_flag && !MMIO_NOTRACE_IOBYNUM(io,r)) \
|
nkeynes@156 | 58 | TRACE( str " [%s.%s: %s]", __VA_ARGS__, \
|
nkeynes@156 | 59 | io->id, MMIO_REGID_IOBYNUM(io, r), \
|
nkeynes@156 | 60 | MMIO_REGDESC_IOBYNUM(io, r) )
|
nkeynes@406 | 61 | #else
|
nkeynes@406 | 62 | #define TRACE_IO( str, p, r, ... )
|
nkeynes@406 | 63 | #define TRACE_P4IO( str, io, r, ... )
|
nkeynes@406 | 64 | #endif
|
nkeynes@10 | 65 |
|
nkeynes@10 | 66 | extern struct mem_region mem_rgn[];
|
nkeynes@10 | 67 | extern struct mmio_region *P4_io[];
|
nkeynes@10 | 68 |
|
nkeynes@10 | 69 | int32_t sh4_read_p4( uint32_t addr )
|
nkeynes@10 | 70 | {
|
nkeynes@10 | 71 | struct mmio_region *io = P4_io[(addr&0x1FFFFFFF)>>19];
|
nkeynes@10 | 72 | if( !io ) {
|
nkeynes@282 | 73 | if( (addr & 0xFF000000) != 0xF4000000 ) {
|
nkeynes@282 | 74 | /* OC address cache isn't implemented, but don't complain about it.
|
nkeynes@282 | 75 | * Complain about anything else though */
|
nkeynes@282 | 76 | ERROR( "Attempted read from unknown P4 region: %08X", addr );
|
nkeynes@282 | 77 | }
|
nkeynes@10 | 78 | return 0;
|
nkeynes@10 | 79 | } else {
|
nkeynes@156 | 80 | int32_t val = io->io_read( addr&0xFFF );
|
nkeynes@156 | 81 | TRACE_P4IO( "Long read %08X <= %08X", io, (addr&0xFFF), val, addr );
|
nkeynes@156 | 82 | return val;
|
nkeynes@10 | 83 | }
|
nkeynes@10 | 84 | }
|
nkeynes@10 | 85 |
|
nkeynes@10 | 86 | void sh4_write_p4( uint32_t addr, int32_t val )
|
nkeynes@10 | 87 | {
|
nkeynes@10 | 88 | struct mmio_region *io = P4_io[(addr&0x1FFFFFFF)>>19];
|
nkeynes@10 | 89 | if( !io ) {
|
nkeynes@10 | 90 | if( (addr & 0xFC000000) == 0xE0000000 ) {
|
nkeynes@10 | 91 | /* Store queue */
|
nkeynes@10 | 92 | SH4_WRITE_STORE_QUEUE( addr, val );
|
nkeynes@38 | 93 | } else if( (addr & 0xFF000000) != 0xF4000000 ) {
|
nkeynes@38 | 94 | /* OC address cache isn't implemented, but don't complain about it.
|
nkeynes@38 | 95 | * Complain about anything else though */
|
nkeynes@10 | 96 | ERROR( "Attempted write to unknown P4 region: %08X", addr );
|
nkeynes@10 | 97 | }
|
nkeynes@10 | 98 | } else {
|
nkeynes@156 | 99 | TRACE_P4IO( "Long write %08X => %08X", io, (addr&0xFFF), val, addr );
|
nkeynes@10 | 100 | io->io_write( addr&0xFFF, val );
|
nkeynes@10 | 101 | }
|
nkeynes@10 | 102 | }
|
nkeynes@10 | 103 |
|
nkeynes@10 | 104 | int32_t sh4_read_phys_word( uint32_t addr )
|
nkeynes@10 | 105 | {
|
nkeynes@10 | 106 | char *page;
|
nkeynes@83 | 107 | if( addr >= 0xE0000000 ) /* P4 Area, handled specially */
|
nkeynes@10 | 108 | return SIGNEXT16(sh4_read_p4( addr ));
|
nkeynes@10 | 109 |
|
nkeynes@10 | 110 | if( (addr&0x1F800000) == 0x04000000 ) {
|
nkeynes@10 | 111 | addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
|
nkeynes@10 | 112 | }
|
nkeynes@10 | 113 |
|
nkeynes@10 | 114 | page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 115 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 116 | if( page == NULL ) {
|
nkeynes@10 | 117 | ERROR( "Attempted word read to missing page: %08X",
|
nkeynes@10 | 118 | addr );
|
nkeynes@10 | 119 | return 0;
|
nkeynes@10 | 120 | }
|
nkeynes@10 | 121 | return SIGNEXT16(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
|
nkeynes@10 | 122 | } else {
|
nkeynes@10 | 123 | return SIGNEXT16(*(int16_t *)(page+(addr&0xFFF)));
|
nkeynes@10 | 124 | }
|
nkeynes@10 | 125 | }
|
nkeynes@10 | 126 |
|
nkeynes@10 | 127 | int32_t sh4_read_long( uint32_t addr )
|
nkeynes@10 | 128 | {
|
nkeynes@10 | 129 | char *page;
|
nkeynes@10 | 130 |
|
nkeynes@10 | 131 | CHECK_READ_WATCH(addr,4);
|
nkeynes@10 | 132 |
|
nkeynes@83 | 133 | if( addr >= 0xE0000000 ) /* P4 Area, handled specially */
|
nkeynes@10 | 134 | return sh4_read_p4( addr );
|
nkeynes@10 | 135 |
|
nkeynes@10 | 136 | if( (addr&0x1F800000) == 0x04000000 ) {
|
nkeynes@10 | 137 | addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
|
nkeynes@355 | 138 | pvr2_render_buffer_invalidate(addr, FALSE);
|
nkeynes@217 | 139 | } else if( (addr&0x1F800000) == 0x05000000 ) {
|
nkeynes@355 | 140 | pvr2_render_buffer_invalidate(addr, FALSE);
|
nkeynes@10 | 141 | }
|
nkeynes@10 | 142 |
|
nkeynes@10 | 143 | page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 144 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 145 | int32_t val;
|
nkeynes@10 | 146 | if( page == NULL ) {
|
nkeynes@10 | 147 | ERROR( "Attempted long read to missing page: %08X", addr );
|
nkeynes@10 | 148 | return 0;
|
nkeynes@10 | 149 | }
|
nkeynes@10 | 150 | val = io_rgn[(uint32_t)page]->io_read(addr&0xFFF);
|
nkeynes@10 | 151 | TRACE_IO( "Long read %08X <= %08X", page, (addr&0xFFF), val, addr );
|
nkeynes@10 | 152 | return val;
|
nkeynes@10 | 153 | } else {
|
nkeynes@10 | 154 | return *(int32_t *)(page+(addr&0xFFF));
|
nkeynes@10 | 155 | }
|
nkeynes@10 | 156 | }
|
nkeynes@10 | 157 |
|
nkeynes@10 | 158 | int32_t sh4_read_word( uint32_t addr )
|
nkeynes@10 | 159 | {
|
nkeynes@10 | 160 | char *page;
|
nkeynes@10 | 161 |
|
nkeynes@10 | 162 | CHECK_READ_WATCH(addr,2);
|
nkeynes@10 | 163 |
|
nkeynes@83 | 164 | if( addr >= 0xE0000000 ) /* P4 Area, handled specially */
|
nkeynes@10 | 165 | return SIGNEXT16(sh4_read_p4( addr ));
|
nkeynes@10 | 166 |
|
nkeynes@10 | 167 | if( (addr&0x1F800000) == 0x04000000 ) {
|
nkeynes@10 | 168 | addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
|
nkeynes@355 | 169 | pvr2_render_buffer_invalidate(addr, FALSE);
|
nkeynes@217 | 170 | } else if( (addr&0x1F800000) == 0x05000000 ) {
|
nkeynes@355 | 171 | pvr2_render_buffer_invalidate(addr, FALSE);
|
nkeynes@10 | 172 | }
|
nkeynes@217 | 173 |
|
nkeynes@10 | 174 | page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 175 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 176 | int32_t val;
|
nkeynes@10 | 177 | if( page == NULL ) {
|
nkeynes@10 | 178 | ERROR( "Attempted word read to missing page: %08X", addr );
|
nkeynes@10 | 179 | return 0;
|
nkeynes@10 | 180 | }
|
nkeynes@10 | 181 | val = SIGNEXT16(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
|
nkeynes@10 | 182 | TRACE_IO( "Word read %04X <= %08X", page, (addr&0xFFF), val&0xFFFF, addr );
|
nkeynes@10 | 183 | return val;
|
nkeynes@10 | 184 | } else {
|
nkeynes@10 | 185 | return SIGNEXT16(*(int16_t *)(page+(addr&0xFFF)));
|
nkeynes@10 | 186 | }
|
nkeynes@10 | 187 | }
|
nkeynes@10 | 188 |
|
nkeynes@10 | 189 | int32_t sh4_read_byte( uint32_t addr )
|
nkeynes@10 | 190 | {
|
nkeynes@10 | 191 | char *page;
|
nkeynes@10 | 192 |
|
nkeynes@10 | 193 | CHECK_READ_WATCH(addr,1);
|
nkeynes@10 | 194 |
|
nkeynes@83 | 195 | if( addr >= 0xE0000000 ) /* P4 Area, handled specially */
|
nkeynes@10 | 196 | return SIGNEXT8(sh4_read_p4( addr ));
|
nkeynes@10 | 197 | if( (addr&0x1F800000) == 0x04000000 ) {
|
nkeynes@10 | 198 | addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
|
nkeynes@355 | 199 | pvr2_render_buffer_invalidate(addr, FALSE);
|
nkeynes@217 | 200 | } else if( (addr&0x1F800000) == 0x05000000 ) {
|
nkeynes@355 | 201 | pvr2_render_buffer_invalidate(addr, FALSE);
|
nkeynes@10 | 202 | }
|
nkeynes@217 | 203 |
|
nkeynes@10 | 204 |
|
nkeynes@10 | 205 | page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 206 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 207 | int32_t val;
|
nkeynes@10 | 208 | if( page == NULL ) {
|
nkeynes@10 | 209 | ERROR( "Attempted byte read to missing page: %08X", addr );
|
nkeynes@10 | 210 | return 0;
|
nkeynes@10 | 211 | }
|
nkeynes@10 | 212 | val = SIGNEXT8(io_rgn[(uint32_t)page]->io_read(addr&0xFFF));
|
nkeynes@10 | 213 | TRACE_IO( "Byte read %02X <= %08X", page, (addr&0xFFF), val&0xFF, addr );
|
nkeynes@10 | 214 | return val;
|
nkeynes@10 | 215 | } else {
|
nkeynes@400 | 216 | // fprintf( stderr, "MOV.B %02X <= %08X\n",(uint32_t)*(uint8_t *)(page+(addr&0xFFF)), addr );
|
nkeynes@10 | 217 | return SIGNEXT8(*(int8_t *)(page+(addr&0xFFF)));
|
nkeynes@10 | 218 | }
|
nkeynes@10 | 219 | }
|
nkeynes@10 | 220 |
|
nkeynes@10 | 221 | void sh4_write_long( uint32_t addr, uint32_t val )
|
nkeynes@10 | 222 | {
|
nkeynes@10 | 223 | char *page;
|
nkeynes@400 | 224 |
|
nkeynes@400 | 225 | // fprintf( stderr, "MOV.L %08X => %08X\n", val, addr );
|
nkeynes@10 | 226 | CHECK_WRITE_WATCH(addr,4,val);
|
nkeynes@10 | 227 |
|
nkeynes@83 | 228 | if( addr >= 0xE0000000 ) {
|
nkeynes@10 | 229 | sh4_write_p4( addr, val );
|
nkeynes@10 | 230 | return;
|
nkeynes@10 | 231 | }
|
nkeynes@130 | 232 | if( (addr&0x1F800000) == 0x04000000 ||
|
nkeynes@130 | 233 | (addr&0x1F800000) == 0x11000000 ) {
|
nkeynes@150 | 234 | texcache_invalidate_page(addr& 0x7FFFFF);
|
nkeynes@10 | 235 | addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
|
nkeynes@355 | 236 | pvr2_render_buffer_invalidate(addr, TRUE);
|
nkeynes@165 | 237 | } else if( (addr&0x1F800000) == 0x05000000 ) {
|
nkeynes@355 | 238 | pvr2_render_buffer_invalidate(addr, TRUE);
|
nkeynes@10 | 239 | }
|
nkeynes@10 | 240 |
|
nkeynes@10 | 241 | if( (addr&0x1FFFFFFF) < 0x200000 ) {
|
nkeynes@10 | 242 | ERROR( "Attempted write to read-only memory: %08X => %08X", val, addr);
|
nkeynes@10 | 243 | sh4_stop();
|
nkeynes@10 | 244 | return;
|
nkeynes@10 | 245 | }
|
nkeynes@137 | 246 | if( (addr&0x1F800000) == 0x00800000 )
|
nkeynes@137 | 247 | asic_g2_write_word();
|
nkeynes@137 | 248 |
|
nkeynes@10 | 249 | page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 250 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 251 | if( page == NULL ) {
|
nkeynes@137 | 252 | if( (addr & 0x1F000000) >= 0x04000000 &&
|
nkeynes@137 | 253 | (addr & 0x1F000000) < 0x07000000 )
|
nkeynes@137 | 254 | return;
|
nkeynes@10 | 255 | ERROR( "Long write to missing page: %08X => %08X", val, addr );
|
nkeynes@10 | 256 | return;
|
nkeynes@10 | 257 | }
|
nkeynes@10 | 258 | TRACE_IO( "Long write %08X => %08X", page, (addr&0xFFF), val, addr );
|
nkeynes@10 | 259 | io_rgn[(uint32_t)page]->io_write(addr&0xFFF, val);
|
nkeynes@10 | 260 | } else {
|
nkeynes@400 | 261 | xlat_invalidate_long(addr);
|
nkeynes@10 | 262 | *(uint32_t *)(page+(addr&0xFFF)) = val;
|
nkeynes@10 | 263 | }
|
nkeynes@10 | 264 | }
|
nkeynes@10 | 265 |
|
nkeynes@10 | 266 | void sh4_write_word( uint32_t addr, uint32_t val )
|
nkeynes@10 | 267 | {
|
nkeynes@10 | 268 | char *page;
|
nkeynes@10 | 269 |
|
nkeynes@400 | 270 | // fprintf( stderr, "MOV.W %04X => %08X\n", val, addr );
|
nkeynes@10 | 271 | CHECK_WRITE_WATCH(addr,2,val);
|
nkeynes@10 | 272 |
|
nkeynes@83 | 273 | if( addr >= 0xE0000000 ) {
|
nkeynes@10 | 274 | sh4_write_p4( addr, (int16_t)val );
|
nkeynes@10 | 275 | return;
|
nkeynes@10 | 276 | }
|
nkeynes@130 | 277 | if( (addr&0x1F800000) == 0x04000000 ||
|
nkeynes@130 | 278 | (addr&0x1F800000) == 0x11000000 ) {
|
nkeynes@150 | 279 | texcache_invalidate_page(addr& 0x7FFFFF);
|
nkeynes@10 | 280 | addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
|
nkeynes@355 | 281 | pvr2_render_buffer_invalidate(addr, TRUE);
|
nkeynes@165 | 282 | } else if( (addr&0x1F800000) == 0x05000000 ) {
|
nkeynes@355 | 283 | pvr2_render_buffer_invalidate(addr, TRUE);
|
nkeynes@10 | 284 | }
|
nkeynes@406 | 285 |
|
nkeynes@400 | 286 | if( (addr&0x1FFFFFFF) < 0x200000 ) {
|
nkeynes@400 | 287 | ERROR( "Attempted write to read-only memory: %08X => %08X", val, addr);
|
nkeynes@400 | 288 | sh4_stop();
|
nkeynes@400 | 289 | return;
|
nkeynes@400 | 290 | }
|
nkeynes@10 | 291 | page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 292 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 293 | if( page == NULL ) {
|
nkeynes@10 | 294 | ERROR( "Attempted word write to missing page: %08X", addr );
|
nkeynes@10 | 295 | return;
|
nkeynes@10 | 296 | }
|
nkeynes@10 | 297 | TRACE_IO( "Word write %04X => %08X", page, (addr&0xFFF), val&0xFFFF, addr );
|
nkeynes@10 | 298 | io_rgn[(uint32_t)page]->io_write(addr&0xFFF, val);
|
nkeynes@10 | 299 | } else {
|
nkeynes@400 | 300 | xlat_invalidate_word(addr);
|
nkeynes@10 | 301 | *(uint16_t *)(page+(addr&0xFFF)) = val;
|
nkeynes@10 | 302 | }
|
nkeynes@10 | 303 | }
|
nkeynes@10 | 304 |
|
nkeynes@10 | 305 | void sh4_write_byte( uint32_t addr, uint32_t val )
|
nkeynes@10 | 306 | {
|
nkeynes@10 | 307 | char *page;
|
nkeynes@10 | 308 |
|
nkeynes@400 | 309 | // fprintf( stderr, "MOV.B %02X => %08X\n", val, addr );
|
nkeynes@10 | 310 | CHECK_WRITE_WATCH(addr,1,val);
|
nkeynes@10 | 311 |
|
nkeynes@83 | 312 | if( addr >= 0xE0000000 ) {
|
nkeynes@10 | 313 | sh4_write_p4( addr, (int8_t)val );
|
nkeynes@10 | 314 | return;
|
nkeynes@10 | 315 | }
|
nkeynes@130 | 316 | if( (addr&0x1F800000) == 0x04000000 ||
|
nkeynes@130 | 317 | (addr&0x1F800000) == 0x11000000 ) {
|
nkeynes@150 | 318 | texcache_invalidate_page(addr& 0x7FFFFF);
|
nkeynes@10 | 319 | addr = TRANSLATE_VIDEO_64BIT_ADDRESS(addr);
|
nkeynes@355 | 320 | pvr2_render_buffer_invalidate(addr, TRUE);
|
nkeynes@165 | 321 | } else if( (addr&0x1F800000) == 0x05000000 ) {
|
nkeynes@355 | 322 | pvr2_render_buffer_invalidate(addr, TRUE);
|
nkeynes@10 | 323 | }
|
nkeynes@10 | 324 |
|
nkeynes@400 | 325 | if( (addr&0x1FFFFFFF) < 0x200000 ) {
|
nkeynes@400 | 326 | ERROR( "Attempted write to read-only memory: %08X => %08X", val, addr);
|
nkeynes@400 | 327 | sh4_stop();
|
nkeynes@400 | 328 | return;
|
nkeynes@400 | 329 | }
|
nkeynes@10 | 330 | page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 331 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 332 | if( page == NULL ) {
|
nkeynes@10 | 333 | ERROR( "Attempted byte write to missing page: %08X", addr );
|
nkeynes@10 | 334 | return;
|
nkeynes@10 | 335 | }
|
nkeynes@10 | 336 | TRACE_IO( "Byte write %02X => %08X", page, (addr&0xFFF), val&0xFF, addr );
|
nkeynes@10 | 337 | io_rgn[(uint32_t)page]->io_write( (addr&0xFFF), val);
|
nkeynes@10 | 338 | } else {
|
nkeynes@400 | 339 | xlat_invalidate_word(addr);
|
nkeynes@10 | 340 | *(uint8_t *)(page+(addr&0xFFF)) = val;
|
nkeynes@10 | 341 | }
|
nkeynes@10 | 342 | }
|
nkeynes@10 | 343 |
|
nkeynes@10 | 344 |
|
nkeynes@10 | 345 |
|
nkeynes@10 | 346 | /* FIXME: Handle all the many special cases when the range doesn't fall cleanly
|
nkeynes@400 | 347 | * into the same memory block
|
nkeynes@10 | 348 | */
|
nkeynes@10 | 349 | void mem_copy_from_sh4( char *dest, uint32_t srcaddr, size_t count ) {
|
nkeynes@103 | 350 | if( srcaddr >= 0x04000000 && srcaddr < 0x05000000 ) {
|
nkeynes@103 | 351 | pvr2_vram64_read( dest, srcaddr, count );
|
nkeynes@103 | 352 | } else {
|
nkeynes@103 | 353 | char *src = mem_get_region(srcaddr);
|
nkeynes@103 | 354 | if( src == NULL ) {
|
nkeynes@103 | 355 | ERROR( "Attempted block read from unknown address %08X", srcaddr );
|
nkeynes@103 | 356 | } else {
|
nkeynes@103 | 357 | memcpy( dest, src, count );
|
nkeynes@103 | 358 | }
|
nkeynes@103 | 359 | }
|
nkeynes@10 | 360 | }
|
nkeynes@10 | 361 |
|
nkeynes@10 | 362 | void mem_copy_to_sh4( uint32_t destaddr, char *src, size_t count ) {
|
nkeynes@325 | 363 | int region;
|
nkeynes@325 | 364 |
|
nkeynes@325 | 365 | if( destaddr >= 0x10000000 && destaddr < 0x14000000 ) {
|
nkeynes@325 | 366 | pvr2_dma_write( destaddr, src, count );
|
nkeynes@325 | 367 | return;
|
nkeynes@325 | 368 | } else if( (destaddr & 0x1F800000) == 0x05000000 ) {
|
nkeynes@355 | 369 | pvr2_render_buffer_invalidate( destaddr, TRUE );
|
nkeynes@325 | 370 | } else if( (destaddr & 0x1F800000) == 0x04000000 ) {
|
nkeynes@103 | 371 | pvr2_vram64_write( destaddr, src, count );
|
nkeynes@325 | 372 | return;
|
nkeynes@325 | 373 | }
|
nkeynes@325 | 374 | char *dest = mem_get_region(destaddr);
|
nkeynes@325 | 375 | if( dest == NULL )
|
nkeynes@325 | 376 | ERROR( "Attempted block write to unknown address %08X", destaddr );
|
nkeynes@325 | 377 | else {
|
nkeynes@400 | 378 | xlat_invalidate_block( destaddr, count );
|
nkeynes@325 | 379 | memcpy( dest, src, count );
|
nkeynes@90 | 380 | }
|
nkeynes@10 | 381 | }
|
nkeynes@369 | 382 |
|
nkeynes@369 | 383 | void sh4_flush_store_queue( uint32_t addr )
|
nkeynes@369 | 384 | {
|
nkeynes@369 | 385 | /* Store queue operation */
|
nkeynes@369 | 386 | int queue = (addr&0x20)>>2;
|
nkeynes@371 | 387 | char *src = (char *)&sh4r.store_queue[queue];
|
nkeynes@369 | 388 | uint32_t hi = (MMIO_READ( MMU, (queue == 0 ? QACR0 : QACR1) ) & 0x1C) << 24;
|
nkeynes@369 | 389 | uint32_t target = addr&0x03FFFFE0 | hi;
|
nkeynes@369 | 390 | mem_copy_to_sh4( target, src, 32 );
|
nkeynes@369 | 391 | }
|