1/* int.c --- M32C interrupt handling.
2
3Copyright (C) 2005, 2007, 2008, 2009, 2010, 2011
4Free Software Foundation, Inc.
5Contributed by Red Hat, Inc.
6
7This file is part of the GNU simulators.
8
9This program is free software; you can redistribute it and/or modify
10it under the terms of the GNU General Public License as published by
11the Free Software Foundation; either version 3 of the License, or
12(at your option) any later version.
13
14This program is distributed in the hope that it will be useful,
15but WITHOUT ANY WARRANTY; without even the implied warranty of
16MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17GNU General Public License for more details.
18
19You should have received a copy of the GNU General Public License
20along with this program.  If not, see <http://www.gnu.org/licenses/>.  */
21
22
23#include "int.h"
24#include "cpu.h"
25#include "mem.h"
26
27static void
28trigger_interrupt (int addr, int clear_u)
29{
30  int s = get_reg (sp);
31  int f = get_reg (flags);
32  int p = get_reg (pc);
33
34  if (clear_u)
35    set_flags (FLAGBIT_U, 0);
36  set_flags (FLAGBIT_I | FLAGBIT_D, 0);
37
38  if (A16)
39    {
40      s -= 4;
41      put_reg (sp, s);
42      mem_put_hi (s, p);
43      mem_put_qi (s + 2, f);
44      mem_put_qi (s + 3, ((f >> 4) & 0x0f) | (p >> 16));
45    }
46  else
47    {
48      s -= 6;
49      put_reg (sp, s);
50      mem_put_si (s, p);
51      mem_put_hi (s + 4, f);
52    }
53  put_reg (pc, mem_get_psi (addr));
54}
55
56void
57trigger_fixed_interrupt (int addr)
58{
59  trigger_interrupt (addr, 1);
60}
61
62void
63trigger_based_interrupt (int vector)
64{
65  int addr = get_reg (intb) + vector * 4;
66  trigger_interrupt (addr, vector <= 31);
67}
68
69void
70trigger_peripheral_interrupt (int vector, int icaddr)
71{
72  unsigned char old_ic = mem_get_qi (icaddr);
73  int addr = get_reg (intb) + vector * 4;
74  trigger_interrupt (addr, 1);
75  put_reg (flags, (get_reg (flags) & 0x8fff) | ((old_ic & 7) << 12));
76  mem_put_qi (icaddr, old_ic & ~ 0x08);
77}
78