Subversion Repositories HelenOS

/*

 * 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.");

}

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);

}

/** 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.");

}

static void ss_fault(int n, istate_t *istate)

{

    fault_if_from_uspace(istate, "Stack fault.");

    decode_istate(istate);

    panic("Stack fault.");

}

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).");

}

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_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->arg);

        spinlock_unlock(&irq->lock);

    } else {

        /*

         * Spurious interrupt.

         */

#ifdef CONFIG_DEBUG

        printf("cpu%d: spurious interrupt (inum=%d)\n", CPU->id, inum);

#endif

    }

    if (!ack)

        trap_virtual_eoi();

}

void interrupt_init(void)

{

    int i;

    for (i = 0; i < IVT_ITEMS; i++)

        exc_register(i, "null", (iroutine) null_interrupt);

    for (i = 0; i < IRQ_COUNT; i++) {

        if ((i != IRQ_PIC_SPUR) && (i != IRQ_PIC1))

            exc_register(IVT_IRQBASE + i, "irq", (iroutine) irq_interrupt);

    }

    exc_register(7, "nm_fault", (iroutine) nm_fault);

    exc_register(12, "ss_fault", (iroutine) ss_fault);

    exc_register(13, "gp_fault", (iroutine) gp_fault);

    exc_register(19, "simd_fp", (iroutine) simd_fp_exception);

#ifdef CONFIG_SMP

    exc_register(VECTOR_TLB_SHOOTDOWN_IPI, "tlb_shootdown", (iroutine) tlb_shootdown_ipi);

#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.");

}

/** @}

 */