From d7b3c5bdc5d59b908e1835839c124d6463a5f1e0 Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Thu, 24 Mar 2022 17:03:08 -0700
Subject: Started unsubscribe irq functionality

---
 kernel/cpu/irq.c | 25 +++++++++++++++++++++++++
 1 file changed, 25 insertions(+)

(limited to 'kernel/cpu')

diff --git a/kernel/cpu/irq.c b/kernel/cpu/irq.c
index 6e48ab1..e7ab8c0 100644
--- a/kernel/cpu/irq.c
+++ b/kernel/cpu/irq.c
@@ -133,3 +133,28 @@ void subscribe_irq(unsigned long irq_num, void* handler, void* handler_info)
 			break;
 	}
 }
+
+void unsubscribe_irq(unsigned long irq_num)
+{
+	if (irq_num >= MAX_IRQS)
+		return;
+	irqs[irq_num].handler = 0;
+	irqs[irq_num].handler_info = 0;
+	switch (irq_num) {
+		case UART_IRQ:
+			store32(1<<25, IRQ_DISABLE2);
+			break;
+		case SYS_TIMER_0_IRQ:
+			store32(SYS_TIMER_SC_M0, IRQ_DISABLE1);
+			break;
+		case SYS_TIMER_1_IRQ:
+			store32(SYS_TIMER_SC_M1, IRQ_DISABLE1);
+			break;
+		case SYS_TIMER_2_IRQ:
+			store32(SYS_TIMER_SC_M2, IRQ_DISABLE1);
+			break;
+		case SYS_TIMER_3_IRQ:
+			store32(SYS_TIMER_SC_M3, IRQ_DISABLE1);
+			break;
+	}
+}
-- 
cgit v1.2.1