#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <stdarg.h>

#include "types.h"
#include "font_bin.h"

#define FRAMEBUFFER_ADDRESS (0x14000000+0x38C0000)
#define FRAMEBUFFER_STRIDE (0xE00)
#define FRAMEBUFFER_STRIDE_WORDS (FRAMEBUFFER_STRIDE >> 2)

#define CHAR_MULT       2
#define CHAR_SIZE_X     8
#define CHAR_SIZE_Y     8


u32* const framebuffer = (u32*)FRAMEBUFFER_ADDRESS;

void clearScreen(u32 color)
{
	int i;
	for(i = 0; i < 896 * 504; i++)
	{
		framebuffer[i] = color;
	}
}

void drawCharacter(char c, int x, int y)
{
    if(c < 32)return;
    c -= 32;
    u8* charData = (u8*)&font_bin[(int)c << 3];
    u32* fb = &framebuffer[x + y * FRAMEBUFFER_STRIDE_WORDS];
    int i, j, n, k;
    for(i = 0; i < CHAR_SIZE_Y; i++)
    {
        for(k = 0; k < CHAR_MULT; k++)
        {
            u8 v = *charData;

            for(j = 0; j < CHAR_SIZE_X; j++)
            {
                for(n = 0; n < CHAR_MULT; n++)
                {
                    if(v & 1)
                    {
                        *fb = 0x00000000;
                    }
                    else
                    {
                        *fb = 0xFFFFFFFF;
                    }
                    fb++;
                }
                v >>= 1;
            }
            fb += FRAMEBUFFER_STRIDE_WORDS - CHAR_SIZE_X * CHAR_MULT;
        }
        charData++;
    }
}

void drawString(char* str, int x, int y)
{
    if(!str) return;
    int k;
    int dx = 0, dy = 0;
    for(k = 0; str[k]; k++)
    {
        if(str[k] >= 32 && str[k] < 128)
            drawCharacter(str[k], x + dx, y + dy);

        dx += CHAR_SIZE_X * CHAR_MULT;

        if(str[k] == '\n')
        {
            dx = 0;
            dy -= CHAR_SIZE_Y * CHAR_MULT;
        }
    }
}

void _printf(int x, int y, const char *format, ...)
{
    void (*kernel_vsnprintf)(char * s, size_t n, const char * format, va_list arg) = (void*)0x0813293C;

    va_list args;
    va_start(args, format);
    static char buffer[0x100];

    kernel_vsnprintf(buffer, 0xFF, format, args);
    drawString(buffer, x, y);

    va_end(args);
}