fb.c revision 50254
1/*-
2 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer as
10 *    the first lines of this file unmodified.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 *    notice, this list of conditions and the following disclaimer in the
13 *    documentation and/or other materials provided with the distribution.
14 * 3. The name of the author may not be used to endorse or promote products
15 *    derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 * $Id: fb.c,v 1.7 1999/07/04 14:58:15 phk Exp $
29 */
30
31#include "fb.h"
32#include "opt_fb.h"
33
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/conf.h>
37#include <sys/bus.h>
38#include <sys/kernel.h>
39#include <sys/malloc.h>
40#include <sys/uio.h>
41#include <sys/fbio.h>
42
43#include <vm/vm.h>
44#include <vm/pmap.h>
45
46#include <dev/fb/fbreg.h>
47
48/* local arrays */
49
50/*
51 * We need at least one entry each in order to initialize a video card
52 * for the kernel console.  The arrays will be increased dynamically
53 * when necessary.
54 */
55
56static int		vid_malloc;
57static int		adapters = 1;
58static video_adapter_t	*adp_ini;
59static video_adapter_t	**adapter = &adp_ini;
60static video_switch_t	*vidsw_ini;
61       video_switch_t	**vidsw = &vidsw_ini;
62
63#ifdef FB_INSTALL_CDEV
64static struct cdevsw	*vidcdevsw_ini;
65static struct cdevsw	**vidcdevsw = &vidcdevsw_ini;
66#endif
67
68#define ARRAY_DELTA	4
69
70static int
71vid_realloc_array(void)
72{
73	video_adapter_t **new_adp;
74	video_switch_t **new_vidsw;
75#ifdef FB_INSTALL_CDEV
76	struct cdevsw **new_cdevsw;
77#endif
78	int newsize;
79	int s;
80
81	if (!vid_malloc)
82		return ENOMEM;
83
84	s = spltty();
85	newsize = ((adapters + ARRAY_DELTA)/ARRAY_DELTA)*ARRAY_DELTA;
86	new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK);
87	new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF, M_WAITOK);
88#ifdef FB_INSTALL_CDEV
89	new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF, M_WAITOK);
90#endif
91	bzero(new_adp, sizeof(*new_adp)*newsize);
92	bzero(new_vidsw, sizeof(*new_vidsw)*newsize);
93	bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
94	bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
95#ifdef FB_INSTALL_CDEV
96	bzero(new_cdevsw, sizeof(*new_cdevsw)*newsize);
97	bcopy(vidcdevsw, new_cdevsw, sizeof(*vidcdevsw)*adapters);
98#endif
99	if (adapters > 1) {
100		free(adapter, M_DEVBUF);
101		free(vidsw, M_DEVBUF);
102#ifdef FB_INSTALL_CDEV
103		free(vidcdevsw, M_DEVBUF);
104#endif
105	}
106	adapter = new_adp;
107	vidsw = new_vidsw;
108#ifdef FB_INSTALL_CDEV
109	vidcdevsw = new_cdevsw;
110#endif
111	adapters = newsize;
112	splx(s);
113
114	if (bootverbose)
115		printf("fb: new array size %d\n", adapters);
116
117	return 0;
118}
119
120static void
121vid_malloc_init(void *arg)
122{
123	vid_malloc = TRUE;
124}
125
126SYSINIT(vid_mem, SI_SUB_KMEM, SI_ORDER_ANY, vid_malloc_init, NULL);
127
128/*
129 * Low-level frame buffer driver functions
130 * frame buffer subdrivers, such as the VGA driver, call these functions
131 * to initialize the video_adapter structure and register it to the virtual
132 * frame buffer driver `fb'.
133 */
134
135/* initialize the video_adapter_t structure */
136void
137vid_init_struct(video_adapter_t *adp, char *name, int type, int unit)
138{
139	adp->va_flags = 0;
140	adp->va_name = name;
141	adp->va_type = type;
142	adp->va_unit = unit;
143}
144
145/* Register a video adapter */
146int
147vid_register(video_adapter_t *adp)
148{
149	const video_driver_t **list;
150	const video_driver_t *p;
151	int index;
152
153	for (index = 0; index < adapters; ++index) {
154		if (adapter[index] == NULL)
155			break;
156	}
157	if (index >= adapters) {
158		if (vid_realloc_array())
159			return -1;
160	}
161
162	adp->va_index = index;
163	adp->va_token = NULL;
164	list = (const video_driver_t **)videodriver_set.ls_items;
165	while ((p = *list++) != NULL) {
166		if (strcmp(p->name, adp->va_name) == 0) {
167			adapter[index] = adp;
168			vidsw[index] = p->vidsw;
169			return index;
170		}
171	}
172
173	return -1;
174}
175
176int
177vid_unregister(video_adapter_t *adp)
178{
179	if ((adp->va_index < 0) || (adp->va_index >= adapters))
180		return ENOENT;
181	if (adapter[adp->va_index] != adp)
182		return ENOENT;
183
184	adapter[adp->va_index] = NULL;
185	vidsw[adp->va_index] = NULL;
186	return 0;
187}
188
189/* Get video I/O function table */
190video_switch_t
191*vid_get_switch(char *name)
192{
193	const video_driver_t **list;
194	const video_driver_t *p;
195
196	list = (const video_driver_t **)videodriver_set.ls_items;
197	while ((p = *list++) != NULL) {
198		if (strcmp(p->name, name) == 0)
199			return p->vidsw;
200	}
201
202	return NULL;
203}
204
205/*
206 * Video card client functions
207 * Video card clients, such as the console driver `syscons' and the frame
208 * buffer cdev driver, use these functions to claim and release a card for
209 * exclusive use.
210 */
211
212/* find the video card specified by a driver name and a unit number */
213int
214vid_find_adapter(char *driver, int unit)
215{
216	int i;
217
218	for (i = 0; i < adapters; ++i) {
219		if (adapter[i] == NULL)
220			continue;
221		if (strcmp("*", driver) && strcmp(adapter[i]->va_name, driver))
222			continue;
223		if ((unit != -1) && (adapter[i]->va_unit != unit))
224			continue;
225		return i;
226	}
227	return -1;
228}
229
230/* allocate a video card */
231int
232vid_allocate(char *driver, int unit, void *id)
233{
234	int index;
235	int s;
236
237	s = spltty();
238	index = vid_find_adapter(driver, unit);
239	if (index >= 0) {
240		if (adapter[index]->va_token) {
241			splx(s);
242			return -1;
243		}
244		adapter[index]->va_token = id;
245	}
246	splx(s);
247	return index;
248}
249
250int
251vid_release(video_adapter_t *adp, void *id)
252{
253	int error;
254	int s;
255
256	s = spltty();
257	if (adp->va_token == NULL) {
258		error = EINVAL;
259	} else if (adp->va_token != id) {
260		error = EPERM;
261	} else {
262		adp->va_token = NULL;
263		error = 0;
264	}
265	splx(s);
266	return error;
267}
268
269/* Get a video adapter structure */
270video_adapter_t
271*vid_get_adapter(int index)
272{
273	if ((index < 0) || (index >= adapters))
274		return NULL;
275	return adapter[index];
276}
277
278/* Configure drivers: this is a backdoor for the console driver XXX */
279int
280vid_configure(int flags)
281{
282	const video_driver_t **list;
283	const video_driver_t *p;
284
285	list = (const video_driver_t **)videodriver_set.ls_items;
286	while ((p = *list++) != NULL) {
287		if (p->configure != NULL)
288			(*p->configure)(flags);
289	}
290
291	return 0;
292}
293
294/*
295 * Virtual frame buffer cdev driver functions
296 * The virtual frame buffer driver dispatches driver functions to
297 * appropriate subdrivers.
298 */
299
300#define FB_DRIVER_NAME	"fb"
301
302#ifdef FB_INSTALL_CDEV
303
304#if experimental
305
306static devclass_t	fb_devclass;
307
308static int		fbprobe(device_t dev);
309static int		fbattach(device_t dev);
310
311static device_method_t fb_methods[] = {
312	DEVMETHOD(device_probe,		fbprobe),
313	DEVMETHOD(device_attach,	fbattach),
314
315	DEVMETHOD(bus_print_child,	bus_generic_print_child),
316	{ 0, 0 }
317};
318
319static driver_t fb_driver = {
320	FB_DRIVER_NAME,
321	fb_methods,
322	0,
323};
324
325static int
326fbprobe(device_t dev)
327{
328	int unit;
329
330	unit = device_get_unit(dev);
331	if (unit >= adapters)
332		return ENXIO;
333	if (adapter[unit] == NULL)
334		return ENXIO;
335
336	device_set_desc(dev, "generic frame buffer");
337	return 0;
338}
339
340static int
341fbattach(device_t dev)
342{
343	printf("fbattach: about to attach children\n");
344	bus_generic_attach(dev);
345	return 0;
346}
347
348#endif /* experimental */
349
350#define FB_UNIT(dev)	minor(dev)
351#define FB_MKMINOR(unit) (u)
352
353static d_open_t		fbopen;
354static d_close_t	fbclose;
355static d_read_t		fbread;
356static d_write_t	fbwrite;
357static d_ioctl_t	fbioctl;
358static d_mmap_t		fbmmap;
359
360#define CDEV_MAJOR	123	/* XXX */
361
362static struct cdevsw fb_cdevsw = {
363	/* open */	fbopen,
364	/* close */	fbclose,
365	/* read */	fbread,
366	/* write */	fbwrite,
367	/* ioctl */	fbioctl,
368	/* stop */	nostop,
369	/* reset */	noreset,
370	/* devtotty */	nodevtotty,
371	/* poll */	nopoll,
372	/* mmap */	fbmmap,
373	/* strategy */	nostrategy,
374	/* name */	FB_DRIVER_NAME,
375	/* parms */	noparms,
376	/* maj */	CDEV_MAJOR,
377	/* dump */	nodump,
378	/* psize */	nopsize,
379	/* flags */	0,
380	/* maxio */	0,
381	/* bmaj */	-1
382};
383
384static void
385vfbattach(void *arg)
386{
387	static int fb_devsw_installed = FALSE;
388
389	if (!fb_devsw_installed) {
390		cdevsw_add(&fb_cdevsw);
391		fb_devsw_installed = TRUE;
392	}
393}
394
395PSEUDO_SET(vfbattach, fb);
396
397int
398fb_attach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
399{
400	int s;
401
402	if (adp->va_index >= adapters)
403		return EINVAL;
404	if (adapter[adp->va_index] != adp)
405		return EINVAL;
406
407	s = spltty();
408	adp->va_minor = minor(dev);
409	vidcdevsw[adp->va_index] = cdevsw;
410	splx(s);
411
412	printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
413	return 0;
414}
415
416int
417fb_detach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
418{
419	int s;
420
421	if (adp->va_index >= adapters)
422		return EINVAL;
423	if (adapter[adp->va_index] != adp)
424		return EINVAL;
425	if (vidcdevsw[adp->va_index] != cdevsw)
426		return EINVAL;
427
428	s = spltty();
429	vidcdevsw[adp->va_index] = NULL;
430	splx(s);
431	return 0;
432}
433
434static int
435fbopen(dev_t dev, int flag, int mode, struct proc *p)
436{
437	int unit;
438
439	unit = FB_UNIT(dev);
440	if (unit >= adapters)
441		return ENXIO;
442	if (vidcdevsw[unit] == NULL)
443		return ENXIO;
444	return (*vidcdevsw[unit]->d_open)(makedev(0, adapter[unit]->va_minor),
445					  flag, mode, p);
446}
447
448static int
449fbclose(dev_t dev, int flag, int mode, struct proc *p)
450{
451	int unit;
452
453	unit = FB_UNIT(dev);
454	if (vidcdevsw[unit] == NULL)
455		return ENXIO;
456	return (*vidcdevsw[unit]->d_close)(makedev(0, adapter[unit]->va_minor),
457					   flag, mode, p);
458}
459
460static int
461fbread(dev_t dev, struct uio *uio, int flag)
462{
463	int unit;
464
465	unit = FB_UNIT(dev);
466	if (vidcdevsw[unit] == NULL)
467		return ENXIO;
468	return (*vidcdevsw[unit]->d_read)(makedev(0, adapter[unit]->va_minor),
469					  uio, flag);
470}
471
472static int
473fbwrite(dev_t dev, struct uio *uio, int flag)
474{
475	int unit;
476
477	unit = FB_UNIT(dev);
478	if (vidcdevsw[unit] == NULL)
479		return ENXIO;
480	return (*vidcdevsw[unit]->d_write)(makedev(0, adapter[unit]->va_minor),
481					   uio, flag);
482}
483
484static int
485fbioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct proc *p)
486{
487	int unit;
488
489	unit = FB_UNIT(dev);
490	if (vidcdevsw[unit] == NULL)
491		return ENXIO;
492	return (*vidcdevsw[unit]->d_ioctl)(makedev(0, adapter[unit]->va_minor),
493					   cmd, arg, flag, p);
494}
495
496static int
497fbmmap(dev_t dev, vm_offset_t offset, int nprot)
498{
499	int unit;
500
501	unit = FB_UNIT(dev);
502	if (vidcdevsw[unit] == NULL)
503		return ENXIO;
504	return (*vidcdevsw[unit]->d_mmap)(makedev(0, adapter[unit]->va_minor),
505					  offset, nprot);
506}
507
508#if experimental
509DEV_DRIVER_MODULE(fb, ???, fb_driver, fb_devclass, fb_cdevsw, 0, 0);
510#endif
511
512/*
513 * Generic frame buffer cdev driver functions
514 * Frame buffer subdrivers may call these functions to implement common
515 * driver functions.
516 */
517
518int genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
519	      struct proc *p)
520{
521	int s;
522
523	s = spltty();
524	if (!(sc->gfb_flags & FB_OPEN))
525		sc->gfb_flags |= FB_OPEN;
526	splx(s);
527	return 0;
528}
529
530int genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
531	       struct proc *p)
532{
533	int s;
534
535	s = spltty();
536	sc->gfb_flags &= ~FB_OPEN;
537	splx(s);
538	return 0;
539}
540
541int genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
542	      int flag)
543{
544	int size;
545	int offset;
546	int error;
547	int len;
548
549	error = 0;
550	size = adp->va_buffer_size/adp->va_info.vi_planes;
551	while (uio->uio_resid > 0) {
552		if (uio->uio_offset >= size)
553			break;
554		offset = uio->uio_offset%adp->va_window_size;
555		len = imin(uio->uio_resid, size - uio->uio_offset);
556		len = imin(len, adp->va_window_size - offset);
557		if (len <= 0)
558			break;
559		(*vidsw[adp->va_index]->set_win_org)(adp, uio->uio_offset);
560		error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
561		if (error)
562			break;
563	}
564	return error;
565}
566
567int genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
568	       int flag)
569{
570	return ENODEV;
571}
572
573int genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
574	       caddr_t arg, int flag, struct proc *p)
575{
576	int error;
577
578	if (adp == NULL)	/* XXX */
579		return ENXIO;
580	error = (*vidsw[adp->va_index]->ioctl)(adp, cmd, arg);
581	if (error == ENOIOCTL)
582		error = ENODEV;
583	return error;
584}
585
586int genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_offset_t offset,
587	      int prot)
588{
589	return (*vidsw[adp->va_index]->mmap)(adp, offset, prot);
590}
591
592#endif /* FB_INSTALL_CDEV */
593
594static char
595*adapter_name(int type)
596{
597    static struct {
598	int type;
599	char *name;
600    } names[] = {
601	{ KD_MONO,	"MDA" },
602	{ KD_HERCULES,	"Hercules" },
603	{ KD_CGA,	"CGA" },
604	{ KD_EGA,	"EGA" },
605	{ KD_VGA,	"VGA" },
606	{ KD_PC98,	"PC-98x1" },
607	{ KD_TGA,	"TGA" },
608	{ -1,		"Unknown" },
609    };
610    int i;
611
612    for (i = 0; names[i].type != -1; ++i)
613	if (names[i].type == type)
614	    break;
615    return names[i].name;
616}
617
618/*
619 * Generic low-level frame buffer functions
620 * The low-level functions in the frame buffer subdriver may use these
621 * functions.
622 */
623
624void
625fb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
626{
627    if (level <= 0)
628	return;
629
630    printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
631	   FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
632	   adapter_name(adp->va_type), adp->va_type, adp->va_flags);
633    printf("%s%d: port:0x%x-0x%x, crtc:0x%x, mem:0x%x 0x%x\n",
634	   FB_DRIVER_NAME, adp->va_index,
635	   adp->va_io_base, adp->va_io_base + adp->va_io_size - 1,
636	   adp->va_crtc_addr, adp->va_mem_base, adp->va_mem_size);
637    printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
638	   FB_DRIVER_NAME, adp->va_index,
639	   adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
640    printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
641	   FB_DRIVER_NAME, adp->va_index,
642	   (void *)adp->va_window, (int)adp->va_window_size/1024,
643	   (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
644	   (int)adp->va_buffer_size/1024);
645}
646
647void
648fb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
649		  int level)
650{
651    if (level <= 0)
652	return;
653
654    printf("%s%d: %s, mode:%d, flags:0x%x ",
655	   driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
656    if (info->vi_flags & V_INFO_GRAPHICS)
657	printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
658	       info->vi_width, info->vi_height,
659	       info->vi_depth, info->vi_planes,
660	       info->vi_cwidth, info->vi_cheight);
661    else
662	printf("T %dx%d, font:%dx%d, ",
663	       info->vi_width, info->vi_height,
664	       info->vi_cwidth, info->vi_cheight);
665    printf("win:0x%x\n", info->vi_window);
666}
667
668int
669fb_type(int adp_type)
670{
671	static struct {
672		int	fb_type;
673		int	va_type;
674	} types[] = {
675		{ FBTYPE_MDA,		KD_MONO },
676		{ FBTYPE_HERCULES,	KD_HERCULES },
677		{ FBTYPE_CGA,		KD_CGA },
678		{ FBTYPE_EGA,		KD_EGA },
679		{ FBTYPE_VGA,		KD_VGA },
680		{ FBTYPE_PC98,		KD_PC98 },
681		{ FBTYPE_TGA,		KD_TGA },
682	};
683	int i;
684
685	for (i = 0; i < sizeof(types)/sizeof(types[0]); ++i) {
686		if (types[i].va_type == adp_type)
687			return types[i].fb_type;
688	}
689	return -1;
690}
691
692int
693fb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
694{
695	int error;
696	int s;
697
698	/* assert(adp != NULL) */
699
700	error = 0;
701	s = spltty();
702
703	switch (cmd) {
704
705	case FBIO_ADAPTER:	/* get video adapter index */
706		*(int *)arg = adp->va_index;
707		break;
708
709	case FBIO_ADPTYPE:	/* get video adapter type */
710		*(int *)arg = adp->va_type;
711		break;
712
713	case FBIO_ADPINFO:	/* get video adapter info */
714	        ((video_adapter_info_t *)arg)->va_index = adp->va_index;
715		((video_adapter_info_t *)arg)->va_type = adp->va_type;
716		bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
717		      imin(strlen(adp->va_name) + 1,
718			   sizeof(((video_adapter_info_t *)arg)->va_name)));
719		((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
720		((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
721		((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
722		((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
723		((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
724		((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
725		((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
726		((video_adapter_info_t *)arg)->va_window
727			= vtophys(adp->va_window);
728		((video_adapter_info_t *)arg)->va_window_size
729			= adp->va_window_size;
730		((video_adapter_info_t *)arg)->va_window_gran
731			= adp->va_window_gran;
732		((video_adapter_info_t *)arg)->va_window_orig
733			= adp->va_window_orig;
734		((video_adapter_info_t *)arg)->va_unused0
735			= (adp->va_buffer) ? vtophys(adp->va_buffer) : 0;
736		((video_adapter_info_t *)arg)->va_buffer_size
737			= adp->va_buffer_size;
738		((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
739		((video_adapter_info_t *)arg)->va_initial_mode
740			= adp->va_initial_mode;
741		((video_adapter_info_t *)arg)->va_initial_bios_mode
742			= adp->va_initial_bios_mode;
743		((video_adapter_info_t *)arg)->va_line_width
744			= adp->va_line_width;
745		((video_adapter_info_t *)arg)->va_disp_start.x
746			= adp->va_disp_start.x;
747		((video_adapter_info_t *)arg)->va_disp_start.y
748			= adp->va_disp_start.y;
749		break;
750
751	case FBIO_MODEINFO:	/* get mode information */
752		error = (*vidsw[adp->va_index]->get_info)(adp,
753				((video_info_t *)arg)->vi_mode,
754				(video_info_t *)arg);
755		if (error)
756			error = ENODEV;
757		break;
758
759	case FBIO_FINDMODE:	/* find a matching video mode */
760		error = (*vidsw[adp->va_index]->query_mode)(adp,
761				(video_info_t *)arg);
762		if (error < 0) {
763			error = EINVAL;
764		} else {
765			error = (*vidsw[adp->va_index]->get_info)(adp,
766					error, (video_info_t *)arg);
767			if (error)
768				error = ENODEV;	/* shouldn't happen */
769		}
770		break;
771
772	case FBIO_GETMODE:	/* get video mode */
773		*(int *)arg = adp->va_mode;
774		break;
775
776	case FBIO_SETMODE:	/* set video mode */
777		error = (*vidsw[adp->va_index]->set_mode)(adp, *(int *)arg);
778		if (error)
779			error = ENODEV;	/* EINVAL? */
780		break;
781
782	case FBIO_GETWINORG:	/* get frame buffer window origin */
783		*(u_int *)arg = adp->va_window_orig;
784		break;
785
786	case FBIO_GETDISPSTART:	/* get display start address */
787		((video_display_start_t *)arg)->x = adp->va_disp_start.x;
788		((video_display_start_t *)arg)->y = adp->va_disp_start.y;
789		break;
790
791	case FBIO_GETLINEWIDTH:	/* get scan line width in bytes */
792		*(u_int *)arg = adp->va_line_width;
793		break;
794
795	case FBIO_GETPALETTE:	/* get color palette */
796	case FBIO_SETPALETTE:	/* set color palette */
797		/* XXX */
798
799	case FBIOPUTCMAP:
800	case FBIOGETCMAP:
801		/* XXX */
802
803	case FBIO_SETWINORG:	/* set frame buffer window origin */
804	case FBIO_SETDISPSTART:	/* set display start address */
805	case FBIO_SETLINEWIDTH:	/* set scan line width in pixel */
806
807	case FBIOGTYPE:
808	case FBIOGATTR:
809	case FBIOSVIDEO:
810	case FBIOGVIDEO:
811	case FBIOSCURSOR:
812	case FBIOGCURSOR:
813	case FBIOSCURPOS:
814	case FBIOGCURPOS:
815	case FBIOGCURMAX:
816
817	default:
818		error = ENODEV;
819		break;
820	}
821
822	splx(s);
823	return error;
824}
825