X-Git-Url: https://hackdaworld.org/gitweb/?p=my-code%2Farm.git;a=blobdiff_plain;f=betty%2Finterrupts.c;fp=betty%2Finterrupts.c;h=e344f054149066fd6724e3ea061056ecb147ce73;hp=db2061dd433f66c0a378bfe4c76e4672b9f081d7;hb=b75b1bf631a3bb68f50f65c65736b1bf743f51b7;hpb=5289778b44c03bc85a970ab2ece27e1888d47558

diff --git a/betty/interrupts.c b/betty/interrupts.c
index db2061d..e344f05 100644
--- a/betty/interrupts.c
+++ b/betty/interrupts.c
@@ -95,6 +95,26 @@ int interrupt_enable(u8 src_number,u8 mode,u8 priority,u32 callback_addr) {
 	return INTERRUPT_SET;
 }
 
+int interrupt_change_callback(u8 src_number,u32 callback) {
+
+	int i;
+	u32 *addr,*cntl;
+
+	cntl=(u32 *)&VICVectCntl0;
+	addr=(u32 *)&VICVectAddr0;
+
+	i=0;
+	while(i<INTERRUPT_MAX_VIC) {
+		if((*cntl&0x1f)==src_number) {
+			*(addr+i)=callback;
+			return INTERRUPT_CALLBACK_CHANGED;
+		}
+		i++;
+	}
+
+	return INTERRUPT_SRC_NOT_USED;
+}
+
 void interrupt_ext_ir_config(u8 eint,u8 wakeup,u8 mode,u8 polarity) {
 
 	if(eint>3)
@@ -105,7 +125,19 @@ void interrupt_ext_ir_config(u8 eint,u8 wakeup,u8 mode,u8 polarity) {
 
 	EXTMODE=(EXTMODE&0xf)|(mode<<eint);
 	EXTPOLAR=(EXTPOLAR&0xf)|(polarity<<eint);
-	EXTINT=(EXTINT&0xf)|(1<<eint);
+}
+
+void interrupt_ext_ir_set(u8 eint) {
+
+	if(eint>3)
+		return;
+
+	EXTINT=(1<<eint);
+}
+
+void interrupt_ack(void) {
+
+	VICVectAddr=0;
 }
 
 /*