X-Git-Url: https://hackdaworld.org/gitweb/?p=my-code%2Farm.git;a=blobdiff_plain;f=betty%2Finterrupts.c;fp=betty%2Finterrupts.c;h=41945cf30b417bf12ea2f43de0e7c7001bcc8bcb;hp=61cf1afd93ebe88f03976f646736058486031eb7;hb=d01b3bb1e7565638e2275e6081dcb106c1fcdb41;hpb=916c8dd1dfa2414ae8b58ab1e3d477b24c553815

diff --git a/betty/interrupts.c b/betty/interrupts.c
index 61cf1af..41945cf 100644
--- a/betty/interrupts.c
+++ b/betty/interrupts.c
@@ -11,12 +11,37 @@
  * functions
  */
 
-void interrupt_set_default_callback(t_interrupt *ir,void *callback) {
+void interrupt_set_default_callback(void *callback) {
 
-	ir->default_callback=callback;
+	VICDefVectAddr=(u32)callback;
+	
 }
 
+void interrupt_clear(u8 src_number) {
 
+}
+
+int interrupt_set(u8 src_number,u8 mode,u8 priority,void *callback) {
+
+	/* check whether this ir source is allready assigned */
+	if(VICSoftInt&(1<<src_number))
+		return INTERRUPT_EINUSE;
+	
+	/* force interrupt */
+	VICSoftInt|=(1<<src_number);
+	VICIntEnable|=(1<<src_number);
+
+	switch(mode) {
+		case INTERRUPT_FIQ:
+			VICIntSelect|=(1<<src_number);
+			break;
+		case INTERRUPT_VIRQ:
+		case INTERRUPT_IRQ:
+		case default:
+	}
+
+	return INTERRUPT_SET;
+}
 
 /*
  * the actual exception handlers (as defined in startup.s)