1 /*-
2 * Copyright (c) 2009 The FreeBSD Foundation
3 * All rights reserved.
4 *
5 * This software was developed by Ed Schouten under sponsorship from the
6 * FreeBSD Foundation.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32
33 #include <sys/param.h>
34 #include <sys/cons.h>
35 #include <sys/consio.h>
36 #include <sys/kernel.h>
37 #include <sys/lock.h>
38 #include <sys/malloc.h>
39 #include <sys/mutex.h>
40 #include <sys/systm.h>
41 #include <sys/terminal.h>
42 #include <sys/tty.h>
43
44 #include <machine/stdarg.h>
45
46 static MALLOC_DEFINE(M_TERMINAL, "terminal", "terminal device");
47
48 /*
49 * Locking.
50 *
51 * Normally we don't need to lock down the terminal emulator, because
52 * the TTY lock is already held when calling teken_input().
53 * Unfortunately this is not the case when the terminal acts as a
54 * console device, because cnputc() can be called at the same time.
55 * This means terminals may need to be locked down using a spin lock.
56 */
57 #define TERMINAL_LOCK(tm) do { \
58 if ((tm)->tm_flags & TF_CONS) \
59 mtx_lock_spin(&(tm)->tm_mtx); \
60 else if ((tm)->tm_tty != NULL) \
61 tty_lock((tm)->tm_tty); \
62 } while (0)
63 #define TERMINAL_UNLOCK(tm) do { \
64 if ((tm)->tm_flags & TF_CONS) \
65 mtx_unlock_spin(&(tm)->tm_mtx); \
66 else if ((tm)->tm_tty != NULL) \
67 tty_unlock((tm)->tm_tty); \
68 } while (0)
69 #define TERMINAL_LOCK_TTY(tm) do { \
70 if ((tm)->tm_flags & TF_CONS) \
71 mtx_lock_spin(&(tm)->tm_mtx); \
72 } while (0)
73 #define TERMINAL_UNLOCK_TTY(tm) do { \
74 if ((tm)->tm_flags & TF_CONS) \
75 mtx_unlock_spin(&(tm)->tm_mtx); \
76 } while (0)
77 #define TERMINAL_LOCK_CONS(tm) mtx_lock_spin(&(tm)->tm_mtx)
78 #define TERMINAL_UNLOCK_CONS(tm) mtx_unlock_spin(&(tm)->tm_mtx)
79
80 /*
81 * TTY routines.
82 */
83
84 static tsw_open_t termtty_open;
85 static tsw_close_t termtty_close;
86 static tsw_outwakeup_t termtty_outwakeup;
87 static tsw_ioctl_t termtty_ioctl;
88 static tsw_mmap_t termtty_mmap;
89
90 static struct ttydevsw terminal_tty_class = {
91 .tsw_open = termtty_open,
92 .tsw_close = termtty_close,
93 .tsw_outwakeup = termtty_outwakeup,
94 .tsw_ioctl = termtty_ioctl,
95 .tsw_mmap = termtty_mmap,
96 };
97
98 /*
99 * Terminal emulator routines.
100 */
101
102 static tf_bell_t termteken_bell;
103 static tf_cursor_t termteken_cursor;
104 static tf_putchar_t termteken_putchar;
105 static tf_fill_t termteken_fill;
106 static tf_copy_t termteken_copy;
107 static tf_param_t termteken_param;
108 static tf_respond_t termteken_respond;
109
110 static teken_funcs_t terminal_drawmethods = {
111 .tf_bell = termteken_bell,
112 .tf_cursor = termteken_cursor,
113 .tf_putchar = termteken_putchar,
114 .tf_fill = termteken_fill,
115 .tf_copy = termteken_copy,
116 .tf_param = termteken_param,
117 .tf_respond = termteken_respond,
118 };
119
120 /* Kernel message formatting. */
121 static const teken_attr_t kernel_message = {
122 .ta_fgcolor = TC_WHITE,
123 .ta_bgcolor = TC_BLACK,
124 .ta_format = TF_BOLD,
125 };
126
127 static const teken_attr_t default_message = {
128 .ta_fgcolor = TC_WHITE,
129 .ta_bgcolor = TC_BLACK,
130 };
131
132 #define TCHAR_CREATE(c, a) ((c) | \
133 (a)->ta_format << 21 | \
134 teken_256to8((a)->ta_fgcolor) << 26 | \
135 teken_256to8((a)->ta_bgcolor) << 29)
136
137 static void
138 terminal_init(struct terminal *tm)
139 {
140
141 if (tm->tm_flags & TF_CONS)
142 mtx_init(&tm->tm_mtx, "trmlck", NULL, MTX_SPIN);
143 teken_init(&tm->tm_emulator, &terminal_drawmethods, tm);
144 teken_set_defattr(&tm->tm_emulator, &default_message);
145 }
146
147 struct terminal *
148 terminal_alloc(const struct terminal_class *tc, void *softc)
149 {
150 struct terminal *tm;
151
152 tm = malloc(sizeof(struct terminal), M_TERMINAL, M_WAITOK|M_ZERO);
153 terminal_init(tm);
154
155 tm->tm_class = tc;
156 tm->tm_softc = softc;
157
158 return (tm);
159 }
160
161 static void
162 terminal_sync_ttysize(struct terminal *tm)
163 {
164 struct tty *tp;
165
166 tp = tm->tm_tty;
167 if (tp == NULL)
168 return;
169
170 tty_lock(tp);
171 tty_set_winsize(tp, &tm->tm_winsize);
172 tty_unlock(tp);
173 }
174
175 void
176 terminal_maketty(struct terminal *tm, const char *fmt, ...)
177 {
178 struct tty *tp;
179 char name[8];
180 va_list ap;
181
182 va_start(ap, fmt);
183 vsnrprintf(name, sizeof name, 32, fmt, ap);
184 va_end(ap);
185
186 tp = tty_alloc(&terminal_tty_class, tm);
187 tty_makedev(tp, NULL, "%s", name);
188 tm->tm_tty = tp;
189 terminal_sync_ttysize(tm);
190 }
191
192 void
193 terminal_set_winsize_blank(struct terminal *tm, const struct winsize *size,
194 int blank)
195 {
196 term_rect_t r;
197
198 tm->tm_winsize = *size;
199
200 r.tr_begin.tp_row = r.tr_begin.tp_col = 0;
201 r.tr_end.tp_row = size->ws_row;
202 r.tr_end.tp_col = size->ws_col;
203
204 TERMINAL_LOCK(tm);
205 if (blank == 0)
206 teken_set_winsize_noreset(&tm->tm_emulator, &r.tr_end);
207 else
208 teken_set_winsize(&tm->tm_emulator, &r.tr_end);
209 TERMINAL_UNLOCK(tm);
210
211 if ((blank != 0) && !(tm->tm_flags & TF_MUTE))
212 tm->tm_class->tc_fill(tm, &r, TCHAR_CREATE((teken_char_t)' ',
213 &default_message));
214
215 terminal_sync_ttysize(tm);
216 }
217
218 void
219 terminal_set_winsize(struct terminal *tm, const struct winsize *size)
220 {
221
222 terminal_set_winsize_blank(tm, size, 1);
223 }
224
225 /*
226 * XXX: This function is a kludge. Drivers like vt(4) need to
227 * temporarily stop input when resizing, etc. This should ideally be
228 * handled within the driver.
229 */
230
231 void
232 terminal_mute(struct terminal *tm, int yes)
233 {
234
235 TERMINAL_LOCK(tm);
236 if (yes)
237 tm->tm_flags |= TF_MUTE;
238 else
239 tm->tm_flags &= ~TF_MUTE;
240 TERMINAL_UNLOCK(tm);
241 }
242
243 void
244 terminal_input_char(struct terminal *tm, term_char_t c)
245 {
246 struct tty *tp;
247
248 tp = tm->tm_tty;
249 if (tp == NULL)
250 return;
251
252 /*
253 * Strip off any attributes. Also ignore input of second part of
254 * CJK fullwidth characters, as we don't want to return these
255 * characters twice.
256 */
257 if (TCHAR_FORMAT(c) & TF_CJK_RIGHT)
258 return;
259 c = TCHAR_CHARACTER(c);
260
261 tty_lock(tp);
262 /*
263 * Conversion to UTF-8.
264 */
265 if (c < 0x80) {
266 ttydisc_rint(tp, c, 0);
267 } else if (c < 0x800) {
268 char str[2] = {
269 0xc0 | (c >> 6),
270 0x80 | (c & 0x3f)
271 };
272
273 ttydisc_rint_simple(tp, str, sizeof str);
274 } else if (c < 0x10000) {
275 char str[3] = {
276 0xe0 | (c >> 12),
277 0x80 | ((c >> 6) & 0x3f),
278 0x80 | (c & 0x3f)
279 };
280
281 ttydisc_rint_simple(tp, str, sizeof str);
282 } else {
283 char str[4] = {
284 0xf0 | (c >> 18),
285 0x80 | ((c >> 12) & 0x3f),
286 0x80 | ((c >> 6) & 0x3f),
287 0x80 | (c & 0x3f)
288 };
289
290 ttydisc_rint_simple(tp, str, sizeof str);
291 }
292 ttydisc_rint_done(tp);
293 tty_unlock(tp);
294 }
295
296 void
297 terminal_input_raw(struct terminal *tm, char c)
298 {
299 struct tty *tp;
300
301 tp = tm->tm_tty;
302 if (tp == NULL)
303 return;
304
305 tty_lock(tp);
306 ttydisc_rint(tp, c, 0);
307 ttydisc_rint_done(tp);
308 tty_unlock(tp);
309 }
310
311 void
312 terminal_input_special(struct terminal *tm, unsigned int k)
313 {
314 struct tty *tp;
315 const char *str;
316
317 tp = tm->tm_tty;
318 if (tp == NULL)
319 return;
320
321 str = teken_get_sequence(&tm->tm_emulator, k);
322 if (str == NULL)
323 return;
324
325 tty_lock(tp);
326 ttydisc_rint_simple(tp, str, strlen(str));
327 ttydisc_rint_done(tp);
328 tty_unlock(tp);
329 }
330
331 /*
332 * Binding with the TTY layer.
333 */
334
335 static int
336 termtty_open(struct tty *tp)
337 {
338 struct terminal *tm = tty_softc(tp);
339
340 tm->tm_class->tc_opened(tm, 1);
341 return (0);
342 }
343
344 static void
345 termtty_close(struct tty *tp)
346 {
347 struct terminal *tm = tty_softc(tp);
348
349 tm->tm_class->tc_opened(tm, 0);
350 }
351
352 static void
353 termtty_outwakeup(struct tty *tp)
354 {
355 struct terminal *tm = tty_softc(tp);
356 char obuf[128];
357 size_t olen;
358 unsigned int flags = 0;
359
360 while ((olen = ttydisc_getc(tp, obuf, sizeof obuf)) > 0) {
361 TERMINAL_LOCK_TTY(tm);
362 if (!(tm->tm_flags & TF_MUTE)) {
363 tm->tm_flags &= ~TF_BELL;
364 teken_input(&tm->tm_emulator, obuf, olen);
365 flags |= tm->tm_flags;
366 }
367 TERMINAL_UNLOCK_TTY(tm);
368 }
369
370 tm->tm_class->tc_done(tm);
371 if (flags & TF_BELL)
372 tm->tm_class->tc_bell(tm);
373 }
374
375 static int
376 termtty_ioctl(struct tty *tp, u_long cmd, caddr_t data, struct thread *td)
377 {
378 struct terminal *tm = tty_softc(tp);
379 int error;
380
381 switch (cmd) {
382 case CONS_GETINFO: {
383 vid_info_t *vi = (vid_info_t *)data;
384 const teken_pos_t *p;
385 int fg, bg;
386
387 if (vi->size != sizeof(vid_info_t))
388 return (EINVAL);
389
390 /* Already help the console driver by filling in some data. */
391 p = teken_get_cursor(&tm->tm_emulator);
392 vi->mv_row = p->tp_row;
393 vi->mv_col = p->tp_col;
394
395 p = teken_get_winsize(&tm->tm_emulator);
396 vi->mv_rsz = p->tp_row;
397 vi->mv_csz = p->tp_col;
398
399 teken_get_defattr_cons25(&tm->tm_emulator, &fg, &bg);
400 vi->mv_norm.fore = fg;
401 vi->mv_norm.back = bg;
402 /* XXX: keep vidcontrol happy; bold backgrounds. */
403 vi->mv_rev.fore = bg;
404 vi->mv_rev.back = fg & 0x7;
405 break;
406 }
407 }
408
409 /*
410 * Unlike various other drivers, this driver will never
411 * deallocate TTYs. This means it's safe to temporarily unlock
412 * the TTY when handling ioctls.
413 */
414 tty_unlock(tp);
415 error = tm->tm_class->tc_ioctl(tm, cmd, data, td);
416 tty_lock(tp);
417 return (error);
418 }
419
420 static int
421 termtty_mmap(struct tty *tp, vm_ooffset_t offset, vm_paddr_t * paddr,
422 int nprot, vm_memattr_t *memattr)
423 {
424 struct terminal *tm = tty_softc(tp);
425
426 return (tm->tm_class->tc_mmap(tm, offset, paddr, nprot, memattr));
427 }
428
429 /*
430 * Binding with the kernel and debug console.
431 */
432
433 static cn_probe_t termcn_cnprobe;
434 static cn_init_t termcn_cninit;
435 static cn_term_t termcn_cnterm;
436 static cn_getc_t termcn_cngetc;
437 static cn_putc_t termcn_cnputc;
438 static cn_grab_t termcn_cngrab;
439 static cn_ungrab_t termcn_cnungrab;
440
441 const struct consdev_ops termcn_cnops = {
442 .cn_probe = termcn_cnprobe,
443 .cn_init = termcn_cninit,
444 .cn_term = termcn_cnterm,
445 .cn_getc = termcn_cngetc,
446 .cn_putc = termcn_cnputc,
447 .cn_grab = termcn_cngrab,
448 .cn_ungrab = termcn_cnungrab,
449 };
450
451 void
452 termcn_cnregister(struct terminal *tm)
453 {
454 struct consdev *cp;
455
456 cp = tm->consdev;
457 if (cp == NULL) {
458 cp = malloc(sizeof(struct consdev), M_TERMINAL,
459 M_WAITOK|M_ZERO);
460 cp->cn_ops = &termcn_cnops;
461 cp->cn_arg = tm;
462 cp->cn_pri = CN_INTERNAL;
463 sprintf(cp->cn_name, "ttyv0");
464
465 tm->tm_flags = TF_CONS;
466 tm->consdev = cp;
467
468 terminal_init(tm);
469 }
470
471 /* Attach terminal as console. */
472 cnadd(cp);
473 }
474
475 static void
476 termcn_cngrab(struct consdev *cp)
477 {
478
479 }
480
481 static void
482 termcn_cnungrab(struct consdev *cp)
483 {
484
485 }
486
487 static void
488 termcn_cnprobe(struct consdev *cp)
489 {
490 struct terminal *tm = cp->cn_arg;
491
492 if (tm == NULL) {
493 cp->cn_pri = CN_DEAD;
494 return;
495 }
496
497 tm->consdev = cp;
498 terminal_init(tm);
499
500 tm->tm_class->tc_cnprobe(tm, cp);
501 }
502
503 static void
504 termcn_cninit(struct consdev *cp)
505 {
506
507 }
508
509 static void
510 termcn_cnterm(struct consdev *cp)
511 {
512
513 }
514
515 static int
516 termcn_cngetc(struct consdev *cp)
517 {
518 struct terminal *tm = cp->cn_arg;
519
520 return (tm->tm_class->tc_cngetc(tm));
521 }
522
523 static void
524 termcn_cnputc(struct consdev *cp, int c)
525 {
526 struct terminal *tm = cp->cn_arg;
527 teken_attr_t backup;
528 char cv = c;
529
530 TERMINAL_LOCK_CONS(tm);
531 if (!(tm->tm_flags & TF_MUTE)) {
532 backup = *teken_get_curattr(&tm->tm_emulator);
533 teken_set_curattr(&tm->tm_emulator, &kernel_message);
534 teken_input(&tm->tm_emulator, &cv, 1);
535 teken_set_curattr(&tm->tm_emulator, &backup);
536 }
537 TERMINAL_UNLOCK_CONS(tm);
538
539 tm->tm_class->tc_done(tm);
540 }
541
542 /*
543 * Binding with the terminal emulator.
544 */
545
546 static void
547 termteken_bell(void *softc)
548 {
549 struct terminal *tm = softc;
550
551 tm->tm_flags |= TF_BELL;
552 }
553
554 static void
555 termteken_cursor(void *softc, const teken_pos_t *p)
556 {
557 struct terminal *tm = softc;
558
559 tm->tm_class->tc_cursor(tm, p);
560 }
561
562 static void
563 termteken_putchar(void *softc, const teken_pos_t *p, teken_char_t c,
564 const teken_attr_t *a)
565 {
566 struct terminal *tm = softc;
567
568 tm->tm_class->tc_putchar(tm, p, TCHAR_CREATE(c, a));
569 }
570
571 static void
572 termteken_fill(void *softc, const teken_rect_t *r, teken_char_t c,
573 const teken_attr_t *a)
574 {
575 struct terminal *tm = softc;
576
577 tm->tm_class->tc_fill(tm, r, TCHAR_CREATE(c, a));
578 }
579
580 static void
581 termteken_copy(void *softc, const teken_rect_t *r, const teken_pos_t *p)
582 {
583 struct terminal *tm = softc;
584
585 tm->tm_class->tc_copy(tm, r, p);
586 }
587
588 static void
589 termteken_param(void *softc, int cmd, unsigned int arg)
590 {
591 struct terminal *tm = softc;
592
593 tm->tm_class->tc_param(tm, cmd, arg);
594 }
595
596 static void
597 termteken_respond(void *softc, const void *buf, size_t len)
598 {
599 #if 0
600 struct terminal *tm = softc;
601 struct tty *tp;
602
603 /*
604 * Only inject a response into the TTY if the data actually
605 * originated from the TTY.
606 *
607 * XXX: This cannot be done right now. The TTY could pick up
608 * other locks. It could also in theory cause loops, when the
609 * TTY performs echoing of a command that generates even more
610 * input.
611 */
612 tp = tm->tm_tty;
613 if (tp == NULL)
614 return;
615
616 ttydisc_rint_simple(tp, buf, len);
617 ttydisc_rint_done(tp);
618 #endif
619 }
Cache object: 96237167f9bb6f1d4f09c4ecb9d8d83e
|