1/* vi: set sw=4 ts=4: */ 2/* 3 * Mini loadkmap implementation for busybox 4 * 5 * Copyright (C) 1998 Enrique Zanardi <ezanardi@ull.es> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License as published by 9 * the Free Software Foundation; either version 2 of the License, or 10 * (at your option) any later version. 11 * 12 * This program is distributed in the hope that it will be useful, 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 15 * General Public License for more details. 16 * 17 * You should have received a copy of the GNU General Public License 18 * along with this program; if not, write to the Free Software 19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 20 * 21 */ 22 23#include <errno.h> 24#include <fcntl.h> 25#include <stdio.h> 26#include <string.h> 27#include <stdlib.h> 28#include <unistd.h> 29#include <sys/ioctl.h> 30#include "busybox.h" 31 32#define BINARY_KEYMAP_MAGIC "bkeymap" 33 34/* From <linux/kd.h> */ 35struct kbentry { 36 unsigned char kb_table; 37 unsigned char kb_index; 38 unsigned short kb_value; 39}; 40static const int KDSKBENT = 0x4B47; /* sets one entry in translation table */ 41 42/* From <linux/keyboard.h> */ 43static const int NR_KEYS = 128; 44static const int MAX_NR_KEYMAPS = 256; 45 46int loadkmap_main(int argc, char **argv) 47{ 48 struct kbentry ke; 49 u_short *ibuff; 50 int i, j, fd, readsz, pos, ibuffsz = NR_KEYS * sizeof(u_short); 51 char flags[MAX_NR_KEYMAPS], buff[7]; 52 53 if (argc != 1) 54 show_usage(); 55 56 fd = open(CURRENT_VC, O_RDWR); 57 if (fd < 0) 58 perror_msg_and_die("Error opening " CURRENT_VC); 59 60 read(0, buff, 7); 61 if (0 != strncmp(buff, BINARY_KEYMAP_MAGIC, 7)) 62 error_msg_and_die("This is not a valid binary keymap."); 63 64 if (MAX_NR_KEYMAPS != read(0, flags, MAX_NR_KEYMAPS)) 65 perror_msg_and_die("Error reading keymap flags"); 66 67 ibuff = (u_short *) xmalloc(ibuffsz); 68 69 for (i = 0; i < MAX_NR_KEYMAPS; i++) { 70 if (flags[i] == 1) { 71 pos = 0; 72 while (pos < ibuffsz) { 73 if ((readsz = read(0, (char *) ibuff + pos, ibuffsz - pos)) < 0) 74 perror_msg_and_die("Error reading keymap"); 75 pos += readsz; 76 } 77 for (j = 0; j < NR_KEYS; j++) { 78 ke.kb_index = j; 79 ke.kb_table = i; 80 ke.kb_value = ibuff[j]; 81 ioctl(fd, KDSKBENT, &ke); 82 } 83 } 84 } 85 /* Don't bother to close files. Exit does that 86 * automagically, so we can save a few bytes */ 87 /* close(fd); */ 88 return EXIT_SUCCESS; 89} 90