xref: /dragonfly/sys/dev/misc/syscons/scvidctl.c (revision 2462e051)
1 /*-
2  * (MPSAFE)
3  *
4  * Copyright (c) 1998 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
5  * All rights reserved.
6  *
7  * This code is derived from software contributed to The DragonFly Project
8  * by Sascha Wildner <saw@online.de>.
9  *
10  * Simple font scaling code by Sascha Wildner and Matthew Dillon
11  *
12  * Redistribution and use in source and binary forms, with or without
13  * modification, are permitted provided that the following conditions
14  * are met:
15  * 1. Redistributions of source code must retain the above copyright
16  *    notice, this list of conditions and the following disclaimer as
17  *    the first lines of this file unmodified.
18  * 2. Redistributions in binary form must reproduce the above copyright
19  *    notice, this list of conditions and the following disclaimer in the
20  *    documentation and/or other materials provided with the distribution.
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: src/sys/dev/syscons/scvidctl.c,v 1.19.2.2 2000/05/05 09:16:08 nyan Exp $
34  */
35 
36 #include "opt_syscons.h"
37 
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/conf.h>
41 #include <sys/signalvar.h>
42 #include <sys/tty.h>
43 #include <sys/kernel.h>
44 #include <sys/thread2.h>
45 
46 #include <machine/console.h>
47 #include <machine/framebuffer.h>
48 
49 #include <dev/video/fb/fbreg.h>
50 #include "syscons.h"
51 
52 SET_DECLARE(scrndr_set, const sc_renderer_t);
53 
54 int
sc_set_text_mode(scr_stat * scp,struct tty * tp,int mode,int xsize,int ysize,int fontsize)55 sc_set_text_mode(scr_stat *scp, struct tty *tp, int mode, int xsize, int ysize,
56 		 int fontsize)
57 {
58     video_info_t info;
59     u_char *font;
60     int prev_ysize;
61     int new_ysize;
62     int error;
63 
64     lwkt_gettoken(&vga_token);
65     if ((*vidsw[scp->sc->adapter]->get_info)(scp->sc->adp, mode, &info)) {
66 	lwkt_reltoken(&vga_token);
67 	return ENODEV;
68     }
69 
70     /* adjust argument values */
71     if (fontsize <= 0)
72 	fontsize = info.vi_cheight;
73     if (fontsize < 14) {
74 	fontsize = 8;
75 #ifndef SC_NO_FONT_LOADING
76 	if (!(scp->sc->fonts_loaded & FONT_8)) {
77 	    lwkt_reltoken(&vga_token);
78 	    return EINVAL;
79 	}
80 	font = scp->sc->font_8;
81 #else
82 	font = NULL;
83 #endif
84     } else if (fontsize >= 16) {
85 	fontsize = 16;
86 #ifndef SC_NO_FONT_LOADING
87 	if (!(scp->sc->fonts_loaded & FONT_16)) {
88 	    lwkt_reltoken(&vga_token);
89 	    return EINVAL;
90 	}
91 	font = scp->sc->font_16;
92 #else
93 	font = NULL;
94 #endif
95     } else {
96 	fontsize = 14;
97 #ifndef SC_NO_FONT_LOADING
98 	if (!(scp->sc->fonts_loaded & FONT_14)) {
99 	    lwkt_reltoken(&vga_token);
100 	    return EINVAL;
101 	}
102 	font = scp->sc->font_14;
103 #else
104 	font = NULL;
105 #endif
106     }
107     if ((xsize <= 0) || (xsize > info.vi_width))
108 	xsize = info.vi_width;
109     if ((ysize <= 0) || (ysize > info.vi_height))
110 	ysize = info.vi_height;
111 
112     /* stop screen saver, etc */
113     if ((error = sc_clean_up(scp, FALSE))) {
114 	lwkt_reltoken(&vga_token);
115 	return error;
116     }
117 
118     if (scp->sc->fbi != NULL &&
119 	sc_render_match(scp, "kms", V_INFO_MM_TEXT) == NULL) {
120 	lwkt_reltoken(&vga_token);
121 	return ENODEV;
122     }
123     if (scp->sc->fbi == NULL &&
124 	sc_render_match(scp, scp->sc->adp->va_name, V_INFO_MM_TEXT) == NULL) {
125 	lwkt_reltoken(&vga_token);
126 	return ENODEV;
127     }
128 
129     /* set up scp */
130     new_ysize = 0;
131 #ifndef SC_NO_HISTORY
132     if (scp->history != NULL) {
133 	sc_hist_save(scp);
134 	new_ysize = sc_vtb_rows(scp->history);
135     }
136 #endif
137     prev_ysize = scp->ysize;
138     /*
139      * This is a kludge to fend off scrn_update() while we
140      * muck around with scp. XXX
141      */
142     scp->status |= UNKNOWN_MODE | MOUSE_HIDDEN;
143     scp->status &= ~(GRAPHICS_MODE | PIXEL_MODE | MOUSE_VISIBLE);
144     scp->mode = mode;
145     scp->model = V_INFO_MM_TEXT;
146     scp->xsize = xsize;
147     scp->ysize = ysize;
148     scp->xoff = 0;
149     scp->yoff = 0;
150     scp->xpixel = scp->xsize*8;
151     scp->ypixel = scp->ysize*fontsize;
152     scp->font = font;
153     scp->font_height = fontsize;
154     scp->font_width = 8;
155 
156     /* allocate buffers */
157     sc_alloc_scr_buffer(scp, TRUE, TRUE);
158     sc_init_emulator(scp, NULL);
159 #ifndef SC_NO_CUTPASTE
160     sc_alloc_cut_buffer(scp, FALSE);
161 #endif
162 #ifndef SC_NO_HISTORY
163     sc_alloc_history_buffer(scp, new_ysize, prev_ysize, FALSE);
164 #endif
165 
166     if (scp == scp->sc->cur_scp)
167 	set_mode(scp);
168     scp->status &= ~UNKNOWN_MODE;
169 
170     if (tp) {
171 	DPRINTF(5, ("ws_*size (%d,%d), size (%d,%d)\n",
172 		tp->t_winsize.ws_col, tp->t_winsize.ws_row,
173 		scp->xsize, scp->ysize));
174 	if (tp->t_winsize.ws_col != scp->xsize ||
175 	    tp->t_winsize.ws_row != scp->ysize) {
176 	    tp->t_winsize.ws_col = scp->xsize;
177 	    tp->t_winsize.ws_row = scp->ysize;
178 	    pgsignal(tp->t_pgrp, SIGWINCH, 1);
179 	}
180     }
181     lwkt_reltoken(&vga_token);
182 
183     return 0;
184 }
185 
186 int
sc_set_graphics_mode(scr_stat * scp,struct tty * tp,int mode)187 sc_set_graphics_mode(scr_stat *scp, struct tty *tp, int mode)
188 {
189 #ifdef SC_NO_MODE_CHANGE
190     return ENODEV;
191 #else
192     video_info_t info;
193     int error;
194 
195     lwkt_gettoken(&vga_token);
196     if ((*vidsw[scp->sc->adapter]->get_info)(scp->sc->adp, mode, &info)) {
197         lwkt_reltoken(&vga_token);
198 	return ENODEV;
199     }
200     lwkt_reltoken(&vga_token);
201 
202     /* stop screen saver, etc */
203     crit_enter();
204     if ((error = sc_clean_up(scp, FALSE))) {
205 	crit_exit();
206 	return error;
207     }
208 
209     if (scp->sc->fbi != NULL &&
210 	sc_render_match(scp, "kms", V_INFO_MM_OTHER) == NULL) {
211 	crit_exit();
212 	return ENODEV;
213     }
214     if (scp->sc->fbi == NULL &&
215 	sc_render_match(scp, scp->sc->adp->va_name, V_INFO_MM_OTHER) == NULL) {
216 	crit_exit();
217 	return ENODEV;
218     }
219 
220     /* set up scp */
221     scp->status |= (UNKNOWN_MODE | GRAPHICS_MODE | MOUSE_HIDDEN);
222     scp->status &= ~(PIXEL_MODE | MOUSE_VISIBLE);
223     scp->mode = mode;
224     scp->model = V_INFO_MM_OTHER;
225     /*
226      * Don't change xsize and ysize; preserve the previous vty
227      * and history buffers.
228      */
229     scp->xoff = 0;
230     scp->yoff = 0;
231     scp->xpixel = info.vi_width;
232     scp->ypixel = info.vi_height;
233     scp->font = NULL;
234     scp->font_height = 0;
235     scp->font_width = 0;
236 #ifndef SC_NO_SYSMOUSE
237     /* move the mouse cursor at the center of the screen */
238     sc_mouse_move(scp, scp->xpixel / 2, scp->ypixel / 2);
239 #endif
240     sc_init_emulator(scp, NULL);
241     crit_exit();
242 
243     if (scp == scp->sc->cur_scp)
244 	set_mode(scp);
245     /* clear_graphics();*/
246     refresh_ega_palette(scp);
247     scp->status &= ~UNKNOWN_MODE;
248 
249     if (tp) {
250 	if (tp->t_winsize.ws_xpixel != scp->xpixel ||
251 	    tp->t_winsize.ws_ypixel != scp->ypixel) {
252 	    tp->t_winsize.ws_xpixel = scp->xpixel;
253 	    tp->t_winsize.ws_ypixel = scp->ypixel;
254 	    pgsignal(tp->t_pgrp, SIGWINCH, 1);
255 	}
256     }
257 
258     return 0;
259 #endif /* SC_NO_MODE_CHANGE */
260 }
261 
262 int
sc_set_pixel_mode(scr_stat * scp,struct tty * tp,int xsize,int ysize,int fontsize)263 sc_set_pixel_mode(scr_stat *scp, struct tty *tp, int xsize, int ysize,
264 		  int fontsize)
265 {
266 #ifndef SC_PIXEL_MODE
267     return ENODEV;
268 #else
269     video_info_t info;
270     u_char *font;
271     int prev_ysize;
272     int new_ysize;
273     int error;
274 
275     lwkt_gettoken(&vga_token);
276     if ((*vidsw[scp->sc->adapter]->get_info)(scp->sc->adp, scp->mode, &info)) {
277         lwkt_reltoken(&vga_token);
278 	return ENODEV;		/* this shouldn't happen */
279     }
280     lwkt_reltoken(&vga_token);
281 
282     /* adjust argument values */
283     if (fontsize <= 0)
284 	fontsize = info.vi_cheight;
285     if (fontsize < 14) {
286 	fontsize = 8;
287 #ifndef SC_NO_FONT_LOADING
288 	if (!(scp->sc->fonts_loaded & FONT_8))
289 	    return EINVAL;
290 	font = scp->sc->font_8;
291 #else
292 	font = NULL;
293 #endif
294     } else if (fontsize >= 16) {
295 	fontsize = 16;
296 #ifndef SC_NO_FONT_LOADING
297 	if (!(scp->sc->fonts_loaded & FONT_16))
298 	    return EINVAL;
299 	font = scp->sc->font_16;
300 #else
301 	font = NULL;
302 #endif
303     } else {
304 	fontsize = 14;
305 #ifndef SC_NO_FONT_LOADING
306 	if (!(scp->sc->fonts_loaded & FONT_14))
307 	    return EINVAL;
308 	font = scp->sc->font_14;
309 #else
310 	font = NULL;
311 #endif
312     }
313     if (xsize <= 0)
314 	xsize = info.vi_width/8;
315     if (ysize <= 0)
316 	ysize = info.vi_height/fontsize;
317 
318     if ((info.vi_width < xsize*8) || (info.vi_height < ysize*fontsize))
319 	return EINVAL;
320 
321     /*
322      * We currently support the following graphic modes:
323      *
324      * - 4 bpp planar modes whose memory size does not exceed 64K
325      * - 8 bbp packed pixel modes
326      * - 15, 16, 24 and 32 bpp direct modes with linear frame buffer
327      */
328 
329     if (info.vi_mem_model == V_INFO_MM_PLANAR) {
330 	if (info.vi_planes != 4)
331 	    return ENODEV;
332 
333 	/*
334 	 * A memory size >64K requires bank switching to access the entire
335 	 * screen. XXX
336 	 */
337 
338 	if (info.vi_width * info.vi_height / 8 > info.vi_window_size)
339 	    return ENODEV;
340     } else if (info.vi_mem_model == V_INFO_MM_PACKED) {
341 	if (info.vi_depth != 8)
342 	    return ENODEV;
343     } else if (info.vi_mem_model == V_INFO_MM_DIRECT) {
344 	if (!(info.vi_flags & V_INFO_LINEAR) &&
345 	    (info.vi_depth != 15) && (info.vi_depth != 16) &&
346 	    (info.vi_depth != 24) && (info.vi_depth != 32))
347 	    return ENODEV;
348     } else
349 	return ENODEV;
350 
351     /* stop screen saver, etc */
352     crit_enter();
353     if ((error = sc_clean_up(scp, FALSE))) {
354 	crit_exit();
355 	return error;
356     }
357 
358     if (sc_render_match(scp, scp->sc->adp->va_name, info.vi_mem_model) == NULL) {
359 	crit_exit();
360 	return ENODEV;
361     }
362 
363 #if 0
364     if (scp->tsw)
365 	(*scp->tsw->te_term)(scp, scp->ts);
366     scp->tsw = NULL;
367     scp->ts = NULL;
368 #endif
369 
370     /* set up scp */
371     new_ysize = 0;
372 #ifndef SC_NO_HISTORY
373     if (scp->history != NULL) {
374 	sc_hist_save(scp);
375 	new_ysize = sc_vtb_rows(scp->history);
376     }
377 #endif
378     prev_ysize = scp->ysize;
379     scp->status |= (UNKNOWN_MODE | PIXEL_MODE | MOUSE_HIDDEN);
380     scp->status &= ~(GRAPHICS_MODE | MOUSE_VISIBLE);
381     scp->model = info.vi_mem_model;
382     scp->xsize = xsize;
383     scp->ysize = ysize;
384     scp->xoff = (scp->xpixel/8 - xsize)/2;
385     scp->yoff = (scp->ypixel/fontsize - ysize)/2;
386     scp->font = font;
387     scp->font_height = fontsize;
388     scp->font_width = 8;
389 
390     /* allocate buffers */
391     sc_alloc_scr_buffer(scp, TRUE, TRUE);
392     sc_init_emulator(scp, NULL);
393 #ifndef SC_NO_CUTPASTE
394     sc_alloc_cut_buffer(scp, FALSE);
395 #endif
396 #ifndef SC_NO_HISTORY
397     sc_alloc_history_buffer(scp, new_ysize, prev_ysize, FALSE);
398 #endif
399     crit_exit();
400 
401     if (scp == scp->sc->cur_scp) {
402 	sc_set_border(scp, scp->border);
403 	sc_set_cursor_image(scp);
404     }
405 
406     scp->status &= ~UNKNOWN_MODE;
407 
408     if (tp) {
409 	if (tp->t_winsize.ws_col != scp->xsize ||
410 	    tp->t_winsize.ws_row != scp->ysize) {
411 	    tp->t_winsize.ws_col = scp->xsize;
412 	    tp->t_winsize.ws_row = scp->ysize;
413 	    pgsignal(tp->t_pgrp, SIGWINCH, 1);
414 	}
415     }
416 
417     return 0;
418 #endif /* SC_PIXEL_MODE */
419 }
420 
421 #define fb_ioctl(a, c, d)		\
422 	(((a) == NULL) ? ENODEV : 	\
423 			 (*vidsw[(a)->va_index]->ioctl)((a), (c), (caddr_t)(d)))
424 
425 int
sc_vid_ioctl(struct tty * tp,u_long cmd,caddr_t data,int flag)426 sc_vid_ioctl(struct tty *tp, u_long cmd, caddr_t data, int flag)
427 {
428     scr_stat *scp;
429     video_adapter_t *adp;
430 #ifndef SC_NO_MODE_CHANGE
431     video_info_t info;
432 #endif
433     int error, ret;
434 
435     KKASSERT(tp->t_dev);
436 
437     scp = SC_STAT(tp->t_dev);
438     if (scp == NULL)		/* tp == SC_MOUSE */
439 	return ENOIOCTL;
440     adp = scp->sc->adp;
441     if (adp == NULL && scp->sc->fbi == NULL)	/* shouldn't happen??? */
442 	return ENODEV;
443 
444     lwkt_gettoken(&vga_token);
445     switch (cmd) {
446 
447     case CONS_CURRENTADP:	/* get current adapter index */
448     case FBIO_ADAPTER:
449 	if (scp->sc->fbi != NULL) {
450 	    ret = ENODEV;
451 	} else {
452 	    ret = fb_ioctl(adp, FBIO_ADAPTER, data);
453 	}
454 	lwkt_reltoken(&vga_token);
455 	return ret;
456 
457     case CONS_CURRENT:  	/* get current adapter type */
458     case FBIO_ADPTYPE:
459 	if (scp->sc->fbi != NULL) {
460 	    ret = ENODEV;
461 	} else {
462 	    ret = fb_ioctl(adp, FBIO_ADPTYPE, data);
463 	}
464 	lwkt_reltoken(&vga_token);
465 	return ret;
466 
467     case CONS_ADPINFO:		/* adapter information */
468     case FBIO_ADPINFO:
469 	if (scp->sc->fbi != NULL) {
470 	    lwkt_reltoken(&vga_token);
471 	    return ENODEV;
472 	}
473 	if (((video_adapter_info_t *)data)->va_index >= 0) {
474 	    adp = vid_get_adapter(((video_adapter_info_t *)data)->va_index);
475 	    if (adp == NULL) {
476 		lwkt_reltoken(&vga_token);
477 		return ENODEV;
478 	    }
479 	}
480 	ret = fb_ioctl(adp, FBIO_ADPINFO, data);
481 	lwkt_reltoken(&vga_token);
482 	return ret;
483 
484     case CONS_GET:      	/* get current video mode */
485     case FBIO_GETMODE:
486 	*(int *)data = scp->mode;
487 	lwkt_reltoken(&vga_token);
488 	return 0;
489 
490 #ifndef SC_NO_MODE_CHANGE
491     case CONS_SET:
492     case FBIO_SETMODE:		/* set video mode */
493 	if (scp->sc->fbi != NULL) {
494 		lwkt_reltoken(&vga_token);
495 		if (*(int *)data != 0)
496 			return ENODEV;
497 		else
498 			return 0;
499 	}
500 	if (!(adp->va_flags & V_ADP_MODECHANGE)) {
501 	    lwkt_reltoken(&vga_token);
502  	    return ENODEV;
503 	}
504 	info.vi_mode = *(int *)data;
505 	error = fb_ioctl(adp, FBIO_MODEINFO, &info);
506 	if (error) {
507 	    lwkt_reltoken(&vga_token);
508 	    return error;
509 	}
510 	if (info.vi_flags & V_INFO_GRAPHICS) {
511 	    lwkt_reltoken(&vga_token);
512 	    return sc_set_graphics_mode(scp, tp, *(int *)data);
513 	} else {
514 	    lwkt_reltoken(&vga_token);
515 	    return sc_set_text_mode(scp, tp, *(int *)data, 0, 0, 0);
516 	}
517 #endif /* SC_NO_MODE_CHANGE */
518 
519     case CONS_MODEINFO:		/* get mode information */
520     case FBIO_MODEINFO:
521 	if (scp->sc->fbi != NULL) {
522 	    /* Fabricate some mode information for KMS framebuffer */
523 	    video_info_t *vinfo = (video_info_t *)data;
524 	    vinfo->vi_mode = 0;
525 	    vinfo->vi_flags = V_INFO_COLOR;
526 	    vinfo->vi_width = scp->xsize;
527 	    vinfo->vi_height = scp->ysize;
528 	    vinfo->vi_cwidth = scp->font_width;
529 	    vinfo->vi_cheight = scp->font_height;
530 	    vinfo->vi_window = 0;
531 	    vinfo->vi_window_size = 0;
532 	    vinfo->vi_buffer = 0;
533 	    vinfo->vi_buffer_size = 0;
534 	    vinfo->vi_mem_model = V_INFO_MM_TEXT;
535 	    ret = 0;
536 	} else {
537 	    ret = fb_ioctl(adp, FBIO_MODEINFO, data);
538 	}
539 	lwkt_reltoken(&vga_token);
540 	return ret;
541 
542     case CONS_FINDMODE:		/* find a matching video mode */
543     case FBIO_FINDMODE:
544 	if (scp->sc->fbi != NULL) {
545 	    ret = ENODEV;
546 	} else {
547 	    ret = fb_ioctl(adp, FBIO_FINDMODE, data);
548 	}
549 	lwkt_reltoken(&vga_token);
550 	return ret;
551 
552     case CONS_SETWINORG:	/* set frame buffer window origin */
553     case FBIO_SETWINORG:
554 	if (scp != scp->sc->cur_scp) {
555 	    lwkt_reltoken(&vga_token);
556 	    return ENODEV;	/* XXX */
557 	}
558 	if (scp->sc->fbi != NULL) {
559 	    lwkt_reltoken(&vga_token);
560 	    return ENODEV;
561 	}
562 	ret = fb_ioctl(adp, FBIO_SETWINORG, data);
563 	lwkt_reltoken(&vga_token);
564 	return ret;
565 
566     case FBIO_GETWINORG:	/* get frame buffer window origin */
567 	if (scp != scp->sc->cur_scp) {
568 	    lwkt_reltoken(&vga_token);
569 	    return ENODEV;	/* XXX */
570 	}
571 	if (scp->sc->fbi != NULL) {
572 	    ret = ENODEV;
573 	} else {
574 	    ret = fb_ioctl(adp, FBIO_GETWINORG, data);
575 	}
576 	lwkt_reltoken(&vga_token);
577 	return ret;
578 
579     case FBIO_GETDISPSTART:
580     case FBIO_SETDISPSTART:
581     case FBIO_GETLINEWIDTH:
582     case FBIO_SETLINEWIDTH:
583 	if (scp != scp->sc->cur_scp) {
584 	    lwkt_reltoken(&vga_token);
585 	    return ENODEV;	/* XXX */
586 	}
587 	if (scp->sc->fbi != NULL) {
588 	    if (cmd == FBIO_GETLINEWIDTH) {
589 		*(u_int *)data = scp->sc->fbi->stride;
590 		ret = 0;
591 	    } else {
592 		ret = ENODEV;
593 	    }
594 	} else {
595 	    ret = fb_ioctl(adp, cmd, data);
596 	}
597 	lwkt_reltoken(&vga_token);
598 	return ret;
599 
600     case FBIO_BLANK:
601 	if (scp != scp->sc->cur_scp) {
602 	    lwkt_reltoken(&vga_token);
603 	    return ENODEV;
604 	}
605 	if (scp->sc->fbi != NULL && ISGRAPHSC(scp)) {
606 	    if (*(int *)data == V_DISPLAY_ON)
607 		sc_stop_scrn_saver(scp->sc);
608 	    else
609 		sc_start_scrn_saver(scp->sc);
610 	    ret = 0;
611 	} else {
612 	    ret = ENODEV;
613 	}
614 	lwkt_reltoken(&vga_token);
615 	return ret;
616 
617     case FBIO_GETPALETTE:
618     case FBIO_SETPALETTE:
619     case FBIOPUTCMAP:
620     case FBIOGETCMAP:
621     case FBIOGTYPE:
622     case FBIOGATTR:
623     case FBIOSVIDEO:
624     case FBIOGVIDEO:
625     case FBIOSCURSOR:
626     case FBIOGCURSOR:
627     case FBIOSCURPOS:
628     case FBIOGCURPOS:
629     case FBIOGCURMAX:
630 	if (scp != scp->sc->cur_scp) {
631 	    lwkt_reltoken(&vga_token);
632 	    return ENODEV;	/* XXX */
633 	}
634 	if (scp->sc->fbi != NULL) {
635 	    if (cmd == FBIOGTYPE) {
636 		((struct fbtype *)data)->fb_type = FBTYPE_DUMBFB;
637 		((struct fbtype *)data)->fb_height = scp->sc->fbi->height;
638 		((struct fbtype *)data)->fb_width = scp->sc->fbi->width;
639 		((struct fbtype *)data)->fb_depth = scp->sc->fbi->depth;
640 		((struct fbtype *)data)->fb_cmsize = 0;
641 		((struct fbtype *)data)->fb_size =
642 		    scp->sc->fbi->height * scp->sc->fbi->stride;
643 		ret = 0;
644 	    } else {
645 		ret = ENODEV;
646 	    }
647 	} else {
648 	    ret = fb_ioctl(adp, cmd, data);
649 	}
650 	lwkt_reltoken(&vga_token);
651 	return ret;
652 
653     case KDSETMODE:     	/* set current mode of this (virtual) console */
654 	switch (*(int *)data) {
655 	case KD_TEXT:   	/* switch to TEXT (known) mode */
656 	    /*
657 	     * If scp->mode is of graphics modes, we don't know which
658 	     * text mode to switch back to...
659 	     */
660 	    if (scp->status & GRAPHICS_MODE) {
661 	        lwkt_reltoken(&vga_token);
662 		return EINVAL;
663 	    }
664 	    /* restore fonts & palette ! */
665 #if 0
666 #ifndef SC_NO_FONT_LOADING
667 	    if (scp->sc->fbi == NULL && ISFONTAVAIL(adp->va_flags)
668 		&& !(scp->status & (GRAPHICS_MODE | PIXEL_MODE))) {
669 		/*
670 		 * FONT KLUDGE
671 		 * Don't load fonts for now... XXX
672 		 */
673 		if (scp->sc->fonts_loaded & FONT_8)
674 		    sc_load_font(scp, 0, 8, scp->sc->font_8, 0, 256);
675 		if (scp->sc->fonts_loaded & FONT_14)
676 		    sc_load_font(scp, 0, 14, scp->sc->font_14, 0, 256);
677 		if (scp->sc->fonts_loaded & FONT_16)
678 		    sc_load_font(scp, 0, 16, scp->sc->font_16, 0, 256);
679 	    }
680 #endif /* SC_NO_FONT_LOADING */
681 #endif
682 
683 	    if (scp->sc->fbi == NULL)
684 		load_palette(adp, scp->sc->palette);
685 
686 	    /* move hardware cursor out of the way */
687 	    if (scp->sc->fbi == NULL)
688 		(*vidsw[adp->va_index]->set_hw_cursor)(adp, -1, -1);
689 	    /* FALL THROUGH */
690 
691 	case KD_TEXT1:  	/* switch to TEXT (known) mode */
692 	    /*
693 	     * If scp->mode is of graphics modes, we don't know which
694 	     * text/pixel mode to switch back to...
695 	     */
696 	    if (scp->status & GRAPHICS_MODE) {
697 	        lwkt_reltoken(&vga_token);
698 		return EINVAL;
699 	    }
700 	    crit_enter();
701 	    if ((error = sc_clean_up(scp, FALSE))) {
702 		crit_exit();
703 		lwkt_reltoken(&vga_token);
704 		return error;
705 	    }
706 	    scp->status |= UNKNOWN_MODE | MOUSE_HIDDEN;
707 	    crit_exit();
708 	    /* no restore fonts & palette */
709 	    if (scp == scp->sc->cur_scp)
710 		set_mode(scp);
711 	    sc_clear_screen(scp);
712 	    scp->status &= ~UNKNOWN_MODE;
713 	    lwkt_reltoken(&vga_token);
714 	    return 0;
715 
716 #ifdef SC_PIXEL_MODE
717 	case KD_PIXEL:		/* pixel (raster) display */
718 	    if (!(scp->status & (GRAPHICS_MODE | PIXEL_MODE))) {
719 	        lwkt_reltoken(&vga_token);
720 		return EINVAL;
721             }
722 	    if (scp->sc->fbi != NULL) {
723 		lwkt_reltoken(&vga_token);
724 		return ENODEV;
725 	    }
726 	    if (scp->status & GRAPHICS_MODE) {
727 	        lwkt_reltoken(&vga_token);
728 		return sc_set_pixel_mode(scp, tp, scp->xsize, scp->ysize,
729 					 scp->font_height);
730 	    }
731 	    crit_enter();
732 	    if ((error = sc_clean_up(scp, FALSE))) {
733 		crit_exit();
734 		lwkt_reltoken(&vga_token);
735 		return error;
736 	    }
737 	    scp->status |= (UNKNOWN_MODE | PIXEL_MODE | MOUSE_HIDDEN);
738 	    crit_exit();
739 	    if (scp == scp->sc->cur_scp) {
740 		set_mode(scp);
741 		load_palette(adp, scp->sc->palette);
742 	    }
743 	    sc_clear_screen(scp);
744 	    scp->status &= ~UNKNOWN_MODE;
745 	    lwkt_reltoken(&vga_token);
746 	    return 0;
747 #endif /* SC_PIXEL_MODE */
748 
749 	case KD_GRAPHICS:	/* switch to GRAPHICS (unknown) mode */
750 	    crit_enter();
751 	    if ((error = sc_clean_up(scp, FALSE))) {
752 		crit_exit();
753 		lwkt_reltoken(&vga_token);
754 		return error;
755 	    }
756 	    scp->status |= UNKNOWN_MODE | MOUSE_HIDDEN;
757 	    crit_exit();
758 	    lwkt_reltoken(&vga_token);
759 	    return 0;
760 
761 	default:
762 	    lwkt_reltoken(&vga_token);
763 	    return EINVAL;
764 	}
765 	/* NOT REACHED */
766 
767 #ifdef SC_PIXEL_MODE
768     case KDRASTER:		/* set pixel (raster) display mode */
769 	if (scp->sc->fbi != NULL || ISUNKNOWNSC(scp) || ISTEXTSC(scp)) {
770 	    lwkt_reltoken(&vga_token);
771 	    return ENODEV;
772 	}
773 	lwkt_reltoken(&vga_token);
774 	return sc_set_pixel_mode(scp, tp, ((int *)data)[0], ((int *)data)[1],
775 				 ((int *)data)[2]);
776 #endif /* SC_PIXEL_MODE */
777 
778     case KDGETMODE:     	/* get current mode of this (virtual) console */
779 	/*
780 	 * From the user program's point of view, KD_PIXEL is the same
781 	 * as KD_TEXT...
782 	 */
783 	*data = ISGRAPHSC(scp) ? KD_GRAPHICS : KD_TEXT;
784 	lwkt_reltoken(&vga_token);
785 	return 0;
786 
787     case KDSBORDER:     	/* set border color of this (virtual) console */
788 	/* Only values in the range [0..15] allowed */
789 	if (*(int *)data < 0 || *(int *)data > 15) {
790 		lwkt_reltoken(&vga_token);
791 		return EINVAL;
792 	}
793 	scp->border = *(int *)data;
794 	if (scp == scp->sc->cur_scp)
795 	    sc_set_border(scp, scp->border);
796 	lwkt_reltoken(&vga_token);
797 	return 0;
798     }
799 
800     lwkt_reltoken(&vga_token);
801     return ENOIOCTL;
802 }
803 
804 static LIST_HEAD(, sc_renderer) sc_rndr_list =
805 	LIST_HEAD_INITIALIZER(sc_rndr_list);
806 
807 int
sc_render_add(sc_renderer_t * rndr)808 sc_render_add(sc_renderer_t *rndr)
809 {
810 	LIST_INSERT_HEAD(&sc_rndr_list, rndr, link);
811 	return 0;
812 }
813 
814 int
sc_render_remove(sc_renderer_t * rndr)815 sc_render_remove(sc_renderer_t *rndr)
816 {
817 	/*
818 	LIST_REMOVE(rndr, link);
819 	*/
820 	return EBUSY;	/* XXX */
821 }
822 
823 sc_rndr_sw_t *
sc_render_match(scr_stat * scp,char * name,int model)824 sc_render_match(scr_stat *scp, char *name, int model)
825 {
826 	const sc_renderer_t **list;
827 	const sc_renderer_t *p;
828 
829 	if (!LIST_EMPTY(&sc_rndr_list)) {
830 		LIST_FOREACH(p, &sc_rndr_list, link) {
831 			if ((strcmp(p->name, name) == 0) &&
832 			    (model == p->model)) {
833 				scp->status &=
834 				    ~(VR_CURSOR_ON | VR_CURSOR_BLINK);
835 				return p->rndrsw;
836 			}
837 		}
838 	} else {
839 		SET_FOREACH(list, scrndr_set) {
840 			p = *list;
841 			if ((strcmp(p->name, name) == 0) &&
842 			    (model == p->model)) {
843 				scp->status &=
844 				    ~(VR_CURSOR_ON | VR_CURSOR_BLINK);
845 				return p->rndrsw;
846 			}
847 		}
848 	}
849 
850 	return NULL;
851 }
852 
853 #define VIRTUAL_TTY(sc, x) ((SC_DEV((sc),(x)) != NULL) ?	\
854 	(SC_DEV((sc),(x))->si_tty) : NULL)
855 
856 void
sc_update_render(scr_stat * scp)857 sc_update_render(scr_stat *scp)
858 {
859 	sc_rndr_sw_t *rndr;
860 	sc_term_sw_t *sw;
861 	struct tty *tp;
862 	int prev_ysize, new_ysize;
863 #ifndef SC_NO_HISTORY
864 	int old_xpos, old_ypos;
865 #endif
866 	int error;
867 
868 	sw = scp->tsw;
869 	if (sw == NULL) {
870 		return;
871 	}
872 
873 	if (scp->rndr == NULL)
874 		return;
875 
876 	if (scp->fbi_generation == scp->sc->fbi_generation)
877 		return;
878 
879 	crit_enter();
880 	scp->fbi_generation = scp->sc->fbi_generation;
881 	/* Needed in case we are implicitly leaving PIXEL_MODE here */
882 	if (scp->model != V_INFO_MM_OTHER)
883 		scp->model = V_INFO_MM_TEXT;
884 	rndr = NULL;
885 	if (strcmp(sw->te_renderer, "*") != 0) {
886 		rndr = sc_render_match(scp, sw->te_renderer, scp->model);
887 	}
888 	if (rndr == NULL && scp->sc->fbi != NULL) {
889 		rndr = sc_render_match(scp, "kms", scp->model);
890 	}
891 	if (rndr == NULL) {	/* this shouldn't happen */
892 		rndr = sc_render_match(scp, scp->sc->adp->va_name, scp->model);
893 		if (rndr != NULL)
894 			scp->rndr = rndr;
895 		crit_exit();
896 		return;
897 	}
898 
899 	scp->rndr = rndr;
900 	/* Mostly copied from sc_set_text_mode */
901 	if ((error = sc_clean_up(scp, FALSE))) {
902 		crit_exit();
903 		return;
904 	}
905 	new_ysize = 0;
906 #ifndef SC_NO_HISTORY
907 	old_xpos = old_ypos = 0;
908 	if (scp->history != NULL) {
909 		if (scp->xsize > 0) {
910 			old_xpos = scp->xpos;
911 			old_ypos = scp->ypos;
912 		}
913 		sc_hist_save(scp);
914 		new_ysize = sc_vtb_rows(scp->history);
915 	}
916 #endif
917 	prev_ysize = scp->ysize;
918 	scp->status |= MOUSE_HIDDEN;
919 	if (scp->status & GRAPHICS_MODE) {
920 		/*
921 		 * We don't handle GRAPHICS_MODE at all when using a KMS
922 		 * framebuffer, so silently switch to UNKNOWN_MODE then.
923 		 */
924 		scp->status |= UNKNOWN_MODE;
925 		scp->status &= ~GRAPHICS_MODE;
926 	}
927 	/* Implicitly leave PIXEL_MODE, but stay in UNKNOWN mode */
928 	scp->status &= ~(PIXEL_MODE | MOUSE_VISIBLE);
929 	scp->xpixel = scp->sc->fbi->width;
930 	scp->ypixel = scp->sc->fbi->height;
931 
932 	/*
933 	 * Assume square pixels for now
934 	 */
935 	sc_font_scale(scp, 0, 0);
936 
937 	DPRINTF(1, ("kms console: scale-to %dx%d cols=%d rows=%d\n",
938 		scp->blk_width, scp->blk_height, scp->xsize, scp->ysize));
939 
940 	/* allocate buffers */
941 	sc_alloc_scr_buffer(scp, TRUE, TRUE);
942 	sc_init_emulator(scp, NULL);
943 #ifndef SC_NO_CUTPASTE
944 	sc_alloc_cut_buffer(scp, FALSE);
945 #endif
946 #ifndef SC_NO_HISTORY
947 	sc_alloc_history_buffer(scp, new_ysize, prev_ysize, FALSE);
948 	if (scp->history != NULL) {
949 		sc_hist_getback(scp, prev_ysize);
950 		sc_move_cursor(scp, old_xpos, old_ypos);
951 	}
952 #endif
953 	crit_exit();
954 	tp = VIRTUAL_TTY(scp->sc, scp->index);
955 	if (tp == NULL)
956 		return;
957 	if (tp->t_winsize.ws_col != scp->xsize ||
958 	    tp->t_winsize.ws_row != scp->ysize) {
959 		tp->t_winsize.ws_col = scp->xsize;
960 		tp->t_winsize.ws_row = scp->ysize;
961 		pgsignal(tp->t_pgrp, SIGWINCH, 1);
962 	}
963 }
964