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