freebsd-skq/sys/dev/fb/fb.c
julian 5596676e6c KSE Milestone 2
Note ALL MODULES MUST BE RECOMPILED
make the kernel aware that there are smaller units of scheduling than the
process. (but only allow one thread per process at this time).
This is functionally equivalent to teh previousl -current except
that there is a thread associated with each process.

Sorry john! (your next MFC will be a doosie!)

Reviewed by: peter@freebsd.org, dillon@freebsd.org

X-MFC after:    ha ha ha ha
2001-09-12 08:38:13 +00:00

841 lines
19 KiB
C

/*-
* Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer as
* the first lines of this file unmodified.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
* $FreeBSD$
*/
#include "opt_fb.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/conf.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/module.h>
#include <sys/uio.h>
#include <sys/fbio.h>
#include <sys/linker_set.h>
#include <vm/vm.h>
#include <vm/pmap.h>
#include <dev/fb/fbreg.h>
SET_DECLARE(videodriver_set, const video_driver_t);
/* local arrays */
/*
* We need at least one entry each in order to initialize a video card
* for the kernel console. The arrays will be increased dynamically
* when necessary.
*/
static int vid_malloc;
static int adapters = 1;
static video_adapter_t *adp_ini;
static video_adapter_t **adapter = &adp_ini;
static video_switch_t *vidsw_ini;
video_switch_t **vidsw = &vidsw_ini;
#ifdef FB_INSTALL_CDEV
static struct cdevsw *vidcdevsw_ini;
static struct cdevsw **vidcdevsw = &vidcdevsw_ini;
#endif
#define ARRAY_DELTA 4
static int
vid_realloc_array(void)
{
video_adapter_t **new_adp;
video_switch_t **new_vidsw;
#ifdef FB_INSTALL_CDEV
struct cdevsw **new_cdevsw;
#endif
int newsize;
int s;
if (!vid_malloc)
return ENOMEM;
s = spltty();
newsize = ((adapters + ARRAY_DELTA)/ARRAY_DELTA)*ARRAY_DELTA;
new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK | M_ZERO);
new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF,
M_WAITOK | M_ZERO);
#ifdef FB_INSTALL_CDEV
new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF,
M_WAITOK | M_ZERO);
#endif
bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
#ifdef FB_INSTALL_CDEV
bcopy(vidcdevsw, new_cdevsw, sizeof(*vidcdevsw)*adapters);
#endif
if (adapters > 1) {
free(adapter, M_DEVBUF);
free(vidsw, M_DEVBUF);
#ifdef FB_INSTALL_CDEV
free(vidcdevsw, M_DEVBUF);
#endif
}
adapter = new_adp;
vidsw = new_vidsw;
#ifdef FB_INSTALL_CDEV
vidcdevsw = new_cdevsw;
#endif
adapters = newsize;
splx(s);
if (bootverbose)
printf("fb: new array size %d\n", adapters);
return 0;
}
static void
vid_malloc_init(void *arg)
{
vid_malloc = TRUE;
}
SYSINIT(vid_mem, SI_SUB_KMEM, SI_ORDER_ANY, vid_malloc_init, NULL);
/*
* Low-level frame buffer driver functions
* frame buffer subdrivers, such as the VGA driver, call these functions
* to initialize the video_adapter structure and register it to the virtual
* frame buffer driver `fb'.
*/
/* initialize the video_adapter_t structure */
void
vid_init_struct(video_adapter_t *adp, char *name, int type, int unit)
{
adp->va_flags = 0;
adp->va_name = name;
adp->va_type = type;
adp->va_unit = unit;
}
/* Register a video adapter */
int
vid_register(video_adapter_t *adp)
{
const video_driver_t **list;
const video_driver_t *p;
int index;
for (index = 0; index < adapters; ++index) {
if (adapter[index] == NULL)
break;
}
if (index >= adapters) {
if (vid_realloc_array())
return -1;
}
adp->va_index = index;
adp->va_token = NULL;
SET_FOREACH(list, videodriver_set) {
p = *list;
if (strcmp(p->name, adp->va_name) == 0) {
adapter[index] = adp;
vidsw[index] = p->vidsw;
return index;
}
}
return -1;
}
int
vid_unregister(video_adapter_t *adp)
{
if ((adp->va_index < 0) || (adp->va_index >= adapters))
return ENOENT;
if (adapter[adp->va_index] != adp)
return ENOENT;
adapter[adp->va_index] = NULL;
vidsw[adp->va_index] = NULL;
return 0;
}
/* Get video I/O function table */
video_switch_t
*vid_get_switch(char *name)
{
const video_driver_t **list;
const video_driver_t *p;
SET_FOREACH(list, videodriver_set) {
p = *list;
if (strcmp(p->name, name) == 0)
return p->vidsw;
}
return NULL;
}
/*
* Video card client functions
* Video card clients, such as the console driver `syscons' and the frame
* buffer cdev driver, use these functions to claim and release a card for
* exclusive use.
*/
/* find the video card specified by a driver name and a unit number */
int
vid_find_adapter(char *driver, int unit)
{
int i;
for (i = 0; i < adapters; ++i) {
if (adapter[i] == NULL)
continue;
if (strcmp("*", driver) && strcmp(adapter[i]->va_name, driver))
continue;
if ((unit != -1) && (adapter[i]->va_unit != unit))
continue;
return i;
}
return -1;
}
/* allocate a video card */
int
vid_allocate(char *driver, int unit, void *id)
{
int index;
int s;
s = spltty();
index = vid_find_adapter(driver, unit);
if (index >= 0) {
if (adapter[index]->va_token) {
splx(s);
return -1;
}
adapter[index]->va_token = id;
}
splx(s);
return index;
}
int
vid_release(video_adapter_t *adp, void *id)
{
int error;
int s;
s = spltty();
if (adp->va_token == NULL) {
error = EINVAL;
} else if (adp->va_token != id) {
error = EPERM;
} else {
adp->va_token = NULL;
error = 0;
}
splx(s);
return error;
}
/* Get a video adapter structure */
video_adapter_t
*vid_get_adapter(int index)
{
if ((index < 0) || (index >= adapters))
return NULL;
return adapter[index];
}
/* Configure drivers: this is a backdoor for the console driver XXX */
int
vid_configure(int flags)
{
const video_driver_t **list;
const video_driver_t *p;
SET_FOREACH(list, videodriver_set) {
p = *list;
if (p->configure != NULL)
(*p->configure)(flags);
}
return 0;
}
/*
* Virtual frame buffer cdev driver functions
* The virtual frame buffer driver dispatches driver functions to
* appropriate subdrivers.
*/
#define FB_DRIVER_NAME "fb"
#ifdef FB_INSTALL_CDEV
#if experimental
static devclass_t fb_devclass;
static int fbprobe(device_t dev);
static int fbattach(device_t dev);
static device_method_t fb_methods[] = {
DEVMETHOD(device_probe, fbprobe),
DEVMETHOD(device_attach, fbattach),
DEVMETHOD(bus_print_child, bus_generic_print_child),
{ 0, 0 }
};
static driver_t fb_driver = {
FB_DRIVER_NAME,
fb_methods,
0,
};
static int
fbprobe(device_t dev)
{
int unit;
unit = device_get_unit(dev);
if (unit >= adapters)
return ENXIO;
if (adapter[unit] == NULL)
return ENXIO;
device_set_desc(dev, "generic frame buffer");
return 0;
}
static int
fbattach(device_t dev)
{
printf("fbattach: about to attach children\n");
bus_generic_attach(dev);
return 0;
}
#endif /* experimental */
#define FB_UNIT(dev) minor(dev)
#define FB_MKMINOR(unit) (u)
static d_open_t fbopen;
static d_close_t fbclose;
static d_read_t fbread;
static d_write_t fbwrite;
static d_ioctl_t fbioctl;
static d_mmap_t fbmmap;
#define CDEV_MAJOR 123 /* XXX */
static struct cdevsw fb_cdevsw = {
/* open */ fbopen,
/* close */ fbclose,
/* read */ fbread,
/* write */ fbwrite,
/* ioctl */ fbioctl,
/* poll */ nopoll,
/* mmap */ fbmmap,
/* strategy */ nostrategy,
/* name */ FB_DRIVER_NAME,
/* maj */ CDEV_MAJOR,
/* dump */ nodump,
/* psize */ nopsize,
/* flags */ 0,
};
static int
fb_modevent(module_t mod, int type, void *data)
{
switch (type) {
case MOD_LOAD:
cdevsw_add(&fb_cdevsw);
break;
case MOD_UNLOAD:
printf("fb module unload - not possible for this module type\n");
return EINVAL;
}
return 0;
}
static moduledata_t fb_mod = {
"fb",
fb_modevent,
NULL
};
DECLARE_MODULE(fb, fb_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
int
fb_attach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
{
int s;
if (adp->va_index >= adapters)
return EINVAL;
if (adapter[adp->va_index] != adp)
return EINVAL;
s = spltty();
adp->va_minor = minor(dev);
vidcdevsw[adp->va_index] = cdevsw;
splx(s);
printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
return 0;
}
int
fb_detach(dev_t dev, video_adapter_t *adp, struct cdevsw *cdevsw)
{
int s;
if (adp->va_index >= adapters)
return EINVAL;
if (adapter[adp->va_index] != adp)
return EINVAL;
if (vidcdevsw[adp->va_index] != cdevsw)
return EINVAL;
s = spltty();
vidcdevsw[adp->va_index] = NULL;
splx(s);
return 0;
}
static int
fbopen(dev_t dev, int flag, int mode, struct thread *td)
{
int unit;
unit = FB_UNIT(dev);
if (unit >= adapters)
return ENXIO;
if (vidcdevsw[unit] == NULL)
return ENXIO;
return (*vidcdevsw[unit]->d_open)(makedev(0, adapter[unit]->va_minor),
flag, mode, td);
}
static int
fbclose(dev_t dev, int flag, int mode, struct thread *td)
{
int unit;
unit = FB_UNIT(dev);
if (vidcdevsw[unit] == NULL)
return ENXIO;
return (*vidcdevsw[unit]->d_close)(makedev(0, adapter[unit]->va_minor),
flag, mode, td);
}
static int
fbread(dev_t dev, struct uio *uio, int flag)
{
int unit;
unit = FB_UNIT(dev);
if (vidcdevsw[unit] == NULL)
return ENXIO;
return (*vidcdevsw[unit]->d_read)(makedev(0, adapter[unit]->va_minor),
uio, flag);
}
static int
fbwrite(dev_t dev, struct uio *uio, int flag)
{
int unit;
unit = FB_UNIT(dev);
if (vidcdevsw[unit] == NULL)
return ENXIO;
return (*vidcdevsw[unit]->d_write)(makedev(0, adapter[unit]->va_minor),
uio, flag);
}
static int
fbioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct thread *td)
{
int unit;
unit = FB_UNIT(dev);
if (vidcdevsw[unit] == NULL)
return ENXIO;
return (*vidcdevsw[unit]->d_ioctl)(makedev(0, adapter[unit]->va_minor),
cmd, arg, flag, td);
}
static int
fbmmap(dev_t dev, vm_offset_t offset, int nprot)
{
int unit;
unit = FB_UNIT(dev);
if (vidcdevsw[unit] == NULL)
return ENXIO;
return (*vidcdevsw[unit]->d_mmap)(makedev(0, adapter[unit]->va_minor),
offset, nprot);
}
#if experimental
DEV_DRIVER_MODULE(fb, ???, fb_driver, fb_devclass, fb_cdevsw, 0, 0);
#endif
/*
* Generic frame buffer cdev driver functions
* Frame buffer subdrivers may call these functions to implement common
* driver functions.
*/
int genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
struct thread *td)
{
int s;
s = spltty();
if (!(sc->gfb_flags & FB_OPEN))
sc->gfb_flags |= FB_OPEN;
splx(s);
return 0;
}
int genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
struct thread *td)
{
int s;
s = spltty();
sc->gfb_flags &= ~FB_OPEN;
splx(s);
return 0;
}
int genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
int flag)
{
int size;
int offset;
int error;
int len;
error = 0;
size = adp->va_buffer_size/adp->va_info.vi_planes;
while (uio->uio_resid > 0) {
if (uio->uio_offset >= size)
break;
offset = uio->uio_offset%adp->va_window_size;
len = imin(uio->uio_resid, size - uio->uio_offset);
len = imin(len, adp->va_window_size - offset);
if (len <= 0)
break;
(*vidsw[adp->va_index]->set_win_org)(adp, uio->uio_offset);
error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
if (error)
break;
}
return error;
}
int genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
int flag)
{
return ENODEV;
}
int genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
caddr_t arg, int flag, struct thread *td)
{
int error;
if (adp == NULL) /* XXX */
return ENXIO;
error = (*vidsw[adp->va_index]->ioctl)(adp, cmd, arg);
if (error == ENOIOCTL)
error = ENODEV;
return error;
}
int genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_offset_t offset,
int prot)
{
return (*vidsw[adp->va_index]->mmap)(adp, offset, prot);
}
#endif /* FB_INSTALL_CDEV */
static char
*adapter_name(int type)
{
static struct {
int type;
char *name;
} names[] = {
{ KD_MONO, "MDA" },
{ KD_HERCULES, "Hercules" },
{ KD_CGA, "CGA" },
{ KD_EGA, "EGA" },
{ KD_VGA, "VGA" },
{ KD_PC98, "PC-98x1" },
{ KD_TGA, "TGA" },
{ -1, "Unknown" },
};
int i;
for (i = 0; names[i].type != -1; ++i)
if (names[i].type == type)
break;
return names[i].name;
}
/*
* Generic low-level frame buffer functions
* The low-level functions in the frame buffer subdriver may use these
* functions.
*/
void
fb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
{
if (level <= 0)
return;
printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
adapter_name(adp->va_type), adp->va_type, adp->va_flags);
printf("%s%d: port:0x%x-0x%x, crtc:0x%x, mem:0x%x 0x%x\n",
FB_DRIVER_NAME, adp->va_index,
adp->va_io_base, adp->va_io_base + adp->va_io_size - 1,
adp->va_crtc_addr, adp->va_mem_base, adp->va_mem_size);
printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
FB_DRIVER_NAME, adp->va_index,
adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
FB_DRIVER_NAME, adp->va_index,
(void *)adp->va_window, (int)adp->va_window_size/1024,
(int)adp->va_window_gran/1024, (void *)adp->va_buffer,
(int)adp->va_buffer_size/1024);
}
void
fb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
int level)
{
if (level <= 0)
return;
printf("%s%d: %s, mode:%d, flags:0x%x ",
driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
if (info->vi_flags & V_INFO_GRAPHICS)
printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
info->vi_width, info->vi_height,
info->vi_depth, info->vi_planes,
info->vi_cwidth, info->vi_cheight);
else
printf("T %dx%d, font:%dx%d, ",
info->vi_width, info->vi_height,
info->vi_cwidth, info->vi_cheight);
printf("win:0x%x\n", info->vi_window);
}
int
fb_type(int adp_type)
{
static struct {
int fb_type;
int va_type;
} types[] = {
{ FBTYPE_MDA, KD_MONO },
{ FBTYPE_HERCULES, KD_HERCULES },
{ FBTYPE_CGA, KD_CGA },
{ FBTYPE_EGA, KD_EGA },
{ FBTYPE_VGA, KD_VGA },
{ FBTYPE_PC98, KD_PC98 },
{ FBTYPE_TGA, KD_TGA },
};
int i;
for (i = 0; i < sizeof(types)/sizeof(types[0]); ++i) {
if (types[i].va_type == adp_type)
return types[i].fb_type;
}
return -1;
}
int
fb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
{
int error;
int s;
/* assert(adp != NULL) */
error = 0;
s = spltty();
switch (cmd) {
case FBIO_ADAPTER: /* get video adapter index */
*(int *)arg = adp->va_index;
break;
case FBIO_ADPTYPE: /* get video adapter type */
*(int *)arg = adp->va_type;
break;
case FBIO_ADPINFO: /* get video adapter info */
((video_adapter_info_t *)arg)->va_index = adp->va_index;
((video_adapter_info_t *)arg)->va_type = adp->va_type;
bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
imin(strlen(adp->va_name) + 1,
sizeof(((video_adapter_info_t *)arg)->va_name)));
((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
((video_adapter_info_t *)arg)->va_window
#ifdef __i386__
= vtophys(adp->va_window);
#else
= adp->va_window;
#endif
((video_adapter_info_t *)arg)->va_window_size
= adp->va_window_size;
((video_adapter_info_t *)arg)->va_window_gran
= adp->va_window_gran;
((video_adapter_info_t *)arg)->va_window_orig
= adp->va_window_orig;
((video_adapter_info_t *)arg)->va_unused0
#ifdef __i386__
= (adp->va_buffer) ? vtophys(adp->va_buffer) : 0;
#else
= adp->va_buffer;
#endif
((video_adapter_info_t *)arg)->va_buffer_size
= adp->va_buffer_size;
((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
((video_adapter_info_t *)arg)->va_initial_mode
= adp->va_initial_mode;
((video_adapter_info_t *)arg)->va_initial_bios_mode
= adp->va_initial_bios_mode;
((video_adapter_info_t *)arg)->va_line_width
= adp->va_line_width;
((video_adapter_info_t *)arg)->va_disp_start.x
= adp->va_disp_start.x;
((video_adapter_info_t *)arg)->va_disp_start.y
= adp->va_disp_start.y;
break;
case FBIO_MODEINFO: /* get mode information */
error = (*vidsw[adp->va_index]->get_info)(adp,
((video_info_t *)arg)->vi_mode,
(video_info_t *)arg);
if (error)
error = ENODEV;
break;
case FBIO_FINDMODE: /* find a matching video mode */
error = (*vidsw[adp->va_index]->query_mode)(adp,
(video_info_t *)arg);
break;
case FBIO_GETMODE: /* get video mode */
*(int *)arg = adp->va_mode;
break;
case FBIO_SETMODE: /* set video mode */
error = (*vidsw[adp->va_index]->set_mode)(adp, *(int *)arg);
if (error)
error = ENODEV; /* EINVAL? */
break;
case FBIO_GETWINORG: /* get frame buffer window origin */
*(u_int *)arg = adp->va_window_orig;
break;
case FBIO_GETDISPSTART: /* get display start address */
((video_display_start_t *)arg)->x = adp->va_disp_start.x;
((video_display_start_t *)arg)->y = adp->va_disp_start.y;
break;
case FBIO_GETLINEWIDTH: /* get scan line width in bytes */
*(u_int *)arg = adp->va_line_width;
break;
case FBIO_BLANK: /* blank display */
error = (*vidsw[adp->va_index]->blank_display)(adp, *(int *)arg);
break;
case FBIO_GETPALETTE: /* get color palette */
case FBIO_SETPALETTE: /* set color palette */
/* XXX */
case FBIOPUTCMAP:
case FBIOGETCMAP:
case FBIOPUTCMAPI:
case FBIOGETCMAPI:
/* XXX */
case FBIO_SETWINORG: /* set frame buffer window origin */
case FBIO_SETDISPSTART: /* set display start address */
case FBIO_SETLINEWIDTH: /* set scan line width in pixel */
case FBIOGTYPE:
case FBIOGATTR:
case FBIOSVIDEO:
case FBIOGVIDEO:
case FBIOVERTICAL:
case FBIOSCURSOR:
case FBIOGCURSOR:
case FBIOSCURPOS:
case FBIOGCURPOS:
case FBIOGCURMAX:
case FBIOMONINFO:
case FBIOGXINFO:
default:
error = ENODEV;
break;
}
splx(s);
return error;
}