fb.c revision 81039
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 81039 2001-08-02 11:26:30Z yokota $
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;
8969781Sdwmalone	new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK | M_ZERO);
9069781Sdwmalone	new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF,
9169781Sdwmalone	    M_WAITOK | M_ZERO);
9248104Syokota#ifdef FB_INSTALL_CDEV
9369781Sdwmalone	new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF,
9469781Sdwmalone	    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
35542421Syokotastatic d_open_t		fbopen;
35642421Syokotastatic d_close_t	fbclose;
35748104Syokotastatic d_read_t		fbread;
35848104Syokotastatic d_write_t	fbwrite;
35942421Syokotastatic d_ioctl_t	fbioctl;
36042421Syokotastatic d_mmap_t		fbmmap;
36142421Syokota
36248104Syokota#define CDEV_MAJOR	123	/* XXX */
36342421Syokota
36442421Syokotastatic struct cdevsw fb_cdevsw = {
36547625Sphk	/* open */	fbopen,
36647625Sphk	/* close */	fbclose,
36748104Syokota	/* read */	fbread,
36848104Syokota	/* write */	fbwrite,
36947625Sphk	/* ioctl */	fbioctl,
37047625Sphk	/* poll */	nopoll,
37147625Sphk	/* mmap */	fbmmap,
37247625Sphk	/* strategy */	nostrategy,
37348104Syokota	/* name */	FB_DRIVER_NAME,
37447625Sphk	/* maj */	CDEV_MAJOR,
37547625Sphk	/* dump */	nodump,
37647625Sphk	/* psize */	nopsize,
37747625Sphk	/* flags */	0,
37842421Syokota};
37942421Syokota
38042421Syokota
38171862Speterstatic int
38271862Speterfb_modevent(module_t mod, int type, void *data)
38371862Speter{
38471862Speter
38571862Speter	switch (type) {
38671862Speter	case MOD_LOAD:
38747640Sphk		cdevsw_add(&fb_cdevsw);
38871862Speter		break;
38971862Speter	case MOD_UNLOAD:
39071862Speter		printf("fb module unload - not possible for this module type\n");
39171862Speter		return EINVAL;
39271862Speter	}
39371862Speter	return 0;
39471862Speter}
39542421Syokota
39671862Speterstatic moduledata_t fb_mod = {
39771862Speter	"fb",
39871862Speter	fb_modevent,
39971862Speter	NULL
40071862Speter};
40142421Syokota
40271862SpeterDECLARE_MODULE(fb, fb_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
40371862Speter
40442421Syokotaint
40548104Syokotafb_attach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
40642421Syokota{
40742421Syokota	int s;
40842421Syokota
40942421Syokota	if (adp->va_index >= adapters)
41042421Syokota		return EINVAL;
41142421Syokota	if (adapter[adp->va_index] != adp)
41242421Syokota		return EINVAL;
41342421Syokota
41442421Syokota	s = spltty();
41542421Syokota	adp->va_minor = minor(dev);
41642421Syokota	vidcdevsw[adp->va_index] = cdevsw;
41742421Syokota	splx(s);
41842421Syokota
41942421Syokota	printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
42042421Syokota	return 0;
42142421Syokota}
42242421Syokota
42342421Syokotaint
42448104Syokotafb_detach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
42542421Syokota{
42642421Syokota	int s;
42742421Syokota
42842421Syokota	if (adp->va_index >= adapters)
42942421Syokota		return EINVAL;
43042421Syokota	if (adapter[adp->va_index] != adp)
43142421Syokota		return EINVAL;
43242421Syokota	if (vidcdevsw[adp->va_index] != cdevsw)
43342421Syokota		return EINVAL;
43442421Syokota
43542421Syokota	s = spltty();
43642421Syokota	vidcdevsw[adp->va_index] = NULL;
43742421Syokota	splx(s);
43842421Syokota	return 0;
43942421Syokota}
44042421Syokota
44148104Syokotastatic int
44248104Syokotafbopen(dev_t dev, int flag, int mode, struct proc *p)
44348104Syokota{
44448104Syokota	int unit;
44548104Syokota
44648104Syokota	unit = FB_UNIT(dev);
44748104Syokota	if (unit >= adapters)
44848104Syokota		return ENXIO;
44948104Syokota	if (vidcdevsw[unit] == NULL)
45048104Syokota		return ENXIO;
45148104Syokota	return (*vidcdevsw[unit]->d_open)(makedev(0, adapter[unit]->va_minor),
45248104Syokota					  flag, mode, p);
45348104Syokota}
45448104Syokota
45548104Syokotastatic int
45648104Syokotafbclose(dev_t dev, int flag, int mode, struct proc *p)
45748104Syokota{
45848104Syokota	int unit;
45948104Syokota
46048104Syokota	unit = FB_UNIT(dev);
46148104Syokota	if (vidcdevsw[unit] == NULL)
46248104Syokota		return ENXIO;
46348104Syokota	return (*vidcdevsw[unit]->d_close)(makedev(0, adapter[unit]->va_minor),
46448104Syokota					   flag, mode, p);
46548104Syokota}
46648104Syokota
46748104Syokotastatic int
46848104Syokotafbread(dev_t dev, struct uio *uio, int flag)
46948104Syokota{
47048104Syokota	int unit;
47148104Syokota
47248104Syokota	unit = FB_UNIT(dev);
47348104Syokota	if (vidcdevsw[unit] == NULL)
47448104Syokota		return ENXIO;
47548104Syokota	return (*vidcdevsw[unit]->d_read)(makedev(0, adapter[unit]->va_minor),
47648104Syokota					  uio, flag);
47748104Syokota}
47848104Syokota
47948104Syokotastatic int
48048104Syokotafbwrite(dev_t dev, struct uio *uio, int flag)
48148104Syokota{
48248104Syokota	int unit;
48348104Syokota
48448104Syokota	unit = FB_UNIT(dev);
48548104Syokota	if (vidcdevsw[unit] == NULL)
48648104Syokota		return ENXIO;
48748104Syokota	return (*vidcdevsw[unit]->d_write)(makedev(0, adapter[unit]->va_minor),
48848104Syokota					   uio, flag);
48948104Syokota}
49048104Syokota
49148104Syokotastatic int
49248104Syokotafbioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct proc *p)
49348104Syokota{
49448104Syokota	int unit;
49548104Syokota
49648104Syokota	unit = FB_UNIT(dev);
49748104Syokota	if (vidcdevsw[unit] == NULL)
49848104Syokota		return ENXIO;
49948104Syokota	return (*vidcdevsw[unit]->d_ioctl)(makedev(0, adapter[unit]->va_minor),
50048104Syokota					   cmd, arg, flag, p);
50148104Syokota}
50248104Syokota
50348104Syokotastatic int
50448104Syokotafbmmap(dev_t dev, vm_offset_t offset, int nprot)
50548104Syokota{
50648104Syokota	int unit;
50748104Syokota
50848104Syokota	unit = FB_UNIT(dev);
50948104Syokota	if (vidcdevsw[unit] == NULL)
51048104Syokota		return ENXIO;
51148104Syokota	return (*vidcdevsw[unit]->d_mmap)(makedev(0, adapter[unit]->va_minor),
51248104Syokota					  offset, nprot);
51348104Syokota}
51448104Syokota
51548104Syokota#if experimental
51648557SphkDEV_DRIVER_MODULE(fb, ???, fb_driver, fb_devclass, fb_cdevsw, 0, 0);
51748104Syokota#endif
51848104Syokota
51948104Syokota/*
52048104Syokota * Generic frame buffer cdev driver functions
52148104Syokota * Frame buffer subdrivers may call these functions to implement common
52248104Syokota * driver functions.
52348104Syokota */
52448104Syokota
52548104Syokotaint genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
52648104Syokota	      struct proc *p)
52748104Syokota{
52848104Syokota	int s;
52948104Syokota
53048104Syokota	s = spltty();
53148104Syokota	if (!(sc->gfb_flags & FB_OPEN))
53248104Syokota		sc->gfb_flags |= FB_OPEN;
53348104Syokota	splx(s);
53448104Syokota	return 0;
53548104Syokota}
53648104Syokota
53748104Syokotaint genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
53848104Syokota	       struct proc *p)
53948104Syokota{
54048104Syokota	int s;
54148104Syokota
54248104Syokota	s = spltty();
54348104Syokota	sc->gfb_flags &= ~FB_OPEN;
54448104Syokota	splx(s);
54548104Syokota	return 0;
54648104Syokota}
54748104Syokota
54848104Syokotaint genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
54948104Syokota	      int flag)
55048104Syokota{
55148104Syokota	int size;
55248104Syokota	int offset;
55348104Syokota	int error;
55448104Syokota	int len;
55548104Syokota
55648104Syokota	error = 0;
55748104Syokota	size = adp->va_buffer_size/adp->va_info.vi_planes;
55848104Syokota	while (uio->uio_resid > 0) {
55948104Syokota		if (uio->uio_offset >= size)
56048104Syokota			break;
56148104Syokota		offset = uio->uio_offset%adp->va_window_size;
56248104Syokota		len = imin(uio->uio_resid, size - uio->uio_offset);
56348104Syokota		len = imin(len, adp->va_window_size - offset);
56448104Syokota		if (len <= 0)
56548104Syokota			break;
56648104Syokota		(*vidsw[adp->va_index]->set_win_org)(adp, uio->uio_offset);
56748104Syokota		error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
56848104Syokota		if (error)
56948104Syokota			break;
57048104Syokota	}
57148104Syokota	return error;
57248104Syokota}
57348104Syokota
57448104Syokotaint genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
57548104Syokota	       int flag)
57648104Syokota{
57748104Syokota	return ENODEV;
57848104Syokota}
57948104Syokota
58048104Syokotaint genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
58148104Syokota	       caddr_t arg, int flag, struct proc *p)
58248104Syokota{
58348104Syokota	int error;
58448104Syokota
58548104Syokota	if (adp == NULL)	/* XXX */
58648104Syokota		return ENXIO;
58748104Syokota	error = (*vidsw[adp->va_index]->ioctl)(adp, cmd, arg);
58848104Syokota	if (error == ENOIOCTL)
58948104Syokota		error = ENODEV;
59048104Syokota	return error;
59148104Syokota}
59248104Syokota
59348104Syokotaint genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_offset_t offset,
59448104Syokota	      int prot)
59548104Syokota{
59648104Syokota	return (*vidsw[adp->va_index]->mmap)(adp, offset, prot);
59748104Syokota}
59848104Syokota
59942421Syokota#endif /* FB_INSTALL_CDEV */
60042421Syokota
60142421Syokotastatic char
60242421Syokota*adapter_name(int type)
60342421Syokota{
60442421Syokota    static struct {
60542421Syokota	int type;
60642421Syokota	char *name;
60742421Syokota    } names[] = {
60842421Syokota	{ KD_MONO,	"MDA" },
60942421Syokota	{ KD_HERCULES,	"Hercules" },
61042421Syokota	{ KD_CGA,	"CGA" },
61142421Syokota	{ KD_EGA,	"EGA" },
61242421Syokota	{ KD_VGA,	"VGA" },
61342421Syokota	{ KD_PC98,	"PC-98x1" },
61448104Syokota	{ KD_TGA,	"TGA" },
61542421Syokota	{ -1,		"Unknown" },
61642421Syokota    };
61742421Syokota    int i;
61842421Syokota
61942421Syokota    for (i = 0; names[i].type != -1; ++i)
62042421Syokota	if (names[i].type == type)
62142421Syokota	    break;
62242421Syokota    return names[i].name;
62342421Syokota}
62442421Syokota
62548104Syokota/*
62648104Syokota * Generic low-level frame buffer functions
62748104Syokota * The low-level functions in the frame buffer subdriver may use these
62848104Syokota * functions.
62948104Syokota */
63048104Syokota
63142421Syokotavoid
63242421Syokotafb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
63342421Syokota{
63442421Syokota    if (level <= 0)
63542421Syokota	return;
63642421Syokota
63742421Syokota    printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
63848104Syokota	   FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
63942421Syokota	   adapter_name(adp->va_type), adp->va_type, adp->va_flags);
64042421Syokota    printf("%s%d: port:0x%x-0x%x, crtc:0x%x, mem:0x%x 0x%x\n",
64148104Syokota	   FB_DRIVER_NAME, adp->va_index,
64242421Syokota	   adp->va_io_base, adp->va_io_base + adp->va_io_size - 1,
64342421Syokota	   adp->va_crtc_addr, adp->va_mem_base, adp->va_mem_size);
64442421Syokota    printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
64548104Syokota	   FB_DRIVER_NAME, adp->va_index,
64642421Syokota	   adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
64748104Syokota    printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
64848104Syokota	   FB_DRIVER_NAME, adp->va_index,
64948104Syokota	   (void *)adp->va_window, (int)adp->va_window_size/1024,
65048104Syokota	   (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
65142831Syokota	   (int)adp->va_buffer_size/1024);
65242421Syokota}
65342421Syokota
65442421Syokotavoid
65542421Syokotafb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
65642421Syokota		  int level)
65742421Syokota{
65842421Syokota    if (level <= 0)
65942421Syokota	return;
66042421Syokota
66142421Syokota    printf("%s%d: %s, mode:%d, flags:0x%x ",
66242421Syokota	   driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
66342421Syokota    if (info->vi_flags & V_INFO_GRAPHICS)
66442421Syokota	printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
66542421Syokota	       info->vi_width, info->vi_height,
66642421Syokota	       info->vi_depth, info->vi_planes,
66742421Syokota	       info->vi_cwidth, info->vi_cheight);
66842421Syokota    else
66942421Syokota	printf("T %dx%d, font:%dx%d, ",
67042421Syokota	       info->vi_width, info->vi_height,
67142421Syokota	       info->vi_cwidth, info->vi_cheight);
67242421Syokota    printf("win:0x%x\n", info->vi_window);
67342421Syokota}
67448104Syokota
67548104Syokotaint
67648104Syokotafb_type(int adp_type)
67748104Syokota{
67848104Syokota	static struct {
67948104Syokota		int	fb_type;
68048104Syokota		int	va_type;
68148104Syokota	} types[] = {
68248104Syokota		{ FBTYPE_MDA,		KD_MONO },
68348104Syokota		{ FBTYPE_HERCULES,	KD_HERCULES },
68448104Syokota		{ FBTYPE_CGA,		KD_CGA },
68548104Syokota		{ FBTYPE_EGA,		KD_EGA },
68648104Syokota		{ FBTYPE_VGA,		KD_VGA },
68748104Syokota		{ FBTYPE_PC98,		KD_PC98 },
68848104Syokota		{ FBTYPE_TGA,		KD_TGA },
68948104Syokota	};
69048104Syokota	int i;
69148104Syokota
69248104Syokota	for (i = 0; i < sizeof(types)/sizeof(types[0]); ++i) {
69348104Syokota		if (types[i].va_type == adp_type)
69448104Syokota			return types[i].fb_type;
69548104Syokota	}
69648104Syokota	return -1;
69748104Syokota}
69848104Syokota
69948104Syokotaint
70048104Syokotafb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
70148104Syokota{
70248104Syokota	int error;
70348104Syokota	int s;
70448104Syokota
70548104Syokota	/* assert(adp != NULL) */
70648104Syokota
70748104Syokota	error = 0;
70848104Syokota	s = spltty();
70948104Syokota
71048104Syokota	switch (cmd) {
71148104Syokota
71248104Syokota	case FBIO_ADAPTER:	/* get video adapter index */
71348104Syokota		*(int *)arg = adp->va_index;
71448104Syokota		break;
71548104Syokota
71648104Syokota	case FBIO_ADPTYPE:	/* get video adapter type */
71748104Syokota		*(int *)arg = adp->va_type;
71848104Syokota		break;
71948104Syokota
72048104Syokota	case FBIO_ADPINFO:	/* get video adapter info */
72148104Syokota	        ((video_adapter_info_t *)arg)->va_index = adp->va_index;
72248104Syokota		((video_adapter_info_t *)arg)->va_type = adp->va_type;
72348104Syokota		bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
72448104Syokota		      imin(strlen(adp->va_name) + 1,
72548104Syokota			   sizeof(((video_adapter_info_t *)arg)->va_name)));
72648104Syokota		((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
72748104Syokota		((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
72848104Syokota		((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
72948104Syokota		((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
73048104Syokota		((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
73148104Syokota		((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
73248104Syokota		((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
73348104Syokota		((video_adapter_info_t *)arg)->va_window
73460742Sgallatin#ifdef __i386__
73548104Syokota			= vtophys(adp->va_window);
73660742Sgallatin#else
73760742Sgallatin			= adp->va_window;
73860742Sgallatin#endif
73948104Syokota		((video_adapter_info_t *)arg)->va_window_size
74048104Syokota			= adp->va_window_size;
74148104Syokota		((video_adapter_info_t *)arg)->va_window_gran
74248104Syokota			= adp->va_window_gran;
74348104Syokota		((video_adapter_info_t *)arg)->va_window_orig
74448104Syokota			= adp->va_window_orig;
74548104Syokota		((video_adapter_info_t *)arg)->va_unused0
74660742Sgallatin#ifdef __i386__
74748104Syokota			= (adp->va_buffer) ? vtophys(adp->va_buffer) : 0;
74860742Sgallatin#else
74960742Sgallatin			= adp->va_buffer;
75060742Sgallatin#endif
75148104Syokota		((video_adapter_info_t *)arg)->va_buffer_size
75248104Syokota			= adp->va_buffer_size;
75348104Syokota		((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
75448104Syokota		((video_adapter_info_t *)arg)->va_initial_mode
75548104Syokota			= adp->va_initial_mode;
75648104Syokota		((video_adapter_info_t *)arg)->va_initial_bios_mode
75748104Syokota			= adp->va_initial_bios_mode;
75848104Syokota		((video_adapter_info_t *)arg)->va_line_width
75948104Syokota			= adp->va_line_width;
76048104Syokota		((video_adapter_info_t *)arg)->va_disp_start.x
76148104Syokota			= adp->va_disp_start.x;
76248104Syokota		((video_adapter_info_t *)arg)->va_disp_start.y
76348104Syokota			= adp->va_disp_start.y;
76448104Syokota		break;
76548104Syokota
76648104Syokota	case FBIO_MODEINFO:	/* get mode information */
76748104Syokota		error = (*vidsw[adp->va_index]->get_info)(adp,
76848104Syokota				((video_info_t *)arg)->vi_mode,
76948104Syokota				(video_info_t *)arg);
77048104Syokota		if (error)
77148104Syokota			error = ENODEV;
77248104Syokota		break;
77348104Syokota
77448104Syokota	case FBIO_FINDMODE:	/* find a matching video mode */
77548104Syokota		error = (*vidsw[adp->va_index]->query_mode)(adp,
77648104Syokota				(video_info_t *)arg);
77748104Syokota		break;
77848104Syokota
77948104Syokota	case FBIO_GETMODE:	/* get video mode */
78048104Syokota		*(int *)arg = adp->va_mode;
78148104Syokota		break;
78248104Syokota
78348104Syokota	case FBIO_SETMODE:	/* set video mode */
78448104Syokota		error = (*vidsw[adp->va_index]->set_mode)(adp, *(int *)arg);
78548104Syokota		if (error)
78648104Syokota			error = ENODEV;	/* EINVAL? */
78748104Syokota		break;
78848104Syokota
78948104Syokota	case FBIO_GETWINORG:	/* get frame buffer window origin */
79048104Syokota		*(u_int *)arg = adp->va_window_orig;
79148104Syokota		break;
79248104Syokota
79348104Syokota	case FBIO_GETDISPSTART:	/* get display start address */
79448104Syokota		((video_display_start_t *)arg)->x = adp->va_disp_start.x;
79548104Syokota		((video_display_start_t *)arg)->y = adp->va_disp_start.y;
79648104Syokota		break;
79748104Syokota
79848104Syokota	case FBIO_GETLINEWIDTH:	/* get scan line width in bytes */
79948104Syokota		*(u_int *)arg = adp->va_line_width;
80048104Syokota		break;
80148104Syokota
80281039Syokota	case FBIO_BLANK:	/* blank display */
80381039Syokota		error = (*vidsw[adp->va_index]->blank_display)(adp, *(int *)arg);
80481039Syokota		break;
80581039Syokota
80648104Syokota	case FBIO_GETPALETTE:	/* get color palette */
80748104Syokota	case FBIO_SETPALETTE:	/* set color palette */
80848104Syokota		/* XXX */
80948104Syokota
81048104Syokota	case FBIOPUTCMAP:
81148104Syokota	case FBIOGETCMAP:
81281039Syokota	case FBIOPUTCMAPI:
81381039Syokota	case FBIOGETCMAPI:
81448104Syokota		/* XXX */
81548104Syokota
81648104Syokota	case FBIO_SETWINORG:	/* set frame buffer window origin */
81748104Syokota	case FBIO_SETDISPSTART:	/* set display start address */
81848104Syokota	case FBIO_SETLINEWIDTH:	/* set scan line width in pixel */
81948104Syokota
82048104Syokota	case FBIOGTYPE:
82148104Syokota	case FBIOGATTR:
82248104Syokota	case FBIOSVIDEO:
82348104Syokota	case FBIOGVIDEO:
82481039Syokota	case FBIOVERTICAL:
82548104Syokota	case FBIOSCURSOR:
82648104Syokota	case FBIOGCURSOR:
82748104Syokota	case FBIOSCURPOS:
82848104Syokota	case FBIOGCURPOS:
82948104Syokota	case FBIOGCURMAX:
83081039Syokota	case FBIOMONINFO:
83181039Syokota	case FBIOGXINFO:
83248104Syokota
83348104Syokota	default:
83448104Syokota		error = ENODEV;
83548104Syokota		break;
83648104Syokota	}
83748104Syokota
83848104Syokota	splx(s);
83948104Syokota	return error;
84048104Syokota}
841