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 | }
|
---|