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