source: MondoRescue/branches/2.2.5/mindi-busybox/console-tools/loadkmap.c

/* 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 "libbb.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);
int loadkmap_main(int argc, char **argv)
{
    struct kbentry ke;
    int i, j, fd;
    uint16_t 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(uint16_t));
            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;
}