gbasys

annotate src/intr.c @ 12:a6ddf338a111

line clipping
author John Tsiombikas <nuclear@member.fsf.org>
date Mon, 01 Feb 2016 04:41:27 +0200
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 }