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 }