1 /*- 2 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp> 3 * Copyright (c) 1992-1998 S�ren Schmidt 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer as 11 * the first lines of this file unmodified. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR 17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, 20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26 * 27 * $FreeBSD$ 28 */ 29 30 #include "opt_syscons.h" 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/kernel.h> 35 #include <sys/consio.h> 36 37 #include <machine/pc/display.h> 38 39 #include <dev/syscons/syscons.h> 40 #include <dev/syscons/sctermvar.h> 41 42 #ifndef SC_DUMB_TERMINAL 43 44 #define MAX_ESC_PAR 5 45 46 /* attribute flags */ 47 typedef struct { 48 u_short fg; /* foreground color */ 49 u_short bg; /* background color */ 50 } color_t; 51 52 typedef struct { 53 int flags; 54 #define SCTERM_BUSY (1 << 0) 55 int esc; 56 int num_param; 57 int last_param; 58 int param[MAX_ESC_PAR]; 59 int saved_xpos; 60 int saved_ypos; 61 int attr_mask; /* current logical attr mask */ 62 #define NORMAL_ATTR 0x00 63 #define BLINK_ATTR 0x01 64 #define BOLD_ATTR 0x02 65 #define UNDERLINE_ATTR 0x04 66 #define REVERSE_ATTR 0x08 67 #define FG_CHANGED 0x10 68 #define BG_CHANGED 0x20 69 int cur_attr; /* current hardware attr word */ 70 color_t cur_color; /* current hardware color */ 71 color_t std_color; /* normal hardware color */ 72 color_t rev_color; /* reverse hardware color */ 73 color_t dflt_std_color; /* default normal color */ 74 color_t dflt_rev_color; /* default reverse color */ 75 } term_stat; 76 77 static sc_term_init_t scterm_init; 78 static sc_term_term_t scterm_term; 79 static sc_term_puts_t scterm_puts; 80 static sc_term_ioctl_t scterm_ioctl; 81 static sc_term_reset_t scterm_reset; 82 static sc_term_default_attr_t scterm_default_attr; 83 static sc_term_clear_t scterm_clear; 84 static sc_term_notify_t scterm_notify; 85 static sc_term_input_t scterm_input; 86 87 static sc_term_sw_t sc_term_sc = { 88 { NULL, NULL }, 89 "sc", /* emulator name */ 90 "syscons terminal", /* description */ 91 "*", /* matching renderer, any :-) */ 92 sizeof(term_stat), /* softc size */ 93 0, 94 scterm_init, 95 scterm_term, 96 scterm_puts, 97 scterm_ioctl, 98 scterm_reset, 99 scterm_default_attr, 100 scterm_clear, 101 scterm_notify, 102 scterm_input, 103 }; 104 105 SCTERM_MODULE(sc, sc_term_sc); 106 107 static term_stat reserved_term_stat; 108 static void scterm_scan_esc(scr_stat *scp, term_stat *tcp, 109 u_char c); 110 static int mask2attr(term_stat *tcp); 111 112 static int 113 scterm_init(scr_stat *scp, void **softc, int code) 114 { 115 term_stat *tcp; 116 117 if (*softc == NULL) { 118 if (reserved_term_stat.flags & SCTERM_BUSY) 119 return EINVAL; 120 *softc = &reserved_term_stat; 121 } 122 tcp = *softc; 123 124 switch (code) { 125 case SC_TE_COLD_INIT: 126 bzero(tcp, sizeof(*tcp)); 127 tcp->flags = SCTERM_BUSY; 128 tcp->esc = 0; 129 tcp->saved_xpos = -1; 130 tcp->saved_ypos = -1; 131 tcp->attr_mask = NORMAL_ATTR; 132 /* XXX */ 133 tcp->dflt_std_color.fg = SC_NORM_ATTR & 0x0f; 134 tcp->dflt_std_color.bg = (SC_NORM_ATTR >> 4) & 0x0f; 135 tcp->dflt_rev_color.fg = SC_NORM_REV_ATTR & 0x0f; 136 tcp->dflt_rev_color.bg = (SC_NORM_REV_ATTR >> 4) & 0x0f; 137 tcp->std_color = tcp->dflt_std_color; 138 tcp->rev_color = tcp->dflt_rev_color; 139 tcp->cur_color = tcp->std_color; 140 tcp->cur_attr = mask2attr(tcp); 141 ++sc_term_sc.te_refcount; 142 break; 143 144 case SC_TE_WARM_INIT: 145 tcp->esc = 0; 146 tcp->saved_xpos = -1; 147 tcp->saved_ypos = -1; 148 #if 0 149 tcp->std_color = tcp->dflt_std_color; 150 tcp->rev_color = tcp->dflt_rev_color; 151 #endif 152 tcp->cur_color = tcp->std_color; 153 tcp->cur_attr = mask2attr(tcp); 154 break; 155 } 156 157 return 0; 158 } 159 160 static int 161 scterm_term(scr_stat *scp, void **softc) 162 { 163 if (*softc == &reserved_term_stat) { 164 *softc = NULL; 165 bzero(&reserved_term_stat, sizeof(reserved_term_stat)); 166 } 167 --sc_term_sc.te_refcount; 168 return 0; 169 } 170 171 static void 172 scterm_scan_esc(scr_stat *scp, term_stat *tcp, u_char c) 173 { 174 static u_char ansi_col[16] = { 175 FG_BLACK, FG_RED, FG_GREEN, FG_BROWN, 176 FG_BLUE, FG_MAGENTA, FG_CYAN, FG_LIGHTGREY, 177 FG_DARKGREY, FG_LIGHTRED, FG_LIGHTGREEN, FG_YELLOW, 178 FG_LIGHTBLUE, FG_LIGHTMAGENTA, FG_LIGHTCYAN, FG_WHITE 179 }; 180 sc_softc_t *sc; 181 int i, n; 182 183 i = n = 0; 184 sc = scp->sc; 185 if (tcp->esc == 1) { /* seen ESC */ 186 switch (c) { 187 188 case '7': /* Save cursor position */ 189 tcp->saved_xpos = scp->xpos; 190 tcp->saved_ypos = scp->ypos; 191 break; 192 193 case '8': /* Restore saved cursor position */ 194 if (tcp->saved_xpos >= 0 && tcp->saved_ypos >= 0) 195 sc_move_cursor(scp, tcp->saved_xpos, 196 tcp->saved_ypos); 197 break; 198 199 case '[': /* Start ESC [ sequence */ 200 tcp->esc = 2; 201 tcp->last_param = -1; 202 for (i = tcp->num_param; i < MAX_ESC_PAR; i++) 203 tcp->param[i] = 1; 204 tcp->num_param = 0; 205 return; 206 207 case 'M': /* Move cursor up 1 line, scroll if at top */ 208 sc_term_up_scroll(scp, 1, sc->scr_map[0x20], 209 tcp->cur_attr, 0, 0); 210 break; 211 #if notyet 212 case 'Q': 213 tcp->esc = 4; 214 return; 215 #endif 216 case 'c': /* Clear screen & home */ 217 sc_clear_screen(scp); 218 break; 219 220 case '(': /* iso-2022: designate 94 character set to G0 */ 221 tcp->esc = 5; 222 return; 223 } 224 } else if (tcp->esc == 2) { /* seen ESC [ */ 225 if (c >= '0' && c <= '9') { 226 if (tcp->num_param < MAX_ESC_PAR) { 227 if (tcp->last_param != tcp->num_param) { 228 tcp->last_param = tcp->num_param; 229 tcp->param[tcp->num_param] = 0; 230 } else { 231 tcp->param[tcp->num_param] *= 10; 232 } 233 tcp->param[tcp->num_param] += c - '0'; 234 return; 235 } 236 } 237 tcp->num_param = tcp->last_param + 1; 238 switch (c) { 239 240 case ';': 241 if (tcp->num_param < MAX_ESC_PAR) 242 return; 243 break; 244 245 case '=': 246 tcp->esc = 3; 247 tcp->last_param = -1; 248 for (i = tcp->num_param; i < MAX_ESC_PAR; i++) 249 tcp->param[i] = 1; 250 tcp->num_param = 0; 251 return; 252 253 case 'A': /* up n rows */ 254 sc_term_up(scp, tcp->param[0], 0); 255 break; 256 257 case 'B': /* down n rows */ 258 sc_term_down(scp, tcp->param[0], 0); 259 break; 260 261 case 'C': /* right n columns */ 262 sc_term_right(scp, tcp->param[0]); 263 break; 264 265 case 'D': /* left n columns */ 266 sc_term_left(scp, tcp->param[0]); 267 break; 268 269 case 'E': /* cursor to start of line n lines down */ 270 n = tcp->param[0]; 271 if (n < 1) 272 n = 1; 273 sc_move_cursor(scp, 0, scp->ypos + n); 274 break; 275 276 case 'F': /* cursor to start of line n lines up */ 277 n = tcp->param[0]; 278 if (n < 1) 279 n = 1; 280 sc_move_cursor(scp, 0, scp->ypos - n); 281 break; 282 283 case 'f': /* Cursor move */ 284 case 'H': 285 if (tcp->num_param == 0) 286 sc_move_cursor(scp, 0, 0); 287 else if (tcp->num_param == 2) 288 sc_move_cursor(scp, tcp->param[1] - 1, 289 tcp->param[0] - 1); 290 break; 291 292 case 'J': /* Clear all or part of display */ 293 if (tcp->num_param == 0) 294 n = 0; 295 else 296 n = tcp->param[0]; 297 sc_term_clr_eos(scp, n, sc->scr_map[0x20], 298 tcp->cur_attr); 299 break; 300 301 case 'K': /* Clear all or part of line */ 302 if (tcp->num_param == 0) 303 n = 0; 304 else 305 n = tcp->param[0]; 306 sc_term_clr_eol(scp, n, sc->scr_map[0x20], 307 tcp->cur_attr); 308 break; 309 310 case 'L': /* Insert n lines */ 311 sc_term_ins_line(scp, scp->ypos, tcp->param[0], 312 sc->scr_map[0x20], tcp->cur_attr, 0); 313 break; 314 315 case 'M': /* Delete n lines */ 316 sc_term_del_line(scp, scp->ypos, tcp->param[0], 317 sc->scr_map[0x20], tcp->cur_attr, 0); 318 break; 319 320 case 'P': /* Delete n chars */ 321 sc_term_del_char(scp, tcp->param[0], 322 sc->scr_map[0x20], tcp->cur_attr); 323 break; 324 325 case '@': /* Insert n chars */ 326 sc_term_ins_char(scp, tcp->param[0], 327 sc->scr_map[0x20], tcp->cur_attr); 328 break; 329 330 case 'S': /* scroll up n lines */ 331 sc_term_del_line(scp, 0, tcp->param[0], 332 sc->scr_map[0x20], tcp->cur_attr, 0); 333 break; 334 335 case 'T': /* scroll down n lines */ 336 sc_term_ins_line(scp, 0, tcp->param[0], 337 sc->scr_map[0x20], tcp->cur_attr, 0); 338 break; 339 340 case 'X': /* erase n characters in line */ 341 n = tcp->param[0]; 342 if (n < 1) 343 n = 1; 344 if (n > scp->xsize - scp->xpos) 345 n = scp->xsize - scp->xpos; 346 sc_vtb_erase(&scp->vtb, scp->cursor_pos, n, 347 sc->scr_map[0x20], tcp->cur_attr); 348 mark_for_update(scp, scp->cursor_pos); 349 mark_for_update(scp, scp->cursor_pos + n - 1); 350 break; 351 352 case 'Z': /* move n tabs backwards */ 353 sc_term_backtab(scp, tcp->param[0]); 354 break; 355 356 case '`': /* move cursor to column n */ 357 sc_term_col(scp, tcp->param[0]); 358 break; 359 360 case 'a': /* move cursor n columns to the right */ 361 sc_term_right(scp, tcp->param[0]); 362 break; 363 364 case 'd': /* move cursor to row n */ 365 sc_term_row(scp, tcp->param[0]); 366 break; 367 368 case 'e': /* move cursor n rows down */ 369 sc_term_down(scp, tcp->param[0], 0); 370 break; 371 372 case 'm': /* change attribute */ 373 if (tcp->num_param == 0) { 374 tcp->attr_mask = NORMAL_ATTR; 375 tcp->cur_color = tcp->std_color; 376 tcp->cur_attr = mask2attr(tcp); 377 break; 378 } 379 for (i = 0; i < tcp->num_param; i++) { 380 switch (n = tcp->param[i]) { 381 case 0: /* back to normal */ 382 tcp->attr_mask = NORMAL_ATTR; 383 tcp->cur_color = tcp->std_color; 384 tcp->cur_attr = mask2attr(tcp); 385 break; 386 case 1: /* bold */ 387 tcp->attr_mask |= BOLD_ATTR; 388 tcp->cur_attr = mask2attr(tcp); 389 break; 390 case 4: /* underline */ 391 tcp->attr_mask |= UNDERLINE_ATTR; 392 tcp->cur_attr = mask2attr(tcp); 393 break; 394 case 5: /* blink */ 395 tcp->attr_mask |= BLINK_ATTR; 396 tcp->cur_attr = mask2attr(tcp); 397 break; 398 case 7: /* reverse */ 399 tcp->attr_mask |= REVERSE_ATTR; 400 tcp->cur_attr = mask2attr(tcp); 401 break; 402 case 22: /* remove bold (or dim) */ 403 tcp->attr_mask &= ~BOLD_ATTR; 404 tcp->cur_attr = mask2attr(tcp); 405 break; 406 case 24: /* remove underline */ 407 tcp->attr_mask &= ~UNDERLINE_ATTR; 408 tcp->cur_attr = mask2attr(tcp); 409 break; 410 case 25: /* remove blink */ 411 tcp->attr_mask &= ~BLINK_ATTR; 412 tcp->cur_attr = mask2attr(tcp); 413 break; 414 case 27: /* remove reverse */ 415 tcp->attr_mask &= ~REVERSE_ATTR; 416 tcp->cur_attr = mask2attr(tcp); 417 break; 418 case 30: case 31: /* set ansi fg color */ 419 case 32: case 33: case 34: 420 case 35: case 36: case 37: 421 tcp->attr_mask |= FG_CHANGED; 422 tcp->cur_color.fg = ansi_col[n - 30]; 423 tcp->cur_attr = mask2attr(tcp); 424 break; 425 case 39: /* restore fg color back to normal */ 426 tcp->attr_mask &= ~(FG_CHANGED|BOLD_ATTR); 427 tcp->cur_color.fg = tcp->std_color.fg; 428 tcp->cur_attr = mask2attr(tcp); 429 break; 430 case 40: case 41: /* set ansi bg color */ 431 case 42: case 43: case 44: 432 case 45: case 46: case 47: 433 tcp->attr_mask |= BG_CHANGED; 434 tcp->cur_color.bg = ansi_col[n - 40]; 435 tcp->cur_attr = mask2attr(tcp); 436 break; 437 case 49: /* restore bg color back to normal */ 438 tcp->attr_mask &= ~BG_CHANGED; 439 tcp->cur_color.bg = tcp->std_color.bg; 440 tcp->cur_attr = mask2attr(tcp); 441 break; 442 } 443 } 444 break; 445 446 case 's': /* Save cursor position */ 447 tcp->saved_xpos = scp->xpos; 448 tcp->saved_ypos = scp->ypos; 449 break; 450 451 case 'u': /* Restore saved cursor position */ 452 if (tcp->saved_xpos >= 0 && tcp->saved_ypos >= 0) 453 sc_move_cursor(scp, tcp->saved_xpos, 454 tcp->saved_ypos); 455 break; 456 457 case 'x': 458 if (tcp->num_param == 0) 459 n = 0; 460 else 461 n = tcp->param[0]; 462 switch (n) { 463 case 0: /* reset colors and attributes back to normal */ 464 tcp->attr_mask = NORMAL_ATTR; 465 tcp->cur_color = tcp->std_color 466 = tcp->dflt_std_color; 467 tcp->rev_color = tcp->dflt_rev_color; 468 tcp->cur_attr = mask2attr(tcp); 469 break; 470 case 1: /* set ansi background */ 471 tcp->attr_mask &= ~BG_CHANGED; 472 tcp->cur_color.bg = tcp->std_color.bg 473 = ansi_col[tcp->param[1] & 0x0f]; 474 tcp->cur_attr = mask2attr(tcp); 475 break; 476 case 2: /* set ansi foreground */ 477 tcp->attr_mask &= ~FG_CHANGED; 478 tcp->cur_color.fg = tcp->std_color.fg 479 = ansi_col[tcp->param[1] & 0x0f]; 480 tcp->cur_attr = mask2attr(tcp); 481 break; 482 case 3: /* set adapter attribute directly */ 483 tcp->attr_mask &= ~(FG_CHANGED | BG_CHANGED); 484 tcp->cur_color.fg = tcp->std_color.fg 485 = tcp->param[1] & 0x0f; 486 tcp->cur_color.bg = tcp->std_color.bg 487 = (tcp->param[1] >> 4) & 0x0f; 488 tcp->cur_attr = mask2attr(tcp); 489 break; 490 case 5: /* set ansi reverse background */ 491 tcp->rev_color.bg = ansi_col[tcp->param[1] & 0x0f]; 492 tcp->cur_attr = mask2attr(tcp); 493 break; 494 case 6: /* set ansi reverse foreground */ 495 tcp->rev_color.fg = ansi_col[tcp->param[1] & 0x0f]; 496 tcp->cur_attr = mask2attr(tcp); 497 break; 498 case 7: /* set adapter reverse attribute directly */ 499 tcp->rev_color.fg = tcp->param[1] & 0x0f; 500 tcp->rev_color.bg = (tcp->param[1] >> 4) & 0x0f; 501 tcp->cur_attr = mask2attr(tcp); 502 break; 503 } 504 break; 505 506 case 'z': /* switch to (virtual) console n */ 507 if (tcp->num_param == 1) 508 sc_switch_scr(sc, tcp->param[0]); 509 break; 510 } 511 } else if (tcp->esc == 3) { /* seen ESC [0-9]+ = */ 512 if (c >= '0' && c <= '9') { 513 if (tcp->num_param < MAX_ESC_PAR) { 514 if (tcp->last_param != tcp->num_param) { 515 tcp->last_param = tcp->num_param; 516 tcp->param[tcp->num_param] = 0; 517 } else { 518 tcp->param[tcp->num_param] *= 10; 519 } 520 tcp->param[tcp->num_param] += c - '0'; 521 return; 522 } 523 } 524 tcp->num_param = tcp->last_param + 1; 525 switch (c) { 526 527 case ';': 528 if (tcp->num_param < MAX_ESC_PAR) 529 return; 530 break; 531 532 case 'A': /* set display border color */ 533 if (tcp->num_param == 1) { 534 scp->border=tcp->param[0] & 0xff; 535 if (scp == sc->cur_scp) 536 sc_set_border(scp, scp->border); 537 } 538 break; 539 540 case 'B': /* set bell pitch and duration */ 541 if (tcp->num_param == 2) { 542 scp->bell_pitch = tcp->param[0]; 543 scp->bell_duration = tcp->param[1]; 544 } 545 break; 546 547 case 'C': /* set cursor type & shape */ 548 i = spltty(); 549 if (!ISGRAPHSC(sc->cur_scp)) 550 sc_remove_cursor_image(sc->cur_scp); 551 if (tcp->num_param == 1) { 552 if (tcp->param[0] & 0x01) 553 sc->flags |= SC_BLINK_CURSOR; 554 else 555 sc->flags &= ~SC_BLINK_CURSOR; 556 if (tcp->param[0] & 0x02) 557 sc->flags |= SC_CHAR_CURSOR; 558 else 559 sc->flags &= ~SC_CHAR_CURSOR; 560 } else if (tcp->num_param == 2) { 561 sc->cursor_base = scp->font_size 562 - (tcp->param[1] & 0x1F) - 1; 563 sc->cursor_height = (tcp->param[1] & 0x1F) 564 - (tcp->param[0] & 0x1F) + 1; 565 } 566 /* 567 * The cursor shape is global property; 568 * all virtual consoles are affected. 569 * Update the cursor in the current console... 570 */ 571 if (!ISGRAPHSC(sc->cur_scp)) { 572 sc_set_cursor_image(sc->cur_scp); 573 sc_draw_cursor_image(sc->cur_scp); 574 } 575 splx(i); 576 break; 577 578 case 'F': /* set adapter foreground */ 579 if (tcp->num_param == 1) { 580 tcp->attr_mask &= ~FG_CHANGED; 581 tcp->cur_color.fg = tcp->std_color.fg 582 = tcp->param[0] & 0x0f; 583 tcp->cur_attr = mask2attr(tcp); 584 } 585 break; 586 587 case 'G': /* set adapter background */ 588 if (tcp->num_param == 1) { 589 tcp->attr_mask &= ~BG_CHANGED; 590 tcp->cur_color.bg = tcp->std_color.bg 591 = tcp->param[0] & 0x0f; 592 tcp->cur_attr = mask2attr(tcp); 593 } 594 break; 595 596 case 'H': /* set adapter reverse foreground */ 597 if (tcp->num_param == 1) { 598 tcp->rev_color.fg = tcp->param[0] & 0x0f; 599 tcp->cur_attr = mask2attr(tcp); 600 } 601 break; 602 603 case 'I': /* set adapter reverse background */ 604 if (tcp->num_param == 1) { 605 tcp->rev_color.bg = tcp->param[0] & 0x0f; 606 tcp->cur_attr = mask2attr(tcp); 607 } 608 break; 609 } 610 #if notyet 611 } else if (tcp->esc == 4) { /* seen ESC Q */ 612 /* to be filled */ 613 #endif 614 } else if (tcp->esc == 5) { /* seen ESC ( */ 615 switch (c) { 616 case 'B': /* iso-2022: desginate ASCII into G0 */ 617 break; 618 /* other items to be filled */ 619 default: 620 break; 621 } 622 } 623 tcp->esc = 0; 624 } 625 626 static void 627 scterm_puts(scr_stat *scp, u_char *buf, int len) 628 { 629 term_stat *tcp; 630 631 tcp = scp->ts; 632 outloop: 633 scp->sc->write_in_progress++; 634 635 if (tcp->esc) { 636 scterm_scan_esc(scp, tcp, *buf); 637 buf++; 638 len--; 639 } else { 640 switch (*buf) { 641 case 0x1b: 642 tcp->esc = 1; 643 tcp->num_param = 0; 644 buf++; 645 len--; 646 break; 647 default: 648 sc_term_gen_print(scp, &buf, &len, tcp->cur_attr); 649 break; 650 } 651 } 652 653 sc_term_gen_scroll(scp, scp->sc->scr_map[0x20], tcp->cur_attr); 654 655 scp->sc->write_in_progress--; 656 if (len) 657 goto outloop; 658 } 659 660 static int 661 scterm_ioctl(scr_stat *scp, struct tty *tp, u_long cmd, caddr_t data, 662 int flag, struct proc *p) 663 { 664 term_stat *tcp = scp->ts; 665 vid_info_t *vi; 666 667 switch (cmd) { 668 case GIO_ATTR: /* get current attributes */ 669 /* FIXME: */ 670 *(int*)data = (tcp->cur_attr >> 8) & 0xff; 671 return 0; 672 case CONS_GETINFO: /* get current (virtual) console info */ 673 vi = (vid_info_t *)data; 674 if (vi->size != sizeof(struct vid_info)) 675 return EINVAL; 676 vi->mv_norm.fore = tcp->std_color.fg; 677 vi->mv_norm.back = tcp->std_color.bg; 678 vi->mv_rev.fore = tcp->rev_color.fg; 679 vi->mv_rev.back = tcp->rev_color.bg; 680 /* 681 * The other fields are filled by the upper routine. XXX 682 */ 683 return ENOIOCTL; 684 } 685 return ENOIOCTL; 686 } 687 688 static int 689 scterm_reset(scr_stat *scp, int code) 690 { 691 /* FIXME */ 692 return 0; 693 } 694 695 static void 696 scterm_default_attr(scr_stat *scp, int color, int rev_color) 697 { 698 term_stat *tcp = scp->ts; 699 700 tcp->dflt_std_color.fg = color & 0x0f; 701 tcp->dflt_std_color.bg = (color >> 4) & 0x0f; 702 tcp->dflt_rev_color.fg = rev_color & 0x0f; 703 tcp->dflt_rev_color.bg = (rev_color >> 4) & 0x0f; 704 tcp->std_color = tcp->dflt_std_color; 705 tcp->rev_color = tcp->dflt_rev_color; 706 tcp->cur_color = tcp->std_color; 707 tcp->cur_attr = mask2attr(tcp); 708 } 709 710 static void 711 scterm_clear(scr_stat *scp) 712 { 713 term_stat *tcp = scp->ts; 714 715 sc_move_cursor(scp, 0, 0); 716 sc_vtb_clear(&scp->vtb, scp->sc->scr_map[0x20], tcp->cur_attr); 717 mark_all(scp); 718 } 719 720 static void 721 scterm_notify(scr_stat *scp, int event) 722 { 723 switch (event) { 724 case SC_TE_NOTIFY_VTSWITCH_IN: 725 break; 726 case SC_TE_NOTIFY_VTSWITCH_OUT: 727 break; 728 } 729 } 730 731 static int 732 scterm_input(scr_stat *scp, int c, struct tty *tp) 733 { 734 return FALSE; 735 } 736 737 /* 738 * Calculate hardware attributes word using logical attributes mask and 739 * hardware colors 740 */ 741 742 /* FIXME */ 743 static int 744 mask2attr(term_stat *tcp) 745 { 746 int attr, mask = tcp->attr_mask; 747 748 if (mask & REVERSE_ATTR) { 749 attr = ((mask & FG_CHANGED) ? 750 tcp->cur_color.bg : tcp->rev_color.fg) | 751 (((mask & BG_CHANGED) ? 752 tcp->cur_color.fg : tcp->rev_color.bg) << 4); 753 } else 754 attr = tcp->cur_color.fg | (tcp->cur_color.bg << 4); 755 756 /* XXX: underline mapping for Hercules adapter can be better */ 757 if (mask & (BOLD_ATTR | UNDERLINE_ATTR)) 758 attr ^= 0x08; 759 if (mask & BLINK_ATTR) 760 attr ^= 0x80; 761 762 return (attr << 8); 763 } 764 765 #endif /* SC_DUMB_TERMINAL */ 766