xref: /freebsd/sys/dev/vt/vt_core.c (revision 864c53ead899f7838cd2e1cca3b485a4a82f5cdc)
1 /*-
2  * Copyright (c) 2009, 2013 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  * Portions of this software were developed by Oleksandr Rybalko
9  * under sponsorship from the FreeBSD Foundation.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions and the following disclaimer.
16  * 2. Redistributions in binary form must reproduce the above copyright
17  *    notice, this list of conditions and the following disclaimer in the
18  *    documentation and/or other materials provided with the distribution.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30  * SUCH DAMAGE.
31  */
32 
33 #include <sys/cdefs.h>
34 __FBSDID("$FreeBSD$");
35 
36 #include "opt_compat.h"
37 
38 #include <sys/param.h>
39 #include <sys/consio.h>
40 #include <sys/eventhandler.h>
41 #include <sys/fbio.h>
42 #include <sys/kbio.h>
43 #include <sys/kdb.h>
44 #include <sys/kernel.h>
45 #include <sys/lock.h>
46 #include <sys/malloc.h>
47 #include <sys/mutex.h>
48 #include <sys/priv.h>
49 #include <sys/proc.h>
50 #include <sys/reboot.h>
51 #include <sys/systm.h>
52 #include <sys/terminal.h>
53 
54 #include <dev/kbd/kbdreg.h>
55 #include <dev/vt/vt.h>
56 
57 #if defined(__i386__) || defined(__amd64__)
58 #include <machine/psl.h>
59 #include <machine/frame.h>
60 #endif
61 
62 static tc_bell_t	vtterm_bell;
63 static tc_cursor_t	vtterm_cursor;
64 static tc_putchar_t	vtterm_putchar;
65 static tc_fill_t	vtterm_fill;
66 static tc_copy_t	vtterm_copy;
67 static tc_param_t	vtterm_param;
68 static tc_done_t	vtterm_done;
69 
70 static tc_cnprobe_t	vtterm_cnprobe;
71 static tc_cngetc_t	vtterm_cngetc;
72 
73 static tc_opened_t	vtterm_opened;
74 static tc_ioctl_t	vtterm_ioctl;
75 static tc_mmap_t	vtterm_mmap;
76 
77 const struct terminal_class vt_termclass = {
78 	.tc_bell	= vtterm_bell,
79 	.tc_cursor	= vtterm_cursor,
80 	.tc_putchar	= vtterm_putchar,
81 	.tc_fill	= vtterm_fill,
82 	.tc_copy	= vtterm_copy,
83 	.tc_param	= vtterm_param,
84 	.tc_done	= vtterm_done,
85 
86 	.tc_cnprobe	= vtterm_cnprobe,
87 	.tc_cngetc	= vtterm_cngetc,
88 
89 	.tc_opened	= vtterm_opened,
90 	.tc_ioctl	= vtterm_ioctl,
91 	.tc_mmap	= vtterm_mmap,
92 };
93 
94 /*
95  * Use a constant timer of 25 Hz to redraw the screen.
96  *
97  * XXX: In theory we should only fire up the timer when there is really
98  * activity. Unfortunately we cannot always start timers. We really
99  * don't want to process kernel messages synchronously, because it
100  * really slows down the system.
101  */
102 #define	VT_TIMERFREQ	25
103 
104 /* Bell pitch/duration. */
105 #define VT_BELLDURATION	((5 * hz + 99) / 100)
106 #define VT_BELLPITCH	800
107 
108 #define	VT_LOCK(vd)	mtx_lock(&(vd)->vd_lock)
109 #define	VT_UNLOCK(vd)	mtx_unlock(&(vd)->vd_lock)
110 
111 #define	VT_UNIT(vw)	((vw)->vw_device->vd_unit * VT_MAXWINDOWS + \
112 			(vw)->vw_number)
113 
114 /* XXX while syscons is here. */
115 int sc_txtmouse_no_retrace_wait;
116 
117 static SYSCTL_NODE(_kern, OID_AUTO, vt, CTLFLAG_RD, 0, "vt(9) parameters");
118 VT_SYSCTL_INT(enable_altgr, 1, "Enable AltGr key (Do not assume R.Alt as Alt)");
119 VT_SYSCTL_INT(debug, 0, "vt(9) debug level");
120 VT_SYSCTL_INT(deadtimer, 15, "Time to wait busy process in VT_PROCESS mode");
121 VT_SYSCTL_INT(suspendswitch, 1, "Switch to VT0 before suspend");
122 
123 static struct vt_device	vt_consdev;
124 static unsigned int vt_unit = 0;
125 static MALLOC_DEFINE(M_VT, "vt", "vt device");
126 struct vt_device *main_vd = &vt_consdev;
127 
128 /* Boot logo. */
129 extern unsigned int vt_logo_width;
130 extern unsigned int vt_logo_height;
131 extern unsigned int vt_logo_depth;
132 extern unsigned char vt_logo_image[];
133 
134 /* Font. */
135 extern struct vt_font vt_font_default;
136 #ifndef SC_NO_CUTPASTE
137 extern struct mouse_cursor vt_default_mouse_pointer;
138 #endif
139 
140 static int signal_vt_rel(struct vt_window *);
141 static int signal_vt_acq(struct vt_window *);
142 static int finish_vt_rel(struct vt_window *, int, int *);
143 static int finish_vt_acq(struct vt_window *);
144 static int vt_window_switch(struct vt_window *);
145 static int vt_late_window_switch(struct vt_window *);
146 static int vt_proc_alive(struct vt_window *);
147 static void vt_resize(struct vt_device *);
148 static void vt_update_static(void *);
149 
150 SET_DECLARE(vt_drv_set, struct vt_driver);
151 
152 #define _VTDEFH MAX(100, PIXEL_HEIGHT(VT_FB_DEFAULT_HEIGHT))
153 #define _VTDEFW MAX(200, PIXEL_WIDTH(VT_FB_DEFAULT_WIDTH))
154 
155 static struct terminal	vt_consterm;
156 static struct vt_window	vt_conswindow;
157 static struct vt_device	vt_consdev = {
158 	.vd_driver = NULL,
159 	.vd_softc = NULL,
160 	.vd_flags = VDF_INVALID,
161 	.vd_windows = { [VT_CONSWINDOW] =  &vt_conswindow, },
162 	.vd_curwindow = &vt_conswindow,
163 	.vd_markedwin = NULL,
164 	.vd_kbstate = 0,
165 };
166 static term_char_t vt_constextbuf[(_VTDEFW) * (VBF_DEFAULT_HISTORY_SIZE)];
167 static term_char_t *vt_constextbufrows[VBF_DEFAULT_HISTORY_SIZE];
168 static struct vt_window	vt_conswindow = {
169 	.vw_number = VT_CONSWINDOW,
170 	.vw_flags = VWF_CONSOLE,
171 	.vw_buf = {
172 		.vb_buffer = vt_constextbuf,
173 		.vb_rows = vt_constextbufrows,
174 		.vb_history_size = VBF_DEFAULT_HISTORY_SIZE,
175 		.vb_curroffset = 0,
176 		.vb_roffset = 0,
177 		.vb_flags = VBF_STATIC,
178 		.vb_mark_start = {.tp_row = 0, .tp_col = 0,},
179 		.vb_mark_end = {.tp_row = 0, .tp_col = 0,},
180 		.vb_scr_size = {
181 			.tp_row = _VTDEFH,
182 			.tp_col = _VTDEFW,
183 		},
184 	},
185 	.vw_device = &vt_consdev,
186 	.vw_terminal = &vt_consterm,
187 	.vw_kbdmode = K_XLATE,
188 };
189 static struct terminal vt_consterm = {
190 	.tm_class = &vt_termclass,
191 	.tm_softc = &vt_conswindow,
192 	.tm_flags = TF_CONS,
193 };
194 static struct consdev vt_consterm_consdev = {
195 	.cn_ops = &termcn_cnops,
196 	.cn_arg = &vt_consterm,
197 	.cn_name = "ttyv0",
198 };
199 
200 /* Add to set of consoles. */
201 DATA_SET(cons_set, vt_consterm_consdev);
202 
203 /*
204  * Right after kmem is done to allow early drivers to use locking and allocate
205  * memory.
206  */
207 SYSINIT(vt_update_static, SI_SUB_KMEM, SI_ORDER_ANY, vt_update_static,
208     &vt_consdev);
209 /* Delay until all devices attached, to not waste time. */
210 SYSINIT(vt_early_cons, SI_SUB_INT_CONFIG_HOOKS, SI_ORDER_ANY, vt_upgrade,
211     &vt_consdev);
212 
213 /* Initialize locks/mem depended members. */
214 static void
215 vt_update_static(void *dummy)
216 {
217 
218 	if (main_vd->vd_driver != NULL)
219 		printf("VT: running with driver \"%s\".\n",
220 		    main_vd->vd_driver->vd_name);
221 	else
222 		printf("VT: init without driver.\n");
223 
224 	mtx_init(&main_vd->vd_lock, "vtdev", NULL, MTX_DEF);
225 	cv_init(&main_vd->vd_winswitch, "vtwswt");
226 }
227 
228 static void
229 vt_switch_timer(void *arg)
230 {
231 
232 	vt_late_window_switch((struct vt_window *)arg);
233 }
234 
235 static int
236 vt_window_preswitch(struct vt_window *vw, struct vt_window *curvw)
237 {
238 
239 	DPRINTF(40, "%s\n", __func__);
240 	curvw->vw_switch_to = vw;
241 	/* Set timer to allow switch in case when process hang. */
242 	callout_reset(&vw->vw_proc_dead_timer, hz * vt_deadtimer,
243 	    vt_switch_timer, (void *)vw);
244 	/* Notify process about vt switch attempt. */
245 	DPRINTF(30, "%s: Notify process.\n", __func__);
246 	signal_vt_rel(curvw);
247 
248 	return (0);
249 }
250 
251 static int
252 vt_window_postswitch(struct vt_window *vw)
253 {
254 
255 	signal_vt_acq(vw);
256 	return (0);
257 }
258 
259 /* vt_late_window_switch will done VT switching for regular case. */
260 static int
261 vt_late_window_switch(struct vt_window *vw)
262 {
263 	int ret;
264 
265 	callout_stop(&vw->vw_proc_dead_timer);
266 
267 	ret = vt_window_switch(vw);
268 	if (ret)
269 		return (ret);
270 
271 	/* Notify owner process about terminal availability. */
272 	if (vw->vw_smode.mode == VT_PROCESS) {
273 		ret = vt_window_postswitch(vw);
274 	}
275 	return (ret);
276 }
277 
278 /* Switch window. */
279 static int
280 vt_proc_window_switch(struct vt_window *vw)
281 {
282 	struct vt_window *curvw;
283 	struct vt_device *vd;
284 	int ret;
285 
286 	vd = vw->vw_device;
287 	curvw = vd->vd_curwindow;
288 
289 	if (curvw->vw_flags & VWF_VTYLOCK)
290 		return (EBUSY);
291 
292 	/* Ask current process permitions to switch away. */
293 	if (curvw->vw_smode.mode == VT_PROCESS) {
294 		DPRINTF(30, "%s: VT_PROCESS ", __func__);
295 		if (vt_proc_alive(curvw) == FALSE) {
296 			DPRINTF(30, "Dead. Cleaning.");
297 			/* Dead */
298 		} else {
299 			DPRINTF(30, "%s: Signaling process.\n", __func__);
300 			/* Alive, try to ask him. */
301 			ret = vt_window_preswitch(vw, curvw);
302 			/* Wait for process answer or timeout. */
303 			return (ret);
304 		}
305 		DPRINTF(30, "\n");
306 	}
307 
308 	ret = vt_late_window_switch(vw);
309 	return (ret);
310 }
311 
312 /* Switch window ignoring process locking. */
313 static int
314 vt_window_switch(struct vt_window *vw)
315 {
316 	struct vt_device *vd = vw->vw_device;
317 	struct vt_window *curvw = vd->vd_curwindow;
318 	keyboard_t *kbd;
319 
320 	VT_LOCK(vd);
321 	if (curvw == vw) {
322 		/* Nothing to do. */
323 		VT_UNLOCK(vd);
324 		return (0);
325 	}
326 	if (!(vw->vw_flags & (VWF_OPENED|VWF_CONSOLE))) {
327 		VT_UNLOCK(vd);
328 		return (EINVAL);
329 	}
330 
331 	vd->vd_curwindow = vw;
332 	vd->vd_flags |= VDF_INVALID;
333 	cv_broadcast(&vd->vd_winswitch);
334 	VT_UNLOCK(vd);
335 
336 	if (vd->vd_driver->vd_postswitch)
337 		vd->vd_driver->vd_postswitch(vd);
338 
339 	/* Restore per-window keyboard mode. */
340 	mtx_lock(&Giant);
341 	kbd = kbd_get_keyboard(vd->vd_keyboard);
342 	if (kbd != NULL) {
343 		kbdd_ioctl(kbd, KDSKBMODE, (void *)&vw->vw_kbdmode);
344 	}
345 	mtx_unlock(&Giant);
346 	DPRINTF(10, "%s(ttyv%d) done\n", __func__, vw->vw_number);
347 
348 	return (0);
349 }
350 
351 static inline void
352 vt_termsize(struct vt_device *vd, struct vt_font *vf, term_pos_t *size)
353 {
354 
355 	size->tp_row = vd->vd_height;
356 	size->tp_col = vd->vd_width;
357 	if (vf != NULL) {
358 		size->tp_row /= vf->vf_height;
359 		size->tp_col /= vf->vf_width;
360 	}
361 }
362 
363 static inline void
364 vt_winsize(struct vt_device *vd, struct vt_font *vf, struct winsize *size)
365 {
366 
367 	size->ws_row = size->ws_ypixel = vd->vd_height;
368 	size->ws_col = size->ws_xpixel = vd->vd_width;
369 	if (vf != NULL) {
370 		size->ws_row /= vf->vf_height;
371 		size->ws_col /= vf->vf_width;
372 	}
373 }
374 
375 static void
376 vt_scroll(struct vt_window *vw, int offset, int whence)
377 {
378 	int diff;
379 	term_pos_t size;
380 
381 	if ((vw->vw_flags & VWF_SCROLL) == 0)
382 		return;
383 
384 	vt_termsize(vw->vw_device, vw->vw_font, &size);
385 
386 	diff = vthistory_seek(&vw->vw_buf, offset, whence);
387 	/*
388 	 * Offset changed, please update Nth lines on sceen.
389 	 * +N - Nth lines at top;
390 	 * -N - Nth lines at bottom.
391 	 */
392 
393 	if (diff < -size.tp_row || diff > size.tp_row) {
394 		vw->vw_device->vd_flags |= VDF_INVALID;
395 		return;
396 	}
397 	vw->vw_device->vd_flags |= VDF_INVALID; /*XXX*/
398 }
399 
400 static int
401 vt_machine_kbdevent(int c)
402 {
403 
404 	switch (c) {
405 	case SPCLKEY | DBG:
406 		kdb_enter(KDB_WHY_BREAK, "manual escape to debugger");
407 		return (1);
408 	case SPCLKEY | RBT:
409 		/* XXX: Make this configurable! */
410 		shutdown_nice(0);
411 		return (1);
412 	case SPCLKEY | HALT:
413 		shutdown_nice(RB_HALT);
414 		return (1);
415 	case SPCLKEY | PDWN:
416 		shutdown_nice(RB_HALT|RB_POWEROFF);
417 		return (1);
418 	};
419 
420 	return (0);
421 }
422 
423 static void
424 vt_scrollmode_kbdevent(struct vt_window *vw, int c, int console)
425 {
426 	struct vt_device *vd;
427 	term_pos_t size;
428 
429 	vd = vw->vw_device;
430 	/* Only special keys handled in ScrollLock mode */
431 	if ((c & SPCLKEY) == 0)
432 		return;
433 
434 	c &= ~SPCLKEY;
435 
436 	if (console == 0) {
437 		if (c >= F_SCR && c <= MIN(L_SCR, F_SCR + VT_MAXWINDOWS - 1)) {
438 			vw = vd->vd_windows[c - F_SCR];
439 			if (vw != NULL)
440 				vt_proc_window_switch(vw);
441 			return;
442 		}
443 		VT_LOCK(vd);
444 	}
445 
446 	switch (c) {
447 	case SLK: {
448 		/* Turn scrolling off. */
449 		vt_scroll(vw, 0, VHS_END);
450 		VTBUF_SLCK_DISABLE(&vw->vw_buf);
451 		vw->vw_flags &= ~VWF_SCROLL;
452 		break;
453 	}
454 	case FKEY | F(49): /* Home key. */
455 		vt_scroll(vw, 0, VHS_SET);
456 		break;
457 	case FKEY | F(50): /* Arrow up. */
458 		vt_scroll(vw, -1, VHS_CUR);
459 		break;
460 	case FKEY | F(51): /* Page up. */
461 		vt_termsize(vd, vw->vw_font, &size);
462 		vt_scroll(vw, -size.tp_row, VHS_CUR);
463 		break;
464 	case FKEY | F(57): /* End key. */
465 		vt_scroll(vw, 0, VHS_END);
466 		break;
467 	case FKEY | F(58): /* Arrow down. */
468 		vt_scroll(vw, 1, VHS_CUR);
469 		break;
470 	case FKEY | F(59): /* Page down. */
471 		vt_termsize(vd, vw->vw_font, &size);
472 		vt_scroll(vw, size.tp_row, VHS_CUR);
473 		break;
474 	}
475 
476 	if (console == 0)
477 		VT_UNLOCK(vd);
478 }
479 
480 static int
481 vt_processkey(keyboard_t *kbd, struct vt_device *vd, int c)
482 {
483 	struct vt_window *vw = vd->vd_curwindow;
484 	int state = 0;
485 
486 #if VT_ALT_TO_ESC_HACK
487 	if (c & RELKEY) {
488 		switch (c & ~RELKEY) {
489 		case (SPCLKEY | RALT):
490 			if (vt_enable_altgr != 0)
491 				break;
492 		case (SPCLKEY | LALT):
493 			vd->vd_kbstate &= ~ALKED;
494 		}
495 		/* Other keys ignored for RELKEY event. */
496 		return (0);
497 	} else {
498 		switch (c & ~RELKEY) {
499 		case (SPCLKEY | RALT):
500 			if (vt_enable_altgr != 0)
501 				break;
502 		case (SPCLKEY | LALT):
503 			vd->vd_kbstate |= ALKED;
504 		}
505 	}
506 #else
507 	if (c & RELKEY)
508 		/* Other keys ignored for RELKEY event. */
509 		return (0);
510 #endif
511 
512 	if (vt_machine_kbdevent(c))
513 		return (0);
514 
515 	if (vw->vw_flags & VWF_SCROLL) {
516 		vt_scrollmode_kbdevent(vw, c, 0/* Not a console */);
517 		/* Scroll mode keys handled, nothing to do more. */
518 		return (0);
519 	}
520 
521 	if (c & SPCLKEY) {
522 		c &= ~SPCLKEY;
523 
524 		if (c >= F_SCR && c <= MIN(L_SCR, F_SCR + VT_MAXWINDOWS - 1)) {
525 			vw = vd->vd_windows[c - F_SCR];
526 			if (vw != NULL)
527 				vt_proc_window_switch(vw);
528 			return (0);
529 		}
530 
531 		switch (c) {
532 		case SLK: {
533 
534 			kbdd_ioctl(kbd, KDGKBSTATE, (caddr_t)&state);
535 			VT_LOCK(vd);
536 			if (state & SLKED) {
537 				/* Turn scrolling on. */
538 				vw->vw_flags |= VWF_SCROLL;
539 				VTBUF_SLCK_ENABLE(&vw->vw_buf);
540 			} else {
541 				/* Turn scrolling off. */
542 				vw->vw_flags &= ~VWF_SCROLL;
543 				VTBUF_SLCK_DISABLE(&vw->vw_buf);
544 				vt_scroll(vw, 0, VHS_END);
545 			}
546 			VT_UNLOCK(vd);
547 			break;
548 		}
549 		case FKEY | F(1):  case FKEY | F(2):  case FKEY | F(3):
550 		case FKEY | F(4):  case FKEY | F(5):  case FKEY | F(6):
551 		case FKEY | F(7):  case FKEY | F(8):  case FKEY | F(9):
552 		case FKEY | F(10): case FKEY | F(11): case FKEY | F(12):
553 			/* F1 through F12 keys. */
554 			terminal_input_special(vw->vw_terminal,
555 			    TKEY_F1 + c - (FKEY | F(1)));
556 			break;
557 		case FKEY | F(49): /* Home key. */
558 			terminal_input_special(vw->vw_terminal, TKEY_HOME);
559 			break;
560 		case FKEY | F(50): /* Arrow up. */
561 			terminal_input_special(vw->vw_terminal, TKEY_UP);
562 			break;
563 		case FKEY | F(51): /* Page up. */
564 			terminal_input_special(vw->vw_terminal, TKEY_PAGE_UP);
565 			break;
566 		case FKEY | F(53): /* Arrow left. */
567 			terminal_input_special(vw->vw_terminal, TKEY_LEFT);
568 			break;
569 		case FKEY | F(55): /* Arrow right. */
570 			terminal_input_special(vw->vw_terminal, TKEY_RIGHT);
571 			break;
572 		case FKEY | F(57): /* End key. */
573 			terminal_input_special(vw->vw_terminal, TKEY_END);
574 			break;
575 		case FKEY | F(58): /* Arrow down. */
576 			terminal_input_special(vw->vw_terminal, TKEY_DOWN);
577 			break;
578 		case FKEY | F(59): /* Page down. */
579 			terminal_input_special(vw->vw_terminal, TKEY_PAGE_DOWN);
580 			break;
581 		case FKEY | F(60): /* Insert key. */
582 			terminal_input_special(vw->vw_terminal, TKEY_INSERT);
583 			break;
584 		case FKEY | F(61): /* Delete key. */
585 			terminal_input_special(vw->vw_terminal, TKEY_DELETE);
586 			break;
587 		}
588 	} else if (KEYFLAGS(c) == 0) {
589 		/* Don't do UTF-8 conversion when doing raw mode. */
590 		if (vw->vw_kbdmode == K_XLATE) {
591 #if VT_ALT_TO_ESC_HACK
592 			if (vd->vd_kbstate & ALKED) {
593 				/*
594 				 * Prepend ESC sequence if one of ALT keys down.
595 				 */
596 				terminal_input_char(vw->vw_terminal, 0x1b);
597 			}
598 #endif
599 
600 			terminal_input_char(vw->vw_terminal, KEYCHAR(c));
601 		} else
602 			terminal_input_raw(vw->vw_terminal, c);
603 	}
604 	return (0);
605 }
606 
607 static int
608 vt_kbdevent(keyboard_t *kbd, int event, void *arg)
609 {
610 	struct vt_device *vd = arg;
611 	int c;
612 
613 	switch (event) {
614 	case KBDIO_KEYINPUT:
615 		break;
616 	case KBDIO_UNLOADING:
617 		mtx_lock(&Giant);
618 		vd->vd_keyboard = -1;
619 		kbd_release(kbd, (void *)&vd->vd_keyboard);
620 		mtx_unlock(&Giant);
621 		return (0);
622 	default:
623 		return (EINVAL);
624 	}
625 
626 	while ((c = kbdd_read_char(kbd, 0)) != NOKEY)
627 		vt_processkey(kbd, vd, c);
628 
629 	return (0);
630 }
631 
632 static int
633 vt_allocate_keyboard(struct vt_device *vd)
634 {
635 	int		 idx0, idx;
636 	keyboard_t	*k0, *k;
637 	keyboard_info_t	 ki;
638 
639 	idx0 = kbd_allocate("kbdmux", -1, vd, vt_kbdevent, vd);
640 	vd->vd_keyboard = idx0;
641 	if (idx0 >= 0) {
642 		DPRINTF(20, "%s: kbdmux allocated, idx = %d\n", __func__, idx0);
643 		k0 = kbd_get_keyboard(idx0);
644 
645 		for (idx = kbd_find_keyboard2("*", -1, 0);
646 		     idx != -1;
647 		     idx = kbd_find_keyboard2("*", -1, idx + 1)) {
648 			k = kbd_get_keyboard(idx);
649 
650 			if (idx == idx0 || KBD_IS_BUSY(k))
651 				continue;
652 
653 			bzero(&ki, sizeof(ki));
654 			strcpy(ki.kb_name, k->kb_name);
655 			ki.kb_unit = k->kb_unit;
656 
657 			kbdd_ioctl(k0, KBADDKBD, (caddr_t) &ki);
658 		}
659 	} else {
660 		DPRINTF(20, "%s: no kbdmux allocated\n", __func__);
661 		idx0 = kbd_allocate("*", -1, vd, vt_kbdevent, vd);
662 		if (idx0 < 0) {
663 			DPRINTF(10, "%s: No keyboard found.\n", __func__);
664 			return (-1);
665 		}
666 	}
667 	DPRINTF(20, "%s: vd_keyboard = %d\n", __func__, vd->vd_keyboard);
668 
669 	return (idx0);
670 }
671 
672 static void
673 vtterm_bell(struct terminal *tm)
674 {
675 	struct vt_window *vw = tm->tm_softc;
676 	struct vt_device *vd = vw->vw_device;
677 
678 	if (vd->vd_flags & VDF_QUIET_BELL)
679 		return;
680 
681 	sysbeep(1193182 / VT_BELLPITCH, VT_BELLDURATION);
682 }
683 
684 static void
685 vtterm_beep(struct terminal *tm, u_int param)
686 {
687 	u_int freq, period;
688 
689 	if ((param == 0) || ((param & 0xffff) == 0)) {
690 		vtterm_bell(tm);
691 		return;
692 	}
693 
694 	period = ((param >> 16) & 0xffff) * hz / 1000;
695 	freq = 1193182 / (param & 0xffff);
696 
697 	sysbeep(freq, period);
698 }
699 
700 static void
701 vtterm_cursor(struct terminal *tm, const term_pos_t *p)
702 {
703 	struct vt_window *vw = tm->tm_softc;
704 
705 	vtbuf_cursor_position(&vw->vw_buf, p);
706 }
707 
708 static void
709 vtterm_putchar(struct terminal *tm, const term_pos_t *p, term_char_t c)
710 {
711 	struct vt_window *vw = tm->tm_softc;
712 
713 	vtbuf_putchar(&vw->vw_buf, p, c);
714 }
715 
716 static void
717 vtterm_fill(struct terminal *tm, const term_rect_t *r, term_char_t c)
718 {
719 	struct vt_window *vw = tm->tm_softc;
720 
721 	vtbuf_fill_locked(&vw->vw_buf, r, c);
722 }
723 
724 static void
725 vtterm_copy(struct terminal *tm, const term_rect_t *r,
726     const term_pos_t *p)
727 {
728 	struct vt_window *vw = tm->tm_softc;
729 
730 	vtbuf_copy(&vw->vw_buf, r, p);
731 }
732 
733 static void
734 vtterm_param(struct terminal *tm, int cmd, unsigned int arg)
735 {
736 	struct vt_window *vw = tm->tm_softc;
737 
738 	switch (cmd) {
739 	case TP_SHOWCURSOR:
740 		vtbuf_cursor_visibility(&vw->vw_buf, arg);
741 		break;
742 	case TP_MOUSE:
743 		vw->vw_mouse_level = arg;
744 		break;
745 	}
746 }
747 
748 static inline void
749 vt_determine_colors(term_char_t c, int cursor,
750     term_color_t *fg, term_color_t *bg)
751 {
752 	term_color_t tmp;
753 	int invert;
754 
755 	invert = 0;
756 
757 	*fg = TCHAR_FGCOLOR(c);
758 	if (TCHAR_FORMAT(c) & TF_BOLD)
759 		*fg = TCOLOR_LIGHT(*fg);
760 	*bg = TCHAR_BGCOLOR(c);
761 
762 	if (TCHAR_FORMAT(c) & TF_REVERSE)
763 		invert ^= 1;
764 	if (cursor)
765 		invert ^= 1;
766 
767 	if (invert) {
768 		tmp = *fg;
769 		*fg = *bg;
770 		*bg = tmp;
771 	}
772 }
773 
774 static void
775 vt_bitblt_char(struct vt_device *vd, struct vt_font *vf, term_char_t c,
776     int iscursor, unsigned int row, unsigned int col)
777 {
778 	term_color_t fg, bg;
779 
780 	vt_determine_colors(c, iscursor, &fg, &bg);
781 
782 	if (vf != NULL) {
783 		const uint8_t *src;
784 		vt_axis_t top, left;
785 
786 		src = vtfont_lookup(vf, c);
787 
788 		/*
789 		 * Align the terminal to the centre of the screen.
790 		 * Fonts may not always be able to fill the entire
791 		 * screen.
792 		 */
793 		top = row * vf->vf_height + vd->vd_offset.tp_row;
794 		left = col * vf->vf_width + vd->vd_offset.tp_col;
795 
796 		vd->vd_driver->vd_bitbltchr(vd, src, NULL, 0, top, left,
797 		    vf->vf_width, vf->vf_height, fg, bg);
798 	} else {
799 		vd->vd_driver->vd_putchar(vd, TCHAR_CHARACTER(c),
800 		    row, col, fg, bg);
801 	}
802 }
803 
804 static void
805 vt_flush(struct vt_device *vd)
806 {
807 	struct vt_window *vw;
808 	struct vt_font *vf;
809 	struct vt_bufmask tmask;
810 	unsigned int row, col;
811 	term_rect_t tarea;
812 	term_pos_t size;
813 	term_char_t *r;
814 #ifndef SC_NO_CUTPASTE
815 	struct mouse_cursor *m;
816 	int bpl, h, w;
817 #endif
818 
819 	vw = vd->vd_curwindow;
820 	if (vw == NULL)
821 		return;
822 	vf = vw->vw_font;
823 	if (((vd->vd_flags & VDF_TEXTMODE) == 0) && (vf == NULL))
824 		return;
825 
826 	if (vd->vd_flags & VDF_SPLASH || vw->vw_flags & VWF_BUSY)
827 		return;
828 
829 	vtbuf_undirty(&vw->vw_buf, &tarea, &tmask);
830 	vt_termsize(vd, vf, &size);
831 
832 	/* Force a full redraw when the screen contents are invalid. */
833 	if (vd->vd_flags & VDF_INVALID) {
834 		tarea.tr_begin.tp_row = tarea.tr_begin.tp_col = 0;
835 		tarea.tr_end = size;
836 		tmask.vbm_row = tmask.vbm_col = VBM_DIRTY;
837 
838 		vd->vd_flags &= ~VDF_INVALID;
839 	}
840 
841 #ifndef SC_NO_CUTPASTE
842 	if ((vw->vw_flags & VWF_MOUSE_HIDE) == 0) {
843 		/* Mark last mouse position as dirty to erase. */
844 		vtbuf_mouse_cursor_position(&vw->vw_buf, vd->vd_mdirtyx,
845 		    vd->vd_mdirtyy);
846 	}
847 #endif
848 
849 	for (row = tarea.tr_begin.tp_row; row < tarea.tr_end.tp_row; row++) {
850 		if (!VTBUF_DIRTYROW(&tmask, row))
851 			continue;
852 		r = VTBUF_GET_ROW(&vw->vw_buf, row);
853 		for (col = tarea.tr_begin.tp_col;
854 		    col < tarea.tr_end.tp_col; col++) {
855 			if (!VTBUF_DIRTYCOL(&tmask, col))
856 				continue;
857 
858 			vt_bitblt_char(vd, vf, r[col],
859 			    VTBUF_ISCURSOR(&vw->vw_buf, row, col), row, col);
860 		}
861 	}
862 
863 #ifndef SC_NO_CUTPASTE
864 	/* Mouse disabled. */
865 	if (vw->vw_flags & VWF_MOUSE_HIDE)
866 		return;
867 
868 	/* No mouse for DDB. */
869 	if (kdb_active || panicstr != NULL)
870 		return;
871 
872 	if ((vd->vd_flags & (VDF_MOUSECURSOR|VDF_TEXTMODE)) ==
873 	    VDF_MOUSECURSOR) {
874 		m = &vt_default_mouse_pointer;
875 		bpl = (m->w + 7) >> 3; /* Bytes per source line. */
876 		w = m->w;
877 		h = m->h;
878 
879 		if ((vd->vd_mx + m->w) > (size.tp_col * vf->vf_width))
880 			w = (size.tp_col * vf->vf_width) - vd->vd_mx - 1;
881 		if ((vd->vd_my + m->h) > (size.tp_row * vf->vf_height))
882 			h = (size.tp_row * vf->vf_height) - vd->vd_my - 1;
883 
884 		vd->vd_driver->vd_maskbitbltchr(vd, m->map, m->mask, bpl,
885 		    vd->vd_offset.tp_row + vd->vd_my,
886 		    vd->vd_offset.tp_col + vd->vd_mx,
887 		    w, h, TC_WHITE, TC_BLACK);
888 		/* Save point of last mouse cursor to erase it later. */
889 		vd->vd_mdirtyx = vd->vd_mx / vf->vf_width;
890 		vd->vd_mdirtyy = vd->vd_my / vf->vf_height;
891 	}
892 #endif
893 }
894 
895 static void
896 vt_timer(void *arg)
897 {
898 	struct vt_device *vd;
899 
900 	vd = arg;
901 	/* Update screen if required. */
902 	vt_flush(vd);
903 
904 	/* Schedule for next update. */
905 	callout_schedule(&vd->vd_timer, hz / VT_TIMERFREQ);
906 }
907 
908 static void
909 vtterm_done(struct terminal *tm)
910 {
911 	struct vt_window *vw = tm->tm_softc;
912 	struct vt_device *vd = vw->vw_device;
913 
914 	if (kdb_active || panicstr != NULL) {
915 		/* Switch to the debugger. */
916 		if (vd->vd_curwindow != vw) {
917 			vd->vd_curwindow = vw;
918 			vd->vd_flags |= VDF_INVALID;
919 			if (vd->vd_driver->vd_postswitch)
920 				vd->vd_driver->vd_postswitch(vd);
921 		}
922 		vd->vd_flags &= ~VDF_SPLASH;
923 		vt_flush(vd);
924 	} else if (!(vd->vd_flags & VDF_ASYNC)) {
925 		vt_flush(vd);
926 	}
927 }
928 
929 #ifdef DEV_SPLASH
930 static void
931 vtterm_splash(struct vt_device *vd)
932 {
933 	vt_axis_t top, left;
934 
935 	/* Display a nice boot splash. */
936 	if (!(vd->vd_flags & VDF_TEXTMODE) && (boothowto & RB_MUTE)) {
937 
938 		top = (vd->vd_height - vt_logo_height) / 2;
939 		left = (vd->vd_width - vt_logo_width) / 2;
940 		switch (vt_logo_depth) {
941 		case 1:
942 			/* XXX: Unhardcode colors! */
943 			vd->vd_driver->vd_bitbltchr(vd, vt_logo_image, NULL, 0,
944 			    top, left, vt_logo_width, vt_logo_height, 0xf, 0x0);
945 		}
946 		vd->vd_flags |= VDF_SPLASH;
947 	}
948 }
949 #endif
950 
951 
952 static void
953 vtterm_cnprobe(struct terminal *tm, struct consdev *cp)
954 {
955 	struct vt_driver *vtd, **vtdlist, *vtdbest = NULL;
956 	struct vt_window *vw = tm->tm_softc;
957 	struct vt_device *vd = vw->vw_device;
958 	struct winsize wsz;
959 
960 	if (vd->vd_flags & VDF_INITIALIZED)
961 		/* Initialization already done. */
962 		return;
963 
964 	SET_FOREACH(vtdlist, vt_drv_set) {
965 		vtd = *vtdlist;
966 		if (vtd->vd_probe == NULL)
967 			continue;
968 		if (vtd->vd_probe(vd) == CN_DEAD)
969 			continue;
970 		if ((vtdbest == NULL) ||
971 		    (vtd->vd_priority > vtdbest->vd_priority))
972 			vtdbest = vtd;
973 	}
974 	if (vtdbest == NULL) {
975 		cp->cn_pri = CN_DEAD;
976 		vd->vd_flags |= VDF_DEAD;
977 	} else {
978 		vd->vd_driver = vtdbest;
979 		cp->cn_pri = vd->vd_driver->vd_init(vd);
980 	}
981 
982 	/* Check if driver's vt_init return CN_DEAD. */
983 	if (cp->cn_pri == CN_DEAD) {
984 		vd->vd_flags |= VDF_DEAD;
985 	}
986 
987 	/* Initialize any early-boot keyboard drivers */
988 	kbd_configure(KB_CONF_PROBE_ONLY);
989 
990 	vd->vd_unit = atomic_fetchadd_int(&vt_unit, 1);
991 	vd->vd_windows[VT_CONSWINDOW] = vw;
992 	sprintf(cp->cn_name, "ttyv%r", VT_UNIT(vw));
993 
994 	/* Attach default font if not in TEXTMODE. */
995 	if (!(vd->vd_flags & VDF_TEXTMODE))
996 		vw->vw_font = vtfont_ref(&vt_font_default);
997 
998 	vtbuf_init_early(&vw->vw_buf);
999 	vt_winsize(vd, vw->vw_font, &wsz);
1000 	terminal_set_winsize(tm, &wsz);
1001 
1002 	if (vtdbest != NULL) {
1003 #ifdef DEV_SPLASH
1004 		vtterm_splash(vd);
1005 #endif
1006 		vd->vd_flags |= VDF_INITIALIZED;
1007 	}
1008 }
1009 
1010 static int
1011 vtterm_cngetc(struct terminal *tm)
1012 {
1013 	struct vt_window *vw = tm->tm_softc;
1014 	struct vt_device *vd = vw->vw_device;
1015 	keyboard_t *kbd;
1016 	int state;
1017 	u_int c;
1018 
1019 	if (vw->vw_kbdsq && *vw->vw_kbdsq)
1020 		return (*vw->vw_kbdsq++);
1021 
1022 	state = 0;
1023 	/* Make sure the splash screen is not there. */
1024 	if (vd->vd_flags & VDF_SPLASH) {
1025 		/* Remove splash */
1026 		vd->vd_flags &= ~VDF_SPLASH;
1027 		/* Mark screen as invalid to force update */
1028 		vd->vd_flags |= VDF_INVALID;
1029 		vt_flush(vd);
1030 	}
1031 
1032 	/* Stripped down keyboard handler. */
1033 	kbd = kbd_get_keyboard(vd->vd_keyboard);
1034 	if (kbd == NULL)
1035 		return (-1);
1036 
1037 	/* Force keyboard input mode to K_XLATE */
1038 	c = K_XLATE;
1039 	kbdd_ioctl(kbd, KDSKBMODE, (void *)&c);
1040 
1041 	/* Switch the keyboard to polling to make it work here. */
1042 	kbdd_poll(kbd, TRUE);
1043 	c = kbdd_read_char(kbd, 0);
1044 	kbdd_poll(kbd, FALSE);
1045 	if (c & RELKEY)
1046 		return (-1);
1047 
1048 	if (vw->vw_flags & VWF_SCROLL) {
1049 		vt_scrollmode_kbdevent(vw, c, 1/* Console mode */);
1050 		vt_flush(vd);
1051 		return (-1);
1052 	}
1053 
1054 	/* Stripped down handling of vt_kbdevent(), without locking, etc. */
1055 	if (c & SPCLKEY) {
1056 		switch (c) {
1057 		case SPCLKEY | SLK:
1058 			kbdd_ioctl(kbd, KDGKBSTATE, (caddr_t)&state);
1059 			if (state & SLKED) {
1060 				/* Turn scrolling on. */
1061 				vw->vw_flags |= VWF_SCROLL;
1062 				VTBUF_SLCK_ENABLE(&vw->vw_buf);
1063 			} else {
1064 				/* Turn scrolling off. */
1065 				vt_scroll(vw, 0, VHS_END);
1066 				vw->vw_flags &= ~VWF_SCROLL;
1067 				VTBUF_SLCK_DISABLE(&vw->vw_buf);
1068 			}
1069 			break;
1070 		/* XXX: KDB can handle history. */
1071 		case SPCLKEY | FKEY | F(50): /* Arrow up. */
1072 			vw->vw_kbdsq = "\x1b[A";
1073 			break;
1074 		case SPCLKEY | FKEY | F(58): /* Arrow down. */
1075 			vw->vw_kbdsq = "\x1b[B";
1076 			break;
1077 		case SPCLKEY | FKEY | F(55): /* Arrow right. */
1078 			vw->vw_kbdsq = "\x1b[C";
1079 			break;
1080 		case SPCLKEY | FKEY | F(53): /* Arrow left. */
1081 			vw->vw_kbdsq = "\x1b[D";
1082 			break;
1083 		}
1084 
1085 		/* Force refresh to make scrollback work. */
1086 		vt_flush(vd);
1087 	} else if (KEYFLAGS(c) == 0) {
1088 		return (KEYCHAR(c));
1089 	}
1090 
1091 	if (vw->vw_kbdsq && *vw->vw_kbdsq)
1092 		return (*vw->vw_kbdsq++);
1093 
1094 	return (-1);
1095 }
1096 
1097 static void
1098 vtterm_opened(struct terminal *tm, int opened)
1099 {
1100 	struct vt_window *vw = tm->tm_softc;
1101 	struct vt_device *vd = vw->vw_device;
1102 
1103 	VT_LOCK(vd);
1104 	vd->vd_flags &= ~VDF_SPLASH;
1105 	if (opened)
1106 		vw->vw_flags |= VWF_OPENED;
1107 	else {
1108 		vw->vw_flags &= ~VWF_OPENED;
1109 		/* TODO: finish ACQ/REL */
1110 	}
1111 	VT_UNLOCK(vd);
1112 }
1113 
1114 static int
1115 vt_change_font(struct vt_window *vw, struct vt_font *vf)
1116 {
1117 	struct vt_device *vd = vw->vw_device;
1118 	struct terminal *tm = vw->vw_terminal;
1119 	term_pos_t size;
1120 	struct winsize wsz;
1121 
1122 	/*
1123 	 * Changing fonts.
1124 	 *
1125 	 * Changing fonts is a little tricky.  We must prevent
1126 	 * simultaneous access to the device, so we must stop
1127 	 * the display timer and the terminal from accessing.
1128 	 * We need to switch fonts and grow our screen buffer.
1129 	 *
1130 	 * XXX: Right now the code uses terminal_mute() to
1131 	 * prevent data from reaching the console driver while
1132 	 * resizing the screen buffer.  This isn't elegant...
1133 	 */
1134 
1135 	VT_LOCK(vd);
1136 	if (vw->vw_flags & VWF_BUSY) {
1137 		/* Another process is changing the font. */
1138 		VT_UNLOCK(vd);
1139 		return (EBUSY);
1140 	}
1141 	if (vw->vw_font == NULL) {
1142 		/* Our device doesn't need fonts. */
1143 		VT_UNLOCK(vd);
1144 		return (ENOTTY);
1145 	}
1146 	vw->vw_flags |= VWF_BUSY;
1147 	VT_UNLOCK(vd);
1148 
1149 	vt_termsize(vd, vf, &size);
1150 	vt_winsize(vd, vf, &wsz);
1151 	/* Save offset to font aligned area. */
1152 	vd->vd_offset.tp_col = (vd->vd_width % vf->vf_width) / 2;
1153 	vd->vd_offset.tp_row = (vd->vd_height % vf->vf_height) / 2;
1154 
1155 	/* Grow the screen buffer and terminal. */
1156 	terminal_mute(tm, 1);
1157 	vtbuf_grow(&vw->vw_buf, &size, vw->vw_buf.vb_history_size);
1158 	terminal_set_winsize_blank(tm, &wsz, 0);
1159 	terminal_mute(tm, 0);
1160 
1161 	/* Actually apply the font to the current window. */
1162 	VT_LOCK(vd);
1163 	vtfont_unref(vw->vw_font);
1164 	vw->vw_font = vtfont_ref(vf);
1165 
1166 	/* Force a full redraw the next timer tick. */
1167 	if (vd->vd_curwindow == vw)
1168 		vd->vd_flags |= VDF_INVALID;
1169 	vw->vw_flags &= ~VWF_BUSY;
1170 	VT_UNLOCK(vd);
1171 	return (0);
1172 }
1173 
1174 static int
1175 vt_set_border(struct vt_window *vw, struct vt_font *vf, term_color_t c)
1176 {
1177 	struct vt_device *vd = vw->vw_device;
1178 	int x, y, off_x, off_y;
1179 
1180 	if (vd->vd_driver->vd_drawrect == NULL)
1181 		return (ENOTSUP);
1182 
1183 	x = vd->vd_width - 1;
1184 	y = vd->vd_height - 1;
1185 	off_x = vd->vd_offset.tp_col;
1186 	off_y = vd->vd_offset.tp_row;
1187 
1188 	/* Top bar. */
1189 	if (off_y > 0)
1190 		vd->vd_driver->vd_drawrect(vd, 0, 0, x, off_y - 1, 1, c);
1191 	/* Left bar. */
1192 	if (off_x > 0)
1193 		vd->vd_driver->vd_drawrect(vd, 0, off_y, off_x - 1, y - off_y,
1194 		    1, c);
1195 	/* Right bar.  May be 1 pixel wider than necessary due to rounding. */
1196 	vd->vd_driver->vd_drawrect(vd, x - off_x, off_y, x, y - off_y, 1, c);
1197 	/* Bottom bar.  May be 1 mixel taller than necessary due to rounding. */
1198 	vd->vd_driver->vd_drawrect(vd, 0, y - off_y, x, y, 1, c);
1199 
1200 	return (0);
1201 }
1202 
1203 static int
1204 vt_proc_alive(struct vt_window *vw)
1205 {
1206 	struct proc *p;
1207 
1208 	if (vw->vw_smode.mode != VT_PROCESS)
1209 		return (FALSE);
1210 
1211 	if (vw->vw_proc) {
1212 		if ((p = pfind(vw->vw_pid)) != NULL)
1213 			PROC_UNLOCK(p);
1214 		if (vw->vw_proc == p)
1215 			return (TRUE);
1216 		vw->vw_proc = NULL;
1217 		vw->vw_smode.mode = VT_AUTO;
1218 		DPRINTF(1, "vt controlling process %d died\n", vw->vw_pid);
1219 		vw->vw_pid = 0;
1220 	}
1221 	return (FALSE);
1222 }
1223 
1224 static int
1225 signal_vt_rel(struct vt_window *vw)
1226 {
1227 
1228 	if (vw->vw_smode.mode != VT_PROCESS)
1229 		return (FALSE);
1230 	if (vw->vw_proc == NULL || vt_proc_alive(vw) == FALSE) {
1231 		vw->vw_proc = NULL;
1232 		vw->vw_pid = 0;
1233 		return (TRUE);
1234 	}
1235 	vw->vw_flags |= VWF_SWWAIT_REL;
1236 	PROC_LOCK(vw->vw_proc);
1237 	kern_psignal(vw->vw_proc, vw->vw_smode.relsig);
1238 	PROC_UNLOCK(vw->vw_proc);
1239 	DPRINTF(1, "sending relsig to %d\n", vw->vw_pid);
1240 	return (TRUE);
1241 }
1242 
1243 static int
1244 signal_vt_acq(struct vt_window *vw)
1245 {
1246 
1247 	if (vw->vw_smode.mode != VT_PROCESS)
1248 		return (FALSE);
1249 	if (vw == vw->vw_device->vd_windows[VT_CONSWINDOW])
1250 		cnavailable(vw->vw_terminal->consdev, FALSE);
1251 	if (vw->vw_proc == NULL || vt_proc_alive(vw) == FALSE) {
1252 		vw->vw_proc = NULL;
1253 		vw->vw_pid = 0;
1254 		return (TRUE);
1255 	}
1256 	vw->vw_flags |= VWF_SWWAIT_ACQ;
1257 	PROC_LOCK(vw->vw_proc);
1258 	kern_psignal(vw->vw_proc, vw->vw_smode.acqsig);
1259 	PROC_UNLOCK(vw->vw_proc);
1260 	DPRINTF(1, "sending acqsig to %d\n", vw->vw_pid);
1261 	return (TRUE);
1262 }
1263 
1264 static int
1265 finish_vt_rel(struct vt_window *vw, int release, int *s)
1266 {
1267 
1268 	if (vw->vw_flags & VWF_SWWAIT_REL) {
1269 		vw->vw_flags &= ~VWF_SWWAIT_REL;
1270 		if (release) {
1271 			callout_drain(&vw->vw_proc_dead_timer);
1272 			vt_late_window_switch(vw->vw_switch_to);
1273 		}
1274 		return (0);
1275 	}
1276 	return (EINVAL);
1277 }
1278 
1279 static int
1280 finish_vt_acq(struct vt_window *vw)
1281 {
1282 
1283 	if (vw->vw_flags & VWF_SWWAIT_ACQ) {
1284 		vw->vw_flags &= ~VWF_SWWAIT_ACQ;
1285 		return (0);
1286 	}
1287 	return (EINVAL);
1288 }
1289 
1290 #ifndef SC_NO_CUTPASTE
1291 static void
1292 vt_mouse_terminput_button(struct vt_device *vd, int button)
1293 {
1294 	struct vt_window *vw;
1295 	struct vt_font *vf;
1296 	char mouseb[6] = "\x1B[M";
1297 	int i, x, y;
1298 
1299 	vw = vd->vd_curwindow;
1300 	vf = vw->vw_font;
1301 
1302 	/* Translate to char position. */
1303 	x = vd->vd_mx / vf->vf_width;
1304 	y = vd->vd_my / vf->vf_height;
1305 	/* Avoid overflow. */
1306 	x = MIN(x, 255 - '!');
1307 	y = MIN(y, 255 - '!');
1308 
1309 	mouseb[3] = ' ' + button;
1310 	mouseb[4] = '!' + x;
1311 	mouseb[5] = '!' + y;
1312 
1313 	for (i = 0; i < sizeof(mouseb); i++ )
1314 		terminal_input_char(vw->vw_terminal, mouseb[i]);
1315 }
1316 
1317 static void
1318 vt_mouse_terminput(struct vt_device *vd, int type, int x, int y, int event,
1319     int cnt)
1320 {
1321 
1322 	switch (type) {
1323 	case MOUSE_BUTTON_EVENT:
1324 		if (cnt > 0) {
1325 			/* Mouse button pressed. */
1326 			if (event & MOUSE_BUTTON1DOWN)
1327 				vt_mouse_terminput_button(vd, 0);
1328 			if (event & MOUSE_BUTTON2DOWN)
1329 				vt_mouse_terminput_button(vd, 1);
1330 			if (event & MOUSE_BUTTON3DOWN)
1331 				vt_mouse_terminput_button(vd, 2);
1332 		} else {
1333 			/* Mouse button released. */
1334 			vt_mouse_terminput_button(vd, 3);
1335 		}
1336 		break;
1337 #ifdef notyet
1338 	case MOUSE_MOTION_EVENT:
1339 		if (mouse->u.data.z < 0) {
1340 			/* Scroll up. */
1341 			sc_mouse_input_button(vd, 64);
1342 		} else if (mouse->u.data.z > 0) {
1343 			/* Scroll down. */
1344 			sc_mouse_input_button(vd, 65);
1345 		}
1346 		break;
1347 #endif
1348 	}
1349 }
1350 
1351 void
1352 vt_mouse_event(int type, int x, int y, int event, int cnt, int mlevel)
1353 {
1354 	struct vt_device *vd;
1355 	struct vt_window *vw;
1356 	struct vt_font *vf;
1357 	term_pos_t size;
1358 	term_char_t *buf;
1359 	int i, len, mark;
1360 
1361 	vd = main_vd;
1362 	vw = vd->vd_curwindow;
1363 	vf = vw->vw_font;
1364 	mark = 0;
1365 
1366 	if (vw->vw_flags & VWF_MOUSE_HIDE)
1367 		return; /* Mouse disabled. */
1368 
1369 	if (vf == NULL)	/* Text mode. */
1370 		return;
1371 
1372 	/*
1373 	 * TODO: add flag about pointer position changed, to not redraw chars
1374 	 * under mouse pointer when nothing changed.
1375 	 */
1376 
1377 	if (vw->vw_mouse_level > 0)
1378 		vt_mouse_terminput(vd, type, x, y, event, cnt);
1379 
1380 	switch (type) {
1381 	case MOUSE_ACTION:
1382 	case MOUSE_MOTION_EVENT:
1383 		/* Movement */
1384 		x += vd->vd_mx;
1385 		y += vd->vd_my;
1386 
1387 		vt_termsize(vd, vf, &size);
1388 
1389 		/* Apply limits. */
1390 		x = MAX(x, 0);
1391 		y = MAX(y, 0);
1392 		x = MIN(x, (size.tp_col * vf->vf_width) - 1);
1393 		y = MIN(y, (size.tp_row * vf->vf_height) - 1);
1394 
1395 		vd->vd_mx = x;
1396 		vd->vd_my = y;
1397 		if ((vd->vd_mstate & MOUSE_BUTTON1DOWN) &&
1398 		    (vtbuf_set_mark(&vw->vw_buf, VTB_MARK_MOVE,
1399 			vd->vd_mx / vf->vf_width,
1400 			vd->vd_my / vf->vf_height) == 1)) {
1401 
1402 			/*
1403 			 * We have something marked to copy, so update pointer
1404 			 * to window with selection.
1405 			 */
1406 			vd->vd_markedwin = vw;
1407 		}
1408 		return; /* Done */
1409 	case MOUSE_BUTTON_EVENT:
1410 		/* Buttons */
1411 		break;
1412 	default:
1413 		return; /* Done */
1414 	}
1415 
1416 	switch (event) {
1417 	case MOUSE_BUTTON1DOWN:
1418 		switch (cnt % 4) {
1419 		case 0:	/* up */
1420 			mark = VTB_MARK_END;
1421 			break;
1422 		case 1: /* single click: start cut operation */
1423 			mark = VTB_MARK_START;
1424 			break;
1425 		case 2:	/* double click: cut a word */
1426 			mark = VTB_MARK_WORD;
1427 			break;
1428 		case 3:	/* triple click: cut a line */
1429 			mark = VTB_MARK_ROW;
1430 			break;
1431 		}
1432 		break;
1433 	case VT_MOUSE_PASTEBUTTON:
1434 		switch (cnt) {
1435 		case 0:	/* up */
1436 			break;
1437 		default:
1438 			if (vd->vd_markedwin == NULL)
1439 				return;
1440 			/* Get current selecton size in bytes. */
1441 			len = vtbuf_get_marked_len(&vd->vd_markedwin->vw_buf);
1442 			if (len <= 0)
1443 				return;
1444 
1445 			buf = malloc(len, M_VT, M_WAITOK | M_ZERO);
1446 			/* Request cupy/paste buffer data, no more than `len' */
1447 			vtbuf_extract_marked(&vd->vd_markedwin->vw_buf, buf,
1448 			    len);
1449 
1450 			len /= sizeof(term_char_t);
1451 			for (i = 0; i < len; i++ ) {
1452 				if (buf[i] == '\0')
1453 					continue;
1454 				terminal_input_char(vw->vw_terminal, buf[i]);
1455 			}
1456 
1457 			/* Done, so cleanup. */
1458 			free(buf, M_VT);
1459 			break;
1460 		}
1461 		return; /* Done */
1462 	case VT_MOUSE_EXTENDBUTTON:
1463 		switch (cnt) {
1464 		case 0:	/* up */
1465 			if (!(vd->vd_mstate & MOUSE_BUTTON1DOWN))
1466 				mark = VTB_MARK_EXTEND;
1467 			else
1468 				mark = 0;
1469 			break;
1470 		default:
1471 			mark = VTB_MARK_EXTEND;
1472 			break;
1473 		}
1474 		break;
1475 	default:
1476 		return; /* Done */
1477 	}
1478 
1479 	/* Save buttons state. */
1480 	if (cnt > 0)
1481 		vd->vd_mstate |= event;
1482 	else
1483 		vd->vd_mstate &= ~event;
1484 
1485 	if (vtbuf_set_mark(&vw->vw_buf, mark, vd->vd_mx / vf->vf_width,
1486 	    vd->vd_my / vf->vf_height) == 1) {
1487 		/*
1488 		 * We have something marked to copy, so update pointer to
1489 		 * window with selection.
1490 		 */
1491 		vd->vd_markedwin = vw;
1492 	}
1493 }
1494 
1495 void
1496 vt_mouse_state(int show)
1497 {
1498 	struct vt_device *vd;
1499 	struct vt_window *vw;
1500 
1501 	vd = main_vd;
1502 	vw = vd->vd_curwindow;
1503 
1504 	switch (show) {
1505 	case VT_MOUSE_HIDE:
1506 		vw->vw_flags |= VWF_MOUSE_HIDE;
1507 		break;
1508 	case VT_MOUSE_SHOW:
1509 		vw->vw_flags &= ~VWF_MOUSE_HIDE;
1510 		break;
1511 	}
1512 }
1513 #endif
1514 
1515 static int
1516 vtterm_mmap(struct terminal *tm, vm_ooffset_t offset, vm_paddr_t * paddr,
1517     int nprot, vm_memattr_t *memattr)
1518 {
1519 	struct vt_window *vw = tm->tm_softc;
1520 	struct vt_device *vd = vw->vw_device;
1521 
1522 	if (vd->vd_driver->vd_fb_mmap)
1523 		return (vd->vd_driver->vd_fb_mmap(vd, offset, paddr, nprot,
1524 		    memattr));
1525 
1526 	return (ENXIO);
1527 }
1528 
1529 static int
1530 vtterm_ioctl(struct terminal *tm, u_long cmd, caddr_t data,
1531     struct thread *td)
1532 {
1533 	struct vt_window *vw = tm->tm_softc;
1534 	struct vt_device *vd = vw->vw_device;
1535 	keyboard_t *kbd;
1536 	int error, i, s;
1537 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1538     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1539 	int ival;
1540 
1541 	switch (cmd) {
1542 	case _IO('v', 4):
1543 		cmd = VT_RELDISP;
1544 		break;
1545 	case _IO('v', 5):
1546 		cmd = VT_ACTIVATE;
1547 		break;
1548 	case _IO('v', 6):
1549 		cmd = VT_WAITACTIVE;
1550 		break;
1551 	case _IO('K', 20):
1552 		cmd = KDSKBSTATE;
1553 		break;
1554 	case _IO('K', 67):
1555 		cmd = KDSETRAD;
1556 		break;
1557 	case _IO('K', 7):
1558 		cmd = KDSKBMODE;
1559 		break;
1560 	case _IO('K', 8):
1561 		cmd = KDMKTONE;
1562 		break;
1563 	case _IO('K', 63):
1564 		cmd = KIOCSOUND;
1565 		break;
1566 	case _IO('K', 66):
1567 		cmd = KDSETLED;
1568 		break;
1569 	case _IO('c', 110):
1570 		cmd = CONS_SETKBD;
1571 		break;
1572 	default:
1573 		goto skip_thunk;
1574 	}
1575 	ival = IOCPARM_IVAL(data);
1576 	data = (caddr_t)&ival;
1577 skip_thunk:
1578 #endif
1579 
1580 	switch (cmd) {
1581 	case KDSETRAD:		/* set keyboard repeat & delay rates (old) */
1582 		if (*(int *)data & ~0x7f)
1583 			return (EINVAL);
1584 	case GIO_KEYMAP:
1585 	case PIO_KEYMAP:
1586 	case GIO_DEADKEYMAP:
1587 	case PIO_DEADKEYMAP:
1588 	case GETFKEY:
1589 	case SETFKEY:
1590 	case KDGKBINFO:
1591 	case KDGKBTYPE:
1592 	case KDSKBSTATE:	/* set keyboard state (locks) */
1593 	case KDGKBSTATE:	/* get keyboard state (locks) */
1594 	case KDGETREPEAT:	/* get keyboard repeat & delay rates */
1595 	case KDSETREPEAT:	/* set keyboard repeat & delay rates (new) */
1596 	case KDSETLED:		/* set keyboard LED status */
1597 	case KDGETLED:		/* get keyboard LED status */
1598 	case KBADDKBD:		/* add/remove keyboard to/from mux */
1599 	case KBRELKBD: {
1600 		error = 0;
1601 
1602 		mtx_lock(&Giant);
1603 		kbd = kbd_get_keyboard(vd->vd_keyboard);
1604 		if (kbd != NULL)
1605 			error = kbdd_ioctl(kbd, cmd, data);
1606 		mtx_unlock(&Giant);
1607 		if (error == ENOIOCTL) {
1608 			if (cmd == KDGKBTYPE) {
1609 				/* always return something? XXX */
1610 				*(int *)data = 0;
1611 			} else {
1612 				return (ENODEV);
1613 			}
1614 		}
1615 		return (error);
1616 	}
1617 	case KDGKBMODE: {
1618 		int mode = -1;
1619 
1620 		mtx_lock(&Giant);
1621 		kbd = kbd_get_keyboard(vd->vd_keyboard);
1622 		if (kbd != NULL) {
1623 			kbdd_ioctl(kbd, KDGKBMODE, (void *)&mode);
1624 		}
1625 		mtx_unlock(&Giant);
1626 		DPRINTF(20, "mode %d, vw_kbdmode %d\n", mode, vw->vw_kbdmode);
1627 		*(int *)data = mode;
1628 		return (0);
1629 	}
1630 	case KDSKBMODE: {
1631 		int mode;
1632 
1633 		mode = *(int *)data;
1634 		switch (mode) {
1635 		case K_XLATE:
1636 		case K_RAW:
1637 		case K_CODE:
1638 			vw->vw_kbdmode = mode;
1639 			if (vw == vd->vd_curwindow) {
1640 				keyboard_t *kbd;
1641 				error = 0;
1642 
1643 				mtx_lock(&Giant);
1644 				kbd = kbd_get_keyboard(vd->vd_keyboard);
1645 				if (kbd != NULL) {
1646 					error = kbdd_ioctl(kbd, KDSKBMODE,
1647 					    (void *)&mode);
1648 				}
1649 				mtx_unlock(&Giant);
1650 			}
1651 			return (0);
1652 		default:
1653 			return (EINVAL);
1654 		}
1655 	}
1656 	case FBIOGTYPE:
1657 	case FBIO_GETWINORG:	/* get frame buffer window origin */
1658 	case FBIO_GETDISPSTART:	/* get display start address */
1659 	case FBIO_GETLINEWIDTH:	/* get scan line width in bytes */
1660 	case FBIO_BLANK:	/* blank display */
1661 		if (vd->vd_driver->vd_fb_ioctl)
1662 			return (vd->vd_driver->vd_fb_ioctl(vd, cmd, data, td));
1663 		break;
1664 	case CONS_BLANKTIME:
1665 		/* XXX */
1666 		return (0);
1667 	case CONS_GET:
1668 		/* XXX */
1669 		*(int *)data = M_CG640x480;
1670 		return (0);
1671 	case CONS_BELLTYPE: 	/* set bell type sound */
1672 		if ((*(int *)data) & CONS_QUIET_BELL)
1673 			vd->vd_flags |= VDF_QUIET_BELL;
1674 		else
1675 			vd->vd_flags &= ~VDF_QUIET_BELL;
1676 		return (0);
1677 	case CONS_GETINFO: {
1678 		vid_info_t *vi = (vid_info_t *)data;
1679 
1680 		vi->m_num = vd->vd_curwindow->vw_number + 1;
1681 		/* XXX: other fields! */
1682 		return (0);
1683 	}
1684 	case CONS_GETVERS:
1685 		*(int *)data = 0x200;
1686 		return (0);
1687 	case CONS_MODEINFO:
1688 		/* XXX */
1689 		return (0);
1690 	case CONS_MOUSECTL: {
1691 		mouse_info_t *mouse = (mouse_info_t*)data;
1692 
1693 		/*
1694 		 * This has no effect on vt(4).  We don't draw any mouse
1695 		 * cursor.  Just ignore MOUSE_HIDE and MOUSE_SHOW to
1696 		 * prevent excessive errors.  All the other commands
1697 		 * should not be applied to individual TTYs, but only to
1698 		 * consolectl.
1699 		 */
1700 		switch (mouse->operation) {
1701 		case MOUSE_HIDE:
1702 			vd->vd_flags &= ~VDF_MOUSECURSOR;
1703 			return (0);
1704 		case MOUSE_SHOW:
1705 			vd->vd_mx = vd->vd_width / 2;
1706 			vd->vd_my = vd->vd_height / 2;
1707 			vd->vd_flags |= VDF_MOUSECURSOR;
1708 			return (0);
1709 		default:
1710 			return (EINVAL);
1711 		}
1712 	}
1713 	case PIO_VFONT: {
1714 		struct vt_font *vf;
1715 
1716 		error = vtfont_load((void *)data, &vf);
1717 		if (error != 0)
1718 			return (error);
1719 
1720 		error = vt_change_font(vw, vf);
1721 		if (error == 0) {
1722 			/* XXX: replace 0 with current bg color. */
1723 			vt_set_border(vw, vf, 0);
1724 		}
1725 		vtfont_unref(vf);
1726 		return (error);
1727 	}
1728 	case GIO_SCRNMAP: {
1729 		scrmap_t *sm = (scrmap_t *)data;
1730 		int i;
1731 
1732 		/* We don't have screen maps, so return a handcrafted one. */
1733 		for (i = 0; i < 256; i++)
1734 			sm->scrmap[i] = i;
1735 		return (0);
1736 	}
1737 	case KDSETMODE:
1738 		/* XXX */
1739 		return (0);
1740 	case KDENABIO:      	/* allow io operations */
1741 		error = priv_check(td, PRIV_IO);
1742 		if (error != 0)
1743 			return (error);
1744 		error = securelevel_gt(td->td_ucred, 0);
1745 		if (error != 0)
1746 			return (error);
1747 #if defined(__i386__)
1748 		td->td_frame->tf_eflags |= PSL_IOPL;
1749 #elif defined(__amd64__)
1750 		td->td_frame->tf_rflags |= PSL_IOPL;
1751 #endif
1752 		return (0);
1753 	case KDDISABIO:     	/* disallow io operations (default) */
1754 #if defined(__i386__)
1755 		td->td_frame->tf_eflags &= ~PSL_IOPL;
1756 #elif defined(__amd64__)
1757 		td->td_frame->tf_rflags &= ~PSL_IOPL;
1758 #endif
1759 		return (0);
1760 	case KDMKTONE:      	/* sound the bell */
1761 		vtterm_beep(tm, *(u_int *)data);
1762 		return (0);
1763 	case KIOCSOUND:     	/* make tone (*data) hz */
1764 		/* TODO */
1765 		return (0);
1766 	case CONS_SETKBD: 		/* set the new keyboard */
1767 		mtx_lock(&Giant);
1768 		error = 0;
1769 		if (vd->vd_keyboard != *(int *)data) {
1770 			kbd = kbd_get_keyboard(*(int *)data);
1771 			if (kbd == NULL) {
1772 				mtx_unlock(&Giant);
1773 				return (EINVAL);
1774 			}
1775 			i = kbd_allocate(kbd->kb_name, kbd->kb_unit,
1776 			    (void *)&vd->vd_keyboard, vt_kbdevent, vd);
1777 			if (i >= 0) {
1778 				if (vd->vd_keyboard != -1) {
1779 					kbd_release(kbd,
1780 					    (void *)&vd->vd_keyboard);
1781 				}
1782 				kbd = kbd_get_keyboard(i);
1783 				vd->vd_keyboard = i;
1784 
1785 				(void)kbdd_ioctl(kbd, KDSKBMODE,
1786 				    (caddr_t)&vd->vd_curwindow->vw_kbdmode);
1787 			} else {
1788 				error = EPERM;	/* XXX */
1789 			}
1790 		}
1791 		mtx_unlock(&Giant);
1792 		return (error);
1793 	case CONS_RELKBD: 		/* release the current keyboard */
1794 		mtx_lock(&Giant);
1795 		error = 0;
1796 		if (vd->vd_keyboard != -1) {
1797 			kbd = kbd_get_keyboard(vd->vd_keyboard);
1798 			if (kbd == NULL) {
1799 				mtx_unlock(&Giant);
1800 				return (EINVAL);
1801 			}
1802 			error = kbd_release(kbd, (void *)&vd->vd_keyboard);
1803 			if (error == 0) {
1804 				vd->vd_keyboard = -1;
1805 			}
1806 		}
1807 		mtx_unlock(&Giant);
1808 		return (error);
1809 	case VT_ACTIVATE: {
1810 		int win;
1811 		win = *(int *)data - 1;
1812 		DPRINTF(5, "%s%d: VT_ACTIVATE ttyv%d ", SC_DRIVER_NAME,
1813 		    VT_UNIT(vw), win);
1814 		if ((win > VT_MAXWINDOWS) || (win < 0))
1815 			return (EINVAL);
1816 		return (vt_proc_window_switch(vd->vd_windows[win]));
1817 	}
1818 	case VT_GETACTIVE:
1819 		*(int *)data = vd->vd_curwindow->vw_number + 1;
1820 		return (0);
1821 	case VT_GETINDEX:
1822 		*(int *)data = vw->vw_number + 1;
1823 		return (0);
1824 	case VT_LOCKSWITCH:
1825 		/* TODO: Check current state, switching can be in progress. */
1826 		if ((*(int *)data) == 0x01)
1827 			vw->vw_flags |= VWF_VTYLOCK;
1828 		else if ((*(int *)data) == 0x02)
1829 			vw->vw_flags &= ~VWF_VTYLOCK;
1830 		else
1831 			return (EINVAL);
1832 		return (0);
1833 	case VT_OPENQRY:
1834 		VT_LOCK(vd);
1835 		for (i = 0; i < VT_MAXWINDOWS; i++) {
1836 			vw = vd->vd_windows[i];
1837 			if (vw == NULL)
1838 				continue;
1839 			if (!(vw->vw_flags & VWF_OPENED)) {
1840 				*(int *)data = vw->vw_number + 1;
1841 				VT_UNLOCK(vd);
1842 				return (0);
1843 			}
1844 		}
1845 		VT_UNLOCK(vd);
1846 		return (EINVAL);
1847 	case VT_WAITACTIVE:
1848 		error = 0;
1849 
1850 		i = *(unsigned int *)data;
1851 		if (i > VT_MAXWINDOWS)
1852 			return (EINVAL);
1853 		if (i != 0)
1854 			vw = vd->vd_windows[i - 1];
1855 
1856 		VT_LOCK(vd);
1857 		while (vd->vd_curwindow != vw && error == 0)
1858 			error = cv_wait_sig(&vd->vd_winswitch, &vd->vd_lock);
1859 		VT_UNLOCK(vd);
1860 		return (error);
1861 	case VT_SETMODE: {    	/* set screen switcher mode */
1862 		struct vt_mode *mode;
1863 		struct proc *p1;
1864 
1865 		mode = (struct vt_mode *)data;
1866 		DPRINTF(5, "%s%d: VT_SETMODE ", SC_DRIVER_NAME, VT_UNIT(vw));
1867 		if (vw->vw_smode.mode == VT_PROCESS) {
1868 			p1 = pfind(vw->vw_pid);
1869 			if (vw->vw_proc == p1 && vw->vw_proc != td->td_proc) {
1870 				if (p1)
1871 					PROC_UNLOCK(p1);
1872 				DPRINTF(5, "error EPERM\n");
1873 				return (EPERM);
1874 			}
1875 			if (p1)
1876 				PROC_UNLOCK(p1);
1877 		}
1878 		if (mode->mode == VT_AUTO) {
1879 			vw->vw_smode.mode = VT_AUTO;
1880 			vw->vw_proc = NULL;
1881 			vw->vw_pid = 0;
1882 			DPRINTF(5, "VT_AUTO, ");
1883 			if (vw == vw->vw_device->vd_windows[VT_CONSWINDOW])
1884 				cnavailable(vw->vw_terminal->consdev, TRUE);
1885 			/* were we in the middle of the vty switching process? */
1886 			if (finish_vt_rel(vw, TRUE, &s) == 0)
1887 				DPRINTF(5, "reset WAIT_REL, ");
1888 			if (finish_vt_acq(vw) == 0)
1889 				DPRINTF(5, "reset WAIT_ACQ, ");
1890 			return (0);
1891 		} else if (mode->mode == VT_PROCESS) {
1892 			if (!ISSIGVALID(mode->relsig) ||
1893 			    !ISSIGVALID(mode->acqsig) ||
1894 			    !ISSIGVALID(mode->frsig)) {
1895 				DPRINTF(5, "error EINVAL\n");
1896 				return (EINVAL);
1897 			}
1898 			DPRINTF(5, "VT_PROCESS %d, ", td->td_proc->p_pid);
1899 			bcopy(data, &vw->vw_smode, sizeof(struct vt_mode));
1900 			vw->vw_proc = td->td_proc;
1901 			vw->vw_pid = vw->vw_proc->p_pid;
1902 			if (vw == vw->vw_device->vd_windows[VT_CONSWINDOW])
1903 				cnavailable(vw->vw_terminal->consdev, FALSE);
1904 		} else {
1905 			DPRINTF(5, "VT_SETMODE failed, unknown mode %d\n",
1906 			    mode->mode);
1907 			return (EINVAL);
1908 		}
1909 		DPRINTF(5, "\n");
1910 		return (0);
1911 	}
1912 	case VT_GETMODE:	/* get screen switcher mode */
1913 		bcopy(&vw->vw_smode, data, sizeof(struct vt_mode));
1914 		return (0);
1915 
1916 	case VT_RELDISP:	/* screen switcher ioctl */
1917 		/*
1918 		 * This must be the current vty which is in the VT_PROCESS
1919 		 * switching mode...
1920 		 */
1921 		if ((vw != vd->vd_curwindow) || (vw->vw_smode.mode !=
1922 		    VT_PROCESS)) {
1923 			return (EINVAL);
1924 		}
1925 		/* ...and this process is controlling it. */
1926 		if (vw->vw_proc != td->td_proc) {
1927 			return (EPERM);
1928 		}
1929 		error = EINVAL;
1930 		switch(*(int *)data) {
1931 		case VT_FALSE:	/* user refuses to release screen, abort */
1932 			if ((error = finish_vt_rel(vw, FALSE, &s)) == 0)
1933 				DPRINTF(5, "%s%d: VT_RELDISP: VT_FALSE\n",
1934 				    SC_DRIVER_NAME, VT_UNIT(vw));
1935 			break;
1936 		case VT_TRUE:	/* user has released screen, go on */
1937 			/* finish_vt_rel(..., TRUE, ...) should not be locked */
1938 			if (vw->vw_flags & VWF_SWWAIT_REL) {
1939 				if ((error = finish_vt_rel(vw, TRUE, &s)) == 0)
1940 					DPRINTF(5, "%s%d: VT_RELDISP: VT_TRUE\n",
1941 					    SC_DRIVER_NAME, VT_UNIT(vw));
1942 			} else {
1943 				error = EINVAL;
1944 			}
1945 			return (error);
1946 		case VT_ACKACQ:	/* acquire acknowledged, switch completed */
1947 			if ((error = finish_vt_acq(vw)) == 0)
1948 				DPRINTF(5, "%s%d: VT_RELDISP: VT_ACKACQ\n",
1949 				    SC_DRIVER_NAME, VT_UNIT(vw));
1950 			break;
1951 		default:
1952 			break;
1953 		}
1954 		return (error);
1955 	}
1956 
1957 	return (ENOIOCTL);
1958 }
1959 
1960 static struct vt_window *
1961 vt_allocate_window(struct vt_device *vd, unsigned int window)
1962 {
1963 	struct vt_window *vw;
1964 	struct terminal *tm;
1965 	term_pos_t size;
1966 	struct winsize wsz;
1967 
1968 	vw = malloc(sizeof *vw, M_VT, M_WAITOK|M_ZERO);
1969 	vw->vw_device = vd;
1970 	vw->vw_number = window;
1971 	vw->vw_kbdmode = K_XLATE;
1972 
1973 	if (!(vd->vd_flags & VDF_TEXTMODE))
1974 		vw->vw_font = vtfont_ref(&vt_font_default);
1975 
1976 	vt_termsize(vd, vw->vw_font, &size);
1977 	vt_winsize(vd, vw->vw_font, &wsz);
1978 	vtbuf_init(&vw->vw_buf, &size);
1979 
1980 	tm = vw->vw_terminal = terminal_alloc(&vt_termclass, vw);
1981 	terminal_set_winsize(tm, &wsz);
1982 	vd->vd_windows[window] = vw;
1983 	callout_init(&vw->vw_proc_dead_timer, 0);
1984 
1985 	return (vw);
1986 }
1987 
1988 void
1989 vt_upgrade(struct vt_device *vd)
1990 {
1991 	struct vt_window *vw;
1992 	unsigned int i;
1993 
1994 	for (i = 0; i < VT_MAXWINDOWS; i++) {
1995 		vw = vd->vd_windows[i];
1996 		if (vw == NULL) {
1997 			/* New window. */
1998 			vw = vt_allocate_window(vd, i);
1999 		}
2000 		if (!(vw->vw_flags & VWF_READY)) {
2001 			callout_init(&vw->vw_proc_dead_timer, 0);
2002 			terminal_maketty(vw->vw_terminal, "v%r", VT_UNIT(vw));
2003 			vw->vw_flags |= VWF_READY;
2004 			if (vw->vw_flags & VWF_CONSOLE) {
2005 				/* For existing console window. */
2006 				EVENTHANDLER_REGISTER(shutdown_pre_sync,
2007 				    vt_window_switch, vw, SHUTDOWN_PRI_DEFAULT);
2008 			}
2009 		}
2010 
2011 	}
2012 	VT_LOCK(vd);
2013 	if (vd->vd_curwindow == NULL)
2014 		vd->vd_curwindow = vd->vd_windows[VT_CONSWINDOW];
2015 
2016 	if (!(vd->vd_flags & VDF_ASYNC)) {
2017 	/* Attach keyboard. */
2018 	vt_allocate_keyboard(vd);
2019 	DPRINTF(20, "%s: vd_keyboard = %d\n", __func__, vd->vd_keyboard);
2020 
2021 		/* Init 25 Hz timer. */
2022 		callout_init_mtx(&vd->vd_timer, &vd->vd_lock, 0);
2023 
2024 		/* Start timer when everything ready. */
2025 		vd->vd_flags |= VDF_ASYNC;
2026 		callout_reset(&vd->vd_timer, hz / VT_TIMERFREQ, vt_timer, vd);
2027 	}
2028 
2029 	VT_UNLOCK(vd);
2030 
2031 	/* Refill settings with new sizes. */
2032 	vt_resize(vd);
2033 }
2034 
2035 static void
2036 vt_resize(struct vt_device *vd)
2037 {
2038 	struct vt_window *vw;
2039 	int i;
2040 
2041 	for (i = 0; i < VT_MAXWINDOWS; i++) {
2042 		vw = vd->vd_windows[i];
2043 		VT_LOCK(vd);
2044 		/* Assign default font to window, if not textmode. */
2045 		if (!(vd->vd_flags & VDF_TEXTMODE) && vw->vw_font == NULL)
2046 			vw->vw_font = vtfont_ref(&vt_font_default);
2047 		VT_UNLOCK(vd);
2048 		/* Resize terminal windows */
2049 		vt_change_font(vw, vw->vw_font);
2050 	}
2051 }
2052 
2053 void
2054 vt_allocate(struct vt_driver *drv, void *softc)
2055 {
2056 	struct vt_device *vd;
2057 	struct winsize wsz;
2058 
2059 	if (main_vd->vd_driver == NULL) {
2060 		main_vd->vd_driver = drv;
2061 		printf("VT: initialize with new VT driver \"%s\".\n",
2062 		    drv->vd_name);
2063 	} else {
2064 		/*
2065 		 * Check if have rights to replace current driver. For example:
2066 		 * it is bad idea to replace KMS driver with generic VGA one.
2067 		 */
2068 		if (drv->vd_priority <= main_vd->vd_driver->vd_priority) {
2069 			printf("VT: Driver priority %d too low. Current %d\n ",
2070 			    drv->vd_priority, main_vd->vd_driver->vd_priority);
2071 			return;
2072 		}
2073 		printf("VT: Replacing driver \"%s\" with new \"%s\".\n",
2074 		    main_vd->vd_driver->vd_name, drv->vd_name);
2075 	}
2076 	vd = main_vd;
2077 	VT_LOCK(vd);
2078 	if (drv->vd_maskbitbltchr == NULL)
2079 		drv->vd_maskbitbltchr = drv->vd_bitbltchr;
2080 
2081 	if (vd->vd_flags & VDF_ASYNC) {
2082 		/* Stop vt_flush periodic task. */
2083 		callout_drain(&vd->vd_timer);
2084 		/*
2085 		 * Mute current terminal until we done. vt_change_font (called
2086 		 * from vt_resize) will unmute it.
2087 		 */
2088 		terminal_mute(vd->vd_curwindow->vw_terminal, 1);
2089 	}
2090 
2091 	/*
2092 	 * Reset VDF_TEXTMODE flag, driver who require that flag (vt_vga) will
2093 	 * set it.
2094 	 */
2095 	vd->vd_flags &= ~VDF_TEXTMODE;
2096 
2097 	vd->vd_driver = drv;
2098 	vd->vd_softc = softc;
2099 	vd->vd_driver->vd_init(vd);
2100 	VT_UNLOCK(vd);
2101 
2102 	vt_upgrade(vd);
2103 
2104 #ifdef DEV_SPLASH
2105 	if (vd->vd_flags & VDF_SPLASH)
2106 		vtterm_splash(vd);
2107 #endif
2108 
2109 	if (vd->vd_flags & VDF_ASYNC) {
2110 		terminal_mute(vd->vd_curwindow->vw_terminal, 0);
2111 		callout_schedule(&vd->vd_timer, hz / VT_TIMERFREQ);
2112 	}
2113 
2114 	termcn_cnregister(vd->vd_windows[VT_CONSWINDOW]->vw_terminal);
2115 
2116 	/* Update console window sizes to actual. */
2117 	vt_winsize(vd, vd->vd_windows[VT_CONSWINDOW]->vw_font, &wsz);
2118 	terminal_set_winsize_blank(vd->vd_windows[VT_CONSWINDOW]->vw_terminal,
2119 	    &wsz, 0);
2120 }
2121 
2122 void
2123 vt_suspend()
2124 {
2125 
2126 	if (vt_suspendswitch == 0)
2127 		return;
2128 	/* Save current window. */
2129 	main_vd->vd_savedwindow = main_vd->vd_curwindow;
2130 	/* Ask holding process to free window and switch to console window */
2131 	vt_proc_window_switch(main_vd->vd_windows[VT_CONSWINDOW]);
2132 }
2133 
2134 void
2135 vt_resume()
2136 {
2137 
2138 	if (vt_suspendswitch == 0)
2139 		return;
2140 	/* Switch back to saved window */
2141 	if (main_vd->vd_savedwindow != NULL)
2142 		vt_proc_window_switch(main_vd->vd_savedwindow);
2143 	main_vd->vd_savedwindow = NULL;
2144 }
2145