Home | History | Annotate | Line # | Download | only in wsfb
genfb.c revision 1.8
      1  1.8      jmmv /*	$NetBSD: genfb.c,v 1.8 2007/08/30 13:32:18 jmmv Exp $ */
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.1  macallan  * Copyright (c) 2007 Michael Lorenz
      5  1.1  macallan  * All rights reserved.
      6  1.1  macallan  *
      7  1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8  1.1  macallan  * modification, are permitted provided that the following conditions
      9  1.1  macallan  * are met:
     10  1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11  1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12  1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15  1.1  macallan  * 3. Neither the name of The NetBSD Foundation nor the names of its
     16  1.1  macallan  *    contributors may be used to endorse or promote products derived
     17  1.1  macallan  *    from this software without specific prior written permission.
     18  1.1  macallan  *
     19  1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1  macallan  */
     31  1.1  macallan 
     32  1.1  macallan #include <sys/cdefs.h>
     33  1.8      jmmv __KERNEL_RCSID(0, "$NetBSD: genfb.c,v 1.8 2007/08/30 13:32:18 jmmv Exp $");
     34  1.1  macallan 
     35  1.1  macallan #include <sys/param.h>
     36  1.1  macallan #include <sys/systm.h>
     37  1.1  macallan #include <sys/kernel.h>
     38  1.1  macallan #include <sys/device.h>
     39  1.1  macallan #include <sys/proc.h>
     40  1.1  macallan #include <sys/mutex.h>
     41  1.1  macallan #include <sys/ioctl.h>
     42  1.1  macallan #include <sys/kernel.h>
     43  1.1  macallan #include <sys/systm.h>
     44  1.5  macallan #include <sys/malloc.h>
     45  1.1  macallan 
     46  1.1  macallan #include <dev/wscons/wsconsio.h>
     47  1.1  macallan #include <dev/wscons/wsdisplayvar.h>
     48  1.1  macallan #include <dev/rasops/rasops.h>
     49  1.1  macallan #include <dev/wsfont/wsfont.h>
     50  1.1  macallan 
     51  1.1  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     52  1.1  macallan 
     53  1.1  macallan #include <dev/wsfb/genfbvar.h>
     54  1.1  macallan 
     55  1.1  macallan #include "opt_genfb.h"
     56  1.1  macallan #include "opt_wsfb.h"
     57  1.1  macallan 
     58  1.1  macallan static int	genfb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     59  1.1  macallan static paddr_t	genfb_mmap(void *, void *, off_t, int);
     60  1.1  macallan static void	genfb_init_screen(void *, struct vcons_screen *, int, long *);
     61  1.1  macallan 
     62  1.1  macallan static int	genfb_putcmap(struct genfb_softc *, struct wsdisplay_cmap *);
     63  1.1  macallan static int 	genfb_getcmap(struct genfb_softc *, struct wsdisplay_cmap *);
     64  1.1  macallan static void	genfb_restore_palette(struct genfb_softc *);
     65  1.1  macallan static int 	genfb_putpalreg(struct genfb_softc *, uint8_t, uint8_t,
     66  1.1  macallan 			    uint8_t, uint8_t);
     67  1.1  macallan 
     68  1.1  macallan extern const u_char rasops_cmap[768];
     69  1.1  macallan 
     70  1.1  macallan struct wsdisplay_accessops genfb_accessops = {
     71  1.1  macallan 	genfb_ioctl,
     72  1.1  macallan 	genfb_mmap,
     73  1.3  macallan 	NULL,	/* alloc_screen */
     74  1.3  macallan 	NULL,	/* free_screen */
     75  1.3  macallan 	NULL,	/* show_screen */
     76  1.3  macallan 	NULL, 	/* load_font */
     77  1.3  macallan 	NULL,	/* pollc */
     78  1.3  macallan 	NULL	/* scroll */
     79  1.1  macallan };
     80  1.1  macallan 
     81  1.2  macallan void
     82  1.2  macallan genfb_init(struct genfb_softc *sc)
     83  1.2  macallan {
     84  1.2  macallan 	prop_dictionary_t dict;
     85  1.4  macallan 	uint64_t cmap_cb;
     86  1.2  macallan 	uint32_t fboffset;
     87  1.2  macallan 
     88  1.2  macallan 	dict = device_properties(&sc->sc_dev);
     89  1.2  macallan #ifdef GENFB_DEBUG
     90  1.2  macallan 	printf(prop_dictionary_externalize(dict));
     91  1.2  macallan #endif
     92  1.2  macallan 	if (!prop_dictionary_get_uint32(dict, "width", &sc->sc_width))
     93  1.2  macallan 		panic("no width property");
     94  1.2  macallan 	if (!prop_dictionary_get_uint32(dict, "height", &sc->sc_height))
     95  1.2  macallan 		panic("no height property");
     96  1.2  macallan 	if (!prop_dictionary_get_uint32(dict, "depth", &sc->sc_depth))
     97  1.2  macallan 		panic("no depth property");
     98  1.2  macallan 
     99  1.2  macallan 	/* XXX should be a 64bit value */
    100  1.2  macallan 	if (!prop_dictionary_get_uint32(dict, "address", &fboffset))
    101  1.2  macallan 		panic("no address property");
    102  1.2  macallan 	sc->sc_fboffset = fboffset;
    103  1.2  macallan 
    104  1.2  macallan 	if (!prop_dictionary_get_uint32(dict, "linebytes", &sc->sc_stride))
    105  1.2  macallan 		sc->sc_stride = (sc->sc_width * sc->sc_depth) >> 3;
    106  1.6  macallan 	sc->sc_fbsize = sc->sc_height * sc->sc_stride;
    107  1.4  macallan 
    108  1.4  macallan 	/* optional colour map callback */
    109  1.4  macallan 	sc->sc_cmcb = NULL;
    110  1.4  macallan 	if (prop_dictionary_get_uint64(dict, "cmap_callback", &cmap_cb)) {
    111  1.4  macallan 		if (cmap_cb != 0)
    112  1.4  macallan 			sc->sc_cmcb = (void *)(vaddr_t)cmap_cb;
    113  1.4  macallan 	}
    114  1.2  macallan }
    115  1.2  macallan 
    116  1.2  macallan int
    117  1.2  macallan genfb_attach(struct genfb_softc *sc, struct genfb_ops *ops)
    118  1.1  macallan {
    119  1.1  macallan 	struct wsemuldisplaydev_attach_args aa;
    120  1.1  macallan 	prop_dictionary_t dict;
    121  1.1  macallan 	struct rasops_info *ri;
    122  1.1  macallan 	long defattr;
    123  1.7  macallan 	int i, j;
    124  1.7  macallan 	bool console;
    125  1.1  macallan 
    126  1.1  macallan 	sc->sc_defaultscreen_descr = (struct wsscreen_descr){
    127  1.1  macallan 		"default",
    128  1.1  macallan 		0, 0,
    129  1.1  macallan 		NULL,
    130  1.1  macallan 		8, 16,
    131  1.1  macallan 		WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
    132  1.3  macallan 		NULL
    133  1.1  macallan 	};
    134  1.1  macallan 	sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
    135  1.1  macallan 	sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
    136  1.1  macallan 	memcpy(&sc->sc_ops, ops, sizeof(struct genfb_ops));
    137  1.1  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    138  1.1  macallan 
    139  1.5  macallan 	sc->sc_shadowfb = malloc(sc->sc_fbsize, M_DEVBUF, M_WAITOK);
    140  1.5  macallan 
    141  1.1  macallan 	dict = device_properties(&sc->sc_dev);
    142  1.1  macallan 
    143  1.1  macallan 	prop_dictionary_get_bool(dict, "is_console", &console);
    144  1.1  macallan 
    145  1.1  macallan 	vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
    146  1.1  macallan 	    &genfb_accessops);
    147  1.1  macallan 	sc->vd.init_screen = genfb_init_screen;
    148  1.1  macallan 
    149  1.1  macallan 	ri = &sc->sc_console_screen.scr_ri;
    150  1.1  macallan 
    151  1.1  macallan 	if (console) {
    152  1.1  macallan 		vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
    153  1.1  macallan 		    &defattr);
    154  1.1  macallan 		sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    155  1.1  macallan 
    156  1.1  macallan 		sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
    157  1.1  macallan 		sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
    158  1.1  macallan 		sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
    159  1.1  macallan 		sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
    160  1.1  macallan 		wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
    161  1.1  macallan 		    defattr);
    162  1.1  macallan 	} else {
    163  1.1  macallan 		/*
    164  1.1  macallan 		 * since we're not the console we can postpone the rest
    165  1.1  macallan 		 * until someone actually allocates a screen for us
    166  1.1  macallan 		 */
    167  1.1  macallan 	}
    168  1.1  macallan 
    169  1.1  macallan 	j = 0;
    170  1.8      jmmv 	for (i = 0; i < (1 << sc->sc_depth); i++) {
    171  1.4  macallan 
    172  1.4  macallan 		sc->sc_cmap_red[i] = rasops_cmap[j];
    173  1.4  macallan 		sc->sc_cmap_green[i] = rasops_cmap[j + 1];
    174  1.4  macallan 		sc->sc_cmap_blue[i] = rasops_cmap[j + 2];
    175  1.1  macallan 		genfb_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1],
    176  1.1  macallan 		    rasops_cmap[j + 2]);
    177  1.1  macallan 		j += 3;
    178  1.1  macallan 	}
    179  1.1  macallan 
    180  1.1  macallan 	aa.console = console;
    181  1.1  macallan 	aa.scrdata = &sc->sc_screenlist;
    182  1.1  macallan 	aa.accessops = &genfb_accessops;
    183  1.1  macallan 	aa.accesscookie = &sc->vd;
    184  1.1  macallan 
    185  1.1  macallan 	config_found(&sc->sc_dev, &aa, wsemuldisplaydevprint);
    186  1.1  macallan 
    187  1.1  macallan 	return 0;
    188  1.1  macallan }
    189  1.1  macallan 
    190  1.1  macallan static int
    191  1.1  macallan genfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    192  1.1  macallan 	struct lwp *l)
    193  1.1  macallan {
    194  1.1  macallan 	struct vcons_data *vd = v;
    195  1.1  macallan 	struct genfb_softc *sc = vd->cookie;
    196  1.1  macallan 	struct wsdisplay_fbinfo *wdf;
    197  1.1  macallan 	struct vcons_screen *ms = vd->active;
    198  1.1  macallan 
    199  1.1  macallan 	switch (cmd) {
    200  1.1  macallan 
    201  1.1  macallan 		case WSDISPLAYIO_GINFO:
    202  1.6  macallan 			if (ms == NULL)
    203  1.6  macallan 				return ENODEV;
    204  1.1  macallan 			wdf = (void *)data;
    205  1.1  macallan 			wdf->height = ms->scr_ri.ri_height;
    206  1.1  macallan 			wdf->width = ms->scr_ri.ri_width;
    207  1.1  macallan 			wdf->depth = ms->scr_ri.ri_depth;
    208  1.1  macallan 			wdf->cmsize = 256;
    209  1.1  macallan 			return 0;
    210  1.1  macallan 
    211  1.1  macallan 		case WSDISPLAYIO_GETCMAP:
    212  1.1  macallan 			return genfb_getcmap(sc,
    213  1.1  macallan 			    (struct wsdisplay_cmap *)data);
    214  1.1  macallan 
    215  1.1  macallan 		case WSDISPLAYIO_PUTCMAP:
    216  1.1  macallan 			return genfb_putcmap(sc,
    217  1.1  macallan 			    (struct wsdisplay_cmap *)data);
    218  1.1  macallan 
    219  1.3  macallan 		case WSDISPLAYIO_LINEBYTES:
    220  1.3  macallan 			*(u_int *)data = sc->sc_stride;
    221  1.3  macallan 			return 0;
    222  1.3  macallan 
    223  1.1  macallan 		case WSDISPLAYIO_SMODE:
    224  1.1  macallan 			{
    225  1.1  macallan 				int new_mode = *(int*)data;
    226  1.1  macallan 				if (new_mode != sc->sc_mode) {
    227  1.1  macallan 					sc->sc_mode = new_mode;
    228  1.1  macallan 					if(new_mode == WSDISPLAYIO_MODE_EMUL) {
    229  1.1  macallan 						genfb_restore_palette(sc);
    230  1.1  macallan 						vcons_redraw_screen(ms);
    231  1.1  macallan 					}
    232  1.1  macallan 				}
    233  1.1  macallan 			}
    234  1.1  macallan 			return 0;
    235  1.1  macallan 		default:
    236  1.1  macallan 			if (sc->sc_ops.genfb_ioctl)
    237  1.1  macallan 				return sc->sc_ops.genfb_ioctl(sc, vs, cmd,
    238  1.1  macallan 				    data, flag, l);
    239  1.1  macallan 	}
    240  1.1  macallan 	return EPASSTHROUGH;
    241  1.1  macallan }
    242  1.1  macallan 
    243  1.1  macallan static paddr_t
    244  1.1  macallan genfb_mmap(void *v, void *vs, off_t offset, int prot)
    245  1.1  macallan {
    246  1.1  macallan 	struct vcons_data *vd = v;
    247  1.1  macallan 	struct genfb_softc *sc = vd->cookie;
    248  1.1  macallan 
    249  1.1  macallan 	if (sc->sc_ops.genfb_mmap)
    250  1.1  macallan 		return sc->sc_ops.genfb_mmap(sc, vs, offset, prot);
    251  1.1  macallan 
    252  1.1  macallan 	return -1;
    253  1.1  macallan }
    254  1.1  macallan 
    255  1.1  macallan static void
    256  1.1  macallan genfb_init_screen(void *cookie, struct vcons_screen *scr,
    257  1.1  macallan     int existing, long *defattr)
    258  1.1  macallan {
    259  1.1  macallan 	struct genfb_softc *sc = cookie;
    260  1.1  macallan 	struct rasops_info *ri = &scr->scr_ri;
    261  1.1  macallan 
    262  1.1  macallan 	ri->ri_depth = sc->sc_depth;
    263  1.1  macallan 	ri->ri_width = sc->sc_width;
    264  1.1  macallan 	ri->ri_height = sc->sc_height;
    265  1.1  macallan 	ri->ri_stride = sc->sc_stride;
    266  1.1  macallan 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
    267  1.1  macallan 
    268  1.5  macallan 	if (sc->sc_shadowfb != NULL) {
    269  1.5  macallan 
    270  1.5  macallan 		ri->ri_hwbits = (char *)sc->sc_fbaddr;
    271  1.5  macallan 		ri->ri_bits = (char *)sc->sc_shadowfb;
    272  1.5  macallan 	} else
    273  1.5  macallan 		ri->ri_bits = (char *)sc->sc_fbaddr;
    274  1.1  macallan 
    275  1.1  macallan 	if (existing) {
    276  1.1  macallan 		ri->ri_flg |= RI_CLEAR;
    277  1.1  macallan 	}
    278  1.1  macallan 
    279  1.1  macallan 	rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
    280  1.1  macallan 	ri->ri_caps = WSSCREEN_WSCOLORS;
    281  1.1  macallan 
    282  1.1  macallan 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    283  1.1  macallan 		    sc->sc_width / ri->ri_font->fontwidth);
    284  1.1  macallan 
    285  1.1  macallan 	ri->ri_hw = scr;
    286  1.1  macallan }
    287  1.1  macallan 
    288  1.1  macallan static int
    289  1.1  macallan genfb_putcmap(struct genfb_softc *sc, struct wsdisplay_cmap *cm)
    290  1.1  macallan {
    291  1.1  macallan 	u_char *r, *g, *b;
    292  1.1  macallan 	u_int index = cm->index;
    293  1.1  macallan 	u_int count = cm->count;
    294  1.1  macallan 	int i, error;
    295  1.1  macallan 	u_char rbuf[256], gbuf[256], bbuf[256];
    296  1.1  macallan 
    297  1.1  macallan #ifdef GENFB_DEBUG
    298  1.1  macallan 	aprint_debug("putcmap: %d %d\n",index, count);
    299  1.1  macallan #endif
    300  1.1  macallan 	if (cm->index >= 256 || cm->count > 256 ||
    301  1.1  macallan 	    (cm->index + cm->count) > 256)
    302  1.1  macallan 		return EINVAL;
    303  1.1  macallan 	error = copyin(cm->red, &rbuf[index], count);
    304  1.1  macallan 	if (error)
    305  1.1  macallan 		return error;
    306  1.1  macallan 	error = copyin(cm->green, &gbuf[index], count);
    307  1.1  macallan 	if (error)
    308  1.1  macallan 		return error;
    309  1.1  macallan 	error = copyin(cm->blue, &bbuf[index], count);
    310  1.1  macallan 	if (error)
    311  1.1  macallan 		return error;
    312  1.1  macallan 
    313  1.1  macallan 	memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
    314  1.1  macallan 	memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
    315  1.1  macallan 	memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
    316  1.1  macallan 
    317  1.1  macallan 	r = &sc->sc_cmap_red[index];
    318  1.1  macallan 	g = &sc->sc_cmap_green[index];
    319  1.1  macallan 	b = &sc->sc_cmap_blue[index];
    320  1.1  macallan 
    321  1.1  macallan 	for (i = 0; i < count; i++) {
    322  1.1  macallan 		genfb_putpalreg(sc, index, *r, *g, *b);
    323  1.1  macallan 		index++;
    324  1.1  macallan 		r++, g++, b++;
    325  1.1  macallan 	}
    326  1.1  macallan 	return 0;
    327  1.1  macallan }
    328  1.1  macallan 
    329  1.1  macallan static int
    330  1.1  macallan genfb_getcmap(struct genfb_softc *sc, struct wsdisplay_cmap *cm)
    331  1.1  macallan {
    332  1.1  macallan 	u_int index = cm->index;
    333  1.1  macallan 	u_int count = cm->count;
    334  1.1  macallan 	int error;
    335  1.1  macallan 
    336  1.1  macallan 	if (index >= 255 || count > 256 || index + count > 256)
    337  1.1  macallan 		return EINVAL;
    338  1.1  macallan 
    339  1.1  macallan 	error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
    340  1.1  macallan 	if (error)
    341  1.1  macallan 		return error;
    342  1.1  macallan 	error = copyout(&sc->sc_cmap_green[index], cm->green, count);
    343  1.1  macallan 	if (error)
    344  1.1  macallan 		return error;
    345  1.1  macallan 	error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
    346  1.1  macallan 	if (error)
    347  1.1  macallan 		return error;
    348  1.1  macallan 
    349  1.1  macallan 	return 0;
    350  1.1  macallan }
    351  1.1  macallan 
    352  1.1  macallan static void
    353  1.1  macallan genfb_restore_palette(struct genfb_softc *sc)
    354  1.1  macallan {
    355  1.1  macallan 	int i;
    356  1.1  macallan 
    357  1.8      jmmv 	for (i = 0; i < (1 << sc->sc_depth); i++) {
    358  1.1  macallan 		genfb_putpalreg(sc, i, sc->sc_cmap_red[i],
    359  1.1  macallan 		    sc->sc_cmap_green[i], sc->sc_cmap_blue[i]);
    360  1.1  macallan 	}
    361  1.1  macallan }
    362  1.1  macallan 
    363  1.1  macallan static int
    364  1.1  macallan genfb_putpalreg(struct genfb_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
    365  1.1  macallan     uint8_t b)
    366  1.1  macallan {
    367  1.1  macallan 
    368  1.4  macallan 	if (sc->sc_cmcb) {
    369  1.4  macallan 
    370  1.4  macallan 		sc->sc_cmcb->gcc_set_mapreg(sc->sc_cmcb->gcc_cookie,
    371  1.4  macallan 		    idx, r, g, b);
    372  1.4  macallan 	}
    373  1.1  macallan 	return 0;
    374  1.1  macallan }
    375  1.1  macallan 
    376