[3320] | 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 | }
|
---|