kbd_mode: new applet by Loïc Grenié <loic.grenie@gmail.com>

kbd_mode_main                                          -     189    +189
packed_usage                                       22745   22833     +88
applets                                             3132    3144     +12
static.opts                                            7      12      +5
------------------------------------------------------------------------------
(add/remove: 1/0 grow/shrink: 3/0 up/down: 294/0)             Total: 294 bytes
   text    data     bss     dec     hex filename
 777210    1000    9532  787742   c051e busybox_old
 777575    1000    9532  788107   c068b busybox_unstripped

3 files changed, 78 insertions, 0 deletions

diff --git a/console-tools/Config.in b/console-tools/Config.in
index f82d4ce13..bd9dfb381 100644
--- a/console-tools/Config.in
+++ b/console-tools/Config.in
@@ -31,6 +31,12 @@ config DUMPKMAP
 	  This program dumps the kernel's keyboard translation table to
 	  stdout, in binary format. You can then use loadkmap to load it.
 
+config KBD_MODE
+	bool "kbd_mode"
+	default n
+	help
+	  This program reports and sets keyboard mode.
+
 config LOADFONT
 	bool "loadfont"
 	default n
diff --git a/console-tools/Kbuild b/console-tools/Kbuild
index a55bc087c..cf3825ec6 100644
--- a/console-tools/Kbuild
+++ b/console-tools/Kbuild
@@ -10,6 +10,7 @@ lib-$(CONFIG_CLEAR)		+= clear.o
 lib-$(CONFIG_DEALLOCVT)		+= deallocvt.o
 lib-$(CONFIG_DUMPKMAP)		+= dumpkmap.o
 lib-$(CONFIG_SETCONSOLE)	+= setconsole.o
+lib-$(CONFIG_KBD_MODE)		+= kbd_mode.o
 lib-$(CONFIG_LOADFONT)		+= loadfont.o
 lib-$(CONFIG_LOADKMAP)		+= loadkmap.o
 lib-$(CONFIG_OPENVT)		+= openvt.o
diff --git a/console-tools/kbd_mode.c b/console-tools/kbd_mode.c
new file mode 100644
index 000000000..0000ea180
--- /dev/null
+++ b/console-tools/kbd_mode.c
@@ -0,0 +1,71 @@
+/* vi: set sw=4 ts=4: */
+/*
+ * Mini loadkmap implementation for busybox
+ *
+ * Copyright (C) 2007 Loïc Grenié <loic.grenie@gmail.com>
+ *   written using Andries Brouwer <aeb@cwi.nl>'s kbd_mode from
+ *   console-utils v0.2.3, licensed under GNU GPLv2
+ *
+ * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
+ *
+ */
+
+#include <getopt.h>
+#include "libbb.h"
+#include <linux/kd.h>
+
+int kbd_mode_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
+int kbd_mode_main(int argc, char **argv)
+{
+	static const char opts[] = "saku";
+
+	const char *opt = argv[1];
+	const char *p;
+	int fd;
+
+	fd = get_console_fd();
+	if (fd < 0) /* get_console_fd() already complained */
+		return EXIT_FAILURE;
+
+	if (opt == NULL) {
+		/* No arg */
+		const char *msg = "unknown";
+		int mode;
+
+		ioctl(fd, KDGKBMODE, &mode);
+		switch(mode) {
+		case K_RAW:
+			msg = "raw (scancode)";
+			break;
+		case K_XLATE:
+			msg = "default (ASCII)";
+			break;
+		case K_MEDIUMRAW:
+			msg = "mediumraw (keycode)";
+			break;
+		case K_UNICODE:
+			msg = "Unicode (UTF-8)";
+			break;
+		}
+		printf("The keyboard is in %s mode\n", msg);
+	}
+	else if (argc > 2 /* more than 1 arg */
+	 || *opt != '-' /* not an option */
+	 || (p = strchr(opts, opt[1])) == NULL /* not an option we expect */
+	 || opt[2] != '\0' /* more than one option char */
+	) {
+		bb_show_usage();
+		/* return EXIT_FAILURE; - not reached */
+	}
+	else {
+#if K_RAW != 0 || K_XLATE != 1 || K_MEDIUMRAW != 2 || K_UNICODE != 3
+#error kbd_mode must be changed
+#endif
+		/* The options are in the order of the various K_xxx */
+		ioctl(fd, KDSKBMODE, p - opts);
+	}
+
+	if (ENABLE_FEATURE_CLEAN_UP)
+		close(fd);
+	return EXIT_SUCCESS;
+}