#include "bindings.h"

#include <stdint.h>
#include <stddef.h>

#define INDEX           0x1CE
#define DATA            0x1CF
#define FB_ADDR         0xE0000000

#define PREFERRED_VY    4096
#define PREFERRED_B     32

uint16_t fb_res_x = 0;
uint16_t fb_res_y = 0;
uint16_t fb_res_b = 0;

uint8_t *fb_buffer = NULL;

int fb_init(uint16_t res_x, uint16_t res_y) {

	outw(INDEX, 0x00);
	uint16_t i = inw(DATA);
	if (i < 0xB0C0 || i > 0xB0C6) {
		return -1;	
	}
	outw(DATA, 0xB0C4);
	i = inw(DATA);
	/* Disable VBE */
	outw(INDEX, 0x04);
	outw(DATA, 0x00);
	/* Set X resolution to 1024 */
	outw(INDEX, 0x01);
	outw(DATA, res_x);
	/* Set Y resolution to 768 */
	outw(INDEX, 0x02);
	outw(DATA, res_y);
	/* Set bpp to 32 */
	outw(INDEX, 0x03);
	outw(DATA, PREFERRED_B);
	/* Set Virtual Height to stuff */
	outw(INDEX, 0x07);
	outw(DATA, PREFERRED_VY);
	/* Re-enable VBE */
	outw(INDEX, 0x04);
	outw(DATA, 0x41);

	uint32_t * text_vid_mem = (uint32_t *)0xA0000;
	text_vid_mem[0] = 0xA5ADFACE;

	for (uintptr_t fb_offset = FB_ADDR; fb_offset < 0xFF000000; fb_offset += 0x01000000) {
		/* Enable the higher memory */
		for (uintptr_t i = fb_offset; i < fb_offset; i += 0x1000) {
			// todo ident map fb
		}

		/* Go find it */
		for (uintptr_t x = fb_offset; x < fb_offset + 0xFF0000; x += 0x1000) {
			if (((uintptr_t *)x)[0] == 0xA5ADFACE) {
				fb_buffer = (uint8_t *) x;
				goto mem_found;
			}
		}
	}

mem_found:
	
	fb_res_x = res_x;
	fb_res_y = res_y;
	fb_res_b = PREFERRED_B;

	return 0;
}