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