//#include <arch/keyboard.h>
#include <arch/vga.h>

typedef struct{
	void	(*write)(u16int);
	u8int	(*read)();
	void	(*set_scancode)(u8int);
	void	(*clean_bf)();
	void	(*up)();
	void	(*down)();
	void	(*time)(u8int);
	
}KBD;

KBD kbd;


static int resend()
{
	if(in(0x60) == 0xFA)
		return 0;
	else
		return 1;
}

static void clean60()
{
	u8int x = in(0x61);
	out(x|0x80, 0x61);
	out(x&0x7f, 0x61);
	
	return;
}

static void up()
{
	do{
		out(0x64,0xAE);
	}while(resend());
	
	return;
}

static void down()
{
	do{
		out(0x64,0xAD);
	}while(resend());
	
	return;
}

static u8int read60()
{
	u8int x = in(0x60);
	while(!(in(0x64)&1));
	clean60();
	return x;
}

static void set_scancode(u8int val)
{
	
		out(0x60,0xF0);
		while(!(in(0x64)&1));
		out(0x60,val);
		while(!(in(0x64)&1));
	//while(resend());
	
	return;
}



static void time(u8int val)
{
	
		out(0x60,0xF3);
		while(!(in(0x64)&1));
		out(0x60,val);
		while(!(in(0x64)&1));
	//while(resend());
	
	return;
}

static void clean_bf()
{
	out(0x60,0xF4);
	while(!(in(0x64)&1));
	
	return;
}

extern void initkey()
{
	kbd.read=read60;
	kbd.set_scancode=set_scancode;
	kbd.up=up;
	kbd.down=down;
	kbd.time=time;
	kbd.clean_bf=clean_bf;
	
	kbd.time(20);
	kbd.set_scancode(2);
	kbd.clean_bf();
	clean60();
	
	return;
}

extern void keyhandler()
{
	kbd.read();
	VGA.drv.write("tastiera premuta\n");
	kbd.clean_bf();
	
	return;
}

