gbasys
annotate src/intr.c @ 7:72c6429ae953
changed all the copyright headers and added a README
| author | John Tsiombikas <nuclear@member.fsf.org> |
|---|---|
| date | Fri, 18 Apr 2014 02:04:46 +0300 |
| parents | 875ef6085efc |
| children | 85f219fcdc82 |
| 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 unsigned short *reg_int_master = (unsigned short*)0x04000208; |
| nuclear@0 | 24 unsigned short *reg_int_mask = (unsigned short*)0x04000200; |
| nuclear@0 | 25 static volatile unsigned short *reg_int = (unsigned short*)0x04000202; |
| nuclear@0 | 26 |
| nuclear@0 | 27 #define MAX_INTR 14 |
| nuclear@0 | 28 static void (*intr_table[MAX_INTR])(void); |
| nuclear@0 | 29 |
| nuclear@0 | 30 static void unexpected_intr(void) { |
| nuclear@0 | 31 panic("unexpected interrupt"); |
| nuclear@0 | 32 } |
| nuclear@0 | 33 |
| nuclear@0 | 34 static void intr_handler(void) { |
| nuclear@0 | 35 int i; |
| nuclear@0 | 36 unsigned short irq; |
| nuclear@0 | 37 char buf[20]; |
| nuclear@7 | 38 |
| nuclear@0 | 39 clr_int(); |
| nuclear@0 | 40 |
| nuclear@0 | 41 irq = *reg_int & 0x3fff; |
| nuclear@0 | 42 |
| nuclear@0 | 43 for(i=0; i<MAX_INTR; i++) { |
| nuclear@0 | 44 unsigned short irq_bit = (1 << i); |
| nuclear@0 | 45 if((irq & irq_bit) && intr_table[i]) { |
| nuclear@0 | 46 intr_table[i](); |
| nuclear@0 | 47 } |
| nuclear@0 | 48 } |
| nuclear@0 | 49 |
| nuclear@0 | 50 *reg_int = irq; |
| nuclear@0 | 51 |
| nuclear@0 | 52 set_int(); |
| nuclear@0 | 53 } |
| nuclear@0 | 54 |
| nuclear@0 | 55 void intr_init(void) { |
| nuclear@0 | 56 int i; |
| nuclear@0 | 57 unsigned long *ptr = (unsigned long*)0x3007ffc; |
| nuclear@0 | 58 *ptr = (unsigned long)intr_handler; |
| nuclear@0 | 59 |
| nuclear@0 | 60 for(i=0; i<MAX_INTR; i++) { |
| nuclear@0 | 61 interrupt(i, unexpected_intr); |
| nuclear@0 | 62 } |
| nuclear@0 | 63 } |
| nuclear@0 | 64 |
| nuclear@0 | 65 void interrupt(int intr, void (*handler)(void)) { |
| nuclear@0 | 66 intr_table[intr] = handler; |
| nuclear@0 | 67 } |