/* * Copyright (c) 2001-2004 Jakub Jermar * 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 ia32interrupt * @{ */ /** @file */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* * 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; const char *irqs_info = NULL; void istate_decode(istate_t *istate) { printf("cs =%0#10" PRIx32 "\teip=%0#10" PRIx32 "\t" "efl=%0#10" PRIx32 "\terr=%0#10" PRIx32 "\n", istate->cs, istate->eip, istate->eflags, istate->error_word); printf("ds =%0#10" PRIx32 "\tes =%0#10" PRIx32 "\t" "fs =%0#10" PRIx32 "\tgs =%0#10" PRIx32 "\n", istate->ds, istate->es, istate->fs, istate->gs); if (istate_from_uspace(istate)) printf("ss =%0#10" PRIx32 "\n", istate->ss); printf("eax=%0#10" PRIx32 "\tebx=%0#10" PRIx32 "\t" "ecx=%0#10" PRIx32 "\tedx=%0#10" PRIx32 "\n", istate->eax, istate->ebx, istate->ecx, istate->edx); printf("esi=%0#10" PRIx32 "\tedi=%0#10" PRIx32 "\t" "ebp=%0#10" PRIx32 "\tesp=%0#10" PRIxn "\n", istate->esi, istate->edi, istate->ebp, istate_from_uspace(istate) ? istate->esp : (uintptr_t) &istate->esp); } static void trap_virtual_eoi(void) { if (eoi_function) eoi_function(); else panic("No eoi_function."); } static void null_interrupt(unsigned int n, istate_t *istate) { fault_if_from_uspace(istate, "Unserviced interrupt: %u.", n); panic_badtrap(istate, n, "Unserviced interrupt: %u.", n); } static void de_fault(unsigned int n, istate_t *istate) { fault_if_from_uspace(istate, "Divide error."); panic_badtrap(istate, n, "Divide error."); } /** General Protection Fault. */ static void gp_fault(unsigned int n __attribute__((unused)), istate_t *istate) { if (TASK) { irq_spinlock_lock(&TASK->lock, false); size_t ver = TASK->arch.iomapver; irq_spinlock_unlock(&TASK->lock, false); 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."); } panic_badtrap(istate, n, "General protection fault."); } static void ss_fault(unsigned int n __attribute__((unused)), istate_t *istate) { fault_if_from_uspace(istate, "Stack fault."); panic_badtrap(istate, n, "Stack fault."); } static void simd_fp_exception(unsigned int n __attribute__((unused)), istate_t *istate) { uint32_t mxcsr; asm volatile ( "stmxcsr %[mxcsr]\n" : [mxcsr] "=m" (mxcsr) ); fault_if_from_uspace(istate, "SIMD FP exception(19), MXCSR=%#0" PRIx32 ".", mxcsr); panic_badtrap(istate, n, "SIMD FP exception"); } static void nm_fault(unsigned int n __attribute__((unused)), istate_t *istate __attribute__((unused))) { #ifdef CONFIG_FPU_LAZY scheduler_fpu_lazy_request(); #else fault_if_from_uspace(istate, "FPU fault."); panic_badtrap(istate, n, "FPU fault."); #endif } #ifdef CONFIG_SMP static void tlb_shootdown_ipi(unsigned int n __attribute__((unused)), istate_t *istate __attribute__((unused))) { trap_virtual_eoi(); tlb_shootdown_ipi_recv(); } static void arch_smp_call_ipi_recv(unsigned int n, istate_t *istate) { trap_virtual_eoi(); smp_call_ipi_recv(); } #endif /** Handler of IRQ exceptions */ static void irq_interrupt(unsigned int n, istate_t *istate __attribute__((unused))) { assert(n >= IVT_IRQBASE); unsigned int inum = n - IVT_IRQBASE; bool ack = false; assert(inum < IRQ_COUNT); assert((inum != IRQ_PIC_SPUR) && (inum != IRQ_PIC1)); irq_t *irq = irq_dispatch_and_lock(inum); if (irq) { /* * The IRQ handler was found. */ if (irq->preack) { /* Send EOI before processing the interrupt */ trap_virtual_eoi(); ack = true; } irq->handler(irq); irq_spinlock_unlock(&irq->lock, false); } else { /* * Spurious interrupt. */ #ifdef CONFIG_DEBUG printf("cpu%u: spurious interrupt (inum=%u)\n", CPU->id, inum); #endif } if (!ack) trap_virtual_eoi(); } void interrupt_init(void) { unsigned int i; for (i = 0; i < IVT_ITEMS; i++) exc_register(i, "null", false, (iroutine_t) null_interrupt); for (i = 0; i < IRQ_COUNT; i++) { if ((i != IRQ_PIC_SPUR) && (i != IRQ_PIC1)) exc_register(IVT_IRQBASE + i, "irq", true, (iroutine_t) irq_interrupt); } exc_register(VECTOR_DE, "de_fault", true, (iroutine_t) de_fault); exc_register(VECTOR_NM, "nm_fault", true, (iroutine_t) nm_fault); exc_register(VECTOR_SS, "ss_fault", true, (iroutine_t) ss_fault); exc_register(VECTOR_GP, "gp_fault", true, (iroutine_t) gp_fault); exc_register(VECTOR_XM, "simd_fp", true, (iroutine_t) simd_fp_exception); #ifdef CONFIG_SMP exc_register(VECTOR_TLB_SHOOTDOWN_IPI, "tlb_shootdown", true, (iroutine_t) tlb_shootdown_ipi); exc_register(VECTOR_SMP_CALL_IPI, "smp_call", true, (iroutine_t) arch_smp_call_ipi_recv); #endif } void trap_virtual_enable_irqs(uint16_t irqmask) { if (enable_irqs_function) enable_irqs_function(irqmask); else panic("No enable_irqs_function."); } void trap_virtual_disable_irqs(uint16_t irqmask) { if (disable_irqs_function) disable_irqs_function(irqmask); else panic("No disable_irqs_function."); } /** @} */