1 files changed, 61 insertions, 0 deletions

diff --git a/console-tools/loadkmap.c b/console-tools/loadkmap.c
new file mode 100644
index 000000000..ce9b6817c
--- /dev/null
+++ b/console-tools/loadkmap.c
@@ -0,0 +1,61 @@
+/* vi: set sw=4 ts=4: */
+/*
+ * Mini loadkmap implementation for busybox
+ *
+ * Copyright (C) 1998 Enrique Zanardi <ezanardi@ull.es>
+ *
+ * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
+ *
+ */
+
+#include "busybox.h"
+
+#define BINARY_KEYMAP_MAGIC "bkeymap"
+
+/* From <linux/kd.h> */
+struct kbentry {
+        unsigned char kb_table;
+        unsigned char kb_index;
+        unsigned short kb_value;
+};
+/* sets one entry in translation table */
+#define KDSKBENT        0x4B47
+
+/* From <linux/keyboard.h> */
+#define NR_KEYS         128
+#define MAX_NR_KEYMAPS  256
+
+int loadkmap_main(int argc, char **argv)
+{
+        struct kbentry ke;
+        int i, j, fd;
+        u_short ibuff[NR_KEYS];
+        char flags[MAX_NR_KEYMAPS];
+        char buff[7];
+
+        if (argc != 1)
+                bb_show_usage();
+
+        fd = xopen(CURRENT_VC, O_RDWR);
+
+        xread(0, buff, 7);
+        if (strncmp(buff, BINARY_KEYMAP_MAGIC, 7))
+                bb_error_msg_and_die("this is not a valid binary keymap");
+
+        xread(0, flags, MAX_NR_KEYMAPS);
+
+        for (i = 0; i < MAX_NR_KEYMAPS; i++) {
+                if (flags[i] == 1) {
+                        xread(0, ibuff, NR_KEYS * sizeof(u_short));
+                        for (j = 0; j < NR_KEYS; j++) {
+                                ke.kb_index = j;
+                                ke.kb_table = i;
+                                ke.kb_value = ibuff[j];
+                                ioctl(fd, KDSKBENT, &ke);
+                        }
+                }
+        }
+
+        if (ENABLE_FEATURE_CLEAN_UP) close(fd);
+        return 0;
+}