save a bit of code with *strchrnul = '\0' trick
[oweals/busybox.git] / console-tools / setkeycodes.c
index 1428bf3f2cdae0dfbcea41d7b97aba9732f989e3..ba3d2e44e6804619f6d270f10162c7a08ae390ed 100644 (file)
@@ -9,12 +9,8 @@
  * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
  */
 
-#include <stdio.h>
-#include <stdlib.h>
-#include <fcntl.h>
-#include <sys/ioctl.h>
-#include "busybox.h"
-
+//#include <sys/ioctl.h>
+#include "libbb.h"
 
 /* From <linux/kd.h> */
 struct kbkeycode {
@@ -24,38 +20,30 @@ enum {
        KDSETKEYCODE = 0x4B4D  /* write kernel keycode table entry */
 };
 
-extern int
-setkeycodes_main(int argc, char** argv)
+int setkeycodes_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
+int setkeycodes_main(int argc, char **argv)
 {
-    char *ep;
-    int fd, sc;
-    struct kbkeycode a;
+       int fd, sc;
+       struct kbkeycode a;
 
-    if (argc % 2 != 1 || argc < 2) {
-      bb_show_usage();
+       if (argc % 2 != 1 || argc < 2) {
+               bb_show_usage();
        }
 
        fd = get_console_fd();
 
-    while (argc > 2) {
-       a.keycode = atoi(argv[2]);
-       a.scancode = sc = strtol(argv[1], &ep, 16);
-       if (*ep) {
-      bb_error_msg_and_die("error reading SCANCODE: '%s'", argv[1]);
-       }
-       if (a.scancode > 127) {
-           a.scancode -= 0xe000;
-           a.scancode += 128;
-       }
-       if (a.scancode > 255 || a.keycode > 127) {
-      bb_error_msg_and_die("SCANCODE or KEYCODE outside bounds");
-       }
-       if (ioctl(fd,KDSETKEYCODE,&a)) {
-           perror("KDSETKEYCODE");
-               bb_error_msg_and_die("failed to set SCANCODE %x to KEYCODE %d", sc, a.keycode);
+       while (argc > 2) {
+               a.keycode = xatoul_range(argv[2], 0, 127);
+               a.scancode = sc = xstrtoul_range(argv[1], 16, 0, 255);
+               if (a.scancode > 127) {
+                       a.scancode -= 0xe000;
+                       a.scancode += 128;
+               }
+               ioctl_or_perror_and_die(fd, KDSETKEYCODE, &a,
+                       "failed to set SCANCODE %x to KEYCODE %d",
+                       sc, a.keycode);
+               argc -= 2;
+               argv += 2;
        }
-       argc -= 2;
-       argv += 2;
-    }
        return EXIT_SUCCESS;
 }