* Makefile.in: Add Timer A support.

[deliverable/binutils-gdb.git] / sim / m32c / int.c

diff --git a/sim/m32c/int.c b/sim/m32c/int.c
index 1959c77f3743c727fdc4be1787784a0e969dffc1..5556a120dc878957c3f6b4c3f2bb1a1ae4ee7c0f 100644 (file)
--- a/sim/m32c/int.c
+++ b/sim/m32c/int.c
@@ -23,13 +23,17 @@ along with this program.  If not, see <http://www.gnu.org/licenses/>.  */
 #include "cpu.h"
 #include "mem.h"
 
-void
-trigger_fixed_interrupt (int addr)
+static void
+trigger_interrupt (int addr, int clear_u)
 {
   int s = get_reg (sp);
   int f = get_reg (flags);
   int p = get_reg (pc);
 
+  if (clear_u)
+    set_flags (FLAGBIT_U, 0);
+  set_flags (FLAGBIT_I | FLAGBIT_D, 0);
+
   if (A16)
     {
       s -= 4;
@@ -46,14 +50,26 @@ trigger_fixed_interrupt (int addr)
       mem_put_hi (s + 4, f);
     }
   put_reg (pc, mem_get_psi (addr));
-  set_flags (FLAGBIT_U | FLAGBIT_I | FLAGBIT_D, 0);
+}
+
+void
+trigger_fixed_interrupt (int addr)
+{
+  trigger_interrupt (addr, 1);
 }
 
 void
 trigger_based_interrupt (int vector)
 {
   int addr = get_reg (intb) + vector * 4;
-  if (vector <= 31)
-    set_flags (FLAGBIT_U, 0);
-  trigger_fixed_interrupt (addr);
+  trigger_interrupt (addr, vector <= 31);
+}
+
+void
+trigger_peripheral_interrupt (int vector, int icaddr)
+{
+  unsigned char old_ic = mem_get_qi (icaddr);
+  int addr = get_reg (intb) + vector * 4;
+  trigger_interrupt (addr, 1);
+  put_reg (flags, (get_reg (flags) & 0x8fff) | ((old_ic & 7) << 12));
 }