sys/dev/misc/syscons/scterm-sc.c

   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 */