PS2Keyboard.c

#include <Driver/IO/PortIO.h>

// PS2 Out Port의 Buffer가 차있는지
BOOL PS2CheckOutputBufferNotEmpty()
{	
	if(PortIO_InByte(0x64) & 0x01)
		return TRUE;
	return FALSE;
}
// PS2 In Port의 Buffer가 차있는지
BOOL PS2CheckInputBufferNotEmpty()
{
	if(PortIO_InByte(0x64) & 0x02)	
		return TRUE;
	return FALSE;
}

// PS2 Port의 응답을 확인 & 키 코드를 푸시
BOOL WaitACKWithScanCodePushQueue()
{
	BOOL result = FALSE;
	for(int i = 0; i< 100; i++)
	{	
		//0xFFFF 만큼 반복할 시간안에 응답이 충분히 옴
		for(int j = 0 ; j < 0xFFFF; j++)
		{
			if(PS2CheckOutputBufferNotEmpty())
				break;
		}		
		//데이터가 ACK이면, 이전 요청에 대한 응답
		BYTE data = PortIO_InByte(0x60);
		if(data == 0xFA)
		{
			result = TRUE;
			break;
		}
		else
		{
			ConvertScanCodeWithPushKeyQueue(data);
		}
	}
	return result; 	
}


BOOL PS2ActivationKeyboard()
{
	//키보드 활성화 PORT IO 기능 사용
	BOOL interrupt_status = SetInterruptFlag(FALSE);
	PortIO_OutByte( 0x64, 0xAE );
	for(int i=0; i< 0xFFFF; i++)
	{
		if(PS2CheckInputBufferNotEmpty() == FALSE)
		{
			break;
		}
	}
	PortIO_OutByte(0x60, 0xF4);
	BOOL result = WaitACKWithScanCodePushQueue();
	SetInterruptFlag(interrupt_status);
	return result;
}
//PortIO를 통한 A20게이트 활성화
void PS2EnableA20Gate()
{
	PortIO_OutByte(0x64, 0xD0);

	for(int i = 0; i < 0xFFFF; i++)
	{
		if(PS2CheckOutputBufferNotEmpty() == TRUE)
			break;
	}
	
	BYTE OutPutData = PortIO_InByte(0x60);

	OutPutData		|= 0x01;


	for(int i=0; i < 0xFFFF; i++)
	{
		if(PS2CheckInputBufferNotEmpty() == FALSE)
				break;
	}
	
	PortIO_OutByte(0x64, 0xD1);

	PortIO_OutByte(0x60, OutPutData);
}

//Keyboard의 LED를 On Off
BOOL PS2SetKeyboardLED(BOOL _CapsLockOn, BOOL _NumLockOn, BOOL _ScrollLockOn)
{

	BOOL intrrupt_status = SetInterruptFlag(FALSE);
	
	//Busy Waiting 0xFFFF Iteration.
	for(int i = 0; i< 0xFFFF; i++)
	{
		if(PS2CheckInputBufferNotEmpty() == FALSE)
			break;
	}
	
	
	//LED 상태 변경 커멘드 전송
	PortIO_OutByte(0x60, 0xED);

	for(int i = 0; i < 0xFFFF; i++)
	{
		if(PS2CheckInputBufferNotEmpty() == FALSE)
			break;
	}
	
	BOOL result = WaitACKWithScanCodePushQueue();
	
	if(result == FALSE)
		return FALSE;

	// LED 변경 값 전송 후 대기
	PortIO_OutByte( 0x60, (_CapsLockOn << 2)|(_NumLockOn << 1)|(_ScrollLockOn));

	for(int i = 0; i< 0xFFFF; i++)
	{
		if(PS2CheckInputBufferNotEmpty() == FALSE)
			break;
	}

	result = WaitACKWithScanCodePushQueue();

	if(result == FALSE)
		return FALSE;
	
	return TRUE;
	
}

void PS2Reboot()
{
	for(int i = 0; i < 0xFFFF; i++)
	{
		if(PS2CheckInputBufferNotEmpty() == FALSE)
			break;
	}
	PortIO_OutByte(0x64, 0xD1);
	PortIO_OutByte(0x60, 0x00);
	
	while(1)
	{
 	 	 	 

	}
}





BYTE PS2GetKeyboardScanCode()
{
	while(PS2CheckOutputBufferNotEmpty() == FALSE);

	return PortIO_InByte(0x60);
}