Commit | Line | Data |
---|---|---|
984263bc MD |
1 | /*- |
2 | * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp> | |
f6e8a0a1 | 3 | * Copyright (c) 1992-1998 Søren Schmidt |
984263bc MD |
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> | |
6bc31f17 | 36 | #include <sys/thread2.h> |
984263bc MD |
37 | |
38 | #include <machine/pc/display.h> | |
39 | ||
1f2de5d4 MD |
40 | #include "syscons.h" |
41 | #include "sctermvar.h" | |
984263bc MD |
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 | |
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 | |
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 | |
173 | scterm_scan_esc(scr_stat *scp, term_stat *tcp, u_char c) | |
174 | { | |
175 | static u_char ansi_col[16] = { | |
984263bc MD |
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 | |
984263bc MD |
180 | }; |
181 | sc_softc_t *sc; | |
182 | int i, n; | |
183 | ||
984263bc MD |
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; | |
122df98f | 211 | #if 0 /* notyet */ |
984263bc MD |
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 */ | |
6bc31f17 | 554 | crit_enter(); |
984263bc MD |
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) { | |
219917ca | 567 | sc->cursor_base = scp->font_height |
984263bc MD |
568 | - (tcp->param[1] & 0x1F) - 1; |
569 | sc->cursor_height = (tcp->param[1] & 0x1F) | |
570 | - (tcp->param[0] & 0x1F) + 1; | |
219917ca SW |
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 | } | |
984263bc MD |
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 | } | |
6bc31f17 | 592 | crit_exit(); |
984263bc MD |
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 | } | |
122df98f | 627 | #if 0 /* notyet */ |
984263bc MD |
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 | |
644 | scterm_puts(scr_stat *scp, u_char *buf, int len) | |
645 | { | |
646 | term_stat *tcp; | |
647 | ||
648 | tcp = scp->ts; | |
649 | outloop: | |
539fbd92 | 650 | atomic_add_char(&scp->sc->write_in_progress, 1); |
984263bc MD |
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 | ||
539fbd92 | 672 | atomic_add_char(&scp->sc->write_in_progress, -1); |
984263bc MD |
673 | if (len) |
674 | goto outloop; | |
675 | } | |
676 | ||
677 | static int | |
678 | scterm_ioctl(scr_stat *scp, struct tty *tp, u_long cmd, caddr_t data, | |
fef8985e | 679 | int flag) |
984263bc MD |
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 | |
706 | scterm_reset(scr_stat *scp, int code) | |
707 | { | |
708 | /* FIXME */ | |
709 | return 0; | |
710 | } | |
711 | ||
712 | static void | |
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 | |
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 | |
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 | |
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 | |
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 */ |