freebsd-dev/usr.sbin/kbdcontrol/kbdcontrol.c

567 lines
12 KiB
C
Raw Normal View History

/*-
* Copyright (c) 1994 S<EFBFBD>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);
}