filename | src/mem.c |
changeset | 825:2ac7ceccd775 |
prev | 796:a2dc83592467 |
next | 929:fd8cb0c82f5f |
next | 953:f4a156508ad1 |
author | nkeynes |
date | Fri Oct 31 02:57:59 2008 +0000 (15 years ago) |
permissions | -rw-r--r-- |
last change | Declare mem_copy_* functions as FASTCALL Split sh4_flush_store_queue into TLB/non-TLB versions, and optimize slightly based on that |
view | annotate | diff | log | raw |
1 /**
2 * $Id$
3 * mem.c is responsible for creating and maintaining the overall system memory
4 * map, as visible from the SH4 processor.
5 *
6 * Copyright (c) 2005 Nathan Keynes.
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 */
18 #define MODULE mem_module
20 #include <sys/types.h>
21 #include <sys/mman.h>
22 #include <sys/stat.h>
23 #include <glib/gstrfuncs.h>
24 #include <assert.h>
25 #include <stdint.h>
26 #include <stdlib.h>
27 #include <stdio.h>
28 #include <unistd.h>
29 #include <fcntl.h>
30 #include <errno.h>
31 #include <string.h>
32 #include <zlib.h>
33 #include "dream.h"
34 #include "mem.h"
35 #include "mmio.h"
36 #include "dreamcast.h"
38 sh4ptr_t *page_map = NULL;
40 int mem_load(FILE *f);
41 void mem_save(FILE *f);
42 struct dreamcast_module mem_module =
43 { "MEM", mem_init, mem_reset, NULL, NULL, NULL, mem_save, mem_load };
45 struct mem_region mem_rgn[MAX_MEM_REGIONS];
46 struct mmio_region *io_rgn[MAX_IO_REGIONS];
47 struct mmio_region *P4_io[4096];
49 uint32_t num_io_rgns = 0, num_mem_rgns = 0;
51 void *mem_alloc_pages( int n )
52 {
53 void *mem = mmap( NULL, n * 4096,
54 PROT_READ|PROT_WRITE, MAP_ANON|MAP_PRIVATE, -1, 0 );
55 if( mem == MAP_FAILED ) {
56 ERROR( "Memory allocation failure! (%s)", strerror(errno) );
57 return NULL;
58 }
59 return mem;
60 }
63 void mem_init( void )
64 {
65 page_map = mmap( NULL, sizeof(sh4ptr_t) * LXDREAM_PAGE_TABLE_ENTRIES,
66 PROT_READ|PROT_WRITE, MAP_ANON|MAP_PRIVATE, -1, 0 );
67 if( page_map == MAP_FAILED ) {
68 ERROR( "Unable to allocate page map! (%s)", strerror(errno) );
69 page_map = NULL;
70 return;
71 }
73 memset( page_map, 0, sizeof(sh4ptr_t) * LXDREAM_PAGE_TABLE_ENTRIES );
74 }
76 void mem_reset( void )
77 {
78 /* Restore all mmio registers to their initial settings */
79 int i, j;
80 for( i=1; i<num_io_rgns; i++ ) {
81 for( j=0; io_rgn[i]->ports[j].id != NULL; j++ ) {
82 if( io_rgn[i]->ports[j].def_val != UNDEFINED &&
83 io_rgn[i]->ports[j].def_val != *io_rgn[i]->ports[j].val ) {
84 io_rgn[i]->io_write( io_rgn[i]->ports[j].offset,
85 io_rgn[i]->ports[j].def_val );
86 }
87 }
88 }
89 }
91 void mem_save( FILE *f )
92 {
93 int i;
94 uint32_t len;
96 /* All memory regions */
97 fwrite( &num_mem_rgns, sizeof(num_mem_rgns), 1, f );
98 for( i=0; i<num_mem_rgns; i++ ) {
99 fwrite_string( mem_rgn[i].name, f );
100 fwrite( &mem_rgn[i].base, sizeof(uint32_t), 1, f );
101 fwrite( &mem_rgn[i].flags, sizeof(uint32_t), 1, f );
102 fwrite( &mem_rgn[i].size, sizeof(uint32_t), 1, f );
103 if( mem_rgn[i].flags != MEM_FLAG_ROM )
104 fwrite_gzip( mem_rgn[i].mem, mem_rgn[i].size, 1, f );
105 }
107 /* All MMIO regions */
108 fwrite( &num_io_rgns, sizeof(num_io_rgns), 1, f );
109 for( i=0; i<num_io_rgns; i++ ) {
110 fwrite_string( io_rgn[i]->id, f );
111 fwrite( &io_rgn[i]->base, sizeof( uint32_t ), 1, f );
112 len = 4096;
113 fwrite( &len, sizeof(len), 1, f );
114 fwrite_gzip( io_rgn[i]->mem, len, 1, f );
115 }
116 }
118 int mem_load( FILE *f )
119 {
120 char tmp[64];
121 uint32_t len;
122 uint32_t base, size;
123 uint32_t flags;
124 int i;
126 /* All memory regions */
127 fread( &len, sizeof(len), 1, f );
128 if( len != num_mem_rgns )
129 return -1;
130 for( i=0; i<len; i++ ) {
131 fread_string( tmp, sizeof(tmp), f );
132 fread( &base, sizeof(base), 1, f );
133 fread( &flags, sizeof(flags), 1, f );
134 fread( &size, sizeof(size), 1, f );
135 if( strcmp( mem_rgn[i].name, tmp ) != 0 ||
136 base != mem_rgn[i].base ||
137 flags != mem_rgn[i].flags ||
138 size != mem_rgn[i].size ) {
139 ERROR( "Bad memory region %d %s", i, tmp );
140 return -1;
141 }
142 if( flags != MEM_FLAG_ROM )
143 fread_gzip( mem_rgn[i].mem, size, 1, f );
144 }
146 /* All MMIO regions */
147 fread( &len, sizeof(len), 1, f );
148 if( len != num_io_rgns )
149 return -1;
150 for( i=0; i<len; i++ ) {
151 fread_string( tmp, sizeof(tmp), f );
152 fread( &base, sizeof(base), 1, f );
153 fread( &size, sizeof(size), 1, f );
154 if( strcmp( io_rgn[i]->id, tmp ) != 0 ||
155 base != io_rgn[i]->base ||
156 size != 4096 ) {
157 ERROR( "Bad MMIO region %d %s", i, tmp );
158 return -1;
159 }
160 fread_gzip( io_rgn[i]->mem, size, 1, f );
161 }
162 return 0;
163 }
165 int mem_save_block( const gchar *file, uint32_t start, uint32_t length )
166 {
167 sh4ptr_t region;
168 int len = 4096, total = 0;
169 uint32_t addr = start;
170 FILE *f = fopen(file,"w");
172 if( f == NULL )
173 return errno;
175 while( total < length ) {
176 region = mem_get_region(addr);
177 len = 4096 - (addr & 0x0FFF);
178 if( len > (length-total) )
179 len = (length-total);
180 if( fwrite( region, len, 1, f ) != 1 ) {
181 ERROR( "Unexpected error writing blocks: %d (%s)", len, strerror(errno) );
182 break;
183 }
185 addr += len;
186 total += len;
187 }
188 fclose( f );
189 INFO( "Saved %d of %d bytes to %08X", total, length, start );
190 return 0;
191 }
193 int mem_load_block( const gchar *file, uint32_t start, uint32_t length )
194 {
195 sh4ptr_t region;
196 int len = 4096, total = 0;
197 uint32_t addr = start;
198 struct stat st;
199 FILE *f = fopen(file,"r");
201 if( f == NULL ) {
202 WARN( "Unable to load file '%s': %s", file, strerror(errno) );
203 return -1;
204 }
205 fstat( fileno(f), &st );
206 if( length == 0 || length == -1 || length > st.st_size )
207 length = st.st_size;
209 while( total < length ) {
210 region = mem_get_region(addr);
211 len = 4096 - (addr & 0x0FFF);
212 if( len > (length-total) )
213 len = (length-total);
214 if( fread( region, len, 1, f ) != 1 ) {
215 ERROR( "Unexpected error reading: %d (%s)", len, strerror(errno) );
216 break;
217 }
219 addr += len;
220 total += len;
221 }
222 fclose( f );
223 INFO( "Loaded %d of %d bytes to %08X", total, length, start );
224 return 0;
225 }
227 struct mem_region *mem_map_region( void *mem, uint32_t base, uint32_t size,
228 const char *name, int flags, uint32_t repeat_offset,
229 uint32_t repeat_until )
230 {
231 int i;
232 mem_rgn[num_mem_rgns].base = base;
233 mem_rgn[num_mem_rgns].size = size;
234 mem_rgn[num_mem_rgns].flags = flags;
235 mem_rgn[num_mem_rgns].name = name;
236 mem_rgn[num_mem_rgns].mem = mem;
237 num_mem_rgns++;
239 do {
240 for( i=0; i<size>>LXDREAM_PAGE_BITS; i++ )
241 page_map[(base>>LXDREAM_PAGE_BITS)+i] = mem + (i<<LXDREAM_PAGE_BITS);
242 base += repeat_offset;
243 } while( base <= repeat_until );
245 return &mem_rgn[num_mem_rgns-1];
246 }
248 void *mem_create_ram_region( uint32_t base, uint32_t size, const char *name )
249 {
250 return mem_create_repeating_ram_region( base, size, name, size, base );
251 }
253 void *mem_create_repeating_ram_region( uint32_t base, uint32_t size, const char *name,
254 uint32_t repeat_offset, uint32_t repeat_until )
255 {
256 char *mem;
258 assert( (base&0xFFFFF000) == base ); /* must be page aligned */
259 assert( (size&0x00000FFF) == 0 );
260 assert( num_mem_rgns < MAX_MEM_REGIONS );
261 assert( page_map != NULL );
263 mem = mem_alloc_pages( size>>LXDREAM_PAGE_BITS );
265 mem_map_region( mem, base, size, name, MEM_FLAG_RAM, repeat_offset, repeat_until );
267 return mem;
268 }
270 gboolean mem_load_rom( const gchar *file, uint32_t base, uint32_t size, uint32_t crc,
271 const gchar *region_name )
272 {
273 sh4ptr_t mem;
274 uint32_t calc_crc;
275 int status;
277 mem = mem_get_region(base);
278 if( mem == NULL ) {
279 mem = mmap( NULL, size, PROT_WRITE|PROT_READ, MAP_ANON|MAP_PRIVATE, -1, 0 );
280 if( mem == MAP_FAILED ) {
281 ERROR( "Unable to allocate ROM memory: %s (%s)", file, strerror(errno) );
282 return FALSE;
283 }
284 mem_map_region( mem, base, size, region_name, MEM_FLAG_ROM, size, base );
285 } else {
286 mprotect( mem, size, PROT_READ|PROT_WRITE );
287 }
289 if( file != NULL && file[0] != '\0' ) {
290 status = mem_load_block( file, base, size );
291 mprotect( mem, size, PROT_READ );
293 if( status == 0 ) {
294 /* CRC check only if we loaded something */
295 calc_crc = crc32(0L, (sh4ptr_t)mem, size);
296 if( calc_crc != crc ) {
297 WARN( "Bios CRC Mismatch in %s: %08X (expected %08X)",
298 file, calc_crc, crc);
299 }
300 return TRUE;
301 }
302 }
303 return FALSE;
304 }
306 sh4ptr_t mem_get_region_by_name( const char *name )
307 {
308 int i;
309 for( i=0; i<num_mem_rgns; i++ ) {
310 if( strcmp( mem_rgn[i].name, name ) == 0 )
311 return mem_rgn[i].mem;
312 }
313 return NULL;
314 }
316 void register_io_region( struct mmio_region *io )
317 {
318 int i;
320 assert(io);
321 io->mem = mem_alloc_pages(2);
322 io->save_mem = io->mem + LXDREAM_PAGE_SIZE;
323 io->index = (struct mmio_port **)malloc(1024*sizeof(struct mmio_port *));
324 io->trace_flag = 0;
325 memset( io->index, 0, 1024*sizeof(struct mmio_port *) );
326 for( i=0; io->ports[i].id != NULL; i++ ) {
327 io->ports[i].val = (uint32_t *)(io->mem + io->ports[i].offset);
328 *io->ports[i].val = io->ports[i].def_val;
329 io->index[io->ports[i].offset>>2] = &io->ports[i];
330 }
331 memcpy( io->save_mem, io->mem, LXDREAM_PAGE_SIZE );
332 if( (io->base & 0xFF000000) == 0xFF000000 ) {
333 /* P4 area (on-chip I/O channels */
334 P4_io[(io->base&0x1FFFFFFF)>>19] = io;
335 } else {
336 page_map[io->base>>12] = (sh4ptr_t)(uintptr_t)num_io_rgns;
337 }
338 io_rgn[num_io_rgns] = io;
339 num_io_rgns++;
340 }
342 void register_io_regions( struct mmio_region **io )
343 {
344 while( *io ) register_io_region( *io++ );
345 }
347 int mem_has_page( uint32_t addr )
348 {
349 sh4ptr_t page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
350 return page != NULL;
351 }
353 sh4ptr_t mem_get_page( uint32_t addr )
354 {
355 sh4ptr_t page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
356 return page;
357 }
359 sh4ptr_t mem_get_region( uint32_t addr )
360 {
361 sh4ptr_t page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
362 if( ((uintptr_t)page) < MAX_IO_REGIONS ) { /* IO Region */
363 return NULL;
364 } else {
365 return page+(addr&0xFFF);
366 }
367 }
369 void mem_write_long( sh4addr_t addr, uint32_t value )
370 {
371 sh4ptr_t ptr = mem_get_region(addr);
372 assert(ptr != NULL);
373 *((uint32_t *)ptr) = value;
374 }
376 struct mmio_region *mem_get_io_region( uint32_t addr )
377 {
378 if( addr > 0xFF000000 ) {
379 return P4_io[(addr&0x00FFFFFF)>>12];
380 }
381 sh4ptr_t page = page_map[(addr&0x1FFFFFFF)>>12];
382 if( ((uintptr_t)page) < MAX_IO_REGIONS ) {
383 return io_rgn[(uintptr_t)page];
384 } else {
385 return NULL;
386 }
387 }
389 struct mmio_region *mem_get_io_region_by_name( const gchar *name )
390 {
391 int i;
392 for( i=0; i<num_io_rgns; i++ ) {
393 if( strcasecmp(io_rgn[i]->id, name) == 0 ) {
394 return io_rgn[i];
395 }
396 }
397 return NULL;
398 }
400 void mem_set_trace( const gchar *tracelist, gboolean flag )
401 {
402 if( tracelist != NULL ) {
403 gchar ** tracev = g_strsplit_set( tracelist, ",:; \t\r\n", 0 );
404 int i;
405 for( i=0; tracev[i] != NULL; i++ ) {
406 // Special case "all" - trace everything
407 if( strcasecmp(tracev[i], "all") == 0 ) {
408 int j;
409 for( j=0; j<num_io_rgns; j++ ) {
410 io_rgn[j]->trace_flag = flag ? 1 : 0;
411 }
412 break;
413 }
414 struct mmio_region *region = mem_get_io_region_by_name( tracev[i] );
415 if( region == NULL ) {
416 WARN( "Unknown IO region '%s'", tracev[i] );
417 } else {
418 region->trace_flag = flag ? 1 : 0;
419 }
420 }
421 g_strfreev( tracev );
422 }
423 }
.