218 lines
6.1 KiB
C
218 lines
6.1 KiB
C
/* fr30 exception, interrupt, and trap (EIT) support
|
||
Copyright (C) 1998, 1999 Free Software Foundation, Inc.
|
||
Contributed by Cygnus Solutions.
|
||
|
||
This file is part of the GNU simulators.
|
||
|
||
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, 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. */
|
||
|
||
#include "sim-main.h"
|
||
#include "targ-vals.h"
|
||
#include "cgen-engine.h"
|
||
|
||
/* The semantic code invokes this for invalid (unrecognized) instructions. */
|
||
|
||
SEM_PC
|
||
sim_engine_invalid_insn (SIM_CPU *current_cpu, IADDR cia, SEM_PC vpc)
|
||
{
|
||
SIM_DESC sd = CPU_STATE (current_cpu);
|
||
|
||
#if 0
|
||
if (STATE_ENVIRONMENT (sd) == OPERATING_ENVIRONMENT)
|
||
{
|
||
h_bsm_set (current_cpu, h_sm_get (current_cpu));
|
||
h_bie_set (current_cpu, h_ie_get (current_cpu));
|
||
h_bcond_set (current_cpu, h_cond_get (current_cpu));
|
||
/* sm not changed */
|
||
h_ie_set (current_cpu, 0);
|
||
h_cond_set (current_cpu, 0);
|
||
|
||
h_bpc_set (current_cpu, cia);
|
||
|
||
sim_engine_restart (CPU_STATE (current_cpu), current_cpu, NULL,
|
||
EIT_RSVD_INSN_ADDR);
|
||
}
|
||
else
|
||
#endif
|
||
sim_engine_halt (sd, current_cpu, NULL, cia, sim_stopped, SIM_SIGILL);
|
||
return vpc;
|
||
}
|
||
|
||
/* Process an address exception. */
|
||
|
||
void
|
||
fr30_core_signal (SIM_DESC sd, SIM_CPU *current_cpu, sim_cia cia,
|
||
unsigned int map, int nr_bytes, address_word addr,
|
||
transfer_type transfer, sim_core_signals sig)
|
||
{
|
||
#if 0
|
||
if (STATE_ENVIRONMENT (sd) == OPERATING_ENVIRONMENT)
|
||
{
|
||
h_bsm_set (current_cpu, h_sm_get (current_cpu));
|
||
h_bie_set (current_cpu, h_ie_get (current_cpu));
|
||
h_bcond_set (current_cpu, h_cond_get (current_cpu));
|
||
/* sm not changed */
|
||
h_ie_set (current_cpu, 0);
|
||
h_cond_set (current_cpu, 0);
|
||
|
||
h_bpc_set (current_cpu, cia);
|
||
|
||
sim_engine_restart (CPU_STATE (current_cpu), current_cpu, NULL,
|
||
EIT_ADDR_EXCP_ADDR);
|
||
}
|
||
else
|
||
#endif
|
||
sim_core_signal (sd, current_cpu, cia, map, nr_bytes, addr,
|
||
transfer, sig);
|
||
}
|
||
|
||
/* Read/write functions for system call interface. */
|
||
|
||
static int
|
||
syscall_read_mem (host_callback *cb, struct cb_syscall *sc,
|
||
unsigned long taddr, char *buf, int bytes)
|
||
{
|
||
SIM_DESC sd = (SIM_DESC) sc->p1;
|
||
SIM_CPU *cpu = (SIM_CPU *) sc->p2;
|
||
|
||
return sim_core_read_buffer (sd, cpu, read_map, buf, taddr, bytes);
|
||
}
|
||
|
||
static int
|
||
syscall_write_mem (host_callback *cb, struct cb_syscall *sc,
|
||
unsigned long taddr, const char *buf, int bytes)
|
||
{
|
||
SIM_DESC sd = (SIM_DESC) sc->p1;
|
||
SIM_CPU *cpu = (SIM_CPU *) sc->p2;
|
||
|
||
return sim_core_write_buffer (sd, cpu, write_map, buf, taddr, bytes);
|
||
}
|
||
|
||
/* Subroutine of fr30_int to save the PS and PC and setup for INT and INTE. */
|
||
|
||
static void
|
||
setup_int (SIM_CPU *current_cpu, PCADDR pc)
|
||
{
|
||
USI ssp = fr30bf_h_dr_get (current_cpu, H_DR_SSP);
|
||
USI ps = fr30bf_h_ps_get (current_cpu);
|
||
|
||
ssp -= 4;
|
||
SETMEMSI (current_cpu, pc, ssp, ps);
|
||
ssp -= 4;
|
||
SETMEMSI (current_cpu, pc, ssp, pc + 2);
|
||
fr30bf_h_dr_set (current_cpu, H_DR_SSP, ssp);
|
||
fr30bf_h_sbit_set (current_cpu, 0);
|
||
}
|
||
|
||
/* Trap support.
|
||
The result is the pc address to continue at.
|
||
Preprocessing like saving the various registers has already been done. */
|
||
|
||
USI
|
||
fr30_int (SIM_CPU *current_cpu, PCADDR pc, int num)
|
||
{
|
||
SIM_DESC sd = CPU_STATE (current_cpu);
|
||
host_callback *cb = STATE_CALLBACK (sd);
|
||
|
||
#ifdef SIM_HAVE_BREAKPOINTS
|
||
/* Check for breakpoints "owned" by the simulator first, regardless
|
||
of --environment. */
|
||
if (num == TRAP_BREAKPOINT)
|
||
{
|
||
/* First try sim-break.c. If it's a breakpoint the simulator "owns"
|
||
it doesn't return. Otherwise it returns and let's us try. */
|
||
sim_handle_breakpoint (sd, current_cpu, pc);
|
||
/* Fall through. */
|
||
}
|
||
#endif
|
||
|
||
if (STATE_ENVIRONMENT (sd) == OPERATING_ENVIRONMENT)
|
||
{
|
||
/* The new pc is the trap vector entry.
|
||
We assume there's a branch there to some handler. */
|
||
USI new_pc;
|
||
setup_int (current_cpu, pc);
|
||
fr30bf_h_ibit_set (current_cpu, 0);
|
||
new_pc = GETMEMSI (current_cpu, pc,
|
||
fr30bf_h_dr_get (current_cpu, H_DR_TBR)
|
||
+ 1024 - ((num + 1) * 4));
|
||
return new_pc;
|
||
}
|
||
|
||
switch (num)
|
||
{
|
||
case TRAP_SYSCALL :
|
||
{
|
||
/* TODO: find out what the ABI for this is */
|
||
CB_SYSCALL s;
|
||
|
||
CB_SYSCALL_INIT (&s);
|
||
s.func = fr30bf_h_gr_get (current_cpu, 0);
|
||
s.arg1 = fr30bf_h_gr_get (current_cpu, 4);
|
||
s.arg2 = fr30bf_h_gr_get (current_cpu, 5);
|
||
s.arg3 = fr30bf_h_gr_get (current_cpu, 6);
|
||
|
||
if (s.func == TARGET_SYS_exit)
|
||
{
|
||
sim_engine_halt (sd, current_cpu, NULL, pc, sim_exited, s.arg1);
|
||
}
|
||
|
||
s.p1 = (PTR) sd;
|
||
s.p2 = (PTR) current_cpu;
|
||
s.read_mem = syscall_read_mem;
|
||
s.write_mem = syscall_write_mem;
|
||
cb_syscall (cb, &s);
|
||
fr30bf_h_gr_set (current_cpu, 2, s.errcode); /* TODO: check this one */
|
||
fr30bf_h_gr_set (current_cpu, 4, s.result);
|
||
fr30bf_h_gr_set (current_cpu, 1, s.result2); /* TODO: check this one */
|
||
break;
|
||
}
|
||
|
||
case TRAP_BREAKPOINT:
|
||
sim_engine_halt (sd, current_cpu, NULL, pc,
|
||
sim_stopped, SIM_SIGTRAP);
|
||
break;
|
||
|
||
default :
|
||
{
|
||
USI new_pc;
|
||
setup_int (current_cpu, pc);
|
||
fr30bf_h_ibit_set (current_cpu, 0);
|
||
new_pc = GETMEMSI (current_cpu, pc,
|
||
fr30bf_h_dr_get (current_cpu, H_DR_TBR)
|
||
+ 1024 - ((num + 1) * 4));
|
||
return new_pc;
|
||
}
|
||
}
|
||
|
||
/* Fake an "reti" insn.
|
||
Since we didn't push anything to stack, all we need to do is
|
||
update pc. */
|
||
return pc + 2;
|
||
}
|
||
|
||
USI
|
||
fr30_inte (SIM_CPU *current_cpu, PCADDR pc, int num)
|
||
{
|
||
/* The new pc is the trap #9 vector entry.
|
||
We assume there's a branch there to some handler. */
|
||
USI new_pc;
|
||
setup_int (current_cpu, pc);
|
||
fr30bf_h_ilm_set (current_cpu, 4);
|
||
new_pc = GETMEMSI (current_cpu, pc,
|
||
fr30bf_h_dr_get (current_cpu, H_DR_TBR)
|
||
+ 1024 - ((9 + 1) * 4));
|
||
return new_pc;
|
||
}
|