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