Rewritten by Manuel Novoa III.
[oweals/busybox.git] / setkeycodes.c
1 /* vi: set sw=4 ts=4: */
2 /*
3  * setkeycodes
4  *
5  * Copyright (C) 1994-1998 Andries E. Brouwer <aeb@cwi.nl>
6  *
7  * Adjusted for BusyBox by Erik Andersen <andersee@debian.org>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17  * General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22  *
23  */
24
25 #include <stdio.h>
26 #include <stdlib.h>
27 #include <fcntl.h>
28 #include <sys/ioctl.h>
29 #include "busybox.h"
30
31
32 /* From <linux/kd.h> */
33 struct kbkeycode {
34         unsigned int scancode, keycode;
35 };
36 static const int KDSETKEYCODE = 0x4B4D;  /* write kernel keycode table entry */
37
38 extern int 
39 setkeycodes_main(int argc, char** argv)
40 {
41     char *ep;
42     int fd, sc;
43     struct kbkeycode a;
44
45     if (argc % 2 != 1 || argc < 2) {
46       show_usage();
47         }
48          
49         fd = get_console_fd("/dev/console");
50
51     while (argc > 2) {
52         a.keycode = atoi(argv[2]);
53         a.scancode = sc = strtol(argv[1], &ep, 16);
54         if (*ep) {
55       error_msg_and_die("error reading SCANCODE: '%s'", argv[1]);
56         }
57         if (a.scancode > 127) {
58             a.scancode -= 0xe000;
59             a.scancode += 128;
60         }
61         if (a.scancode > 255 || a.keycode > 127) {
62       error_msg_and_die("SCANCODE or KEYCODE outside bounds");
63         }
64         if (ioctl(fd,KDSETKEYCODE,&a)) {
65             perror("KDSETKEYCODE");
66                 error_msg_and_die("failed to set SCANCODE %x to KEYCODE %d", sc, a.keycode);
67         }
68         argc -= 2;
69         argv += 2;
70     }
71         return EXIT_SUCCESS;
72 }