bond/hal/print.c

/* Copyright 2016 secXsQuared
 * Distributed under GPL license
 * See COPYING under root for details
 */

#include "type.h"
#include "lib/sxtdlib.h"
#include "hal/print.h"
#include "hal/cpu.h"

#define get_column(pos) ((pos) % 80)
#define get_row(pos) ((pos) / 80)
#define get_pos(row,col) ((row) * 80 + (col))

static uint64_t text_pos;

void KABI hal_print_init(void)
{
    text_pos = 0;
}

static void KABI halp_print_scroll(void)
{
    lb_mem_move((void *) (0xb8000 + get_pos(1, 0) * 2), (void *) (0xb8000 + get_pos(0, 0) * 2), (80 * 24) * 2);
    return;
}

static void KABI halp_print_str(char const *str)
{
    if(str == NULL)
        return;
    while (*str != 0)
    {
        if(*str == '\n')
        {
            text_pos = 80 * (get_row(text_pos) + 1);
            if(text_pos > 80 * 25 - 1)
            {
                //can't hold
                halp_print_scroll();
                lb_mem_set((void *) (0xb8000 + 80 * 24 * 2), 0, 80 * 2); // clear last row
                text_pos = 80 * 24;
            }
            str++;
        }
        else
        {
            if (text_pos > 80 * 25 - 1)
            {
                //can't hold
                halp_print_scroll();
                text_pos = 80 * 24;
            }
            *((char*)(0xb8000) + text_pos*2) = *str;
            *((char*)(0xb8000) + text_pos*2 + 1) = 7;
            str++;
            text_pos++;
        }
    }
    return;
}

static void KABI halp_print_uint(uint64_t number)
{
    char arr[21]; // do not need to initialize
    arr[20] = 0; //zero-terminated
    uint32_t index = 19;
    uint32_t const div = 10;
    while (1)
    {
        uint64_t quo = number / div;
        uint64_t rmd = number % div;
        number = quo;
        arr[index--] = (char) ('0' + rmd);
        if (number == 0)
            break;
    }
    halp_print_str(&(arr[index + 1]));
    return;
}

static void KABI halp_print_int(int64_t number)
{
    char arr[21]; // do not need to initialize
    arr[20] = 0; //zero-terminated
    uint32_t index = 19;
    uint32_t isNegative = 0;
    uint32_t const div = 10;
    if (number < 0)
    {
        isNegative = 1;
        number *= -1;
    }
    while (1)
    {
        int64_t quo = number / div;
        int64_t rmd = number % div;
        number = quo;
        arr[index--] = (char) ('0' + rmd);
        if (number == 0)
            break;
    }
    if (isNegative)
    {
        arr[index--] = '-';
    }
    halp_print_str(&(arr[index + 1]));
    return;
}

static void KABI halp_print_hex(uint64_t number, uint64_t capital)
{
    char const lookup_table_cap[16] = {'0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'A', 'B', 'C', 'D', 'E', 'F'};
    char const lookup_table[16] = {'0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'a', 'b', 'c', 'd', 'e', 'f'};
    char const * const look_up = capital == 1 ? &lookup_table_cap[0] : &lookup_table[0];
    char arr[17];
    arr[16] = 0; //zero-terminated
    uint32_t index = 15;
    uint32_t const div = 16;
    while (1)
    {
        uint64_t quo = number / div;
        uint64_t rmd = number % div;
        number = quo;
        arr[index--] = look_up[rmd];
        if (number == 0)
            break;
    }
    halp_print_str(&(arr[index + 1]));
    return;
}

void KABI hal_clear_screen(void)
{
    text_pos = 0; // reset text_pos
    lb_mem_set((void *) 0xb8000, 0, 25 * 80 * 2);
    return;
}

void KABI hal_vprintf(char const * format, va_list args)
{
    char buf[2] = {0, 0};
    int64_t d;
    uint64_t u;
    char* s;
    char c;
    for(;*format != '\0';format++)
    {
        if (*format != '%')
        {
            buf[0] = *format;
            halp_print_str(buf);
            continue;
        }
        format++;
        switch (*format)
        {
            case 'd':
                d = va_arg(args, int64_t);
                halp_print_int(d);
                break;
            case 'u':
                u = va_arg(args, uint64_t);
                halp_print_uint(u);
                break;
            case 's':
                s = va_arg(args, char *);
                halp_print_str(s);
                break;
            case 'c':
                c = (char)va_arg(args, int64_t);
                buf[0] = c;
                halp_print_str(buf);
                break;
            case 'x':
                u = va_arg(args, uint64_t);
                halp_print_hex(u, 0);
                break;
            case 'X':
                u = va_arg(args, uint64_t);
                halp_print_hex(u, 1);
                break;
            case '%':
                buf[0] = '%';
                halp_print_str(buf);
                break;
            default:
                buf[0] = '%';
                halp_print_str(buf);
                format--;
                break;
        }
    }
}

void KABI hal_printf(char const *format, ...)
{
    va_list args;
    va_start(args, format);
    hal_vprintf(format, args);
    va_end(args);
}

void KABI hal_assert(uint32_t expression, char *message)
{
    if (!expression)
    {
        hal_printf("HAL: Assertion failed. Detail: %s", message == NULL ? "NULL" : message);
        hal_halt_cpu();
    }
    return;
}