/* * Copyright (c) 2003-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 mips64 * @{ */ /** @file */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include static const char *exctable[] = { "Interrupt", "TLB Modified", "TLB Invalid", "TLB Invalid Store", "Address Error - load/instr. fetch", "Address Error - store", "Bus Error - fetch instruction", "Bus Error - data reference", "Syscall", "BreakPoint", "Reserved Instruction", "Coprocessor Unusable", "Arithmetic Overflow", "Trap", "Virtual Coherency - instruction", "Floating Point", NULL, NULL, NULL, NULL, NULL, NULL, NULL, "WatchHi/WatchLo", /* 23 */ NULL, NULL, NULL, NULL, NULL, NULL, NULL, "Virtual Coherency - data", }; void istate_decode(istate_t *istate) { printf("epc=%#018" PRIx64 "\tsta=%#018" PRIx64 "\t" "lo =%#018" PRIx64 "\thi =%#018" PRIx64 "\n", istate->epc, istate->status, istate->lo, istate->hi); printf("a0 =%#018" PRIx64 "\ta1 =%#018" PRIx64 "\t" "a2 =%#018" PRIx64 "\ta3 =%#018" PRIx64 "\n", istate->a0, istate->a1, istate->a2, istate->a3); printf("t0 =%#018" PRIx64 "\tt1 =%#018" PRIx64 "\t" "t2 =%#018" PRIx64 "\tt3 =%#018" PRIx64 "\n", istate->t0, istate->t1, istate->t2, istate->t3); printf("t4 =%#018" PRIx64 "\tt5 =%#018" PRIx64 "\t" "t6 =%#018" PRIx64 "\tt7 =%#018" PRIx64 "\n", istate->t4, istate->t5, istate->t6, istate->t7); printf("t8 =%#018" PRIx64 "\tt9 =%#018" PRIx64 "\t" "v0 =%#018" PRIx64 "\tv1 =%#018" PRIx64 "\n", istate->t8, istate->t9, istate->v0, istate->v1); printf("s0 =%#018" PRIx64 "\ts1 =%#018" PRIx64 "\t" "s2 =%#018" PRIx64 "\ts3 =%#018" PRIx64 "\n", istate->s0, istate->s1, istate->s2, istate->s3); printf("s4 =%#018" PRIx64 "\ts5 =%#018" PRIx64 "\t" "s6 =%#018" PRIx64 "\ts7 =%#018" PRIx64 "\n", istate->s4, istate->s5, istate->s6, istate->s7); printf("s8 =%#018" PRIx64 "\tat =%#018" PRIx64 "\t" "kt0=%#018" PRIx64 "\tkt1=%#018" PRIx64 "\n", istate->s8, istate->at, istate->kt0, istate->kt1); printf("sp =%#018" PRIx64 "\tra =%#018" PRIx64 "\t" "gp =%#018" PRIx64 "\n", istate->sp, istate->ra, istate->gp); } static void unhandled_exception(unsigned int n, istate_t *istate) { fault_if_from_uspace(istate, "Unhandled exception %s.", exctable[n]); panic_badtrap(istate, n, "Unhandled exception %s.", exctable[n]); } static void reserved_instr_exception(unsigned int n, istate_t *istate) { if (*((uint32_t *) istate->epc) == 0x7c03e83b) { ASSERT(THREAD); istate->epc += 4; istate->v1 = istate->kt1; } else unhandled_exception(n, istate); } static void breakpoint_exception(unsigned int n, istate_t *istate) { #ifdef CONFIG_DEBUG debugger_bpoint(istate); #else /* it is necessary to not re-execute BREAK instruction after returning from Exception handler (see page 138 in R4000 Manual for more information) */ istate->epc += 4; #endif } static void tlbmod_exception(unsigned int n, istate_t *istate) { tlb_modified(istate); } static void tlbinv_exception(unsigned int n, istate_t *istate) { tlb_invalid(istate); } #ifdef CONFIG_FPU_LAZY static void cpuns_exception(unsigned int n, istate_t *istate) { if (cp0_cause_coperr(cp0_cause_read()) == fpu_cop_id) scheduler_fpu_lazy_request(); else { fault_if_from_uspace(istate, "Unhandled Coprocessor Unusable Exception."); panic_badtrap(istate, n, "Unhandled Coprocessor Unusable Exception."); } } #endif static void interrupt_exception(unsigned int n, istate_t *istate) { /* Decode interrupt number and process the interrupt */ uint32_t cause = (cp0_cause_read() >> 8) & 0xff; unsigned int i; for (i = 0; i < 8; i++) { if (cause & (1 << i)) { irq_t *irq = irq_dispatch_and_lock(i); if (irq) { /* * The IRQ handler was found. */ 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, i); #endif } } } } /** Handle syscall userspace call */ static void syscall_exception(unsigned int n, istate_t *istate) { fault_if_from_uspace(istate, "Syscall is handled through shortcut."); } void exception_init(void) { unsigned int i; /* Clear exception table */ for (i = 0; i < IVT_ITEMS; i++) exc_register(i, "undef", false, (iroutine_t) unhandled_exception); exc_register(EXC_Bp, "bkpoint", true, (iroutine_t) breakpoint_exception); exc_register(EXC_RI, "resinstr", true, (iroutine_t) reserved_instr_exception); exc_register(EXC_Mod, "tlb_mod", true, (iroutine_t) tlbmod_exception); exc_register(EXC_TLBL, "tlbinvl", true, (iroutine_t) tlbinv_exception); exc_register(EXC_TLBS, "tlbinvl", true, (iroutine_t) tlbinv_exception); exc_register(EXC_Int, "interrupt", true, (iroutine_t) interrupt_exception); #ifdef CONFIG_FPU_LAZY exc_register(EXC_CpU, "cpunus", true, (iroutine_t) cpuns_exception); #endif exc_register(EXC_Sys, "syscall", true, (iroutine_t) syscall_exception); } /** @} */