common.c

Go to the documentation of this file.

#include <sys/types.h>
#include <stdio.h>
#include <stdlib.h>
#include <stddef.h>
#include <stdint.h>
#include <unistd.h>
#include <stdarg.h>
#include <string.h>
#include <time.h>
#include <semaphore.h>

#include <segment.h>
#include <idt.h>
#include <pic.h>
#include <interrupt.h>
#include <isr.h>

#include <fdc.h>
#include <video.h>
#include <serial.h>
#include <keyboard.h>

#include <paging.h>

#include <arch.h> /* panic */
#include <x86.h> /* halt */

#include <timer_handler.h>
#include <divide_error_handler.h>
#include <page_fault_handler.h>

#include <debug.h>

static int eoi(int sub_irq, void *info, void *data)
{
        if (sub_irq == IRQ_NR_FDC) {
                static int cnt = 0;
                dbg_printf("========= EOI ==========[%d]\n", cnt++);
        }

        asm volatile (
                "mov $0x20, %%al;"
                "mov $0x20, %%dx;"
                "outb %%al, %%dx"
                :   
                :   
                : "eax", "edx"
        );  

        return 0;
}

int arch_init(void)
{
        int ret;

        segment_init();
        interrupt_init();

        ret = register_irq(IRQ_NR_TIMER, LOW_PRIORITY, eoi, NULL);
        if (ret < 0) {
                return ret;
        }

        ret = register_irq(IRQ_NR_FDC, LOW_PRIORITY, eoi, NULL);
        if (ret < 0) {
                unregister_irq(IRQ_NR_TIMER, eoi, NULL);
                return ret;
        }

        ret = register_irq(IRQ_NR_KEYBOARD, LOW_PRIORITY, eoi, NULL);
        if (ret < 0) {
                unregister_irq(IRQ_NR_FDC, eoi, NULL);
                unregister_irq(IRQ_NR_TIMER, eoi, NULL);
                return ret;
        }

        ret = register_irq(IRQ_NR_PAGE_FAULT, NORMAL_PRIORITY,
                                page_fault_handler, NULL);
        if (ret < 0) {
                unregister_irq(IRQ_NR_KEYBOARD, eoi, NULL);
                unregister_irq(IRQ_NR_FDC, eoi, NULL);
                unregister_irq(IRQ_NR_TIMER, eoi, NULL);
                return ret;
        }

        ret = register_irq(IRQ_NR_TIMER, NORMAL_PRIORITY, timer_handler, NULL);
        if (ret < 0) {
                unregister_irq(IRQ_NR_PAGE_FAULT, page_fault_handler, NULL);
                unregister_irq(IRQ_NR_KEYBOARD, eoi, NULL);
                unregister_irq(IRQ_NR_FDC, eoi, NULL);
                unregister_irq(IRQ_NR_TIMER, eoi, NULL);
                return ret;
        }

        ret = register_irq(IRQ_NR_DIVIDE, NORMAL_PRIORITY, divide_error_handler, NULL);
        if (ret < 0) {
                unregister_irq(IRQ_NR_TIMER, timer_handler, NULL);
                unregister_irq(IRQ_NR_PAGE_FAULT, page_fault_handler, NULL);
                unregister_irq(IRQ_NR_KEYBOARD, eoi, NULL);
                unregister_irq(IRQ_NR_FDC, eoi, NULL);
                unregister_irq(IRQ_NR_TIMER, eoi, NULL);
                return ret;
        }

        pic_init();
        timer_init(100);

        return 0;
}

void __attribute__((noreturn)) panic(const char *fmt, ...)
{
        va_list ap;

        va_start(ap, fmt);
        vprintf(fmt, ap);
        va_end(ap);

        halt();
}

void __attribute__((noreturn)) halt(void)
{
        asm ("1: hlt; jmp 1b;"::);
        while (1) {
        }
}

void drivers_init(void)
{
        video_init();
        serial_init();
        fdc_init();
        keyboard_init();
}

/* End of a file */