OSDev.org

Code: Select all

#include "sys/mattise.h"
#include "sys/kernel.h"
#include "sys/ps2.h"
#include "sys/kstdio.h"

// commands for PS2
#define ENABLE_PS2	0xA8
#define KBD_STAT	0x64
#define MOUSE		0xD4
#define MOUSE_STREAM	0xF4
#define MOUSE_DISABLE	0xF5
#define KBD_CMD		0x60
#define DISABLE_KBD	0xAD
#define ENABLE_KBD	0xAE

// checks the port
void CheckPort()
{
	unsigned char temp;
	while( true )
	{
		temp = inportb( KBD_STAT );
		if( (  temp & 2 ) == 0 )
			break;
	}
}

// set the ps2 bytes
void PS2Set()
{
	outportb( KBD_STAT, ENABLE_PS2 );
	CheckPort();
}

// waits for the mouse
void WaitMouse()
{
	outportb( KBD_STAT, MOUSE );
	CheckPort();
}

// waits for the ouse buffer to be full
void MouseBufferFull()
{
	unsigned char temp;
	while( true )
	{
		temp = inportb( KBD_STAT );
		if( (  temp & 0x20 ) == 0 )
			break;
	}
}

// checks the mouse
char CheckMouse()
{
	unsigned char temp;
	temp = inportb( KBD_STAT );

	if( temp & 1 )
		return 0;
	else
		return 1;
}

// sets the streaming mode
void StartStream()
{
	WaitMouse();
	outportb( KBD_CMD, MOUSE_STREAM );
	CheckPort();
	CheckMouse();
}

// disables the keyboard
void DisableKeyboard()
{
	outportb( KBD_STAT, DISABLE_KBD );
	CheckPort();
}

// enables the keyboard
void EnableKeyboard()
{
	outportb( KBD_STAT, ENABLE_KBD );
	CheckPort();
}

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
char GetByte()
{
	DisableKeyboard();

	char ret = 1;

	while( ret )
		ret = CheckMouse();

	MouseWait( 0 );
	ret = inportb( 0x60 );
	EnableKeyboard();

	return ret;
}

// get data from the mouse
void GetMouseData( MOUSEDATA* data )
{
	// wait for the buffer to be full
	// MouseBufferFull();

	// get the data
	data->status = GetByte();
	data->xcoord = GetByte();
	data->ycoord = GetByte();
}

// init the mouse
void InitMouse()
{
	kputs( "Initializing PS2 mouse..." );
	PS2Set();
	StartStream();
}

Code: Select all

#include "mattise.h"

#ifndef PS2_H
#define PS2_H

/** PS2 **/

typedef struct tagMOUSEDATA
{ 
	char status; 
	char xcoord; 
	char ycoord; 
} MOUSEDATA;

// init the mouse
void InitMouse();

// get data from the mouse
void GetMouseData( MOUSEDATA* data );

/** END PS2 **/

#endif

Code: Select all

// get a byte from the port 
char GetByte() 
{ 
   DisableKeyboard();   //This is BAD (slow)

   char ret = 1;

   while( ret )                        //BAD (obsolete)
      ret = CheckMouse();       //BAD (obsolete)

   MouseWait( 0 );               //BAD (slow)
   ret = inportb( 0x60 );       //The only RELIABLE thing around here
   EnableKeyboard();          //This is BAD (slow)

   return ret;         //Here we return 1 byte
} 

Code: Select all

char off=0;

void GetMouseData( MOUSEDATA* data ) 
{ 
   // get the data 
   (off==0)?(data->status = GetByte();off++;return;):(0);
   (off==1)?(data->xcoord = GetByte();off++;return;):(0); 
   (off==2)?(data->ycoord = GetByte();off++;return;):(0);

   if(off==3)
   {
    //Reset buffer:
      off=0;

    //Do some processing:
    ///////////
    ///////////
    ///////////
    ///////////
   }

 //Acknowledge IRQ by PIC:
 //
} 

Code: Select all

#include "sys/mattise.h"
#include "sys/kernel.h"
#include "sys/ps2.h"
#include "sys/kstdio.h"

// commands for PS2
#define ENABLE_PS2	0xA8
#define KBD_STAT	0x64
#define MOUSE		0xD4
#define MOUSE_STREAM	0xF4
#define MOUSE_DISABLE	0xF5
#define KBD_CMD		0x60
#define DISABLE_KBD	0xAD
#define ENABLE_KBD	0xAE

// checks the port
void CheckPort()
{
	unsigned char temp;
	while( true )
	{
		temp = inportb( KBD_STAT );
		if( (  temp & 2 ) == 0 )
			break;
	}
}

// waits for the ouse buffer to be full
void MouseBufferFull()
{
	unsigned char temp;
	while( true )
	{
		temp = inportb( KBD_STAT );
		if( (  temp & 0x20 ) == 0 )
			break;
	}
}

// checks the mouse
char CheckMouse()
{
	unsigned char temp;
	temp = inportb( KBD_STAT );

	if( temp & 1 )
		return 0;
	else
		return 1;
}

// writes to the keyboard
void WriteKeyboard( unsigned char val )
{
	unsigned int n;

	n = 0xFFFF;
	while( n-- )
	{
		if( inportb( 0x64 ) & 2 == 0 )
		{
			n = 1;
			break;
		}
	}

	if( !n ) return;

	outportb( 0x60, val );

	n = 0xFFFF;
	while( n-- )
	{
		if( inportb( 0x64 ) & 2 == 0 )
		{
			n = 1;
			break;
		}
	}
}

unsigned char ReadKeyboard()
{
	unsigned char res;
	unsigned int n;

	n = 0xFFFF;
	while( n-- )
	{
		if( inportb( 0x64 ) & 1 )
		{
			n = 1;
			break;
		}
	}

	if( !n ) return;

	res = inportb( 0x60 );

	return res;
}

// sends a command to the keyboard
void KeyboardCmd( unsigned char cmd )
{
	outportb( 0x64, cmd );
}

// set the ps2 bytes
void PS2Set()
{
	outportb( KBD_STAT, ENABLE_PS2 );
	CheckPort();

	// enable the mouse irq
	unsigned char c;
	KeyboardCmd( 0x20 );
	c = ReadKeyboard() | 2;
	KeyboardCmd( 0x60 );
	WriteKeyboard( c );
}

// waits for the mouse
void WaitMouse()
{
	outportb( KBD_STAT, MOUSE );
	CheckPort();
}

// sets the streaming mode
void StartStream()
{
	WaitMouse();
	outportb( KBD_CMD, MOUSE_STREAM );
	CheckPort();
	CheckMouse();
}

// disables the keyboard
void DisableKeyboard()
{
	outportb( KBD_STAT, DISABLE_KBD );
	CheckPort();
}

// enables the keyboard
void EnableKeyboard()
{
	outportb( KBD_STAT, ENABLE_KBD );
	CheckPort();
}

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
char GetByte()
{
//	DisableKeyboard();

	char ret = 1;

/*	while( ret )
		ret = CheckMouse();

	MouseWait( 0 );*/
	ret = inportb( 0x60 );
/*	EnableKeyboard();*/

	return ret;
}

// info
int getstat = 0;
int readable = 0;
MOUSEDATA LocalData;

// data pointer

// irq handler for the mouse
void MouseIRQ( struct regs* r )
{
	kputs( "MouseIRQ " );

	// check the counter
	if( getstat == 0 )
	{
		LocalData.status = GetByte();
		getstat = 1;
		return;
	}
	if( getstat == 1 )
	{
		LocalData.xcoord = GetByte();
		getstat = 2;
		return;
	}
	if( getstat == 2 )
	{
		LocalData.ycoord = GetByte();
		getstat = 3;
	}

	if( getstat == 3 )
	{
		readable = 1;
	}
}

// get data from the mouse
void GetMouseData( MOUSEDATA* data )
{
	kputs( "reading..." );

	// is there data?
	while( !readable )
	{
		pause();
	}

	// readable is false now
	readable = 0;

	// return the data
	*data = LocalData;

	// set sc to 0, so we can get more data
	getstat = 0;
}

// init the mouse
void InitMouse()
{
	kputs( "Initializing PS2 mouse... " );
	PS2Set();
	StartStream();

	kputs( "Installing irq handler..." );

	// install the irq handler
	irq_install_handler( 12, MouseIRQ );
}

Code: Select all

//For mouse:
  outportb(0xA0,0x20);
  outportb(0x20,0x20);



//For keyboard:
  outportb(0x20,0x20);

Code: Select all

outportb( 0x64, 0x20 );
// wait for that to be sent
unsgined char c = inportb( 0x60 ) | 2;
outportb( 0x64, 0x60 );
// wait for that to be sent
outportb( 0x60, c );

Code: Select all

asm{
             mov al,0xD1 ;WRITE OUTPUT PORT.
             out 0x64,al

            call KeybController_waitUntilReady

             mov al,11111111b
               ; 0-Normal
               ; 1-Enable A20
               ; 2-Data to Mouse
               ; 3-Mouse Clock
               ; 4-IRQ1 Active
               ; 5-IRQ12 Active
               ; 6-Keyboard Clock
               ; 7-Data to Keyboard
               out 0x60,al
}

asm{
  KeybController_waitUntilReady:
   in al,0x64
   test al,00000010b
   jnz KeybController_waitUntilReady
  ret
}