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

diff --git a/betty/interrupts.c b/betty/interrupts.c
index bb2344c..e344f05 100644
--- a/betty/interrupts.c
+++ b/betty/interrupts.c
@@ -6,11 +6,9 @@
  */
 
 #include "interrupts.h"
+#include "functions.h"
 
-/*
- * module static interrupt variable
- */
-
+// 'module global' interrupt variable
 static t_interrupt interrupt;
 
 /*
@@ -19,9 +17,9 @@ static t_interrupt interrupt;
 
 void interrupt_init(void) {
 
-	memset(&interrupt,0,sizeof(t_interrupt));
-	VICSoftIntClear=0xff;
-	VICIntEnClear=0xff;
+	interrupt.default_soft_callback=0;
+	VICSoftIntClr=0xffffffff;
+	VICIntEnClr=0xffffffff;
 	VICDefVectAddr=0;
 }
 
@@ -32,12 +30,12 @@ void interrupt_set_default_callback(u32 callback_addr) {
 
 void interrupt_set_soft_callback(void (*callback)(void)) {
 
-	interrupt->default_soft_callback=callback;
+	interrupt.default_soft_callback=callback;
 }
 
 void interrupt_soft_clear(u8 src_number) {
 
-	VICSoftIntClear=(1<<src_number);
+	VICSoftIntClr=(1<<src_number);
 }
 void interrupt_clear(u8 src_number) {
 
@@ -45,14 +43,14 @@ void interrupt_clear(u8 src_number) {
 	u32 *addr;
 	u32 *cntl;
 
-	VICIntEnClear=(1<<src_number);
+	VICIntEnClr=(1<<src_number);
 	VICIntSelect&=~(1<<src_number);
 
-	addr=&VICVectAddr0;
-	cntl=&VICVectCntl0;
+	addr=(u32 *)&VICVectAddr0;
+	cntl=(u32 *)&VICVectCntl0;
 
 	for(cnt=0;cnt<INTERRUPT_MAX_VIC;cnt++) {
-		if(cntl[cnt]&0x1f==src_number) {
+		if((cntl[cnt]&0x1f)==src_number) {
 			*((volatile u32 *)(addr+cnt))=0;
 			*((volatile u32 *)(cntl+cnt))=0;
 		}
@@ -69,32 +67,79 @@ int interrupt_enable(u8 src_number,u8 mode,u8 priority,u32 callback_addr) {
 	u32 *addr;
 	u32 *cntl;
 
-	addr=&VICVectAddr0;
-	cntl=&VICVectCntl0;
+	addr=(u32 *)&VICVectAddr0;
+	cntl=(u32 *)&VICVectCntl0;
 
 	/* check whether this ir source is allready assigned */
 	if(VICIntEnable&(1<<src_number))
 		return INTERRUPT_USED;
 
-	/* force interrupt */
-	VICIntEnable=(1<<src_number);
-
+	/* prepare depending on mode */
 	switch(mode) {
-		case INTERRUPT_FIQ:
+		case INTERRUPT_MODE_FIQ:
 			VICIntSelect|=(1<<src_number);
 			break;
-		case INTERRUPT_VIRQ:
-			if(addr[p]&0x3f)
-				return INTERRUP_PRIORITY_USED;
-			*((volatile u32 *)(addr+p))=callback_addr;
-			*((volatile u32 *)(cntl+p))=src_number&0x1f+(1<<5);
-		case INTERRUPT_IRQ:
-		case default:
+		case INTERRUPT_MODE_VIRQ:
+			if(addr[priority]&0x3f)
+				return INTERRUPT_PRIORITY_USED;
+			*((volatile u32 *)(addr+priority))=callback_addr;
+			*((volatile u32 *)(cntl+priority))=(src_number&0x1f)+0x20;
+		case INTERRUPT_MODE_IRQ:
+		default:
+			break;
 	}
 
+	/* force interrupt */
+	VICIntEnable=(1<<src_number);
+
 	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)
+		return;
+
+	if(wakeup)
+		EXTWAKE=(EXTWAKE&0xf)|(1<<eint);
+
+	EXTMODE=(EXTMODE&0xf)|(mode<<eint);
+	EXTPOLAR=(EXTPOLAR&0xf)|(polarity<<eint);
+}
+
+void interrupt_ext_ir_set(u8 eint) {
+
+	if(eint>3)
+		return;
+
+	EXTINT=(1<<eint);
+}
+
+void interrupt_ack(void) {
+
+	VICVectAddr=0;
+}
+
 /*
  * the actual exception handlers (as defined in startup.s)
  */