xref: /freebsd-12.1/sys/dev/syscons/syscons.c (revision c43ee887)
1 /*-
2  * Copyright (c) 1992-1998 S�ren Schmidt
3  * All rights reserved.
4  *
5  * This code is derived from software contributed to The DragonFly Project
6  * by Sascha Wildner <[email protected]>
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  *    without modification, immediately at the beginning of the file.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  * 3. The name of the author may not be used to endorse or promote products
18  *    derived from this software without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30  */
31 
32 #include <sys/cdefs.h>
33 __FBSDID("$FreeBSD$");
34 
35 #include "opt_compat.h"
36 #include "opt_syscons.h"
37 #include "opt_splash.h"
38 #include "opt_ddb.h"
39 
40 #include <sys/param.h>
41 #include <sys/systm.h>
42 #include <sys/bus.h>
43 #include <sys/conf.h>
44 #include <sys/cons.h>
45 #include <sys/consio.h>
46 #include <sys/kdb.h>
47 #include <sys/eventhandler.h>
48 #include <sys/fbio.h>
49 #include <sys/kbio.h>
50 #include <sys/kernel.h>
51 #include <sys/lock.h>
52 #include <sys/malloc.h>
53 #include <sys/mutex.h>
54 #include <sys/priv.h>
55 #include <sys/proc.h>
56 #include <sys/random.h>
57 #include <sys/reboot.h>
58 #include <sys/serial.h>
59 #include <sys/signalvar.h>
60 #include <sys/sysctl.h>
61 #include <sys/tty.h>
62 #include <sys/power.h>
63 
64 #include <machine/clock.h>
65 #if defined(__sparc64__) || defined(__powerpc__)
66 #include <machine/sc_machdep.h>
67 #else
68 #include <machine/pc/display.h>
69 #endif
70 #if defined( __i386__) || defined(__amd64__)
71 #include <machine/psl.h>
72 #include <machine/frame.h>
73 #endif
74 #include <machine/stdarg.h>
75 
76 #include <dev/kbd/kbdreg.h>
77 #include <dev/fb/fbreg.h>
78 #include <dev/fb/splashreg.h>
79 #include <dev/syscons/syscons.h>
80 
81 #define COLD 0
82 #define WARM 1
83 
84 #define DEFAULT_BLANKTIME	(5*60)		/* 5 minutes */
85 #define MAX_BLANKTIME		(7*24*60*60)	/* 7 days!? */
86 
87 #define KEYCODE_BS		0x0e		/* "<-- Backspace" key, XXX */
88 
89 typedef struct default_attr {
90 	int		std_color;		/* normal hardware color */
91 	int		rev_color;		/* reverse hardware color */
92 } default_attr;
93 
94 static default_attr user_default = {
95     SC_NORM_ATTR,
96     SC_NORM_REV_ATTR,
97 };
98 
99 static	int		sc_console_unit = -1;
100 static	int		sc_saver_keyb_only = 1;
101 static  scr_stat    	*sc_console;
102 static  struct consdev	*sc_consptr;
103 static	scr_stat	main_console;
104 static	struct tty 	*main_devs[MAXCONS];
105 
106 static  char        	init_done = COLD;
107 static  char		shutdown_in_progress = FALSE;
108 static	char		sc_malloc = FALSE;
109 
110 static	int		saver_mode = CONS_NO_SAVER; /* LKM/user saver */
111 static	int		run_scrn_saver = FALSE;	/* should run the saver? */
112 static	int		enable_bell = TRUE; /* enable beeper */
113 
114 #ifndef SC_DISABLE_REBOOT
115 static  int		enable_reboot = TRUE; /* enable keyboard reboot */
116 #endif
117 
118 #ifndef SC_DISABLE_KDBKEY
119 static  int		enable_kdbkey = TRUE; /* enable keyboard debug */
120 #endif
121 
122 static	long        	scrn_blank_time = 0;    /* screen saver timeout value */
123 #ifdef DEV_SPLASH
124 static	int     	scrn_blanked;		/* # of blanked screen */
125 static	int		sticky_splash = FALSE;
126 
127 static	void		none_saver(sc_softc_t *sc, int blank) { }
128 static	void		(*current_saver)(sc_softc_t *, int) = none_saver;
129 #endif
130 
131 SYSCTL_NODE(_hw, OID_AUTO, syscons, CTLFLAG_RD, 0, "syscons");
132 SYSCTL_NODE(_hw_syscons, OID_AUTO, saver, CTLFLAG_RD, 0, "saver");
133 SYSCTL_INT(_hw_syscons_saver, OID_AUTO, keybonly, CTLFLAG_RW,
134     &sc_saver_keyb_only, 0, "screen saver interrupted by input only");
135 SYSCTL_INT(_hw_syscons, OID_AUTO, bell, CTLFLAG_RW, &enable_bell,
136     0, "enable bell");
137 #ifndef SC_DISABLE_REBOOT
138 SYSCTL_INT(_hw_syscons, OID_AUTO, kbd_reboot, CTLFLAG_RW|CTLFLAG_SECURE, &enable_reboot,
139     0, "enable keyboard reboot");
140 #endif
141 #ifndef SC_DISABLE_KDBKEY
142 SYSCTL_INT(_hw_syscons, OID_AUTO, kbd_debug, CTLFLAG_RW|CTLFLAG_SECURE, &enable_kdbkey,
143     0, "enable keyboard debug");
144 #endif
145 #if !defined(SC_NO_FONT_LOADING) && defined(SC_DFLT_FONT)
146 #include "font.h"
147 #endif
148 
149 	tsw_ioctl_t	*sc_user_ioctl;
150 
151 static	bios_values_t	bios_value;
152 
153 static	int		enable_panic_key;
154 SYSCTL_INT(_machdep, OID_AUTO, enable_panic_key, CTLFLAG_RW, &enable_panic_key,
155 	   0, "Enable panic via keypress specified in kbdmap(5)");
156 
157 #define SC_CONSOLECTL	255
158 
159 #define VTY_WCHAN(sc, vty) (&SC_DEV(sc, vty))
160 
161 static	int		debugger;
162 
163 /* prototypes */
164 static int sc_allocate_keyboard(sc_softc_t *sc, int unit);
165 static int scvidprobe(int unit, int flags, int cons);
166 static int sckbdprobe(int unit, int flags, int cons);
167 static void scmeminit(void *arg);
168 static int scdevtounit(struct tty *tp);
169 static kbd_callback_func_t sckbdevent;
170 static void scinit(int unit, int flags);
171 static scr_stat *sc_get_stat(struct tty *tp);
172 static void scterm(int unit, int flags);
173 static void scshutdown(void *arg, int howto);
174 static u_int scgetc(sc_softc_t *sc, u_int flags);
175 #define SCGETC_CN	1
176 #define SCGETC_NONBLOCK	2
177 static void sccnupdate(scr_stat *scp);
178 static scr_stat *alloc_scp(sc_softc_t *sc, int vty);
179 static void init_scp(sc_softc_t *sc, int vty, scr_stat *scp);
180 static timeout_t scrn_timer;
181 static int and_region(int *s1, int *e1, int s2, int e2);
182 static void scrn_update(scr_stat *scp, int show_cursor);
183 
184 #ifdef DEV_SPLASH
185 static int scsplash_callback(int event, void *arg);
186 static void scsplash_saver(sc_softc_t *sc, int show);
187 static int add_scrn_saver(void (*this_saver)(sc_softc_t *, int));
188 static int remove_scrn_saver(void (*this_saver)(sc_softc_t *, int));
189 static int set_scrn_saver_mode(scr_stat *scp, int mode, u_char *pal, int border);
190 static int restore_scrn_saver_mode(scr_stat *scp, int changemode);
191 static void stop_scrn_saver(sc_softc_t *sc, void (*saver)(sc_softc_t *, int));
192 static int wait_scrn_saver_stop(sc_softc_t *sc);
193 #define scsplash_stick(stick)		(sticky_splash = (stick))
194 #else /* !DEV_SPLASH */
195 #define scsplash_stick(stick)
196 #endif /* DEV_SPLASH */
197 
198 static int do_switch_scr(sc_softc_t *sc, int s);
199 static int vt_proc_alive(scr_stat *scp);
200 static int signal_vt_rel(scr_stat *scp);
201 static int signal_vt_acq(scr_stat *scp);
202 static int finish_vt_rel(scr_stat *scp, int release, int *s);
203 static int finish_vt_acq(scr_stat *scp);
204 static void exchange_scr(sc_softc_t *sc);
205 static void update_cursor_image(scr_stat *scp);
206 static void change_cursor_shape(scr_stat *scp, int flags, int base, int height);
207 static int save_kbd_state(scr_stat *scp);
208 static int update_kbd_state(scr_stat *scp, int state, int mask);
209 static int update_kbd_leds(scr_stat *scp, int which);
210 static timeout_t blink_screen;
211 static struct tty *sc_alloc_tty(int, int);
212 
213 static cn_probe_t	sc_cnprobe;
214 static cn_init_t	sc_cninit;
215 static cn_term_t	sc_cnterm;
216 static cn_getc_t	sc_cngetc;
217 static cn_putc_t	sc_cnputc;
218 
219 CONSOLE_DRIVER(sc);
220 
221 static	tsw_open_t	sctty_open;
222 static	tsw_close_t	sctty_close;
223 static	tsw_outwakeup_t	sctty_outwakeup;
224 static	tsw_ioctl_t	sctty_ioctl;
225 static	tsw_mmap_t	sctty_mmap;
226 
227 static struct ttydevsw sc_ttydevsw = {
228 	.tsw_open	= sctty_open,
229 	.tsw_close	= sctty_close,
230 	.tsw_outwakeup	= sctty_outwakeup,
231 	.tsw_ioctl	= sctty_ioctl,
232 	.tsw_mmap	= sctty_mmap,
233 };
234 
235 static d_ioctl_t	consolectl_ioctl;
236 
237 static struct cdevsw consolectl_devsw = {
238 	.d_version	= D_VERSION,
239 	.d_flags	= D_NEEDGIANT,
240 	.d_ioctl	= consolectl_ioctl,
241 	.d_name		= "consolectl",
242 };
243 
244 int
245 sc_probe_unit(int unit, int flags)
246 {
247     if (!scvidprobe(unit, flags, FALSE)) {
248 	if (bootverbose)
249 	    printf("%s%d: no video adapter found.\n", SC_DRIVER_NAME, unit);
250 	return ENXIO;
251     }
252 
253     /* syscons will be attached even when there is no keyboard */
254     sckbdprobe(unit, flags, FALSE);
255 
256     return 0;
257 }
258 
259 /* probe video adapters, return TRUE if found */
260 static int
261 scvidprobe(int unit, int flags, int cons)
262 {
263     /*
264      * Access the video adapter driver through the back door!
265      * Video adapter drivers need to be configured before syscons.
266      * However, when syscons is being probed as the low-level console,
267      * they have not been initialized yet.  We force them to initialize
268      * themselves here. XXX
269      */
270     vid_configure(cons ? VIO_PROBE_ONLY : 0);
271 
272     return (vid_find_adapter("*", unit) >= 0);
273 }
274 
275 /* probe the keyboard, return TRUE if found */
276 static int
277 sckbdprobe(int unit, int flags, int cons)
278 {
279     /* access the keyboard driver through the backdoor! */
280     kbd_configure(cons ? KB_CONF_PROBE_ONLY : 0);
281 
282     return (kbd_find_keyboard("*", unit) >= 0);
283 }
284 
285 static char
286 *adapter_name(video_adapter_t *adp)
287 {
288     static struct {
289 	int type;
290 	char *name[2];
291     } names[] = {
292 	{ KD_MONO,	{ "MDA",	"MDA" } },
293 	{ KD_HERCULES,	{ "Hercules",	"Hercules" } },
294 	{ KD_CGA,	{ "CGA",	"CGA" } },
295 	{ KD_EGA,	{ "EGA",	"EGA (mono)" } },
296 	{ KD_VGA,	{ "VGA",	"VGA (mono)" } },
297 	{ KD_PC98,	{ "PC-98x1",	"PC-98x1" } },
298 	{ KD_TGA,	{ "TGA",	"TGA" } },
299 	{ -1,		{ "Unknown",	"Unknown" } },
300     };
301     int i;
302 
303     for (i = 0; names[i].type != -1; ++i)
304 	if (names[i].type == adp->va_type)
305 	    break;
306     return names[i].name[(adp->va_flags & V_ADP_COLOR) ? 0 : 1];
307 }
308 
309 static void
310 sctty_outwakeup(struct tty *tp)
311 {
312     size_t len;
313     u_char buf[PCBURST];
314     scr_stat *scp = sc_get_stat(tp);
315 
316     if (scp->status & SLKED ||
317 	(scp == scp->sc->cur_scp && scp->sc->blink_in_progress))
318 	return;
319 
320     for (;;) {
321 	len = ttydisc_getc(tp, buf, sizeof buf);
322 	if (len == 0)
323 	    break;
324 	sc_puts(scp, buf, len, 0);
325     }
326 }
327 
328 static struct tty *
329 sc_alloc_tty(int index, int devnum)
330 {
331 	struct sc_ttysoftc *stc;
332 	struct tty *tp;
333 
334 	/* Allocate TTY object and softc to store unit number. */
335 	stc = malloc(sizeof(struct sc_ttysoftc), M_DEVBUF, M_WAITOK);
336 	stc->st_index = index;
337 	stc->st_stat = NULL;
338 	tp = tty_alloc_mutex(&sc_ttydevsw, stc, &Giant);
339 
340 	/* Create device node. */
341 	tty_makedev(tp, NULL, "v%r", devnum);
342 
343 	return (tp);
344 }
345 
346 #ifdef SC_PIXEL_MODE
347 static int
348 sc_initial_mode(video_adapter_t *adp, int unit)
349 {
350 	video_info_t info;
351 	int depth, vmode;
352 	int i;
353 
354 	vmode = 0;
355 	(void)resource_int_value("sc", unit, "vesa_mode", &vmode);
356 	if (vmode < M_VESA_BASE || vmode > M_VESA_MODE_MAX)
357 	    vmode = 0;
358 
359 	/*
360 	 * If the default mode is not supported, search for an available
361 	 * 800x600 graphics mode with the highest color depth.
362 	 */
363 	if (vmode == 0 || vidd_get_info(adp, vmode, &info) != 0) {
364 	    depth = vmode = 0;
365 	    for (i = M_VESA_BASE; i <= M_VESA_MODE_MAX; i++)
366 		if (vidd_get_info(adp, i, &info) == 0 &&
367 		    (info.vi_flags & V_INFO_GRAPHICS) != 0 &&
368 		    info.vi_width == 800 && info.vi_height == 600 &&
369 		    info.vi_depth > depth) {
370 			vmode = i;
371 			depth = info.vi_depth;
372 		}
373 	}
374 
375 	return (vmode);
376 }
377 #endif
378 
379 int
380 sc_attach_unit(int unit, int flags)
381 {
382     sc_softc_t *sc;
383     scr_stat *scp;
384     int vc;
385     struct cdev *dev;
386 
387     flags &= ~SC_KERNEL_CONSOLE;
388 
389     if (sc_console_unit == unit) {
390 	/*
391 	 * If this unit is being used as the system console, we need to
392 	 * adjust some variables and buffers before and after scinit().
393 	 */
394 	/* assert(sc_console != NULL) */
395 	flags |= SC_KERNEL_CONSOLE;
396 	scmeminit(NULL);
397     }
398     scinit(unit, flags);
399 
400     sc = sc_get_softc(unit, flags & SC_KERNEL_CONSOLE);
401     sc->config = flags;
402     scp = sc_get_stat(sc->dev[0]);
403     if (sc_console == NULL)	/* sc_console_unit < 0 */
404 	sc_console = scp;
405 
406 #ifdef SC_PIXEL_MODE
407     if ((sc->config & SC_VESAMODE) != 0) {
408 	int vmode;
409 	vmode = sc_initial_mode(sc->adp, unit);
410 	if (vmode >= M_VESA_BASE) {
411 #ifdef DEV_SPLASH
412 	    if (sc->flags & SC_SPLASH_SCRN)
413 		splash_term(sc->adp);
414 #endif
415 	    sc_set_graphics_mode(scp, NULL, vmode);
416 	    sc_set_pixel_mode(scp, NULL, 0, 0, 16, 8);
417 #ifndef SC_NO_PALETTE_LOADING
418 	    vidd_save_palette(sc->adp, sc->palette);
419 #endif
420 	    sc->initial_mode = vmode;
421 #ifdef DEV_SPLASH
422 	    /* put up the splash again! */
423 	    if (sc->flags & SC_SPLASH_SCRN)
424 		splash_init(sc->adp, scsplash_callback, sc);
425 #endif
426 	}
427     }
428 #endif /* SC_PIXEL_MODE */
429 
430     /* initialize cursor */
431     if (!ISGRAPHSC(scp))
432     	update_cursor_image(scp);
433 
434     /* get screen update going */
435     scrn_timer(sc);
436 
437     /* set up the keyboard */
438     kbdd_ioctl(sc->kbd, KDSKBMODE, (caddr_t)&scp->kbd_mode);
439     update_kbd_state(scp, scp->status, LOCK_MASK);
440 
441     printf("%s%d: %s <%d virtual consoles, flags=0x%x>\n",
442 	   SC_DRIVER_NAME, unit, adapter_name(sc->adp), sc->vtys, sc->config);
443     if (bootverbose) {
444 	printf("%s%d:", SC_DRIVER_NAME, unit);
445     	if (sc->adapter >= 0)
446 	    printf(" fb%d", sc->adapter);
447 	if (sc->keyboard >= 0)
448 	    printf(", kbd%d", sc->keyboard);
449 	if (scp->tsw)
450 	    printf(", terminal emulator: %s (%s)",
451 		   scp->tsw->te_name, scp->tsw->te_desc);
452 	printf("\n");
453     }
454 
455     /* register a shutdown callback for the kernel console */
456     if (sc_console_unit == unit)
457 	EVENTHANDLER_REGISTER(shutdown_pre_sync, scshutdown,
458 			      (void *)(uintptr_t)unit, SHUTDOWN_PRI_DEFAULT);
459 
460     for (vc = 0; vc < sc->vtys; vc++) {
461 	if (sc->dev[vc] == NULL) {
462 		sc->dev[vc] = sc_alloc_tty(vc, vc + unit * MAXCONS);
463 		if (vc == 0 && sc->dev == main_devs)
464 			SC_STAT(sc->dev[0]) = &main_console;
465 	}
466 	/*
467 	 * The first vty already has struct tty and scr_stat initialized
468 	 * in scinit().  The other vtys will have these structs when
469 	 * first opened.
470 	 */
471     }
472 
473     dev = make_dev(&consolectl_devsw, 0, UID_ROOT, GID_WHEEL, 0600,
474         "consolectl");
475     dev->si_drv1 = sc->dev[0];
476 
477     return 0;
478 }
479 
480 static void
481 scmeminit(void *arg)
482 {
483     if (sc_malloc)
484 	return;
485     sc_malloc = TRUE;
486 
487     /*
488      * As soon as malloc() becomes functional, we had better allocate
489      * various buffers for the kernel console.
490      */
491 
492     if (sc_console_unit < 0)	/* sc_console == NULL */
493 	return;
494 
495     /* copy the temporary buffer to the final buffer */
496     sc_alloc_scr_buffer(sc_console, FALSE, FALSE);
497 
498 #ifndef SC_NO_CUTPASTE
499     sc_alloc_cut_buffer(sc_console, FALSE);
500 #endif
501 
502 #ifndef SC_NO_HISTORY
503     /* initialize history buffer & pointers */
504     sc_alloc_history_buffer(sc_console, 0, 0, FALSE);
505 #endif
506 }
507 
508 /* XXX */
509 SYSINIT(sc_mem, SI_SUB_KMEM, SI_ORDER_ANY, scmeminit, NULL);
510 
511 static int
512 scdevtounit(struct tty *tp)
513 {
514     int vty = SC_VTY(tp);
515 
516     if (vty == SC_CONSOLECTL)
517 	return ((sc_console != NULL) ? sc_console->sc->unit : -1);
518     else if ((vty < 0) || (vty >= MAXCONS*sc_max_unit()))
519 	return -1;
520     else
521 	return vty/MAXCONS;
522 }
523 
524 static int
525 sctty_open(struct tty *tp)
526 {
527     int unit = scdevtounit(tp);
528     sc_softc_t *sc;
529     scr_stat *scp;
530 #ifndef __sparc64__
531     keyarg_t key;
532 #endif
533 
534     DPRINTF(5, ("scopen: dev:%s, unit:%d, vty:%d\n",
535 		devtoname(tp->t_dev), unit, SC_VTY(tp)));
536 
537     sc = sc_get_softc(unit, (sc_console_unit == unit) ? SC_KERNEL_CONSOLE : 0);
538     if (sc == NULL)
539 	return ENXIO;
540 
541     if (!tty_opened(tp)) {
542         /* Use the current setting of the <-- key as default VERASE. */
543         /* If the Delete key is preferable, an stty is necessary     */
544 #ifndef __sparc64__
545 	if (sc->kbd != NULL) {
546 	    key.keynum = KEYCODE_BS;
547 	    kbdd_ioctl(sc->kbd, GIO_KEYMAPENT, (caddr_t)&key);
548             tp->t_termios.c_cc[VERASE] = key.key.map[0];
549 	}
550 #endif
551     }
552 
553     scp = sc_get_stat(tp);
554     if (scp == NULL) {
555 	scp = SC_STAT(tp) = alloc_scp(sc, SC_VTY(tp));
556 	if (ISGRAPHSC(scp))
557 	    sc_set_pixel_mode(scp, NULL, 0, 0, 16, 8);
558     }
559     if (!tp->t_winsize.ws_col && !tp->t_winsize.ws_row) {
560 	tp->t_winsize.ws_col = scp->xsize;
561 	tp->t_winsize.ws_row = scp->ysize;
562     }
563 
564     return (0);
565 }
566 
567 static void
568 sctty_close(struct tty *tp)
569 {
570     scr_stat *scp;
571     int s;
572 
573     if (SC_VTY(tp) != SC_CONSOLECTL) {
574 	scp = sc_get_stat(tp);
575 	/* were we in the middle of the VT switching process? */
576 	DPRINTF(5, ("sc%d: scclose(), ", scp->sc->unit));
577 	s = spltty();
578 	if ((scp == scp->sc->cur_scp) && (scp->sc->unit == sc_console_unit))
579 	    cnavailable(sc_consptr, TRUE);
580 	if (finish_vt_rel(scp, TRUE, &s) == 0)	/* force release */
581 	    DPRINTF(5, ("reset WAIT_REL, "));
582 	if (finish_vt_acq(scp) == 0)		/* force acknowledge */
583 	    DPRINTF(5, ("reset WAIT_ACQ, "));
584 #ifdef not_yet_done
585 	if (scp == &main_console) {
586 	    scp->pid = 0;
587 	    scp->proc = NULL;
588 	    scp->smode.mode = VT_AUTO;
589 	}
590 	else {
591 	    sc_vtb_destroy(&scp->vtb);
592 #ifndef __sparc64__
593 	    sc_vtb_destroy(&scp->scr);
594 #endif
595 	    sc_free_history_buffer(scp, scp->ysize);
596 	    SC_STAT(tp) = NULL;
597 	    free(scp, M_DEVBUF);
598 	}
599 #else
600 	scp->pid = 0;
601 	scp->proc = NULL;
602 	scp->smode.mode = VT_AUTO;
603 #endif
604 	scp->kbd_mode = K_XLATE;
605 	if (scp == scp->sc->cur_scp)
606 	    kbdd_ioctl(scp->sc->kbd, KDSKBMODE, (caddr_t)&scp->kbd_mode);
607 	DPRINTF(5, ("done.\n"));
608     }
609 }
610 
611 #if 0 /* XXX mpsafetty: fix screensaver. What about outwakeup? */
612 static int
613 scread(struct cdev *dev, struct uio *uio, int flag)
614 {
615     if (!sc_saver_keyb_only)
616 	sc_touch_scrn_saver();
617     return ttyread(dev, uio, flag);
618 }
619 #endif
620 
621 static int
622 sckbdevent(keyboard_t *thiskbd, int event, void *arg)
623 {
624     sc_softc_t *sc;
625     struct tty *cur_tty;
626     int c, error = 0;
627     size_t len;
628     u_char *cp;
629 
630     sc = (sc_softc_t *)arg;
631     /* assert(thiskbd == sc->kbd) */
632 
633     mtx_lock(&Giant);
634 
635     switch (event) {
636     case KBDIO_KEYINPUT:
637 	break;
638     case KBDIO_UNLOADING:
639 	sc->kbd = NULL;
640 	sc->keyboard = -1;
641 	kbd_release(thiskbd, (void *)&sc->keyboard);
642 	goto done;
643     default:
644 	error = EINVAL;
645 	goto done;
646     }
647 
648     /*
649      * Loop while there is still input to get from the keyboard.
650      * I don't think this is nessesary, and it doesn't fix
651      * the Xaccel-2.1 keyboard hang, but it can't hurt.		XXX
652      */
653     while ((c = scgetc(sc, SCGETC_NONBLOCK)) != NOKEY) {
654 
655 	cur_tty = SC_DEV(sc, sc->cur_scp->index);
656 	if (!tty_opened(cur_tty))
657 	    continue;
658 
659 	if ((*sc->cur_scp->tsw->te_input)(sc->cur_scp, c, cur_tty))
660 	    continue;
661 
662 	switch (KEYFLAGS(c)) {
663 	case 0x0000: /* normal key */
664 	    ttydisc_rint(cur_tty, KEYCHAR(c), 0);
665 	    break;
666 	case FKEY:  /* function key, return string */
667 	    cp = kbdd_get_fkeystr(thiskbd, KEYCHAR(c), &len);
668 	    if (cp != NULL)
669 	    	ttydisc_rint_simple(cur_tty, cp, len);
670 	    break;
671 	case MKEY:  /* meta is active, prepend ESC */
672 	    ttydisc_rint(cur_tty, 0x1b, 0);
673 	    ttydisc_rint(cur_tty, KEYCHAR(c), 0);
674 	    break;
675 	case BKEY:  /* backtab fixed sequence (esc [ Z) */
676 	    ttydisc_rint(cur_tty, 0x1b, 0);
677 	    ttydisc_rint(cur_tty, '[', 0);
678 	    ttydisc_rint(cur_tty, 'Z', 0);
679 	    break;
680 	}
681 
682 	ttydisc_rint_done(cur_tty);
683     }
684 
685     sc->cur_scp->status |= MOUSE_HIDDEN;
686 
687 done:
688     mtx_unlock(&Giant);
689     return (error);
690 }
691 
692 static int
693 sctty_ioctl(struct tty *tp, u_long cmd, caddr_t data, struct thread *td)
694 {
695     int error;
696     int i;
697     sc_softc_t *sc;
698     scr_stat *scp;
699     int s;
700 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
701     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
702     int ival;
703 #endif
704 
705     /* If there is a user_ioctl function call that first */
706     if (sc_user_ioctl) {
707 	error = (*sc_user_ioctl)(tp, cmd, data, td);
708 	if (error != ENOIOCTL)
709 	    return error;
710     }
711 
712     error = sc_vid_ioctl(tp, cmd, data, td);
713     if (error != ENOIOCTL)
714 	return error;
715 
716 #ifndef SC_NO_HISTORY
717     error = sc_hist_ioctl(tp, cmd, data, td);
718     if (error != ENOIOCTL)
719 	return error;
720 #endif
721 
722 #ifndef SC_NO_SYSMOUSE
723     error = sc_mouse_ioctl(tp, cmd, data, td);
724     if (error != ENOIOCTL)
725 	return error;
726 #endif
727 
728     scp = sc_get_stat(tp);
729     /* assert(scp != NULL) */
730     /* scp is sc_console, if SC_VTY(dev) == SC_CONSOLECTL. */
731     sc = scp->sc;
732 
733     if (scp->tsw) {
734 	error = (*scp->tsw->te_ioctl)(scp, tp, cmd, data, td);
735 	if (error != ENOIOCTL)
736 	    return error;
737     }
738 
739     switch (cmd) {  		/* process console hardware related ioctl's */
740 
741     case GIO_ATTR:      	/* get current attributes */
742 	/* this ioctl is not processed here, but in the terminal emulator */
743 	return ENOTTY;
744 
745     case GIO_COLOR:     	/* is this a color console ? */
746 	*(int *)data = (sc->adp->va_flags & V_ADP_COLOR) ? 1 : 0;
747 	return 0;
748 
749     case CONS_BLANKTIME:    	/* set screen saver timeout (0 = no saver) */
750 	if (*(int *)data < 0 || *(int *)data > MAX_BLANKTIME)
751             return EINVAL;
752 	s = spltty();
753 	scrn_blank_time = *(int *)data;
754 	run_scrn_saver = (scrn_blank_time != 0);
755 	splx(s);
756 	return 0;
757 
758     case CONS_CURSORTYPE:   	/* set cursor type (obsolete) */
759 	s = spltty();
760 	*(int *)data &= CONS_CURSOR_ATTRS;
761 	sc_change_cursor_shape(scp, *(int *)data, -1, -1);
762 	splx(s);
763 	return 0;
764 
765     case CONS_GETCURSORSHAPE:   /* get cursor shape (new interface) */
766 	if (((int *)data)[0] & CONS_LOCAL_CURSOR) {
767 	    ((int *)data)[0] = scp->curr_curs_attr.flags;
768 	    ((int *)data)[1] = scp->curr_curs_attr.base;
769 	    ((int *)data)[2] = scp->curr_curs_attr.height;
770 	} else {
771 	    ((int *)data)[0] = sc->curs_attr.flags;
772 	    ((int *)data)[1] = sc->curs_attr.base;
773 	    ((int *)data)[2] = sc->curs_attr.height;
774 	}
775 	return 0;
776 
777     case CONS_SETCURSORSHAPE:   /* set cursor shape (new interface) */
778 	s = spltty();
779 	sc_change_cursor_shape(scp, ((int *)data)[0],
780 	    ((int *)data)[1], ((int *)data)[2]);
781 	splx(s);
782 	return 0;
783 
784     case CONS_BELLTYPE: 	/* set bell type sound/visual */
785 	if ((*(int *)data) & CONS_VISUAL_BELL)
786 	    sc->flags |= SC_VISUAL_BELL;
787 	else
788 	    sc->flags &= ~SC_VISUAL_BELL;
789 	if ((*(int *)data) & CONS_QUIET_BELL)
790 	    sc->flags |= SC_QUIET_BELL;
791 	else
792 	    sc->flags &= ~SC_QUIET_BELL;
793 	return 0;
794 
795     case CONS_GETINFO:  	/* get current (virtual) console info */
796     {
797 	vid_info_t *ptr = (vid_info_t*)data;
798 	if (ptr->size == sizeof(struct vid_info)) {
799 	    ptr->m_num = sc->cur_scp->index;
800 	    ptr->font_size = scp->font_size;
801 	    ptr->mv_col = scp->xpos;
802 	    ptr->mv_row = scp->ypos;
803 	    ptr->mv_csz = scp->xsize;
804 	    ptr->mv_rsz = scp->ysize;
805 	    ptr->mv_hsz = (scp->history != NULL) ? scp->history->vtb_rows : 0;
806 	    /*
807 	     * The following fields are filled by the terminal emulator. XXX
808 	     *
809 	     * ptr->mv_norm.fore
810 	     * ptr->mv_norm.back
811 	     * ptr->mv_rev.fore
812 	     * ptr->mv_rev.back
813 	     */
814 	    ptr->mv_grfc.fore = 0;      /* not supported */
815 	    ptr->mv_grfc.back = 0;      /* not supported */
816 	    ptr->mv_ovscan = scp->border;
817 	    if (scp == sc->cur_scp)
818 		save_kbd_state(scp);
819 	    ptr->mk_keylock = scp->status & LOCK_MASK;
820 	    return 0;
821 	}
822 	return EINVAL;
823     }
824 
825     case CONS_GETVERS:  	/* get version number */
826 	*(int*)data = 0x200;    /* version 2.0 */
827 	return 0;
828 
829     case CONS_IDLE:		/* see if the screen has been idle */
830 	/*
831 	 * When the screen is in the GRAPHICS_MODE or UNKNOWN_MODE,
832 	 * the user process may have been writing something on the
833 	 * screen and syscons is not aware of it. Declare the screen
834 	 * is NOT idle if it is in one of these modes. But there is
835 	 * an exception to it; if a screen saver is running in the
836 	 * graphics mode in the current screen, we should say that the
837 	 * screen has been idle.
838 	 */
839 	*(int *)data = (sc->flags & SC_SCRN_IDLE)
840 		       && (!ISGRAPHSC(sc->cur_scp)
841 			   || (sc->cur_scp->status & SAVER_RUNNING));
842 	return 0;
843 
844     case CONS_SAVERMODE:	/* set saver mode */
845 	switch(*(int *)data) {
846 	case CONS_NO_SAVER:
847 	case CONS_USR_SAVER:
848 	    /* if a LKM screen saver is running, stop it first. */
849 	    scsplash_stick(FALSE);
850 	    saver_mode = *(int *)data;
851 	    s = spltty();
852 #ifdef DEV_SPLASH
853 	    if ((error = wait_scrn_saver_stop(NULL))) {
854 		splx(s);
855 		return error;
856 	    }
857 #endif
858 	    run_scrn_saver = TRUE;
859 	    if (saver_mode == CONS_USR_SAVER)
860 		scp->status |= SAVER_RUNNING;
861 	    else
862 		scp->status &= ~SAVER_RUNNING;
863 	    scsplash_stick(TRUE);
864 	    splx(s);
865 	    break;
866 	case CONS_LKM_SAVER:
867 	    s = spltty();
868 	    if ((saver_mode == CONS_USR_SAVER) && (scp->status & SAVER_RUNNING))
869 		scp->status &= ~SAVER_RUNNING;
870 	    saver_mode = *(int *)data;
871 	    splx(s);
872 	    break;
873 	default:
874 	    return EINVAL;
875 	}
876 	return 0;
877 
878     case CONS_SAVERSTART:	/* immediately start/stop the screen saver */
879 	/*
880 	 * Note that this ioctl does not guarantee the screen saver
881 	 * actually starts or stops. It merely attempts to do so...
882 	 */
883 	s = spltty();
884 	run_scrn_saver = (*(int *)data != 0);
885 	if (run_scrn_saver)
886 	    sc->scrn_time_stamp -= scrn_blank_time;
887 	splx(s);
888 	return 0;
889 
890     case CONS_SCRSHOT:		/* get a screen shot */
891     {
892 	int retval, hist_rsz;
893 	size_t lsize, csize;
894 	vm_offset_t frbp, hstp;
895 	unsigned lnum;
896 	scrshot_t *ptr = (scrshot_t *)data;
897 	void *outp = ptr->buf;
898 
899 	if (ptr->x < 0 || ptr->y < 0 || ptr->xsize < 0 || ptr->ysize < 0)
900 		return EINVAL;
901 	s = spltty();
902 	if (ISGRAPHSC(scp)) {
903 	    splx(s);
904 	    return EOPNOTSUPP;
905 	}
906 	hist_rsz = (scp->history != NULL) ? scp->history->vtb_rows : 0;
907 	if (((u_int)ptr->x + ptr->xsize) > scp->xsize ||
908 	    ((u_int)ptr->y + ptr->ysize) > (scp->ysize + hist_rsz)) {
909 	    splx(s);
910 	    return EINVAL;
911 	}
912 
913 	lsize = scp->xsize * sizeof(u_int16_t);
914 	csize = ptr->xsize * sizeof(u_int16_t);
915 	/* Pointer to the last line of framebuffer */
916 	frbp = scp->vtb.vtb_buffer + scp->ysize * lsize + ptr->x *
917 	       sizeof(u_int16_t);
918 	/* Pointer to the last line of target buffer */
919 	outp = (char *)outp + ptr->ysize * csize;
920 	/* Pointer to the last line of history buffer */
921 	if (scp->history != NULL)
922 	    hstp = scp->history->vtb_buffer + sc_vtb_tail(scp->history) *
923 		sizeof(u_int16_t) + ptr->x * sizeof(u_int16_t);
924 	else
925 	    hstp = 0;
926 
927 	retval = 0;
928 	for (lnum = 0; lnum < (ptr->y + ptr->ysize); lnum++) {
929 	    if (lnum < scp->ysize) {
930 		frbp -= lsize;
931 	    } else {
932 		hstp -= lsize;
933 		if (hstp < scp->history->vtb_buffer)
934 		    hstp += scp->history->vtb_rows * lsize;
935 		frbp = hstp;
936 	    }
937 	    if (lnum < ptr->y)
938 		continue;
939 	    outp = (char *)outp - csize;
940 	    retval = copyout((void *)frbp, outp, csize);
941 	    if (retval != 0)
942 		break;
943 	}
944 	splx(s);
945 	return retval;
946     }
947 
948     case VT_SETMODE:    	/* set screen switcher mode */
949     {
950 	struct vt_mode *mode;
951 	struct proc *p1;
952 
953 	mode = (struct vt_mode *)data;
954 	DPRINTF(5, ("%s%d: VT_SETMODE ", SC_DRIVER_NAME, sc->unit));
955 	if (scp->smode.mode == VT_PROCESS) {
956 	    p1 = pfind(scp->pid);
957     	    if (scp->proc == p1 && scp->proc != td->td_proc) {
958 		if (p1)
959 		    PROC_UNLOCK(p1);
960 		DPRINTF(5, ("error EPERM\n"));
961 		return EPERM;
962 	    }
963 	    if (p1)
964 		PROC_UNLOCK(p1);
965 	}
966 	s = spltty();
967 	if (mode->mode == VT_AUTO) {
968 	    scp->smode.mode = VT_AUTO;
969 	    scp->proc = NULL;
970 	    scp->pid = 0;
971 	    DPRINTF(5, ("VT_AUTO, "));
972 	    if ((scp == sc->cur_scp) && (sc->unit == sc_console_unit))
973 		cnavailable(sc_consptr, TRUE);
974 	    /* were we in the middle of the vty switching process? */
975 	    if (finish_vt_rel(scp, TRUE, &s) == 0)
976 		DPRINTF(5, ("reset WAIT_REL, "));
977 	    if (finish_vt_acq(scp) == 0)
978 		DPRINTF(5, ("reset WAIT_ACQ, "));
979 	} else {
980 	    if (!ISSIGVALID(mode->relsig) || !ISSIGVALID(mode->acqsig)
981 		|| !ISSIGVALID(mode->frsig)) {
982 		splx(s);
983 		DPRINTF(5, ("error EINVAL\n"));
984 		return EINVAL;
985 	    }
986 	    DPRINTF(5, ("VT_PROCESS %d, ", td->td_proc->p_pid));
987 	    bcopy(data, &scp->smode, sizeof(struct vt_mode));
988 	    scp->proc = td->td_proc;
989 	    scp->pid = scp->proc->p_pid;
990 	    if ((scp == sc->cur_scp) && (sc->unit == sc_console_unit))
991 		cnavailable(sc_consptr, FALSE);
992 	}
993 	splx(s);
994 	DPRINTF(5, ("\n"));
995 	return 0;
996     }
997 
998     case VT_GETMODE:    	/* get screen switcher mode */
999 	bcopy(&scp->smode, data, sizeof(struct vt_mode));
1000 	return 0;
1001 
1002 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1003     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1004     case _IO('v', 4):
1005 	ival = IOCPARM_IVAL(data);
1006 	data = (caddr_t)&ival;
1007 	/* FALLTHROUGH */
1008 #endif
1009     case VT_RELDISP:    	/* screen switcher ioctl */
1010 	s = spltty();
1011 	/*
1012 	 * This must be the current vty which is in the VT_PROCESS
1013 	 * switching mode...
1014 	 */
1015 	if ((scp != sc->cur_scp) || (scp->smode.mode != VT_PROCESS)) {
1016 	    splx(s);
1017 	    return EINVAL;
1018 	}
1019 	/* ...and this process is controlling it. */
1020 	if (scp->proc != td->td_proc) {
1021 	    splx(s);
1022 	    return EPERM;
1023 	}
1024 	error = EINVAL;
1025 	switch(*(int *)data) {
1026 	case VT_FALSE:  	/* user refuses to release screen, abort */
1027 	    if ((error = finish_vt_rel(scp, FALSE, &s)) == 0)
1028 		DPRINTF(5, ("%s%d: VT_FALSE\n", SC_DRIVER_NAME, sc->unit));
1029 	    break;
1030 	case VT_TRUE:   	/* user has released screen, go on */
1031 	    if ((error = finish_vt_rel(scp, TRUE, &s)) == 0)
1032 		DPRINTF(5, ("%s%d: VT_TRUE\n", SC_DRIVER_NAME, sc->unit));
1033 	    break;
1034 	case VT_ACKACQ: 	/* acquire acknowledged, switch completed */
1035 	    if ((error = finish_vt_acq(scp)) == 0)
1036 		DPRINTF(5, ("%s%d: VT_ACKACQ\n", SC_DRIVER_NAME, sc->unit));
1037 	    break;
1038 	default:
1039 	    break;
1040 	}
1041 	splx(s);
1042 	return error;
1043 
1044     case VT_OPENQRY:    	/* return free virtual console */
1045 	for (i = sc->first_vty; i < sc->first_vty + sc->vtys; i++) {
1046 	    tp = SC_DEV(sc, i);
1047 	    if (!tty_opened(tp)) {
1048 		*(int *)data = i + 1;
1049 		return 0;
1050 	    }
1051 	}
1052 	return EINVAL;
1053 
1054 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1055     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1056     case _IO('v', 5):
1057 	ival = IOCPARM_IVAL(data);
1058 	data = (caddr_t)&ival;
1059 	/* FALLTHROUGH */
1060 #endif
1061     case VT_ACTIVATE:   	/* switch to screen *data */
1062 	i = (*(int *)data == 0) ? scp->index : (*(int *)data - 1);
1063 	s = spltty();
1064 	error = sc_clean_up(sc->cur_scp);
1065 	splx(s);
1066 	if (error)
1067 	    return error;
1068 	error = sc_switch_scr(sc, i);
1069 	return (error);
1070 
1071 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1072     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1073     case _IO('v', 6):
1074 	ival = IOCPARM_IVAL(data);
1075 	data = (caddr_t)&ival;
1076 	/* FALLTHROUGH */
1077 #endif
1078     case VT_WAITACTIVE: 	/* wait for switch to occur */
1079 	i = (*(int *)data == 0) ? scp->index : (*(int *)data - 1);
1080 	if ((i < sc->first_vty) || (i >= sc->first_vty + sc->vtys))
1081 	    return EINVAL;
1082 	if (i == sc->cur_scp->index)
1083 	    return 0;
1084 	error = tsleep(VTY_WCHAN(sc, i), (PZERO + 1) | PCATCH, "waitvt", 0);
1085 	return error;
1086 
1087     case VT_GETACTIVE:		/* get active vty # */
1088 	*(int *)data = sc->cur_scp->index + 1;
1089 	return 0;
1090 
1091     case VT_GETINDEX:		/* get this vty # */
1092 	*(int *)data = scp->index + 1;
1093 	return 0;
1094 
1095     case VT_LOCKSWITCH:		/* prevent vty switching */
1096 	if ((*(int *)data) & 0x01)
1097 	    sc->flags |= SC_SCRN_VTYLOCK;
1098 	else
1099 	    sc->flags &= ~SC_SCRN_VTYLOCK;
1100 	return 0;
1101 
1102     case KDENABIO:      	/* allow io operations */
1103 	error = priv_check(td, PRIV_IO);
1104 	if (error != 0)
1105 	    return error;
1106 	error = securelevel_gt(td->td_ucred, 0);
1107 	if (error != 0)
1108 		return error;
1109 #ifdef __i386__
1110 	td->td_frame->tf_eflags |= PSL_IOPL;
1111 #elif defined(__amd64__)
1112 	td->td_frame->tf_rflags |= PSL_IOPL;
1113 #endif
1114 	return 0;
1115 
1116     case KDDISABIO:     	/* disallow io operations (default) */
1117 #ifdef __i386__
1118 	td->td_frame->tf_eflags &= ~PSL_IOPL;
1119 #elif defined(__amd64__)
1120 	td->td_frame->tf_rflags &= ~PSL_IOPL;
1121 #endif
1122 	return 0;
1123 
1124 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1125     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1126     case _IO('K', 20):
1127 	ival = IOCPARM_IVAL(data);
1128 	data = (caddr_t)&ival;
1129 	/* FALLTHROUGH */
1130 #endif
1131     case KDSKBSTATE:    	/* set keyboard state (locks) */
1132 	if (*(int *)data & ~LOCK_MASK)
1133 	    return EINVAL;
1134 	scp->status &= ~LOCK_MASK;
1135 	scp->status |= *(int *)data;
1136 	if (scp == sc->cur_scp)
1137 	    update_kbd_state(scp, scp->status, LOCK_MASK);
1138 	return 0;
1139 
1140     case KDGKBSTATE:    	/* get keyboard state (locks) */
1141 	if (scp == sc->cur_scp)
1142 	    save_kbd_state(scp);
1143 	*(int *)data = scp->status & LOCK_MASK;
1144 	return 0;
1145 
1146     case KDGETREPEAT:      	/* get keyboard repeat & delay rates */
1147     case KDSETREPEAT:      	/* set keyboard repeat & delay rates (new) */
1148 	error = kbdd_ioctl(sc->kbd, cmd, data);
1149 	if (error == ENOIOCTL)
1150 	    error = ENODEV;
1151 	return error;
1152 
1153 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1154     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1155     case _IO('K', 67):
1156 	ival = IOCPARM_IVAL(data);
1157 	data = (caddr_t)&ival;
1158 	/* FALLTHROUGH */
1159 #endif
1160     case KDSETRAD:      	/* set keyboard repeat & delay rates (old) */
1161 	if (*(int *)data & ~0x7f)
1162 	    return EINVAL;
1163 	error = kbdd_ioctl(sc->kbd, KDSETRAD, data);
1164 	if (error == ENOIOCTL)
1165 	    error = ENODEV;
1166 	return error;
1167 
1168 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1169     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1170     case _IO('K', 7):
1171 	ival = IOCPARM_IVAL(data);
1172 	data = (caddr_t)&ival;
1173 	/* FALLTHROUGH */
1174 #endif
1175     case KDSKBMODE:     	/* set keyboard mode */
1176 	switch (*(int *)data) {
1177 	case K_XLATE:   	/* switch to XLT ascii mode */
1178 	case K_RAW: 		/* switch to RAW scancode mode */
1179 	case K_CODE: 		/* switch to CODE mode */
1180 	    scp->kbd_mode = *(int *)data;
1181 	    if (scp == sc->cur_scp)
1182 		kbdd_ioctl(sc->kbd, KDSKBMODE, data);
1183 	    return 0;
1184 	default:
1185 	    return EINVAL;
1186 	}
1187 	/* NOT REACHED */
1188 
1189     case KDGKBMODE:     	/* get keyboard mode */
1190 	*(int *)data = scp->kbd_mode;
1191 	return 0;
1192 
1193     case KDGKBINFO:
1194 	error = kbdd_ioctl(sc->kbd, cmd, data);
1195 	if (error == ENOIOCTL)
1196 	    error = ENODEV;
1197 	return error;
1198 
1199 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1200     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1201     case _IO('K', 8):
1202 	ival = IOCPARM_IVAL(data);
1203 	data = (caddr_t)&ival;
1204 	/* FALLTHROUGH */
1205 #endif
1206     case KDMKTONE:      	/* sound the bell */
1207 	if (*(int*)data)
1208 	    sc_bell(scp, (*(int*)data)&0xffff,
1209 		    (((*(int*)data)>>16)&0xffff)*hz/1000);
1210 	else
1211 	    sc_bell(scp, scp->bell_pitch, scp->bell_duration);
1212 	return 0;
1213 
1214 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1215     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1216     case _IO('K', 63):
1217 	ival = IOCPARM_IVAL(data);
1218 	data = (caddr_t)&ival;
1219 	/* FALLTHROUGH */
1220 #endif
1221     case KIOCSOUND:     	/* make tone (*data) hz */
1222 	if (scp == sc->cur_scp) {
1223 	    if (*(int *)data)
1224 		return sc_tone(*(int *)data);
1225 	    else
1226 		return sc_tone(0);
1227 	}
1228 	return 0;
1229 
1230     case KDGKBTYPE:     	/* get keyboard type */
1231 	error = kbdd_ioctl(sc->kbd, cmd, data);
1232 	if (error == ENOIOCTL) {
1233 	    /* always return something? XXX */
1234 	    *(int *)data = 0;
1235 	}
1236 	return 0;
1237 
1238 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1239     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1240     case _IO('K', 66):
1241 	ival = IOCPARM_IVAL(data);
1242 	data = (caddr_t)&ival;
1243 	/* FALLTHROUGH */
1244 #endif
1245     case KDSETLED:      	/* set keyboard LED status */
1246 	if (*(int *)data & ~LED_MASK)	/* FIXME: LOCK_MASK? */
1247 	    return EINVAL;
1248 	scp->status &= ~LED_MASK;
1249 	scp->status |= *(int *)data;
1250 	if (scp == sc->cur_scp)
1251 	    update_kbd_leds(scp, scp->status);
1252 	return 0;
1253 
1254     case KDGETLED:      	/* get keyboard LED status */
1255 	if (scp == sc->cur_scp)
1256 	    save_kbd_state(scp);
1257 	*(int *)data = scp->status & LED_MASK;
1258 	return 0;
1259 
1260     case KBADDKBD:		/* add/remove keyboard to/from mux */
1261     case KBRELKBD:
1262 	error = kbdd_ioctl(sc->kbd, cmd, data);
1263 	if (error == ENOIOCTL)
1264 	    error = ENODEV;
1265 	return error;
1266 
1267 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \
1268     defined(COMPAT_FREEBSD4) || defined(COMPAT_43)
1269     case _IO('c', 110):
1270 	ival = IOCPARM_IVAL(data);
1271 	data = (caddr_t)&ival;
1272 	/* FALLTHROUGH */
1273 #endif
1274     case CONS_SETKBD: 		/* set the new keyboard */
1275 	{
1276 	    keyboard_t *newkbd;
1277 
1278 	    s = spltty();
1279 	    newkbd = kbd_get_keyboard(*(int *)data);
1280 	    if (newkbd == NULL) {
1281 		splx(s);
1282 		return EINVAL;
1283 	    }
1284 	    error = 0;
1285 	    if (sc->kbd != newkbd) {
1286 		i = kbd_allocate(newkbd->kb_name, newkbd->kb_unit,
1287 				 (void *)&sc->keyboard, sckbdevent, sc);
1288 		/* i == newkbd->kb_index */
1289 		if (i >= 0) {
1290 		    if (sc->kbd != NULL) {
1291 			save_kbd_state(sc->cur_scp);
1292 			kbd_release(sc->kbd, (void *)&sc->keyboard);
1293 		    }
1294 		    sc->kbd = kbd_get_keyboard(i); /* sc->kbd == newkbd */
1295 		    sc->keyboard = i;
1296 		    kbdd_ioctl(sc->kbd, KDSKBMODE,
1297 			      (caddr_t)&sc->cur_scp->kbd_mode);
1298 		    update_kbd_state(sc->cur_scp, sc->cur_scp->status,
1299 				     LOCK_MASK);
1300 		} else {
1301 		    error = EPERM;	/* XXX */
1302 		}
1303 	    }
1304 	    splx(s);
1305 	    return error;
1306 	}
1307 
1308     case CONS_RELKBD: 		/* release the current keyboard */
1309 	s = spltty();
1310 	error = 0;
1311 	if (sc->kbd != NULL) {
1312 	    save_kbd_state(sc->cur_scp);
1313 	    error = kbd_release(sc->kbd, (void *)&sc->keyboard);
1314 	    if (error == 0) {
1315 		sc->kbd = NULL;
1316 		sc->keyboard = -1;
1317 	    }
1318 	}
1319 	splx(s);
1320 	return error;
1321 
1322     case CONS_GETTERM:		/* get the current terminal emulator info */
1323 	{
1324 	    sc_term_sw_t *sw;
1325 
1326 	    if (((term_info_t *)data)->ti_index == 0) {
1327 		sw = scp->tsw;
1328 	    } else {
1329 		sw = sc_term_match_by_number(((term_info_t *)data)->ti_index);
1330 	    }
1331 	    if (sw != NULL) {
1332 		strncpy(((term_info_t *)data)->ti_name, sw->te_name,
1333 			sizeof(((term_info_t *)data)->ti_name));
1334 		strncpy(((term_info_t *)data)->ti_desc, sw->te_desc,
1335 			sizeof(((term_info_t *)data)->ti_desc));
1336 		((term_info_t *)data)->ti_flags = 0;
1337 		return 0;
1338 	    } else {
1339 		((term_info_t *)data)->ti_name[0] = '\0';
1340 		((term_info_t *)data)->ti_desc[0] = '\0';
1341 		((term_info_t *)data)->ti_flags = 0;
1342 		return EINVAL;
1343 	    }
1344 	}
1345 
1346     case CONS_SETTERM:		/* set the current terminal emulator */
1347 	s = spltty();
1348 	error = sc_init_emulator(scp, ((term_info_t *)data)->ti_name);
1349 	/* FIXME: what if scp == sc_console! XXX */
1350 	splx(s);
1351 	return error;
1352 
1353     case GIO_SCRNMAP:   	/* get output translation table */
1354 	bcopy(&sc->scr_map, data, sizeof(sc->scr_map));
1355 	return 0;
1356 
1357     case PIO_SCRNMAP:   	/* set output translation table */
1358 	bcopy(data, &sc->scr_map, sizeof(sc->scr_map));
1359 	for (i=0; i<sizeof(sc->scr_map); i++) {
1360 	    sc->scr_rmap[sc->scr_map[i]] = i;
1361 	}
1362 	return 0;
1363 
1364     case GIO_KEYMAP:		/* get keyboard translation table */
1365     case PIO_KEYMAP:		/* set keyboard translation table */
1366     case GIO_DEADKEYMAP:	/* get accent key translation table */
1367     case PIO_DEADKEYMAP:	/* set accent key translation table */
1368     case GETFKEY:		/* get function key string */
1369     case SETFKEY:		/* set function key string */
1370 	error = kbdd_ioctl(sc->kbd, cmd, data);
1371 	if (error == ENOIOCTL)
1372 	    error = ENODEV;
1373 	return error;
1374 
1375 #ifndef SC_NO_FONT_LOADING
1376 
1377     case PIO_FONT8x8:   	/* set 8x8 dot font */
1378 	if (!ISFONTAVAIL(sc->adp->va_flags))
1379 	    return ENXIO;
1380 	bcopy(data, sc->font_8, 8*256);
1381 	sc->fonts_loaded |= FONT_8;
1382 	/*
1383 	 * FONT KLUDGE
1384 	 * Always use the font page #0. XXX
1385 	 * Don't load if the current font size is not 8x8.
1386 	 */
1387 	if (ISTEXTSC(sc->cur_scp) && (sc->cur_scp->font_size < 14))
1388 	    sc_load_font(sc->cur_scp, 0, 8, 8, sc->font_8, 0, 256);
1389 	return 0;
1390 
1391     case GIO_FONT8x8:   	/* get 8x8 dot font */
1392 	if (!ISFONTAVAIL(sc->adp->va_flags))
1393 	    return ENXIO;
1394 	if (sc->fonts_loaded & FONT_8) {
1395 	    bcopy(sc->font_8, data, 8*256);
1396 	    return 0;
1397 	}
1398 	else
1399 	    return ENXIO;
1400 
1401     case PIO_FONT8x14:  	/* set 8x14 dot font */
1402 	if (!ISFONTAVAIL(sc->adp->va_flags))
1403 	    return ENXIO;
1404 	bcopy(data, sc->font_14, 14*256);
1405 	sc->fonts_loaded |= FONT_14;
1406 	/*
1407 	 * FONT KLUDGE
1408 	 * Always use the font page #0. XXX
1409 	 * Don't load if the current font size is not 8x14.
1410 	 */
1411 	if (ISTEXTSC(sc->cur_scp)
1412 	    && (sc->cur_scp->font_size >= 14)
1413 	    && (sc->cur_scp->font_size < 16))
1414 	    sc_load_font(sc->cur_scp, 0, 14, 8, sc->font_14, 0, 256);
1415 	return 0;
1416 
1417     case GIO_FONT8x14:  	/* get 8x14 dot font */
1418 	if (!ISFONTAVAIL(sc->adp->va_flags))
1419 	    return ENXIO;
1420 	if (sc->fonts_loaded & FONT_14) {
1421 	    bcopy(sc->font_14, data, 14*256);
1422 	    return 0;
1423 	}
1424 	else
1425 	    return ENXIO;
1426 
1427     case PIO_FONT8x16:  	/* set 8x16 dot font */
1428 	if (!ISFONTAVAIL(sc->adp->va_flags))
1429 	    return ENXIO;
1430 	bcopy(data, sc->font_16, 16*256);
1431 	sc->fonts_loaded |= FONT_16;
1432 	/*
1433 	 * FONT KLUDGE
1434 	 * Always use the font page #0. XXX
1435 	 * Don't load if the current font size is not 8x16.
1436 	 */
1437 	if (ISTEXTSC(sc->cur_scp) && (sc->cur_scp->font_size >= 16))
1438 	    sc_load_font(sc->cur_scp, 0, 16, 8, sc->font_16, 0, 256);
1439 	return 0;
1440 
1441     case GIO_FONT8x16:  	/* get 8x16 dot font */
1442 	if (!ISFONTAVAIL(sc->adp->va_flags))
1443 	    return ENXIO;
1444 	if (sc->fonts_loaded & FONT_16) {
1445 	    bcopy(sc->font_16, data, 16*256);
1446 	    return 0;
1447 	}
1448 	else
1449 	    return ENXIO;
1450 
1451 #endif /* SC_NO_FONT_LOADING */
1452 
1453     default:
1454 	break;
1455     }
1456 
1457     return (ENOIOCTL);
1458 }
1459 
1460 static int
1461 consolectl_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag,
1462     struct thread *td)
1463 {
1464 
1465 	return sctty_ioctl(dev->si_drv1, cmd, data, td);
1466 }
1467 
1468 static void
1469 sc_cnprobe(struct consdev *cp)
1470 {
1471     int unit;
1472     int flags;
1473 
1474     cp->cn_pri = sc_get_cons_priority(&unit, &flags);
1475 
1476     /* a video card is always required */
1477     if (!scvidprobe(unit, flags, TRUE))
1478 	cp->cn_pri = CN_DEAD;
1479 
1480     /* syscons will become console even when there is no keyboard */
1481     sckbdprobe(unit, flags, TRUE);
1482 
1483     if (cp->cn_pri == CN_DEAD)
1484 	return;
1485 
1486     /* initialize required fields */
1487     strcpy(cp->cn_name, "ttyv0");
1488 }
1489 
1490 static void
1491 sc_cninit(struct consdev *cp)
1492 {
1493     int unit;
1494     int flags;
1495 
1496     sc_get_cons_priority(&unit, &flags);
1497     scinit(unit, flags | SC_KERNEL_CONSOLE);
1498     sc_console_unit = unit;
1499     sc_console = sc_get_stat(sc_get_softc(unit, SC_KERNEL_CONSOLE)->dev[0]);
1500     sc_consptr = cp;
1501 }
1502 
1503 static void
1504 sc_cnterm(struct consdev *cp)
1505 {
1506     /* we are not the kernel console any more, release everything */
1507 
1508     if (sc_console_unit < 0)
1509 	return;			/* shouldn't happen */
1510 
1511 #if 0 /* XXX */
1512     sc_clear_screen(sc_console);
1513     sccnupdate(sc_console);
1514 #endif
1515 
1516     scterm(sc_console_unit, SC_KERNEL_CONSOLE);
1517     sc_console_unit = -1;
1518     sc_console = NULL;
1519 }
1520 
1521 static void
1522 sc_cnputc(struct consdev *cd, int c)
1523 {
1524     u_char buf[1];
1525     scr_stat *scp = sc_console;
1526 #ifndef SC_NO_HISTORY
1527 #if 0
1528     struct tty *tp;
1529 #endif
1530 #endif /* !SC_NO_HISTORY */
1531     int s;
1532 
1533     /* assert(sc_console != NULL) */
1534 
1535 #ifndef SC_NO_HISTORY
1536     if (scp == scp->sc->cur_scp && scp->status & SLKED) {
1537 	scp->status &= ~SLKED;
1538 	update_kbd_state(scp, scp->status, SLKED);
1539 	if (scp->status & BUFFER_SAVED) {
1540 	    if (!sc_hist_restore(scp))
1541 		sc_remove_cutmarking(scp);
1542 	    scp->status &= ~BUFFER_SAVED;
1543 	    scp->status |= CURSOR_ENABLED;
1544 	    sc_draw_cursor_image(scp);
1545 	}
1546 #if 0
1547 	/*
1548 	 * XXX: Now that TTY's have their own locks, we cannot process
1549 	 * any data after disabling scroll lock. cnputs already holds a
1550 	 * spinlock.
1551 	 */
1552 	tp = SC_DEV(scp->sc, scp->index);
1553 	tty_lock(tp);
1554 	if (tty_opened(tp))
1555 	    sctty_outwakeup(tp);
1556 	tty_unlock(tp);
1557 #endif
1558     }
1559 #endif /* !SC_NO_HISTORY */
1560 
1561     buf[0] = c;
1562     sc_puts(scp, buf, 1, 1);
1563 
1564     s = spltty();	/* block sckbdevent and scrn_timer */
1565     sccnupdate(scp);
1566     splx(s);
1567 }
1568 
1569 static int
1570 sc_cngetc(struct consdev *cd)
1571 {
1572     static struct fkeytab fkey;
1573     static int fkeycp;
1574     scr_stat *scp;
1575     u_char *p;
1576     int cur_mode;
1577     int s = spltty();	/* block sckbdevent and scrn_timer while we poll */
1578     int c;
1579 
1580     /* assert(sc_console != NULL) */
1581 
1582     /*
1583      * Stop the screen saver and update the screen if necessary.
1584      * What if we have been running in the screen saver code... XXX
1585      */
1586     sc_touch_scrn_saver();
1587     scp = sc_console->sc->cur_scp;	/* XXX */
1588     sccnupdate(scp);
1589 
1590     if (fkeycp < fkey.len) {
1591 	splx(s);
1592 	return fkey.str[fkeycp++];
1593     }
1594 
1595     if (scp->sc->kbd == NULL) {
1596 	splx(s);
1597 	return -1;
1598     }
1599 
1600     /*
1601      * Make sure the keyboard is accessible even when the kbd device
1602      * driver is disabled.
1603      */
1604     kbdd_enable(scp->sc->kbd);
1605 
1606     /* we shall always use the keyboard in the XLATE mode here */
1607     cur_mode = scp->kbd_mode;
1608     scp->kbd_mode = K_XLATE;
1609     kbdd_ioctl(scp->sc->kbd, KDSKBMODE, (caddr_t)&scp->kbd_mode);
1610 
1611     kbdd_poll(scp->sc->kbd, TRUE);
1612     c = scgetc(scp->sc, SCGETC_CN | SCGETC_NONBLOCK);
1613     kbdd_poll(scp->sc->kbd, FALSE);
1614 
1615     scp->kbd_mode = cur_mode;
1616     kbdd_ioctl(scp->sc->kbd, KDSKBMODE, (caddr_t)&scp->kbd_mode);
1617     kbdd_disable(scp->sc->kbd);
1618     splx(s);
1619 
1620     switch (KEYFLAGS(c)) {
1621     case 0:	/* normal char */
1622 	return KEYCHAR(c);
1623     case FKEY:	/* function key */
1624 	p = kbdd_get_fkeystr(scp->sc->kbd, KEYCHAR(c), (size_t *)&fkeycp);
1625 	fkey.len = fkeycp;
1626 	if ((p != NULL) && (fkey.len > 0)) {
1627 	    bcopy(p, fkey.str, fkey.len);
1628 	    fkeycp = 1;
1629 	    return fkey.str[0];
1630 	}
1631 	return c;	/* XXX */
1632     case NOKEY:
1633     case ERRKEY:
1634     default:
1635 	return -1;
1636     }
1637     /* NOT REACHED */
1638 }
1639 
1640 static void
1641 sccnupdate(scr_stat *scp)
1642 {
1643     /* this is a cut-down version of scrn_timer()... */
1644 
1645     if (scp->sc->font_loading_in_progress)
1646 	return;
1647 
1648     if (debugger > 0 || panicstr || shutdown_in_progress) {
1649 	sc_touch_scrn_saver();
1650     } else if (scp != scp->sc->cur_scp) {
1651 	return;
1652     }
1653 
1654     if (!run_scrn_saver)
1655 	scp->sc->flags &= ~SC_SCRN_IDLE;
1656 #ifdef DEV_SPLASH
1657     if ((saver_mode != CONS_LKM_SAVER) || !(scp->sc->flags & SC_SCRN_IDLE))
1658 	if (scp->sc->flags & SC_SCRN_BLANKED)
1659             stop_scrn_saver(scp->sc, current_saver);
1660 #endif
1661 
1662     if (scp != scp->sc->cur_scp || scp->sc->blink_in_progress
1663 	|| scp->sc->switch_in_progress)
1664 	return;
1665     /*
1666      * FIXME: unlike scrn_timer(), we call scrn_update() from here even
1667      * when write_in_progress is non-zero.  XXX
1668      */
1669 
1670     if (!ISGRAPHSC(scp) && !(scp->sc->flags & SC_SCRN_BLANKED))
1671 	scrn_update(scp, TRUE);
1672 }
1673 
1674 static void
1675 scrn_timer(void *arg)
1676 {
1677 #ifndef PC98
1678     static int kbd_interval = 0;
1679 #endif
1680     struct timeval tv;
1681     sc_softc_t *sc;
1682     scr_stat *scp;
1683     int again;
1684     int s;
1685 
1686     again = (arg != NULL);
1687     if (arg != NULL)
1688 	sc = (sc_softc_t *)arg;
1689     else if (sc_console != NULL)
1690 	sc = sc_console->sc;
1691     else
1692 	return;
1693 
1694     /* don't do anything when we are performing some I/O operations */
1695     if (sc->font_loading_in_progress) {
1696 	if (again)
1697 	    timeout(scrn_timer, sc, hz / 10);
1698 	return;
1699     }
1700     s = spltty();
1701 
1702 #ifndef PC98
1703     if ((sc->kbd == NULL) && (sc->config & SC_AUTODETECT_KBD)) {
1704 	/* try to allocate a keyboard automatically */
1705 	if (++kbd_interval >= 25) {
1706 	    sc->keyboard = sc_allocate_keyboard(sc, -1);
1707 	    if (sc->keyboard >= 0) {
1708 		sc->kbd = kbd_get_keyboard(sc->keyboard);
1709 		kbdd_ioctl(sc->kbd, KDSKBMODE,
1710 			  (caddr_t)&sc->cur_scp->kbd_mode);
1711 		update_kbd_state(sc->cur_scp, sc->cur_scp->status,
1712 				 LOCK_MASK);
1713 	    }
1714 	    kbd_interval = 0;
1715 	}
1716     }
1717 #endif /* PC98 */
1718 
1719     /* find the vty to update */
1720     scp = sc->cur_scp;
1721 
1722     /* should we stop the screen saver? */
1723     getmicrouptime(&tv);
1724     if (debugger > 0 || panicstr || shutdown_in_progress)
1725 	sc_touch_scrn_saver();
1726     if (run_scrn_saver) {
1727 	if (tv.tv_sec > sc->scrn_time_stamp + scrn_blank_time)
1728 	    sc->flags |= SC_SCRN_IDLE;
1729 	else
1730 	    sc->flags &= ~SC_SCRN_IDLE;
1731     } else {
1732 	sc->scrn_time_stamp = tv.tv_sec;
1733 	sc->flags &= ~SC_SCRN_IDLE;
1734 	if (scrn_blank_time > 0)
1735 	    run_scrn_saver = TRUE;
1736     }
1737 #ifdef DEV_SPLASH
1738     if ((saver_mode != CONS_LKM_SAVER) || !(sc->flags & SC_SCRN_IDLE))
1739 	if (sc->flags & SC_SCRN_BLANKED)
1740             stop_scrn_saver(sc, current_saver);
1741 #endif
1742 
1743     /* should we just return ? */
1744     if (sc->blink_in_progress || sc->switch_in_progress
1745 	|| sc->write_in_progress) {
1746 	if (again)
1747 	    timeout(scrn_timer, sc, hz / 10);
1748 	splx(s);
1749 	return;
1750     }
1751 
1752     /* Update the screen */
1753     scp = sc->cur_scp;		/* cur_scp may have changed... */
1754     if (!ISGRAPHSC(scp) && !(sc->flags & SC_SCRN_BLANKED))
1755 	scrn_update(scp, TRUE);
1756 
1757 #ifdef DEV_SPLASH
1758     /* should we activate the screen saver? */
1759     if ((saver_mode == CONS_LKM_SAVER) && (sc->flags & SC_SCRN_IDLE))
1760 	if (!ISGRAPHSC(scp) || (sc->flags & SC_SCRN_BLANKED))
1761 	    (*current_saver)(sc, TRUE);
1762 #endif
1763 
1764     if (again)
1765 	timeout(scrn_timer, sc, hz / 25);
1766     splx(s);
1767 }
1768 
1769 static int
1770 and_region(int *s1, int *e1, int s2, int e2)
1771 {
1772     if (*e1 < s2 || e2 < *s1)
1773 	return FALSE;
1774     *s1 = imax(*s1, s2);
1775     *e1 = imin(*e1, e2);
1776     return TRUE;
1777 }
1778 
1779 static void
1780 scrn_update(scr_stat *scp, int show_cursor)
1781 {
1782     int start;
1783     int end;
1784     int s;
1785     int e;
1786 
1787     /* assert(scp == scp->sc->cur_scp) */
1788 
1789     SC_VIDEO_LOCK(scp->sc);
1790 
1791 #ifndef SC_NO_CUTPASTE
1792     /* remove the previous mouse pointer image if necessary */
1793     if (scp->status & MOUSE_VISIBLE) {
1794 	s = scp->mouse_pos;
1795 	e = scp->mouse_pos + scp->xsize + 1;
1796 	if ((scp->status & (MOUSE_MOVED | MOUSE_HIDDEN))
1797 	    || and_region(&s, &e, scp->start, scp->end)
1798 	    || ((scp->status & CURSOR_ENABLED) &&
1799 		(scp->cursor_pos != scp->cursor_oldpos) &&
1800 		(and_region(&s, &e, scp->cursor_pos, scp->cursor_pos)
1801 		 || and_region(&s, &e, scp->cursor_oldpos, scp->cursor_oldpos)))) {
1802 	    sc_remove_mouse_image(scp);
1803 	    if (scp->end >= scp->xsize*scp->ysize)
1804 		scp->end = scp->xsize*scp->ysize - 1;
1805 	}
1806     }
1807 #endif /* !SC_NO_CUTPASTE */
1808 
1809 #if 1
1810     /* debug: XXX */
1811     if (scp->end >= scp->xsize*scp->ysize) {
1812 	printf("scrn_update(): scp->end %d > size_of_screen!!\n", scp->end);
1813 	scp->end = scp->xsize*scp->ysize - 1;
1814     }
1815     if (scp->start < 0) {
1816 	printf("scrn_update(): scp->start %d < 0\n", scp->start);
1817 	scp->start = 0;
1818     }
1819 #endif
1820 
1821     /* update screen image */
1822     if (scp->start <= scp->end)  {
1823 	if (scp->mouse_cut_end >= 0) {
1824 	    /* there is a marked region for cut & paste */
1825 	    if (scp->mouse_cut_start <= scp->mouse_cut_end) {
1826 		start = scp->mouse_cut_start;
1827 		end = scp->mouse_cut_end;
1828 	    } else {
1829 		start = scp->mouse_cut_end;
1830 		end = scp->mouse_cut_start - 1;
1831 	    }
1832 	    s = start;
1833 	    e = end;
1834 	    /* does the cut-mark region overlap with the update region? */
1835 	    if (and_region(&s, &e, scp->start, scp->end)) {
1836 		(*scp->rndr->draw)(scp, s, e - s + 1, TRUE);
1837 		s = 0;
1838 		e = start - 1;
1839 		if (and_region(&s, &e, scp->start, scp->end))
1840 		    (*scp->rndr->draw)(scp, s, e - s + 1, FALSE);
1841 		s = end + 1;
1842 		e = scp->xsize*scp->ysize - 1;
1843 		if (and_region(&s, &e, scp->start, scp->end))
1844 		    (*scp->rndr->draw)(scp, s, e - s + 1, FALSE);
1845 	    } else {
1846 		(*scp->rndr->draw)(scp, scp->start,
1847 				   scp->end - scp->start + 1, FALSE);
1848 	    }
1849 	} else {
1850 	    (*scp->rndr->draw)(scp, scp->start,
1851 			       scp->end - scp->start + 1, FALSE);
1852 	}
1853     }
1854 
1855     /* we are not to show the cursor and the mouse pointer... */
1856     if (!show_cursor) {
1857         scp->end = 0;
1858         scp->start = scp->xsize*scp->ysize - 1;
1859 	SC_VIDEO_UNLOCK(scp->sc);
1860 	return;
1861     }
1862 
1863     /* update cursor image */
1864     if (scp->status & CURSOR_ENABLED) {
1865 	s = scp->start;
1866 	e = scp->end;
1867         /* did cursor move since last time ? */
1868         if (scp->cursor_pos != scp->cursor_oldpos) {
1869             /* do we need to remove old cursor image ? */
1870             if (!and_region(&s, &e, scp->cursor_oldpos, scp->cursor_oldpos))
1871                 sc_remove_cursor_image(scp);
1872             sc_draw_cursor_image(scp);
1873         } else {
1874             if (and_region(&s, &e, scp->cursor_pos, scp->cursor_pos))
1875 		/* cursor didn't move, but has been overwritten */
1876 		sc_draw_cursor_image(scp);
1877 	    else if (scp->curs_attr.flags & CONS_BLINK_CURSOR)
1878 		/* if it's a blinking cursor, update it */
1879 		(*scp->rndr->blink_cursor)(scp, scp->cursor_pos,
1880 					   sc_inside_cutmark(scp,
1881 					       scp->cursor_pos));
1882         }
1883     }
1884 
1885 #ifndef SC_NO_CUTPASTE
1886     /* update "pseudo" mouse pointer image */
1887     if (scp->sc->flags & SC_MOUSE_ENABLED) {
1888 	if (!(scp->status & (MOUSE_VISIBLE | MOUSE_HIDDEN))) {
1889 	    scp->status &= ~MOUSE_MOVED;
1890 	    sc_draw_mouse_image(scp);
1891 	}
1892     }
1893 #endif /* SC_NO_CUTPASTE */
1894 
1895     scp->end = 0;
1896     scp->start = scp->xsize*scp->ysize - 1;
1897 
1898     SC_VIDEO_UNLOCK(scp->sc);
1899 }
1900 
1901 #ifdef DEV_SPLASH
1902 static int
1903 scsplash_callback(int event, void *arg)
1904 {
1905     sc_softc_t *sc;
1906     int error;
1907 
1908     sc = (sc_softc_t *)arg;
1909 
1910     switch (event) {
1911     case SPLASH_INIT:
1912 	if (add_scrn_saver(scsplash_saver) == 0) {
1913 	    sc->flags &= ~SC_SAVER_FAILED;
1914 	    run_scrn_saver = TRUE;
1915 	    if (cold && !(boothowto & RB_VERBOSE)) {
1916 		scsplash_stick(TRUE);
1917 		(*current_saver)(sc, TRUE);
1918 	    }
1919 	}
1920 	return 0;
1921 
1922     case SPLASH_TERM:
1923 	if (current_saver == scsplash_saver) {
1924 	    scsplash_stick(FALSE);
1925 	    error = remove_scrn_saver(scsplash_saver);
1926 	    if (error)
1927 		return error;
1928 	}
1929 	return 0;
1930 
1931     default:
1932 	return EINVAL;
1933     }
1934 }
1935 
1936 static void
1937 scsplash_saver(sc_softc_t *sc, int show)
1938 {
1939     static int busy = FALSE;
1940     scr_stat *scp;
1941 
1942     if (busy)
1943 	return;
1944     busy = TRUE;
1945 
1946     scp = sc->cur_scp;
1947     if (show) {
1948 	if (!(sc->flags & SC_SAVER_FAILED)) {
1949 	    if (!(sc->flags & SC_SCRN_BLANKED))
1950 		set_scrn_saver_mode(scp, -1, NULL, 0);
1951 	    switch (splash(sc->adp, TRUE)) {
1952 	    case 0:		/* succeeded */
1953 		break;
1954 	    case EAGAIN:	/* try later */
1955 		restore_scrn_saver_mode(scp, FALSE);
1956 		sc_touch_scrn_saver();		/* XXX */
1957 		break;
1958 	    default:
1959 		sc->flags |= SC_SAVER_FAILED;
1960 		scsplash_stick(FALSE);
1961 		restore_scrn_saver_mode(scp, TRUE);
1962 		printf("scsplash_saver(): failed to put up the image\n");
1963 		break;
1964 	    }
1965 	}
1966     } else if (!sticky_splash) {
1967 	if ((sc->flags & SC_SCRN_BLANKED) && (splash(sc->adp, FALSE) == 0))
1968 	    restore_scrn_saver_mode(scp, TRUE);
1969     }
1970     busy = FALSE;
1971 }
1972 
1973 static int
1974 add_scrn_saver(void (*this_saver)(sc_softc_t *, int))
1975 {
1976 #if 0
1977     int error;
1978 
1979     if (current_saver != none_saver) {
1980 	error = remove_scrn_saver(current_saver);
1981 	if (error)
1982 	    return error;
1983     }
1984 #endif
1985     if (current_saver != none_saver)
1986 	return EBUSY;
1987 
1988     run_scrn_saver = FALSE;
1989     saver_mode = CONS_LKM_SAVER;
1990     current_saver = this_saver;
1991     return 0;
1992 }
1993 
1994 static int
1995 remove_scrn_saver(void (*this_saver)(sc_softc_t *, int))
1996 {
1997     if (current_saver != this_saver)
1998 	return EINVAL;
1999 
2000 #if 0
2001     /*
2002      * In order to prevent `current_saver' from being called by
2003      * the timeout routine `scrn_timer()' while we manipulate
2004      * the saver list, we shall set `current_saver' to `none_saver'
2005      * before stopping the current saver, rather than blocking by `splXX()'.
2006      */
2007     current_saver = none_saver;
2008     if (scrn_blanked)
2009         stop_scrn_saver(this_saver);
2010 #endif
2011 
2012     /* unblank all blanked screens */
2013     wait_scrn_saver_stop(NULL);
2014     if (scrn_blanked)
2015 	return EBUSY;
2016 
2017     current_saver = none_saver;
2018     return 0;
2019 }
2020 
2021 static int
2022 set_scrn_saver_mode(scr_stat *scp, int mode, u_char *pal, int border)
2023 {
2024     int s;
2025 
2026     /* assert(scp == scp->sc->cur_scp) */
2027     s = spltty();
2028     if (!ISGRAPHSC(scp))
2029 	sc_remove_cursor_image(scp);
2030     scp->splash_save_mode = scp->mode;
2031     scp->splash_save_status = scp->status & (GRAPHICS_MODE | PIXEL_MODE);
2032     scp->status &= ~(GRAPHICS_MODE | PIXEL_MODE);
2033     scp->status |= (UNKNOWN_MODE | SAVER_RUNNING);
2034     scp->sc->flags |= SC_SCRN_BLANKED;
2035     ++scrn_blanked;
2036     splx(s);
2037     if (mode < 0)
2038 	return 0;
2039     scp->mode = mode;
2040     if (set_mode(scp) == 0) {
2041 	if (scp->sc->adp->va_info.vi_flags & V_INFO_GRAPHICS)
2042 	    scp->status |= GRAPHICS_MODE;
2043 #ifndef SC_NO_PALETTE_LOADING
2044 	if (pal != NULL)
2045 	    vidd_load_palette(scp->sc->adp, pal);
2046 #endif
2047 	sc_set_border(scp, border);
2048 	return 0;
2049     } else {
2050 	s = spltty();
2051 	scp->mode = scp->splash_save_mode;
2052 	scp->status &= ~(UNKNOWN_MODE | SAVER_RUNNING);
2053 	scp->status |= scp->splash_save_status;
2054 	splx(s);
2055 	return 1;
2056     }
2057 }
2058 
2059 static int
2060 restore_scrn_saver_mode(scr_stat *scp, int changemode)
2061 {
2062     int mode;
2063     int status;
2064     int s;
2065 
2066     /* assert(scp == scp->sc->cur_scp) */
2067     s = spltty();
2068     mode = scp->mode;
2069     status = scp->status;
2070     scp->mode = scp->splash_save_mode;
2071     scp->status &= ~(UNKNOWN_MODE | SAVER_RUNNING);
2072     scp->status |= scp->splash_save_status;
2073     scp->sc->flags &= ~SC_SCRN_BLANKED;
2074     if (!changemode) {
2075 	if (!ISGRAPHSC(scp))
2076 	    sc_draw_cursor_image(scp);
2077 	--scrn_blanked;
2078 	splx(s);
2079 	return 0;
2080     }
2081     if (set_mode(scp) == 0) {
2082 #ifndef SC_NO_PALETTE_LOADING
2083 	vidd_load_palette(scp->sc->adp, scp->sc->palette);
2084 #endif
2085 	--scrn_blanked;
2086 	splx(s);
2087 	return 0;
2088     } else {
2089 	scp->mode = mode;
2090 	scp->status = status;
2091 	splx(s);
2092 	return 1;
2093     }
2094 }
2095 
2096 static void
2097 stop_scrn_saver(sc_softc_t *sc, void (*saver)(sc_softc_t *, int))
2098 {
2099     (*saver)(sc, FALSE);
2100     run_scrn_saver = FALSE;
2101     /* the screen saver may have chosen not to stop after all... */
2102     if (sc->flags & SC_SCRN_BLANKED)
2103 	return;
2104 
2105     mark_all(sc->cur_scp);
2106     if (sc->delayed_next_scr)
2107 	sc_switch_scr(sc, sc->delayed_next_scr - 1);
2108     if (debugger == 0)
2109 	wakeup(&scrn_blanked);
2110 }
2111 
2112 static int
2113 wait_scrn_saver_stop(sc_softc_t *sc)
2114 {
2115     int error = 0;
2116 
2117     while (scrn_blanked > 0) {
2118 	run_scrn_saver = FALSE;
2119 	if (sc && !(sc->flags & SC_SCRN_BLANKED)) {
2120 	    error = 0;
2121 	    break;
2122 	}
2123 	error = tsleep(&scrn_blanked, PZERO | PCATCH, "scrsav", 0);
2124 	if ((error != 0) && (error != ERESTART))
2125 	    break;
2126     }
2127     run_scrn_saver = FALSE;
2128     return error;
2129 }
2130 #endif /* DEV_SPLASH */
2131 
2132 void
2133 sc_touch_scrn_saver(void)
2134 {
2135     scsplash_stick(FALSE);
2136     run_scrn_saver = FALSE;
2137 }
2138 
2139 int
2140 sc_switch_scr(sc_softc_t *sc, u_int next_scr)
2141 {
2142     scr_stat *cur_scp;
2143     struct tty *tp;
2144     struct proc *p;
2145     int s;
2146 
2147     DPRINTF(5, ("sc0: sc_switch_scr() %d ", next_scr + 1));
2148 
2149     if (sc->cur_scp == NULL)
2150 	return (0);
2151 
2152     /* prevent switch if previously requested */
2153     if (sc->flags & SC_SCRN_VTYLOCK) {
2154 	    sc_bell(sc->cur_scp, sc->cur_scp->bell_pitch,
2155 		sc->cur_scp->bell_duration);
2156 	    return EPERM;
2157     }
2158 
2159     /* delay switch if the screen is blanked or being updated */
2160     if ((sc->flags & SC_SCRN_BLANKED) || sc->write_in_progress
2161 	|| sc->blink_in_progress) {
2162 	sc->delayed_next_scr = next_scr + 1;
2163 	sc_touch_scrn_saver();
2164 	DPRINTF(5, ("switch delayed\n"));
2165 	return 0;
2166     }
2167     sc->delayed_next_scr = 0;
2168 
2169     s = spltty();
2170     cur_scp = sc->cur_scp;
2171 
2172     /* we are in the middle of the vty switching process... */
2173     if (sc->switch_in_progress
2174 	&& (cur_scp->smode.mode == VT_PROCESS)
2175 	&& cur_scp->proc) {
2176 	p = pfind(cur_scp->pid);
2177 	if (cur_scp->proc != p) {
2178 	    if (p)
2179 		PROC_UNLOCK(p);
2180 	    /*
2181 	     * The controlling process has died!!.  Do some clean up.
2182 	     * NOTE:`cur_scp->proc' and `cur_scp->smode.mode'
2183 	     * are not reset here yet; they will be cleared later.
2184 	     */
2185 	    DPRINTF(5, ("cur_scp controlling process %d died, ",
2186 	       cur_scp->pid));
2187 	    if (cur_scp->status & SWITCH_WAIT_REL) {
2188 		/*
2189 		 * Force the previous switch to finish, but return now
2190 		 * with error.
2191 		 */
2192 		DPRINTF(5, ("reset WAIT_REL, "));
2193 		finish_vt_rel(cur_scp, TRUE, &s);
2194 		splx(s);
2195 		DPRINTF(5, ("finishing previous switch\n"));
2196 		return EINVAL;
2197 	    } else if (cur_scp->status & SWITCH_WAIT_ACQ) {
2198 		/* let's assume screen switch has been completed. */
2199 		DPRINTF(5, ("reset WAIT_ACQ, "));
2200 		finish_vt_acq(cur_scp);
2201 	    } else {
2202 		/*
2203 	 	 * We are in between screen release and acquisition, and
2204 		 * reached here via scgetc() or scrn_timer() which has
2205 		 * interrupted exchange_scr(). Don't do anything stupid.
2206 		 */
2207 		DPRINTF(5, ("waiting nothing, "));
2208 	    }
2209 	} else {
2210 	    if (p)
2211 		PROC_UNLOCK(p);
2212 	    /*
2213 	     * The controlling process is alive, but not responding...
2214 	     * It is either buggy or it may be just taking time.
2215 	     * The following code is a gross kludge to cope with this
2216 	     * problem for which there is no clean solution. XXX
2217 	     */
2218 	    if (cur_scp->status & SWITCH_WAIT_REL) {
2219 		switch (sc->switch_in_progress++) {
2220 		case 1:
2221 		    break;
2222 		case 2:
2223 		    DPRINTF(5, ("sending relsig again, "));
2224 		    signal_vt_rel(cur_scp);
2225 		    break;
2226 		case 3:
2227 		    break;
2228 		case 4:
2229 		default:
2230 		    /*
2231 		     * Act as if the controlling program returned
2232 		     * VT_FALSE.
2233 		     */
2234 		    DPRINTF(5, ("force reset WAIT_REL, "));
2235 		    finish_vt_rel(cur_scp, FALSE, &s);
2236 		    splx(s);
2237 		    DPRINTF(5, ("act as if VT_FALSE was seen\n"));
2238 		    return EINVAL;
2239 		}
2240 	    } else if (cur_scp->status & SWITCH_WAIT_ACQ) {
2241 		switch (sc->switch_in_progress++) {
2242 		case 1:
2243 		    break;
2244 		case 2:
2245 		    DPRINTF(5, ("sending acqsig again, "));
2246 		    signal_vt_acq(cur_scp);
2247 		    break;
2248 		case 3:
2249 		    break;
2250 		case 4:
2251 		default:
2252 		     /* clear the flag and finish the previous switch */
2253 		    DPRINTF(5, ("force reset WAIT_ACQ, "));
2254 		    finish_vt_acq(cur_scp);
2255 		    break;
2256 		}
2257 	    }
2258 	}
2259     }
2260 
2261     /*
2262      * Return error if an invalid argument is given, or vty switch
2263      * is still in progress.
2264      */
2265     if ((next_scr < sc->first_vty) || (next_scr >= sc->first_vty + sc->vtys)
2266 	|| sc->switch_in_progress) {
2267 	splx(s);
2268 	sc_bell(cur_scp, bios_value.bell_pitch, BELL_DURATION);
2269 	DPRINTF(5, ("error 1\n"));
2270 	return EINVAL;
2271     }
2272 
2273     /*
2274      * Don't allow switching away from the graphics mode vty
2275      * if the switch mode is VT_AUTO, unless the next vty is the same
2276      * as the current or the current vty has been closed (but showing).
2277      */
2278     tp = SC_DEV(sc, cur_scp->index);
2279     if ((cur_scp->index != next_scr)
2280 	&& tty_opened(tp)
2281 	&& (cur_scp->smode.mode == VT_AUTO)
2282 	&& ISGRAPHSC(cur_scp)) {
2283 	splx(s);
2284 	sc_bell(cur_scp, bios_value.bell_pitch, BELL_DURATION);
2285 	DPRINTF(5, ("error, graphics mode\n"));
2286 	return EINVAL;
2287     }
2288 
2289     /*
2290      * Is the wanted vty open? Don't allow switching to a closed vty.
2291      * If we are in DDB, don't switch to a vty in the VT_PROCESS mode.
2292      * Note that we always allow the user to switch to the kernel
2293      * console even if it is closed.
2294      */
2295     if ((sc_console == NULL) || (next_scr != sc_console->index)) {
2296 	tp = SC_DEV(sc, next_scr);
2297 	if (!tty_opened(tp)) {
2298 	    splx(s);
2299 	    sc_bell(cur_scp, bios_value.bell_pitch, BELL_DURATION);
2300 	    DPRINTF(5, ("error 2, requested vty isn't open!\n"));
2301 	    return EINVAL;
2302 	}
2303 	if ((debugger > 0) && (SC_STAT(tp)->smode.mode == VT_PROCESS)) {
2304 	    splx(s);
2305 	    DPRINTF(5, ("error 3, requested vty is in the VT_PROCESS mode\n"));
2306 	    return EINVAL;
2307 	}
2308     }
2309 
2310     /* this is the start of vty switching process... */
2311     ++sc->switch_in_progress;
2312     sc->old_scp = cur_scp;
2313     sc->new_scp = sc_get_stat(SC_DEV(sc, next_scr));
2314     if (sc->new_scp == sc->old_scp) {
2315 	sc->switch_in_progress = 0;
2316 	/*
2317 	 * XXX wakeup() locks the scheduler lock which will hang if
2318 	 * the lock is in an in-between state, e.g., when we stop at
2319 	 * a breakpoint at fork_exit.  It has always been wrong to call
2320 	 * wakeup() when the debugger is active.  In RELENG_4, wakeup()
2321 	 * is supposed to be locked by splhigh(), but the debugger may
2322 	 * be invoked at splhigh().
2323 	 */
2324 	if (debugger == 0)
2325 	    wakeup(VTY_WCHAN(sc,next_scr));
2326 	splx(s);
2327 	DPRINTF(5, ("switch done (new == old)\n"));
2328 	return 0;
2329     }
2330 
2331     /* has controlling process died? */
2332     vt_proc_alive(sc->old_scp);
2333     vt_proc_alive(sc->new_scp);
2334 
2335     /* wait for the controlling process to release the screen, if necessary */
2336     if (signal_vt_rel(sc->old_scp)) {
2337 	splx(s);
2338 	return 0;
2339     }
2340 
2341     /* go set up the new vty screen */
2342     splx(s);
2343     exchange_scr(sc);
2344     s = spltty();
2345 
2346     /* wake up processes waiting for this vty */
2347     if (debugger == 0)
2348 	wakeup(VTY_WCHAN(sc,next_scr));
2349 
2350     /* wait for the controlling process to acknowledge, if necessary */
2351     if (signal_vt_acq(sc->cur_scp)) {
2352 	splx(s);
2353 	return 0;
2354     }
2355 
2356     sc->switch_in_progress = 0;
2357     if (sc->unit == sc_console_unit)
2358 	cnavailable(sc_consptr,  TRUE);
2359     splx(s);
2360     DPRINTF(5, ("switch done\n"));
2361 
2362     return 0;
2363 }
2364 
2365 static int
2366 do_switch_scr(sc_softc_t *sc, int s)
2367 {
2368     vt_proc_alive(sc->new_scp);
2369 
2370     splx(s);
2371     exchange_scr(sc);
2372     s = spltty();
2373     /* sc->cur_scp == sc->new_scp */
2374     wakeup(VTY_WCHAN(sc,sc->cur_scp->index));
2375 
2376     /* wait for the controlling process to acknowledge, if necessary */
2377     if (!signal_vt_acq(sc->cur_scp)) {
2378 	sc->switch_in_progress = 0;
2379 	if (sc->unit == sc_console_unit)
2380 	    cnavailable(sc_consptr,  TRUE);
2381     }
2382 
2383     return s;
2384 }
2385 
2386 static int
2387 vt_proc_alive(scr_stat *scp)
2388 {
2389     struct proc *p;
2390 
2391     if (scp->proc) {
2392 	if ((p = pfind(scp->pid)) != NULL)
2393 	    PROC_UNLOCK(p);
2394 	if (scp->proc == p)
2395 	    return TRUE;
2396 	scp->proc = NULL;
2397 	scp->smode.mode = VT_AUTO;
2398 	DPRINTF(5, ("vt controlling process %d died\n", scp->pid));
2399     }
2400     return FALSE;
2401 }
2402 
2403 static int
2404 signal_vt_rel(scr_stat *scp)
2405 {
2406     if (scp->smode.mode != VT_PROCESS)
2407 	return FALSE;
2408     scp->status |= SWITCH_WAIT_REL;
2409     PROC_LOCK(scp->proc);
2410     psignal(scp->proc, scp->smode.relsig);
2411     PROC_UNLOCK(scp->proc);
2412     DPRINTF(5, ("sending relsig to %d\n", scp->pid));
2413     return TRUE;
2414 }
2415 
2416 static int
2417 signal_vt_acq(scr_stat *scp)
2418 {
2419     if (scp->smode.mode != VT_PROCESS)
2420 	return FALSE;
2421     if (scp->sc->unit == sc_console_unit)
2422 	cnavailable(sc_consptr,  FALSE);
2423     scp->status |= SWITCH_WAIT_ACQ;
2424     PROC_LOCK(scp->proc);
2425     psignal(scp->proc, scp->smode.acqsig);
2426     PROC_UNLOCK(scp->proc);
2427     DPRINTF(5, ("sending acqsig to %d\n", scp->pid));
2428     return TRUE;
2429 }
2430 
2431 static int
2432 finish_vt_rel(scr_stat *scp, int release, int *s)
2433 {
2434     if (scp == scp->sc->old_scp && scp->status & SWITCH_WAIT_REL) {
2435 	scp->status &= ~SWITCH_WAIT_REL;
2436 	if (release)
2437 	    *s = do_switch_scr(scp->sc, *s);
2438 	else
2439 	    scp->sc->switch_in_progress = 0;
2440 	return 0;
2441     }
2442     return EINVAL;
2443 }
2444 
2445 static int
2446 finish_vt_acq(scr_stat *scp)
2447 {
2448     if (scp == scp->sc->new_scp && scp->status & SWITCH_WAIT_ACQ) {
2449 	scp->status &= ~SWITCH_WAIT_ACQ;
2450 	scp->sc->switch_in_progress = 0;
2451 	return 0;
2452     }
2453     return EINVAL;
2454 }
2455 
2456 static void
2457 exchange_scr(sc_softc_t *sc)
2458 {
2459     scr_stat *scp;
2460 
2461     /* save the current state of video and keyboard */
2462     sc_move_cursor(sc->old_scp, sc->old_scp->xpos, sc->old_scp->ypos);
2463     if (!ISGRAPHSC(sc->old_scp))
2464 	sc_remove_cursor_image(sc->old_scp);
2465     if (sc->old_scp->kbd_mode == K_XLATE)
2466 	save_kbd_state(sc->old_scp);
2467 
2468     /* set up the video for the new screen */
2469     scp = sc->cur_scp = sc->new_scp;
2470 #ifdef PC98
2471     if (sc->old_scp->mode != scp->mode || ISUNKNOWNSC(sc->old_scp) || ISUNKNOWNSC(sc->new_scp))
2472 #else
2473     if (sc->old_scp->mode != scp->mode || ISUNKNOWNSC(sc->old_scp))
2474 #endif
2475 	set_mode(scp);
2476 #ifndef __sparc64__
2477     else
2478 	sc_vtb_init(&scp->scr, VTB_FRAMEBUFFER, scp->xsize, scp->ysize,
2479 		    (void *)sc->adp->va_window, FALSE);
2480 #endif
2481     scp->status |= MOUSE_HIDDEN;
2482     sc_move_cursor(scp, scp->xpos, scp->ypos);
2483     if (!ISGRAPHSC(scp))
2484 	sc_set_cursor_image(scp);
2485 #ifndef SC_NO_PALETTE_LOADING
2486     if (ISGRAPHSC(sc->old_scp))
2487 	vidd_load_palette(sc->adp, sc->palette);
2488 #endif
2489     sc_set_border(scp, scp->border);
2490 
2491     /* set up the keyboard for the new screen */
2492     if (sc->old_scp->kbd_mode != scp->kbd_mode)
2493 	kbdd_ioctl(sc->kbd, KDSKBMODE, (caddr_t)&scp->kbd_mode);
2494     update_kbd_state(scp, scp->status, LOCK_MASK);
2495 
2496     mark_all(scp);
2497 }
2498 
2499 void
2500 sc_puts(scr_stat *scp, u_char *buf, int len, int kernel)
2501 {
2502     int need_unlock = 0;
2503 
2504 #ifdef DEV_SPLASH
2505     /* make screensaver happy */
2506     if (!sticky_splash && scp == scp->sc->cur_scp && !sc_saver_keyb_only)
2507 	run_scrn_saver = FALSE;
2508 #endif
2509 
2510     if (scp->tsw) {
2511 	if (!kdb_active && !mtx_owned(&scp->scr_lock)) {
2512 		need_unlock = 1;
2513 		mtx_lock_spin(&scp->scr_lock);
2514 	}
2515 	(*scp->tsw->te_puts)(scp, buf, len, kernel);
2516 	if (need_unlock)
2517 		mtx_unlock_spin(&scp->scr_lock);
2518     }
2519 
2520     if (scp->sc->delayed_next_scr)
2521 	sc_switch_scr(scp->sc, scp->sc->delayed_next_scr - 1);
2522 }
2523 
2524 void
2525 sc_draw_cursor_image(scr_stat *scp)
2526 {
2527     /* assert(scp == scp->sc->cur_scp); */
2528     SC_VIDEO_LOCK(scp->sc);
2529     (*scp->rndr->draw_cursor)(scp, scp->cursor_pos,
2530 			      scp->curs_attr.flags & CONS_BLINK_CURSOR, TRUE,
2531 			      sc_inside_cutmark(scp, scp->cursor_pos));
2532     scp->cursor_oldpos = scp->cursor_pos;
2533     SC_VIDEO_UNLOCK(scp->sc);
2534 }
2535 
2536 void
2537 sc_remove_cursor_image(scr_stat *scp)
2538 {
2539     /* assert(scp == scp->sc->cur_scp); */
2540     SC_VIDEO_LOCK(scp->sc);
2541     (*scp->rndr->draw_cursor)(scp, scp->cursor_oldpos,
2542 			      scp->curs_attr.flags & CONS_BLINK_CURSOR, FALSE,
2543 			      sc_inside_cutmark(scp, scp->cursor_oldpos));
2544     SC_VIDEO_UNLOCK(scp->sc);
2545 }
2546 
2547 static void
2548 update_cursor_image(scr_stat *scp)
2549 {
2550     /* assert(scp == scp->sc->cur_scp); */
2551     sc_remove_cursor_image(scp);
2552     sc_set_cursor_image(scp);
2553     sc_draw_cursor_image(scp);
2554 }
2555 
2556 void
2557 sc_set_cursor_image(scr_stat *scp)
2558 {
2559     scp->curs_attr.flags = scp->curr_curs_attr.flags;
2560     if (scp->curs_attr.flags & CONS_HIDDEN_CURSOR) {
2561 	/* hidden cursor is internally represented as zero-height underline */
2562 	scp->curs_attr.flags = CONS_CHAR_CURSOR;
2563 	scp->curs_attr.base = scp->curs_attr.height = 0;
2564     } else if (scp->curs_attr.flags & CONS_CHAR_CURSOR) {
2565 	scp->curs_attr.base = imin(scp->curr_curs_attr.base,
2566 				  scp->font_size - 1);
2567 	scp->curs_attr.height = imin(scp->curr_curs_attr.height,
2568 				    scp->font_size - scp->curs_attr.base);
2569     } else {	/* block cursor */
2570 	scp->curs_attr.base = 0;
2571 	scp->curs_attr.height = scp->font_size;
2572     }
2573 
2574     /* assert(scp == scp->sc->cur_scp); */
2575     SC_VIDEO_LOCK(scp->sc);
2576     (*scp->rndr->set_cursor)(scp, scp->curs_attr.base, scp->curs_attr.height,
2577 			     scp->curs_attr.flags & CONS_BLINK_CURSOR);
2578     SC_VIDEO_UNLOCK(scp->sc);
2579 }
2580 
2581 static void
2582 change_cursor_shape(scr_stat *scp, int flags, int base, int height)
2583 {
2584     if ((scp == scp->sc->cur_scp) && !ISGRAPHSC(scp))
2585 	sc_remove_cursor_image(scp);
2586 
2587     if (base >= 0)
2588 	scp->curr_curs_attr.base = base;
2589     if (height >= 0)
2590 	scp->curr_curs_attr.height = height;
2591     if (flags & CONS_RESET_CURSOR)
2592 	scp->curr_curs_attr = scp->dflt_curs_attr;
2593     else
2594 	scp->curr_curs_attr.flags = flags & CONS_CURSOR_ATTRS;
2595 
2596     if ((scp == scp->sc->cur_scp) && !ISGRAPHSC(scp)) {
2597 	sc_set_cursor_image(scp);
2598 	sc_draw_cursor_image(scp);
2599     }
2600 }
2601 
2602 void
2603 sc_change_cursor_shape(scr_stat *scp, int flags, int base, int height)
2604 {
2605     sc_softc_t *sc;
2606     struct tty *tp;
2607     int s;
2608     int i;
2609 
2610     s = spltty();
2611     if ((flags != -1) && (flags & CONS_LOCAL_CURSOR)) {
2612 	/* local (per vty) change */
2613 	change_cursor_shape(scp, flags, base, height);
2614 	splx(s);
2615 	return;
2616     }
2617 
2618     /* global change */
2619     sc = scp->sc;
2620     if (base >= 0)
2621 	sc->curs_attr.base = base;
2622     if (height >= 0)
2623 	sc->curs_attr.height = height;
2624     if (flags != -1) {
2625 	if (flags & CONS_RESET_CURSOR)
2626 	    sc->curs_attr = sc->dflt_curs_attr;
2627 	else
2628 	    sc->curs_attr.flags = flags & CONS_CURSOR_ATTRS;
2629     }
2630 
2631     for (i = sc->first_vty; i < sc->first_vty + sc->vtys; ++i) {
2632 	if ((tp = SC_DEV(sc, i)) == NULL)
2633 	    continue;
2634 	if ((scp = sc_get_stat(tp)) == NULL)
2635 	    continue;
2636 	scp->dflt_curs_attr = sc->curs_attr;
2637 	change_cursor_shape(scp, CONS_RESET_CURSOR, -1, -1);
2638     }
2639     splx(s);
2640 }
2641 
2642 static void
2643 scinit(int unit, int flags)
2644 {
2645 
2646     /*
2647      * When syscons is being initialized as the kernel console, malloc()
2648      * is not yet functional, because various kernel structures has not been
2649      * fully initialized yet.  Therefore, we need to declare the following
2650      * static buffers for the console.  This is less than ideal,
2651      * but is necessry evil for the time being.  XXX
2652      */
2653 #ifdef PC98
2654     static u_short sc_buffer[ROW*COL*2];/* XXX */
2655 #else
2656     static u_short sc_buffer[ROW*COL];	/* XXX */
2657 #endif
2658 #ifndef SC_NO_FONT_LOADING
2659     static u_char font_8[256*8];
2660     static u_char font_14[256*14];
2661     static u_char font_16[256*16];
2662 #endif
2663 
2664     sc_softc_t *sc;
2665     scr_stat *scp;
2666     video_adapter_t *adp;
2667     int col;
2668     int row;
2669     int i;
2670 
2671     /* one time initialization */
2672     if (init_done == COLD)
2673 	sc_get_bios_values(&bios_value);
2674     init_done = WARM;
2675 
2676     /*
2677      * Allocate resources.  Even if we are being called for the second
2678      * time, we must allocate them again, because they might have
2679      * disappeared...
2680      */
2681     sc = sc_get_softc(unit, flags & SC_KERNEL_CONSOLE);
2682     if ((sc->flags & SC_INIT_DONE) == 0)
2683 	SC_VIDEO_LOCKINIT(sc);
2684 
2685     adp = NULL;
2686     if (sc->adapter >= 0) {
2687 	vid_release(sc->adp, (void *)&sc->adapter);
2688 	adp = sc->adp;
2689 	sc->adp = NULL;
2690     }
2691     if (sc->keyboard >= 0) {
2692 	DPRINTF(5, ("sc%d: releasing kbd%d\n", unit, sc->keyboard));
2693 	i = kbd_release(sc->kbd, (void *)&sc->keyboard);
2694 	DPRINTF(5, ("sc%d: kbd_release returned %d\n", unit, i));
2695 	if (sc->kbd != NULL) {
2696 	    DPRINTF(5, ("sc%d: kbd != NULL!, index:%d, unit:%d, flags:0x%x\n",
2697 		unit, sc->kbd->kb_index, sc->kbd->kb_unit, sc->kbd->kb_flags));
2698 	}
2699 	sc->kbd = NULL;
2700     }
2701     sc->adapter = vid_allocate("*", unit, (void *)&sc->adapter);
2702     sc->adp = vid_get_adapter(sc->adapter);
2703     /* assert((sc->adapter >= 0) && (sc->adp != NULL)) */
2704 
2705     sc->keyboard = sc_allocate_keyboard(sc, unit);
2706     DPRINTF(1, ("sc%d: keyboard %d\n", unit, sc->keyboard));
2707 
2708     sc->kbd = kbd_get_keyboard(sc->keyboard);
2709     if (sc->kbd != NULL) {
2710 	DPRINTF(1, ("sc%d: kbd index:%d, unit:%d, flags:0x%x\n",
2711 		unit, sc->kbd->kb_index, sc->kbd->kb_unit, sc->kbd->kb_flags));
2712     }
2713 
2714     if (!(sc->flags & SC_INIT_DONE) || (adp != sc->adp)) {
2715 
2716 	sc->initial_mode = sc->adp->va_initial_mode;
2717 
2718 #ifndef SC_NO_FONT_LOADING
2719 	if (flags & SC_KERNEL_CONSOLE) {
2720 	    sc->font_8 = font_8;
2721 	    sc->font_14 = font_14;
2722 	    sc->font_16 = font_16;
2723 	} else if (sc->font_8 == NULL) {
2724 	    /* assert(sc_malloc) */
2725 	    sc->font_8 = malloc(sizeof(font_8), M_DEVBUF, M_WAITOK);
2726 	    sc->font_14 = malloc(sizeof(font_14), M_DEVBUF, M_WAITOK);
2727 	    sc->font_16 = malloc(sizeof(font_16), M_DEVBUF, M_WAITOK);
2728 	}
2729 #endif
2730 
2731 	/* extract the hardware cursor location and hide the cursor for now */
2732 	vidd_read_hw_cursor(sc->adp, &col, &row);
2733 	vidd_set_hw_cursor(sc->adp, -1, -1);
2734 
2735 	/* set up the first console */
2736 	sc->first_vty = unit*MAXCONS;
2737 	sc->vtys = MAXCONS;		/* XXX: should be configurable */
2738 	if (flags & SC_KERNEL_CONSOLE) {
2739 	    /*
2740 	     * Set up devs structure but don't use it yet, calling make_dev()
2741 	     * might panic kernel.  Wait for sc_attach_unit() to actually
2742 	     * create the devices.
2743 	     */
2744 	    sc->dev = main_devs;
2745 	    scp = &main_console;
2746 	    init_scp(sc, sc->first_vty, scp);
2747 	    sc_vtb_init(&scp->vtb, VTB_MEMORY, scp->xsize, scp->ysize,
2748 			(void *)sc_buffer, FALSE);
2749 
2750 	    /* move cursors to the initial positions */
2751 	    if (col >= scp->xsize)
2752 		col = 0;
2753 	    if (row >= scp->ysize)
2754 		row = scp->ysize - 1;
2755 	    scp->xpos = col;
2756 	    scp->ypos = row;
2757 	    scp->cursor_pos = scp->cursor_oldpos = row*scp->xsize + col;
2758 
2759 	    if (sc_init_emulator(scp, SC_DFLT_TERM))
2760 		sc_init_emulator(scp, "*");
2761 	    (*scp->tsw->te_default_attr)(scp,
2762 					 user_default.std_color,
2763 					 user_default.rev_color);
2764 	} else {
2765 	    /* assert(sc_malloc) */
2766 	    sc->dev = malloc(sizeof(struct tty *)*sc->vtys, M_DEVBUF,
2767 	        M_WAITOK|M_ZERO);
2768 	    sc->dev[0] = sc_alloc_tty(0, unit * MAXCONS);
2769 	    scp = alloc_scp(sc, sc->first_vty);
2770 	    SC_STAT(sc->dev[0]) = scp;
2771 	}
2772 	sc->cur_scp = scp;
2773 
2774 #ifndef __sparc64__
2775 	/* copy screen to temporary buffer */
2776 	sc_vtb_init(&scp->scr, VTB_FRAMEBUFFER, scp->xsize, scp->ysize,
2777 		    (void *)scp->sc->adp->va_window, FALSE);
2778 	if (ISTEXTSC(scp))
2779 	    sc_vtb_copy(&scp->scr, 0, &scp->vtb, 0, scp->xsize*scp->ysize);
2780 #endif
2781 
2782 	if (bios_value.cursor_end < scp->font_size)
2783 	    sc->dflt_curs_attr.base = scp->font_size -
2784 					  bios_value.cursor_end - 1;
2785 	else
2786 	    sc->dflt_curs_attr.base = 0;
2787 	i = bios_value.cursor_end - bios_value.cursor_start + 1;
2788 	sc->dflt_curs_attr.height = imin(i, scp->font_size);
2789 	sc->dflt_curs_attr.flags = 0;
2790 	sc->curs_attr = sc->dflt_curs_attr;
2791 	scp->curr_curs_attr = scp->dflt_curs_attr = sc->curs_attr;
2792 
2793 #ifndef SC_NO_SYSMOUSE
2794 	sc_mouse_move(scp, scp->xpixel/2, scp->ypixel/2);
2795 #endif
2796 	if (!ISGRAPHSC(scp)) {
2797     	    sc_set_cursor_image(scp);
2798     	    sc_draw_cursor_image(scp);
2799 	}
2800 
2801 	/* save font and palette */
2802 #ifndef SC_NO_FONT_LOADING
2803 	sc->fonts_loaded = 0;
2804 	if (ISFONTAVAIL(sc->adp->va_flags)) {
2805 #ifdef SC_DFLT_FONT
2806 	    bcopy(dflt_font_8, sc->font_8, sizeof(dflt_font_8));
2807 	    bcopy(dflt_font_14, sc->font_14, sizeof(dflt_font_14));
2808 	    bcopy(dflt_font_16, sc->font_16, sizeof(dflt_font_16));
2809 	    sc->fonts_loaded = FONT_16 | FONT_14 | FONT_8;
2810 	    if (scp->font_size < 14) {
2811 		sc_load_font(scp, 0, 8, 8, sc->font_8, 0, 256);
2812 	    } else if (scp->font_size >= 16) {
2813 		sc_load_font(scp, 0, 16, 8, sc->font_16, 0, 256);
2814 	    } else {
2815 		sc_load_font(scp, 0, 14, 8, sc->font_14, 0, 256);
2816 	    }
2817 #else /* !SC_DFLT_FONT */
2818 	    if (scp->font_size < 14) {
2819 		sc_save_font(scp, 0, 8, 8, sc->font_8, 0, 256);
2820 		sc->fonts_loaded = FONT_8;
2821 	    } else if (scp->font_size >= 16) {
2822 		sc_save_font(scp, 0, 16, 8, sc->font_16, 0, 256);
2823 		sc->fonts_loaded = FONT_16;
2824 	    } else {
2825 		sc_save_font(scp, 0, 14, 8, sc->font_14, 0, 256);
2826 		sc->fonts_loaded = FONT_14;
2827 	    }
2828 #endif /* SC_DFLT_FONT */
2829 	    /* FONT KLUDGE: always use the font page #0. XXX */
2830 	    sc_show_font(scp, 0);
2831 	}
2832 #endif /* !SC_NO_FONT_LOADING */
2833 
2834 #ifndef SC_NO_PALETTE_LOADING
2835 	vidd_save_palette(sc->adp, sc->palette);
2836 #endif
2837 
2838 #ifdef DEV_SPLASH
2839 	if (!(sc->flags & SC_SPLASH_SCRN)) {
2840 	    /* we are ready to put up the splash image! */
2841 	    splash_init(sc->adp, scsplash_callback, sc);
2842 	    sc->flags |= SC_SPLASH_SCRN;
2843 	}
2844 #endif
2845     }
2846 
2847     /* the rest is not necessary, if we have done it once */
2848     if (sc->flags & SC_INIT_DONE)
2849 	return;
2850 
2851     /* initialize mapscrn arrays to a one to one map */
2852     for (i = 0; i < sizeof(sc->scr_map); i++)
2853 	sc->scr_map[i] = sc->scr_rmap[i] = i;
2854 #ifdef PC98
2855     sc->scr_map[0x5c] = (u_char)0xfc;	/* for backslash */
2856 #endif
2857 
2858     sc->flags |= SC_INIT_DONE;
2859 }
2860 
2861 static void
2862 scterm(int unit, int flags)
2863 {
2864     sc_softc_t *sc;
2865     scr_stat *scp;
2866 
2867     sc = sc_get_softc(unit, flags & SC_KERNEL_CONSOLE);
2868     if (sc == NULL)
2869 	return;			/* shouldn't happen */
2870 
2871 #ifdef DEV_SPLASH
2872     /* this console is no longer available for the splash screen */
2873     if (sc->flags & SC_SPLASH_SCRN) {
2874 	splash_term(sc->adp);
2875 	sc->flags &= ~SC_SPLASH_SCRN;
2876     }
2877 #endif
2878 
2879 #if 0 /* XXX */
2880     /* move the hardware cursor to the upper-left corner */
2881     vidd_set_hw_cursor(sc->adp, 0, 0);
2882 #endif
2883 
2884     /* release the keyboard and the video card */
2885     if (sc->keyboard >= 0)
2886 	kbd_release(sc->kbd, &sc->keyboard);
2887     if (sc->adapter >= 0)
2888 	vid_release(sc->adp, &sc->adapter);
2889 
2890     /* stop the terminal emulator, if any */
2891     scp = sc_get_stat(sc->dev[0]);
2892     if (scp->tsw)
2893 	(*scp->tsw->te_term)(scp, &scp->ts);
2894     if (scp->ts != NULL)
2895 	free(scp->ts, M_DEVBUF);
2896     mtx_destroy(&scp->scr_lock);
2897 
2898     /* clear the structure */
2899     if (!(flags & SC_KERNEL_CONSOLE)) {
2900 	/* XXX: We need delete_dev() for this */
2901 	free(sc->dev, M_DEVBUF);
2902 #if 0
2903 	/* XXX: We need a ttyunregister for this */
2904 	free(sc->tty, M_DEVBUF);
2905 #endif
2906 #ifndef SC_NO_FONT_LOADING
2907 	free(sc->font_8, M_DEVBUF);
2908 	free(sc->font_14, M_DEVBUF);
2909 	free(sc->font_16, M_DEVBUF);
2910 #endif
2911 	/* XXX vtb, history */
2912     }
2913     bzero(sc, sizeof(*sc));
2914     sc->keyboard = -1;
2915     sc->adapter = -1;
2916 }
2917 
2918 static void
2919 scshutdown(void *arg, int howto)
2920 {
2921     /* assert(sc_console != NULL) */
2922 
2923     sc_touch_scrn_saver();
2924     if (!cold && sc_console
2925 	&& sc_console->sc->cur_scp->smode.mode == VT_AUTO
2926 	&& sc_console->smode.mode == VT_AUTO)
2927 	sc_switch_scr(sc_console->sc, sc_console->index);
2928     shutdown_in_progress = TRUE;
2929 }
2930 
2931 int
2932 sc_clean_up(scr_stat *scp)
2933 {
2934 #ifdef DEV_SPLASH
2935     int error;
2936 #endif
2937 
2938     if (scp->sc->flags & SC_SCRN_BLANKED) {
2939 	sc_touch_scrn_saver();
2940 #ifdef DEV_SPLASH
2941 	if ((error = wait_scrn_saver_stop(scp->sc)))
2942 	    return error;
2943 #endif
2944     }
2945     scp->status |= MOUSE_HIDDEN;
2946     sc_remove_mouse_image(scp);
2947     sc_remove_cutmarking(scp);
2948     return 0;
2949 }
2950 
2951 void
2952 sc_alloc_scr_buffer(scr_stat *scp, int wait, int discard)
2953 {
2954     sc_vtb_t new;
2955     sc_vtb_t old;
2956 
2957     old = scp->vtb;
2958     sc_vtb_init(&new, VTB_MEMORY, scp->xsize, scp->ysize, NULL, wait);
2959     if (!discard && (old.vtb_flags & VTB_VALID)) {
2960 	/* retain the current cursor position and buffer contants */
2961 	scp->cursor_oldpos = scp->cursor_pos;
2962 	/*
2963 	 * This works only if the old buffer has the same size as or larger
2964 	 * than the new one. XXX
2965 	 */
2966 	sc_vtb_copy(&old, 0, &new, 0, scp->xsize*scp->ysize);
2967 	scp->vtb = new;
2968     } else {
2969 	scp->vtb = new;
2970 	sc_vtb_destroy(&old);
2971     }
2972 
2973 #ifndef SC_NO_SYSMOUSE
2974     /* move the mouse cursor at the center of the screen */
2975     sc_mouse_move(scp, scp->xpixel / 2, scp->ypixel / 2);
2976 #endif
2977 }
2978 
2979 static scr_stat
2980 *alloc_scp(sc_softc_t *sc, int vty)
2981 {
2982     scr_stat *scp;
2983 
2984     /* assert(sc_malloc) */
2985 
2986     scp = (scr_stat *)malloc(sizeof(scr_stat), M_DEVBUF, M_WAITOK);
2987     init_scp(sc, vty, scp);
2988 
2989     sc_alloc_scr_buffer(scp, TRUE, TRUE);
2990     if (sc_init_emulator(scp, SC_DFLT_TERM))
2991 	sc_init_emulator(scp, "*");
2992 
2993 #ifndef SC_NO_CUTPASTE
2994     sc_alloc_cut_buffer(scp, TRUE);
2995 #endif
2996 
2997 #ifndef SC_NO_HISTORY
2998     sc_alloc_history_buffer(scp, 0, 0, TRUE);
2999 #endif
3000 
3001     return scp;
3002 }
3003 
3004 static void
3005 init_scp(sc_softc_t *sc, int vty, scr_stat *scp)
3006 {
3007     video_info_t info;
3008 
3009     bzero(scp, sizeof(*scp));
3010 
3011     scp->index = vty;
3012     scp->sc = sc;
3013     scp->status = 0;
3014     scp->mode = sc->initial_mode;
3015     vidd_get_info(sc->adp, scp->mode, &info);
3016     if (info.vi_flags & V_INFO_GRAPHICS) {
3017 	scp->status |= GRAPHICS_MODE;
3018 	scp->xpixel = info.vi_width;
3019 	scp->ypixel = info.vi_height;
3020 	scp->xsize = info.vi_width/info.vi_cwidth;
3021 	scp->ysize = info.vi_height/info.vi_cheight;
3022 	scp->font_size = 0;
3023 	scp->font = NULL;
3024     } else {
3025 	scp->xsize = info.vi_width;
3026 	scp->ysize = info.vi_height;
3027 	scp->xpixel = scp->xsize*info.vi_cwidth;
3028 	scp->ypixel = scp->ysize*info.vi_cheight;
3029     }
3030 
3031 	scp->font_size = info.vi_cheight;
3032 	scp->font_width = info.vi_cwidth;
3033 	if (info.vi_cheight < 14) {
3034 #ifndef SC_NO_FONT_LOADING
3035 	    scp->font = sc->font_8;
3036 #else
3037 	    scp->font = NULL;
3038 #endif
3039 	} else if (info.vi_cheight >= 16) {
3040 #ifndef SC_NO_FONT_LOADING
3041 	    scp->font = sc->font_16;
3042 #else
3043 	    scp->font = NULL;
3044 #endif
3045 	} else {
3046 #ifndef SC_NO_FONT_LOADING
3047 	    scp->font = sc->font_14;
3048 #else
3049 	    scp->font = NULL;
3050 #endif
3051 	}
3052 
3053     sc_vtb_init(&scp->vtb, VTB_MEMORY, 0, 0, NULL, FALSE);
3054 #ifndef __sparc64__
3055     sc_vtb_init(&scp->scr, VTB_FRAMEBUFFER, 0, 0, NULL, FALSE);
3056 #endif
3057     scp->xoff = scp->yoff = 0;
3058     scp->xpos = scp->ypos = 0;
3059     scp->start = scp->xsize * scp->ysize - 1;
3060     scp->end = 0;
3061     scp->tsw = NULL;
3062     scp->ts = NULL;
3063     scp->rndr = NULL;
3064     scp->border = (SC_NORM_ATTR >> 4) & 0x0f;
3065     scp->curr_curs_attr = scp->dflt_curs_attr = sc->curs_attr;
3066     scp->mouse_cut_start = scp->xsize*scp->ysize;
3067     scp->mouse_cut_end = -1;
3068     scp->mouse_signal = 0;
3069     scp->mouse_pid = 0;
3070     scp->mouse_proc = NULL;
3071     scp->kbd_mode = K_XLATE;
3072     scp->bell_pitch = bios_value.bell_pitch;
3073     scp->bell_duration = BELL_DURATION;
3074     scp->status |= (bios_value.shift_state & NLKED);
3075     scp->status |= CURSOR_ENABLED | MOUSE_HIDDEN;
3076     scp->pid = 0;
3077     scp->proc = NULL;
3078     scp->smode.mode = VT_AUTO;
3079     scp->history = NULL;
3080     scp->history_pos = 0;
3081     scp->history_size = 0;
3082 
3083     mtx_init(&scp->scr_lock, "scrlock", NULL, MTX_SPIN);
3084 }
3085 
3086 int
3087 sc_init_emulator(scr_stat *scp, char *name)
3088 {
3089     sc_term_sw_t *sw;
3090     sc_rndr_sw_t *rndr;
3091     void *p;
3092     int error;
3093 
3094     if (name == NULL)	/* if no name is given, use the current emulator */
3095 	sw = scp->tsw;
3096     else		/* ...otherwise find the named emulator */
3097 	sw = sc_term_match(name);
3098     if (sw == NULL)
3099 	return EINVAL;
3100 
3101     rndr = NULL;
3102     if (strcmp(sw->te_renderer, "*") != 0) {
3103 	rndr = sc_render_match(scp, sw->te_renderer,
3104 			       scp->status & (GRAPHICS_MODE | PIXEL_MODE));
3105     }
3106     if (rndr == NULL) {
3107 	rndr = sc_render_match(scp, scp->sc->adp->va_name,
3108 			       scp->status & (GRAPHICS_MODE | PIXEL_MODE));
3109 	if (rndr == NULL)
3110 	    return ENODEV;
3111     }
3112 
3113     if (sw == scp->tsw) {
3114 	error = (*sw->te_init)(scp, &scp->ts, SC_TE_WARM_INIT);
3115 	scp->rndr = rndr;
3116 	scp->rndr->init(scp);
3117 	sc_clear_screen(scp);
3118 	/* assert(error == 0); */
3119 	return error;
3120     }
3121 
3122     if (sc_malloc && (sw->te_size > 0))
3123 	p = malloc(sw->te_size, M_DEVBUF, M_NOWAIT);
3124     else
3125 	p = NULL;
3126     error = (*sw->te_init)(scp, &p, SC_TE_COLD_INIT);
3127     if (error)
3128 	return error;
3129 
3130     if (scp->tsw)
3131 	(*scp->tsw->te_term)(scp, &scp->ts);
3132     if (scp->ts != NULL)
3133 	free(scp->ts, M_DEVBUF);
3134     scp->tsw = sw;
3135     scp->ts = p;
3136     scp->rndr = rndr;
3137     scp->rndr->init(scp);
3138 
3139     /* XXX */
3140     (*sw->te_default_attr)(scp, user_default.std_color, user_default.rev_color);
3141     sc_clear_screen(scp);
3142 
3143     return 0;
3144 }
3145 
3146 /*
3147  * scgetc(flags) - get character from keyboard.
3148  * If flags & SCGETC_CN, then avoid harmful side effects.
3149  * If flags & SCGETC_NONBLOCK, then wait until a key is pressed, else
3150  * return NOKEY if there is nothing there.
3151  */
3152 static u_int
3153 scgetc(sc_softc_t *sc, u_int flags)
3154 {
3155     scr_stat *scp;
3156 #ifndef SC_NO_HISTORY
3157     struct tty *tp;
3158 #endif
3159     u_int c;
3160     int this_scr;
3161     int f;
3162     int i;
3163 
3164     if (sc->kbd == NULL)
3165 	return NOKEY;
3166 
3167 next_code:
3168 #if 1
3169     /* I don't like this, but... XXX */
3170     if (flags & SCGETC_CN)
3171 	sccnupdate(sc->cur_scp);
3172 #endif
3173     scp = sc->cur_scp;
3174     /* first see if there is something in the keyboard port */
3175     for (;;) {
3176 	c = kbdd_read_char(sc->kbd, !(flags & SCGETC_NONBLOCK));
3177 	if (c == ERRKEY) {
3178 	    if (!(flags & SCGETC_CN))
3179 		sc_bell(scp, bios_value.bell_pitch, BELL_DURATION);
3180 	} else if (c == NOKEY)
3181 	    return c;
3182 	else
3183 	    break;
3184     }
3185 
3186     /* make screensaver happy */
3187     if (!(c & RELKEY))
3188 	sc_touch_scrn_saver();
3189 
3190     if (!(flags & SCGETC_CN))
3191 	random_harvest(&c, sizeof(c), 1, 0, RANDOM_KEYBOARD);
3192 
3193     if (scp->kbd_mode != K_XLATE)
3194 	return KEYCHAR(c);
3195 
3196     /* if scroll-lock pressed allow history browsing */
3197     if (!ISGRAPHSC(scp) && scp->history && scp->status & SLKED) {
3198 
3199 	scp->status &= ~CURSOR_ENABLED;
3200 	sc_remove_cursor_image(scp);
3201 
3202 #ifndef SC_NO_HISTORY
3203 	if (!(scp->status & BUFFER_SAVED)) {
3204 	    scp->status |= BUFFER_SAVED;
3205 	    sc_hist_save(scp);
3206 	}
3207 	switch (c) {
3208 	/* FIXME: key codes */
3209 	case SPCLKEY | FKEY | F(49):  /* home key */
3210 	    sc_remove_cutmarking(scp);
3211 	    sc_hist_home(scp);
3212 	    goto next_code;
3213 
3214 	case SPCLKEY | FKEY | F(57):  /* end key */
3215 	    sc_remove_cutmarking(scp);
3216 	    sc_hist_end(scp);
3217 	    goto next_code;
3218 
3219 	case SPCLKEY | FKEY | F(50):  /* up arrow key */
3220 	    sc_remove_cutmarking(scp);
3221 	    if (sc_hist_up_line(scp))
3222 		if (!(flags & SCGETC_CN))
3223 		    sc_bell(scp, bios_value.bell_pitch, BELL_DURATION);
3224 	    goto next_code;
3225 
3226 	case SPCLKEY | FKEY | F(58):  /* down arrow key */
3227 	    sc_remove_cutmarking(scp);
3228 	    if (sc_hist_down_line(scp))
3229 		if (!(flags & SCGETC_CN))
3230 		    sc_bell(scp, bios_value.bell_pitch, BELL_DURATION);
3231 	    goto next_code;
3232 
3233 	case SPCLKEY | FKEY | F(51):  /* page up key */
3234 	    sc_remove_cutmarking(scp);
3235 	    for (i=0; i<scp->ysize; i++)
3236 	    if (sc_hist_up_line(scp)) {
3237 		if (!(flags & SCGETC_CN))
3238 		    sc_bell(scp, bios_value.bell_pitch, BELL_DURATION);
3239 		break;
3240 	    }
3241 	    goto next_code;
3242 
3243 	case SPCLKEY | FKEY | F(59):  /* page down key */
3244 	    sc_remove_cutmarking(scp);
3245 	    for (i=0; i<scp->ysize; i++)
3246 	    if (sc_hist_down_line(scp)) {
3247 		if (!(flags & SCGETC_CN))
3248 		    sc_bell(scp, bios_value.bell_pitch, BELL_DURATION);
3249 		break;
3250 	    }
3251 	    goto next_code;
3252 	}
3253 #endif /* SC_NO_HISTORY */
3254     }
3255 
3256     /*
3257      * Process and consume special keys here.  Return a plain char code
3258      * or a char code with the META flag or a function key code.
3259      */
3260     if (c & RELKEY) {
3261 	/* key released */
3262 	/* goto next_code */
3263     } else {
3264 	/* key pressed */
3265 	if (c & SPCLKEY) {
3266 	    c &= ~SPCLKEY;
3267 	    switch (KEYCHAR(c)) {
3268 	    /* LOCKING KEYS */
3269 	    case NLK: case CLK: case ALK:
3270 		break;
3271 	    case SLK:
3272 		kbdd_ioctl(sc->kbd, KDGKBSTATE, (caddr_t)&f);
3273 		if (f & SLKED) {
3274 		    scp->status |= SLKED;
3275 		} else {
3276 		    if (scp->status & SLKED) {
3277 			scp->status &= ~SLKED;
3278 #ifndef SC_NO_HISTORY
3279 			if (scp->status & BUFFER_SAVED) {
3280 			    if (!sc_hist_restore(scp))
3281 				sc_remove_cutmarking(scp);
3282 			    scp->status &= ~BUFFER_SAVED;
3283 			    scp->status |= CURSOR_ENABLED;
3284 			    sc_draw_cursor_image(scp);
3285 			}
3286 			tp = SC_DEV(sc, scp->index);
3287 			if (!kdb_active && tty_opened(tp))
3288 			    sctty_outwakeup(tp);
3289 #endif
3290 		    }
3291 		}
3292 		break;
3293 
3294 	    case PASTE:
3295 #ifndef SC_NO_CUTPASTE
3296 		sc_mouse_paste(scp);
3297 #endif
3298 		break;
3299 
3300 	    /* NON-LOCKING KEYS */
3301 	    case NOP:
3302 	    case LSH:  case RSH:  case LCTR: case RCTR:
3303 	    case LALT: case RALT: case ASH:  case META:
3304 		break;
3305 
3306 	    case BTAB:
3307 		if (!(sc->flags & SC_SCRN_BLANKED))
3308 		    return c;
3309 		break;
3310 
3311 	    case SPSC:
3312 #ifdef DEV_SPLASH
3313 		/* force activatation/deactivation of the screen saver */
3314 		if (!(sc->flags & SC_SCRN_BLANKED)) {
3315 		    run_scrn_saver = TRUE;
3316 		    sc->scrn_time_stamp -= scrn_blank_time;
3317 		}
3318 		if (cold) {
3319 		    /*
3320 		     * While devices are being probed, the screen saver need
3321 		     * to be invoked explictly. XXX
3322 		     */
3323 		    if (sc->flags & SC_SCRN_BLANKED) {
3324 			scsplash_stick(FALSE);
3325 			stop_scrn_saver(sc, current_saver);
3326 		    } else {
3327 			if (!ISGRAPHSC(scp)) {
3328 			    scsplash_stick(TRUE);
3329 			    (*current_saver)(sc, TRUE);
3330 			}
3331 		    }
3332 		}
3333 #endif /* DEV_SPLASH */
3334 		break;
3335 
3336 	    case RBT:
3337 #ifndef SC_DISABLE_REBOOT
3338 		if (enable_reboot)
3339 			shutdown_nice(0);
3340 #endif
3341 		break;
3342 
3343 	    case HALT:
3344 #ifndef SC_DISABLE_REBOOT
3345 		if (enable_reboot)
3346 			shutdown_nice(RB_HALT);
3347 #endif
3348 		break;
3349 
3350 	    case PDWN:
3351 #ifndef SC_DISABLE_REBOOT
3352 		if (enable_reboot)
3353 			shutdown_nice(RB_HALT|RB_POWEROFF);
3354 #endif
3355 		break;
3356 
3357 	    case SUSP:
3358 		power_pm_suspend(POWER_SLEEP_STATE_SUSPEND);
3359 		break;
3360 	    case STBY:
3361 		power_pm_suspend(POWER_SLEEP_STATE_STANDBY);
3362 		break;
3363 
3364 	    case DBG:
3365 #ifndef SC_DISABLE_KDBKEY
3366 		if (enable_kdbkey)
3367 			kdb_enter(KDB_WHY_BREAK, "manual escape to debugger");
3368 #endif
3369 		break;
3370 
3371 	    case PNC:
3372 		if (enable_panic_key)
3373 			panic("Forced by the panic key");
3374 		break;
3375 
3376 	    case NEXT:
3377 		this_scr = scp->index;
3378 		for (i = (this_scr - sc->first_vty + 1)%sc->vtys;
3379 			sc->first_vty + i != this_scr;
3380 			i = (i + 1)%sc->vtys) {
3381 		    struct tty *tp = SC_DEV(sc, sc->first_vty + i);
3382 		    if (tty_opened(tp)) {
3383 			sc_switch_scr(scp->sc, sc->first_vty + i);
3384 			break;
3385 		    }
3386 		}
3387 		break;
3388 
3389 	    case PREV:
3390 		this_scr = scp->index;
3391 		for (i = (this_scr - sc->first_vty + sc->vtys - 1)%sc->vtys;
3392 			sc->first_vty + i != this_scr;
3393 			i = (i + sc->vtys - 1)%sc->vtys) {
3394 		    struct tty *tp = SC_DEV(sc, sc->first_vty + i);
3395 		    if (tty_opened(tp)) {
3396 			sc_switch_scr(scp->sc, sc->first_vty + i);
3397 			break;
3398 		    }
3399 		}
3400 		break;
3401 
3402 	    default:
3403 		if (KEYCHAR(c) >= F_SCR && KEYCHAR(c) <= L_SCR) {
3404 		    sc_switch_scr(scp->sc, sc->first_vty + KEYCHAR(c) - F_SCR);
3405 		    break;
3406 		}
3407 		/* assert(c & FKEY) */
3408 		if (!(sc->flags & SC_SCRN_BLANKED))
3409 		    return c;
3410 		break;
3411 	    }
3412 	    /* goto next_code */
3413 	} else {
3414 	    /* regular keys (maybe MKEY is set) */
3415 	    if (!(sc->flags & SC_SCRN_BLANKED))
3416 		return c;
3417 	}
3418     }
3419 
3420     goto next_code;
3421 }
3422 
3423 static int
3424 sctty_mmap(struct tty *tp, vm_offset_t offset, vm_paddr_t *paddr, int nprot)
3425 {
3426     scr_stat *scp;
3427 
3428     scp = sc_get_stat(tp);
3429     if (scp != scp->sc->cur_scp)
3430 	return -1;
3431     return vidd_mmap(scp->sc->adp, offset, paddr, nprot);
3432 }
3433 
3434 static int
3435 save_kbd_state(scr_stat *scp)
3436 {
3437     int state;
3438     int error;
3439 
3440     error = kbdd_ioctl(scp->sc->kbd, KDGKBSTATE, (caddr_t)&state);
3441     if (error == ENOIOCTL)
3442 	error = ENODEV;
3443     if (error == 0) {
3444 	scp->status &= ~LOCK_MASK;
3445 	scp->status |= state;
3446     }
3447     return error;
3448 }
3449 
3450 static int
3451 update_kbd_state(scr_stat *scp, int new_bits, int mask)
3452 {
3453     int state;
3454     int error;
3455 
3456     if (mask != LOCK_MASK) {
3457 	error = kbdd_ioctl(scp->sc->kbd, KDGKBSTATE, (caddr_t)&state);
3458 	if (error == ENOIOCTL)
3459 	    error = ENODEV;
3460 	if (error)
3461 	    return error;
3462 	state &= ~mask;
3463 	state |= new_bits & mask;
3464     } else {
3465 	state = new_bits & LOCK_MASK;
3466     }
3467     error = kbdd_ioctl(scp->sc->kbd, KDSKBSTATE, (caddr_t)&state);
3468     if (error == ENOIOCTL)
3469 	error = ENODEV;
3470     return error;
3471 }
3472 
3473 static int
3474 update_kbd_leds(scr_stat *scp, int which)
3475 {
3476     int error;
3477 
3478     which &= LOCK_MASK;
3479     error = kbdd_ioctl(scp->sc->kbd, KDSETLED, (caddr_t)&which);
3480     if (error == ENOIOCTL)
3481 	error = ENODEV;
3482     return error;
3483 }
3484 
3485 int
3486 set_mode(scr_stat *scp)
3487 {
3488     video_info_t info;
3489 
3490     /* reject unsupported mode */
3491     if (vidd_get_info(scp->sc->adp, scp->mode, &info))
3492 	return 1;
3493 
3494     /* if this vty is not currently showing, do nothing */
3495     if (scp != scp->sc->cur_scp)
3496 	return 0;
3497 
3498     /* setup video hardware for the given mode */
3499     vidd_set_mode(scp->sc->adp, scp->mode);
3500     scp->rndr->init(scp);
3501 #ifndef __sparc64__
3502     sc_vtb_init(&scp->scr, VTB_FRAMEBUFFER, scp->xsize, scp->ysize,
3503 		(void *)scp->sc->adp->va_window, FALSE);
3504 #endif
3505 
3506 #ifndef SC_NO_FONT_LOADING
3507     /* load appropriate font */
3508     if (!(scp->status & GRAPHICS_MODE)) {
3509 	if (!(scp->status & PIXEL_MODE) && ISFONTAVAIL(scp->sc->adp->va_flags)) {
3510 	    if (scp->font_size < 14) {
3511 		if (scp->sc->fonts_loaded & FONT_8)
3512 		    sc_load_font(scp, 0, 8, 8, scp->sc->font_8, 0, 256);
3513 	    } else if (scp->font_size >= 16) {
3514 		if (scp->sc->fonts_loaded & FONT_16)
3515 		    sc_load_font(scp, 0, 16, 8, scp->sc->font_16, 0, 256);
3516 	    } else {
3517 		if (scp->sc->fonts_loaded & FONT_14)
3518 		    sc_load_font(scp, 0, 14, 8, scp->sc->font_14, 0, 256);
3519 	    }
3520 	    /*
3521 	     * FONT KLUDGE:
3522 	     * This is an interim kludge to display correct font.
3523 	     * Always use the font page #0 on the video plane 2.
3524 	     * Somehow we cannot show the font in other font pages on
3525 	     * some video cards... XXX
3526 	     */
3527 	    sc_show_font(scp, 0);
3528 	}
3529 	mark_all(scp);
3530     }
3531 #endif /* !SC_NO_FONT_LOADING */
3532 
3533     sc_set_border(scp, scp->border);
3534     sc_set_cursor_image(scp);
3535 
3536     return 0;
3537 }
3538 
3539 void
3540 sc_set_border(scr_stat *scp, int color)
3541 {
3542     SC_VIDEO_LOCK(scp->sc);
3543     (*scp->rndr->draw_border)(scp, color);
3544     SC_VIDEO_UNLOCK(scp->sc);
3545 }
3546 
3547 #ifndef SC_NO_FONT_LOADING
3548 void
3549 sc_load_font(scr_stat *scp, int page, int size, int width, u_char *buf,
3550 	     int base, int count)
3551 {
3552     sc_softc_t *sc;
3553 
3554     sc = scp->sc;
3555     sc->font_loading_in_progress = TRUE;
3556     vidd_load_font(sc->adp, page, size, width, buf, base, count);
3557     sc->font_loading_in_progress = FALSE;
3558 }
3559 
3560 void
3561 sc_save_font(scr_stat *scp, int page, int size, int width, u_char *buf,
3562 	     int base, int count)
3563 {
3564     sc_softc_t *sc;
3565 
3566     sc = scp->sc;
3567     sc->font_loading_in_progress = TRUE;
3568     vidd_save_font(sc->adp, page, size, width, buf, base, count);
3569     sc->font_loading_in_progress = FALSE;
3570 }
3571 
3572 void
3573 sc_show_font(scr_stat *scp, int page)
3574 {
3575     vidd_show_font(scp->sc->adp, page);
3576 }
3577 #endif /* !SC_NO_FONT_LOADING */
3578 
3579 void
3580 sc_paste(scr_stat *scp, const u_char *p, int count)
3581 {
3582     struct tty *tp;
3583     u_char *rmap;
3584 
3585     tp = SC_DEV(scp->sc, scp->sc->cur_scp->index);
3586     if (!tty_opened(tp))
3587 	return;
3588     rmap = scp->sc->scr_rmap;
3589     for (; count > 0; --count)
3590 	ttydisc_rint(tp, rmap[*p++], 0);
3591     ttydisc_rint_done(tp);
3592 }
3593 
3594 void
3595 sc_respond(scr_stat *scp, const u_char *p, int count, int wakeup)
3596 {
3597     struct tty *tp;
3598 
3599     tp = SC_DEV(scp->sc, scp->sc->cur_scp->index);
3600     if (!tty_opened(tp))
3601 	return;
3602     ttydisc_rint_simple(tp, p, count);
3603     if (wakeup) {
3604 	/* XXX: we can't always call ttydisc_rint_done() here! */
3605 	ttydisc_rint_done(tp);
3606     }
3607 }
3608 
3609 void
3610 sc_bell(scr_stat *scp, int pitch, int duration)
3611 {
3612     if (cold || shutdown_in_progress || !enable_bell)
3613 	return;
3614 
3615     if (scp != scp->sc->cur_scp && (scp->sc->flags & SC_QUIET_BELL))
3616 	return;
3617 
3618     if (scp->sc->flags & SC_VISUAL_BELL) {
3619 	if (scp->sc->blink_in_progress)
3620 	    return;
3621 	scp->sc->blink_in_progress = 3;
3622 	if (scp != scp->sc->cur_scp)
3623 	    scp->sc->blink_in_progress += 2;
3624 	blink_screen(scp->sc->cur_scp);
3625     } else if (duration != 0 && pitch != 0) {
3626 	if (scp != scp->sc->cur_scp)
3627 	    pitch *= 2;
3628 	sysbeep(1193182 / pitch, duration);
3629     }
3630 }
3631 
3632 static void
3633 blink_screen(void *arg)
3634 {
3635     scr_stat *scp = arg;
3636     struct tty *tp;
3637 
3638     if (ISGRAPHSC(scp) || (scp->sc->blink_in_progress <= 1)) {
3639 	scp->sc->blink_in_progress = 0;
3640     	mark_all(scp);
3641 	tp = SC_DEV(scp->sc, scp->index);
3642 	if (tty_opened(tp))
3643 	    sctty_outwakeup(tp);
3644 	if (scp->sc->delayed_next_scr)
3645 	    sc_switch_scr(scp->sc, scp->sc->delayed_next_scr - 1);
3646     }
3647     else {
3648 	(*scp->rndr->draw)(scp, 0, scp->xsize*scp->ysize,
3649 			   scp->sc->blink_in_progress & 1);
3650 	scp->sc->blink_in_progress--;
3651 	timeout(blink_screen, scp, hz / 10);
3652     }
3653 }
3654 
3655 /*
3656  * Until sc_attach_unit() gets called no dev structures will be available
3657  * to store the per-screen current status.  This is the case when the
3658  * kernel is initially booting and needs access to its console.  During
3659  * this early phase of booting the console's current status is kept in
3660  * one statically defined scr_stat structure, and any pointers to the
3661  * dev structures will be NULL.
3662  */
3663 
3664 static scr_stat *
3665 sc_get_stat(struct tty *tp)
3666 {
3667 	if (tp == NULL)
3668 		return (&main_console);
3669 	return (SC_STAT(tp));
3670 }
3671 
3672 /*
3673  * Allocate active keyboard. Try to allocate "kbdmux" keyboard first, and,
3674  * if found, add all non-busy keyboards to "kbdmux". Otherwise look for
3675  * any keyboard.
3676  */
3677 
3678 static int
3679 sc_allocate_keyboard(sc_softc_t *sc, int unit)
3680 {
3681 	int		 idx0, idx;
3682 	keyboard_t	*k0, *k;
3683 	keyboard_info_t	 ki;
3684 
3685 	idx0 = kbd_allocate("kbdmux", -1, (void *)&sc->keyboard, sckbdevent, sc);
3686 	if (idx0 != -1) {
3687 		k0 = kbd_get_keyboard(idx0);
3688 
3689 		for (idx = kbd_find_keyboard2("*", -1, 0);
3690 		     idx != -1;
3691 		     idx = kbd_find_keyboard2("*", -1, idx + 1)) {
3692 			k = kbd_get_keyboard(idx);
3693 
3694 			if (idx == idx0 || KBD_IS_BUSY(k))
3695 				continue;
3696 
3697 			bzero(&ki, sizeof(ki));
3698 			strcpy(ki.kb_name, k->kb_name);
3699 			ki.kb_unit = k->kb_unit;
3700 
3701 			kbdd_ioctl(k0, KBADDKBD, (caddr_t) &ki);
3702 		}
3703 	} else
3704 		idx0 = kbd_allocate("*", unit, (void *)&sc->keyboard, sckbdevent, sc);
3705 
3706 	return (idx0);
3707 }
3708