wm: teppich

ref: 086331e6bf7b682b12ca392130160a1afb371f12
dir: /pc/ps2.c/

View raw version 
#include <u.h>
#include <x86.h>
#include <ps2.h>

uint8
ps2_read_status(void)
{
	return inb(KB_CTR);
}

void
ps2_init()
{
	int a = 256 - 3; // 2^8 - 1- 2
	outb(0x64, SET_RATE);
	outb(0x64, a);
}

char
ps2_getc()
{
	char c;
	while(1)
	{
		if(!(ps2_read_status() & 1))
			return 0;

		c = inb(KB);
		if(c & 0x80)
			return 0;
		return keymap[c];

	}
}