- better - more sphisticated
Committed on the Free edition of March Hare Software CVSNT Server. Upgrade to CVS Suite for more features and support: http://march-hare.com/cvsnt/ git-svn-id: http://moon:8086/svn/vhdl/trunk@628 cc03376c-175c-47c8-b038-4cd826a8556b
This commit is contained in:
@@ -11,6 +11,19 @@ char buffer[16384];
|
||||
char * volatile pPtr_r;
|
||||
char * volatile pPtr_w;
|
||||
|
||||
// -------------------------------------------------------------
|
||||
typedef struct _sps2_if_t
|
||||
{
|
||||
volatile UINT32 *pCTRL;
|
||||
volatile UINT32 *pDATA;
|
||||
} ps2_if_t;
|
||||
|
||||
static ps2_if_t ps2_if[2] =
|
||||
{
|
||||
{(UINT32*)sys_ps2_0_stat, (UINT32*)sys_ps2_0_data},
|
||||
{(UINT32*)sys_ps2_1_stat, (UINT32*)sys_ps2_1_data}
|
||||
};
|
||||
|
||||
void handler0(void)
|
||||
{
|
||||
printf("Interrupt 0\n");
|
||||
@@ -63,9 +76,71 @@ void handler5(void)
|
||||
printf("Interrupt 5\n");
|
||||
}
|
||||
|
||||
static INT32 mouse_x, mouse_y;
|
||||
|
||||
void handler6(void)
|
||||
{
|
||||
printf("Interrupt 6\n");
|
||||
int p, i;
|
||||
ps2_if_t *pIF;
|
||||
UINT8 mouse_rsp[3];
|
||||
UINT32 timeout_count, key;
|
||||
|
||||
INT32 dx, dy;
|
||||
|
||||
for (p=0; p < sizeof(ps2_if)/sizeof(ps2_if_t); p++)
|
||||
{
|
||||
pIF = &ps2_if[p];
|
||||
if (p==0)
|
||||
{
|
||||
while(sys_ps2_bit_rx_irq & *pIF->pCTRL)
|
||||
{
|
||||
key = *pIF->pDATA;
|
||||
printf("Keyboard scan code = 0x%02X\n", key);
|
||||
}
|
||||
}
|
||||
if (p==1)
|
||||
{
|
||||
if(!(sys_ps2_bit_rx_irq & *pIF->pCTRL))
|
||||
continue;
|
||||
|
||||
for (i=0; i < 3; i++)
|
||||
{
|
||||
timeout_count = 100;
|
||||
while(!(sys_ps2_bit_rx_irq & *pIF->pCTRL))
|
||||
{
|
||||
timeout_count--;
|
||||
if (!timeout_count)
|
||||
{
|
||||
break;
|
||||
}
|
||||
sleep(1);
|
||||
}
|
||||
if (!timeout_count)
|
||||
{
|
||||
break;
|
||||
}
|
||||
mouse_rsp[i] = (UINT8)*pIF->pDATA;
|
||||
}
|
||||
if (!timeout_count)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
dx = mouse_rsp[1];
|
||||
if (mouse_rsp[0] & 0x10)
|
||||
dx |= 0xFFFFFF00;
|
||||
dy = mouse_rsp[2];
|
||||
if (mouse_rsp[0] & 0x20)
|
||||
dy |= 0xFFFFFF00;
|
||||
|
||||
// printf("dx = %5d, dy = %5d\n", dx, dy);
|
||||
|
||||
mouse_x += dx;
|
||||
mouse_y += dy;
|
||||
|
||||
printf("x = %5d, y = %5d\n", mouse_x, mouse_y);
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void handler7(void)
|
||||
@@ -73,6 +148,125 @@ void handler7(void)
|
||||
printf("Interrupt 7\n");
|
||||
}
|
||||
|
||||
void PS2_byte_write(UINT32 port, UINT8 byte)
|
||||
{
|
||||
ps2_if_t *pIF;
|
||||
|
||||
pIF = &ps2_if[port];
|
||||
|
||||
while(!(*pIF->pCTRL & sys_ps2_bit_tx_empty));
|
||||
|
||||
*pIF->pDATA = (UINT32)byte;
|
||||
}
|
||||
|
||||
UINT32 PS2_byte_read(UINT32 port, UINT32 timeout_ms)
|
||||
{
|
||||
ps2_if_t *pIF;
|
||||
|
||||
pIF = &ps2_if[port];
|
||||
|
||||
while(!(*pIF->pCTRL & sys_ps2_bit_rx_avail))
|
||||
{
|
||||
timeout_ms--;
|
||||
if (!timeout_ms)
|
||||
return ERROR;
|
||||
|
||||
sleep(1);
|
||||
}
|
||||
return (UINT32)*pIF->pDATA;
|
||||
}
|
||||
|
||||
UINT32 PS2_cmd(UINT32 port, UINT8 cmd, UINT32 ack_timeout_ms)
|
||||
{
|
||||
UINT32 result;
|
||||
|
||||
PS2_byte_write(port, cmd);
|
||||
result = PS2_byte_read(port, ack_timeout_ms);
|
||||
if (0xFA != result)
|
||||
{
|
||||
printf ("PS2_cmd(%d): no ACK received. Result = %08X\n", port, result);
|
||||
return ERROR;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
void PS2_flush(UINT32 port)
|
||||
{
|
||||
while (ERROR != PS2_byte_read(port, 10));
|
||||
}
|
||||
|
||||
void PS2_init(UINT32 port)
|
||||
{
|
||||
ps2_if_t *pIF;
|
||||
|
||||
pIF = &ps2_if[port];
|
||||
|
||||
UINT32 result;
|
||||
|
||||
// Disable RX-interrupt
|
||||
*pIF->pCTRL &= ~sys_ps2_bit_rx_inten;
|
||||
|
||||
printf ("PS2_init(%d) - Initialize... ", port);
|
||||
|
||||
// Flush buffer
|
||||
PS2_flush(port);
|
||||
|
||||
// send RESET
|
||||
result = PS2_cmd(port, 0xFF, 1000);
|
||||
if (IS_ERROR(result))
|
||||
{
|
||||
printf ("Reset error %08X\n", result);
|
||||
return;
|
||||
}
|
||||
|
||||
// Read BAT
|
||||
result = PS2_byte_read(port, 1000);
|
||||
if (0xAA != result)
|
||||
{
|
||||
printf ("BAT error %08X\n", result);
|
||||
return;
|
||||
}
|
||||
|
||||
printf ("Success\n");
|
||||
|
||||
// Read ID
|
||||
result = PS2_byte_read(port, 10);
|
||||
if (IS_ERROR(result))
|
||||
{
|
||||
// No ID => keyboard
|
||||
printf ("PS2_init(%d) - Keyboard detected\n", port);
|
||||
}
|
||||
|
||||
if (result == 0)
|
||||
{
|
||||
printf ("PS2_init(%d) - Mouse device detected\n", port);
|
||||
printf ("PS2_init(%d) - Enable stream mode...", port);
|
||||
result = PS2_cmd(port, 0xF4, 1000);
|
||||
if (IS_ERROR(result))
|
||||
{
|
||||
printf ("error %08X\n", result);
|
||||
return;
|
||||
}
|
||||
printf ("Success\n");
|
||||
}
|
||||
|
||||
// send Get Device-ID
|
||||
result = PS2_cmd(port, 0xF2, 1000);
|
||||
if (IS_ERROR(result))
|
||||
{
|
||||
printf ("Get Device-ID error %08X\n", result);
|
||||
return;
|
||||
}
|
||||
printf ("PS2_init(%d) - Device-ID: %08X\n", port, result);
|
||||
|
||||
// Flush buffer
|
||||
while (ERROR != PS2_byte_read(port, 10));
|
||||
|
||||
// Enable RX-interrupt
|
||||
*pIF->pCTRL |= sys_ps2_bit_rx_inten;
|
||||
|
||||
}
|
||||
|
||||
int main(void)
|
||||
{
|
||||
|
||||
@@ -81,18 +275,20 @@ int main(void)
|
||||
volatile UINT32 *pUART0_baud = (UINT32*)sys_uart0_baud;
|
||||
volatile UINT32 *pUART1_baud = (UINT32*)sys_uart1_baud;
|
||||
|
||||
char string[65];
|
||||
|
||||
UART1_setbaud(460800);
|
||||
printf("Hello\n");
|
||||
memset(buffer, 0, sizeof(buffer));
|
||||
pPtr_r = buffer;
|
||||
pPtr_w = buffer;
|
||||
interrupt_register(0, handler0);
|
||||
interrupt_register(0, (void*)handler0);
|
||||
interrupt_enable(0);
|
||||
|
||||
interrupt_register(1, handler1);
|
||||
interrupt_register(1, (void*)handler1);
|
||||
interrupt_enable(1);
|
||||
|
||||
interrupt_register(2, handler2);
|
||||
interrupt_register(2, (void*)handler2);
|
||||
interrupt_enable(2);
|
||||
|
||||
printf("UART0 Status = 0x%8.8X\n", *pUART0_stat);
|
||||
@@ -100,25 +296,28 @@ int main(void)
|
||||
printf("UART1 Status = 0x%8.8X\n", *pUART1_stat);
|
||||
printf("UART1 Baud = 0x%8.8X\n", *pUART1_baud);
|
||||
|
||||
// enable RX interrupt
|
||||
// UART: enable RX interrupt
|
||||
*pUART0_stat |= (1 << 6);
|
||||
*pUART1_stat |= (1 << 6);
|
||||
printf("UART0 Status = 0x%8.8X\n", *pUART0_stat);
|
||||
printf("UART1 Status = 0x%8.8X\n", *pUART1_stat);
|
||||
|
||||
interrupt_register(3, handler3);
|
||||
PS2_init(0);
|
||||
PS2_init(1);
|
||||
|
||||
interrupt_register(3, (void*)handler3);
|
||||
interrupt_enable(3);
|
||||
|
||||
interrupt_register(4, handler4);
|
||||
interrupt_register(4, (void*)handler4);
|
||||
// interrupt_enable(4);
|
||||
|
||||
interrupt_register(5, handler5);
|
||||
interrupt_register(5, (void*)handler5);
|
||||
interrupt_enable(5);
|
||||
|
||||
interrupt_register(6, handler6);
|
||||
interrupt_register(6, (void*)handler6);
|
||||
interrupt_enable(6);
|
||||
|
||||
interrupt_register(7, handler7);
|
||||
interrupt_register(7, (void*)handler7);
|
||||
interrupt_enable(7);
|
||||
|
||||
printf("Start:\n");
|
||||
@@ -139,6 +338,18 @@ int main(void)
|
||||
sputs("Status : ");
|
||||
print_word(CP0_SR_read());
|
||||
sputs("\n");
|
||||
sputs("\n");
|
||||
|
||||
interrupt_disable(6);
|
||||
printf("Bitte gebe ein: ");
|
||||
scanf("%s", string);
|
||||
printf("Du schriebst: %s\n", string);
|
||||
|
||||
// Flush buffer
|
||||
PS2_flush(0);
|
||||
PS2_flush(1);
|
||||
|
||||
interrupt_enable(6);
|
||||
|
||||
while(1)
|
||||
{
|
||||
@@ -147,7 +358,7 @@ int main(void)
|
||||
// sputs("r: "); print_word((int)pPtr_r); sputs("\n");
|
||||
if (pPtr_r == &buffer[16383])
|
||||
pPtr_r = buffer;
|
||||
writechar(*(pPtr_r++));
|
||||
writechar(0, *(pPtr_r++));
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
|
||||
Reference in New Issue
Block a user