darlinghq/darling-gdb
1
0
Fork 0
mirror of https://github.com/darlinghq/darling-gdb.git synced 2024-11-29 15:00:34 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity
aeec20bafb
darling-gdb/sim/ppc/psim.c
Stan Shebs 7a292a7adf import gdb-19990422 snapshot
1999-04-26 18:34:20 +00:00

1100 lines
29 KiB
C
Raw Blame History

/* This file is part of the program psim.
Copyright (C) 1994-1997, Andrew Cagney <cagney@highland.com.au>
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 2 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, write to the Free Software
Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
*/
#ifndef _PSIM_C_
#define _PSIM_C_
#include "cpu.h" /* includes psim.h */
#include "idecode.h"
#include "options.h"
#include "tree.h"
#include <signal.h>
#include <stdio.h>
#include <ctype.h>
#ifdef HAVE_STDLIB_H
#include <stdlib.h>
#endif
#include <setjmp.h>
#ifdef HAVE_STRING_H
#include <string.h>
#else
#ifdef HAVE_STRINGS_H
#include <strings.h>
#endif
#endif
#include "bfd.h"
/* system structure, actual size of processor array determined at
runtime */
struct _psim {
event_queue *events;
device *devices;
mon *monitor;
os_emul *os_emulation;
core *memory;
/* escape routine for inner functions */
void *path_to_halt;
void *path_to_restart;
/* status from last halt */
psim_status halt_status;
/* the processors proper */
int nr_cpus;
int last_cpu; /* CPU that last (tried to) execute an instruction */
cpu *processors[MAX_NR_PROCESSORS];
};
int current_target_byte_order;
int current_host_byte_order;
int current_environment;
int current_alignment;
int current_floating_point;
int current_model_issue = MODEL_ISSUE_IGNORE;
int current_stdio = DO_USE_STDIO;
model_enum current_model = WITH_DEFAULT_MODEL;
/* create the device tree */
INLINE_PSIM\
(device *)
psim_tree(void)
{
device *root = tree_parse(NULL, "core");
tree_parse(root, "/aliases");
tree_parse(root, "/options");
tree_parse(root, "/chosen");
tree_parse(root, "/packages");
tree_parse(root, "/cpus");
tree_parse(root, "/openprom");
tree_parse(root, "/openprom/init");
tree_parse(root, "/openprom/trace");
tree_parse(root, "/openprom/options");
return root;
}
STATIC_INLINE_PSIM\
(char *)
find_arg(char *err_msg,
int *ptr_to_argp,
char **argv)
{
*ptr_to_argp += 1;
if (argv[*ptr_to_argp] == NULL)
error(err_msg);
return argv[*ptr_to_argp];
}
INLINE_PSIM\
(void)
psim_usage(int verbose)
{
printf_filtered("Usage:\n");
printf_filtered("\n");
printf_filtered("\tpsim [ <psim-option> ... ] <image> [ <image-arg> ... ]\n");
printf_filtered("\n");
printf_filtered("Where\n");
printf_filtered("\n");
printf_filtered("\t<image> Name of the PowerPC program to run.\n");
if (verbose) {
printf_filtered("\t This can either be a PowerPC binary or\n");
printf_filtered("\t a text file containing a device tree\n");
printf_filtered("\t specification.\n");
printf_filtered("\t PSIM will attempt to determine from the\n");
printf_filtered("\t specified <image> the intended emulation\n");
printf_filtered("\t environment.\n");
printf_filtered("\t If PSIM gets it wrong, the emulation\n");
printf_filtered("\t environment can be specified using the\n");
printf_filtered("\t `-e' option (described below).\n");
printf_filtered("\n"); }
printf_filtered("\t<image-arg> Argument to be passed to <image>\n");
if (verbose) {
printf_filtered("\t These arguments will be passed to\n");
printf_filtered("\t <image> (as standard C argv, argc)\n");
printf_filtered("\t when <image> is started.\n");
printf_filtered("\n"); }
printf_filtered("\t<psim-option> See below\n");
printf_filtered("\n");
printf_filtered("The following are valid <psim-option>s:\n");
printf_filtered("\n");
printf_filtered("\t-c <count> Limit the simulation to <count> iterations\n");
if (verbose) {
printf_filtered("\n");
}
printf_filtered("\t-i or -i2 Print instruction counting statistics\n");
if (verbose) {
printf_filtered("\t Specify -i2 for a more detailed display\n");
printf_filtered("\n");
}
printf_filtered("\t-I Print execution unit statistics\n");
if (verbose) { printf_filtered("\n"); }
printf_filtered("\t-e <os-emul> specify an OS or platform to model\n");
if (verbose) {
printf_filtered("\t Can be any of the following:\n");
printf_filtered("\t bug - OEA + MOTO BUG ROM calls\n");
printf_filtered("\t netbsd - UEA + NetBSD system calls\n");
printf_filtered("\t solaris - UEA + Solaris system calls\n");
printf_filtered("\t linux - UEA + Linux system calls\n");
printf_filtered("\t chirp - OEA + a few OpenBoot calls\n");
printf_filtered("\n"); }
printf_filtered("\t-E <endian> Specify the endianness of the target\n");
if (verbose) {
printf_filtered("\t Can be any of the following:\n");
printf_filtered("\t big - big endian target\n");
printf_filtered("\t little - little endian target\n");
printf_filtered("\n"); }
printf_filtered("\t-f <file> Merge <file> into the device tree\n");
if (verbose) { printf_filtered("\n"); }
printf_filtered("\t-h -? -H give more detailed usage\n");
if (verbose) { printf_filtered("\n"); }
printf_filtered("\t-m <model> Specify the processor to model (604)\n");
if (verbose) {
printf_filtered("\t Selects the processor to use when\n");
printf_filtered("\t modeling execution units. Includes:\n");
printf_filtered("\t 604, 603 and 603e\n");
printf_filtered("\n"); }
printf_filtered("\t-n <nr-smp> Specify the number of processors in SMP simulations\n");
if (verbose) {
printf_filtered("\t Specifies the number of processors that are\n");
printf_filtered("\t to be modeled in a symetric multi-processor (SMP)\n");
printf_filtered("\t simulation\n");
printf_filtered("\n"); }
printf_filtered("\t-o <dev-spec> Add device <dev-spec> to the device tree\n");
if (verbose) { printf_filtered("\n"); }
printf_filtered("\t-r <ram-size> Set RAM size in bytes (OEA environments)\n");
if (verbose) { printf_filtered("\n"); }
printf_filtered("\t-t [!]<trace> Enable (disable) <trace> option\n");
if (verbose) { printf_filtered("\n"); }
printf_filtered("\n");
trace_usage(verbose);
device_usage(verbose);
if (verbose > 1) {
printf_filtered("\n");
print_options();
}
error("");
}
/* Test "string" for containing a string of digits that form a number
between "min" and "max". The return value is the number or "err". */
static
int is_num( char *string, int min, int max, int err)
{
int result = 0;
for ( ; *string; ++string)
{
if (!isdigit(*string))
{
result = err;
break;
}
result = result * 10 + (*string - '0');
}
if (result < min || result > max)
result = err;
return result;
}
INLINE_PSIM\
(char **)
psim_options(device *root,
char **argv)
{
device *current = root;
int argp;
if (argv == NULL)
return NULL;
argp = 0;
while (argv[argp] != NULL && argv[argp][0] == '-') {
char *p = argv[argp] + 1;
char *param;
while (*p != '\0') {
switch (*p) {
default:
psim_usage(0);
error ("");
break;
case 'c':
param = find_arg("Missing <count> option for -c (max-iterations)\n", &argp, argv);
tree_parse(root, "/openprom/options/max-iterations %s", param);
break;
case 'e':
param = find_arg("Missing <emul> option for -e (os-emul)\n", &argp, argv);
tree_parse(root, "/openprom/options/os-emul %s", param);
break;
case 'E':
/* endian spec, ignored for now */
param = find_arg("Missing <endian> option for -E (target-endian)\n", &argp, argv);
if (strcmp (param, "big") == 0)
tree_parse (root, "/options/little-endian? false");
else if (strcmp (param, "little") == 0)
tree_parse (root, "/options/little-endian? true");
else
{
printf_filtered ("Invalid <endian> option for -E (target-endian)\n");
psim_usage (0);
}
break;
case 'f':
param = find_arg("Missing <file> option for -f\n", &argp, argv);
psim_merge_device_file(root, param);
break;
case 'h':
case '?':
psim_usage(1);
break;
case 'H':
psim_usage(2);
break;
case 'i':
if (isdigit(p[1])) {
tree_parse(root, "/openprom/trace/print-info %c", p[1]);
p++;
}
else {
tree_parse(root, "/openprom/trace/print-info 1");
}
break;
case 'I':
tree_parse(root, "/openprom/trace/print-info 2");
tree_parse(root, "/openprom/options/model-issue %d",
MODEL_ISSUE_PROCESS);
break;
case 'm':
param = find_arg("Missing <model> option for -m (model)\n", &argp, argv);
tree_parse(root, "/openprom/options/model \"%s", param);
break;
case 'n':
param = find_arg("Missing <nr-smp> option for -n (smp)\n", &argp, argv);
tree_parse(root, "/openprom/options/smp %s", param);
break;
case 'o':
param = find_arg("Missing <dev-spec> option for -o\n", &argp, argv);
if (memcmp(param, "mpc860c0", 8) == 0)
{
if (param[8] == '\0')
tree_parse(root, "/options/mpc860c0 5");
else if (param[8] == '=' && is_num(param+9, 1, 10, 0))
{
tree_parse(root, "/options/mpc860c0 %s", param+9);
}
else error("Invalid mpc860c0 option for -o\n");
}
else
current = tree_parse(current, "%s", param);
break;
case 'r':
param = find_arg("Missing <ram-size> option for -r (oea-memory-size)\n", &argp, argv);
tree_parse(root, "/openprom/options/oea-memory-size %s",
param);
break;
case 't':
param = find_arg("Missing <trace> option for -t (trace/*)\n", &argp, argv);
if (param[0] == '!')
tree_parse(root, "/openprom/trace/%s 0", param+1);
else
tree_parse(root, "/openprom/trace/%s 1", param);
break;
}
p += 1;
}
argp += 1;
}
/* force the trace node to process its options now *before* the tree
initialization occures */
device_ioctl(tree_find_device(root, "/openprom/trace"),
NULL, 0,
device_ioctl_set_trace);
{
void semantic_init(device* root);
semantic_init(root);
}
/* return where the options end */
return argv + argp;
}
INLINE_PSIM\
(void)
psim_command(device *root,
char **argv)
{
int argp = 0;
if (argv[argp] == NULL) {
return;
}
else if (strcmp(argv[argp], "trace") == 0) {
const char *opt = find_arg("Missing <trace> option", &argp, argv);
if (opt[0] == '!')
trace_option(opt + 1, 0);
else
trace_option(opt, 1);
}
else if (strcmp(*argv, "change-media") == 0) {
char *device = find_arg("Missing device name", &argp, argv);
char *media = argv[++argp];
device_ioctl(tree_find_device(root, device), NULL, 0,
device_ioctl_change_media, media);
}
else {
printf_filtered("Unknown PSIM command %s, try\n", argv[argp]);
printf_filtered(" trace <trace-option>\n");
printf_filtered(" change-media <device> [ <new-image> ]\n");
}
}
/* create the simulator proper from the device tree and executable */
INLINE_PSIM\
(psim *)
psim_create(const char *file_name,
device *root)
{
int cpu_nr;
const char *env;
psim *system;
os_emul *os_emulation;
int nr_cpus;
/* given this partially populated device tree, os_emul_create() uses
it and file_name to determine the selected emulation and hence
further populate the tree with any other required nodes. */
os_emulation = os_emul_create(file_name, root);
if (os_emulation == NULL)
error("psim: either file %s was not reconized or unreconized or unknown os-emulation type\n", file_name);
/* fill in the missing real number of CPU's */
nr_cpus = tree_find_integer_property(root, "/openprom/options/smp");
if (MAX_NR_PROCESSORS < nr_cpus)
error("target and configured number of cpus conflict\n");
/* fill in the missing TARGET BYTE ORDER information */
current_target_byte_order
= (tree_find_boolean_property(root, "/options/little-endian?")
? LITTLE_ENDIAN
: BIG_ENDIAN);
if (CURRENT_TARGET_BYTE_ORDER != current_target_byte_order)
error("target and configured byte order conflict\n");
/* fill in the missing HOST BYTE ORDER information */
current_host_byte_order = (current_host_byte_order = 1,
(*(char*)(&current_host_byte_order)
? LITTLE_ENDIAN
: BIG_ENDIAN));
if (CURRENT_HOST_BYTE_ORDER != current_host_byte_order)
error("host and configured byte order conflict\n");
/* fill in the missing OEA/VEA information */
env = tree_find_string_property(root, "/openprom/options/env");
current_environment = ((strcmp(env, "user") == 0
|| strcmp(env, "uea") == 0)
? USER_ENVIRONMENT
: (strcmp(env, "virtual") == 0
|| strcmp(env, "vea") == 0)
? VIRTUAL_ENVIRONMENT
: (strcmp(env, "operating") == 0
|| strcmp(env, "oea") == 0)
? OPERATING_ENVIRONMENT
: 0);
if (current_environment == 0)
error("unreconized /options env property\n");
if (CURRENT_ENVIRONMENT != current_environment)
error("target and configured environment conflict\n");
/* fill in the missing ALLIGNMENT information */
current_alignment
= (tree_find_boolean_property(root, "/openprom/options/strict-alignment?")
? STRICT_ALIGNMENT
: NONSTRICT_ALIGNMENT);
if (CURRENT_ALIGNMENT != current_alignment)
error("target and configured alignment conflict\n");
/* fill in the missing FLOATING POINT information */
current_floating_point
= (tree_find_boolean_property(root, "/openprom/options/floating-point?")
? HARD_FLOATING_POINT
: SOFT_FLOATING_POINT);
if (CURRENT_FLOATING_POINT != current_floating_point)
error("target and configured floating-point conflict\n");
/* fill in the missing STDIO information */
current_stdio
= (tree_find_boolean_property(root, "/openprom/options/use-stdio?")
? DO_USE_STDIO
: DONT_USE_STDIO);
if (CURRENT_STDIO != current_stdio)
error("target and configured stdio interface conflict\n");
/* sort out the level of detail for issue modeling */
current_model_issue
= tree_find_integer_property(root, "/openprom/options/model-issue");
if (CURRENT_MODEL_ISSUE != current_model_issue)
error("target and configured model-issue conflict\n");
/* sort out our model architecture - wrong.
FIXME: this should be obtaining the required information from the
device tree via the "/chosen" property "cpu" which is an instance
(ihandle) for the only executing processor. By converting that
ihandle into the corresponding cpu's phandle and then querying
the "name" property, the cpu type can be determined. Ok? */
model_set(tree_find_string_property(root, "/openprom/options/model"));
/* create things */
system = ZALLOC(psim);
system->events = event_queue_create();
system->memory = core_from_device(root);
system->monitor = mon_create();
system->nr_cpus = nr_cpus;
system->os_emulation = os_emulation;
system->devices = root;
/* now all the processors attaching to each their per-cpu information */
for (cpu_nr = 0; cpu_nr < MAX_NR_PROCESSORS; cpu_nr++) {
system->processors[cpu_nr] = cpu_create(system,
system->memory,
mon_cpu(system->monitor,
cpu_nr),
system->os_emulation,
cpu_nr);
}
/* dump out the contents of the device tree */
if (ppc_trace[trace_print_device_tree] || ppc_trace[trace_dump_device_tree])
tree_print(root);
if (ppc_trace[trace_dump_device_tree])
error("");
return system;
}
/* allow the simulation to stop/restart abnormaly */
INLINE_PSIM\
(void)
psim_set_halt_and_restart(psim *system,
void *halt_jmp_buf,
void *restart_jmp_buf)
{
system->path_to_halt = halt_jmp_buf;
system->path_to_restart = restart_jmp_buf;
}
INLINE_PSIM\
(void)
psim_clear_halt_and_restart(psim *system)
{
system->path_to_halt = NULL;
system->path_to_restart = NULL;
}
INLINE_PSIM\
(void)
psim_restart(psim *system,
int current_cpu)
{
ASSERT(current_cpu >= 0 && current_cpu < system->nr_cpus);
ASSERT(system->path_to_restart != NULL);
system->last_cpu = current_cpu;
longjmp(*(jmp_buf*)(system->path_to_restart), current_cpu + 1);
}
static void
cntrl_c_simulation(void *data)
{
psim *system = data;
psim_halt(system,
psim_nr_cpus(system),
was_continuing,
SIGINT);
}
INLINE_PSIM\
(void)
psim_stop(psim *system)
{
event_queue_schedule_after_signal(psim_event_queue(system),
0 /*NOW*/,
cntrl_c_simulation,
system);
}
INLINE_PSIM\
(void)
psim_halt(psim *system,
int current_cpu,
stop_reason reason,
int signal)
{
ASSERT(current_cpu >= 0 && current_cpu <= system->nr_cpus);
ASSERT(system->path_to_halt != NULL);
system->last_cpu = current_cpu;
system->halt_status.reason = reason;
system->halt_status.signal = signal;
if (current_cpu == system->nr_cpus) {
system->halt_status.cpu_nr = 0;
system->halt_status.program_counter =
cpu_get_program_counter(system->processors[0]);
}
else {
system->halt_status.cpu_nr = current_cpu;
system->halt_status.program_counter =
cpu_get_program_counter(system->processors[current_cpu]);
}
longjmp(*(jmp_buf*)(system->path_to_halt), current_cpu + 1);
}
INLINE_PSIM\
(int)
psim_last_cpu(psim *system)
{
return system->last_cpu;
}
INLINE_PSIM\
(int)
psim_nr_cpus(psim *system)
{
return system->nr_cpus;
}
INLINE_PSIM\
(psim_status)
psim_get_status(psim *system)
{
return system->halt_status;
}
INLINE_PSIM\
(cpu *)
psim_cpu(psim *system,
int cpu_nr)
{
if (cpu_nr < 0 || cpu_nr >= system->nr_cpus)
return NULL;
else
return system->processors[cpu_nr];
}
INLINE_PSIM\
(device *)
psim_device(psim *system,
const char *path)
{
return tree_find_device(system->devices, path);
}
INLINE_PSIM\
(event_queue *)
psim_event_queue(psim *system)
{
return system->events;
}
STATIC_INLINE_PSIM\
(void)
psim_max_iterations_exceeded(void *data)
{
psim *system = data;
psim_halt(system,
system->nr_cpus, /* halted during an event */
was_signalled,
-1);
}
INLINE_PSIM\
(void)
psim_init(psim *system)
{
int cpu_nr;
/* scrub the monitor */
mon_init(system->monitor, system->nr_cpus);
/* trash any pending events */
event_queue_init(system->events);
/* if needed, schedule a halt event. FIXME - In the future this
will be replaced by a more generic change to psim_command(). A
new command `schedule NNN halt' being added. */
if (tree_find_property(system->devices, "/openprom/options/max-iterations")) {
event_queue_schedule(system->events,
tree_find_integer_property(system->devices,
"/openprom/options/max-iterations") - 2,
psim_max_iterations_exceeded,
system);
}
/* scrub all the cpus */
for (cpu_nr = 0; cpu_nr < system->nr_cpus; cpu_nr++)
cpu_init(system->processors[cpu_nr]);
/* init all the devices (which updates the cpus) */
tree_init(system->devices, system);
/* and the emulation (which needs an initialized device tree) */
os_emul_init(system->os_emulation, system->nr_cpus);
/* now sync each cpu against the initialized state of its registers */
for (cpu_nr = 0; cpu_nr < system->nr_cpus; cpu_nr++) {
cpu *processor = system->processors[cpu_nr];
cpu_synchronize_context(processor, cpu_get_program_counter(processor));
cpu_page_tlb_invalidate_all(processor);
}
/* force loop to start with first cpu */
system->last_cpu = -1;
}
INLINE_PSIM\
(void)
psim_stack(psim *system,
char **argv,
char **envp)
{
/* pass the stack device the argv/envp and let it work out what to
do with it */
device *stack_device = tree_find_device(system->devices,
"/openprom/init/stack");
if (stack_device != (device*)0) {
unsigned_word stack_pointer;
psim_read_register(system, 0, &stack_pointer, "sp", cooked_transfer);
device_ioctl(stack_device,
NULL, /*cpu*/
0, /*cia*/
device_ioctl_create_stack,
stack_pointer,
argv,
envp);
}
}
/* SIMULATE INSTRUCTIONS, various different ways of achieving the same
thing */
INLINE_PSIM\
(void)
psim_step(psim *system)
{
volatile int keep_running = 0;
idecode_run_until_stop(system, &keep_running,
system->events, system->processors, system->nr_cpus);
}
INLINE_PSIM\
(void)
psim_run(psim *system)
{
idecode_run(system,
system->events, system->processors, system->nr_cpus);
}
/* storage manipulation functions */
INLINE_PSIM\
(void)
psim_read_register(psim *system,
int which_cpu,
void *buf,
const char reg[],
transfer_mode mode)
{
register_descriptions description;
char cooked_buf[sizeof(unsigned_8)];
cpu *processor;
/* find our processor */
if (which_cpu == MAX_NR_PROCESSORS) {
if (system->last_cpu == system->nr_cpus
|| system->last_cpu == -1)
which_cpu = 0;
else
which_cpu = system->last_cpu;
}
ASSERT(which_cpu >= 0 && which_cpu < system->nr_cpus);
processor = system->processors[which_cpu];
/* find the register description */
description = register_description(reg);
if (description.type == reg_invalid)
error("psim_read_register() invalid register name `%s'\n", reg);
/* get the cooked value */
switch (description.type) {
case reg_gpr:
*(gpreg*)cooked_buf = cpu_registers(processor)->gpr[description.index];
break;
case reg_spr:
*(spreg*)cooked_buf = cpu_registers(processor)->spr[description.index];
break;
case reg_sr:
*(sreg*)cooked_buf = cpu_registers(processor)->sr[description.index];
break;
case reg_fpr:
*(fpreg*)cooked_buf = cpu_registers(processor)->fpr[description.index];
break;
case reg_pc:
*(unsigned_word*)cooked_buf = cpu_get_program_counter(processor);
break;
case reg_cr:
*(creg*)cooked_buf = cpu_registers(processor)->cr;
break;
case reg_msr:
*(msreg*)cooked_buf = cpu_registers(processor)->msr;
break;
case reg_fpscr:
*(fpscreg*)cooked_buf = cpu_registers(processor)->fpscr;
break;
case reg_insns:
*(unsigned_word*)cooked_buf = mon_get_number_of_insns(system->monitor,
which_cpu);
break;
case reg_stalls:
if (cpu_model(processor) == NULL)
error("$stalls only valid if processor unit model enabled (-I)\n");
*(unsigned_word*)cooked_buf = model_get_number_of_stalls(cpu_model(processor));
break;
case reg_cycles:
if (cpu_model(processor) == NULL)
error("$cycles only valid if processor unit model enabled (-I)\n");
*(unsigned_word*)cooked_buf = model_get_number_of_cycles(cpu_model(processor));
break;
default:
printf_filtered("psim_read_register(processor=0x%lx,buf=0x%lx,reg=%s) %s\n",
(unsigned long)processor, (unsigned long)buf, reg,
"read of this register unimplemented");
break;
}
/* the PSIM internal values are in host order. To fetch raw data,
they need to be converted into target order and then returned */
if (mode == raw_transfer) {
/* FIXME - assumes that all registers are simple integers */
switch (description.size) {
case 1:
*(unsigned_1*)buf = H2T_1(*(unsigned_1*)cooked_buf);
break;
case 2:
*(unsigned_2*)buf = H2T_2(*(unsigned_2*)cooked_buf);
break;
case 4:
*(unsigned_4*)buf = H2T_4(*(unsigned_4*)cooked_buf);
break;
case 8:
*(unsigned_8*)buf = H2T_8(*(unsigned_8*)cooked_buf);
break;
}
}
else {
memcpy(buf/*dest*/, cooked_buf/*src*/, description.size);
}
}
INLINE_PSIM\
(void)
psim_write_register(psim *system,
int which_cpu,
const void *buf,
const char reg[],
transfer_mode mode)
{
cpu *processor;
register_descriptions description;
char cooked_buf[sizeof(unsigned_8)];
/* find our processor */
if (which_cpu == MAX_NR_PROCESSORS) {
if (system->last_cpu == system->nr_cpus
|| system->last_cpu == -1)
which_cpu = 0;
else
which_cpu = system->last_cpu;
}
if (which_cpu == -1) {
int i;
for (i = 0; i < system->nr_cpus; i++)
psim_write_register(system, i, buf, reg, mode);
return;
}
ASSERT(which_cpu >= 0 && which_cpu < system->nr_cpus);
processor = system->processors[which_cpu];
/* find the description of the register */
description = register_description(reg);
if (description.type == reg_invalid)
error("psim_write_register() invalid register name %s\n", reg);
/* If the data is comming in raw (target order), need to cook it
into host order before putting it into PSIM's internal structures */
if (mode == raw_transfer) {
switch (description.size) {
case 1:
*(unsigned_1*)cooked_buf = T2H_1(*(unsigned_1*)buf);
break;
case 2:
*(unsigned_2*)cooked_buf = T2H_2(*(unsigned_2*)buf);
break;
case 4:
*(unsigned_4*)cooked_buf = T2H_4(*(unsigned_4*)buf);
break;
case 8:
*(unsigned_8*)cooked_buf = T2H_8(*(unsigned_8*)buf);
break;
}
}
else {
memcpy(cooked_buf/*dest*/, buf/*src*/, description.size);
}
/* put the cooked value into the register */
switch (description.type) {
case reg_gpr:
cpu_registers(processor)->gpr[description.index] = *(gpreg*)cooked_buf;
break;
case reg_fpr:
cpu_registers(processor)->fpr[description.index] = *(fpreg*)cooked_buf;
break;
case reg_pc:
cpu_set_program_counter(processor, *(unsigned_word*)cooked_buf);
break;
case reg_spr:
cpu_registers(processor)->spr[description.index] = *(spreg*)cooked_buf;
break;
case reg_sr:
cpu_registers(processor)->sr[description.index] = *(sreg*)cooked_buf;
break;
case reg_cr:
cpu_registers(processor)->cr = *(creg*)cooked_buf;
break;
case reg_msr:
cpu_registers(processor)->msr = *(msreg*)cooked_buf;
break;
case reg_fpscr:
cpu_registers(processor)->fpscr = *(fpscreg*)cooked_buf;
break;
default:
printf_filtered("psim_write_register(processor=0x%lx,cooked_buf=0x%lx,reg=%s) %s\n",
(unsigned long)processor, (unsigned long)cooked_buf, reg,
"read of this register unimplemented");
break;
}
}
INLINE_PSIM\
(unsigned)
psim_read_memory(psim *system,
int which_cpu,
void *buffer,
unsigned_word vaddr,
unsigned nr_bytes)
{
cpu *processor;
if (which_cpu == MAX_NR_PROCESSORS) {
if (system->last_cpu == system->nr_cpus
|| system->last_cpu == -1)
which_cpu = 0;
else
which_cpu = system->last_cpu;
}
processor = system->processors[which_cpu];
return vm_data_map_read_buffer(cpu_data_map(processor),
buffer, vaddr, nr_bytes,
NULL, -1);
}
INLINE_PSIM\
(unsigned)
psim_write_memory(psim *system,
int which_cpu,
const void *buffer,
unsigned_word vaddr,
unsigned nr_bytes,
int violate_read_only_section)
{
cpu *processor;
if (which_cpu == MAX_NR_PROCESSORS) {
if (system->last_cpu == system->nr_cpus
|| system->last_cpu == -1)
which_cpu = 0;
else
which_cpu = system->last_cpu;
}
ASSERT(which_cpu >= 0 && which_cpu < system->nr_cpus);
processor = system->processors[which_cpu];
return vm_data_map_write_buffer(cpu_data_map(processor),
buffer, vaddr, nr_bytes, 1/*violate-read-only*/,
NULL, -1);
}
INLINE_PSIM\
(void)
psim_print_info(psim *system,
int verbose)
{
mon_print_info(system, system->monitor, verbose);
}
/* Merge a device tree and a device file. */
INLINE_PSIM\
(void)
psim_merge_device_file(device *root,
const char *file_name)
{
FILE *description;
int line_nr;
char device_path[1000];
device *current;
/* try opening the file */
description = fopen(file_name, "r");
if (description == NULL) {
perror(file_name);
error("Invalid file %s specified", file_name);
}
line_nr = 0;
current = root;
while (fgets(device_path, sizeof(device_path), description)) {
char *device;
/* check that the full line was read */
if (strchr(device_path, '\n') == NULL) {
fclose(description);
error("%s:%d: line to long - %s",
file_name, line_nr, device_path);
}
else
*strchr(device_path, '\n') = '\0';
line_nr++;
/* skip comments ("#" or ";") and blank lines lines */
for (device = device_path;
*device != '\0' && isspace(*device);
device++);
if (device[0] == '#'
|| device[0] == ';'
|| device[0] == '\0')
continue;
/* merge any appended lines */
while (device_path[strlen(device_path) - 1] == '\\') {
int curlen = strlen(device_path) - 1;
/* zap \ */
device_path[curlen] = '\0';
/* append the next line */
if (!fgets(device_path + curlen, sizeof(device_path) - curlen, description)) {
fclose(description);
error("%s:%s: unexpected eof in line continuation - %s",
file_name, line_nr, device_path);
}
if (strchr(device_path, '\n') == NULL) {
fclose(description);
error("%s:%d: line to long - %s",
file_name, line_nr, device_path);
}
else
*strchr(device_path, '\n') = '\0';
line_nr++;
}
/* parse this line */
current = tree_parse(current, "%s", device);
}
fclose(description);
}
#endif /* _PSIM_C_ */
Reference in New Issue View Git Blame Copy Permalink