#include "sim-main.h"
#include "sim-options.h"
#include "v850_sim.h"
#include "sim-assert.h"
#include "itable.h"
#ifdef HAVE_STDLIB_H
#include <stdlib.h>
#endif
#ifdef HAVE_STRING_H
#include <string.h>
#else
#ifdef HAVE_STRINGS_H
#include <strings.h>
#endif
#endif
#include "bfd.h"
#ifndef INLINE
#ifdef __GNUC__
#define INLINE inline
#else
#define INLINE
#endif
#endif
static const char * get_insn_name (sim_cpu *, int);
SIM_DESC simulator;
enum interrupt_type
{
int_reset,
int_nmi,
int_intov1,
int_intp10,
int_intp11,
int_intp12,
int_intp13,
int_intcm4,
num_int_types
};
char *interrupt_names[] = {
"reset",
"nmi",
"intov1",
"intp10",
"intp11",
"intp12",
"intp13",
"intcm4",
NULL
};
static void
do_interrupt (sd, data)
SIM_DESC sd;
void *data;
{
char **interrupt_name = (char**)data;
enum interrupt_type inttype;
inttype = (interrupt_name - STATE_WATCHPOINTS (sd)->interrupt_names);
if (inttype == int_reset)
{
PC = 0;
PSW = 0x20;
ECR = 0;
sim_engine_restart (sd, NULL, NULL, NULL_CIA);
}
if (inttype == int_nmi)
{
if (PSW & PSW_NP)
{
if (STATE_CPU (sd, 0)->pending_nmi != NULL)
sim_events_deschedule (sd, STATE_CPU (sd, 0)->pending_nmi);
STATE_CPU (sd, 0)->pending_nmi =
sim_events_schedule (sd, 1, do_interrupt, data);
return;
}
else
{
FEPC = PC;
FEPSW = PSW;
ECR &= 0x0000ffff;
ECR |= 0x10;
PSW |= PSW_NP;
PSW &= ~PSW_EP;
PSW |= PSW_ID;
PC = 0x10;
sim_engine_restart (sd, NULL, NULL, NULL_CIA);
}
}
if (inttype > int_nmi && inttype < num_int_types)
{
if ((PSW & PSW_NP) || (PSW & PSW_ID))
{
sim_events_schedule (sd, 1, do_interrupt, data);
return;
}
else
{
EIPC = PC;
EIPSW = PSW;
PSW |= PSW_ID;
PSW &= ~PSW_EP;
ECR &= 0xffff0000;
switch (inttype)
{
case int_intov1:
PC = 0x80;
ECR |= 0x80;
break;
case int_intp10:
PC = 0x90;
ECR |= 0x90;
break;
case int_intp11:
PC = 0xa0;
ECR |= 0xa0;
break;
case int_intp12:
PC = 0xb0;
ECR |= 0xb0;
break;
case int_intp13:
PC = 0xc0;
ECR |= 0xc0;
break;
case int_intcm4:
PC = 0xd0;
ECR |= 0xd0;
break;
default:
sim_engine_abort (sd, NULL, NULL_CIA,
"do_interrupt - internal error - bad switch");
break;
}
}
sim_engine_restart (sd, NULL, NULL, NULL_CIA);
}
sim_engine_abort (sd, NULL, NULL_CIA,
"do_interrupt - internal error - interrupt %d unknown",
inttype);
}
static const char *
get_insn_name (sim_cpu *cpu, int i)
{
return itable[i].name;
}
uint32 OP[4];
SIM_DESC
sim_open (kind, cb, abfd, argv)
SIM_OPEN_KIND kind;
host_callback *cb;
struct _bfd *abfd;
char **argv;
{
SIM_DESC sd = sim_state_alloc (kind, cb);
int mach;
SIM_ASSERT (STATE_MAGIC (sd) == SIM_MAGIC_NUMBER);
simulator = sd;
STATE_WATCHPOINTS (sd)->pc = &(PC);
STATE_WATCHPOINTS (sd)->sizeof_pc = sizeof (PC);
STATE_WATCHPOINTS (sd)->interrupt_handler = do_interrupt;
STATE_WATCHPOINTS (sd)->interrupt_names = interrupt_names;
CPU_INSN_NAME (STATE_CPU (sd, 0)) = get_insn_name;
CPU_MAX_INSNS (STATE_CPU (sd, 0)) = nr_itable_entries;
if (sim_pre_argv_init (sd, argv[0]) != SIM_RC_OK)
return 0;
sim_do_commandf (sd, "memory region 0,0x100000,0x%lx", V850_ROM_SIZE);
sim_do_commandf (sd, "memory region 0x100000,0x%lx", V850_LOW_END-0x100000);
sim_do_command (sd, "memory region 0xfff000,0x1000,1024");
sim_do_command (sd, "memory region 0xffe000,0x1000,1024");
if (sim_parse_args (sd, argv) != SIM_RC_OK)
{
sim_module_uninstall (sd);
return 0;
}
if (sim_analyze_program (sd,
(STATE_PROG_ARGV (sd) != NULL
? *STATE_PROG_ARGV (sd)
: NULL),
abfd) != SIM_RC_OK)
{
sim_module_uninstall (sd);
return 0;
}
if (sim_config (sd) != SIM_RC_OK)
{
sim_module_uninstall (sd);
return 0;
}
if (sim_post_argv_init (sd) != SIM_RC_OK)
{
sim_module_uninstall (sd);
return 0;
}
if (STATE_ARCHITECTURE (sd) != NULL
&& STATE_ARCHITECTURE (sd)->arch == bfd_arch_v850)
mach = STATE_ARCHITECTURE (sd)->mach;
else
mach = bfd_mach_v850;
switch (mach)
{
case bfd_mach_v850:
case bfd_mach_v850e:
STATE_CPU (sd, 0)->psw_mask = (PSW_NP | PSW_EP | PSW_ID | PSW_SAT
| PSW_CY | PSW_OV | PSW_S | PSW_Z);
break;
}
return sd;
}
void
sim_close (sd, quitting)
SIM_DESC sd;
int quitting;
{
sim_module_uninstall (sd);
}
SIM_RC
sim_create_inferior (sd, prog_bfd, argv, env)
SIM_DESC sd;
struct _bfd *prog_bfd;
char **argv;
char **env;
{
memset (&State, 0, sizeof (State));
if (prog_bfd != NULL)
PC = bfd_get_start_address (prog_bfd);
return SIM_RC_OK;
}
int
sim_fetch_register (sd, rn, memory, length)
SIM_DESC sd;
int rn;
unsigned char *memory;
int length;
{
*(unsigned32*)memory = H2T_4 (State.regs[rn]);
return -1;
}
int
sim_store_register (sd, rn, memory, length)
SIM_DESC sd;
int rn;
unsigned char *memory;
int length;
{
State.regs[rn] = T2H_4 (*(unsigned32*)memory);
return -1;
}
void
sim_do_command (sd, cmd)
SIM_DESC sd;
char *cmd;
{
char *mm_cmd = "memory-map";
char *int_cmd = "interrupt";
if (sim_args_command (sd, cmd) != SIM_RC_OK)
{
if (strncmp (cmd, mm_cmd, strlen (mm_cmd) == 0))
sim_io_eprintf (sd, "`memory-map' command replaced by `sim memory'\n");
else if (strncmp (cmd, int_cmd, strlen (int_cmd)) == 0)
sim_io_eprintf (sd, "`interrupt' command replaced by `sim watch'\n");
else
sim_io_eprintf (sd, "Unknown command `%s'\n", cmd);
}
}