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