]> git.ipfire.org Git - thirdparty/binutils-gdb.git/blobdiff - sim/mn10300/interp.c
Automatic date update in version.in
[thirdparty/binutils-gdb.git] / sim / mn10300 / interp.c
index a85c2655729886e76d9f8d5aa8854d8ec526f1f1..541d4b14668cc81cd76d11cd54263e23e2064a3a 100644 (file)
+/* This must come before any other includes.  */
+#include "defs.h"
+
 #include <signal.h>
-#include "sysdep.h"
+
+#include "sim-main.h"
+#include "sim-options.h"
+#include "sim-hw.h"
+
 #include "bfd.h"
+#include "sim-assert.h"
 
-#include "mn10300_sim.h"
+#include <stdlib.h>
+#include <string.h>
 
-#ifndef INLINE
-#ifdef __GNUC__
-#define INLINE inline
-#else
-#define INLINE
-#endif
-#endif
+#include "bfd.h"
+
+
+struct _state State;
 
-host_callback *mn10300_callback;
-int mn10300_debug;
 
-uint32 OP[4];
+/* simulation target board.  NULL=default configuration */
+static char* board = NULL;
 
-static struct hash_entry *lookup_hash PARAMS ((uint32 ins, int));
-static long hash PARAMS ((long));
-static void init_system PARAMS ((void));
-#define MAX_HASH  63
+static DECLARE_OPTION_HANDLER (mn10300_option_handler);
+
+enum {
+  OPTION_BOARD = OPTION_START,
+};
+
+static SIM_RC
+mn10300_option_handler (SIM_DESC sd,
+                       sim_cpu *cpu,
+                       int opt,
+                       char *arg,
+                       int is_command)
+{
+  int cpu_nr;
+  switch (opt)
+    {
+    case OPTION_BOARD:
+      {
+       if (arg)
+         {
+           board = zalloc(strlen(arg) + 1);
+           strcpy(board, arg);
+         }
+       return SIM_RC_OK;
+      }
+    }
+  
+  return SIM_RC_OK;
+}
 
-struct hash_entry
+static const OPTION mn10300_options[] = 
 {
-  struct hash_entry *next;
-  long opcode;
-  long mask;
-  struct simops *ops;
+#define BOARD_AM32 "stdeval1"
+  { {"board", required_argument, NULL, OPTION_BOARD},
+     '\0', "none" /* rely on compile-time string concatenation for other options */
+           "|" BOARD_AM32
+    , "Customize simulation for a particular board.", mn10300_option_handler },
+
+  { {NULL, no_argument, NULL, 0}, '\0', NULL, NULL, NULL }
 };
 
-struct hash_entry hash_table[MAX_HASH+1];
+/* For compatibility */
+SIM_DESC simulator;
 
+static sim_cia
+mn10300_pc_get (sim_cpu *cpu)
+{
+  return PC;
+}
 
-/* This probably doesn't do a very good job at bucket filling, but
-   it's simple... */
-static INLINE long 
-hash(insn)
-     long insn;
+static void
+mn10300_pc_set (sim_cpu *cpu, sim_cia pc)
 {
-  /* These are one byte insns.  */
-  if ((insn & 0xffffff00) == 0)
-    {
-      if ((insn & 0xf0) == 0x00
-         || (insn & 0xf0) == 0x40)
-       return (insn & 0xf3) & 0x3f;
+  PC = pc;
+}
 
-      if ((insn & 0xf0) == 0x10
-         || (insn & 0xf0) == 0x30
-         || (insn & 0xf0) == 0x50)
-       return (insn & 0xfc) & 0x3f;
+static int mn10300_reg_fetch (SIM_CPU *, int, unsigned char *, int);
+static int mn10300_reg_store (SIM_CPU *, int, unsigned char *, int);
 
-      if ((insn & 0xf0) == 0x60
-         || (insn & 0xf0) == 0x70
-         || (insn & 0xf0) == 0x80
-         || (insn & 0xf0) == 0x90
-         || (insn & 0xf0) == 0xa0
-         || (insn & 0xf0) == 0xb0
-         || (insn & 0xf0) == 0xe0)
-       return (insn & 0xf0) & 0x3f;
+/* These default values correspond to expected usage for the chip.  */
 
-      return (insn & 0xff) & 0x3f;
-    }
+SIM_DESC
+sim_open (SIM_OPEN_KIND kind,
+         host_callback *cb,
+         struct bfd *abfd,
+         char * const *argv)
+{
+  int i;
+  SIM_DESC sd = sim_state_alloc (kind, cb);
 
-  /* These are two byte insns */
-  if ((insn & 0xffff0000) == 0)
-    {
-      if ((insn & 0xf000) == 0x2000
-         || (insn & 0xf000) == 0x5000)
-       return ((insn & 0xfc00) >> 8) & 0x3f;
+  SIM_ASSERT (STATE_MAGIC (sd) == SIM_MAGIC_NUMBER);
 
-      if ((insn & 0xf000) == 0x4000)
-       return ((insn & 0xf300) >> 8) & 0x3f;
+  /* The cpu data is kept in a separately allocated chunk of memory.  */
+  if (sim_cpu_alloc_all (sd, 1) != SIM_RC_OK)
+    return 0;
 
-      if ((insn & 0xf000) == 0x8000
-         || (insn & 0xf000) == 0x9000
-         || (insn & 0xf000) == 0xa000
-         || (insn & 0xf000) == 0xb000)
-       return ((insn & 0xf000) >> 8) & 0x3f;
+  /* for compatibility */
+  simulator = sd;
 
-      return ((insn & 0xff00) >> 8) & 0x3f;
-    }
+  /* FIXME: should be better way of setting up interrupts.  For
+     moment, only support watchpoints causing a breakpoint (gdb
+     halt). */
+  STATE_WATCHPOINTS (sd)->interrupt_handler = NULL;
+  STATE_WATCHPOINTS (sd)->interrupt_names = NULL;
 
-  /* These are three byte insns.  */
-  if ((insn & 0xff000000) == 0)
-    {
-      if ((insn & 0xf00000) == 0x000000)
-       return ((insn & 0xf30000) >> 16) & 0x3f;
+  if (sim_pre_argv_init (sd, argv[0]) != SIM_RC_OK)
+    return 0;
+  sim_add_option_table (sd, NULL, mn10300_options);
 
-      if ((insn & 0xf00000) == 0x200000
-         || (insn & 0xf00000) == 0x300000)
-       return ((insn & 0xfc0000) >> 16) & 0x3f;
+  /* Allocate core managed memory */
+  sim_do_command (sd, "memory region 0,0x100000");
+  sim_do_command (sd, "memory region 0x40000000,0x200000");
 
-        return ((insn & 0xff0000) >> 16) & 0x3f;
+  /* The parser will print an error message for us, so we silently return.  */
+  if (sim_parse_args (sd, argv) != SIM_RC_OK)
+    {
+      /* Uninstall the modules to avoid memory leaks,
+        file descriptor leaks, etc.  */
+      sim_module_uninstall (sd);
+      return 0;
     }
 
-  /* These are four byte or larger insns.  */
-  return ((insn & 0xff000000) >> 24) & 0x3f;
-}
+  if ( NULL != board
+       && (strcmp(board, BOARD_AM32) == 0 ) )
+    {
+      /* environment */
+      STATE_ENVIRONMENT (sd) = OPERATING_ENVIRONMENT;
 
-static struct hash_entry *
-lookup_hash (ins, length)
-     uint32 ins;
-     int length;
-{
-  struct hash_entry *h;
+      sim_do_command (sd, "memory region 0x44000000,0x40000");
+      sim_do_command (sd, "memory region 0x48000000,0x400000");
+
+      /* device support for mn1030002 */
+      /* interrupt controller */
 
-  h = &hash_table[hash(ins)];
+      sim_hw_parse (sd, "/mn103int@0x34000100/reg 0x34000100 0x7C 0x34000200 0x8 0x34000280 0x8");
 
-  while ((ins & h->mask) != h->opcode
-        || (length != h->ops->length))
+      /* DEBUG: NMI input's */
+      sim_hw_parse (sd, "/glue@0x30000000/reg 0x30000000 12");
+      sim_hw_parse (sd, "/glue@0x30000000 > int0 nmirq /mn103int");
+      sim_hw_parse (sd, "/glue@0x30000000 > int1 watchdog /mn103int");
+      sim_hw_parse (sd, "/glue@0x30000000 > int2 syserr /mn103int");
+      
+      /* DEBUG: ACK input */
+      sim_hw_parse (sd, "/glue@0x30002000/reg 0x30002000 4");
+      sim_hw_parse (sd, "/glue@0x30002000 > int ack /mn103int");
+      
+      /* DEBUG: LEVEL output */
+      sim_hw_parse (sd, "/glue@0x30004000/reg 0x30004000 8");
+      sim_hw_parse (sd, "/mn103int > nmi int0 /glue@0x30004000");
+      sim_hw_parse (sd, "/mn103int > level int1 /glue@0x30004000");
+      
+      /* DEBUG: A bunch of interrupt inputs */
+      sim_hw_parse (sd, "/glue@0x30006000/reg 0x30006000 32");
+      sim_hw_parse (sd, "/glue@0x30006000 > int0 irq-0 /mn103int");
+      sim_hw_parse (sd, "/glue@0x30006000 > int1 irq-1 /mn103int");
+      sim_hw_parse (sd, "/glue@0x30006000 > int2 irq-2 /mn103int");
+      sim_hw_parse (sd, "/glue@0x30006000 > int3 irq-3 /mn103int");
+      sim_hw_parse (sd, "/glue@0x30006000 > int4 irq-4 /mn103int");
+      sim_hw_parse (sd, "/glue@0x30006000 > int5 irq-5 /mn103int");
+      sim_hw_parse (sd, "/glue@0x30006000 > int6 irq-6 /mn103int");
+      sim_hw_parse (sd, "/glue@0x30006000 > int7 irq-7 /mn103int");
+      
+      /* processor interrupt device */
+      
+      /* the device */
+      sim_hw_parse (sd, "/mn103cpu@0x20000000");
+      sim_hw_parse (sd, "/mn103cpu@0x20000000/reg 0x20000000 0x42");
+      
+      /* DEBUG: ACK output wired upto a glue device */
+      sim_hw_parse (sd, "/glue@0x20002000");
+      sim_hw_parse (sd, "/glue@0x20002000/reg 0x20002000 4");
+      sim_hw_parse (sd, "/mn103cpu > ack int0 /glue@0x20002000");
+      
+      /* DEBUG: RESET/NMI/LEVEL wired up to a glue device */
+      sim_hw_parse (sd, "/glue@0x20004000");
+      sim_hw_parse (sd, "/glue@0x20004000/reg 0x20004000 12");
+      sim_hw_parse (sd, "/glue@0x20004000 > int0 reset /mn103cpu");
+      sim_hw_parse (sd, "/glue@0x20004000 > int1 nmi /mn103cpu");
+      sim_hw_parse (sd, "/glue@0x20004000 > int2 level /mn103cpu");
+      
+      /* REAL: The processor wired up to the real interrupt controller */
+      sim_hw_parse (sd, "/mn103cpu > ack ack /mn103int");
+      sim_hw_parse (sd, "/mn103int > level level /mn103cpu");
+      sim_hw_parse (sd, "/mn103int > nmi nmi /mn103cpu");
+      
+      
+      /* PAL */
+      
+      /* the device */
+      sim_hw_parse (sd, "/pal@0x31000000");
+      sim_hw_parse (sd, "/pal@0x31000000/reg 0x31000000 64");
+      sim_hw_parse (sd, "/pal@0x31000000/poll? true");
+      
+      /* DEBUG: PAL wired up to a glue device */
+      sim_hw_parse (sd, "/glue@0x31002000");
+      sim_hw_parse (sd, "/glue@0x31002000/reg 0x31002000 16");
+      sim_hw_parse (sd, "/pal@0x31000000 > countdown int0 /glue@0x31002000");
+      sim_hw_parse (sd, "/pal@0x31000000 > timer int1 /glue@0x31002000");
+      sim_hw_parse (sd, "/pal@0x31000000 > int int2 /glue@0x31002000");
+      sim_hw_parse (sd, "/glue@0x31002000 > int0 int3 /glue@0x31002000");
+      sim_hw_parse (sd, "/glue@0x31002000 > int1 int3 /glue@0x31002000");
+      sim_hw_parse (sd, "/glue@0x31002000 > int2 int3 /glue@0x31002000");
+      
+      /* REAL: The PAL wired up to the real interrupt controller */
+      sim_hw_parse (sd, "/pal@0x31000000 > countdown irq-0 /mn103int");
+      sim_hw_parse (sd, "/pal@0x31000000 > timer irq-1 /mn103int");
+      sim_hw_parse (sd, "/pal@0x31000000 > int irq-2 /mn103int");
+      
+      /* 8 and 16 bit timers */
+      sim_hw_parse (sd, "/mn103tim@0x34001000/reg 0x34001000 36 0x34001080 100 0x34004000 16");
+
+      /* Hook timer interrupts up to interrupt controller */
+      sim_hw_parse (sd, "/mn103tim > timer-0-underflow timer-0-underflow /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-1-underflow timer-1-underflow /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-2-underflow timer-2-underflow /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-3-underflow timer-3-underflow /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-4-underflow timer-4-underflow /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-5-underflow timer-5-underflow /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-6-underflow timer-6-underflow /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-6-compare-a timer-6-compare-a /mn103int");
+      sim_hw_parse (sd, "/mn103tim > timer-6-compare-b timer-6-compare-b /mn103int");
+      
+      
+      /* Serial devices 0,1,2 */
+      sim_hw_parse (sd, "/mn103ser@0x34000800/reg 0x34000800 48");
+      sim_hw_parse (sd, "/mn103ser@0x34000800/poll? true");
+      
+      /* Hook serial interrupts up to interrupt controller */
+      sim_hw_parse (sd, "/mn103ser > serial-0-receive serial-0-receive /mn103int");
+      sim_hw_parse (sd, "/mn103ser > serial-0-transmit serial-0-transmit /mn103int");
+      sim_hw_parse (sd, "/mn103ser > serial-1-receive serial-1-receive /mn103int");
+      sim_hw_parse (sd, "/mn103ser > serial-1-transmit serial-1-transmit /mn103int");
+      sim_hw_parse (sd, "/mn103ser > serial-2-receive serial-2-receive /mn103int");
+      sim_hw_parse (sd, "/mn103ser > serial-2-transmit serial-2-transmit /mn103int");
+      
+      sim_hw_parse (sd, "/mn103iop@0x36008000/reg 0x36008000 8 0x36008020 8 0x36008040 0xc 0x36008060 8 0x36008080 8");
+
+      /* Memory control registers */
+      sim_do_command (sd, "memory region 0x32000020,0x30");
+      /* Cache control register */
+      sim_do_command (sd, "memory region 0x20000070,0x4");
+      /* Cache purge regions */
+      sim_do_command (sd, "memory region 0x28400000,0x800");
+      sim_do_command (sd, "memory region 0x28401000,0x800");
+      /* DMA registers */
+      sim_do_command (sd, "memory region 0x32000100,0xF");
+      sim_do_command (sd, "memory region 0x32000200,0xF");
+      sim_do_command (sd, "memory region 0x32000400,0xF");
+      sim_do_command (sd, "memory region 0x32000800,0xF");
+    }
+  else
     {
-      if (h->next == NULL)
-       {
-         (*mn10300_callback->printf_filtered) (mn10300_callback, "ERROR looking up hash for 0x%x, PC=0x%x\n", ins, PC);
-         exit(1);
+      if (board != NULL)
+        {
+         sim_io_eprintf (sd, "Error: Board `%s' unknown.\n", board);
+          return 0;
        }
-      h = h->next;
     }
-  return (h);
-}
+  
+  
+
+  /* check for/establish the a reference program image */
+  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;
+    }
 
-/* FIXME These would more efficient to use than load_mem/store_mem,
-   but need to be changed to use the memory map.  */
+  /* establish any remaining configuration options */
+  if (sim_config (sd) != SIM_RC_OK)
+    {
+      sim_module_uninstall (sd);
+      return 0;
+    }
 
-uint8
-get_byte (x)
-     uint8 *x;
-{
-  return *x;
-}
+  if (sim_post_argv_init (sd) != SIM_RC_OK)
+    {
+      /* Uninstall the modules to avoid memory leaks,
+        file descriptor leaks, etc.  */
+      sim_module_uninstall (sd);
+      return 0;
+    }
 
-uint16
-get_half (x)
-     uint8 *x;
-{
-  uint8 *a = x;
-  return (a[1] << 8) + (a[0]);
-}
 
-uint32
-get_word (x)
-      uint8 *x;
-{
-  uint8 *a = x;
-  return (a[3]<<24) + (a[2]<<16) + (a[1]<<8) + (a[0]);
+  /* set machine specific configuration */
+/*   STATE_CPU (sd, 0)->psw_mask = (PSW_NP | PSW_EP | PSW_ID | PSW_SAT */
+/*                          | PSW_CY | PSW_OV | PSW_S | PSW_Z); */
+
+  /* CPU specific initialization.  */
+  for (i = 0; i < MAX_NR_PROCESSORS; ++i)
+    {
+      SIM_CPU *cpu = STATE_CPU (sd, i);
+
+      CPU_REG_FETCH (cpu) = mn10300_reg_fetch;
+      CPU_REG_STORE (cpu) = mn10300_reg_store;
+      CPU_PC_FETCH (cpu) = mn10300_pc_get;
+      CPU_PC_STORE (cpu) = mn10300_pc_set;
+    }
+
+  return sd;
 }
 
-void
-put_byte (addr, data)
-     uint8 *addr;
-     uint8 data;
+SIM_RC
+sim_create_inferior (SIM_DESC sd,
+                    struct bfd *prog_bfd,
+                    char * const *argv,
+                    char * const *env)
 {
-  uint8 *a = addr;
-  a[0] = data;
+  memset (&State, 0, sizeof (State));
+  if (prog_bfd != NULL) {
+    PC = bfd_get_start_address (prog_bfd);
+  } else {
+    PC = 0;
+  }
+  CPU_PC_SET (STATE_CPU (sd, 0), (unsigned64) PC);
+
+  if (STATE_ARCHITECTURE (sd)->mach == bfd_mach_am33_2)
+    PSW |= PSW_FE;
+
+  return SIM_RC_OK;
 }
 
-void
-put_half (addr, data)
-     uint8 *addr;
-     uint16 data;
+/* FIXME These would more efficient to use than load_mem/store_mem,
+   but need to be changed to use the memory map.  */
+
+static int
+mn10300_reg_fetch (SIM_CPU *cpu, int rn, unsigned char *memory, int length)
 {
-  uint8 *a = addr;
-  a[0] = data & 0xff;
-  a[1] = (data >> 8) & 0xff;
+  reg_t reg = State.regs[rn];
+  uint8 *a = memory;
+  a[0] = reg;
+  a[1] = reg >> 8;
+  a[2] = reg >> 16;
+  a[3] = reg >> 24;
+  return length;
 }
-
-void
-put_word (addr, data)
-     uint8 *addr;
-     uint32 data;
+static int
+mn10300_reg_store (SIM_CPU *cpu, int rn, unsigned char *memory, int length)
 {
-  uint8 *a = addr;
-  a[0] = data & 0xff;
-  a[1] = (data >> 8) & 0xff;
-  a[2] = (data >> 16) & 0xff;
-  a[3] = (data >> 24) & 0xff;
+  uint8 *a = memory;
+  State.regs[rn] = (a[3] << 24) + (a[2] << 16) + (a[1] << 8) + a[0];
+  return length;
 }
 
-
-uint32
-load_mem_big (addr, len)
-     SIM_ADDR addr;
-     int len;
+void
+mn10300_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)
 {
-  uint8 *p = addr + State.mem;
+  const char *copy = (transfer == read_transfer ? "read" : "write");
+  address_word ip = CIA_ADDR (cia);
 
-  switch (len)
+  switch (sig)
     {
-    case 1:
-      return p[0];
-    case 2:
-      return p[0] << 8 | p[1];
-    case 3:
-      return p[0] << 16 | p[1] << 8 | p[2];
-    case 4:
-      return p[0] << 24 | p[1] << 16 | p[2] << 8 | p[3];
+    case sim_core_unmapped_signal:
+      sim_io_eprintf (sd, "mn10300-core: %d byte %s to unmapped address 0x%lx at 0x%lx\n",
+                      nr_bytes, copy, 
+                      (unsigned long) addr, (unsigned long) ip);
+      program_interrupt(sd, cpu, cia, SIM_SIGSEGV);
+      break;
+
+    case sim_core_unaligned_signal:
+      sim_io_eprintf (sd, "mn10300-core: %d byte %s to unaligned address 0x%lx at 0x%lx\n",
+                      nr_bytes, copy, 
+                      (unsigned long) addr, (unsigned long) ip);
+      program_interrupt(sd, cpu, cia, SIM_SIGBUS);
+      break;
+
     default:
-      abort ();
+      sim_engine_abort (sd, cpu, cia,
+                        "mn10300_core_signal - internal error - bad switch");
     }
 }
 
-uint32
-load_mem (addr, len)
-     SIM_ADDR addr;
-     int len;
+
+void
+program_interrupt (SIM_DESC sd,
+                  sim_cpu *cpu,
+                  sim_cia cia,
+                  SIM_SIGNAL sig)
 {
-  uint8 *p = addr + State.mem;
+  int status;
+  struct hw *device;
+  static int in_interrupt = 0;
 
-  switch (len)
+#ifdef SIM_CPU_EXCEPTION_TRIGGER
+  SIM_CPU_EXCEPTION_TRIGGER(sd,cpu,cia);
+#endif
+
+  /* avoid infinite recursion */
+  if (in_interrupt)
+    sim_io_printf (sd, "ERROR: recursion in program_interrupt during software exception dispatch.");
+  else
     {
-    case 1:
-      return p[0];
-    case 2:
-      return p[1] << 8 | p[0];
-    case 3:
-      return p[2] << 16 | p[1] << 8 | p[0];
-    case 4:
-      return p[3] << 24 | p[2] << 16 | p[1] << 8 | p[0];
-    default:
-      abort ();
+      in_interrupt = 1;
+      /* copy NMI handler code from dv-mn103cpu.c */
+      store_word (SP - 4, CPU_PC_GET (cpu));
+      store_half (SP - 8, PSW);
+
+      /* Set the SYSEF flag in NMICR by backdoor method.  See
+        dv-mn103int.c:write_icr().  This is necessary because
+         software exceptions are not modelled by actually talking to
+         the interrupt controller, so it cannot set its own SYSEF
+         flag. */
+     if ((NULL != board) && (strcmp(board, BOARD_AM32) == 0))
+       store_byte (0x34000103, 0x04);
     }
-}
 
-void
-store_mem (addr, len, data)
-     SIM_ADDR addr;
-     int len;
-     uint32 data;
-{
-  uint8 *p = addr + State.mem;
-
-  switch (len)
-    {
-    case 1:
-      p[0] = data;
-      return;
-    case 2:
-      p[0] = data;
-      p[1] = data >> 8;
-      return;
-    case 4:
-      p[0] = data;
-      p[1] = data >> 8;
-      p[2] = data >> 16;
-      p[3] = data >> 24;
-      return;
-    default:
-      abort ();
-    }
+  PSW &= ~PSW_IE;
+  SP = SP - 8;
+  CPU_PC_SET (cpu, 0x40000008);
+
+  in_interrupt = 0;
+  sim_engine_halt(sd, cpu, NULL, cia, sim_stopped, sig);
 }
 
-void
-sim_size (power)
-     int power;
 
+void
+mn10300_cpu_exception_trigger(SIM_DESC sd, sim_cpu* cpu, address_word cia)
 {
-  if (State.mem)
-    free (State.mem);
+  ASSERT(cpu != NULL);
 
-  State.mem = (uint8 *) calloc (1,  1 << power);
-  if (!State.mem)
-    {
-      (*mn10300_callback->printf_filtered) (mn10300_callback, "Allocation of main memory failed.\n");
-      exit (1);
-    }
-}
+  if(State.exc_suspended > 0)
+    sim_io_eprintf(sd, "Warning, nested exception triggered (%d)\n", State.exc_suspended); 
 
-static void
-init_system ()
-{
-  if (!State.mem)
-    sim_size(18);
+  CPU_PC_SET (cpu, cia);
+  memcpy(State.exc_trigger_regs, State.regs, sizeof(State.exc_trigger_regs));
+  State.exc_suspended = 0;
 }
 
-int
-sim_write (addr, buffer, size)
-     SIM_ADDR addr;
-     unsigned char *buffer;
-     int size;
+void
+mn10300_cpu_exception_suspend(SIM_DESC sd, sim_cpu* cpu, int exception)
 {
-  int i;
-
-  init_system ();
+  ASSERT(cpu != NULL);
 
-  for (i = 0; i < size; i++)
-    store_mem (addr + i, 1, buffer[i]);
+  if(State.exc_suspended > 0)
+    sim_io_eprintf(sd, "Warning, nested exception signal (%d then %d)\n", 
+                  State.exc_suspended, exception); 
 
-  return size;
+  memcpy(State.exc_suspend_regs, State.regs, sizeof(State.exc_suspend_regs));
+  memcpy(State.regs, State.exc_trigger_regs, sizeof(State.regs));
+  CPU_PC_SET (cpu, PC); /* copy PC back from new State.regs */
+  State.exc_suspended = exception;
 }
 
 void
-sim_open (args)
-     char *args;
+mn10300_cpu_exception_resume(SIM_DESC sd, sim_cpu* cpu, int exception)
 {
-  struct simops *s;
-  struct hash_entry *h;
-  if (args != NULL)
+  ASSERT(cpu != NULL);
+
+  if(exception == 0 && State.exc_suspended > 0)
     {
-#ifdef DEBUG
-      if (strcmp (args, "-t") == 0)
-       mn10300_debug = DEBUG;
-      else
+#ifndef SIGTRAP
+# define SIGTRAP 5
 #endif
-       (*mn10300_callback->printf_filtered) (mn10300_callback, "ERROR: unsupported option(s): %s\n",args);
+      if(State.exc_suspended != SIGTRAP) /* warn not for breakpoints */
+         sim_io_eprintf(sd, "Warning, resuming but ignoring pending exception signal (%d)\n",
+                      State.exc_suspended); 
     }
-
-  /* put all the opcodes in the hash table */
-  for (s = Simops; s->func; s++)
+  else if(exception != 0 && State.exc_suspended > 0)
     {
-      h = &hash_table[hash(s->opcode)];
+      if(exception != State.exc_suspended) 
+       sim_io_eprintf(sd, "Warning, resuming with mismatched exception signal (%d vs %d)\n",
+                      State.exc_suspended, exception); 
       
-      /* go to the last entry in the chain */
-      while (h->next)
-         h = h->next;
-
-      if (h->ops)
-       {
-         h->next = calloc(1,sizeof(struct hash_entry));
-         h = h->next;
-       }
-      h->ops = s;
-      h->mask = s->mask;
-      h->opcode = s->opcode;
+      memcpy(State.regs, State.exc_suspend_regs, sizeof(State.regs)); 
+      CPU_PC_SET (cpu, PC); /* copy PC back from new State.regs */
     }
+  else if(exception != 0 && State.exc_suspended == 0)
+    {
+      sim_io_eprintf(sd, "Warning, ignoring spontanous exception signal (%d)\n", exception); 
+    }
+  State.exc_suspended = 0; 
 }
 
-
+/* This is called when an FP instruction is issued when the FP unit is
+   disabled, i.e., the FE bit of PSW is zero.  It raises interrupt
+   code 0x1c0.  */
 void
-sim_close (quitting)
-     int quitting;
+fpu_disabled_exception (SIM_DESC sd, sim_cpu *cpu, sim_cia cia)
 {
-  /* nothing to do */
+  sim_io_eprintf(sd, "FPU disabled exception\n");
+  program_interrupt (sd, cpu, cia, SIM_SIGFPE);
 }
 
+/* This is called when the FP unit is enabled but one of the
+   unimplemented insns is issued.  It raises interrupt code 0x1c8.  */
 void
-sim_set_profile (n)
-     int n;
+fpu_unimp_exception (SIM_DESC sd, sim_cpu *cpu, sim_cia cia)
 {
-  (*mn10300_callback->printf_filtered) (mn10300_callback, "sim_set_profile %d\n", n);
+  sim_io_eprintf(sd, "Unimplemented FPU instruction exception\n");
+  program_interrupt (sd, cpu, cia, SIM_SIGFPE);
 }
 
+/* This is called at the end of any FP insns that may have triggered
+   FP exceptions.  If no exception is enabled, it returns immediately.
+   Otherwise, it raises an exception code 0x1d0.  */
 void
-sim_set_profile_size (n)
-     int n;
+fpu_check_signal_exception (SIM_DESC sd, sim_cpu *cpu, sim_cia cia)
 {
-  (*mn10300_callback->printf_filtered) (mn10300_callback, "sim_set_profile_size %d\n", n);
+  if ((FPCR & EC_MASK) == 0)
+    return;
+
+  sim_io_eprintf(sd, "FPU %s%s%s%s%s exception\n",
+                (FPCR & EC_V) ? "V" : "",
+                (FPCR & EC_Z) ? "Z" : "",
+                (FPCR & EC_O) ? "O" : "",
+                (FPCR & EC_U) ? "U" : "",
+                (FPCR & EC_I) ? "I" : "");
+  program_interrupt (sd, cpu, cia, SIM_SIGFPE);
 }
 
-void
-sim_resume (step, siggnal)
-     int step, siggnal;
+/* Convert a 32-bit single-precision FP value in the target platform
+   format to a sim_fpu value.  */
+static void
+reg2val_32 (const void *reg, sim_fpu *val)
 {
-  uint32 inst, opcode;
-  reg_t oldpc;
-  struct hash_entry *h;
+  FS2FPU (*(reg_t *)reg, *val);
+}
 
-  if (step)
-    State.exception = SIGTRAP;
-  else
-    State.exception = 0;
-
-  do
-    {
-      unsigned long insn, extension;
-
-      /* Fetch the current instruction.  */
-      inst = load_mem_big (PC, 1);
-      oldpc = PC;
-
-      /* These are one byte insns.  */
-      if ((inst & 0xf3) == 0x00
-         || (inst & 0xf0) == 0x10
-         || (inst & 0xfc) == 0x3c
-         || (inst & 0xf3) == 0x41
-         || (inst & 0xf3) == 0x40
-         || (inst & 0xfc) == 0x50
-         || (inst & 0xfc) == 0x54
-         || (inst & 0xf0) == 0x60
-         || (inst & 0xf0) == 0x70
-         || ((inst & 0xf0) == 0x80
-             && (inst & 0x0c) >> 2 != (inst & 0x03))
-         || ((inst & 0xf0) == 0x90
-             && (inst & 0x0c) >> 2 != (inst & 0x03))
-         || ((inst & 0xf0) == 0xa0
-             && (inst & 0x0c) >> 2 != (inst & 0x03))
-         || ((inst & 0xf0) == 0xb0
-             && (inst & 0x0c) >> 2 != (inst & 0x03))
-         || (inst & 0xff) == 0xcb
-         || (inst & 0xfc) == 0xd0
-         || (inst & 0xfc) == 0xd4
-         || (inst & 0xfc) == 0xd8
-         || (inst & 0xf0) == 0xe0)
-       {
-         insn = inst;
-         h = lookup_hash (insn, 1);
-         extension = 0;
-         (h->ops->func)(insn, extension);
-         PC += 1;
-       }
+/* Round the given sim_fpu value to single precision, following the
+   target platform rounding and denormalization conventions.  On
+   AM33/2.0, round_near is the only rounding mode.  */
+static int
+round_32 (sim_fpu *val)
+{
+  return sim_fpu_round_32 (val, sim_fpu_round_near, sim_fpu_denorm_zero);
+}
 
-      /* These are two byte insns.  */
-      else if ((inst & 0xf0) == 0x80
-              || (inst & 0xf0) == 0x90
-              || (inst & 0xf0) == 0xa0
-              || (inst & 0xf0) == 0xb0
-              || (inst & 0xfc) == 0x20
-              || (inst & 0xfc) == 0x28
-              || (inst & 0xf3) == 0x43
-              || (inst & 0xf3) == 0x42
-              || (inst & 0xfc) == 0x58
-              || (inst & 0xfc) == 0x5c
-              || ((inst & 0xf0) == 0xc0
-                  && (inst & 0xff) != 0xcb
-                  && (inst & 0xff) != 0xcc
-                  && (inst & 0xff) != 0xcd)
-              || (inst & 0xff) == 0xf0
-              || (inst & 0xff) == 0xf1
-              || (inst & 0xff) == 0xf2
-              || (inst & 0xff) == 0xf3
-              || (inst & 0xff) == 0xf4
-              || (inst & 0xff) == 0xf5
-              || (inst & 0xff) == 0xf6)
-       {
-         insn = load_mem_big (PC, 2);
-         h = lookup_hash (insn, 2);
-         extension = 0;
-         (h->ops->func)(insn, extension);
-         PC += 2;
-       }
+/* Convert a sim_fpu value to the 32-bit single-precision target
+   representation.  */
+static void
+val2reg_32 (const sim_fpu *val, void *reg)
+{
+  FPU2FS (*val, *(reg_t *)reg);
+}
 
-      /* These are three byte insns.  */
-      else if ((inst & 0xff) == 0xf8
-              || (inst & 0xff) == 0xcc 
-              || (inst & 0xff) == 0xf9
-              || (inst & 0xf3) == 0x01
-              || (inst & 0xf3) == 0x02
-              || (inst & 0xf3) == 0x03
-              || (inst & 0xfc) == 0x24
-              || (inst & 0xfc) == 0x2c
-              || (inst & 0xfc) == 0x30
-              || (inst & 0xfc) == 0x34
-              || (inst & 0xfc) == 0x38
-              || (inst & 0xff) == 0xde
-              || (inst & 0xff) == 0xdf
-              || (inst & 0xff) == 0xcc)
-       {
-         insn = load_mem_big (PC, 3);
-         h = lookup_hash (insn, 3);
-         extension = 0;
-         (h->ops->func)(insn, extension);
-         PC += 3;
-       }
+/* Define the 32-bit single-precision conversion and rounding uniform
+   interface.  */
+const struct fp_prec_t
+fp_single_prec = {
+  reg2val_32, round_32, val2reg_32
+};
 
-      /* These are four byte insns.  */
-      else if ((inst & 0xff) == 0xfa
-              || (inst & 0xff) == 0xfb)
-       {
-         insn = load_mem_big (PC, 4);
-         h = lookup_hash (insn, 4);
-         extension = 0;
-         (h->ops->func)();
-         PC += 4;
-       }
+/* Convert a 64-bit double-precision FP value in the target platform
+   format to a sim_fpu value.  */
+static void
+reg2val_64 (const void *reg, sim_fpu *val)
+{
+  FD2FPU (*(dword *)reg, *val);
+}
 
-      /* These are five byte insns.  */
-      else if ((inst & 0xff) == 0xcd
-              || (inst & 0xff) == 0xdc)
-       {
-         insn = load_mem_big (PC, 4);
-         h = lookup_hash (insn, 5);
-         extension = load_mem_big (PC + 4, 1);
-         (h->ops->func)(insn, extension);
-         PC += 5;
-       }
+/* Round the given sim_fpu value to double precision, following the
+   target platform rounding and denormalization conventions.  On
+   AM33/2.0, round_near is the only rounding mode.  */
+static int
+round_64 (sim_fpu *val)
+{
+  return sim_fpu_round_64 (val, sim_fpu_round_near, sim_fpu_denorm_zero);
+}
 
-      /* These are six byte insns.  */
-      else if ((inst & 0xff) == 0xfd
-              || (inst & 0xff) == 0xfc)
-       {
-         insn = load_mem_big (PC, 4);
-         h = lookup_hash (insn, 6);
-         extension = load_mem_big (PC + 4, 2);
-         (h->ops->func)(insn, extension);
-         PC += 6;
-       }
+/* Convert a sim_fpu value to the 64-bit double-precision target
+   representation.  */
+static void
+val2reg_64 (const sim_fpu *val, void *reg)
+{
+  FPU2FD (*val, *(dword *)reg);
+}
+
+/* Define the 64-bit single-precision conversion and rounding uniform
+   interface.  */
+const struct fp_prec_t
+fp_double_prec = {
+  reg2val_64, round_64, val2reg_64
+};
+
+/* Define shortcuts to the uniform interface operations.  */
+#define REG2VAL(reg,val) (*ops->reg2val) (reg,val)
+#define ROUND(val) (*ops->round) (val)
+#define VAL2REG(val,reg) (*ops->val2reg) (val,reg)
+
+/* Check whether overflow, underflow or inexact exceptions should be
+   raised.  */
+static int
+fpu_status_ok (sim_fpu_status stat)
+{
+  if ((stat & sim_fpu_status_overflow)
+      && (FPCR & EE_O))
+    FPCR |= EC_O;
+  else if ((stat & (sim_fpu_status_underflow | sim_fpu_status_denorm))
+          && (FPCR & EE_U))
+    FPCR |= EC_U;
+  else if ((stat & (sim_fpu_status_inexact | sim_fpu_status_rounded))
+          && (FPCR & EE_I))
+    FPCR |= EC_I;
+  else if (stat & ~ (sim_fpu_status_overflow
+                    | sim_fpu_status_underflow
+                    | sim_fpu_status_denorm
+                    | sim_fpu_status_inexact
+                    | sim_fpu_status_rounded))
+    abort ();
+  else
+    return 1;
+  return 0;
+}
+
+/* Implement a 32/64 bit reciprocal square root, signaling FP
+   exceptions when appropriate.  */
+void
+fpu_rsqrt (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+          const void *reg_in, void *reg_out, const struct fp_prec_t *ops)
+{
+  sim_fpu in, med, out;
 
-      /* Else its a seven byte insns (in theory).  */
+  REG2VAL (reg_in, &in);
+  ROUND (&in);
+  FPCR &= ~ EC_MASK;
+  switch (sim_fpu_is (&in))
+    {
+    case SIM_FPU_IS_SNAN:
+    case SIM_FPU_IS_NNUMBER:
+    case SIM_FPU_IS_NINF:
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+      break;
+           
+    case SIM_FPU_IS_QNAN:
+      VAL2REG (&sim_fpu_qnan, reg_out);
+      break;
+
+    case SIM_FPU_IS_PINF:
+      VAL2REG (&sim_fpu_zero, reg_out);
+      break;
+
+    case SIM_FPU_IS_PNUMBER:
+      {
+       /* Since we don't have a function to compute rsqrt directly,
+          use sqrt and inv.  */
+       sim_fpu_status stat = 0;
+       stat |= sim_fpu_sqrt (&med, &in);
+       stat |= sim_fpu_inv (&out, &med);
+       stat |= ROUND (&out);
+       if (fpu_status_ok (stat))
+         VAL2REG (&out, reg_out);
+      }
+      break;
+
+    case SIM_FPU_IS_NZERO:
+    case SIM_FPU_IS_PZERO:
+      if (FPCR & EE_Z)
+       FPCR |= EC_Z;
       else
        {
-         insn = load_mem_big (PC, 4);
-         h = lookup_hash (insn, 7);
-         extension = load_mem_big (PC + 4, 3);
-         (h->ops->func)(insn, extension);
-         PC += 7;
+         /* Generate an INF with the same sign.  */
+         sim_fpu_inv (&out, &in);
+         VAL2REG (&out, reg_out);
        }
+      break;
+
+    default:
+      abort ();
     }
-  while (!State.exception);
+
+  fpu_check_signal_exception (sd, cpu, cia);
 }
 
-int
-sim_trace ()
+static inline reg_t
+cmp2fcc (int res)
 {
-#ifdef DEBUG
-  mn10300_debug = DEBUG;
-#endif
-  sim_resume (0, 0);
-  return 1;
+  switch (res)
+    {
+    case SIM_FPU_IS_SNAN:
+    case SIM_FPU_IS_QNAN:
+      return FCC_U;
+      
+    case SIM_FPU_IS_NINF:
+    case SIM_FPU_IS_NNUMBER:
+    case SIM_FPU_IS_NDENORM:
+      return FCC_L;
+      
+    case SIM_FPU_IS_PINF:
+    case SIM_FPU_IS_PNUMBER:
+    case SIM_FPU_IS_PDENORM:
+      return FCC_G;
+      
+    case SIM_FPU_IS_NZERO:
+    case SIM_FPU_IS_PZERO:
+      return FCC_E;
+      
+    default:
+      abort ();
+    }
 }
 
+/* Implement a 32/64 bit FP compare, setting the FPCR status and/or
+   exception bits as specified.  */
 void
-sim_info (verbose)
-     int verbose;
+fpu_cmp (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+        const void *reg_in1, const void *reg_in2,
+        const struct fp_prec_t *ops)
 {
-  (*mn10300_callback->printf_filtered) (mn10300_callback, "sim_info\n");
+  sim_fpu m, n;
+
+  REG2VAL (reg_in1, &m);
+  REG2VAL (reg_in2, &n);
+  FPCR &= ~ EC_MASK;
+  FPCR &= ~ FCC_MASK;
+  ROUND (&m);
+  ROUND (&n);
+  if (sim_fpu_is_snan (&m) || sim_fpu_is_snan (&n))
+    {
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       FPCR |= FCC_U;
+    }
+  else
+    FPCR |= cmp2fcc (sim_fpu_cmp (&m, &n));
+
+  fpu_check_signal_exception (sd, cpu, cia);
 }
 
+/* Implement a 32/64 bit FP add, setting FP exception bits when
+   appropriate.  */
 void
-sim_create_inferior (start_address, argv, env)
-     SIM_ADDR start_address;
-     char **argv;
-     char **env;
+fpu_add (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+        const void *reg_in1, const void *reg_in2,
+        void *reg_out, const struct fp_prec_t *ops)
 {
-  PC = start_address;
+  sim_fpu m, n, r;
+
+  REG2VAL (reg_in1, &m);
+  REG2VAL (reg_in2, &n);
+  ROUND (&m);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is (&m) == SIM_FPU_IS_PINF
+         && sim_fpu_is (&n) == SIM_FPU_IS_NINF)
+      || (sim_fpu_is (&m) == SIM_FPU_IS_NINF
+         && sim_fpu_is (&n) == SIM_FPU_IS_PINF))
+    {
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else
+    {
+      sim_fpu_status stat = sim_fpu_add (&r, &m, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
 }
 
+/* Implement a 32/64 bit FP sub, setting FP exception bits when
+   appropriate.  */
 void
-sim_kill ()
+fpu_sub (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+        const void *reg_in1, const void *reg_in2,
+        void *reg_out, const struct fp_prec_t *ops)
 {
-  /* nothing to do */
+  sim_fpu m, n, r;
+
+  REG2VAL (reg_in1, &m);
+  REG2VAL (reg_in2, &n);
+  ROUND (&m);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is (&m) == SIM_FPU_IS_PINF
+         && sim_fpu_is (&n) == SIM_FPU_IS_PINF)
+      || (sim_fpu_is (&m) == SIM_FPU_IS_NINF
+         && sim_fpu_is (&n) == SIM_FPU_IS_NINF))
+    {
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else
+    {
+      sim_fpu_status stat = sim_fpu_sub (&r, &m, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
 }
 
+/* Implement a 32/64 bit FP mul, setting FP exception bits when
+   appropriate.  */
 void
-sim_set_callbacks (p)
-     host_callback *p;
+fpu_mul (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+        const void *reg_in1, const void *reg_in2,
+        void *reg_out, const struct fp_prec_t *ops)
 {
-  mn10300_callback = p;
+  sim_fpu m, n, r;
+
+  REG2VAL (reg_in1, &m);
+  REG2VAL (reg_in2, &n);
+  ROUND (&m);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is_infinity (&m) && sim_fpu_is_zero (&n))
+      || (sim_fpu_is_zero (&m) && sim_fpu_is_infinity (&n)))
+    {
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else
+    {
+      sim_fpu_status stat = sim_fpu_mul (&r, &m, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
 }
 
-/* All the code for exiting, signals, etc needs to be revamped.
-
-   This is enough to get c-torture limping though.  */
-
+/* Implement a 32/64 bit FP div, setting FP exception bits when
+   appropriate.  */
 void
-sim_stop_reason (reason, sigrc)
-     enum sim_stop *reason;
-     int *sigrc;
+fpu_div (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+        const void *reg_in1, const void *reg_in2,
+        void *reg_out, const struct fp_prec_t *ops)
 {
-  *reason = sim_stopped;
-  if (State.exception == SIGQUIT)
-    *sigrc = 0;
+  sim_fpu m, n, r;
+
+  REG2VAL (reg_in1, &m);
+  REG2VAL (reg_in2, &n);
+  ROUND (&m);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is_infinity (&m) && sim_fpu_is_infinity (&n))
+      || (sim_fpu_is_zero (&m) && sim_fpu_is_zero (&n)))
+    {
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else if (sim_fpu_is_number (&m) && sim_fpu_is_zero (&n)
+          && (FPCR & EE_Z))
+    FPCR |= EC_Z;
   else
-    *sigrc = State.exception;
+    {
+      sim_fpu_status stat = sim_fpu_div (&r, &m, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
 }
 
+/* Implement a 32/64 bit FP madd, setting FP exception bits when
+   appropriate.  */
 void
-sim_fetch_register (rn, memory)
-     int rn;
-     unsigned char *memory;
+fpu_fmadd (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+          const void *reg_in1, const void *reg_in2, const void *reg_in3,
+          void *reg_out, const struct fp_prec_t *ops)
 {
-  put_word (memory, State.regs[rn]);
+  sim_fpu m1, m2, m, n, r;
+
+  REG2VAL (reg_in1, &m1);
+  REG2VAL (reg_in2, &m2);
+  REG2VAL (reg_in3, &n);
+  ROUND (&m1);
+  ROUND (&m2);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m1) || sim_fpu_is_snan (&m2) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is_infinity (&m1) && sim_fpu_is_zero (&m2))
+      || (sim_fpu_is_zero (&m1) && sim_fpu_is_infinity (&m2)))
+    {
+    invalid_operands:
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else
+    {
+      sim_fpu_status stat = sim_fpu_mul (&m, &m1, &m2);
+
+      if (sim_fpu_is_infinity (&m) && sim_fpu_is_infinity (&n)
+         && sim_fpu_sign (&m) != sim_fpu_sign (&n))
+       goto invalid_operands;
+
+      stat |= sim_fpu_add (&r, &m, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
 }
+
+/* Implement a 32/64 bit FP msub, setting FP exception bits when
+   appropriate.  */
 void
-sim_store_register (rn, memory)
-     int rn;
-     unsigned char *memory;
+fpu_fmsub (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+          const void *reg_in1, const void *reg_in2, const void *reg_in3,
+          void *reg_out, const struct fp_prec_t *ops)
 {
-  State.regs[rn] = get_word (memory);
-}
+  sim_fpu m1, m2, m, n, r;
+
+  REG2VAL (reg_in1, &m1);
+  REG2VAL (reg_in2, &m2);
+  REG2VAL (reg_in3, &n);
+  ROUND (&m1);
+  ROUND (&m2);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m1) || sim_fpu_is_snan (&m2) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is_infinity (&m1) && sim_fpu_is_zero (&m2))
+      || (sim_fpu_is_zero (&m1) && sim_fpu_is_infinity (&m2)))
+    {
+    invalid_operands:
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else
+    {
+      sim_fpu_status stat = sim_fpu_mul (&m, &m1, &m2);
 
-int
-sim_read (addr, buffer, size)
-     SIM_ADDR addr;
-     unsigned char *buffer;
-     int size;
-{
-  int i;
-  for (i = 0; i < size; i++)
-    buffer[i] = load_mem (addr + i, 1);
+      if (sim_fpu_is_infinity (&m) && sim_fpu_is_infinity (&n)
+         && sim_fpu_sign (&m) == sim_fpu_sign (&n))
+       goto invalid_operands;
 
-  return size;
-} 
+      stat |= sim_fpu_sub (&r, &m, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
+}
 
+/* Implement a 32/64 bit FP nmadd, setting FP exception bits when
+   appropriate.  */
 void
-sim_do_command (cmd)
-     char *cmd;
+fpu_fnmadd (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+           const void *reg_in1, const void *reg_in2, const void *reg_in3,
+           void *reg_out, const struct fp_prec_t *ops)
 {
-  (*mn10300_callback->printf_filtered) (mn10300_callback, "\"%s\" is not a valid mn10300 simulator command.\n", cmd);
+  sim_fpu m1, m2, m, mm, n, r;
+
+  REG2VAL (reg_in1, &m1);
+  REG2VAL (reg_in2, &m2);
+  REG2VAL (reg_in3, &n);
+  ROUND (&m1);
+  ROUND (&m2);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m1) || sim_fpu_is_snan (&m2) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is_infinity (&m1) && sim_fpu_is_zero (&m2))
+      || (sim_fpu_is_zero (&m1) && sim_fpu_is_infinity (&m2)))
+    {
+    invalid_operands:
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else
+    {
+      sim_fpu_status stat = sim_fpu_mul (&m, &m1, &m2);
+
+      if (sim_fpu_is_infinity (&m) && sim_fpu_is_infinity (&n)
+         && sim_fpu_sign (&m) == sim_fpu_sign (&n))
+       goto invalid_operands;
+
+      stat |= sim_fpu_neg (&mm, &m);
+      stat |= sim_fpu_add (&r, &mm, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
 }
 
-int
-sim_load (prog, from_tty)
-     char *prog;
-     int from_tty;
+/* Implement a 32/64 bit FP nmsub, setting FP exception bits when
+   appropriate.  */
+void
+fpu_fnmsub (SIM_DESC sd, sim_cpu *cpu, sim_cia cia,
+           const void *reg_in1, const void *reg_in2, const void *reg_in3,
+           void *reg_out, const struct fp_prec_t *ops)
 {
-  /* Return nonzero so GDB will handle it.  */
-  return 1;
-} 
+  sim_fpu m1, m2, m, mm, n, r;
+
+  REG2VAL (reg_in1, &m1);
+  REG2VAL (reg_in2, &m2);
+  REG2VAL (reg_in3, &n);
+  ROUND (&m1);
+  ROUND (&m2);
+  ROUND (&n);
+  FPCR &= ~ EC_MASK;
+  if (sim_fpu_is_snan (&m1) || sim_fpu_is_snan (&m2) || sim_fpu_is_snan (&n)
+      || (sim_fpu_is_infinity (&m1) && sim_fpu_is_zero (&m2))
+      || (sim_fpu_is_zero (&m1) && sim_fpu_is_infinity (&m2)))
+    {
+    invalid_operands:
+      if (FPCR & EE_V)
+       FPCR |= EC_V;
+      else
+       VAL2REG (&sim_fpu_qnan, reg_out);
+    }
+  else
+    {
+      sim_fpu_status stat = sim_fpu_mul (&m, &m1, &m2);
+
+      if (sim_fpu_is_infinity (&m) && sim_fpu_is_infinity (&n)
+         && sim_fpu_sign (&m) != sim_fpu_sign (&n))
+       goto invalid_operands;
+
+      stat |= sim_fpu_neg (&mm, &m);
+      stat |= sim_fpu_sub (&r, &mm, &n);
+      stat |= ROUND (&r);
+      if (fpu_status_ok (stat))
+       VAL2REG (&r, reg_out);
+    }
+  
+  fpu_check_signal_exception (sd, cpu, cia);
+}