fb.c revision 48557
142421Syokota/*-
242421Syokota * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
342421Syokota * All rights reserved.
442421Syokota *
542421Syokota * Redistribution and use in source and binary forms, with or without
642421Syokota * modification, are permitted provided that the following conditions
742421Syokota * are met:
842421Syokota * 1. Redistributions of source code must retain the above copyright
942421Syokota *    notice, this list of conditions and the following disclaimer as
1042421Syokota *    the first lines of this file unmodified.
1142421Syokota * 2. Redistributions in binary form must reproduce the above copyright
1242421Syokota *    notice, this list of conditions and the following disclaimer in the
1342421Syokota *    documentation and/or other materials provided with the distribution.
1442421Syokota * 3. The name of the author may not be used to endorse or promote products
1542421Syokota *    derived from this software without specific prior written permission.
1642421Syokota *
1742421Syokota * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
1842421Syokota * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
1942421Syokota * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
2042421Syokota * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
2142421Syokota * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
2242421Syokota * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
2342421Syokota * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
2442421Syokota * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
2542421Syokota * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
2642421Syokota * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2742421Syokota *
2848557Sphk * $Id: fb.c,v 1.6 1999/06/22 14:13:22 yokota Exp $
2942421Syokota */
3042421Syokota
3142421Syokota#include "fb.h"
3242421Syokota#include "opt_fb.h"
3342421Syokota
3442421Syokota#include <sys/param.h>
3542421Syokota#include <sys/systm.h>
3642421Syokota#include <sys/conf.h>
3748104Syokota#include <sys/bus.h>
3842421Syokota#include <sys/kernel.h>
3942421Syokota#include <sys/malloc.h>
4048104Syokota#include <sys/uio.h>
4148104Syokota#include <sys/fbio.h>
4242421Syokota
4348104Syokota#include <vm/vm.h>
4448104Syokota#include <vm/pmap.h>
4542421Syokota
4642421Syokota#include <dev/fb/fbreg.h>
4742421Syokota
4842421Syokota/* local arrays */
4942421Syokota
5042421Syokota/*
5142421Syokota * We need at least one entry each in order to initialize a video card
5242421Syokota * for the kernel console.  The arrays will be increased dynamically
5342421Syokota * when necessary.
5442421Syokota */
5542564Syokota
5648104Syokotastatic int		vid_malloc;
5742564Syokotastatic int		adapters = 1;
5842421Syokotastatic video_adapter_t	*adp_ini;
5942564Syokotastatic video_adapter_t	**adapter = &adp_ini;
6042421Syokotastatic video_switch_t	*vidsw_ini;
6142421Syokota       video_switch_t	**vidsw = &vidsw_ini;
6242421Syokota
6342564Syokota#ifdef FB_INSTALL_CDEV
6448104Syokotastatic struct cdevsw	*vidcdevsw_ini;
6548104Syokotastatic struct cdevsw	**vidcdevsw = &vidcdevsw_ini;
6648104Syokota#endif
6742564Syokota
6842421Syokota#define ARRAY_DELTA	4
6942421Syokota
7048104Syokotastatic int
7142421Syokotavid_realloc_array(void)
7242421Syokota{
7342421Syokota	video_adapter_t **new_adp;
7442421Syokota	video_switch_t **new_vidsw;
7548104Syokota#ifdef FB_INSTALL_CDEV
7642421Syokota	struct cdevsw **new_cdevsw;
7748104Syokota#endif
7842421Syokota	int newsize;
7942421Syokota	int s;
8042421Syokota
8148104Syokota	if (!vid_malloc)
8248104Syokota		return ENOMEM;
8348104Syokota
8442421Syokota	s = spltty();
8542421Syokota	newsize = ((adapters + ARRAY_DELTA)/ARRAY_DELTA)*ARRAY_DELTA;
8642421Syokota	new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK);
8742421Syokota	new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF, M_WAITOK);
8848104Syokota#ifdef FB_INSTALL_CDEV
8942421Syokota	new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF, M_WAITOK);
9048104Syokota#endif
9142421Syokota	bzero(new_adp, sizeof(*new_adp)*newsize);
9242421Syokota	bzero(new_vidsw, sizeof(*new_vidsw)*newsize);
9342421Syokota	bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
9442421Syokota	bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
9548104Syokota#ifdef FB_INSTALL_CDEV
9648104Syokota	bzero(new_cdevsw, sizeof(*new_cdevsw)*newsize);
9742421Syokota	bcopy(vidcdevsw, new_cdevsw, sizeof(*vidcdevsw)*adapters);
9848104Syokota#endif
9942421Syokota	if (adapters > 1) {
10042421Syokota		free(adapter, M_DEVBUF);
10142421Syokota		free(vidsw, M_DEVBUF);
10248104Syokota#ifdef FB_INSTALL_CDEV
10342421Syokota		free(vidcdevsw, M_DEVBUF);
10448104Syokota#endif
10542421Syokota	}
10642421Syokota	adapter = new_adp;
10742421Syokota	vidsw = new_vidsw;
10848104Syokota#ifdef FB_INSTALL_CDEV
10942421Syokota	vidcdevsw = new_cdevsw;
11048104Syokota#endif
11142421Syokota	adapters = newsize;
11242421Syokota	splx(s);
11342421Syokota
11442421Syokota	if (bootverbose)
11542421Syokota		printf("fb: new array size %d\n", adapters);
11648104Syokota
11748104Syokota	return 0;
11842421Syokota}
11942421Syokota
12048104Syokotastatic void
12148104Syokotavid_malloc_init(void *arg)
12248104Syokota{
12348104Syokota	vid_malloc = TRUE;
12448104Syokota}
12542564Syokota
12648104SyokotaSYSINIT(vid_mem, SI_SUB_KMEM, SI_ORDER_ANY, vid_malloc_init, NULL);
12748104Syokota
12842421Syokota/*
12942421Syokota * Low-level frame buffer driver functions
13042421Syokota * frame buffer subdrivers, such as the VGA driver, call these functions
13142421Syokota * to initialize the video_adapter structure and register it to the virtual
13242421Syokota * frame buffer driver `fb'.
13342421Syokota */
13442421Syokota
13542421Syokota/* initialize the video_adapter_t structure */
13642421Syokotavoid
13742421Syokotavid_init_struct(video_adapter_t *adp, char *name, int type, int unit)
13842421Syokota{
13942421Syokota	adp->va_flags = 0;
14042421Syokota	adp->va_name = name;
14142421Syokota	adp->va_type = type;
14242421Syokota	adp->va_unit = unit;
14342421Syokota}
14442421Syokota
14542421Syokota/* Register a video adapter */
14642421Syokotaint
14742421Syokotavid_register(video_adapter_t *adp)
14842421Syokota{
14948104Syokota	const video_driver_t **list;
15048104Syokota	const video_driver_t *p;
15142421Syokota	int index;
15242421Syokota
15342421Syokota	for (index = 0; index < adapters; ++index) {
15442421Syokota		if (adapter[index] == NULL)
15542421Syokota			break;
15642421Syokota	}
15748104Syokota	if (index >= adapters) {
15848104Syokota		if (vid_realloc_array())
15948104Syokota			return -1;
16048104Syokota	}
16142421Syokota
16242421Syokota	adp->va_index = index;
16342421Syokota	adp->va_token = NULL;
16448104Syokota	list = (const video_driver_t **)videodriver_set.ls_items;
16542421Syokota	while ((p = *list++) != NULL) {
16642421Syokota		if (strcmp(p->name, adp->va_name) == 0) {
16742421Syokota			adapter[index] = adp;
16842421Syokota			vidsw[index] = p->vidsw;
16942421Syokota			return index;
17042421Syokota		}
17142421Syokota	}
17242421Syokota
17342421Syokota	return -1;
17442421Syokota}
17542421Syokota
17642421Syokotaint
17742421Syokotavid_unregister(video_adapter_t *adp)
17842421Syokota{
17942421Syokota	if ((adp->va_index < 0) || (adp->va_index >= adapters))
18042421Syokota		return ENOENT;
18142421Syokota	if (adapter[adp->va_index] != adp)
18242421Syokota		return ENOENT;
18342421Syokota
18442421Syokota	adapter[adp->va_index] = NULL;
18542421Syokota	vidsw[adp->va_index] = NULL;
18642421Syokota	return 0;
18742421Syokota}
18842421Syokota
18942421Syokota/* Get video I/O function table */
19042421Syokotavideo_switch_t
19142421Syokota*vid_get_switch(char *name)
19242421Syokota{
19348104Syokota	const video_driver_t **list;
19448104Syokota	const video_driver_t *p;
19542421Syokota
19648104Syokota	list = (const video_driver_t **)videodriver_set.ls_items;
19742421Syokota	while ((p = *list++) != NULL) {
19842421Syokota		if (strcmp(p->name, name) == 0)
19942421Syokota			return p->vidsw;
20042421Syokota	}
20142421Syokota
20242421Syokota	return NULL;
20342421Syokota}
20442421Syokota
20542421Syokota/*
20642421Syokota * Video card client functions
20742421Syokota * Video card clients, such as the console driver `syscons' and the frame
20842421Syokota * buffer cdev driver, use these functions to claim and release a card for
20942421Syokota * exclusive use.
21042421Syokota */
21142421Syokota
21242421Syokota/* find the video card specified by a driver name and a unit number */
21342421Syokotaint
21442421Syokotavid_find_adapter(char *driver, int unit)
21542421Syokota{
21642421Syokota	int i;
21742421Syokota
21842421Syokota	for (i = 0; i < adapters; ++i) {
21942421Syokota		if (adapter[i] == NULL)
22042421Syokota			continue;
22142421Syokota		if (strcmp("*", driver) && strcmp(adapter[i]->va_name, driver))
22242421Syokota			continue;
22342421Syokota		if ((unit != -1) && (adapter[i]->va_unit != unit))
22442421Syokota			continue;
22542421Syokota		return i;
22642421Syokota	}
22742421Syokota	return -1;
22842421Syokota}
22942421Syokota
23042421Syokota/* allocate a video card */
23142421Syokotaint
23242421Syokotavid_allocate(char *driver, int unit, void *id)
23342421Syokota{
23442421Syokota	int index;
23542421Syokota	int s;
23642421Syokota
23742421Syokota	s = spltty();
23842421Syokota	index = vid_find_adapter(driver, unit);
23942421Syokota	if (index >= 0) {
24042421Syokota		if (adapter[index]->va_token) {
24142421Syokota			splx(s);
24242421Syokota			return -1;
24342421Syokota		}
24442421Syokota		adapter[index]->va_token = id;
24542421Syokota	}
24642421Syokota	splx(s);
24742421Syokota	return index;
24842421Syokota}
24942421Syokota
25042421Syokotaint
25142421Syokotavid_release(video_adapter_t *adp, void *id)
25242421Syokota{
25342421Syokota	int error;
25442421Syokota	int s;
25542421Syokota
25642421Syokota	s = spltty();
25742421Syokota	if (adp->va_token == NULL) {
25842421Syokota		error = EINVAL;
25942421Syokota	} else if (adp->va_token != id) {
26042421Syokota		error = EPERM;
26142421Syokota	} else {
26242421Syokota		adp->va_token = NULL;
26342421Syokota		error = 0;
26442421Syokota	}
26542421Syokota	splx(s);
26642421Syokota	return error;
26742421Syokota}
26842421Syokota
26942421Syokota/* Get a video adapter structure */
27042421Syokotavideo_adapter_t
27142421Syokota*vid_get_adapter(int index)
27242421Syokota{
27342421Syokota	if ((index < 0) || (index >= adapters))
27442421Syokota		return NULL;
27542421Syokota	return adapter[index];
27642421Syokota}
27742421Syokota
27842421Syokota/* Configure drivers: this is a backdoor for the console driver XXX */
27942421Syokotaint
28042421Syokotavid_configure(int flags)
28142421Syokota{
28248104Syokota	const video_driver_t **list;
28348104Syokota	const video_driver_t *p;
28442421Syokota
28548104Syokota	list = (const video_driver_t **)videodriver_set.ls_items;
28642421Syokota	while ((p = *list++) != NULL) {
28742421Syokota		if (p->configure != NULL)
28842421Syokota			(*p->configure)(flags);
28942421Syokota	}
29042421Syokota
29142421Syokota	return 0;
29242421Syokota}
29342421Syokota
29442421Syokota/*
29542421Syokota * Virtual frame buffer cdev driver functions
29642421Syokota * The virtual frame buffer driver dispatches driver functions to
29742421Syokota * appropriate subdrivers.
29842421Syokota */
29942421Syokota
30048104Syokota#define FB_DRIVER_NAME	"fb"
30142421Syokota
30242421Syokota#ifdef FB_INSTALL_CDEV
30342421Syokota
30448104Syokota#if experimental
30548104Syokota
30648104Syokotastatic devclass_t	fb_devclass;
30748104Syokota
30848104Syokotastatic int		fbprobe(device_t dev);
30948104Syokotastatic int		fbattach(device_t dev);
31048104Syokota
31148104Syokotastatic device_method_t fb_methods[] = {
31248104Syokota	DEVMETHOD(device_probe,		fbprobe),
31348104Syokota	DEVMETHOD(device_attach,	fbattach),
31448104Syokota
31548104Syokota	DEVMETHOD(bus_print_child,	bus_generic_print_child),
31648104Syokota	{ 0, 0 }
31748104Syokota};
31848104Syokota
31948104Syokotastatic driver_t fb_driver = {
32048104Syokota	FB_DRIVER_NAME,
32148104Syokota	fb_methods,
32248104Syokota	0,
32348104Syokota};
32448104Syokota
32548104Syokotastatic int
32648104Syokotafbprobe(device_t dev)
32748104Syokota{
32848104Syokota	int unit;
32948104Syokota
33048104Syokota	unit = device_get_unit(dev);
33148104Syokota	if (unit >= adapters)
33248104Syokota		return ENXIO;
33348104Syokota	if (adapter[unit] == NULL)
33448104Syokota		return ENXIO;
33548104Syokota
33648104Syokota	device_set_desc(dev, "generic frame buffer");
33748104Syokota	return 0;
33848104Syokota}
33948104Syokota
34048104Syokotastatic int
34148104Syokotafbattach(device_t dev)
34248104Syokota{
34348104Syokota	printf("fbattach: about to attach children\n");
34448104Syokota	bus_generic_attach(dev);
34548104Syokota	return 0;
34648104Syokota}
34748104Syokota
34848104Syokota#endif /* experimental */
34948104Syokota
35042421Syokota#define FB_UNIT(dev)	minor(dev)
35142421Syokota#define FB_MKMINOR(unit) (u)
35242421Syokota
35342421Syokotastatic d_open_t		fbopen;
35442421Syokotastatic d_close_t	fbclose;
35548104Syokotastatic d_read_t		fbread;
35648104Syokotastatic d_write_t	fbwrite;
35742421Syokotastatic d_ioctl_t	fbioctl;
35842421Syokotastatic d_mmap_t		fbmmap;
35942421Syokota
36048104Syokota#define CDEV_MAJOR	123	/* XXX */
36142421Syokota
36242421Syokotastatic struct cdevsw fb_cdevsw = {
36347625Sphk	/* open */	fbopen,
36447625Sphk	/* close */	fbclose,
36548104Syokota	/* read */	fbread,
36648104Syokota	/* write */	fbwrite,
36747625Sphk	/* ioctl */	fbioctl,
36847625Sphk	/* stop */	nostop,
36947625Sphk	/* reset */	noreset,
37047625Sphk	/* devtotty */	nodevtotty,
37147625Sphk	/* poll */	nopoll,
37247625Sphk	/* mmap */	fbmmap,
37347625Sphk	/* strategy */	nostrategy,
37448104Syokota	/* name */	FB_DRIVER_NAME,
37547625Sphk	/* parms */	noparms,
37647625Sphk	/* maj */	CDEV_MAJOR,
37747625Sphk	/* dump */	nodump,
37847625Sphk	/* psize */	nopsize,
37947625Sphk	/* flags */	0,
38047625Sphk	/* maxio */	0,
38147625Sphk	/* bmaj */	-1
38242421Syokota};
38342421Syokota
38442421Syokotastatic void
38542421Syokotavfbattach(void *arg)
38642421Syokota{
38742421Syokota	static int fb_devsw_installed = FALSE;
38842421Syokota
38942421Syokota	if (!fb_devsw_installed) {
39047640Sphk		cdevsw_add(&fb_cdevsw);
39142421Syokota		fb_devsw_installed = TRUE;
39242421Syokota	}
39342421Syokota}
39442421Syokota
39542421SyokotaPSEUDO_SET(vfbattach, fb);
39642421Syokota
39742421Syokotaint
39848104Syokotafb_attach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
39942421Syokota{
40042421Syokota	int s;
40142421Syokota
40242421Syokota	if (adp->va_index >= adapters)
40342421Syokota		return EINVAL;
40442421Syokota	if (adapter[adp->va_index] != adp)
40542421Syokota		return EINVAL;
40642421Syokota
40742421Syokota	s = spltty();
40842421Syokota	adp->va_minor = minor(dev);
40942421Syokota	vidcdevsw[adp->va_index] = cdevsw;
41042421Syokota	splx(s);
41142421Syokota
41242421Syokota	/* XXX: DEVFS? */
41342421Syokota
41442421Syokota	printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
41542421Syokota	return 0;
41642421Syokota}
41742421Syokota
41842421Syokotaint
41948104Syokotafb_detach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
42042421Syokota{
42142421Syokota	int s;
42242421Syokota
42342421Syokota	if (adp->va_index >= adapters)
42442421Syokota		return EINVAL;
42542421Syokota	if (adapter[adp->va_index] != adp)
42642421Syokota		return EINVAL;
42742421Syokota	if (vidcdevsw[adp->va_index] != cdevsw)
42842421Syokota		return EINVAL;
42942421Syokota
43042421Syokota	s = spltty();
43142421Syokota	vidcdevsw[adp->va_index] = NULL;
43242421Syokota	splx(s);
43342421Syokota	return 0;
43442421Syokota}
43542421Syokota
43648104Syokotastatic int
43748104Syokotafbopen(dev_t dev, int flag, int mode, struct proc *p)
43848104Syokota{
43948104Syokota	int unit;
44048104Syokota
44148104Syokota	unit = FB_UNIT(dev);
44248104Syokota	if (unit >= adapters)
44348104Syokota		return ENXIO;
44448104Syokota	if (vidcdevsw[unit] == NULL)
44548104Syokota		return ENXIO;
44648104Syokota	return (*vidcdevsw[unit]->d_open)(makedev(0, adapter[unit]->va_minor),
44748104Syokota					  flag, mode, p);
44848104Syokota}
44948104Syokota
45048104Syokotastatic int
45148104Syokotafbclose(dev_t dev, int flag, int mode, struct proc *p)
45248104Syokota{
45348104Syokota	int unit;
45448104Syokota
45548104Syokota	unit = FB_UNIT(dev);
45648104Syokota	if (vidcdevsw[unit] == NULL)
45748104Syokota		return ENXIO;
45848104Syokota	return (*vidcdevsw[unit]->d_close)(makedev(0, adapter[unit]->va_minor),
45948104Syokota					   flag, mode, p);
46048104Syokota}
46148104Syokota
46248104Syokotastatic int
46348104Syokotafbread(dev_t dev, struct uio *uio, int flag)
46448104Syokota{
46548104Syokota	int unit;
46648104Syokota
46748104Syokota	unit = FB_UNIT(dev);
46848104Syokota	if (vidcdevsw[unit] == NULL)
46948104Syokota		return ENXIO;
47048104Syokota	return (*vidcdevsw[unit]->d_read)(makedev(0, adapter[unit]->va_minor),
47148104Syokota					  uio, flag);
47248104Syokota}
47348104Syokota
47448104Syokotastatic int
47548104Syokotafbwrite(dev_t dev, struct uio *uio, int flag)
47648104Syokota{
47748104Syokota	int unit;
47848104Syokota
47948104Syokota	unit = FB_UNIT(dev);
48048104Syokota	if (vidcdevsw[unit] == NULL)
48148104Syokota		return ENXIO;
48248104Syokota	return (*vidcdevsw[unit]->d_write)(makedev(0, adapter[unit]->va_minor),
48348104Syokota					   uio, flag);
48448104Syokota}
48548104Syokota
48648104Syokotastatic int
48748104Syokotafbioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct proc *p)
48848104Syokota{
48948104Syokota	int unit;
49048104Syokota
49148104Syokota	unit = FB_UNIT(dev);
49248104Syokota	if (vidcdevsw[unit] == NULL)
49348104Syokota		return ENXIO;
49448104Syokota	return (*vidcdevsw[unit]->d_ioctl)(makedev(0, adapter[unit]->va_minor),
49548104Syokota					   cmd, arg, flag, p);
49648104Syokota}
49748104Syokota
49848104Syokotastatic int
49948104Syokotafbmmap(dev_t dev, vm_offset_t offset, int nprot)
50048104Syokota{
50148104Syokota	int unit;
50248104Syokota
50348104Syokota	unit = FB_UNIT(dev);
50448104Syokota	if (vidcdevsw[unit] == NULL)
50548104Syokota		return ENXIO;
50648104Syokota	return (*vidcdevsw[unit]->d_mmap)(makedev(0, adapter[unit]->va_minor),
50748104Syokota					  offset, nprot);
50848104Syokota}
50948104Syokota
51048104Syokota#if experimental
51148557SphkDEV_DRIVER_MODULE(fb, ???, fb_driver, fb_devclass, fb_cdevsw, 0, 0);
51248104Syokota#endif
51348104Syokota
51448104Syokota/*
51548104Syokota * Generic frame buffer cdev driver functions
51648104Syokota * Frame buffer subdrivers may call these functions to implement common
51748104Syokota * driver functions.
51848104Syokota */
51948104Syokota
52048104Syokotaint genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
52148104Syokota	      struct proc *p)
52248104Syokota{
52348104Syokota	int s;
52448104Syokota
52548104Syokota	s = spltty();
52648104Syokota	if (!(sc->gfb_flags & FB_OPEN))
52748104Syokota		sc->gfb_flags |= FB_OPEN;
52848104Syokota	splx(s);
52948104Syokota	return 0;
53048104Syokota}
53148104Syokota
53248104Syokotaint genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
53348104Syokota	       struct proc *p)
53448104Syokota{
53548104Syokota	int s;
53648104Syokota
53748104Syokota	s = spltty();
53848104Syokota	sc->gfb_flags &= ~FB_OPEN;
53948104Syokota	splx(s);
54048104Syokota	return 0;
54148104Syokota}
54248104Syokota
54348104Syokotaint genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
54448104Syokota	      int flag)
54548104Syokota{
54648104Syokota	int size;
54748104Syokota	int offset;
54848104Syokota	int error;
54948104Syokota	int len;
55048104Syokota
55148104Syokota	error = 0;
55248104Syokota	size = adp->va_buffer_size/adp->va_info.vi_planes;
55348104Syokota	while (uio->uio_resid > 0) {
55448104Syokota		if (uio->uio_offset >= size)
55548104Syokota			break;
55648104Syokota		offset = uio->uio_offset%adp->va_window_size;
55748104Syokota		len = imin(uio->uio_resid, size - uio->uio_offset);
55848104Syokota		len = imin(len, adp->va_window_size - offset);
55948104Syokota		if (len <= 0)
56048104Syokota			break;
56148104Syokota		(*vidsw[adp->va_index]->set_win_org)(adp, uio->uio_offset);
56248104Syokota		error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
56348104Syokota		if (error)
56448104Syokota			break;
56548104Syokota	}
56648104Syokota	return error;
56748104Syokota}
56848104Syokota
56948104Syokotaint genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
57048104Syokota	       int flag)
57148104Syokota{
57248104Syokota	return ENODEV;
57348104Syokota}
57448104Syokota
57548104Syokotaint genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
57648104Syokota	       caddr_t arg, int flag, struct proc *p)
57748104Syokota{
57848104Syokota	int error;
57948104Syokota
58048104Syokota	if (adp == NULL)	/* XXX */
58148104Syokota		return ENXIO;
58248104Syokota	error = (*vidsw[adp->va_index]->ioctl)(adp, cmd, arg);
58348104Syokota	if (error == ENOIOCTL)
58448104Syokota		error = ENODEV;
58548104Syokota	return error;
58648104Syokota}
58748104Syokota
58848104Syokotaint genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_offset_t offset,
58948104Syokota	      int prot)
59048104Syokota{
59148104Syokota	return (*vidsw[adp->va_index]->mmap)(adp, offset, prot);
59248104Syokota}
59348104Syokota
59442421Syokota#endif /* FB_INSTALL_CDEV */
59542421Syokota
59642421Syokotastatic char
59742421Syokota*adapter_name(int type)
59842421Syokota{
59942421Syokota    static struct {
60042421Syokota	int type;
60142421Syokota	char *name;
60242421Syokota    } names[] = {
60342421Syokota	{ KD_MONO,	"MDA" },
60442421Syokota	{ KD_HERCULES,	"Hercules" },
60542421Syokota	{ KD_CGA,	"CGA" },
60642421Syokota	{ KD_EGA,	"EGA" },
60742421Syokota	{ KD_VGA,	"VGA" },
60842421Syokota	{ KD_PC98,	"PC-98x1" },
60948104Syokota	{ KD_TGA,	"TGA" },
61042421Syokota	{ -1,		"Unknown" },
61142421Syokota    };
61242421Syokota    int i;
61342421Syokota
61442421Syokota    for (i = 0; names[i].type != -1; ++i)
61542421Syokota	if (names[i].type == type)
61642421Syokota	    break;
61742421Syokota    return names[i].name;
61842421Syokota}
61942421Syokota
62048104Syokota/*
62148104Syokota * Generic low-level frame buffer functions
62248104Syokota * The low-level functions in the frame buffer subdriver may use these
62348104Syokota * functions.
62448104Syokota */
62548104Syokota
62642421Syokotavoid
62742421Syokotafb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
62842421Syokota{
62942421Syokota    if (level <= 0)
63042421Syokota	return;
63142421Syokota
63242421Syokota    printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
63348104Syokota	   FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
63442421Syokota	   adapter_name(adp->va_type), adp->va_type, adp->va_flags);
63542421Syokota    printf("%s%d: port:0x%x-0x%x, crtc:0x%x, mem:0x%x 0x%x\n",
63648104Syokota	   FB_DRIVER_NAME, adp->va_index,
63742421Syokota	   adp->va_io_base, adp->va_io_base + adp->va_io_size - 1,
63842421Syokota	   adp->va_crtc_addr, adp->va_mem_base, adp->va_mem_size);
63942421Syokota    printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
64048104Syokota	   FB_DRIVER_NAME, adp->va_index,
64142421Syokota	   adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
64248104Syokota    printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
64348104Syokota	   FB_DRIVER_NAME, adp->va_index,
64448104Syokota	   (void *)adp->va_window, (int)adp->va_window_size/1024,
64548104Syokota	   (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
64642831Syokota	   (int)adp->va_buffer_size/1024);
64742421Syokota}
64842421Syokota
64942421Syokotavoid
65042421Syokotafb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
65142421Syokota		  int level)
65242421Syokota{
65342421Syokota    if (level <= 0)
65442421Syokota	return;
65542421Syokota
65642421Syokota    printf("%s%d: %s, mode:%d, flags:0x%x ",
65742421Syokota	   driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
65842421Syokota    if (info->vi_flags & V_INFO_GRAPHICS)
65942421Syokota	printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
66042421Syokota	       info->vi_width, info->vi_height,
66142421Syokota	       info->vi_depth, info->vi_planes,
66242421Syokota	       info->vi_cwidth, info->vi_cheight);
66342421Syokota    else
66442421Syokota	printf("T %dx%d, font:%dx%d, ",
66542421Syokota	       info->vi_width, info->vi_height,
66642421Syokota	       info->vi_cwidth, info->vi_cheight);
66742421Syokota    printf("win:0x%x\n", info->vi_window);
66842421Syokota}
66948104Syokota
67048104Syokotaint
67148104Syokotafb_type(int adp_type)
67248104Syokota{
67348104Syokota	static struct {
67448104Syokota		int	fb_type;
67548104Syokota		int	va_type;
67648104Syokota	} types[] = {
67748104Syokota		{ FBTYPE_MDA,		KD_MONO },
67848104Syokota		{ FBTYPE_HERCULES,	KD_HERCULES },
67948104Syokota		{ FBTYPE_CGA,		KD_CGA },
68048104Syokota		{ FBTYPE_EGA,		KD_EGA },
68148104Syokota		{ FBTYPE_VGA,		KD_VGA },
68248104Syokota		{ FBTYPE_PC98,		KD_PC98 },
68348104Syokota		{ FBTYPE_TGA,		KD_TGA },
68448104Syokota	};
68548104Syokota	int i;
68648104Syokota
68748104Syokota	for (i = 0; i < sizeof(types)/sizeof(types[0]); ++i) {
68848104Syokota		if (types[i].va_type == adp_type)
68948104Syokota			return types[i].fb_type;
69048104Syokota	}
69148104Syokota	return -1;
69248104Syokota}
69348104Syokota
69448104Syokotaint
69548104Syokotafb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
69648104Syokota{
69748104Syokota	int error;
69848104Syokota	int s;
69948104Syokota
70048104Syokota	/* assert(adp != NULL) */
70148104Syokota
70248104Syokota	error = 0;
70348104Syokota	s = spltty();
70448104Syokota
70548104Syokota	switch (cmd) {
70648104Syokota
70748104Syokota	case FBIO_ADAPTER:	/* get video adapter index */
70848104Syokota		*(int *)arg = adp->va_index;
70948104Syokota		break;
71048104Syokota
71148104Syokota	case FBIO_ADPTYPE:	/* get video adapter type */
71248104Syokota		*(int *)arg = adp->va_type;
71348104Syokota		break;
71448104Syokota
71548104Syokota	case FBIO_ADPINFO:	/* get video adapter info */
71648104Syokota	        ((video_adapter_info_t *)arg)->va_index = adp->va_index;
71748104Syokota		((video_adapter_info_t *)arg)->va_type = adp->va_type;
71848104Syokota		bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
71948104Syokota		      imin(strlen(adp->va_name) + 1,
72048104Syokota			   sizeof(((video_adapter_info_t *)arg)->va_name)));
72148104Syokota		((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
72248104Syokota		((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
72348104Syokota		((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
72448104Syokota		((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
72548104Syokota		((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
72648104Syokota		((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
72748104Syokota		((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
72848104Syokota		((video_adapter_info_t *)arg)->va_window
72948104Syokota			= vtophys(adp->va_window);
73048104Syokota		((video_adapter_info_t *)arg)->va_window_size
73148104Syokota			= adp->va_window_size;
73248104Syokota		((video_adapter_info_t *)arg)->va_window_gran
73348104Syokota			= adp->va_window_gran;
73448104Syokota		((video_adapter_info_t *)arg)->va_window_orig
73548104Syokota			= adp->va_window_orig;
73648104Syokota		((video_adapter_info_t *)arg)->va_unused0
73748104Syokota			= (adp->va_buffer) ? vtophys(adp->va_buffer) : 0;
73848104Syokota		((video_adapter_info_t *)arg)->va_buffer_size
73948104Syokota			= adp->va_buffer_size;
74048104Syokota		((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
74148104Syokota		((video_adapter_info_t *)arg)->va_initial_mode
74248104Syokota			= adp->va_initial_mode;
74348104Syokota		((video_adapter_info_t *)arg)->va_initial_bios_mode
74448104Syokota			= adp->va_initial_bios_mode;
74548104Syokota		((video_adapter_info_t *)arg)->va_line_width
74648104Syokota			= adp->va_line_width;
74748104Syokota		((video_adapter_info_t *)arg)->va_disp_start.x
74848104Syokota			= adp->va_disp_start.x;
74948104Syokota		((video_adapter_info_t *)arg)->va_disp_start.y
75048104Syokota			= adp->va_disp_start.y;
75148104Syokota		break;
75248104Syokota
75348104Syokota	case FBIO_MODEINFO:	/* get mode information */
75448104Syokota		error = (*vidsw[adp->va_index]->get_info)(adp,
75548104Syokota				((video_info_t *)arg)->vi_mode,
75648104Syokota				(video_info_t *)arg);
75748104Syokota		if (error)
75848104Syokota			error = ENODEV;
75948104Syokota		break;
76048104Syokota
76148104Syokota	case FBIO_FINDMODE:	/* find a matching video mode */
76248104Syokota		error = (*vidsw[adp->va_index]->query_mode)(adp,
76348104Syokota				(video_info_t *)arg);
76448104Syokota		if (error < 0) {
76548104Syokota			error = EINVAL;
76648104Syokota		} else {
76748104Syokota			error = (*vidsw[adp->va_index]->get_info)(adp,
76848104Syokota					error, (video_info_t *)arg);
76948104Syokota			if (error)
77048104Syokota				error = ENODEV;	/* shouldn't happen */
77148104Syokota		}
77248104Syokota		break;
77348104Syokota
77448104Syokota	case FBIO_GETMODE:	/* get video mode */
77548104Syokota		*(int *)arg = adp->va_mode;
77648104Syokota		break;
77748104Syokota
77848104Syokota	case FBIO_SETMODE:	/* set video mode */
77948104Syokota		error = (*vidsw[adp->va_index]->set_mode)(adp, *(int *)arg);
78048104Syokota		if (error)
78148104Syokota			error = ENODEV;	/* EINVAL? */
78248104Syokota		break;
78348104Syokota
78448104Syokota	case FBIO_GETWINORG:	/* get frame buffer window origin */
78548104Syokota		*(u_int *)arg = adp->va_window_orig;
78648104Syokota		break;
78748104Syokota
78848104Syokota	case FBIO_GETDISPSTART:	/* get display start address */
78948104Syokota		((video_display_start_t *)arg)->x = adp->va_disp_start.x;
79048104Syokota		((video_display_start_t *)arg)->y = adp->va_disp_start.y;
79148104Syokota		break;
79248104Syokota
79348104Syokota	case FBIO_GETLINEWIDTH:	/* get scan line width in bytes */
79448104Syokota		*(u_int *)arg = adp->va_line_width;
79548104Syokota		break;
79648104Syokota
79748104Syokota	case FBIO_GETPALETTE:	/* get color palette */
79848104Syokota	case FBIO_SETPALETTE:	/* set color palette */
79948104Syokota		/* XXX */
80048104Syokota
80148104Syokota	case FBIOPUTCMAP:
80248104Syokota	case FBIOGETCMAP:
80348104Syokota		/* XXX */
80448104Syokota
80548104Syokota	case FBIO_SETWINORG:	/* set frame buffer window origin */
80648104Syokota	case FBIO_SETDISPSTART:	/* set display start address */
80748104Syokota	case FBIO_SETLINEWIDTH:	/* set scan line width in pixel */
80848104Syokota
80948104Syokota	case FBIOGTYPE:
81048104Syokota	case FBIOGATTR:
81148104Syokota	case FBIOSVIDEO:
81248104Syokota	case FBIOGVIDEO:
81348104Syokota	case FBIOSCURSOR:
81448104Syokota	case FBIOGCURSOR:
81548104Syokota	case FBIOSCURPOS:
81648104Syokota	case FBIOGCURPOS:
81748104Syokota	case FBIOGCURMAX:
81848104Syokota
81948104Syokota	default:
82048104Syokota		error = ENODEV;
82148104Syokota		break;
82248104Syokota	}
82348104Syokota
82448104Syokota	splx(s);
82548104Syokota	return error;
82648104Syokota}
827