some interrupt stuff, now basketball ...

[my-code/arm.git] / betty / interrupts.c

diff --git a/betty/interrupts.c b/betty/interrupts.c
index 61cf1af..41945cf 100644 (file)
--- 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)