1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
|
#include "memory.h"
#include <stdio.h>
#include <stdlib.h>
static device_vtable_t const memory_vtable = {
memory_read,
memory_write,
memory_deinit
};
void memory_init( memory_t *memory, memory_type_t type, uint16_t addr, uint16_t size )
{
device_init( &memory->base, ( type == MEMORY_ROM ) ? "ROM" : "RAM" );
memory->type = type;
memory->addr = addr;
memory->size = size;
memory->cell = malloc( memory->size );
memory->base.vtable = (device_vtable_t *)&memory_vtable;
}
void memory_load( memory_t *memory, const char *filename )
{
if( memory->type == MEMORY_ROM ) {
FILE *f = fopen( filename, "rb" );
if( f == NULL ) {
fprintf( stderr, "ERROR: Unable to open ROM file '%s'\n", filename );
exit( EXIT_FAILURE );
}
fread( &memory->cell[0], memory->size, 1, f );
fclose( f );
fprintf( stderr, "INFO: Loaded firware from '%s' of size %d starting on address %04X\n",
filename, memory->size, memory->addr );
} else {
fprintf( stderr, "ERROR: Cannot load firmware into RAM at address %04X\n", memory->addr );
}
}
uint8_t memory_read( void *obj, uint16_t addr )
{
memory_t *memory = (memory_t *)obj;
return memory->cell[addr-memory->addr];
}
void memory_write( void *obj, uint16_t addr, uint8_t data )
{
memory_t *memory = (memory_t *)obj;
if( memory->type && MEMORY_ROM ) {
// ignore writes to ROM
} else {
memory->cell[addr-memory->addr] = data;
}
}
void memory_deinit( void *obj )
{
memory_t *memory = (memory_t *)obj;
device_deinit( &memory->base );
}
|