arch-spec/dev/irq.c copied from wrpc-sw (commit 82fd420e) and compiled

96f4b173 · Aurelio Colosimo · 5dd2ab04 · 96f4b173 · 96f4b173 · 96f4b173
Commit 96f4b173 authored Jul 21, 2012 by Aurelio Colosimo
Hide whitespace changes
Inline Side-by-side

Showing with 40 additions and 6 deletions

Makefile arch-spec/Makefile +1 -0

irq.c arch-spec/dev/irq.c +39 -0

spec-startup.c arch-spec/spec-startup.c +0 -6

No files found.
--- a/arch-spec/Makefile
+++ b/arch-spec/Makefile
@@ -23,6 +23,7 @@ OBJ-libarch := $A/spec-startup.o \
 	$A/dev/pps_gen.o \
 	$A/dev/minic.o \
 	$A/dev/softpll_ng.o \
+	$A/dev/irq.o \
 	lib/div64.o

 $(LIBARCH): $(OBJ-libarch)

--- a/arch-spec/dev/irq.c
+++ b/arch-spec/dev/irq.c
+#include "irq.h"
+
+void disable_irq()
+{
+    unsigned int ie, im;
+    unsigned int Mask = ~1;
+
+    /* disable peripheral interrupts in case they were enabled */
+    asm volatile ("rcsr %0,ie":"=r"(ie));
+    ie &= (~0x1);
+    asm volatile ("wcsr ie, %0"::"r"(ie));
+
+    /* disable mask-bit in im */
+    asm volatile ("rcsr %0, im":"=r"(im));
+    im &= Mask;
+    asm volatile ("wcsr im, %0"::"r"(im));
+
+}
+
+
+void enable_irq()
+{
+    unsigned int ie, im;
+    unsigned int Mask = 1;
+
+
+    /* disable peripheral interrupts in-case they were enabled*/
+    asm volatile ("rcsr %0,ie":"=r"(ie));
+    ie &= (~0x1);
+    asm volatile ("wcsr ie, %0"::"r"(ie));
+
+    /* enable mask-bit in im */
+    asm volatile ("rcsr %0, im":"=r"(im));
+    im |= Mask;
+    asm volatile ("wcsr im, %0"::"r"(im));
+
+    ie |= 0x1;
+    asm volatile ("wcsr ie, %0"::"r"(ie));
+}
--- a/arch-spec/spec-startup.c
+++ b/arch-spec/spec-startup.c
@@ -64,9 +64,3 @@ void ppsi_main(void)
 /* Our crt0.S is unchanged: it wants a "main" function, and "_irq_entry" too" */

 int main(void) __attribute__((alias("ppsi_main")));
-
-void _irq_entry(void)
-{
-	return;
-}
-