fb.c revision 50477
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 *
2850477Speter * $FreeBSD: head/sys/dev/fb/fb.c 50477 1999-08-28 01:08:13Z peter $
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	printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
41342421Syokota	return 0;
41442421Syokota}
41542421Syokota
41642421Syokotaint
41748104Syokotafb_detach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
41842421Syokota{
41942421Syokota	int s;
42042421Syokota
42142421Syokota	if (adp->va_index >= adapters)
42242421Syokota		return EINVAL;
42342421Syokota	if (adapter[adp->va_index] != adp)
42442421Syokota		return EINVAL;
42542421Syokota	if (vidcdevsw[adp->va_index] != cdevsw)
42642421Syokota		return EINVAL;
42742421Syokota
42842421Syokota	s = spltty();
42942421Syokota	vidcdevsw[adp->va_index] = NULL;
43042421Syokota	splx(s);
43142421Syokota	return 0;
43242421Syokota}
43342421Syokota
43448104Syokotastatic int
43548104Syokotafbopen(dev_t dev, int flag, int mode, struct proc *p)
43648104Syokota{
43748104Syokota	int unit;
43848104Syokota
43948104Syokota	unit = FB_UNIT(dev);
44048104Syokota	if (unit >= adapters)
44148104Syokota		return ENXIO;
44248104Syokota	if (vidcdevsw[unit] == NULL)
44348104Syokota		return ENXIO;
44448104Syokota	return (*vidcdevsw[unit]->d_open)(makedev(0, adapter[unit]->va_minor),
44548104Syokota					  flag, mode, p);
44648104Syokota}
44748104Syokota
44848104Syokotastatic int
44948104Syokotafbclose(dev_t dev, int flag, int mode, struct proc *p)
45048104Syokota{
45148104Syokota	int unit;
45248104Syokota
45348104Syokota	unit = FB_UNIT(dev);
45448104Syokota	if (vidcdevsw[unit] == NULL)
45548104Syokota		return ENXIO;
45648104Syokota	return (*vidcdevsw[unit]->d_close)(makedev(0, adapter[unit]->va_minor),
45748104Syokota					   flag, mode, p);
45848104Syokota}
45948104Syokota
46048104Syokotastatic int
46148104Syokotafbread(dev_t dev, struct uio *uio, int flag)
46248104Syokota{
46348104Syokota	int unit;
46448104Syokota
46548104Syokota	unit = FB_UNIT(dev);
46648104Syokota	if (vidcdevsw[unit] == NULL)
46748104Syokota		return ENXIO;
46848104Syokota	return (*vidcdevsw[unit]->d_read)(makedev(0, adapter[unit]->va_minor),
46948104Syokota					  uio, flag);
47048104Syokota}
47148104Syokota
47248104Syokotastatic int
47348104Syokotafbwrite(dev_t dev, struct uio *uio, int flag)
47448104Syokota{
47548104Syokota	int unit;
47648104Syokota
47748104Syokota	unit = FB_UNIT(dev);
47848104Syokota	if (vidcdevsw[unit] == NULL)
47948104Syokota		return ENXIO;
48048104Syokota	return (*vidcdevsw[unit]->d_write)(makedev(0, adapter[unit]->va_minor),
48148104Syokota					   uio, flag);
48248104Syokota}
48348104Syokota
48448104Syokotastatic int
48548104Syokotafbioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct proc *p)
48648104Syokota{
48748104Syokota	int unit;
48848104Syokota
48948104Syokota	unit = FB_UNIT(dev);
49048104Syokota	if (vidcdevsw[unit] == NULL)
49148104Syokota		return ENXIO;
49248104Syokota	return (*vidcdevsw[unit]->d_ioctl)(makedev(0, adapter[unit]->va_minor),
49348104Syokota					   cmd, arg, flag, p);
49448104Syokota}
49548104Syokota
49648104Syokotastatic int
49748104Syokotafbmmap(dev_t dev, vm_offset_t offset, int nprot)
49848104Syokota{
49948104Syokota	int unit;
50048104Syokota
50148104Syokota	unit = FB_UNIT(dev);
50248104Syokota	if (vidcdevsw[unit] == NULL)
50348104Syokota		return ENXIO;
50448104Syokota	return (*vidcdevsw[unit]->d_mmap)(makedev(0, adapter[unit]->va_minor),
50548104Syokota					  offset, nprot);
50648104Syokota}
50748104Syokota
50848104Syokota#if experimental
50948557SphkDEV_DRIVER_MODULE(fb, ???, fb_driver, fb_devclass, fb_cdevsw, 0, 0);
51048104Syokota#endif
51148104Syokota
51248104Syokota/*
51348104Syokota * Generic frame buffer cdev driver functions
51448104Syokota * Frame buffer subdrivers may call these functions to implement common
51548104Syokota * driver functions.
51648104Syokota */
51748104Syokota
51848104Syokotaint genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
51948104Syokota	      struct proc *p)
52048104Syokota{
52148104Syokota	int s;
52248104Syokota
52348104Syokota	s = spltty();
52448104Syokota	if (!(sc->gfb_flags & FB_OPEN))
52548104Syokota		sc->gfb_flags |= FB_OPEN;
52648104Syokota	splx(s);
52748104Syokota	return 0;
52848104Syokota}
52948104Syokota
53048104Syokotaint genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
53148104Syokota	       struct proc *p)
53248104Syokota{
53348104Syokota	int s;
53448104Syokota
53548104Syokota	s = spltty();
53648104Syokota	sc->gfb_flags &= ~FB_OPEN;
53748104Syokota	splx(s);
53848104Syokota	return 0;
53948104Syokota}
54048104Syokota
54148104Syokotaint genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
54248104Syokota	      int flag)
54348104Syokota{
54448104Syokota	int size;
54548104Syokota	int offset;
54648104Syokota	int error;
54748104Syokota	int len;
54848104Syokota
54948104Syokota	error = 0;
55048104Syokota	size = adp->va_buffer_size/adp->va_info.vi_planes;
55148104Syokota	while (uio->uio_resid > 0) {
55248104Syokota		if (uio->uio_offset >= size)
55348104Syokota			break;
55448104Syokota		offset = uio->uio_offset%adp->va_window_size;
55548104Syokota		len = imin(uio->uio_resid, size - uio->uio_offset);
55648104Syokota		len = imin(len, adp->va_window_size - offset);
55748104Syokota		if (len <= 0)
55848104Syokota			break;
55948104Syokota		(*vidsw[adp->va_index]->set_win_org)(adp, uio->uio_offset);
56048104Syokota		error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
56148104Syokota		if (error)
56248104Syokota			break;
56348104Syokota	}
56448104Syokota	return error;
56548104Syokota}
56648104Syokota
56748104Syokotaint genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
56848104Syokota	       int flag)
56948104Syokota{
57048104Syokota	return ENODEV;
57148104Syokota}
57248104Syokota
57348104Syokotaint genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
57448104Syokota	       caddr_t arg, int flag, struct proc *p)
57548104Syokota{
57648104Syokota	int error;
57748104Syokota
57848104Syokota	if (adp == NULL)	/* XXX */
57948104Syokota		return ENXIO;
58048104Syokota	error = (*vidsw[adp->va_index]->ioctl)(adp, cmd, arg);
58148104Syokota	if (error == ENOIOCTL)
58248104Syokota		error = ENODEV;
58348104Syokota	return error;
58448104Syokota}
58548104Syokota
58648104Syokotaint genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_offset_t offset,
58748104Syokota	      int prot)
58848104Syokota{
58948104Syokota	return (*vidsw[adp->va_index]->mmap)(adp, offset, prot);
59048104Syokota}
59148104Syokota
59242421Syokota#endif /* FB_INSTALL_CDEV */
59342421Syokota
59442421Syokotastatic char
59542421Syokota*adapter_name(int type)
59642421Syokota{
59742421Syokota    static struct {
59842421Syokota	int type;
59942421Syokota	char *name;
60042421Syokota    } names[] = {
60142421Syokota	{ KD_MONO,	"MDA" },
60242421Syokota	{ KD_HERCULES,	"Hercules" },
60342421Syokota	{ KD_CGA,	"CGA" },
60442421Syokota	{ KD_EGA,	"EGA" },
60542421Syokota	{ KD_VGA,	"VGA" },
60642421Syokota	{ KD_PC98,	"PC-98x1" },
60748104Syokota	{ KD_TGA,	"TGA" },
60842421Syokota	{ -1,		"Unknown" },
60942421Syokota    };
61042421Syokota    int i;
61142421Syokota
61242421Syokota    for (i = 0; names[i].type != -1; ++i)
61342421Syokota	if (names[i].type == type)
61442421Syokota	    break;
61542421Syokota    return names[i].name;
61642421Syokota}
61742421Syokota
61848104Syokota/*
61948104Syokota * Generic low-level frame buffer functions
62048104Syokota * The low-level functions in the frame buffer subdriver may use these
62148104Syokota * functions.
62248104Syokota */
62348104Syokota
62442421Syokotavoid
62542421Syokotafb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
62642421Syokota{
62742421Syokota    if (level <= 0)
62842421Syokota	return;
62942421Syokota
63042421Syokota    printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
63148104Syokota	   FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
63242421Syokota	   adapter_name(adp->va_type), adp->va_type, adp->va_flags);
63342421Syokota    printf("%s%d: port:0x%x-0x%x, crtc:0x%x, mem:0x%x 0x%x\n",
63448104Syokota	   FB_DRIVER_NAME, adp->va_index,
63542421Syokota	   adp->va_io_base, adp->va_io_base + adp->va_io_size - 1,
63642421Syokota	   adp->va_crtc_addr, adp->va_mem_base, adp->va_mem_size);
63742421Syokota    printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
63848104Syokota	   FB_DRIVER_NAME, adp->va_index,
63942421Syokota	   adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
64048104Syokota    printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
64148104Syokota	   FB_DRIVER_NAME, adp->va_index,
64248104Syokota	   (void *)adp->va_window, (int)adp->va_window_size/1024,
64348104Syokota	   (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
64442831Syokota	   (int)adp->va_buffer_size/1024);
64542421Syokota}
64642421Syokota
64742421Syokotavoid
64842421Syokotafb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
64942421Syokota		  int level)
65042421Syokota{
65142421Syokota    if (level <= 0)
65242421Syokota	return;
65342421Syokota
65442421Syokota    printf("%s%d: %s, mode:%d, flags:0x%x ",
65542421Syokota	   driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
65642421Syokota    if (info->vi_flags & V_INFO_GRAPHICS)
65742421Syokota	printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
65842421Syokota	       info->vi_width, info->vi_height,
65942421Syokota	       info->vi_depth, info->vi_planes,
66042421Syokota	       info->vi_cwidth, info->vi_cheight);
66142421Syokota    else
66242421Syokota	printf("T %dx%d, font:%dx%d, ",
66342421Syokota	       info->vi_width, info->vi_height,
66442421Syokota	       info->vi_cwidth, info->vi_cheight);
66542421Syokota    printf("win:0x%x\n", info->vi_window);
66642421Syokota}
66748104Syokota
66848104Syokotaint
66948104Syokotafb_type(int adp_type)
67048104Syokota{
67148104Syokota	static struct {
67248104Syokota		int	fb_type;
67348104Syokota		int	va_type;
67448104Syokota	} types[] = {
67548104Syokota		{ FBTYPE_MDA,		KD_MONO },
67648104Syokota		{ FBTYPE_HERCULES,	KD_HERCULES },
67748104Syokota		{ FBTYPE_CGA,		KD_CGA },
67848104Syokota		{ FBTYPE_EGA,		KD_EGA },
67948104Syokota		{ FBTYPE_VGA,		KD_VGA },
68048104Syokota		{ FBTYPE_PC98,		KD_PC98 },
68148104Syokota		{ FBTYPE_TGA,		KD_TGA },
68248104Syokota	};
68348104Syokota	int i;
68448104Syokota
68548104Syokota	for (i = 0; i < sizeof(types)/sizeof(types[0]); ++i) {
68648104Syokota		if (types[i].va_type == adp_type)
68748104Syokota			return types[i].fb_type;
68848104Syokota	}
68948104Syokota	return -1;
69048104Syokota}
69148104Syokota
69248104Syokotaint
69348104Syokotafb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
69448104Syokota{
69548104Syokota	int error;
69648104Syokota	int s;
69748104Syokota
69848104Syokota	/* assert(adp != NULL) */
69948104Syokota
70048104Syokota	error = 0;
70148104Syokota	s = spltty();
70248104Syokota
70348104Syokota	switch (cmd) {
70448104Syokota
70548104Syokota	case FBIO_ADAPTER:	/* get video adapter index */
70648104Syokota		*(int *)arg = adp->va_index;
70748104Syokota		break;
70848104Syokota
70948104Syokota	case FBIO_ADPTYPE:	/* get video adapter type */
71048104Syokota		*(int *)arg = adp->va_type;
71148104Syokota		break;
71248104Syokota
71348104Syokota	case FBIO_ADPINFO:	/* get video adapter info */
71448104Syokota	        ((video_adapter_info_t *)arg)->va_index = adp->va_index;
71548104Syokota		((video_adapter_info_t *)arg)->va_type = adp->va_type;
71648104Syokota		bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
71748104Syokota		      imin(strlen(adp->va_name) + 1,
71848104Syokota			   sizeof(((video_adapter_info_t *)arg)->va_name)));
71948104Syokota		((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
72048104Syokota		((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
72148104Syokota		((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
72248104Syokota		((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
72348104Syokota		((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
72448104Syokota		((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
72548104Syokota		((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
72648104Syokota		((video_adapter_info_t *)arg)->va_window
72748104Syokota			= vtophys(adp->va_window);
72848104Syokota		((video_adapter_info_t *)arg)->va_window_size
72948104Syokota			= adp->va_window_size;
73048104Syokota		((video_adapter_info_t *)arg)->va_window_gran
73148104Syokota			= adp->va_window_gran;
73248104Syokota		((video_adapter_info_t *)arg)->va_window_orig
73348104Syokota			= adp->va_window_orig;
73448104Syokota		((video_adapter_info_t *)arg)->va_unused0
73548104Syokota			= (adp->va_buffer) ? vtophys(adp->va_buffer) : 0;
73648104Syokota		((video_adapter_info_t *)arg)->va_buffer_size
73748104Syokota			= adp->va_buffer_size;
73848104Syokota		((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
73948104Syokota		((video_adapter_info_t *)arg)->va_initial_mode
74048104Syokota			= adp->va_initial_mode;
74148104Syokota		((video_adapter_info_t *)arg)->va_initial_bios_mode
74248104Syokota			= adp->va_initial_bios_mode;
74348104Syokota		((video_adapter_info_t *)arg)->va_line_width
74448104Syokota			= adp->va_line_width;
74548104Syokota		((video_adapter_info_t *)arg)->va_disp_start.x
74648104Syokota			= adp->va_disp_start.x;
74748104Syokota		((video_adapter_info_t *)arg)->va_disp_start.y
74848104Syokota			= adp->va_disp_start.y;
74948104Syokota		break;
75048104Syokota
75148104Syokota	case FBIO_MODEINFO:	/* get mode information */
75248104Syokota		error = (*vidsw[adp->va_index]->get_info)(adp,
75348104Syokota				((video_info_t *)arg)->vi_mode,
75448104Syokota				(video_info_t *)arg);
75548104Syokota		if (error)
75648104Syokota			error = ENODEV;
75748104Syokota		break;
75848104Syokota
75948104Syokota	case FBIO_FINDMODE:	/* find a matching video mode */
76048104Syokota		error = (*vidsw[adp->va_index]->query_mode)(adp,
76148104Syokota				(video_info_t *)arg);
76248104Syokota		if (error < 0) {
76348104Syokota			error = EINVAL;
76448104Syokota		} else {
76548104Syokota			error = (*vidsw[adp->va_index]->get_info)(adp,
76648104Syokota					error, (video_info_t *)arg);
76748104Syokota			if (error)
76848104Syokota				error = ENODEV;	/* shouldn't happen */
76948104Syokota		}
77048104Syokota		break;
77148104Syokota
77248104Syokota	case FBIO_GETMODE:	/* get video mode */
77348104Syokota		*(int *)arg = adp->va_mode;
77448104Syokota		break;
77548104Syokota
77648104Syokota	case FBIO_SETMODE:	/* set video mode */
77748104Syokota		error = (*vidsw[adp->va_index]->set_mode)(adp, *(int *)arg);
77848104Syokota		if (error)
77948104Syokota			error = ENODEV;	/* EINVAL? */
78048104Syokota		break;
78148104Syokota
78248104Syokota	case FBIO_GETWINORG:	/* get frame buffer window origin */
78348104Syokota		*(u_int *)arg = adp->va_window_orig;
78448104Syokota		break;
78548104Syokota
78648104Syokota	case FBIO_GETDISPSTART:	/* get display start address */
78748104Syokota		((video_display_start_t *)arg)->x = adp->va_disp_start.x;
78848104Syokota		((video_display_start_t *)arg)->y = adp->va_disp_start.y;
78948104Syokota		break;
79048104Syokota
79148104Syokota	case FBIO_GETLINEWIDTH:	/* get scan line width in bytes */
79248104Syokota		*(u_int *)arg = adp->va_line_width;
79348104Syokota		break;
79448104Syokota
79548104Syokota	case FBIO_GETPALETTE:	/* get color palette */
79648104Syokota	case FBIO_SETPALETTE:	/* set color palette */
79748104Syokota		/* XXX */
79848104Syokota
79948104Syokota	case FBIOPUTCMAP:
80048104Syokota	case FBIOGETCMAP:
80148104Syokota		/* XXX */
80248104Syokota
80348104Syokota	case FBIO_SETWINORG:	/* set frame buffer window origin */
80448104Syokota	case FBIO_SETDISPSTART:	/* set display start address */
80548104Syokota	case FBIO_SETLINEWIDTH:	/* set scan line width in pixel */
80648104Syokota
80748104Syokota	case FBIOGTYPE:
80848104Syokota	case FBIOGATTR:
80948104Syokota	case FBIOSVIDEO:
81048104Syokota	case FBIOGVIDEO:
81148104Syokota	case FBIOSCURSOR:
81248104Syokota	case FBIOGCURSOR:
81348104Syokota	case FBIOSCURPOS:
81448104Syokota	case FBIOGCURPOS:
81548104Syokota	case FBIOGCURMAX:
81648104Syokota
81748104Syokota	default:
81848104Syokota		error = ENODEV;
81948104Syokota		break;
82048104Syokota	}
82148104Syokota
82248104Syokota	splx(s);
82348104Syokota	return error;
82448104Syokota}
825