os-k/kaleid/kernel/ke/panic.c

//----------------------------------------------------------------------------//
//                           GNU GPL OS/K                                     //
//                                                                            //
//  Desc:       How NOT to panic 101                                          //
//                                                                            //
//                                                                            //
//  Copyright © 2018-2019 The OS/K Team                                       //
//                                                                            //
//  This file is part of OS/K.                                                //
//                                                                            //
//  OS/K 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 3 of the License, or         //
//  any later version.                                                        //
//                                                                            //
//  OS/K 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 OS/K.  If not, see <https://www.gnu.org/licenses/>.            //
//----------------------------------------------------------------------------//

#include <kernel/term.h>
#include <kernel/panic.h>

//
// Failed assert() handler
//
noreturn void __assert_handler(const char *msg,
                               const char *file,
                               int line,
                               const char *func)
{
    DisableIRQs();

    (void)file; (void)line; (void)func;

    StartPanic("cpu%d: In function '%s', from %s line %d - assert() failed: '%s'",
                   _GetCurCPU(), func, file, line, msg);
}

//
// Your best boy panic()
// This is CPU local...
//
noreturn void StartPanic(const char *fmt, ...)
{
    va_list ap;

    DisableIRQs();

    if (GetCurProc()) _SetCurProc(NULL);
    if (GetStdOut() == NULL) CrashSystem();

    GetStdOut()->ClearTermUnlocked(GetStdOut());

    if (fmt == NULL) {
        fmt = "(no message given)";
    }

    if (*GetPanicStr()) {
        GetStdOut()->PrintOnTermUnlocked(GetStdOut(), "\nDouble panic!");
        HaltCPU();
    }

    va_start(ap, fmt);
    vsnprintf(GetPanicStr(), PANICSTR_SIZE, fmt, ap);
    va_end(ap);

    GetStdOut()->PrintOnTermUnlocked(GetStdOut(), "\nPanic!\n\n");
    GetStdOut()->PrintOnTermUnlocked(GetStdOut(), GetPanicStr());

    HaltCPU();
}

//
// Oh well
//
noreturn void CrashSystem(void)
{
    while (1) {
        DisableIRQs();
        HaltCPU();
    }
}