gbasys
annotate src/intr.c @ 9:85f219fcdc82
merged
| author | John Tsiombikas <nuclear@member.fsf.org> |
|---|---|
| date | Sun, 22 Jun 2014 06:27:18 +0300 |
| parents | 047c61960005 72c6429ae953 |
| children |
| rev | line source |
|---|---|
| nuclear@0 | 1 /* |
| nuclear@7 | 2 gbasys - a gameboy advance hardware abstraction library |
| nuclear@7 | 3 Copyright (C) 2004-2014 John Tsiombikas <nuclear@member.fsf.org> |
| nuclear@0 | 4 |
| nuclear@7 | 5 This program is free software: you can redistribute it and/or modify |
| nuclear@0 | 6 it under the terms of the GNU General Public License as published by |
| nuclear@7 | 7 the Free Software Foundation, either version 3 of the License, or |
| nuclear@0 | 8 (at your option) any later version. |
| nuclear@0 | 9 |
| nuclear@0 | 10 This program is distributed in the hope that it will be useful, |
| nuclear@0 | 11 but WITHOUT ANY WARRANTY; without even the implied warranty of |
| nuclear@0 | 12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| nuclear@0 | 13 GNU General Public License for more details. |
| nuclear@0 | 14 |
| nuclear@0 | 15 You should have received a copy of the GNU General Public License |
| nuclear@7 | 16 along with this program. If not, see <http://www.gnu.org/licenses/>. |
| nuclear@0 | 17 */ |
| nuclear@0 | 18 #include "intr.h" |
| nuclear@0 | 19 #include "error.h" |
| nuclear@0 | 20 |
| nuclear@0 | 21 #include "gfx.h" |
| nuclear@0 | 22 |
| nuclear@0 | 23 #define MAX_INTR 14 |
| nuclear@0 | 24 static void (*intr_table[MAX_INTR])(void); |
| nuclear@0 | 25 |
| nuclear@0 | 26 static void unexpected_intr(void) { |
| nuclear@0 | 27 panic("unexpected interrupt"); |
| nuclear@0 | 28 } |
| nuclear@0 | 29 |
| nuclear@0 | 30 static void intr_handler(void) { |
| nuclear@0 | 31 int i; |
| nuclear@0 | 32 unsigned short irq; |
| nuclear@0 | 33 char buf[20]; |
| nuclear@7 | 34 |
| nuclear@0 | 35 clr_int(); |
| nuclear@0 | 36 |
| nuclear@8 | 37 irq = REG_INTR & 0x3fff; |
| nuclear@0 | 38 |
| nuclear@0 | 39 for(i=0; i<MAX_INTR; i++) { |
| nuclear@0 | 40 unsigned short irq_bit = (1 << i); |
| nuclear@0 | 41 if((irq & irq_bit) && intr_table[i]) { |
| nuclear@0 | 42 intr_table[i](); |
| nuclear@0 | 43 } |
| nuclear@0 | 44 } |
| nuclear@0 | 45 |
| nuclear@8 | 46 REG_INTR = irq; |
| nuclear@0 | 47 |
| nuclear@0 | 48 set_int(); |
| nuclear@0 | 49 } |
| nuclear@0 | 50 |
| nuclear@0 | 51 void intr_init(void) { |
| nuclear@0 | 52 int i; |
| nuclear@0 | 53 unsigned long *ptr = (unsigned long*)0x3007ffc; |
| nuclear@0 | 54 *ptr = (unsigned long)intr_handler; |
| nuclear@0 | 55 |
| nuclear@0 | 56 for(i=0; i<MAX_INTR; i++) { |
| nuclear@0 | 57 interrupt(i, unexpected_intr); |
| nuclear@0 | 58 } |
| nuclear@0 | 59 } |
| nuclear@0 | 60 |
| nuclear@0 | 61 void interrupt(int intr, void (*handler)(void)) { |
| nuclear@0 | 62 intr_table[intr] = handler; |
| nuclear@0 | 63 } |