1/* $NetBSD: util.c,v 1.33 2021/12/25 13:54:13 mlelstv Exp $ */ 2 3/*- 4 * Copyright (c) 1998, 2006, 2012 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Juergen Hannken-Illjes and Julio M. Merino Vidal. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32#include <sys/time.h> 33 34#include <dev/wscons/wsconsio.h> 35#include <dev/wscons/wsksymdef.h> 36#include <dev/videomode/videomode.h> 37#include <dev/videomode/edidreg.h> 38#include <dev/videomode/edidvar.h> 39 40#include <err.h> 41#include <errno.h> 42#include <limits.h> 43#include <stdio.h> 44#include <stdlib.h> 45#include <string.h> 46#include <unistd.h> 47 48#include "wsconsctl.h" 49 50#define TABLEN(t) (sizeof(t)/sizeof(t[0])) 51 52extern struct wskbd_map_data kbmap; /* from keyboard.c */ 53extern struct wskbd_map_data newkbmap; /* from map_parse.y */ 54 55struct nameint { 56 int value; 57 const char *name; 58}; 59 60static struct nameint kbtype_tab[] = { 61 { WSKBD_TYPE_LK201, "lk201" }, 62 { WSKBD_TYPE_LK401, "lk401" }, 63 { WSKBD_TYPE_PC_XT, "pc-xt" }, 64 { WSKBD_TYPE_PC_AT, "pc-at" }, 65 { WSKBD_TYPE_USB, "usb" }, 66 { WSKBD_TYPE_HPC_KBD, "hpc-kbd" }, 67 { WSKBD_TYPE_HPC_BTN, "hpc-btn" }, 68 { WSKBD_TYPE_ARCHIMEDES, "archimedes" }, 69 { WSKBD_TYPE_RISCPC, "riscpc" }, 70 { WSKBD_TYPE_ADB, "adb" }, 71 { WSKBD_TYPE_HIL, "hil" }, 72 { WSKBD_TYPE_AMIGA, "amiga" }, 73 { WSKBD_TYPE_MAPLE, "maple" }, 74 { WSKBD_TYPE_ATARI, "atari" }, 75 { WSKBD_TYPE_SUN, "sun" }, 76 { WSKBD_TYPE_SUN5, "sun-type5" }, 77 { WSKBD_TYPE_SGI, "sgi" }, 78 { WSKBD_TYPE_MATRIXKP, "matrix-keypad" }, 79 { WSKBD_TYPE_BLUETOOTH, "bluetooth" }, 80}; 81 82static struct nameint mstype_tab[] = { 83 { WSMOUSE_TYPE_VSXXX, "dec-tc" }, 84 { WSMOUSE_TYPE_PS2, "ps2" }, 85 { WSMOUSE_TYPE_USB, "usb" }, 86 { WSMOUSE_TYPE_LMS, "logitech-bus" }, 87 { WSMOUSE_TYPE_MMS, "ms-inport" }, 88 { WSMOUSE_TYPE_TPANEL, "touch-panel" }, 89 { WSMOUSE_TYPE_NEXT, "next" }, 90 { WSMOUSE_TYPE_ARCHIMEDES, "archimedes" }, 91 { WSMOUSE_TYPE_HIL, "hil" }, 92 { WSMOUSE_TYPE_AMIGA, "amiga" }, 93 { WSMOUSE_TYPE_MAXINE, "dec-maxine" }, 94 { WSMOUSE_TYPE_MAPLE, "maple" }, 95 { WSMOUSE_TYPE_BLUETOOTH, "bluetooth" }, 96}; 97 98static struct nameint dpytype_tab[] = { 99 { WSDISPLAY_TYPE_UNKNOWN, "unknown" }, 100 { WSDISPLAY_TYPE_PM_MONO, "dec-pm-mono" }, 101 { WSDISPLAY_TYPE_PM_COLOR, "dec-pm-color" }, 102 { WSDISPLAY_TYPE_CFB, "dec-cfb" }, 103 { WSDISPLAY_TYPE_XCFB, "dec-xcfb" }, 104 { WSDISPLAY_TYPE_MFB, "dec-mfb" }, 105 { WSDISPLAY_TYPE_SFB, "dec-sfb" }, 106 { WSDISPLAY_TYPE_ISAVGA, "vga-isa" }, 107 { WSDISPLAY_TYPE_PCIVGA, "vga-pci" }, 108 { WSDISPLAY_TYPE_TGA, "dec-tga-pci" }, 109 { WSDISPLAY_TYPE_SFBP, "dec-sfb+" }, 110 { WSDISPLAY_TYPE_PCIMISC, "generic-pci" }, 111 { WSDISPLAY_TYPE_NEXTMONO, "next-mono" }, 112 { WSDISPLAY_TYPE_PX, "dec-px" }, 113 { WSDISPLAY_TYPE_PXG, "dec-pxg" }, 114 { WSDISPLAY_TYPE_TX, "dec-tx" }, 115 { WSDISPLAY_TYPE_HPCFB, "generic-hpc" }, 116 { WSDISPLAY_TYPE_VIDC, "arm-vidc" }, 117 { WSDISPLAY_TYPE_SPX, "dec-spx" }, 118 { WSDISPLAY_TYPE_GPX, "dec-gpx" }, 119 { WSDISPLAY_TYPE_LCG, "dec-lcg" }, 120 { WSDISPLAY_TYPE_VAX_MONO, "dec-vax-mono" }, 121 { WSDISPLAY_TYPE_SB_P9100, "sparcbook-p9100" }, 122 { WSDISPLAY_TYPE_EGA, "ega" }, 123 { WSDISPLAY_TYPE_DCPVR, "dreamcast-pvr" }, 124 { WSDISPLAY_TYPE_GBOX, "hp-gator" }, 125 { WSDISPLAY_TYPE_TOPCAT, "hp-topcat" }, 126 { WSDISPLAY_TYPE_RBOX, "hp-renaissance" }, 127 { WSDISPLAY_TYPE_CATSEYE, "hp-catseye" }, 128 { WSDISPLAY_TYPE_DVBOX, "hp-davinci" }, 129 { WSDISPLAY_TYPE_TVRX, "hp-tiger" }, 130 { WSDISPLAY_TYPE_HYPERION, "hp-hyperion" }, 131 { WSDISPLAY_TYPE_AMIGACC, "amiga-cc" }, 132 { WSDISPLAY_TYPE_GRF, "grf" }, 133 { WSDISPLAY_TYPE_SUN24, "sun24" }, 134 { WSDISPLAY_TYPE_NEWPORT, "sgi-newport" }, 135 { WSDISPLAY_TYPE_GR2, "sgi-gr2" }, 136 { WSDISPLAY_TYPE_SUNCG12, "suncg12" }, 137 { WSDISPLAY_TYPE_SUNCG14, "suncg14" }, 138 { WSDISPLAY_TYPE_SUNTCX, "suntcx" }, 139 { WSDISPLAY_TYPE_SUNFFB, "sunffb" }, 140}; 141 142static struct nameint kbdenc_tab[] = { 143 KB_ENCTAB 144}; 145 146static struct nameint kbdvar_tab[] = { 147 KB_VARTAB 148}; 149 150static struct nameint color_tab[] = { 151 { WSCOL_UNSUPPORTED, "unsupported" }, 152 { WSCOL_BLACK, "black" }, 153 { WSCOL_RED, "red" }, 154 { WSCOL_GREEN, "green" }, 155 { WSCOL_BROWN, "brown" }, 156 { WSCOL_BLUE, "blue" }, 157 { WSCOL_MAGENTA, "magenta" }, 158 { WSCOL_CYAN, "cyan" }, 159 { WSCOL_WHITE, "white" }, 160}; 161 162static struct nameint attr_tab[] = { 163 { WSATTR_NONE, "none" }, 164 { WSATTR_REVERSE, "reverse" }, 165 { WSATTR_HILIT, "hilit" }, 166 { WSATTR_BLINK, "blink" }, 167 { WSATTR_UNDERLINE, "underline" }, 168 { WSATTR_WSCOLORS, "color" }, 169}; 170 171static struct field *field_tab; 172static int field_tab_len; 173 174static const char *int2name(int, int, struct nameint *, int); 175static int name2int(char *, struct nameint *, int); 176static void print_kmap(struct wskbd_map_data *); 177static unsigned int rd_bitfield(const char *); 178static void pr_bitfield(unsigned int); 179 180void 181field_setup(struct field *ftab, int len) 182{ 183 184 field_tab = ftab; 185 field_tab_len = len; 186} 187 188struct field * 189field_by_name(char *name) 190{ 191 int i; 192 193 for (i = 0; i < field_tab_len; i++) 194 if (strcmp(field_tab[i].name, name) == 0) 195 return field_tab + i; 196 197 errx(EXIT_FAILURE, "%s: not found", name); 198} 199 200struct field * 201field_by_value(void *addr) 202{ 203 int i; 204 205 for (i = 0; i < field_tab_len; i++) 206 if (field_tab[i].valp == addr) 207 return field_tab + i; 208 209 errx(EXIT_FAILURE, "internal error: field_by_value: not found"); 210} 211 212void 213field_disable_by_value(void *addr) 214{ 215 struct field *f; 216 217 f = field_by_value(addr); 218 f->flags |= FLG_DISABLED; 219} 220 221static const char * 222int2name(int val, int uflag, struct nameint *tab, int len) 223{ 224 static char tmp[20]; 225 int i; 226 227 for (i = 0; i < len; i++) 228 if (tab[i].value == val) 229 return tab[i].name; 230 231 if (uflag) { 232 (void)snprintf(tmp, sizeof(tmp), "unknown_%d", val); 233 return tmp; 234 } else 235 return NULL; 236} 237 238static int 239name2int(char *val, struct nameint *tab, int len) 240{ 241 int i; 242 243 for (i = 0; i < len; i++) 244 if (strcmp(tab[i].name, val) == 0) 245 return tab[i].value; 246 return -1; 247} 248 249void 250pr_field(struct field *f, const char *sep) 251{ 252 const char *p; 253 unsigned int flags; 254 int first, i, mask; 255 struct wsdisplayio_edid_info *info; 256 struct edid_info edid; 257 258 if (sep) 259 (void)printf("%s%s", f->name, sep); 260 261 switch (f->format) { 262 case FMT_UINT: 263 (void)printf("%u", *((unsigned int *) f->valp)); 264 break; 265 case FMT_INT: 266 (void)printf("%d", *((int *) f->valp)); 267 break; 268 case FMT_STRING: 269 (void)printf("\"%s\"", *((char **) f->valp)); 270 break; 271 case FMT_BITFIELD: 272 pr_bitfield(*((unsigned int *) f->valp)); 273 break; 274 case FMT_KBDTYPE: 275 p = int2name(*((unsigned int *) f->valp), 1, 276 kbtype_tab, TABLEN(kbtype_tab)); 277 (void)printf("%s", p); 278 break; 279 case FMT_MSTYPE: 280 p = int2name(*((unsigned int *) f->valp), 1, 281 mstype_tab, TABLEN(mstype_tab)); 282 (void)printf("%s", p); 283 break; 284 case FMT_DPYTYPE: 285 p = int2name(*((unsigned int *) f->valp), 1, 286 dpytype_tab, TABLEN(dpytype_tab)); 287 (void)printf("%s", p); 288 break; 289 case FMT_KBDENC: 290 p = int2name(KB_ENCODING(*((unsigned int *) f->valp)), 1, 291 kbdenc_tab, TABLEN(kbdenc_tab)); 292 (void)printf("%s", p); 293 294 flags = KB_VARIANT(*((unsigned int *) f->valp)); 295 for (i = 0; i < 32; i++) { 296 if (!(flags & (1 << i))) 297 continue; 298 p = int2name(flags & (1 << i), 1, 299 kbdvar_tab, TABLEN(kbdvar_tab)); 300 (void)printf(".%s", p); 301 } 302 break; 303 case FMT_KBMAP: 304 print_kmap((struct wskbd_map_data *) f->valp); 305 break; 306 case FMT_COLOR: 307 p = int2name(*((unsigned int *) f->valp), 1, 308 color_tab, TABLEN(color_tab)); 309 (void)printf("%s", p); 310 break; 311 case FMT_ATTRS: 312 mask = 0x10; 313 first = 1; 314 while (mask > 0) { 315 if (*((unsigned int *) f->valp) & mask) { 316 p = int2name(*((unsigned int *) f->valp) & mask, 317 1, attr_tab, TABLEN(attr_tab)); 318 (void)printf("%s%s", first ? "" : ",", p); 319 first = 0; 320 } 321 mask >>= 1; 322 } 323 if (first) 324 (void)printf("none"); 325 break; 326 case FMT_EDID: 327 info = (struct wsdisplayio_edid_info *)f->valp; 328 if (edid_parse(info->edid_data, &edid)) 329 (void)printf("invalid"); 330 else { 331 (void)printf("\n"); 332 edid_print(&edid); 333 } 334 break; 335 default: 336 errx(EXIT_FAILURE, "internal error: pr_field: no format %d", 337 f->format); 338 break; 339 } 340 341 (void)printf("\n"); 342} 343 344static void 345pr_bitfield(unsigned int f) 346{ 347 348 if (f == 0) 349 (void)printf("none"); 350 else { 351 unsigned int i; 352 int first, mask; 353 354 for (i = 0, first = 1, mask = 1; i < sizeof(f) * 8; i++) { 355 if (f & mask) { 356 (void)printf("%s%u", first ? "" : " ", i); 357 first = 0; 358 } 359 mask = mask << 1; 360 } 361 } 362} 363 364void 365rd_field(struct field *f, char *val, int merge) 366{ 367 int i; 368 unsigned int u; 369 char *p; 370 struct wscons_keymap *mp; 371 372 switch (f->format) { 373 case FMT_UINT: 374 if (sscanf(val, "%u", &u) != 1) 375 errx(EXIT_FAILURE, "%s: not a number", val); 376 if (merge) 377 *((unsigned int *) f->valp) += u; 378 else 379 *((unsigned int *) f->valp) = u; 380 break; 381 case FMT_INT: 382 if (sscanf(val, "%d", &i) != 1) 383 errx(EXIT_FAILURE, "%s: not a number", val); 384 if (merge) 385 *((int *) f->valp) += i; 386 else 387 *((int *) f->valp) = i; 388 break; 389 case FMT_STRING: 390 if ((*((char **) f->valp) = strdup(val)) == NULL) 391 err(EXIT_FAILURE, "strdup"); 392 break; 393 case FMT_BITFIELD: 394 *((unsigned int *) f->valp) = rd_bitfield(val); 395 break; 396 case FMT_KBDENC: 397 p = strchr(val, '.'); 398 if (p != NULL) 399 *p++ = '\0'; 400 401 i = name2int(val, kbdenc_tab, TABLEN(kbdenc_tab)); 402 if (i == -1) 403 errx(EXIT_FAILURE, "%s: not a valid encoding", val); 404 *((unsigned int *) f->valp) = i; 405 406 while (p) { 407 val = p; 408 p = strchr(p, '.'); 409 if (p != NULL) 410 *p++ = '\0'; 411 i = name2int(val, kbdvar_tab, TABLEN(kbdvar_tab)); 412 if (i == -1) 413 errx(EXIT_FAILURE, "%s: not a valid variant", 414 val); 415 *((unsigned int *) f->valp) |= i; 416 } 417 break; 418 case FMT_KBMAP: 419 if (! merge) 420 kbmap.maplen = 0; 421 map_scan_setinput(val); 422 yyparse(); 423 if (merge) { 424 if (newkbmap.maplen < kbmap.maplen) 425 newkbmap.maplen = kbmap.maplen; 426 for (u = 0; u < kbmap.maplen; u++) { 427 mp = newkbmap.map + u; 428 if (mp->command == KS_voidSymbol && 429 mp->group1[0] == KS_voidSymbol && 430 mp->group1[1] == KS_voidSymbol && 431 mp->group2[0] == KS_voidSymbol && 432 mp->group2[1] == KS_voidSymbol) 433 *mp = kbmap.map[u]; 434 } 435 } 436 kbmap.maplen = newkbmap.maplen; 437 memcpy(kbmap.map, newkbmap.map, 438 kbmap.maplen * sizeof(struct wscons_keymap)); 439 break; 440 case FMT_COLOR: 441 i = name2int(val, color_tab, TABLEN(color_tab)); 442 if (i == -1) 443 errx(EXIT_FAILURE, "%s: not a valid color", val); 444 *((unsigned int *) f->valp) = i; 445 break; 446 case FMT_ATTRS: 447 p = val; 448 while (p) { 449 val = p; 450 p = strchr(p, ','); 451 if (p != NULL) 452 *p++ = '\0'; 453 i = name2int(val, attr_tab, TABLEN(attr_tab)); 454 if (i == -1) 455 errx(EXIT_FAILURE, "%s: not a valid attribute", 456 val); 457 *((unsigned int *) f->valp) |= i; 458 } 459 break; 460 default: 461 errx(EXIT_FAILURE, "internal error: rd_field: no format %d", 462 f->format); 463 break; 464 } 465} 466 467static unsigned int 468rd_bitfield(const char *str) 469{ 470 const char *ptr; 471 char *ep; 472 long lval; 473 unsigned int result; 474 475 ep = NULL; 476 ptr = str; 477 result = 0; 478 while (*ptr != '\0') { 479 errno = 0; 480 lval = strtol(ptr, &ep, 10); 481 if (*ep != '\0' && *ep != ' ') 482 errx(EXIT_FAILURE, "%s: not a valid number list", str); 483 if (errno == ERANGE && (lval == LONG_MAX || lval == LONG_MIN)) 484 errx(EXIT_FAILURE, "%s: not a valid number list", str); 485 if (lval >= (long)sizeof(result) * 8) 486 errx(EXIT_FAILURE, "%ld: number out of range", lval); 487 result |= (1 << lval); 488 489 ptr = ep; 490 while (*ptr == ' ') 491 ptr++; 492 } 493 494 return result; 495} 496 497static void 498print_kmap(struct wskbd_map_data *map) 499{ 500 unsigned int i; 501 struct wscons_keymap *mp; 502 503 for (i = 0; i < map->maplen; i++) { 504 mp = map->map + i; 505 506 if (mp->command == KS_voidSymbol && 507 mp->group1[0] == KS_voidSymbol && 508 mp->group1[1] == KS_voidSymbol && 509 mp->group2[0] == KS_voidSymbol && 510 mp->group2[1] == KS_voidSymbol) 511 continue; 512 (void)printf("\n"); 513 (void)printf("keycode %u =", i); 514 if (mp->command != KS_voidSymbol) 515 (void)printf(" %s", ksym2name(mp->command)); 516 (void)printf(" %s", ksym2name(mp->group1[0])); 517 if (mp->group1[0] != mp->group1[1] || 518 mp->group1[0] != mp->group2[0] || 519 mp->group1[0] != mp->group2[1]) { 520 (void)printf(" %s", ksym2name(mp->group1[1])); 521 if (mp->group1[0] != mp->group2[0] || 522 mp->group1[1] != mp->group2[1]) { 523 (void)printf(" %s", ksym2name(mp->group2[0])); 524 (void)printf(" %s", ksym2name(mp->group2[1])); 525 } 526 } 527 } 528} 529 530