567 lines
12 KiB
C
567 lines
12 KiB
C
/*-
|
||
* Copyright (c) 1994 Søren Schmidt
|
||
* All rights reserved.
|
||
*
|
||
* Redistribution and use in source and binary forms, with or without
|
||
* modification, are permitted provided that the following conditions
|
||
* are met:
|
||
* 1. Redistributions of source code must retain the above copyright
|
||
* notice, this list of conditions and the following disclaimer.
|
||
* 2. Redistributions in binary form must reproduce the above copyright
|
||
* notice, this list of conditions and the following disclaimer in the
|
||
* documentation and/or other materials provided with the distribution.
|
||
* 3. The name of the author may not be used to endorse or promote products
|
||
* derived from this software withough specific prior written permission
|
||
*
|
||
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
*
|
||
* $Id: kbdcontrol.c,v 1.1 1994/05/20 12:18:05 sos Exp $
|
||
*/
|
||
|
||
#include <ctype.h>
|
||
#include <stdio.h>
|
||
#include <machine/console.h>
|
||
#include "path.h"
|
||
#include "lex.h"
|
||
|
||
char ctrl_names[32][4] = {
|
||
"nul", "soh", "stx", "etx", "eot", "enq", "ack", "bel",
|
||
"bs ", "ht ", "nl ", "vt ", "ff ", "cr ", "so ", "si ",
|
||
"dle", "dc1", "dc2", "dc3", "dc4", "nak", "syn", "etb",
|
||
"can", "em ", "sub", "esc", "fs ", "gs ", "rs ", "ns "
|
||
};
|
||
|
||
char fkey_table[60][MAXFK] = {
|
||
/* 00-03 */ "\033[M", "\033[N", "\033[O", "\033[P",
|
||
/* 04-07 */ "\033[Q", "\033[R", "\033[S", "\033[T",
|
||
/* 08-0B */ "\033[U", "\033[V", "\033[W", "\033[X",
|
||
/* 0C-0F */ "\033[W", "\033[X", "\033[Y", "\033[Z",
|
||
/* 10-13 */ "\033[a", "\033[b", "\033[c", "\033[d",
|
||
/* 14-17 */ "\033[e", "\033[f", "\033[g", "\033[h",
|
||
/* 18-1B */ "\033[g", "\033[h", "\033[i", "\033[j",
|
||
/* 1C-1F */ "\033[k", "\033[l", "\033[m", "\033[n",
|
||
/* 20-23 */ "\033[o", "\033[p", "\033[q", "\033[r",
|
||
/* 24-27 */ "\033[g", "\033[h", "\033[i", "\033[j",
|
||
/* 28-2B */ "\033[k", "\033[l", "\033[m", "\033[n",
|
||
/* 2C-2F */ "\033[o", "\033[p", "\033[q", "\033[r",
|
||
/* 30-33 */ "\033[H", "\033[A", "\033[I", "-" ,
|
||
/* 34-37 */ "\033[D", "\177" , "\033[C", "+" ,
|
||
/* 38-3B */ "\033[F", "\033[B", "\033[G", "\033[L"
|
||
};
|
||
|
||
const int delays[] = {250, 500, 750, 1000};
|
||
const int repeats[] = { 34, 38, 42, 46, 50, 55, 59, 63,
|
||
68, 76, 84, 92, 100, 110, 118, 126,
|
||
136, 152, 168, 184, 200, 220, 236, 252,
|
||
272, 304, 336, 368, 400, 440, 472, 504};
|
||
const int ndelays = (sizeof(delays) / sizeof(int));
|
||
const int nrepeats = (sizeof(repeats) / sizeof(int));
|
||
int hex = 0;
|
||
int number, verbose = 0;
|
||
char letter;
|
||
|
||
|
||
char *
|
||
nextarg(int ac, char **av, int *indp, int oc)
|
||
{
|
||
if (*indp < ac)
|
||
return(av[(*indp)++]);
|
||
fprintf(stderr, "%s: option requires two arguments -- %c\n", av[0], oc);
|
||
usage();
|
||
exit(1);
|
||
return("");
|
||
}
|
||
|
||
|
||
char *
|
||
mkfullname(const char *s1, const char *s2, const char *s3)
|
||
{
|
||
static char *buf = NULL;
|
||
static int bufl = 0;
|
||
int f;
|
||
|
||
|
||
f = strlen(s1) + strlen(s2) + strlen(s3) + 1;
|
||
if (f > bufl)
|
||
if (buf)
|
||
buf = (char *)realloc(buf, f);
|
||
else
|
||
buf = (char *)malloc(f);
|
||
if (!buf) {
|
||
bufl = 0;
|
||
return(NULL);
|
||
}
|
||
|
||
bufl = f;
|
||
strcpy(buf, s1);
|
||
strcat(buf, s2);
|
||
strcat(buf, s3);
|
||
return(buf);
|
||
}
|
||
|
||
|
||
int
|
||
get_entry()
|
||
{
|
||
switch (yylex()) {
|
||
case TNOP:
|
||
return NOP | 0x100;
|
||
case TLSH:
|
||
return LSH | 0x100;
|
||
case TRSH:
|
||
return RSH | 0x100;
|
||
case TCLK:
|
||
return CLK | 0x100;
|
||
case TNLK:
|
||
return NLK | 0x100;
|
||
case TSLK:
|
||
return SLK | 0x100;
|
||
case TBTAB:
|
||
return BTAB | 0x100;
|
||
case TLALT:
|
||
return LALT | 0x100;
|
||
case TLCTR:
|
||
return LCTR | 0x100;
|
||
case TNEXT:
|
||
return NEXT | 0x100;
|
||
case TRCTR:
|
||
return RCTR | 0x100;
|
||
case TRALT:
|
||
return RALT | 0x100;
|
||
case TALK:
|
||
return ALK | 0x100;
|
||
case TASH:
|
||
return ASH | 0x100;
|
||
case TMETA:
|
||
return META | 0x100;
|
||
case TRBT:
|
||
return RBT | 0x100;
|
||
case TDBG:
|
||
return DBG | 0x100;
|
||
case TFUNC:
|
||
if (F(number) > L_FN)
|
||
return -1;
|
||
return F(number) | 0x100;
|
||
case TSCRN:
|
||
if (S(number) > L_SCR)
|
||
return -1;
|
||
return S(number) | 0x100;
|
||
case TLET:
|
||
return (unsigned char)letter;
|
||
case TNUM:
|
||
if (number < 0 || number > 255)
|
||
return -1;
|
||
return number;
|
||
default:
|
||
return -1;
|
||
}
|
||
}
|
||
|
||
|
||
int
|
||
get_key_definition_line(FILE* fd, keymap_t *map)
|
||
{
|
||
int i, def, scancode;
|
||
|
||
yyin = fd;
|
||
|
||
/* get scancode number */
|
||
if (yylex() != TNUM)
|
||
return -1;
|
||
if (number < 0 || number >= NUM_KEYS)
|
||
return -1;
|
||
scancode = number;
|
||
|
||
/* get key definitions */
|
||
map->key[scancode].spcl = 0;
|
||
for (i=0; i<NUM_STATES; i++) {
|
||
if ((def = get_entry()) == -1)
|
||
return -1;
|
||
if (def & 0x100)
|
||
map->key[scancode].spcl |= (0x80 >> i);
|
||
map->key[scancode].map[i] = def & 0xFF;
|
||
}
|
||
/* get lock state key def */
|
||
if (yylex() != TFLAG)
|
||
return -1;
|
||
map->key[scancode].flgs = number;
|
||
return scancode;
|
||
}
|
||
|
||
|
||
int
|
||
print_entry(FILE *fp, int value)
|
||
{
|
||
int val = value & 0xFF;
|
||
|
||
switch (value) {
|
||
case NOP | 0x100:
|
||
fprintf(fp, " nop ");
|
||
break;
|
||
case LSH | 0x100:
|
||
fprintf(fp, " lshift");
|
||
break;
|
||
case RSH | 0x100:
|
||
fprintf(fp, " rshift");
|
||
break;
|
||
case CLK | 0x100:
|
||
fprintf(fp, " clock ");
|
||
break;
|
||
case NLK | 0x100:
|
||
fprintf(fp, " nlock ");
|
||
break;
|
||
case SLK | 0x100:
|
||
fprintf(fp, " slock ");
|
||
break;
|
||
case BTAB | 0x100:
|
||
fprintf(fp, " btab ");
|
||
break;
|
||
case LALT | 0x100:
|
||
fprintf(fp, " lalt ");
|
||
break;
|
||
case LCTR | 0x100:
|
||
fprintf(fp, " lctrl ");
|
||
break;
|
||
case NEXT | 0x100:
|
||
fprintf(fp, " nscr ");
|
||
break;
|
||
case RCTR | 0x100:
|
||
fprintf(fp, " rctrl ");
|
||
break;
|
||
case RALT | 0x100:
|
||
fprintf(fp, " ralt ");
|
||
break;
|
||
case ALK | 0x100:
|
||
fprintf(fp, " alock ");
|
||
break;
|
||
case ASH | 0x100:
|
||
fprintf(fp, " ashift");
|
||
break;
|
||
case META | 0x100:
|
||
fprintf(fp, " meta ");
|
||
break;
|
||
case RBT | 0x100:
|
||
fprintf(fp, " boot ");
|
||
break;
|
||
case DBG | 0x100:
|
||
fprintf(fp, " debug ");
|
||
break;
|
||
default:
|
||
if (value & 0x100) {
|
||
if (val >= F_FN && val <= L_FN)
|
||
fprintf(fp, " fkey%02d", val - F_FN + 1);
|
||
else if (val >= F_SCR && val <= L_SCR)
|
||
fprintf(fp, " scr%02d ", val - F_SCR + 1);
|
||
else if (hex)
|
||
fprintf(fp, " 0x%02x ", val);
|
||
else
|
||
fprintf(fp, " %3d ", val);
|
||
}
|
||
else {
|
||
if (val < ' ')
|
||
fprintf(fp, " %s ", ctrl_names[val]);
|
||
else if (val == 127)
|
||
fprintf(fp, " del ");
|
||
else if (isprint(val))
|
||
fprintf(fp, " '%c' ", val);
|
||
else if (hex)
|
||
fprintf(fp, " 0x%02x ", val);
|
||
else
|
||
fprintf(fp, " %3d ", val);
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
void
|
||
print_key_definition_line(FILE *fp, int scancode, struct key_t *key)
|
||
{
|
||
int i, value;
|
||
|
||
/* print scancode number */
|
||
if (hex)
|
||
fprintf(fp, " 0x%02x ", scancode);
|
||
else
|
||
fprintf(fp, " %03d ", scancode);
|
||
|
||
/* print key definitions */
|
||
for (i=0; i<NUM_STATES; i++) {
|
||
if (key->spcl & (0x80 >> i))
|
||
print_entry(fp, key->map[i] | 0x100);
|
||
else
|
||
print_entry(fp, key->map[i]);
|
||
}
|
||
|
||
/* print lock state key def */
|
||
switch (key->flgs) {
|
||
case 0:
|
||
fprintf(fp, " O\n");
|
||
break;
|
||
case 1:
|
||
fprintf(fp, " C\n");
|
||
break;
|
||
case 2:
|
||
fprintf(fp, " N\n");
|
||
break;
|
||
}
|
||
}
|
||
|
||
|
||
void
|
||
load_keymap(char *opt)
|
||
{
|
||
keymap_t map;
|
||
FILE *fd;
|
||
int scancode, i;
|
||
char *name;
|
||
char *prefix[] = {"", "", KEYMAP_PATH, NULL};
|
||
char *postfix[] = {"", ".kbd", ".kbd"};
|
||
|
||
for (i=0; prefix[i]; i++) {
|
||
name = mkfullname(prefix[i], opt, postfix[i]);
|
||
if (fd = fopen(name, "r"))
|
||
break;
|
||
}
|
||
if (fd == NULL) {
|
||
perror("keymap file not found");
|
||
return;
|
||
}
|
||
memset(map, 0, sizeof(map));
|
||
while (1) {
|
||
if ((scancode = get_key_definition_line(fd, &map)) < 0)
|
||
break;
|
||
if (scancode > map.n_keys) map.n_keys = scancode;
|
||
}
|
||
if (ioctl(0, PIO_KEYMAP, &map) < 0) {
|
||
perror("setting keymap");
|
||
fclose(fd);
|
||
return;
|
||
}
|
||
}
|
||
|
||
|
||
void
|
||
print_keymap()
|
||
{
|
||
keymap_t map;
|
||
int i;
|
||
|
||
if (ioctl(0, GIO_KEYMAP, &map) < 0) {
|
||
perror("getting keymap");
|
||
exit(1);
|
||
}
|
||
printf(
|
||
"# alt\n"
|
||
"# scan cntrl alt alt cntrl lock\n"
|
||
"# code base shift cntrl shift alt shift cntrl shift state\n"
|
||
"# ------------------------------------------------------------------\n"
|
||
);
|
||
for (i=0; i<map.n_keys; i++)
|
||
print_key_definition_line(stdout, i, &map.key[i]);
|
||
}
|
||
|
||
|
||
void
|
||
load_default_functionkeys()
|
||
{
|
||
fkeyarg_t fkey;
|
||
int i;
|
||
|
||
for (i=0; i<NUM_FKEYS; i++) {
|
||
fkey.keynum = i;
|
||
strcpy(fkey.keydef, fkey_table[i]);
|
||
fkey.flen = strlen(fkey_table[i]);
|
||
if (ioctl(0, SETFKEY, &fkey) < 0)
|
||
perror("setting function key");
|
||
}
|
||
}
|
||
|
||
void
|
||
set_functionkey(char *keynumstr, char *string)
|
||
{
|
||
fkeyarg_t fkey;
|
||
int keynum;
|
||
|
||
if (!strcmp(keynumstr, "load") && !strcmp(string, "default")) {
|
||
load_default_functionkeys();
|
||
return;
|
||
}
|
||
fkey.keynum = atoi(keynumstr);
|
||
if (fkey.keynum < 1 || fkey.keynum > NUM_FKEYS) {
|
||
fprintf(stderr,
|
||
"function key number must be between 1 and %d\n",
|
||
NUM_FKEYS);
|
||
return;
|
||
}
|
||
if ((fkey.flen = strlen(string)) > MAXFK) {
|
||
fprintf(stderr, "function key string too long (%d > %d)\n",
|
||
fkey.flen, MAXFK);
|
||
return;
|
||
}
|
||
strcpy(fkey.keydef, string);
|
||
if (verbose)
|
||
fprintf(stderr, "setting function key %d to <%s>\n",
|
||
fkey.keynum, fkey.keydef);
|
||
fkey.keynum -= 1;
|
||
if (ioctl(0, SETFKEY, &fkey) < 0)
|
||
perror("setting function key");
|
||
}
|
||
|
||
|
||
void
|
||
set_bell_values(char *opt)
|
||
{
|
||
int duration, pitch;
|
||
|
||
if (!strcmp(opt, "normal"))
|
||
duration = 1, pitch = 15;
|
||
else {
|
||
int n;
|
||
char *v1;
|
||
|
||
duration = strtol(opt, &v1, 0);
|
||
if ((duration < 0) || (*v1 != '.'))
|
||
goto badopt;
|
||
opt = ++v1;
|
||
pitch = strtol(opt, &v1, 0);
|
||
if ((pitch < 0) || (*opt == '\0') || (*v1 != '\0')) {
|
||
badopt:
|
||
fprintf(stderr,
|
||
"argument to -b must be DURATION.PITCH\n");
|
||
return;
|
||
}
|
||
}
|
||
|
||
if (verbose)
|
||
fprintf(stderr, "setting bell values to %d.%d\n",
|
||
duration, pitch);
|
||
fprintf(stderr, "[=%d;%dB", pitch, duration);
|
||
}
|
||
|
||
|
||
void
|
||
set_keyrates(char *opt)
|
||
{
|
||
struct {
|
||
int rep:5;
|
||
int del:2;
|
||
int pad:1;
|
||
}rate;
|
||
|
||
if (!strcmp(opt, "slow"))
|
||
rate.del = 3, rate.rep = 31;
|
||
else if (!strcmp(opt, "normal"))
|
||
rate.del = 1, rate.rep = 15;
|
||
else if (!strcmp(opt, "fast"))
|
||
rate.del = rate.rep = 0;
|
||
else {
|
||
int n;
|
||
int delay, repeat;
|
||
char *v1;
|
||
|
||
delay = strtol(opt, &v1, 0);
|
||
if ((delay < 0) || (*v1 != '.'))
|
||
goto badopt;
|
||
opt = ++v1;
|
||
repeat = strtol(opt, &v1, 0);
|
||
if ((repeat < 0) || (*opt == '\0') || (*v1 != '\0')) {
|
||
badopt:
|
||
fprintf(stderr,
|
||
"argument to -r must be delay.repeat\n");
|
||
return;
|
||
}
|
||
for (n = 0; n < ndelays - 1; n++)
|
||
if (delay <= delays[n])
|
||
break;
|
||
rate.del = n;
|
||
for (n = 0; n < nrepeats - 1; n++)
|
||
if (repeat <= repeats[n])
|
||
break;
|
||
rate.rep = n;
|
||
}
|
||
|
||
if (verbose)
|
||
fprintf(stderr, "setting keyboard rate to %d.%d\n",
|
||
delays[rate.del], repeats[rate.rep]);
|
||
if (ioctl(0, KDSETRAD, rate) < 0)
|
||
perror("setting keyboard rate");
|
||
}
|
||
|
||
|
||
usage()
|
||
{
|
||
fprintf(stderr,
|
||
"Usage: kbdcontrol -b duration.pitch (set bell duration & pitch)\n"
|
||
" -d (dump keyboard map to stdout)\n"
|
||
" -l filename (load keyboard map file)\n"
|
||
" -f <N> string (set function key N to send <string>)\n"
|
||
" -F (set function keys back to default)\n"
|
||
" -r delay.repeat (set keyboard delay & repeat rate)\n"
|
||
" -r slow (set keyboard delay & repeat to slow)\n"
|
||
" -r normal (set keyboard delay & repeat to normal)\n"
|
||
" -r fast (set keyboard delay & repeat to fast)\n"
|
||
" -v (verbose)\n"
|
||
);
|
||
}
|
||
|
||
|
||
void
|
||
main(int argc, char **argv)
|
||
{
|
||
extern char *optarg;
|
||
extern int optind;
|
||
int opt;
|
||
|
||
/*
|
||
if (!is_syscons(0))
|
||
exit(1);
|
||
*/
|
||
while((opt = getopt(argc, argv, "b:df:Fl:r:vx")) != -1)
|
||
switch(opt) {
|
||
case 'b':
|
||
set_bell_values(optarg);
|
||
break;
|
||
case 'd':
|
||
print_keymap();
|
||
break;
|
||
case 'l':
|
||
load_keymap(optarg);
|
||
break;
|
||
case 'f':
|
||
set_functionkey(optarg,
|
||
nextarg(argc, argv, &optind, 'f'));
|
||
break;
|
||
case 'F':
|
||
load_default_functionkeys();
|
||
break;
|
||
case 'r':
|
||
set_keyrates(optarg);
|
||
break;
|
||
case 'v':
|
||
verbose = 1;
|
||
break;
|
||
case 'x':
|
||
hex = 1;
|
||
break;
|
||
default:
|
||
usage();
|
||
exit(1);
|
||
}
|
||
if ((optind != argc) || (argc == 1)) {
|
||
usage();
|
||
exit(1);
|
||
}
|
||
exit(0);
|
||
}
|
||
|
||
|