nkeynes@10 | 1 | /**
|
nkeynes@17 | 2 | * $Id: mem.c,v 1.4 2005-12-13 14:47:59 nkeynes Exp $
|
nkeynes@10 | 3 | * mem.c is responsible for creating and maintaining the overall system memory
|
nkeynes@10 | 4 | * map, as visible from the SH4 processor.
|
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@10 | 19 | #include <sys/mman.h>
|
nkeynes@10 | 20 | #include <assert.h>
|
nkeynes@10 | 21 | #include <stdint.h>
|
nkeynes@10 | 22 | #include <stdlib.h>
|
nkeynes@10 | 23 | #include <stdio.h>
|
nkeynes@10 | 24 | #include <unistd.h>
|
nkeynes@10 | 25 | #include <fcntl.h>
|
nkeynes@10 | 26 | #include <errno.h>
|
nkeynes@10 | 27 | #include <string.h>
|
nkeynes@10 | 28 | #include <zlib.h>
|
nkeynes@10 | 29 | #include "dream.h"
|
nkeynes@10 | 30 | #include "mem.h"
|
nkeynes@10 | 31 | #include "mmio.h"
|
nkeynes@15 | 32 | #include "modules.h"
|
nkeynes@10 | 33 | #include "dreamcast.h"
|
nkeynes@10 | 34 |
|
nkeynes@10 | 35 | char **page_map = NULL;
|
nkeynes@10 | 36 |
|
nkeynes@17 | 37 | int mem_load(FILE *f);
|
nkeynes@17 | 38 | void mem_save(FILE *f);
|
nkeynes@15 | 39 | struct dreamcast_module mem_module =
|
nkeynes@17 | 40 | { "MEM", mem_init, mem_reset, NULL, NULL, mem_save, mem_load };
|
nkeynes@15 | 41 |
|
nkeynes@10 | 42 | struct mem_region mem_rgn[MAX_MEM_REGIONS];
|
nkeynes@10 | 43 | struct mmio_region *io_rgn[MAX_IO_REGIONS];
|
nkeynes@10 | 44 | struct mmio_region *P4_io[4096];
|
nkeynes@10 | 45 |
|
nkeynes@10 | 46 | int num_io_rgns = 1, num_mem_rgns = 0;
|
nkeynes@10 | 47 |
|
nkeynes@10 | 48 | void *mem_alloc_pages( int n )
|
nkeynes@10 | 49 | {
|
nkeynes@10 | 50 | void *mem = mmap( NULL, n * 4096,
|
nkeynes@10 | 51 | PROT_READ|PROT_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, -1, 0 );
|
nkeynes@10 | 52 | if( mem == MAP_FAILED ) {
|
nkeynes@10 | 53 | ERROR( "Memory allocation failure! (%s)", strerror(errno) );
|
nkeynes@10 | 54 | return NULL;
|
nkeynes@10 | 55 | }
|
nkeynes@10 | 56 | return mem;
|
nkeynes@10 | 57 | }
|
nkeynes@10 | 58 |
|
nkeynes@10 | 59 |
|
nkeynes@10 | 60 | void mem_init( void )
|
nkeynes@10 | 61 | {
|
nkeynes@10 | 62 | page_map = mmap( NULL, sizeof(char *) * PAGE_TABLE_ENTRIES,
|
nkeynes@10 | 63 | PROT_READ|PROT_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, -1, 0 );
|
nkeynes@10 | 64 | if( page_map == MAP_FAILED ) {
|
nkeynes@10 | 65 | ERROR( "Unable to allocate page map! (%s)", strerror(errno) );
|
nkeynes@10 | 66 | page_map = NULL;
|
nkeynes@10 | 67 | return;
|
nkeynes@10 | 68 | }
|
nkeynes@10 | 69 |
|
nkeynes@10 | 70 | memset( page_map, 0, sizeof(uint32_t) * PAGE_TABLE_ENTRIES );
|
nkeynes@10 | 71 | }
|
nkeynes@10 | 72 |
|
nkeynes@10 | 73 | void mem_reset( void )
|
nkeynes@10 | 74 | {
|
nkeynes@10 | 75 | /* Restore all mmio registers to their initial settings */
|
nkeynes@10 | 76 | int i, j;
|
nkeynes@10 | 77 | for( i=1; i<num_io_rgns; i++ ) {
|
nkeynes@10 | 78 | for( j=0; io_rgn[i]->ports[j].id != NULL; j++ ) {
|
nkeynes@10 | 79 | if( io_rgn[i]->ports[j].def_val != UNDEFINED &&
|
nkeynes@10 | 80 | io_rgn[i]->ports[j].def_val != *io_rgn[i]->ports[j].val ) {
|
nkeynes@10 | 81 | io_rgn[i]->io_write( io_rgn[i]->ports[j].offset,
|
nkeynes@10 | 82 | io_rgn[i]->ports[j].def_val );
|
nkeynes@10 | 83 | }
|
nkeynes@10 | 84 | }
|
nkeynes@10 | 85 | }
|
nkeynes@10 | 86 | }
|
nkeynes@10 | 87 |
|
nkeynes@17 | 88 | void mem_save( FILE *f )
|
nkeynes@17 | 89 | {
|
nkeynes@17 | 90 | int i;
|
nkeynes@17 | 91 | uint32_t len;
|
nkeynes@17 | 92 |
|
nkeynes@17 | 93 | /* All memory regions */
|
nkeynes@17 | 94 | fwrite( &num_mem_rgns, sizeof(num_mem_rgns), 1, f );
|
nkeynes@17 | 95 | for( i=0; i<num_mem_rgns; i++ ) {
|
nkeynes@17 | 96 | fwrite_string( mem_rgn[i].name, f );
|
nkeynes@17 | 97 | fwrite( &mem_rgn[i].base, sizeof(uint32_t), 1, f );
|
nkeynes@17 | 98 | fwrite( &mem_rgn[i].flags, sizeof(int), 1, f );
|
nkeynes@17 | 99 | fwrite( &mem_rgn[i].size, sizeof(uint32_t), 1, f );
|
nkeynes@17 | 100 | fwrite( mem_rgn[i].mem, mem_rgn[i].size, 1, f );
|
nkeynes@17 | 101 | }
|
nkeynes@17 | 102 |
|
nkeynes@17 | 103 | /* All MMIO regions */
|
nkeynes@17 | 104 | fwrite( &num_io_rgns, sizeof(num_io_rgns), 1, f );
|
nkeynes@17 | 105 | for( i=0; i<num_io_rgns; i++ ) {
|
nkeynes@17 | 106 | fwrite_string( io_rgn[i]->id, f );
|
nkeynes@17 | 107 | fwrite( &io_rgn[i]->base, sizeof( uint32_t ), 1, f );
|
nkeynes@17 | 108 | fwrite( io_rgn[i]->mem, 4096, 1, f );
|
nkeynes@17 | 109 | }
|
nkeynes@17 | 110 | }
|
nkeynes@17 | 111 |
|
nkeynes@17 | 112 | int mem_load( FILE *f )
|
nkeynes@17 | 113 | {
|
nkeynes@17 | 114 | char tmp[64];
|
nkeynes@17 | 115 | uint32_t len;
|
nkeynes@17 | 116 | int i;
|
nkeynes@17 | 117 |
|
nkeynes@17 | 118 | /* All memory regions */
|
nkeynes@17 | 119 |
|
nkeynes@17 | 120 | }
|
nkeynes@17 | 121 |
|
nkeynes@10 | 122 | struct mem_region *mem_map_region( void *mem, uint32_t base, uint32_t size,
|
nkeynes@10 | 123 | char *name, int flags )
|
nkeynes@10 | 124 | {
|
nkeynes@10 | 125 | int i;
|
nkeynes@10 | 126 | mem_rgn[num_mem_rgns].base = base;
|
nkeynes@10 | 127 | mem_rgn[num_mem_rgns].size = size;
|
nkeynes@10 | 128 | mem_rgn[num_mem_rgns].flags = flags;
|
nkeynes@10 | 129 | mem_rgn[num_mem_rgns].name = name;
|
nkeynes@10 | 130 | mem_rgn[num_mem_rgns].mem = mem;
|
nkeynes@10 | 131 | num_mem_rgns++;
|
nkeynes@10 | 132 |
|
nkeynes@10 | 133 | for( i=0; i<size>>PAGE_BITS; i++ )
|
nkeynes@10 | 134 | page_map[(base>>PAGE_BITS)+i] = mem + (i<<PAGE_BITS);
|
nkeynes@10 | 135 |
|
nkeynes@10 | 136 | return &mem_rgn[num_mem_rgns-1];
|
nkeynes@10 | 137 | }
|
nkeynes@10 | 138 |
|
nkeynes@10 | 139 | void *mem_create_ram_region( uint32_t base, uint32_t size, char *name )
|
nkeynes@10 | 140 | {
|
nkeynes@10 | 141 | char *mem;
|
nkeynes@10 | 142 |
|
nkeynes@10 | 143 | assert( (base&0xFFFFF000) == base ); /* must be page aligned */
|
nkeynes@10 | 144 | assert( (size&0x00000FFF) == 0 );
|
nkeynes@10 | 145 | assert( num_mem_rgns < MAX_MEM_REGIONS );
|
nkeynes@10 | 146 | assert( page_map != NULL );
|
nkeynes@10 | 147 |
|
nkeynes@10 | 148 | mem = mem_alloc_pages( size>>PAGE_BITS );
|
nkeynes@10 | 149 |
|
nkeynes@10 | 150 | mem_map_region( mem, base, size, name, 6 );
|
nkeynes@10 | 151 | return mem;
|
nkeynes@10 | 152 | }
|
nkeynes@10 | 153 |
|
nkeynes@10 | 154 | void *mem_load_rom( char *file, uint32_t base, uint32_t size, uint32_t crc )
|
nkeynes@10 | 155 | {
|
nkeynes@10 | 156 | char buf[512], *mem;
|
nkeynes@10 | 157 | int fd;
|
nkeynes@10 | 158 | uint32_t calc_crc;
|
nkeynes@10 | 159 | snprintf( buf, 512, "%s/%s",BIOS_PATH, file );
|
nkeynes@10 | 160 | fd = open( buf, O_RDONLY );
|
nkeynes@10 | 161 | if( fd == -1 ) {
|
nkeynes@10 | 162 | ERROR( "Bios file not found: %s", buf );
|
nkeynes@10 | 163 | return NULL;
|
nkeynes@10 | 164 | }
|
nkeynes@10 | 165 | mem = mmap( NULL, size, PROT_READ, MAP_PRIVATE, fd, 0 );
|
nkeynes@10 | 166 | if( mem == MAP_FAILED ) {
|
nkeynes@10 | 167 | ERROR( "Unable to map bios file: %s (%s)", file, strerror(errno) );
|
nkeynes@10 | 168 | close(fd);
|
nkeynes@10 | 169 | return NULL;
|
nkeynes@10 | 170 | }
|
nkeynes@10 | 171 | mem_map_region( mem, base, size, file, 4 );
|
nkeynes@10 | 172 |
|
nkeynes@10 | 173 | /* CRC check */
|
nkeynes@10 | 174 | calc_crc = crc32(0L, mem, size);
|
nkeynes@10 | 175 | if( calc_crc != crc ) {
|
nkeynes@10 | 176 | WARN( "Bios CRC Mismatch in %s: %08X (expected %08X)",
|
nkeynes@10 | 177 | file, calc_crc, crc);
|
nkeynes@10 | 178 | }
|
nkeynes@10 | 179 | return mem;
|
nkeynes@10 | 180 | }
|
nkeynes@10 | 181 |
|
nkeynes@10 | 182 | char *mem_get_region_by_name( char *name )
|
nkeynes@10 | 183 | {
|
nkeynes@10 | 184 | int i;
|
nkeynes@10 | 185 | for( i=0; i<num_mem_rgns; i++ ) {
|
nkeynes@10 | 186 | if( strcmp( mem_rgn[i].name, name ) == 0 )
|
nkeynes@10 | 187 | return mem_rgn[i].mem;
|
nkeynes@10 | 188 | }
|
nkeynes@10 | 189 | return NULL;
|
nkeynes@10 | 190 | }
|
nkeynes@10 | 191 |
|
nkeynes@10 | 192 | void register_io_region( struct mmio_region *io )
|
nkeynes@10 | 193 | {
|
nkeynes@10 | 194 | int i;
|
nkeynes@10 | 195 |
|
nkeynes@10 | 196 | assert(io);
|
nkeynes@10 | 197 | io->mem = mem_alloc_pages(2);
|
nkeynes@10 | 198 | io->save_mem = io->mem + PAGE_SIZE;
|
nkeynes@10 | 199 | io->index = (struct mmio_port **)malloc(1024*sizeof(struct mmio_port *));
|
nkeynes@10 | 200 | io->trace_flag = 1;
|
nkeynes@10 | 201 | memset( io->index, 0, 1024*sizeof(struct mmio_port *) );
|
nkeynes@10 | 202 | for( i=0; io->ports[i].id != NULL; i++ ) {
|
nkeynes@10 | 203 | io->ports[i].val = (uint32_t *)(io->mem + io->ports[i].offset);
|
nkeynes@10 | 204 | *io->ports[i].val = io->ports[i].def_val;
|
nkeynes@10 | 205 | io->index[io->ports[i].offset>>2] = &io->ports[i];
|
nkeynes@10 | 206 | }
|
nkeynes@10 | 207 | memcpy( io->save_mem, io->mem, PAGE_SIZE );
|
nkeynes@10 | 208 | if( (io->base & 0xFF000000) == 0xFF000000 ) {
|
nkeynes@10 | 209 | /* P4 area (on-chip I/O channels */
|
nkeynes@10 | 210 | P4_io[(io->base&0x1FFFFFFF)>>19] = io;
|
nkeynes@10 | 211 | } else {
|
nkeynes@10 | 212 | page_map[io->base>>12] = (char *)num_io_rgns;
|
nkeynes@10 | 213 | }
|
nkeynes@10 | 214 | io_rgn[num_io_rgns] = io;
|
nkeynes@10 | 215 | num_io_rgns++;
|
nkeynes@10 | 216 | }
|
nkeynes@10 | 217 |
|
nkeynes@10 | 218 | void register_io_regions( struct mmio_region **io )
|
nkeynes@10 | 219 | {
|
nkeynes@10 | 220 | while( *io ) register_io_region( *io++ );
|
nkeynes@10 | 221 | }
|
nkeynes@10 | 222 |
|
nkeynes@10 | 223 | int mem_has_page( uint32_t addr )
|
nkeynes@10 | 224 | {
|
nkeynes@10 | 225 | char *page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 226 | return page != NULL;
|
nkeynes@10 | 227 | }
|
nkeynes@10 | 228 |
|
nkeynes@10 | 229 | char *mem_get_page( uint32_t addr )
|
nkeynes@10 | 230 | {
|
nkeynes@10 | 231 | char *page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 232 | return page;
|
nkeynes@10 | 233 | }
|
nkeynes@10 | 234 |
|
nkeynes@10 | 235 | char *mem_get_region( uint32_t addr )
|
nkeynes@10 | 236 | {
|
nkeynes@10 | 237 | char *page = page_map[ (addr & 0x1FFFFFFF) >> 12 ];
|
nkeynes@10 | 238 | if( ((uint32_t)page) < MAX_IO_REGIONS ) { /* IO Region */
|
nkeynes@10 | 239 | return NULL;
|
nkeynes@10 | 240 | } else {
|
nkeynes@10 | 241 | return page+(addr&0xFFF);
|
nkeynes@10 | 242 | }
|
nkeynes@10 | 243 | }
|
nkeynes@11 | 244 |
|