fb.c revision 111815
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 111815 2003-03-03 12:15:54Z phk $
2942421Syokota */
3042421Syokota
3142421Syokota#include "opt_fb.h"
3242421Syokota
3342421Syokota#include <sys/param.h>
3442421Syokota#include <sys/systm.h>
3542421Syokota#include <sys/conf.h>
3648104Syokota#include <sys/bus.h>
3742421Syokota#include <sys/kernel.h>
3842421Syokota#include <sys/malloc.h>
3971862Speter#include <sys/module.h>
4048104Syokota#include <sys/uio.h>
4148104Syokota#include <sys/fbio.h>
4278161Speter#include <sys/linker_set.h>
4342421Syokota
4448104Syokota#include <vm/vm.h>
4548104Syokota#include <vm/pmap.h>
4642421Syokota
4742421Syokota#include <dev/fb/fbreg.h>
4842421Syokota
4978161SpeterSET_DECLARE(videodriver_set, const video_driver_t);
5078161Speter
5142421Syokota/* local arrays */
5242421Syokota
5342421Syokota/*
5442421Syokota * We need at least one entry each in order to initialize a video card
5542421Syokota * for the kernel console.  The arrays will be increased dynamically
5642421Syokota * when necessary.
5742421Syokota */
5842564Syokota
5948104Syokotastatic int		vid_malloc;
6042564Syokotastatic int		adapters = 1;
6142421Syokotastatic video_adapter_t	*adp_ini;
6242564Syokotastatic video_adapter_t	**adapter = &adp_ini;
6342421Syokotastatic video_switch_t	*vidsw_ini;
6442421Syokota       video_switch_t	**vidsw = &vidsw_ini;
6542421Syokota
6642564Syokota#ifdef FB_INSTALL_CDEV
6748104Syokotastatic struct cdevsw	*vidcdevsw_ini;
6848104Syokotastatic struct cdevsw	**vidcdevsw = &vidcdevsw_ini;
6948104Syokota#endif
7042564Syokota
7142421Syokota#define ARRAY_DELTA	4
7242421Syokota
7348104Syokotastatic int
7442421Syokotavid_realloc_array(void)
7542421Syokota{
7642421Syokota	video_adapter_t **new_adp;
7742421Syokota	video_switch_t **new_vidsw;
7848104Syokota#ifdef FB_INSTALL_CDEV
7942421Syokota	struct cdevsw **new_cdevsw;
8048104Syokota#endif
8142421Syokota	int newsize;
8242421Syokota	int s;
8342421Syokota
8448104Syokota	if (!vid_malloc)
8548104Syokota		return ENOMEM;
8648104Syokota
8742421Syokota	s = spltty();
8842421Syokota	newsize = ((adapters + ARRAY_DELTA)/ARRAY_DELTA)*ARRAY_DELTA;
89111119Simp	new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK | M_ZERO);
9069781Sdwmalone	new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF,
91111119Simp	    M_WAITOK | M_ZERO);
9248104Syokota#ifdef FB_INSTALL_CDEV
9369781Sdwmalone	new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF,
94111119Simp	    M_WAITOK | M_ZERO);
9548104Syokota#endif
9642421Syokota	bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
9742421Syokota	bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
9848104Syokota#ifdef FB_INSTALL_CDEV
9942421Syokota	bcopy(vidcdevsw, new_cdevsw, sizeof(*vidcdevsw)*adapters);
10048104Syokota#endif
10142421Syokota	if (adapters > 1) {
10242421Syokota		free(adapter, M_DEVBUF);
10342421Syokota		free(vidsw, M_DEVBUF);
10448104Syokota#ifdef FB_INSTALL_CDEV
10542421Syokota		free(vidcdevsw, M_DEVBUF);
10648104Syokota#endif
10742421Syokota	}
10842421Syokota	adapter = new_adp;
10942421Syokota	vidsw = new_vidsw;
11048104Syokota#ifdef FB_INSTALL_CDEV
11142421Syokota	vidcdevsw = new_cdevsw;
11248104Syokota#endif
11342421Syokota	adapters = newsize;
11442421Syokota	splx(s);
11542421Syokota
11642421Syokota	if (bootverbose)
11742421Syokota		printf("fb: new array size %d\n", adapters);
11848104Syokota
11948104Syokota	return 0;
12042421Syokota}
12142421Syokota
12248104Syokotastatic void
12348104Syokotavid_malloc_init(void *arg)
12448104Syokota{
12548104Syokota	vid_malloc = TRUE;
12648104Syokota}
12742564Syokota
12848104SyokotaSYSINIT(vid_mem, SI_SUB_KMEM, SI_ORDER_ANY, vid_malloc_init, NULL);
12948104Syokota
13042421Syokota/*
13142421Syokota * Low-level frame buffer driver functions
13242421Syokota * frame buffer subdrivers, such as the VGA driver, call these functions
13342421Syokota * to initialize the video_adapter structure and register it to the virtual
13442421Syokota * frame buffer driver `fb'.
13542421Syokota */
13642421Syokota
13742421Syokota/* initialize the video_adapter_t structure */
13842421Syokotavoid
13942421Syokotavid_init_struct(video_adapter_t *adp, char *name, int type, int unit)
14042421Syokota{
14142421Syokota	adp->va_flags = 0;
14242421Syokota	adp->va_name = name;
14342421Syokota	adp->va_type = type;
14442421Syokota	adp->va_unit = unit;
14542421Syokota}
14642421Syokota
14742421Syokota/* Register a video adapter */
14842421Syokotaint
14942421Syokotavid_register(video_adapter_t *adp)
15042421Syokota{
15148104Syokota	const video_driver_t **list;
15248104Syokota	const video_driver_t *p;
15342421Syokota	int index;
15442421Syokota
15542421Syokota	for (index = 0; index < adapters; ++index) {
15642421Syokota		if (adapter[index] == NULL)
15742421Syokota			break;
15842421Syokota	}
15948104Syokota	if (index >= adapters) {
16048104Syokota		if (vid_realloc_array())
16148104Syokota			return -1;
16248104Syokota	}
16342421Syokota
16442421Syokota	adp->va_index = index;
16542421Syokota	adp->va_token = NULL;
16678161Speter	SET_FOREACH(list, videodriver_set) {
16778161Speter		p = *list;
16842421Syokota		if (strcmp(p->name, adp->va_name) == 0) {
16942421Syokota			adapter[index] = adp;
17042421Syokota			vidsw[index] = p->vidsw;
17142421Syokota			return index;
17242421Syokota		}
17342421Syokota	}
17442421Syokota
17542421Syokota	return -1;
17642421Syokota}
17742421Syokota
17842421Syokotaint
17942421Syokotavid_unregister(video_adapter_t *adp)
18042421Syokota{
18142421Syokota	if ((adp->va_index < 0) || (adp->va_index >= adapters))
18242421Syokota		return ENOENT;
18342421Syokota	if (adapter[adp->va_index] != adp)
18442421Syokota		return ENOENT;
18542421Syokota
18642421Syokota	adapter[adp->va_index] = NULL;
18742421Syokota	vidsw[adp->va_index] = NULL;
18842421Syokota	return 0;
18942421Syokota}
19042421Syokota
19142421Syokota/* Get video I/O function table */
19242421Syokotavideo_switch_t
19342421Syokota*vid_get_switch(char *name)
19442421Syokota{
19548104Syokota	const video_driver_t **list;
19648104Syokota	const video_driver_t *p;
19742421Syokota
19878161Speter	SET_FOREACH(list, videodriver_set) {
19978161Speter		p = *list;
20042421Syokota		if (strcmp(p->name, name) == 0)
20142421Syokota			return p->vidsw;
20242421Syokota	}
20342421Syokota
20442421Syokota	return NULL;
20542421Syokota}
20642421Syokota
20742421Syokota/*
20842421Syokota * Video card client functions
20942421Syokota * Video card clients, such as the console driver `syscons' and the frame
21042421Syokota * buffer cdev driver, use these functions to claim and release a card for
21142421Syokota * exclusive use.
21242421Syokota */
21342421Syokota
21442421Syokota/* find the video card specified by a driver name and a unit number */
21542421Syokotaint
21642421Syokotavid_find_adapter(char *driver, int unit)
21742421Syokota{
21842421Syokota	int i;
21942421Syokota
22042421Syokota	for (i = 0; i < adapters; ++i) {
22142421Syokota		if (adapter[i] == NULL)
22242421Syokota			continue;
22342421Syokota		if (strcmp("*", driver) && strcmp(adapter[i]->va_name, driver))
22442421Syokota			continue;
22542421Syokota		if ((unit != -1) && (adapter[i]->va_unit != unit))
22642421Syokota			continue;
22742421Syokota		return i;
22842421Syokota	}
22942421Syokota	return -1;
23042421Syokota}
23142421Syokota
23242421Syokota/* allocate a video card */
23342421Syokotaint
23442421Syokotavid_allocate(char *driver, int unit, void *id)
23542421Syokota{
23642421Syokota	int index;
23742421Syokota	int s;
23842421Syokota
23942421Syokota	s = spltty();
24042421Syokota	index = vid_find_adapter(driver, unit);
24142421Syokota	if (index >= 0) {
24242421Syokota		if (adapter[index]->va_token) {
24342421Syokota			splx(s);
24442421Syokota			return -1;
24542421Syokota		}
24642421Syokota		adapter[index]->va_token = id;
24742421Syokota	}
24842421Syokota	splx(s);
24942421Syokota	return index;
25042421Syokota}
25142421Syokota
25242421Syokotaint
25342421Syokotavid_release(video_adapter_t *adp, void *id)
25442421Syokota{
25542421Syokota	int error;
25642421Syokota	int s;
25742421Syokota
25842421Syokota	s = spltty();
25942421Syokota	if (adp->va_token == NULL) {
26042421Syokota		error = EINVAL;
26142421Syokota	} else if (adp->va_token != id) {
26242421Syokota		error = EPERM;
26342421Syokota	} else {
26442421Syokota		adp->va_token = NULL;
26542421Syokota		error = 0;
26642421Syokota	}
26742421Syokota	splx(s);
26842421Syokota	return error;
26942421Syokota}
27042421Syokota
27142421Syokota/* Get a video adapter structure */
27242421Syokotavideo_adapter_t
27342421Syokota*vid_get_adapter(int index)
27442421Syokota{
27542421Syokota	if ((index < 0) || (index >= adapters))
27642421Syokota		return NULL;
27742421Syokota	return adapter[index];
27842421Syokota}
27942421Syokota
28042421Syokota/* Configure drivers: this is a backdoor for the console driver XXX */
28142421Syokotaint
28242421Syokotavid_configure(int flags)
28342421Syokota{
28448104Syokota	const video_driver_t **list;
28548104Syokota	const video_driver_t *p;
28642421Syokota
28778161Speter	SET_FOREACH(list, videodriver_set) {
28878161Speter		p = *list;
28942421Syokota		if (p->configure != NULL)
29042421Syokota			(*p->configure)(flags);
29142421Syokota	}
29242421Syokota
29342421Syokota	return 0;
29442421Syokota}
29542421Syokota
29642421Syokota/*
29742421Syokota * Virtual frame buffer cdev driver functions
29842421Syokota * The virtual frame buffer driver dispatches driver functions to
29942421Syokota * appropriate subdrivers.
30042421Syokota */
30142421Syokota
30248104Syokota#define FB_DRIVER_NAME	"fb"
30342421Syokota
30442421Syokota#ifdef FB_INSTALL_CDEV
30542421Syokota
30648104Syokota#if experimental
30748104Syokota
30848104Syokotastatic devclass_t	fb_devclass;
30948104Syokota
31048104Syokotastatic int		fbprobe(device_t dev);
31148104Syokotastatic int		fbattach(device_t dev);
31248104Syokota
31348104Syokotastatic device_method_t fb_methods[] = {
31448104Syokota	DEVMETHOD(device_probe,		fbprobe),
31548104Syokota	DEVMETHOD(device_attach,	fbattach),
31648104Syokota
31748104Syokota	DEVMETHOD(bus_print_child,	bus_generic_print_child),
31848104Syokota	{ 0, 0 }
31948104Syokota};
32048104Syokota
32148104Syokotastatic driver_t fb_driver = {
32248104Syokota	FB_DRIVER_NAME,
32348104Syokota	fb_methods,
32448104Syokota	0,
32548104Syokota};
32648104Syokota
32748104Syokotastatic int
32848104Syokotafbprobe(device_t dev)
32948104Syokota{
33048104Syokota	int unit;
33148104Syokota
33248104Syokota	unit = device_get_unit(dev);
33348104Syokota	if (unit >= adapters)
33448104Syokota		return ENXIO;
33548104Syokota	if (adapter[unit] == NULL)
33648104Syokota		return ENXIO;
33748104Syokota
33848104Syokota	device_set_desc(dev, "generic frame buffer");
33948104Syokota	return 0;
34048104Syokota}
34148104Syokota
34248104Syokotastatic int
34348104Syokotafbattach(device_t dev)
34448104Syokota{
34548104Syokota	printf("fbattach: about to attach children\n");
34648104Syokota	bus_generic_attach(dev);
34748104Syokota	return 0;
34848104Syokota}
34948104Syokota
35048104Syokota#endif /* experimental */
35148104Syokota
35242421Syokota#define FB_UNIT(dev)	minor(dev)
35342421Syokota#define FB_MKMINOR(unit) (u)
35442421Syokota
355111576Sphk#if experimental
35642421Syokotastatic d_open_t		fbopen;
35742421Syokotastatic d_close_t	fbclose;
35848104Syokotastatic d_read_t		fbread;
35948104Syokotastatic d_write_t	fbwrite;
36042421Syokotastatic d_ioctl_t	fbioctl;
36142421Syokotastatic d_mmap_t		fbmmap;
36242421Syokota
36348104Syokota#define CDEV_MAJOR	123	/* XXX */
36442421Syokota
36542421Syokotastatic struct cdevsw fb_cdevsw = {
366111815Sphk	.d_open =	fbopen,
367111815Sphk	.d_close =	fbclose,
368111815Sphk	.d_read =	fbread,
369111815Sphk	.d_write =	fbwrite,
370111815Sphk	.d_ioctl =	fbioctl,
371111815Sphk	.d_mmap =	fbmmap,
372111815Sphk	.d_name =	FB_DRIVER_NAME,
373111815Sphk	.d_maj =	CDEV_MAJOR,
37442421Syokota};
375111576Sphk#endif
37642421Syokota
37742421Syokota
37871862Speterstatic int
37971862Speterfb_modevent(module_t mod, int type, void *data)
38071862Speter{
38171862Speter
38271862Speter	switch (type) {
38371862Speter	case MOD_LOAD:
38471862Speter		break;
38571862Speter	case MOD_UNLOAD:
38671862Speter		printf("fb module unload - not possible for this module type\n");
38771862Speter		return EINVAL;
38871862Speter	}
38971862Speter	return 0;
39071862Speter}
39142421Syokota
39271862Speterstatic moduledata_t fb_mod = {
39371862Speter	"fb",
39471862Speter	fb_modevent,
39571862Speter	NULL
39671862Speter};
39742421Syokota
39871862SpeterDECLARE_MODULE(fb, fb_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
39971862Speter
40042421Syokotaint
40148104Syokotafb_attach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
40242421Syokota{
40342421Syokota	int s;
40442421Syokota
40542421Syokota	if (adp->va_index >= adapters)
40642421Syokota		return EINVAL;
40742421Syokota	if (adapter[adp->va_index] != adp)
40842421Syokota		return EINVAL;
40942421Syokota
41042421Syokota	s = spltty();
41142421Syokota	adp->va_minor = minor(dev);
41242421Syokota	vidcdevsw[adp->va_index] = cdevsw;
41342421Syokota	splx(s);
41442421Syokota
41542421Syokota	printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
41642421Syokota	return 0;
41742421Syokota}
41842421Syokota
41942421Syokotaint
42048104Syokotafb_detach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
42142421Syokota{
42242421Syokota	int s;
42342421Syokota
42442421Syokota	if (adp->va_index >= adapters)
42542421Syokota		return EINVAL;
42642421Syokota	if (adapter[adp->va_index] != adp)
42742421Syokota		return EINVAL;
42842421Syokota	if (vidcdevsw[adp->va_index] != cdevsw)
42942421Syokota		return EINVAL;
43042421Syokota
43142421Syokota	s = spltty();
43242421Syokota	vidcdevsw[adp->va_index] = NULL;
43342421Syokota	splx(s);
43442421Syokota	return 0;
43542421Syokota}
43642421Syokota
437111576Sphk#if experimental
43848104Syokotastatic int
43983366Sjulianfbopen(dev_t dev, int flag, int mode, struct thread *td)
44048104Syokota{
44148104Syokota	int unit;
44248104Syokota
44348104Syokota	unit = FB_UNIT(dev);
44448104Syokota	if (unit >= adapters)
44548104Syokota		return ENXIO;
44648104Syokota	if (vidcdevsw[unit] == NULL)
44748104Syokota		return ENXIO;
44848104Syokota	return (*vidcdevsw[unit]->d_open)(makedev(0, adapter[unit]->va_minor),
44983366Sjulian					  flag, mode, td);
45048104Syokota}
45148104Syokota
45248104Syokotastatic int
45383366Sjulianfbclose(dev_t dev, int flag, int mode, struct thread *td)
45448104Syokota{
45548104Syokota	int unit;
45648104Syokota
45748104Syokota	unit = FB_UNIT(dev);
45848104Syokota	if (vidcdevsw[unit] == NULL)
45948104Syokota		return ENXIO;
46048104Syokota	return (*vidcdevsw[unit]->d_close)(makedev(0, adapter[unit]->va_minor),
46183366Sjulian					   flag, mode, td);
46248104Syokota}
46348104Syokota
46448104Syokotastatic int
46548104Syokotafbread(dev_t dev, struct uio *uio, int flag)
46648104Syokota{
46748104Syokota	int unit;
46848104Syokota
46948104Syokota	unit = FB_UNIT(dev);
47048104Syokota	if (vidcdevsw[unit] == NULL)
47148104Syokota		return ENXIO;
47248104Syokota	return (*vidcdevsw[unit]->d_read)(makedev(0, adapter[unit]->va_minor),
47348104Syokota					  uio, flag);
47448104Syokota}
47548104Syokota
47648104Syokotastatic int
47748104Syokotafbwrite(dev_t dev, struct uio *uio, int flag)
47848104Syokota{
47948104Syokota	int unit;
48048104Syokota
48148104Syokota	unit = FB_UNIT(dev);
48248104Syokota	if (vidcdevsw[unit] == NULL)
48348104Syokota		return ENXIO;
48448104Syokota	return (*vidcdevsw[unit]->d_write)(makedev(0, adapter[unit]->va_minor),
48548104Syokota					   uio, flag);
48648104Syokota}
48748104Syokota
48848104Syokotastatic int
48983366Sjulianfbioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct thread *td)
49048104Syokota{
49148104Syokota	int unit;
49248104Syokota
49348104Syokota	unit = FB_UNIT(dev);
49448104Syokota	if (vidcdevsw[unit] == NULL)
49548104Syokota		return ENXIO;
49648104Syokota	return (*vidcdevsw[unit]->d_ioctl)(makedev(0, adapter[unit]->va_minor),
49783366Sjulian					   cmd, arg, flag, td);
49848104Syokota}
49948104Syokota
50048104Syokotastatic int
501111462Smuxfbmmap(dev_t dev, vm_offset_t offset, vm_offset_t *paddr, int nprot)
50248104Syokota{
50348104Syokota	int unit;
50448104Syokota
50548104Syokota	unit = FB_UNIT(dev);
50648104Syokota	if (vidcdevsw[unit] == NULL)
50748104Syokota		return ENXIO;
50848104Syokota	return (*vidcdevsw[unit]->d_mmap)(makedev(0, adapter[unit]->va_minor),
509111462Smux					  offset, paddr, nprot);
51048104Syokota}
51148104Syokota
51248557SphkDEV_DRIVER_MODULE(fb, ???, fb_driver, fb_devclass, fb_cdevsw, 0, 0);
51348104Syokota#endif
51448104Syokota
51548104Syokota/*
51648104Syokota * Generic frame buffer cdev driver functions
51748104Syokota * Frame buffer subdrivers may call these functions to implement common
51848104Syokota * driver functions.
51948104Syokota */
52048104Syokota
52148104Syokotaint genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
52283366Sjulian	      struct thread *td)
52348104Syokota{
52448104Syokota	int s;
52548104Syokota
52648104Syokota	s = spltty();
52748104Syokota	if (!(sc->gfb_flags & FB_OPEN))
52848104Syokota		sc->gfb_flags |= FB_OPEN;
52948104Syokota	splx(s);
53048104Syokota	return 0;
53148104Syokota}
53248104Syokota
53348104Syokotaint genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
53483366Sjulian	       struct thread *td)
53548104Syokota{
53648104Syokota	int s;
53748104Syokota
53848104Syokota	s = spltty();
53948104Syokota	sc->gfb_flags &= ~FB_OPEN;
54048104Syokota	splx(s);
54148104Syokota	return 0;
54248104Syokota}
54348104Syokota
54448104Syokotaint genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
54548104Syokota	      int flag)
54648104Syokota{
54748104Syokota	int size;
54848104Syokota	int offset;
54948104Syokota	int error;
55048104Syokota	int len;
55148104Syokota
55248104Syokota	error = 0;
55348104Syokota	size = adp->va_buffer_size/adp->va_info.vi_planes;
55448104Syokota	while (uio->uio_resid > 0) {
55548104Syokota		if (uio->uio_offset >= size)
55648104Syokota			break;
55748104Syokota		offset = uio->uio_offset%adp->va_window_size;
55848104Syokota		len = imin(uio->uio_resid, size - uio->uio_offset);
55948104Syokota		len = imin(len, adp->va_window_size - offset);
56048104Syokota		if (len <= 0)
56148104Syokota			break;
56248104Syokota		(*vidsw[adp->va_index]->set_win_org)(adp, uio->uio_offset);
56348104Syokota		error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
56448104Syokota		if (error)
56548104Syokota			break;
56648104Syokota	}
56748104Syokota	return error;
56848104Syokota}
56948104Syokota
57048104Syokotaint genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
57148104Syokota	       int flag)
57248104Syokota{
57348104Syokota	return ENODEV;
57448104Syokota}
57548104Syokota
57648104Syokotaint genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
57783366Sjulian	       caddr_t arg, int flag, struct thread *td)
57848104Syokota{
57948104Syokota	int error;
58048104Syokota
58148104Syokota	if (adp == NULL)	/* XXX */
58248104Syokota		return ENXIO;
58348104Syokota	error = (*vidsw[adp->va_index]->ioctl)(adp, cmd, arg);
58448104Syokota	if (error == ENOIOCTL)
58548104Syokota		error = ENODEV;
58648104Syokota	return error;
58748104Syokota}
58848104Syokota
58948104Syokotaint genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_offset_t offset,
590111462Smux	      vm_offset_t *paddr, int prot)
59148104Syokota{
592111462Smux	return (*vidsw[adp->va_index]->mmap)(adp, offset, paddr, prot);
59348104Syokota}
59448104Syokota
59542421Syokota#endif /* FB_INSTALL_CDEV */
59642421Syokota
59742421Syokotastatic char
59842421Syokota*adapter_name(int type)
59942421Syokota{
60042421Syokota    static struct {
60142421Syokota	int type;
60242421Syokota	char *name;
60342421Syokota    } names[] = {
60442421Syokota	{ KD_MONO,	"MDA" },
60542421Syokota	{ KD_HERCULES,	"Hercules" },
60642421Syokota	{ KD_CGA,	"CGA" },
60742421Syokota	{ KD_EGA,	"EGA" },
60842421Syokota	{ KD_VGA,	"VGA" },
60942421Syokota	{ KD_PC98,	"PC-98x1" },
61048104Syokota	{ KD_TGA,	"TGA" },
61142421Syokota	{ -1,		"Unknown" },
61242421Syokota    };
61342421Syokota    int i;
61442421Syokota
61542421Syokota    for (i = 0; names[i].type != -1; ++i)
61642421Syokota	if (names[i].type == type)
61742421Syokota	    break;
61842421Syokota    return names[i].name;
61942421Syokota}
62042421Syokota
62148104Syokota/*
62248104Syokota * Generic low-level frame buffer functions
62348104Syokota * The low-level functions in the frame buffer subdriver may use these
62448104Syokota * functions.
62548104Syokota */
62648104Syokota
62742421Syokotavoid
62842421Syokotafb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
62942421Syokota{
63042421Syokota    if (level <= 0)
63142421Syokota	return;
63242421Syokota
63342421Syokota    printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
63448104Syokota	   FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
63542421Syokota	   adapter_name(adp->va_type), adp->va_type, adp->va_flags);
63694617Sobrien    printf("%s%d: port:0x%lx-0x%lx, crtc:0x%lx, mem:0x%lx 0x%x\n",
63794617Sobrien	   FB_DRIVER_NAME, adp->va_index, (u_long)adp->va_io_base,
63894617Sobrien	   (u_long)adp->va_io_base + adp->va_io_size - 1,
63994617Sobrien	   (u_long)adp->va_crtc_addr, (u_long)adp->va_mem_base,
64094617Sobrien	   adp->va_mem_size);
64142421Syokota    printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
64248104Syokota	   FB_DRIVER_NAME, adp->va_index,
64342421Syokota	   adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
64448104Syokota    printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
64548104Syokota	   FB_DRIVER_NAME, adp->va_index,
64648104Syokota	   (void *)adp->va_window, (int)adp->va_window_size/1024,
64748104Syokota	   (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
64842831Syokota	   (int)adp->va_buffer_size/1024);
64942421Syokota}
65042421Syokota
65142421Syokotavoid
65242421Syokotafb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
65342421Syokota		  int level)
65442421Syokota{
65542421Syokota    if (level <= 0)
65642421Syokota	return;
65742421Syokota
65842421Syokota    printf("%s%d: %s, mode:%d, flags:0x%x ",
65942421Syokota	   driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
66042421Syokota    if (info->vi_flags & V_INFO_GRAPHICS)
66142421Syokota	printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
66242421Syokota	       info->vi_width, info->vi_height,
66342421Syokota	       info->vi_depth, info->vi_planes,
66442421Syokota	       info->vi_cwidth, info->vi_cheight);
66542421Syokota    else
66642421Syokota	printf("T %dx%d, font:%dx%d, ",
66742421Syokota	       info->vi_width, info->vi_height,
66842421Syokota	       info->vi_cwidth, info->vi_cheight);
66994617Sobrien    printf("win:0x%lx\n", (u_long)info->vi_window);
67042421Syokota}
67148104Syokota
67248104Syokotaint
67348104Syokotafb_type(int adp_type)
67448104Syokota{
67548104Syokota	static struct {
67648104Syokota		int	fb_type;
67748104Syokota		int	va_type;
67848104Syokota	} types[] = {
67948104Syokota		{ FBTYPE_MDA,		KD_MONO },
68048104Syokota		{ FBTYPE_HERCULES,	KD_HERCULES },
68148104Syokota		{ FBTYPE_CGA,		KD_CGA },
68248104Syokota		{ FBTYPE_EGA,		KD_EGA },
68348104Syokota		{ FBTYPE_VGA,		KD_VGA },
68448104Syokota		{ FBTYPE_PC98,		KD_PC98 },
68548104Syokota		{ FBTYPE_TGA,		KD_TGA },
68648104Syokota	};
68748104Syokota	int i;
68848104Syokota
68948104Syokota	for (i = 0; i < sizeof(types)/sizeof(types[0]); ++i) {
69048104Syokota		if (types[i].va_type == adp_type)
69148104Syokota			return types[i].fb_type;
69248104Syokota	}
69348104Syokota	return -1;
69448104Syokota}
69548104Syokota
69648104Syokotaint
69748104Syokotafb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
69848104Syokota{
69948104Syokota	int error;
70048104Syokota	int s;
70148104Syokota
70248104Syokota	/* assert(adp != NULL) */
70348104Syokota
70448104Syokota	error = 0;
70548104Syokota	s = spltty();
70648104Syokota
70748104Syokota	switch (cmd) {
70848104Syokota
70948104Syokota	case FBIO_ADAPTER:	/* get video adapter index */
71048104Syokota		*(int *)arg = adp->va_index;
71148104Syokota		break;
71248104Syokota
71348104Syokota	case FBIO_ADPTYPE:	/* get video adapter type */
71448104Syokota		*(int *)arg = adp->va_type;
71548104Syokota		break;
71648104Syokota
71748104Syokota	case FBIO_ADPINFO:	/* get video adapter info */
71848104Syokota	        ((video_adapter_info_t *)arg)->va_index = adp->va_index;
71948104Syokota		((video_adapter_info_t *)arg)->va_type = adp->va_type;
72048104Syokota		bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
72148104Syokota		      imin(strlen(adp->va_name) + 1,
72248104Syokota			   sizeof(((video_adapter_info_t *)arg)->va_name)));
72348104Syokota		((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
72448104Syokota		((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
72548104Syokota		((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
72648104Syokota		((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
72748104Syokota		((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
72848104Syokota		((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
72948104Syokota		((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
73048104Syokota		((video_adapter_info_t *)arg)->va_window
73160742Sgallatin#ifdef __i386__
73248104Syokota			= vtophys(adp->va_window);
73360742Sgallatin#else
73460742Sgallatin			= adp->va_window;
73560742Sgallatin#endif
73648104Syokota		((video_adapter_info_t *)arg)->va_window_size
73748104Syokota			= adp->va_window_size;
73848104Syokota		((video_adapter_info_t *)arg)->va_window_gran
73948104Syokota			= adp->va_window_gran;
74048104Syokota		((video_adapter_info_t *)arg)->va_window_orig
74148104Syokota			= adp->va_window_orig;
74248104Syokota		((video_adapter_info_t *)arg)->va_unused0
74360742Sgallatin#ifdef __i386__
74448104Syokota			= (adp->va_buffer) ? vtophys(adp->va_buffer) : 0;
74560742Sgallatin#else
74660742Sgallatin			= adp->va_buffer;
74760742Sgallatin#endif
74848104Syokota		((video_adapter_info_t *)arg)->va_buffer_size
74948104Syokota			= adp->va_buffer_size;
75048104Syokota		((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
75148104Syokota		((video_adapter_info_t *)arg)->va_initial_mode
75248104Syokota			= adp->va_initial_mode;
75348104Syokota		((video_adapter_info_t *)arg)->va_initial_bios_mode
75448104Syokota			= adp->va_initial_bios_mode;
75548104Syokota		((video_adapter_info_t *)arg)->va_line_width
75648104Syokota			= adp->va_line_width;
75748104Syokota		((video_adapter_info_t *)arg)->va_disp_start.x
75848104Syokota			= adp->va_disp_start.x;
75948104Syokota		((video_adapter_info_t *)arg)->va_disp_start.y
76048104Syokota			= adp->va_disp_start.y;
76148104Syokota		break;
76248104Syokota
76348104Syokota	case FBIO_MODEINFO:	/* get mode information */
76448104Syokota		error = (*vidsw[adp->va_index]->get_info)(adp,
76548104Syokota				((video_info_t *)arg)->vi_mode,
76648104Syokota				(video_info_t *)arg);
76748104Syokota		if (error)
76848104Syokota			error = ENODEV;
76948104Syokota		break;
77048104Syokota
77148104Syokota	case FBIO_FINDMODE:	/* find a matching video mode */
77248104Syokota		error = (*vidsw[adp->va_index]->query_mode)(adp,
77348104Syokota				(video_info_t *)arg);
77448104Syokota		break;
77548104Syokota
77648104Syokota	case FBIO_GETMODE:	/* get video mode */
77748104Syokota		*(int *)arg = adp->va_mode;
77848104Syokota		break;
77948104Syokota
78048104Syokota	case FBIO_SETMODE:	/* set video mode */
78148104Syokota		error = (*vidsw[adp->va_index]->set_mode)(adp, *(int *)arg);
78248104Syokota		if (error)
78348104Syokota			error = ENODEV;	/* EINVAL? */
78448104Syokota		break;
78548104Syokota
78648104Syokota	case FBIO_GETWINORG:	/* get frame buffer window origin */
78748104Syokota		*(u_int *)arg = adp->va_window_orig;
78848104Syokota		break;
78948104Syokota
79048104Syokota	case FBIO_GETDISPSTART:	/* get display start address */
79148104Syokota		((video_display_start_t *)arg)->x = adp->va_disp_start.x;
79248104Syokota		((video_display_start_t *)arg)->y = adp->va_disp_start.y;
79348104Syokota		break;
79448104Syokota
79548104Syokota	case FBIO_GETLINEWIDTH:	/* get scan line width in bytes */
79648104Syokota		*(u_int *)arg = adp->va_line_width;
79748104Syokota		break;
79848104Syokota
79981039Syokota	case FBIO_BLANK:	/* blank display */
80081039Syokota		error = (*vidsw[adp->va_index]->blank_display)(adp, *(int *)arg);
80181039Syokota		break;
80281039Syokota
80348104Syokota	case FBIO_GETPALETTE:	/* get color palette */
80448104Syokota	case FBIO_SETPALETTE:	/* set color palette */
80548104Syokota		/* XXX */
80648104Syokota
80748104Syokota	case FBIOPUTCMAP:
80848104Syokota	case FBIOGETCMAP:
80981039Syokota	case FBIOPUTCMAPI:
81081039Syokota	case FBIOGETCMAPI:
81148104Syokota		/* XXX */
81248104Syokota
81348104Syokota	case FBIO_SETWINORG:	/* set frame buffer window origin */
81448104Syokota	case FBIO_SETDISPSTART:	/* set display start address */
81548104Syokota	case FBIO_SETLINEWIDTH:	/* set scan line width in pixel */
81648104Syokota
81748104Syokota	case FBIOGTYPE:
81848104Syokota	case FBIOGATTR:
81948104Syokota	case FBIOSVIDEO:
82048104Syokota	case FBIOGVIDEO:
82181039Syokota	case FBIOVERTICAL:
82248104Syokota	case FBIOSCURSOR:
82348104Syokota	case FBIOGCURSOR:
82448104Syokota	case FBIOSCURPOS:
82548104Syokota	case FBIOGCURPOS:
82648104Syokota	case FBIOGCURMAX:
82781039Syokota	case FBIOMONINFO:
82881039Syokota	case FBIOGXINFO:
82948104Syokota
83048104Syokota	default:
83148104Syokota		error = ENODEV;
83248104Syokota		break;
83348104Syokota	}
83448104Syokota
83548104Syokota	splx(s);
83648104Syokota	return error;
83748104Syokota}
838