/*********************************************************************** * * (C) Copyright 2004 * DENX Software Engineering * Wolfgang Denk, wd@denx.de * All rights reserved. * * PS/2 multiplexer driver * * Originally from linux source (drivers/char/ps2mult.c) * * Uses simple serial driver (ps2ser.c) to access the multiplexer * Used by PS/2 keyboard driver (pc_keyb.c) * ***********************************************************************/ #include <common.h> #include <pc_keyb.h> #include <asm/atomic.h> #include <ps2mult.h> /* #define DEBUG_MULT */ /* #define DEBUG_KEYB */ #define KBD_STAT_DEFAULT (KBD_STAT_SELFTEST | KBD_STAT_UNLOCKED) #define PRINTF(format, args...) printf("ps2mult.c: " format, ## args) #ifdef DEBUG_MULT #define PRINTF_MULT(format, args...) printf("PS2MULT: " format, ## args) #else #define PRINTF_MULT(format, args...) #endif #ifdef DEBUG_KEYB #define PRINTF_KEYB(format, args...) printf("KEYB: " format, ## args) #else #define PRINTF_KEYB(format, args...) #endif static ulong start_time; static int init_done = 0; static int received_escape = 0; static int received_bsync = 0; static int received_selector = 0; static int kbd_command_active = 0; static int mouse_command_active = 0; static int ctl_command_active = 0; static u_char command_byte = 0; static void (*keyb_handler)(void *dev_id); static u_char ps2mult_buf [PS2BUF_SIZE]; static atomic_t ps2mult_buf_cnt; static int ps2mult_buf_in_idx; static int ps2mult_buf_out_idx; static u_char ps2mult_buf_status [PS2BUF_SIZE]; #ifndef CONFIG_BOARD_EARLY_INIT_R #error #define CONFIG_BOARD_EARLY_INIT_R and call ps2mult_early_init() in board_early_init_r() #endif void ps2mult_early_init (void) { start_time = get_timer(0); } static void ps2mult_send_byte(u_char byte, u_char sel) { ps2ser_putc(sel); if (sel == PS2MULT_KB_SELECTOR) { PRINTF_MULT("0x%02x send KEYBOARD\n", byte); kbd_command_active = 1; } else { PRINTF_MULT("0x%02x send MOUSE\n", byte); mouse_command_active = 1; } switch (byte) { case PS2MULT_ESCAPE: case PS2MULT_BSYNC: case PS2MULT_KB_SELECTOR: case PS2MULT_MS_SELECTOR: case PS2MULT_SESSION_START: case PS2MULT_SESSION_END: ps2ser_putc(PS2MULT_ESCAPE); break; default: break; } ps2ser_putc(byte); } static void ps2mult_receive_byte(u_char byte, u_char sel) { u_char status = KBD_STAT_DEFAULT; #if 1 /* Ignore mouse in U-Boot */ if (sel == PS2MULT_MS_SELECTOR) return; #endif if (sel == PS2MULT_KB_SELECTOR) { if (kbd_command_active) { if (!received_bsync) { PRINTF_MULT("0x%02x lost KEYBOARD !!!\n", byte); return; } else { kbd_command_active = 0; received_bsync = 0; } } PRINTF_MULT("0x%02x receive KEYBOARD\n", byte); status |= KBD_STAT_IBF | KBD_STAT_OBF; } else { if (mouse_command_active) { if (!received_bsync) { PRINTF_MULT("0x%02x lost MOUSE !!!\n", byte); return; } else { mouse_command_active = 0; received_bsync = 0; } } PRINTF_MULT("0x%02x receive MOUSE\n", byte); status |= KBD_STAT_IBF | KBD_STAT_OBF | KBD_STAT_MOUSE_OBF; } if (atomic_read(&ps2mult_buf_cnt) < PS2BUF_SIZE) { ps2mult_buf_status[ps2mult_buf_in_idx] = status; ps2mult_buf[ps2mult_buf_in_idx++] = byte; ps2mult_buf_in_idx &= (PS2BUF_SIZE - 1); atomic_inc(&ps2mult_buf_cnt); } else { PRINTF("buffer overflow\n"); } if (received_bsync) { PRINTF("unexpected BSYNC\n"); received_bsync = 0; } } void ps2mult_callback (int in_cnt) { int i; u_char byte; static int keyb_handler_active = 0; if (!init_done) { return; } for (i = 0; i < in_cnt; i ++) { byte = ps2ser_getc(); if (received_escape) { ps2mult_receive_byte(byte, received_selector); received_escape = 0; } else switch (byte) { case PS2MULT_ESCAPE: PRINTF_MULT("ESCAPE receive\n"); received_escape = 1; break; case PS2MULT_BSYNC: PRINTF_MULT("BSYNC receive\n"); received_bsync = 1; break; case PS2MULT_KB_SELECTOR: case PS2MULT_MS_SELECTOR: PRINTF_MULT("%s receive\n", byte == PS2MULT_KB_SELECTOR ? "KB_SEL" : "MS_SEL"); received_selector = byte; break; case PS2MULT_SESSION_START: case PS2MULT_SESSION_END: PRINTF_MULT("%s receive\n", byte == PS2MULT_SESSION_START ? "SESSION_START" : "SESSION_END"); break; default: ps2mult_receive_byte(byte, received_selector); } } if (keyb_handler && !keyb_handler_active && atomic_read(&ps2mult_buf_cnt)) { keyb_handler_active = 1; keyb_handler(NULL); keyb_handler_active = 0; } } u_char ps2mult_read_status(void) { u_char byte; if (atomic_read(&ps2mult_buf_cnt) == 0) { ps2ser_check(); } if (atomic_read(&ps2mult_buf_cnt)) { byte = ps2mult_buf_status[ps2mult_buf_out_idx]; } else { byte = KBD_STAT_DEFAULT; } PRINTF_KEYB("read_status()=0x%02x\n", byte); return byte; } u_char ps2mult_read_input(void) { u_char byte = 0; if (atomic_read(&ps2mult_buf_cnt) == 0) { ps2ser_check(); } if (atomic_read(&ps2mult_buf_cnt)) { byte = ps2mult_buf[ps2mult_buf_out_idx++]; ps2mult_buf_out_idx &= (PS2BUF_SIZE - 1); atomic_dec(&ps2mult_buf_cnt); } PRINTF_KEYB("read_input()=0x%02x\n", byte); return byte; } void ps2mult_write_output(u_char val) { int i; PRINTF_KEYB("write_output(0x%02x)\n", val); for (i = 0; i < KBD_TIMEOUT; i++) { if (!kbd_command_active && !mouse_command_active) { break; } udelay(1000); ps2ser_check(); } if (kbd_command_active) { PRINTF("keyboard command not acknoledged\n"); kbd_command_active = 0; } if (mouse_command_active) { PRINTF("mouse command not acknoledged\n"); mouse_command_active = 0; } if (ctl_command_active) { switch (ctl_command_active) { case KBD_CCMD_WRITE_MODE: /* Scan code conversion not supported */ command_byte = val & ~KBD_MODE_KCC; break; case KBD_CCMD_WRITE_AUX_OBUF: ps2mult_receive_byte(val, PS2MULT_MS_SELECTOR); break; case KBD_CCMD_WRITE_MOUSE: ps2mult_send_byte(val, PS2MULT_MS_SELECTOR); break; default: PRINTF("invalid controller command\n"); break; } ctl_command_active = 0; return; } ps2mult_send_byte(val, PS2MULT_KB_SELECTOR); } void ps2mult_write_command(u_char val) { ctl_command_active = 0; PRINTF_KEYB("write_command(0x%02x)\n", val); switch (val) { case KBD_CCMD_READ_MODE: ps2mult_receive_byte(command_byte, PS2MULT_KB_SELECTOR); break; case KBD_CCMD_WRITE_MODE: ctl_command_active = val; break; case KBD_CCMD_MOUSE_DISABLE: break; case KBD_CCMD_MOUSE_ENABLE: break; case KBD_CCMD_SELF_TEST: ps2mult_receive_byte(0x55, PS2MULT_KB_SELECTOR); break; case KBD_CCMD_KBD_TEST: ps2mult_receive_byte(0x00, PS2MULT_KB_SELECTOR); break; case KBD_CCMD_KBD_DISABLE: break; case KBD_CCMD_KBD_ENABLE: break; case KBD_CCMD_WRITE_AUX_OBUF: ctl_command_active = val; break; case KBD_CCMD_WRITE_MOUSE: ctl_command_active = val; break; default: PRINTF("invalid controller command\n"); break; } } static int ps2mult_getc_w (void) { int res = -1; int i; for (i = 0; i < KBD_TIMEOUT; i++) { if (ps2ser_check()) { res = ps2ser_getc(); break; } udelay(1000); } switch (res) { case PS2MULT_KB_SELECTOR: case PS2MULT_MS_SELECTOR: received_selector = res; break; default: break; } return res; } int ps2mult_init (void) { int byte; int kbd_found = 0; int mouse_found = 0; while (get_timer(start_time) < CONFIG_PS2MULT_DELAY); ps2ser_init(); ps2ser_putc(PS2MULT_SESSION_START); ps2ser_putc(PS2MULT_KB_SELECTOR); ps2ser_putc(KBD_CMD_RESET); do { byte = ps2mult_getc_w(); } while (byte >= 0 && byte != KBD_REPLY_ACK); if (byte == KBD_REPLY_ACK) { byte = ps2mult_getc_w(); if (byte == 0xaa) { kbd_found = 1; puts("keyboard"); } } if (!kbd_found) { while (byte >= 0) { byte = ps2mult_getc_w(); } } #if 1 /* detect mouse */ ps2ser_putc(PS2MULT_MS_SELECTOR); ps2ser_putc(AUX_RESET); do { byte = ps2mult_getc_w(); } while (byte >= 0 && byte != AUX_ACK); if (byte == AUX_ACK) { byte = ps2mult_getc_w(); if (byte == 0xaa) { byte = ps2mult_getc_w(); if (byte == 0x00) { mouse_found = 1; puts(", mouse"); } } } if (!mouse_found) { while (byte >= 0) { byte = ps2mult_getc_w(); } } #endif if (mouse_found || kbd_found) { if (!received_selector) { if (mouse_found) { received_selector = PS2MULT_MS_SELECTOR; } else { received_selector = PS2MULT_KB_SELECTOR; } } init_done = 1; } else { puts("No device found"); } puts("\n"); #if 0 /* for testing */ { int i; u_char key[] = { 0x1f, 0x12, 0x14, 0x12, 0x31, 0x2f, 0x39, /* setenv */ 0x1f, 0x14, 0x20, 0x17, 0x31, 0x39, /* stdin */ 0x1f, 0x12, 0x13, 0x17, 0x1e, 0x26, 0x1c, /* serial */ }; for (i = 0; i < sizeof (key); i++) { ps2mult_receive_byte (key[i], PS2MULT_KB_SELECTOR); ps2mult_receive_byte (key[i] | 0x80, PS2MULT_KB_SELECTOR); } } #endif return init_done ? 0 : -1; } int ps2mult_request_irq(void (*handler)(void *)) { keyb_handler = handler; return 0; }