Subversion Repositories freemyipod

//
//
//    Copyright 2010 TheSeven
//
//
//    This file is part of emBIOS.
//
//    emBIOS is free software: you can redistribute it and/or
//    modify it under the terms of the GNU General Public License as
//    published by the Free Software Foundation, either version 2 of the
//    License, or (at your option) any later version.
//
//    emBIOS is distributed in the hope that it will be useful,
//    but WITHOUT ANY WARRANTY; without even the implied warranty of
//    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
//    See the GNU General Public License for more details.
//
//    You should have received a copy of the GNU General Public License along
//    with emBIOS.  If not, see <http://www.gnu.org/licenses/>.
//
//


#include "global.h"
#include "panic.h"
#include "lcd.h"
#include "lcdconsole.h"
#include "console.h"
#include "format.h"
#include "thread.h"
#include "contextswitch.h"


extern struct scheduler_thread* scheduler_threads;
extern struct scheduler_thread* current_thread;


void handle_panic(enum panic_severity severity)
{
    int i;
    if (severity == PANIC_KILLTHREAD) thread_exit();
    else
    {
        uint32_t mode = enter_critical_section();
        for (i = 0; i < MAX_THREADS; i++)
            if (scheduler_threads[i].type == USER_THREAD)
                scheduler_threads[i].state = THREAD_SUSPENDED;
        current_thread->state = THREAD_DEFUNCT_ACK;
        current_thread->block_type = THREAD_DEFUNCT_PANIC;
        leave_critical_section(mode);
        context_switch();
    }
}

void panic(enum panic_severity severity, const char* string)
{
    if (severity == PANIC_FATAL)
    {
        enter_critical_section();
        while (!displaylcd_safe());
        lcdconsole_puts_noblit("\n*PANIC*\n", 0, -1);
        lcdconsole_puts_noblit(string, 0, -1);
        lcdconsole_puts_noblit("\n", 0, -1);
        lcdconsole_update();
        hang();
    }
    else
    {
        cputs(1, "\n*PANIC*\n");
        cputs(1, string);
        cputc(1, '\n');
        handle_panic(severity);
    }
}

static int pprfunc(void* ptr, unsigned char letter)
{
    lcdconsole_putc_noblit(letter, 0, -1);
    return true;
}

void panicf(enum panic_severity severity, const char* string, ...)
{
    va_list ap;
    if (severity == PANIC_FATAL)
    {
        enter_critical_section();
        while (!displaylcd_safe());
        lcdconsole_puts_noblit("\n*PANIC*\n", 0, -1);
        va_start(ap, string);
        format(pprfunc, NULL, string, ap);
        va_end(ap);
        lcdconsole_puts_noblit("\n", 0, -1);
        lcdconsole_update();
        hang();
    }
    else
    {
        cputs(1, "\n*PANIC*\n");
        va_start(ap, string);
        cvprintf(1, string, ap);
        va_end(ap);
        cputc(1, '\n');
        handle_panic(severity);
    }
}

void __div0()
{
    panic(PANIC_KILLTHREAD, "Division by zero!");
}