WebSVN – HelenOS – Diff – /branches/dynload/uspace/srv/kbd/arch/ia64/src/kbd.c

 #include <arch/kbd.h>
 #include <ipc/ipc.h>
 #include <sysinfo.h>
 #include <kbd.h>
 #include <keys.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <align.h>
+#include <async.h>
+#include <ipc/ipc.h>
+#include <errno.h>
+#include <stdio.h>
+#include <ddi.h>
+#include <sysinfo.h>
+#include <as.h>
+#include <ipc/fb.h>
+#include <ipc/ipc.h>
+#include <ipc/ns.h>
+#include <ipc/services.h>
+#include <libarch/ddi.h>
+extern int lkbd_arch_process(keybuffer_t *keybuffer, ipc_call_t *call);
+extern int lkbd_arch_init(void);
 #define KEY_F1 0x504f1b
 #define KEY_F2 0x514f1b
 #define KEY_F3 0x524f1b
 #define KEY_F4 0x534f1b
 #define KEY_F9 0x7e30325b1b
 #define KEY_F10 0x7e31325b1b
 #define KEY_F11 0x7e33325b1b
 #define KEY_F12 0x7e34325b1b
+#define NSKEY_F1 0x415b5b1b
+#define NSKEY_F2 0x425b5b1b
+#define NSKEY_F3 0x435b5b1b
+#define NSKEY_F4 0x445b5b1b
+#define NSKEY_F5 0x455b5b1b
+#define NSKEY_F6 0x37315b1b
+#define NSKEY_F7 0x38315b1b
+#define NSKEY_F8 0x39315b1b
+#define NSKEY_F9 0x30325b1b
+#define NSKEY_F10 0x31325b1b
+#define NSKEY_F11 0x33325b1b
+#define NSKEY_F12 0x34325b1b
 #define FUNCTION_KEYS 0x100
+#define KBD_SKI 1
+#define KBD_LEGACY 2
+#define KBD_NS16550 3
+/* NS16550 registers */
+#define RBR_REG     0   /** Receiver Buffer Register. */
+#define IER_REG     1   /** Interrupt Enable Register. */
+#define IIR_REG     2   /** Interrupt Ident Register (read). */
+#define FCR_REG     2   /** FIFO control register (write). */
+#define LCR_REG     3   /** Line Control register. */
+#define MCR_REG     4   /** Modem Control Register. */
+#define LSR_REG     5   /** Line Status Register. */
 irq_cmd_t ski_cmds[1] = {
     { CMD_IA64_GETCHAR, 0, 0, 2 }
 };
 irq_code_t ski_kbd = {
 ,
     ski_cmds
 };
+irq_cmd_t ns16550_cmds[1] = {
+    { CMD_PORT_READ_1, 0, 0, 2 },
+};
+irq_code_t ns16550_kbd = {
+,
+    ns16550_cmds
+};
+uint16_t ns16550_port;
+int kbd_type;
 int kbd_arch_init(void)
+{
     if (sysinfo_value("kbd")) {
+        kbd_type=sysinfo_value("kbd.type");
+        if(kbd_type==KBD_SKI) ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &ski_kbd);
+        if(kbd_type==KBD_LEGACY) return lkbd_arch_init();
+        if(kbd_type==KBD_NS16550) {
+            ns16550_kbd.cmds[0].addr= (void *)  (sysinfo_value("kbd.port")+RBR_REG);
-        ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &ski_kbd);
+            ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &ns16550_kbd);
+            iospace_enable(task_get_id(),ns16550_port=sysinfo_value("kbd.port"),8);
+        }
         return 0;
+    }
     return 1;
+}
 int to_hex(int v)
+{
     return "0123456789ABCDEF"[v];
+}
 */
+#define LSR_DATA_READY  0x01
+int kbd_ns16550_process(keybuffer_t *keybuffer, ipc_call_t *call)
+{
+    static unsigned long buf = 0;
+    static int count = 0, esc_count=0;
+    int scan_code = IPC_GET_ARG2(*call);
+    if (scan_code == 0x1b) {
+        esc_count++;
+        if (esc_count == 3) {
+            __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
+        }
+    } else {
+        esc_count = 0;
+    }
+    if(scan_code==0x0d) return 1;   //Delete CR
+    if(scan_code==0x7f) scan_code='\b'; //Convert backspace
+    if(scan_code == 0x7e) {
+        switch (buf) {
+        case NSKEY_F6:
+            keybuffer_push(keybuffer,FUNCTION_KEYS | 6);
+            buf = count = 0;
+            return 1;
+        case NSKEY_F7:
+            keybuffer_push(keybuffer,FUNCTION_KEYS | 7);
+            buf = count = 0;
+            return 1;
+        case NSKEY_F8:
+            keybuffer_push(keybuffer,FUNCTION_KEYS | 8);
+            buf = count = 0;
+            return 1;
+        case NSKEY_F9:
+            keybuffer_push(keybuffer,FUNCTION_KEYS | 9);
+            buf = count = 0;
+            return 1;
+        case NSKEY_F10:
+            keybuffer_push(keybuffer,FUNCTION_KEYS | 10);
+            buf = count = 0;
+            return 1;
+        case NSKEY_F11:
+            keybuffer_push(keybuffer,FUNCTION_KEYS | 11);
+            buf = count = 0;
+            return 1;
+        case NSKEY_F12:
+            keybuffer_push(keybuffer,FUNCTION_KEYS | 12);
+            buf = count = 0;
+            return 1;
+        default:
+            keybuffer_push(keybuffer, buf & 0xff);
+            keybuffer_push(keybuffer, (buf >> 8) &0xff);
+            keybuffer_push(keybuffer, (buf >> 16) &0xff);
+            keybuffer_push(keybuffer, (buf >> 24) &0xff);
+            keybuffer_push(keybuffer, scan_code);
+            buf = count = 0;
+            return 1;
+        }
+    }
+    buf |= ((unsigned long) scan_code)<<(8*(count++));
+    if((buf & 0xff) != (NSKEY_F1 & 0xff)) {
+        keybuffer_push(keybuffer, buf);
+        buf = count = 0;
+        return 1;
+    }
+    if (count <= 1)
+        return 1;
+    if ((buf & 0xffff) != (NSKEY_F1 & 0xffff))  {
+        keybuffer_push(keybuffer, buf & 0xff);
+        keybuffer_push(keybuffer, (buf >> 8) &0xff);
+        buf = count = 0;
+        return 1;
+    }
+    if (count <= 2)
+        return 1;
+    if ((buf & 0xffffff) != (NSKEY_F1 & 0xffffff)
+        && (buf & 0xffffff) != (NSKEY_F6 & 0xffffff)
+        && (buf & 0xffffff) != (NSKEY_F9 & 0xffffff) ) {
+        keybuffer_push(keybuffer, buf & 0xff);
+        keybuffer_push(keybuffer, (buf >> 8) &0xff);
+        keybuffer_push(keybuffer, (buf >> 16) &0xff);
+        buf = count = 0;
+        return 1;
+    }
+    if (count <= 3)
+        return 1;
+    switch (buf) {
+    case NSKEY_F1:
+        keybuffer_push(keybuffer,FUNCTION_KEYS | 1);
+        buf = count = 0;
+        return 1;
+    case NSKEY_F2:
+        keybuffer_push(keybuffer,FUNCTION_KEYS | 2);
+        buf = count = 0;
+        return 1;
+    case NSKEY_F3:
+        keybuffer_push(keybuffer,FUNCTION_KEYS | 3);
+        buf = count = 0;
+        return 1;
+    case NSKEY_F4:
+        keybuffer_push(keybuffer,FUNCTION_KEYS | 4);
+        buf = count = 0;
+        return 1;
+    case NSKEY_F5:
+        keybuffer_push(keybuffer,FUNCTION_KEYS | 5);
+        buf = count = 0;
+        return 1;
+    }
+    switch (buf) {
+    case NSKEY_F6:
+    case NSKEY_F7:
+    case NSKEY_F8:
+    case NSKEY_F9:
+    case NSKEY_F10:
+    case NSKEY_F11:
+    case NSKEY_F12:
+        return 1;
+    default:
+        keybuffer_push(keybuffer, buf & 0xff);
+        keybuffer_push(keybuffer, (buf >> 8) &0xff);
+        keybuffer_push(keybuffer, (buf >> 16) &0xff);
+        keybuffer_push(keybuffer, (buf >> 24) &0xff);
+        buf = count = 0;
+        return 1;
+    }
+    return 1;
+}
-int kbd_arch_process(keybuffer_t *keybuffer, ipc_call_t *call)
+int kbd_ski_process(keybuffer_t *keybuffer, ipc_call_t *call)
+{
     static unsigned long long buf = 0;
     static int count = 0;
     static int esc_count = 0;
     int scan_code = IPC_GET_ARG2(*call);
     /*
      * Please preserve this code (it can be used to determine scancodes)
      */
     //keybuffer_push(keybuffer, to_hex((scan_code>>4)&0xf));
     //keybuffer_push(keybuffer, to_hex(scan_code&0xf));
                 break;
+            }
+        }
         buf = count = 0;
+    }
     return  1;
+}
+int kbd_arch_process(keybuffer_t *keybuffer, ipc_call_t *call)
+{
+    printf("KBD Key pressed: %x(%c)\n",IPC_GET_ARG2(*call),IPC_GET_ARG2(*call));
+    if(kbd_type==KBD_SKI) return kbd_ski_process(keybuffer,call);
+    if(kbd_type==KBD_NS16550) return kbd_ns16550_process(keybuffer,call);
+    if(kbd_type==KBD_LEGACY) return lkbd_arch_process(keybuffer,call);
+}
 /**
  * @}
  */

Subversion Repositories HelenOS

(root)/branches/dynload/uspace/srv/kbd/arch/ia64/src/kbd.c – Rev 2927 → 3674