1 /* int.c --- M32C interrupt handling. 2 3 Copyright (C) 2005, 2007, 2008, 2009, 2010, 2011 4 Free Software Foundation, Inc. 5 Contributed by Red Hat, Inc. 6 7 This file is part of the GNU simulators. 8 9 This program is free software; you can redistribute it and/or modify 10 it under the terms of the GNU General Public License as published by 11 the Free Software Foundation; either version 3 of the License, or 12 (at your option) any later version. 13 14 This program is distributed in the hope that it will be useful, 15 but WITHOUT ANY WARRANTY; without even the implied warranty of 16 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17 GNU General Public License for more details. 18 19 You should have received a copy of the GNU General Public License 20 along 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 27 static void 28 trigger_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 56 void 57 trigger_fixed_interrupt (int addr) 58 { 59 trigger_interrupt (addr, 1); 60 } 61 62 void 63 trigger_based_interrupt (int vector) 64 { 65 int addr = get_reg (intb) + vector * 4; 66 trigger_interrupt (addr, vector <= 31); 67 } 68 69 void 70 trigger_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