WebSVN – HelenOS – Diff – /branches/rcu/kernel/arch/ia32xen/src/interrupt.c

 /*
  * Copyright (c) 2006 Martin Decky
  * All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:
  *
  * - Redistributions of source code must retain the above copyright
  *   notice, this list of conditions and the following disclaimer.
  * - Redistributions in binary form must reproduce the above copyright
  *   notice, this list of conditions and the following disclaimer in the
  *   documentation and/or other materials provided with the distribution.
  * - The name of the author may not be used to endorse or promote products
  *   derived from this software without specific prior written permission.
  *
  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
 /** @addtogroup ia32xen_interrupt
  * @{
  */
 /** @file
  */
 #include <arch/interrupt.h>
 #include <syscall/syscall.h>
 #include <print.h>
 #include <debug.h>
 #include <panic.h>
 #include <func.h>
 #include <cpu.h>
 #include <arch/asm.h>
 #include <mm/tlb.h>
 #include <mm/as.h>
 #include <arch.h>
 #include <symtab.h>
 #include <proc/thread.h>
 #include <proc/task.h>
 #include <synch/spinlock.h>
 #include <arch/ddi/ddi.h>
 #include <ipc/sysipc.h>
 #include <interrupt.h>
 #include <ddi/irq.h>
 /*
  * Interrupt and exception dispatching.
  */
 void (* disable_irqs_function)(uint16_t irqmask) = NULL;
 void (* enable_irqs_function)(uint16_t irqmask) = NULL;
 void (* eoi_function)(void) = NULL;
 void decode_istate(istate_t *istate)
 {
     char *symbol = get_symtab_entry(istate->eip);
     if (!symbol)
         symbol = "";
     if (CPU)
         printf("----------------EXCEPTION OCCURED (cpu%d)----------------\n", CPU->id);
     else
         printf("----------------EXCEPTION OCCURED----------------\n");
     printf("%%eip: %#x (%s)\n",istate->eip,symbol);
     printf("ERROR_WORD=%#x\n", istate->error_word);
     printf("%%cs=%#x,flags=%#x\n", istate->cs, istate->eflags);
     printf("%%eax=%#x, %%ecx=%#x, %%edx=%#x, %%esp=%#x\n",  istate->eax,istate->ecx,istate->edx,&istate->stack[0]);
 #ifdef CONFIG_DEBUG_ALLREGS
     printf("%%esi=%#x, %%edi=%#x, %%ebp=%#x, %%ebx=%#x\n",  istate->esi,istate->edi,istate->ebp,istate->ebx);
 #endif
     printf("stack: %#x, %#x, %#x, %#x\n", istate->stack[0], istate->stack[1], istate->stack[2], istate->stack[3]);
     printf("       %#x, %#x, %#x, %#x\n", istate->stack[4], istate->stack[5], istate->stack[6], istate->stack[7]);
 }
 static void trap_virtual_eoi(void)
 {
     if (eoi_function)
         eoi_function();
     else
         panic("no eoi_function\n");
 }
 static void null_interrupt(int n, istate_t *istate)
 {
     fault_if_from_uspace(istate, "unserviced interrupt: %d", n);
     decode_istate(istate);
     panic("unserviced interrupt: %d\n", n);
 }
 /** General Protection Fault. */
 static void gp_fault(int n, istate_t *istate)
 {
     if (TASK) {
         count_t ver;
         spinlock_lock(&TASK->lock);
         ver = TASK->arch.iomapver;
         spinlock_unlock(&TASK->lock);
         if (CPU->arch.iomapver_copy != ver) {
             /*
              * This fault can be caused by an early access
              * to I/O port because of an out-dated
              * I/O Permission bitmap installed on CPU.
              * Install the fresh copy and restart
              * the instruction.
              */
             io_perm_bitmap_install();
             return;
         }
         fault_if_from_uspace(istate, "general protection fault");
     }
     decode_istate(istate);
     panic("general protection fault\n");
 }
 static void ss_fault(int n, istate_t *istate)
 {
     fault_if_from_uspace(istate, "stack fault");
     decode_istate(istate);
     panic("stack fault\n");
 }
 static void simd_fp_exception(int n, istate_t *istate)
 {
     uint32_t mxcsr;
     asm
     (
         "stmxcsr %0;\n"
         :"=m"(mxcsr)
     );
     fault_if_from_uspace(istate, "SIMD FP exception(19), MXCSR: %#zx",
                  (unative_t)mxcsr);
     decode_istate(istate);
     printf("MXCSR: %#zx\n",(unative_t)(mxcsr));
     panic("SIMD FP exception(19)\n");
 }
 static void nm_fault(int n, istate_t *istate)
 {
 #ifdef CONFIG_FPU_LAZY
     scheduler_fpu_lazy_request();
 #else
     fault_if_from_uspace(istate, "fpu fault");
     panic("fpu fault");
 #endif
 }
 #ifdef CONFIG_SMP
 static void tlb_shootdown_ipi(int n, istate_t *istate)
 {
     trap_virtual_eoi();
     tlb_shootdown_ipi_recv();
 }
 #endif
 /** Handler of IRQ exceptions */
 static void irq_interrupt(int n, istate_t *istate)
 {
     ASSERT(n >= IVT_IRQBASE);
     int inum = n - IVT_IRQBASE;
-    bool ack = false;
+    ASSERT(inum < IRQ_COUNT);
-    ASSERT(inum < IRQ_COUNT);
+    ASSERT((inum != IRQ_PIC_SPUR) && (inum != IRQ_PIC1));
-    ASSERT((inum != IRQ_PIC_SPUR) && (inum != IRQ_PIC1));
+    irq_t *irq = irq_dispatch_and_lock(inum);
-    irq_t *irq = irq_dispatch_and_lock(inum);
+    if (irq) {
-    if (irq) {
+        /*
-        /*
+         * The IRQ handler was found.
-         * The IRQ handler was found.
+         */
-         */
+        irq->handler(irq, irq->arg);
+        spinlock_unlock(&irq->lock);
-        if (irq->preack) {
+    } else {
-            /* Send EOI before processing the interrupt */
+        /*
-            trap_virtual_eoi();
+         * Spurious interrupt.
-            ack = true;
+         */
-        }
+#ifdef CONFIG_DEBUG
-        irq->handler(irq, irq->arg);
+        printf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, inum);
-        spinlock_unlock(&irq->lock);
+#endif
-    } else {
+    }
-        /*
+    trap_virtual_eoi();
-         * Spurious interrupt.
+}
-         */
-#ifdef CONFIG_DEBUG
+void interrupt_init(void)
-        printf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, inum);
+{
-#endif
+    int i;
-    }
+    for (i = 0; i < IVT_ITEMS; i++)
-    if (!ack)
+        exc_register(i, "null", (iroutine) null_interrupt);
-        trap_virtual_eoi();
-}
+    for (i = 0; i < IRQ_COUNT; i++) {
+        if ((i != IRQ_PIC_SPUR) && (i != IRQ_PIC1))
-void interrupt_init(void)
+            exc_register(IVT_IRQBASE + i, "irq", (iroutine) irq_interrupt);
-{
+    }
-    int i;
+    exc_register(7, "nm_fault", (iroutine) nm_fault);
-    for (i = 0; i < IVT_ITEMS; i++)
+    exc_register(12, "ss_fault", (iroutine) ss_fault);
-        exc_register(i, "null", (iroutine) null_interrupt);
+    exc_register(13, "gp_fault", (iroutine) gp_fault);
+    exc_register(19, "simd_fp", (iroutine) simd_fp_exception);
-    for (i = 0; i < IRQ_COUNT; i++) {
-        if ((i != IRQ_PIC_SPUR) && (i != IRQ_PIC1))
+#ifdef CONFIG_SMP
-            exc_register(IVT_IRQBASE + i, "irq", (iroutine) irq_interrupt);
+    exc_register(VECTOR_TLB_SHOOTDOWN_IPI, "tlb_shootdown", (iroutine) tlb_shootdown_ipi);
-    }
+#endif
+}
-    exc_register(7, "nm_fault", (iroutine) nm_fault);
-    exc_register(12, "ss_fault", (iroutine) ss_fault);
+void trap_virtual_enable_irqs(uint16_t irqmask)
-    exc_register(13, "gp_fault", (iroutine) gp_fault);
+{
-    exc_register(19, "simd_fp", (iroutine) simd_fp_exception);
+    if (enable_irqs_function)
+        enable_irqs_function(irqmask);
-#ifdef CONFIG_SMP
+    else
-    exc_register(VECTOR_TLB_SHOOTDOWN_IPI, "tlb_shootdown", (iroutine) tlb_shootdown_ipi);
+        panic("no enable_irqs_function\n");
-#endif
+}
-}
+void trap_virtual_disable_irqs(uint16_t irqmask)
-void trap_virtual_enable_irqs(uint16_t irqmask)
+{
-{
+    if (disable_irqs_function)
-    if (enable_irqs_function)
+        disable_irqs_function(irqmask);
-        enable_irqs_function(irqmask);
+    else
-    else
+        panic("no disable_irqs_function\n");
-        panic("no enable_irqs_function\n");
+}
-}
+/** @}
-void trap_virtual_disable_irqs(uint16_t irqmask)
+ */
-{
-    if (disable_irqs_function)
-        disable_irqs_function(irqmask);
-    else
-        panic("no disable_irqs_function\n");
-}
-/** @}
- */

Subversion Repositories HelenOS

(root)/branches/rcu/kernel/arch/ia32xen/src/interrupt.c – Rev 2265 → 2292