81c641e707
When building with device and hw support, the sim-core code generates a lot of build time warnings such as: ./../common/sim-core.c: In function 'sim_core_map_attach': ./../common/sim-core.c:198:7: warning: passing argument 1 of 'device_error' from incompatible pointer type ../common/sim-core.h:347:6: note: expected 'struct device *' but argument is of type 'struct hw *' ./../common/sim-core.c:235:7: warning: passing argument 1 of 'device_error' from incompatible pointer type ../common/sim-core.h:347:6: note: expected 'struct device *' but argument is of type 'struct hw *' In reality, these two structures get cast back and forth in the core code already and so are "compatible". So tweak the three functions that generate all of these warnings to include the casts automatically. I know this isn't exactly clean, but the current device/hw ifdef approach is full of landmines itself and I'm not entirely sure how to unscrew it. Signed-off-by: Mike Frysinger <vapier@gentoo.org>
859 lines
22 KiB
C
859 lines
22 KiB
C
/* The common simulator framework for GDB, the GNU Debugger.
|
|
|
|
Copyright 2002, 2007, 2008, 2009, 2010 Free Software Foundation, Inc.
|
|
|
|
Contributed by Andrew Cagney and Red Hat.
|
|
|
|
This file is part of GDB.
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>. */
|
|
|
|
|
|
#ifndef SIM_CORE_C
|
|
#define SIM_CORE_C
|
|
|
|
#include "sim-main.h"
|
|
#include "sim-assert.h"
|
|
|
|
#if (WITH_HW)
|
|
#include "sim-hw.h"
|
|
#define device_error(client, ...) device_error ((device *)(client), __VA_ARGS__)
|
|
#define device_io_read_buffer(client, ...) device_io_read_buffer ((device *)(client), __VA_ARGS__)
|
|
#define device_io_write_buffer(client, ...) device_io_write_buffer ((device *)(client), __VA_ARGS__)
|
|
#endif
|
|
|
|
/* "core" module install handler.
|
|
|
|
This is called via sim_module_install to install the "core"
|
|
subsystem into the simulator. */
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
static MODULE_INIT_FN sim_core_init;
|
|
static MODULE_UNINSTALL_FN sim_core_uninstall;
|
|
#endif
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
SIM_RC
|
|
sim_core_install (SIM_DESC sd)
|
|
{
|
|
SIM_ASSERT (STATE_MAGIC (sd) == SIM_MAGIC_NUMBER);
|
|
|
|
/* establish the other handlers */
|
|
sim_module_add_uninstall_fn (sd, sim_core_uninstall);
|
|
sim_module_add_init_fn (sd, sim_core_init);
|
|
|
|
/* establish any initial data structures - none */
|
|
return SIM_RC_OK;
|
|
}
|
|
#endif
|
|
|
|
|
|
/* Uninstall the "core" subsystem from the simulator. */
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
static void
|
|
sim_core_uninstall (SIM_DESC sd)
|
|
{
|
|
sim_core *core = STATE_CORE(sd);
|
|
unsigned map;
|
|
/* blow away any mappings */
|
|
for (map = 0; map < nr_maps; map++) {
|
|
sim_core_mapping *curr = core->common.map[map].first;
|
|
while (curr != NULL) {
|
|
sim_core_mapping *tbd = curr;
|
|
curr = curr->next;
|
|
if (tbd->free_buffer != NULL) {
|
|
SIM_ASSERT(tbd->buffer != NULL);
|
|
zfree(tbd->free_buffer);
|
|
}
|
|
zfree(tbd);
|
|
}
|
|
core->common.map[map].first = NULL;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
static SIM_RC
|
|
sim_core_init (SIM_DESC sd)
|
|
{
|
|
/* Nothing to do */
|
|
return SIM_RC_OK;
|
|
}
|
|
#endif
|
|
|
|
|
|
|
|
#ifndef SIM_CORE_SIGNAL
|
|
#define SIM_CORE_SIGNAL(SD,CPU,CIA,MAP,NR_BYTES,ADDR,TRANSFER,ERROR) \
|
|
sim_core_signal ((SD), (CPU), (CIA), (MAP), (NR_BYTES), (ADDR), (TRANSFER), (ERROR))
|
|
#endif
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
void
|
|
sim_core_signal (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
sim_cia cia,
|
|
unsigned map,
|
|
int nr_bytes,
|
|
address_word addr,
|
|
transfer_type transfer,
|
|
sim_core_signals sig)
|
|
{
|
|
const char *copy = (transfer == read_transfer ? "read" : "write");
|
|
address_word ip = CIA_ADDR (cia);
|
|
switch (sig)
|
|
{
|
|
case sim_core_unmapped_signal:
|
|
sim_io_eprintf (sd, "core: %d byte %s to unmapped address 0x%lx at 0x%lx\n",
|
|
nr_bytes, copy, (unsigned long) addr, (unsigned long) ip);
|
|
sim_engine_halt (sd, cpu, NULL, cia, sim_stopped, SIM_SIGSEGV);
|
|
break;
|
|
case sim_core_unaligned_signal:
|
|
sim_io_eprintf (sd, "core: %d byte misaligned %s to address 0x%lx at 0x%lx\n",
|
|
nr_bytes, copy, (unsigned long) addr, (unsigned long) ip);
|
|
sim_engine_halt (sd, cpu, NULL, cia, sim_stopped, SIM_SIGBUS);
|
|
break;
|
|
default:
|
|
sim_engine_abort (sd, cpu, cia,
|
|
"sim_core_signal - internal error - bad switch");
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
static sim_core_mapping *
|
|
new_sim_core_mapping (SIM_DESC sd,
|
|
int level,
|
|
int space,
|
|
address_word addr,
|
|
address_word nr_bytes,
|
|
unsigned modulo,
|
|
#if WITH_HW
|
|
struct hw *device,
|
|
#else
|
|
device *device,
|
|
#endif
|
|
void *buffer,
|
|
void *free_buffer)
|
|
{
|
|
sim_core_mapping *new_mapping = ZALLOC(sim_core_mapping);
|
|
/* common */
|
|
new_mapping->level = level;
|
|
new_mapping->space = space;
|
|
new_mapping->base = addr;
|
|
new_mapping->nr_bytes = nr_bytes;
|
|
new_mapping->bound = addr + (nr_bytes - 1);
|
|
if (modulo == 0)
|
|
new_mapping->mask = (unsigned) 0 - 1;
|
|
else
|
|
new_mapping->mask = modulo - 1;
|
|
new_mapping->buffer = buffer;
|
|
new_mapping->free_buffer = free_buffer;
|
|
new_mapping->device = device;
|
|
return new_mapping;
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
static void
|
|
sim_core_map_attach (SIM_DESC sd,
|
|
sim_core_map *access_map,
|
|
int level,
|
|
int space,
|
|
address_word addr,
|
|
address_word nr_bytes,
|
|
unsigned modulo,
|
|
#if WITH_HW
|
|
struct hw *client, /*callback/default*/
|
|
#else
|
|
device *client, /*callback/default*/
|
|
#endif
|
|
void *buffer, /*raw_memory*/
|
|
void *free_buffer) /*raw_memory*/
|
|
{
|
|
/* find the insertion point for this additional mapping and then
|
|
insert */
|
|
sim_core_mapping *next_mapping;
|
|
sim_core_mapping **last_mapping;
|
|
|
|
SIM_ASSERT ((client == NULL) != (buffer == NULL));
|
|
SIM_ASSERT ((client == NULL) >= (free_buffer != NULL));
|
|
|
|
/* actually do occasionally get a zero size map */
|
|
if (nr_bytes == 0)
|
|
{
|
|
#if (WITH_DEVICES)
|
|
device_error(client, "called on sim_core_map_attach with size zero");
|
|
#endif
|
|
#if (WITH_HW)
|
|
sim_hw_abort (sd, client, "called on sim_core_map_attach with size zero");
|
|
#endif
|
|
sim_io_error (sd, "called on sim_core_map_attach with size zero");
|
|
}
|
|
|
|
/* find the insertion point (between last/next) */
|
|
next_mapping = access_map->first;
|
|
last_mapping = &access_map->first;
|
|
while(next_mapping != NULL
|
|
&& (next_mapping->level < level
|
|
|| (next_mapping->level == level
|
|
&& next_mapping->bound < addr)))
|
|
{
|
|
/* provided levels are the same */
|
|
/* assert: next_mapping->base > all bases before next_mapping */
|
|
/* assert: next_mapping->bound >= all bounds before next_mapping */
|
|
last_mapping = &next_mapping->next;
|
|
next_mapping = next_mapping->next;
|
|
}
|
|
|
|
/* check insertion point correct */
|
|
SIM_ASSERT (next_mapping == NULL || next_mapping->level >= level);
|
|
if (next_mapping != NULL && next_mapping->level == level
|
|
&& next_mapping->base < (addr + (nr_bytes - 1)))
|
|
{
|
|
#if (WITH_DEVICES)
|
|
device_error (client, "memory map %d:0x%lx..0x%lx (%ld bytes) overlaps %d:0x%lx..0x%lx (%ld bytes)",
|
|
space,
|
|
(long) addr,
|
|
(long) (addr + nr_bytes - 1),
|
|
(long) nr_bytes,
|
|
next_mapping->space,
|
|
(long) next_mapping->base,
|
|
(long) next_mapping->bound,
|
|
(long) next_mapping->nr_bytes);
|
|
#endif
|
|
#if WITH_HW
|
|
sim_hw_abort (sd, client, "memory map %d:0x%lx..0x%lx (%ld bytes) overlaps %d:0x%lx..0x%lx (%ld bytes)",
|
|
space,
|
|
(long) addr,
|
|
(long) (addr + (nr_bytes - 1)),
|
|
(long) nr_bytes,
|
|
next_mapping->space,
|
|
(long) next_mapping->base,
|
|
(long) next_mapping->bound,
|
|
(long) next_mapping->nr_bytes);
|
|
#endif
|
|
sim_io_error (sd, "memory map %d:0x%lx..0x%lx (%ld bytes) overlaps %d:0x%lx..0x%lx (%ld bytes)",
|
|
space,
|
|
(long) addr,
|
|
(long) (addr + (nr_bytes - 1)),
|
|
(long) nr_bytes,
|
|
next_mapping->space,
|
|
(long) next_mapping->base,
|
|
(long) next_mapping->bound,
|
|
(long) next_mapping->nr_bytes);
|
|
}
|
|
|
|
/* create/insert the new mapping */
|
|
*last_mapping = new_sim_core_mapping(sd,
|
|
level,
|
|
space, addr, nr_bytes, modulo,
|
|
client, buffer, free_buffer);
|
|
(*last_mapping)->next = next_mapping;
|
|
}
|
|
#endif
|
|
|
|
|
|
/* Attach memory or a memory mapped device to the simulator.
|
|
See sim-core.h for a full description. */
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
void
|
|
sim_core_attach (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
int level,
|
|
unsigned mapmask,
|
|
int space,
|
|
address_word addr,
|
|
address_word nr_bytes,
|
|
unsigned modulo,
|
|
#if WITH_HW
|
|
struct hw *client,
|
|
#else
|
|
device *client,
|
|
#endif
|
|
void *optional_buffer)
|
|
{
|
|
sim_core *memory = STATE_CORE(sd);
|
|
unsigned map;
|
|
void *buffer;
|
|
void *free_buffer;
|
|
|
|
/* check for for attempt to use unimplemented per-processor core map */
|
|
if (cpu != NULL)
|
|
sim_io_error (sd, "sim_core_map_attach - processor specific memory map not yet supported");
|
|
|
|
/* verify modulo memory */
|
|
if (!WITH_MODULO_MEMORY && modulo != 0)
|
|
{
|
|
#if (WITH_DEVICES)
|
|
device_error (client, "sim_core_attach - internal error - modulo memory disabled");
|
|
#endif
|
|
#if (WITH_HW)
|
|
sim_hw_abort (sd, client, "sim_core_attach - internal error - modulo memory disabled");
|
|
#endif
|
|
sim_io_error (sd, "sim_core_attach - internal error - modulo memory disabled");
|
|
}
|
|
if (client != NULL && modulo != 0)
|
|
{
|
|
#if (WITH_DEVICES)
|
|
device_error (client, "sim_core_attach - internal error - modulo and callback memory conflict");
|
|
#endif
|
|
#if (WITH_HW)
|
|
sim_hw_abort (sd, client, "sim_core_attach - internal error - modulo and callback memory conflict");
|
|
#endif
|
|
sim_io_error (sd, "sim_core_attach - internal error - modulo and callback memory conflict");
|
|
}
|
|
if (modulo != 0)
|
|
{
|
|
unsigned mask = modulo - 1;
|
|
/* any zero bits */
|
|
while (mask >= sizeof (unsigned64)) /* minimum modulo */
|
|
{
|
|
if ((mask & 1) == 0)
|
|
mask = 0;
|
|
else
|
|
mask >>= 1;
|
|
}
|
|
if (mask != sizeof (unsigned64) - 1)
|
|
{
|
|
#if (WITH_DEVICES)
|
|
device_error (client, "sim_core_attach - internal error - modulo %lx not power of two", (long) modulo);
|
|
#endif
|
|
#if (WITH_HW)
|
|
sim_hw_abort (sd, client, "sim_core_attach - internal error - modulo %lx not power of two", (long) modulo);
|
|
#endif
|
|
sim_io_error (sd, "sim_core_attach - internal error - modulo %lx not power of two", (long) modulo);
|
|
}
|
|
}
|
|
|
|
/* verify consistency between device and buffer */
|
|
if (client != NULL && optional_buffer != NULL)
|
|
{
|
|
#if (WITH_DEVICES)
|
|
device_error (client, "sim_core_attach - internal error - conflicting buffer and attach arguments");
|
|
#endif
|
|
#if (WITH_HW)
|
|
sim_hw_abort (sd, client, "sim_core_attach - internal error - conflicting buffer and attach arguments");
|
|
#endif
|
|
sim_io_error (sd, "sim_core_attach - internal error - conflicting buffer and attach arguments");
|
|
}
|
|
if (client == NULL)
|
|
{
|
|
if (optional_buffer == NULL)
|
|
{
|
|
int padding = (addr % sizeof (unsigned64));
|
|
unsigned long bytes = (modulo == 0 ? nr_bytes : modulo) + padding;
|
|
free_buffer = zalloc (bytes);
|
|
buffer = (char*) free_buffer + padding;
|
|
}
|
|
else
|
|
{
|
|
buffer = optional_buffer;
|
|
free_buffer = NULL;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* a device */
|
|
buffer = NULL;
|
|
free_buffer = NULL;
|
|
}
|
|
|
|
/* attach the region to all applicable access maps */
|
|
for (map = 0;
|
|
map < nr_maps;
|
|
map++)
|
|
{
|
|
if (mapmask & (1 << map))
|
|
{
|
|
sim_core_map_attach (sd, &memory->common.map[map],
|
|
level, space, addr, nr_bytes, modulo,
|
|
client, buffer, free_buffer);
|
|
free_buffer = NULL;
|
|
}
|
|
}
|
|
|
|
/* Just copy this map to each of the processor specific data structures.
|
|
FIXME - later this will be replaced by true processor specific
|
|
maps. */
|
|
{
|
|
int i;
|
|
for (i = 0; i < MAX_NR_PROCESSORS; i++)
|
|
{
|
|
CPU_CORE (STATE_CPU (sd, i))->common = STATE_CORE (sd)->common;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
/* Remove any memory reference related to this address */
|
|
#if EXTERN_SIM_CORE_P
|
|
static void
|
|
sim_core_map_detach (SIM_DESC sd,
|
|
sim_core_map *access_map,
|
|
int level,
|
|
int space,
|
|
address_word addr)
|
|
{
|
|
sim_core_mapping **entry;
|
|
for (entry = &access_map->first;
|
|
(*entry) != NULL;
|
|
entry = &(*entry)->next)
|
|
{
|
|
if ((*entry)->base == addr
|
|
&& (*entry)->level == level
|
|
&& (*entry)->space == space)
|
|
{
|
|
sim_core_mapping *dead = (*entry);
|
|
(*entry) = dead->next;
|
|
if (dead->free_buffer != NULL)
|
|
zfree (dead->free_buffer);
|
|
zfree (dead);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
void
|
|
sim_core_detach (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
int level,
|
|
int address_space,
|
|
address_word addr)
|
|
{
|
|
sim_core *memory = STATE_CORE (sd);
|
|
unsigned map;
|
|
for (map = 0; map < nr_maps; map++)
|
|
{
|
|
sim_core_map_detach (sd, &memory->common.map[map],
|
|
level, address_space, addr);
|
|
}
|
|
/* Just copy this update to each of the processor specific data
|
|
structures. FIXME - later this will be replaced by true
|
|
processor specific maps. */
|
|
{
|
|
int i;
|
|
for (i = 0; i < MAX_NR_PROCESSORS; i++)
|
|
{
|
|
CPU_CORE (STATE_CPU (sd, i))->common = STATE_CORE (sd)->common;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
STATIC_INLINE_SIM_CORE\
|
|
(sim_core_mapping *)
|
|
sim_core_find_mapping(sim_core_common *core,
|
|
unsigned map,
|
|
address_word addr,
|
|
unsigned nr_bytes,
|
|
transfer_type transfer,
|
|
int abort, /*either 0 or 1 - hint to inline/-O */
|
|
sim_cpu *cpu, /* abort => cpu != NULL */
|
|
sim_cia cia)
|
|
{
|
|
sim_core_mapping *mapping = core->map[map].first;
|
|
ASSERT ((addr & (nr_bytes - 1)) == 0); /* must be aligned */
|
|
ASSERT ((addr + (nr_bytes - 1)) >= addr); /* must not wrap */
|
|
ASSERT (!abort || cpu != NULL); /* abort needs a non null CPU */
|
|
while (mapping != NULL)
|
|
{
|
|
if (addr >= mapping->base
|
|
&& (addr + (nr_bytes - 1)) <= mapping->bound)
|
|
return mapping;
|
|
mapping = mapping->next;
|
|
}
|
|
if (abort)
|
|
{
|
|
SIM_CORE_SIGNAL (CPU_STATE (cpu), cpu, cia, map, nr_bytes, addr, transfer,
|
|
sim_core_unmapped_signal);
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
|
|
STATIC_INLINE_SIM_CORE\
|
|
(void *)
|
|
sim_core_translate (sim_core_mapping *mapping,
|
|
address_word addr)
|
|
{
|
|
if (WITH_MODULO_MEMORY)
|
|
return (void *)((unsigned8 *) mapping->buffer
|
|
+ ((addr - mapping->base) & mapping->mask));
|
|
else
|
|
return (void *)((unsigned8 *) mapping->buffer
|
|
+ addr - mapping->base);
|
|
}
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
unsigned
|
|
sim_core_read_buffer (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
unsigned map,
|
|
void *buffer,
|
|
address_word addr,
|
|
unsigned len)
|
|
{
|
|
sim_core_common *core = (cpu == NULL ? &STATE_CORE (sd)->common : &CPU_CORE (cpu)->common);
|
|
unsigned count = 0;
|
|
while (count < len)
|
|
{
|
|
address_word raddr = addr + count;
|
|
sim_core_mapping *mapping =
|
|
sim_core_find_mapping (core, map,
|
|
raddr, /*nr-bytes*/1,
|
|
read_transfer,
|
|
0 /*dont-abort*/, NULL, NULL_CIA);
|
|
if (mapping == NULL)
|
|
break;
|
|
#if (WITH_DEVICES)
|
|
if (mapping->device != NULL)
|
|
{
|
|
int nr_bytes = len - count;
|
|
sim_cia cia = cpu ? CIA_GET (cpu) : NULL_CIA;
|
|
if (raddr + nr_bytes - 1> mapping->bound)
|
|
nr_bytes = mapping->bound - raddr + 1;
|
|
if (device_io_read_buffer (mapping->device,
|
|
(unsigned_1*)buffer + count,
|
|
mapping->space,
|
|
raddr,
|
|
nr_bytes,
|
|
sd,
|
|
cpu,
|
|
cia) != nr_bytes)
|
|
break;
|
|
count += nr_bytes;
|
|
continue;
|
|
}
|
|
#endif
|
|
#if (WITH_HW)
|
|
if (mapping->device != NULL)
|
|
{
|
|
int nr_bytes = len - count;
|
|
if (raddr + nr_bytes - 1> mapping->bound)
|
|
nr_bytes = mapping->bound - raddr + 1;
|
|
if (sim_hw_io_read_buffer (sd, mapping->device,
|
|
(unsigned_1*)buffer + count,
|
|
mapping->space,
|
|
raddr,
|
|
nr_bytes) != nr_bytes)
|
|
break;
|
|
count += nr_bytes;
|
|
continue;
|
|
}
|
|
#endif
|
|
((unsigned_1*)buffer)[count] =
|
|
*(unsigned_1*)sim_core_translate(mapping, raddr);
|
|
count += 1;
|
|
}
|
|
return count;
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
unsigned
|
|
sim_core_write_buffer (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
unsigned map,
|
|
const void *buffer,
|
|
address_word addr,
|
|
unsigned len)
|
|
{
|
|
sim_core_common *core = (cpu == NULL ? &STATE_CORE (sd)->common : &CPU_CORE (cpu)->common);
|
|
unsigned count = 0;
|
|
while (count < len)
|
|
{
|
|
address_word raddr = addr + count;
|
|
sim_core_mapping *mapping =
|
|
sim_core_find_mapping (core, map,
|
|
raddr, /*nr-bytes*/1,
|
|
write_transfer,
|
|
0 /*dont-abort*/, NULL, NULL_CIA);
|
|
if (mapping == NULL)
|
|
break;
|
|
#if (WITH_DEVICES)
|
|
if (WITH_CALLBACK_MEMORY
|
|
&& mapping->device != NULL)
|
|
{
|
|
int nr_bytes = len - count;
|
|
sim_cia cia = cpu ? CIA_GET (cpu) : NULL_CIA;
|
|
if (raddr + nr_bytes - 1 > mapping->bound)
|
|
nr_bytes = mapping->bound - raddr + 1;
|
|
if (device_io_write_buffer (mapping->device,
|
|
(unsigned_1*)buffer + count,
|
|
mapping->space,
|
|
raddr,
|
|
nr_bytes,
|
|
sd,
|
|
cpu,
|
|
cia) != nr_bytes)
|
|
break;
|
|
count += nr_bytes;
|
|
continue;
|
|
}
|
|
#endif
|
|
#if (WITH_HW)
|
|
if (WITH_CALLBACK_MEMORY
|
|
&& mapping->device != NULL)
|
|
{
|
|
int nr_bytes = len - count;
|
|
if (raddr + nr_bytes - 1 > mapping->bound)
|
|
nr_bytes = mapping->bound - raddr + 1;
|
|
if (sim_hw_io_write_buffer (sd, mapping->device,
|
|
(unsigned_1*)buffer + count,
|
|
mapping->space,
|
|
raddr,
|
|
nr_bytes) != nr_bytes)
|
|
break;
|
|
count += nr_bytes;
|
|
continue;
|
|
}
|
|
#endif
|
|
*(unsigned_1*)sim_core_translate(mapping, raddr) =
|
|
((unsigned_1*)buffer)[count];
|
|
count += 1;
|
|
}
|
|
return count;
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
void
|
|
sim_core_set_xor (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
int is_xor)
|
|
{
|
|
/* set up the XOR map if required. */
|
|
if (WITH_XOR_ENDIAN) {
|
|
{
|
|
sim_core *core = STATE_CORE (sd);
|
|
sim_cpu_core *cpu_core = (cpu != NULL ? CPU_CORE (cpu) : NULL);
|
|
if (cpu_core != NULL)
|
|
{
|
|
int i = 1;
|
|
unsigned mask;
|
|
if (is_xor)
|
|
mask = WITH_XOR_ENDIAN - 1;
|
|
else
|
|
mask = 0;
|
|
while (i - 1 < WITH_XOR_ENDIAN)
|
|
{
|
|
cpu_core->xor[i-1] = mask;
|
|
mask = (mask << 1) & (WITH_XOR_ENDIAN - 1);
|
|
i = (i << 1);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (is_xor)
|
|
core->byte_xor = WITH_XOR_ENDIAN - 1;
|
|
else
|
|
core->byte_xor = 0;
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
if (is_xor)
|
|
sim_engine_abort (sd, NULL, NULL_CIA,
|
|
"Attempted to enable xor-endian mode when permenantly disabled.");
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
static void
|
|
reverse_n (unsigned_1 *dest,
|
|
const unsigned_1 *src,
|
|
int nr_bytes)
|
|
{
|
|
int i;
|
|
for (i = 0; i < nr_bytes; i++)
|
|
{
|
|
dest [nr_bytes - i - 1] = src [i];
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
unsigned
|
|
sim_core_xor_read_buffer (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
unsigned map,
|
|
void *buffer,
|
|
address_word addr,
|
|
unsigned nr_bytes)
|
|
{
|
|
address_word byte_xor = (cpu == NULL ? STATE_CORE (sd)->byte_xor : CPU_CORE (cpu)->xor[0]);
|
|
if (!WITH_XOR_ENDIAN || !byte_xor)
|
|
return sim_core_read_buffer (sd, cpu, map, buffer, addr, nr_bytes);
|
|
else
|
|
/* only break up transfers when xor-endian is both selected and enabled */
|
|
{
|
|
unsigned_1 x[WITH_XOR_ENDIAN + 1]; /* +1 to avoid zero-sized array */
|
|
unsigned nr_transfered = 0;
|
|
address_word start = addr;
|
|
unsigned nr_this_transfer = (WITH_XOR_ENDIAN - (addr & ~(WITH_XOR_ENDIAN - 1)));
|
|
address_word stop;
|
|
/* initial and intermediate transfers are broken when they cross
|
|
an XOR endian boundary */
|
|
while (nr_transfered + nr_this_transfer < nr_bytes)
|
|
/* initial/intermediate transfers */
|
|
{
|
|
/* since xor-endian is enabled stop^xor defines the start
|
|
address of the transfer */
|
|
stop = start + nr_this_transfer - 1;
|
|
SIM_ASSERT (start <= stop);
|
|
SIM_ASSERT ((stop ^ byte_xor) <= (start ^ byte_xor));
|
|
if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
|
|
!= nr_this_transfer)
|
|
return nr_transfered;
|
|
reverse_n (&((unsigned_1*)buffer)[nr_transfered], x, nr_this_transfer);
|
|
nr_transfered += nr_this_transfer;
|
|
nr_this_transfer = WITH_XOR_ENDIAN;
|
|
start = stop + 1;
|
|
}
|
|
/* final transfer */
|
|
nr_this_transfer = nr_bytes - nr_transfered;
|
|
stop = start + nr_this_transfer - 1;
|
|
SIM_ASSERT (stop == (addr + nr_bytes - 1));
|
|
if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
|
|
!= nr_this_transfer)
|
|
return nr_transfered;
|
|
reverse_n (&((unsigned_1*)buffer)[nr_transfered], x, nr_this_transfer);
|
|
return nr_bytes;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
unsigned
|
|
sim_core_xor_write_buffer (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
unsigned map,
|
|
const void *buffer,
|
|
address_word addr,
|
|
unsigned nr_bytes)
|
|
{
|
|
address_word byte_xor = (cpu == NULL ? STATE_CORE (sd)->byte_xor : CPU_CORE (cpu)->xor[0]);
|
|
if (!WITH_XOR_ENDIAN || !byte_xor)
|
|
return sim_core_write_buffer (sd, cpu, map, buffer, addr, nr_bytes);
|
|
else
|
|
/* only break up transfers when xor-endian is both selected and enabled */
|
|
{
|
|
unsigned_1 x[WITH_XOR_ENDIAN + 1]; /* +1 to avoid zero sized array */
|
|
unsigned nr_transfered = 0;
|
|
address_word start = addr;
|
|
unsigned nr_this_transfer = (WITH_XOR_ENDIAN - (addr & ~(WITH_XOR_ENDIAN - 1)));
|
|
address_word stop;
|
|
/* initial and intermediate transfers are broken when they cross
|
|
an XOR endian boundary */
|
|
while (nr_transfered + nr_this_transfer < nr_bytes)
|
|
/* initial/intermediate transfers */
|
|
{
|
|
/* since xor-endian is enabled stop^xor defines the start
|
|
address of the transfer */
|
|
stop = start + nr_this_transfer - 1;
|
|
SIM_ASSERT (start <= stop);
|
|
SIM_ASSERT ((stop ^ byte_xor) <= (start ^ byte_xor));
|
|
reverse_n (x, &((unsigned_1*)buffer)[nr_transfered], nr_this_transfer);
|
|
if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
|
|
!= nr_this_transfer)
|
|
return nr_transfered;
|
|
nr_transfered += nr_this_transfer;
|
|
nr_this_transfer = WITH_XOR_ENDIAN;
|
|
start = stop + 1;
|
|
}
|
|
/* final transfer */
|
|
nr_this_transfer = nr_bytes - nr_transfered;
|
|
stop = start + nr_this_transfer - 1;
|
|
SIM_ASSERT (stop == (addr + nr_bytes - 1));
|
|
reverse_n (x, &((unsigned_1*)buffer)[nr_transfered], nr_this_transfer);
|
|
if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
|
|
!= nr_this_transfer)
|
|
return nr_transfered;
|
|
return nr_bytes;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#if EXTERN_SIM_CORE_P
|
|
void *
|
|
sim_core_trans_addr (SIM_DESC sd,
|
|
sim_cpu *cpu,
|
|
unsigned map,
|
|
address_word addr)
|
|
{
|
|
sim_core_common *core = (cpu == NULL ? &STATE_CORE (sd)->common : &CPU_CORE (cpu)->common);
|
|
sim_core_mapping *mapping =
|
|
sim_core_find_mapping (core, map,
|
|
addr, /*nr-bytes*/1,
|
|
write_transfer,
|
|
0 /*dont-abort*/, NULL, NULL_CIA);
|
|
if (mapping == NULL)
|
|
return NULL;
|
|
return sim_core_translate(mapping, addr);
|
|
}
|
|
#endif
|
|
|
|
|
|
|
|
/* define the read/write 1/2/4/8/16/word functions */
|
|
|
|
#define N 16
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 8
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 7
|
|
#define M 8
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 6
|
|
#define M 8
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 5
|
|
#define M 8
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 4
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 3
|
|
#define M 4
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 2
|
|
#include "sim-n-core.h"
|
|
|
|
#define N 1
|
|
#include "sim-n-core.h"
|
|
|
|
#endif
|