console-tools/showkey.c

   1 /* vi: set sw=4 ts=4: */
   2 /*
   3  * shows keys pressed. inspired by kbd package
   4  *
   5  * Copyright (C) 2008 by Vladimir Dronnikov <dronnikov@gmail.com>
   6  *
   7  * Licensed under GPLv2, see file LICENSE in this source tree.
   8  */
   9
  10 #include "libbb.h"
  11 #include <linux/kd.h>
  12
  13
  14 struct globals {
  15         int kbmode;
  16         struct termios tio, tio0;
  17 };
  18 #define G (*ptr_to_globals)
  19 #define kbmode  (G.kbmode)
  20 #define tio     (G.tio)
  21 #define tio0    (G.tio0)
  22 #define INIT_G() do { \
  23         SET_PTR_TO_GLOBALS(xzalloc(sizeof(G))); \
  24 } while (0)
  25
  26
  27 // set raw tty mode
  28 // also used by microcom
  29 // libbb candidates?
  30 static void xget1(struct termios *t, struct termios *oldt)
  31 {
  32         tcgetattr(STDIN_FILENO, oldt);
  33         *t = *oldt;
  34         cfmakeraw(t);
  35 }
  36
  37 static void xset1(struct termios *t)
  38 {
  39         int ret = tcsetattr(STDIN_FILENO, TCSAFLUSH, t);
  40         if (ret) {
  41                 bb_perror_msg("can't tcsetattr for stdin");
  42         }
  43 }
  44
  45 int showkey_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
  46 int showkey_main(int argc UNUSED_PARAM, char **argv)
  47 {
  48         enum {
  49                 OPT_a = (1<<0), // display the decimal/octal/hex values of the keys
  50                 OPT_k = (1<<1), // display only the interpreted keycodes (default)
  51                 OPT_s = (1<<2), // display only the raw scan-codes
  52         };
  53
  54         INIT_G();
  55
  56         // FIXME: aks are all mutually exclusive
  57         getopt32(argv, "aks");
  58
  59         // get keyboard settings
  60         xioctl(STDIN_FILENO, KDGKBMODE, &kbmode);
  61         printf("kb mode was %s\n\nPress any keys. Program terminates %s\n\n",
  62                 kbmode == K_RAW ? "RAW" :
  63                         (kbmode == K_XLATE ? "XLATE" :
  64                                 (kbmode == K_MEDIUMRAW ? "MEDIUMRAW" :
  65                                         (kbmode == K_UNICODE ? "UNICODE" : "UNKNOWN")))
  66                 , (option_mask32 & OPT_a) ? "on EOF (ctrl-D)" : "10s after last keypress"
  67         );
  68
  69         // prepare for raw mode
  70         xget1(&tio, &tio0);
  71         // put stdin in raw mode
  72         xset1(&tio);
  73
  74         if (option_mask32 & OPT_a) {
  75                 unsigned char c;
  76
  77                 // just read stdin char by char
  78                 while (1 == read(STDIN_FILENO, &c, 1)) {
  79                         printf("%3u 0%03o 0x%02x\r\n", c, c, c);
  80                         if (04 /*CTRL-D*/ == c)
  81                                 break;
  82                 }
  83         } else {
  84                 // set raw keyboard mode
  85                 xioctl(STDIN_FILENO, KDSKBMODE, (void *)(ptrdiff_t)((option_mask32 & OPT_k) ? K_MEDIUMRAW : K_RAW));
  86
  87                 // we should exit on any signal; signals should interrupt read
  88                 bb_signals_recursive_norestart(BB_FATAL_SIGS, record_signo);
  89
  90                 // read and show scancodes
  91                 while (!bb_got_signal) {
  92                         char buf[18];
  93                         int i, n;
  94
  95                         // setup 10s watchdog
  96                         alarm(10);
  97                         // read scancodes
  98                         n = read(STDIN_FILENO, buf, sizeof(buf));
  99                         i = 0;
 100                         while (i < n) {
 101                                 if (option_mask32 & OPT_s) {
 102                                         // show raw scancodes
 103                                         printf("0x%02x ", buf[i++]);
 104                                 } else {
 105                                         // show interpreted scancodes (default)
 106                                         char c = buf[i];
 107                                         int kc;
 108                                         if (i+2 < n
 109                                          && (c & 0x7f) == 0
 110                                          && (buf[i+1] & 0x80) != 0
 111                                          && (buf[i+2] & 0x80) != 0
 112                                         ) {
 113                                                 kc = ((buf[i+1] & 0x7f) << 7) | (buf[i+2] & 0x7f);
 114                                                 i += 3;
 115                                         } else {
 116                                                 kc = (c & 0x7f);
 117                                                 i++;
 118                                         }
 119                                         printf("keycode %3u %s", kc, (c & 0x80) ? "release" : "press");
 120                                 }
 121                         }
 122                         puts("\r");
 123                 }
 124         }
 125
 126         // restore keyboard and console settings
 127         xset1(&tio0);
 128         xioctl(STDIN_FILENO, KDSKBMODE, (void *)(ptrdiff_t)kbmode);
 129
 130         return EXIT_SUCCESS;
 131 }