/*
 * Copyright (c) 2015 Stefan Kristiansson
 *
 * Use of this source code is governed by a MIT-style
 * license that can be found in the LICENSE file or at
 * https://opensource.org/licenses/MIT
 */
#include <lk/debug.h>
#include <arch/or1k.h>
#include <kernel/thread.h>
#include <platform.h>

static void dump_fault_frame(struct or1k_iframe *frame) {
    addr_t stack = (addr_t)((char *)frame + 128 + sizeof(frame));

    dprintf(CRITICAL, "r0:  0x%08x r1:  0x%08x: r2:  0x%08x r3:  0x%08x\n",
            0, (uint32_t)stack, frame->r2, frame->r3);
    dprintf(CRITICAL, "r4:  0x%08x r5:  0x%08x: r6:  0x%08x r7:  0x%08x\n",
            frame->r4, frame->r5, frame->r6, frame->r7);
    dprintf(CRITICAL, "r8:  0x%08x r9:  0x%08x: r10: 0x%08x r11: 0x%08x\n",
            frame->r8, frame->r9, frame->r10, frame->r11);
    dprintf(CRITICAL, "r12: 0x%08x r13: 0x%08x: r14: 0x%08x r15: 0x%08x\n",
            frame->r12, frame->r13, frame->r14, frame->r15);
    dprintf(CRITICAL, "r16: 0x%08x r17: 0x%08x: r18: 0x%08x r19: 0x%08x\n",
            frame->r16, frame->r17, frame->r18, frame->r19);
    dprintf(CRITICAL, "r20: 0x%08x r21: 0x%08x: r22: 0x%08x r23: 0x%08x\n",
            frame->r20, frame->r21, frame->r22, frame->r23);
    dprintf(CRITICAL, "r24: 0x%08x r25: 0x%08x: r26: 0x%08x r27: 0x%08x\n",
            frame->r24, frame->r25, frame->r26, frame->r27);
    dprintf(CRITICAL, "r28: 0x%08x r29: 0x%08x: r30: 0x%08x r31: 0x%08x\n",
            frame->r28, frame->r29, frame->r30, frame->r31);
    dprintf(CRITICAL, "PC:  0x%08x SR:  0x%08x\n",
            frame->pc, frame->sr);

    dprintf(CRITICAL, "bottom of stack at 0x%08x:\n", (unsigned int)stack);
    hexdump((void *)stack, 128);

}

static void exception_die(struct or1k_iframe *frame, const char *msg) {
    dprintf(CRITICAL, msg);
    dump_fault_frame(frame);

    platform_halt(HALT_ACTION_HALT, HALT_REASON_SW_PANIC);
    for (;;);
}

void or1k_busfault_handler(struct or1k_iframe *frame, uint32_t addr) {
    dprintf(CRITICAL, "unhandled busfault (EEAR: 0x%08x)", addr);
    exception_die(frame, ", halting\n");
}

void or1k_data_pagefault_handler(struct or1k_iframe *frame, uint32_t addr) {
    dprintf(CRITICAL, "unhandled data pagefault (EEAR: 0x%08x)", addr);
    exception_die(frame, ", halting\n");
}

void or1k_instruction_pagefault_handler(struct or1k_iframe *frame, uint32_t addr) {
    dprintf(CRITICAL, "unhandled instruction pagefault (EEAR: 0x%08x)", addr);
    exception_die(frame, ", halting\n");
}

void or1k_alignment_handler(struct or1k_iframe *frame, uint32_t addr) {
    dprintf(CRITICAL, "unhandled unaligned access (EEAR: 0x%08x)", addr);
    exception_die(frame, ", halting\n");
}

void or1k_illegal_instruction_handler(struct or1k_iframe *frame, uint32_t addr) {
    dprintf(CRITICAL, "unhandled illegal instruction (EEAR: 0x%08x)", addr);
    exception_die(frame, ", halting\n");
}

void or1k_syscall_handler(struct or1k_iframe *frame) {
    exception_die(frame, "unhandled syscall, halting\n");
}

void or1k_unhandled_exception(struct or1k_iframe *frame, uint32_t vector) {
    dprintf(CRITICAL, "unhandled exception (vector: 0x%08x)", vector);
    exception_die(frame, ", halting\n");
}