gbasys

annotate src/intr.c @ 3:06726f0b8cd3

foo
author John Tsiombikas <nuclear@member.fsf.org>
date Thu, 08 Mar 2012 14:37:17 +0200
parents
children 72c6429ae953 047c61960005
rev   line source
nuclear@0 1 /*
nuclear@0 2 Copyright 2004 John Tsiombikas <nuclear@siggraph.org>
nuclear@0 3
nuclear@0 4 This file is part of libgba, a library for GameBoy Advance development.
nuclear@0 5
nuclear@0 6 This program is free software; you can redistribute it and/or modify
nuclear@0 7 it under the terms of the GNU General Public License as published by
nuclear@0 8 the Free Software Foundation; either version 2 of the License, or
nuclear@0 9 (at your option) any later version.
nuclear@0 10
nuclear@0 11 This program is distributed in the hope that it will be useful,
nuclear@0 12 but WITHOUT ANY WARRANTY; without even the implied warranty of
nuclear@0 13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
nuclear@0 14 GNU General Public License for more details.
nuclear@0 15
nuclear@0 16 You should have received a copy of the GNU General Public License
nuclear@0 17 along with this program; if not, write to the Free Software
nuclear@0 18 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
nuclear@0 19 */
nuclear@0 20
nuclear@0 21 #include "intr.h"
nuclear@0 22 #include "error.h"
nuclear@0 23
nuclear@0 24 #include "gfx.h"
nuclear@0 25
nuclear@0 26 unsigned short *reg_int_master = (unsigned short*)0x04000208;
nuclear@0 27 unsigned short *reg_int_mask = (unsigned short*)0x04000200;
nuclear@0 28 static volatile unsigned short *reg_int = (unsigned short*)0x04000202;
nuclear@0 29
nuclear@0 30 #define MAX_INTR 14
nuclear@0 31 static void (*intr_table[MAX_INTR])(void);
nuclear@0 32
nuclear@0 33 static void unexpected_intr(void) {
nuclear@0 34 panic("unexpected interrupt");
nuclear@0 35 }
nuclear@0 36
nuclear@0 37 static void intr_handler(void) {
nuclear@0 38 int i;
nuclear@0 39 unsigned short irq;
nuclear@0 40 char buf[20];
nuclear@0 41
nuclear@0 42 clr_int();
nuclear@0 43
nuclear@0 44 irq = *reg_int & 0x3fff;
nuclear@0 45
nuclear@0 46 for(i=0; i<MAX_INTR; i++) {
nuclear@0 47 unsigned short irq_bit = (1 << i);
nuclear@0 48 if((irq & irq_bit) && intr_table[i]) {
nuclear@0 49 intr_table[i]();
nuclear@0 50 }
nuclear@0 51 }
nuclear@0 52
nuclear@0 53 *reg_int = irq;
nuclear@0 54
nuclear@0 55 set_int();
nuclear@0 56 }
nuclear@0 57
nuclear@0 58 void intr_init(void) {
nuclear@0 59 int i;
nuclear@0 60 unsigned long *ptr = (unsigned long*)0x3007ffc;
nuclear@0 61 *ptr = (unsigned long)intr_handler;
nuclear@0 62
nuclear@0 63 for(i=0; i<MAX_INTR; i++) {
nuclear@0 64 interrupt(i, unexpected_intr);
nuclear@0 65 }
nuclear@0 66 }
nuclear@0 67
nuclear@0 68 void interrupt(int intr, void (*handler)(void)) {
nuclear@0 69 intr_table[intr] = handler;
nuclear@0 70 }