OSDev.org

Code: Select all

#define ENABLE_PS2		0xa8
#define KBD_STAT		0x64
#define MOUSE			0xd4
#define MOUSE_STREAM	0xf4
#define MOUSE_DISABLE	0xf5
#define KBD_CMD			0x60

void chkprt()
{
	unsigned char temp;
	while(1)
	{
		temp=inportb(KBD_STAT);
		if((temp&2)==0)	{
			break;
		}
	}
}

void ps2set()
{
	outportb(KBD_STAT,ENABLE_PS2);
	chkprt();
}

void wmous()
{
	outportb(KBD_STAT,MOUSE);
	chkprt();
}

void mbufful()
{
	unsigned char temp;
	while(1)
	{
		temp=inportb(KBD_STAT);
		if((temp&0x20)==0)
			break;
	}
}

char chkmous()
{
	unsigned char temp;
	temp=inportb(KBD_STAT);
	if(temp&1)	{
		return 0;
	}
	else	{
		return 1;
	}
}

void actmous()
{
	wmous();
	outportb(KBD_CMD,MOUSE_STREAM);
	chkprt();
	chkmous();
}

#define DISABLE_KBD		0xad
#define ENABLE_KBD		0xae

void dkeyb()
{
	outportb(KBD_STAT,DISABLE_KBD);
	chkprt();
}

void ekeyb()
{
	outportb(KBD_STAT,ENABLE_KBD);
	chkprt();
}

unsigned char getb()
{
	unsigned char bl=1;
	while(bl)	{
		bl=chkmous();
	}
	dkeyb();
	bl=inportb(0x60);
	ekeyb();
	return bl;
}

struct mouse_data	{
	unsigned char status;
	unsigned char xcoord;
	unsigned char ycoord;
};

typedef struct mouse_data md;

void get_mouse_data(md *data)
{
	data->status=getb();
	data->xcoord=getb();
	data->ycoord=getb();
}

void init_mouse()
{
	printf("\nSetting up PS2 mouse");
	ps2set();
	actmous();
}

Code: Select all

#define K_RDWR 0x60
#define KBD_TIMEOUT 100000

void write_kbd(unsigned adr, unsigned data)
{
	unsigned long timeout;
	unsigned stat;
	for(timeout = KBD_TIMEOUT; timeout != 0; timeout--)
	{
		stat = inportb(K_STATUS);
		if((stat & K_IBUF_FUL) == 0)
			break;
	}
	if(timeout != 0)
		outportb(adr, data); 
}

void init_kbd()
{
	printf("\nSetting up keyboard ");
	empty_8042();
	write_kbd(K_RDWR,0xff);
	set_kbd_leds(NUMLOCK);
	bal=0;
	kbd_set_typematic(0,0);
	delay_ms(200);
}

void set_kbd_leds(unsigned char status)
{
	write_kbd(K_RDWR,K_CMD_LEDS);
	write_kbd(K_RDWR,status);
}

void empty_8042()
{
	unsigned char temp;
	do
	{
		temp = inportb(K_CMD);
		if((temp & K_OBUF_FUL) != 0)
		{
			(void)inportb(K_RDWR);
			continue;
		}
	} 
	while((temp & K_IBUF_FUL) != 0);
}

void kbd_set_typematic(unsigned char delay,unsigned char rate)
{
	unsigned char res=0;
	res|=0x80;
	res|=(delay*32);
	res|=rate;
	write_kbd(K_RDWR,res);
}

#define SCRLLOCK	0x1
#define NUMLOCK		0x2
#define CAPSLOCK	0x4

Code: Select all

void set_leds(void)
{
	kb_wait_input() ;
	outportb(KB_DATAREG_IO,0xED) ;
	kb_ack() ;
	
	kb_wait_input() ;
	outportb(KB_DATAREG_IO,key_flags) ;
	kb_ack()  ;
} 

inline int kb_wait_input( void )
{
	dword_t time_out = KB_TIMEOUT ; 
	volatile int i ;
    while( time_out-- )
    {
    	for(i=0;i<1000;i++) ;
    	if((inportb( KB_STATUS_IO ) & 2)==0)
        	return 0 ;
    }
    printf("time out error in kb_wait_input\n") ;
    return time_out ;
}

Code: Select all

void MouseWait( char thetype )
{
	long timeout = 100000;
	if( thetype == 0 )
	{
		while( timeout-- )
		{
			if( inportb( 0x64 ) & 1 )
			{
				return;
			}
		}
		return;
	}
	if( thetype == 1 )
	{
		while( timeout-- )
		{
			if( ( inportb( 0x64 ) & 2 ) == 0 )
			{
				return;
			}
		}
		return;
	}
}

// get a byte from the port
unsigned char GetByte()
{
	unsigned char ret;

	DisableKeyboard();
	MouseWait( 0 );
	ret = inportb( 0x60 );
	EnableKeyboard(); // yours are ekbd or something...

	return ret;
}