1 #include "config_file/config_file.h"
5 #define CHKRANGE(a, b, c) a >= (unsigned int)b && a < (unsigned int)(b + c)
7 static unsigned int target;
9 extern const char *map_type_names[MAPTYPE_NUM];
10 const char *op_type_names[OP_TYPE_NUM] = {
17 int handle_mapped_read(struct emulator_config *cfg, unsigned int addr, unsigned int *val, unsigned char type, unsigned char mirror) {
18 unsigned char *read_addr = NULL;
21 //printf("Mapped read: %.8x\n", addr);
23 for (int i = 0; i < MAX_NUM_MAPPED_ITEMS; i++) {
24 if (cfg->map_type[i] == MAPTYPE_NONE)
26 switch(cfg->map_type[i]) {
28 if (CHKRANGE(addr, cfg->map_offset[i], cfg->map_size[i]))
29 read_addr = cfg->map_data[i] + (addr - cfg->map_offset[i]);
30 else if (cfg->map_mirror[i] != -1 && mirror && CHKRANGE(addr, cfg->map_mirror[i], cfg->map_size[i]))
31 read_addr = cfg->map_data[i] + (addr - cfg->map_mirror[i]);
34 if (CHKRANGE(addr, cfg->map_offset[i], cfg->map_size[i]))
35 read_addr = cfg->map_data[i] + (addr - cfg->map_offset[i]);
37 case MAPTYPE_REGISTER:
38 if (CHKRANGE(addr, cfg->map_offset[i], cfg->map_size[i]))
43 if (!read_addr && !handle_regs)
47 if (handle_register_read(addr, type, &target) != -1) {
54 //printf("Read %s from %s (%.8X) (%d)\n", op_type_names[type], map_type_names[cfg->map_type[i]], addr, mirror);
55 //printf("Readaddr: %.8lX (Base %.8lX\n", (uint64_t)(read_addr), (uint64_t)cfg->map_data[i]);
59 //printf("Read val: %.8lX (%d)\n", (uint64_t)val, *val);
63 *val = be16toh(((unsigned short *)read_addr)[0]);
64 //printf("Read val: %.8lX (%d)\n", (uint64_t)val, *val);
67 case OP_TYPE_LONGWORD:
68 *val = be32toh(((unsigned int *)read_addr)[0]);
69 //printf("Read val: %.8lX (%d)\n", (uint64_t)val, *val);
82 int handle_mapped_write(struct emulator_config *cfg, unsigned int addr, unsigned int value, unsigned char type, unsigned char mirror) {
83 unsigned char *write_addr = NULL;
86 //printf("Mapped write: %.8x\n", addr);
88 for (int i = 0; i < MAX_NUM_MAPPED_ITEMS; i++) {
89 if (cfg->map_type[i] == MAPTYPE_NONE)
91 switch(cfg->map_type[i]) {
93 if (cfg->map_mirror[i] != -1 && mirror && CHKRANGE(addr, cfg->map_mirror[i], cfg->map_size[i]))
95 else if (CHKRANGE(addr, cfg->map_offset[i], cfg->map_size[i]))
99 if (CHKRANGE(addr, cfg->map_offset[i], cfg->map_size[i]))
100 write_addr = cfg->map_data[i] + (addr - cfg->map_offset[i]);
102 case MAPTYPE_REGISTER:
103 if (CHKRANGE(addr, cfg->map_offset[i], cfg->map_size[i]))
108 if (!write_addr && !handle_regs)
112 return handle_register_write(addr, value, type);
114 else if (write_addr) {
115 //printf("Write %s to %s (%.8X) (%d)\n", op_type_names[type], map_type_names[cfg->map_type[i]], addr, mirror);
116 //printf("Writeaddr: %.8lX (Base %.8lX\n", (uint64_t)(write_addr), (uint64_t)cfg->map_data[i]);
119 write_addr[0] = (unsigned char)value;
120 //printf("Write val: %.8X (%d)\n", (uint32_t)value, value);
124 ((short *)write_addr)[0] = htobe16(value);
125 //printf("Write val: %.8X (%d)\n", (uint32_t)value, value);
128 case OP_TYPE_LONGWORD:
129 ((int *)write_addr)[0] = htobe32(value);
130 //printf("Write val: %.8X (%d)\n", (uint32_t)value, value);