WebSVN – HelenOS – Diff – /branches/arm/kernel/arch/arm32/src/exception.c

 #include <arch/exception.h>
 #include "aux_print/printf.h"
 #include <arch/memstr.h>
 #include <arch/regutils.h>
 #include <interrupt.h>
+#include <arch/drivers/gxemul.h>
 #define PREFETCH_OFFSET     0x8
 #define BRANCH_OPCODE       0xea000000
 #define LDR_OPCODE      0xe59ff000
 #define VALID_BRANCH_MASK   0xff000000
 #define EXC_VECTORS_SIZE    0x20
 #define EXC_VECTORS     0x8
-/* GXEmul interrupt controller macros
-TODO might go to drivers/ together with servicing functions
-*/
-/* IRQ Controller device is added in a special premium gxemul
- * edition at www.ms.mff.cuni.cz/~stepp3am/mygxemul-0.4.4.1.tar.gz
- * :)
- */
-#define IRQ_CONTROLLER_CAUSE    0x0000000016000000
-#define IRQ_CONTROLLER_MAX_IRQ  8
-/* IRQs */
-#define CONSOLE_IRQ     2
-#define TIMER_IRQ       4
 #define SAVE_REGS_TO_STACK          \
     asm("stmfd sp!, {r0-r12, sp, lr}");     \
     asm("mrs r14, spsr");           \
     asm("stmfd sp!, {r14}");
 /** Interrupt Exception handler.
  * Determines the sources of interrupt, and calls their handlers.
  */
 static void irq_exception(int exc_no, istate_t* istate)
+{
-    /* TODO this will call interrupt dispatching routine
-     *
-     */
-    uint32_t sources = *(uint32_t*) IRQ_CONTROLLER_CAUSE;
+    uint32_t sources = gxemul_irqc_get_sources();
     int i = 0;
-    int noirq = 1;
-    for (; i < IRQ_CONTROLLER_MAX_IRQ; i++) {
+    for (; i < GXEMUL_IRQC_MAX_IRQ; i++) {
         if (sources & (1 << i)) {
+            irq_t *irq = irq_dispatch_and_lock(i);
+            if (irq) {
+                /* The IRQ handler was found. */
+                irq->handler(irq, irq->arg);
+                spinlock_unlock(&irq->lock);
+            } else {
+                /* Spurious interrupt.*/
+                aux_printf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, i);
+            }
+        }
+    }
+/* TODO remove after testing the above code
             noirq = 0;
             if (i == CONSOLE_IRQ) {
                 char readchar = *(char*)0x10000000;
                 if (readchar == 0) {
                     aux_puts("?");
+                }
+            }
             else if (i == TIMER_IRQ) {
                 aux_printf("\n.\n");
-                /* acknowledge  */
+                //acknowledge
                 *(uint32_t*)0x15000110 = 0;
+            }
+        }
+    }
     if (noirq)
-        aux_puts("IRQ exception without source\n");
+    aux_puts("IRQ exception without source\n");*/
+}
 /** Fills exception vectors with appropriate exception handlers.
 */
 void install_exception_handlers(void)
     install_handler((unsigned)fiq_exception_entry,
              (unsigned*)EXC_FIQ_VEC);
+}
+/** Initializes exception handling.
+ *
+ * Installs low-level exception handlers and then registers
-/** Registers exceptions and their handlers to kernel exception dispatcher. */
+ * exceptions and their handlers to kernel exception dispatcher.
+ */
 void exception_init(void)
+{
+    install_exception_handlers();
     exc_register(EXC_IRQ, "interrupt", (iroutine) irq_exception);
     /* TODO add next */
+}
 /* TODO change soon, temporary hack. */
     current_status_reg_control_write(
             (cspr & ~STATUS_REG_MODE_MASK) | IRQ_MODE
     );
     asm("ldr sp, =irq_stack");
     current_status_reg_control_write( cspr);
+    /* TODO if you want to test other exceptions than IRQ,
+    make stack analogous to irq_stack (in start.S),
+    and then set stack pointer here */
+}
 /** @}
  */

Subversion Repositories HelenOS

(root)/branches/arm/kernel/arch/arm32/src/exception.c – Rev 2235 → 2245