Home | History | Annotate | Line # | Download | only in igma
      1  1.4  thorpej /*	$NetBSD: igmafb.c,v 1.4 2021/08/07 16:19:14 thorpej Exp $	*/
      2  1.1  mlelstv 
      3  1.1  mlelstv /*
      4  1.1  mlelstv  * Copyright (c) 2012 Michael van Elst
      5  1.1  mlelstv  *
      6  1.1  mlelstv  * Permission to use, copy, modify, and distribute this software for any
      7  1.1  mlelstv  * purpose with or without fee is hereby granted, provided that the above
      8  1.1  mlelstv  * copyright notice and this permission notice appear in all copies.
      9  1.1  mlelstv  *
     10  1.1  mlelstv  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     11  1.1  mlelstv  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     12  1.1  mlelstv  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     13  1.1  mlelstv  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     14  1.1  mlelstv  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     15  1.1  mlelstv  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     16  1.1  mlelstv  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     17  1.1  mlelstv  */
     18  1.1  mlelstv 
     19  1.1  mlelstv /*
     20  1.1  mlelstv  * Intel Graphic Media Accelerator
     21  1.1  mlelstv  */
     22  1.1  mlelstv 
     23  1.1  mlelstv #include <sys/cdefs.h>
     24  1.4  thorpej __KERNEL_RCSID(0, "$NetBSD: igmafb.c,v 1.4 2021/08/07 16:19:14 thorpej Exp $");
     25  1.1  mlelstv 
     26  1.1  mlelstv #include <sys/param.h>
     27  1.1  mlelstv #include <sys/systm.h>
     28  1.1  mlelstv #include <sys/device.h>
     29  1.1  mlelstv #include <sys/bus.h>
     30  1.1  mlelstv #include <sys/kmem.h>
     31  1.1  mlelstv 
     32  1.1  mlelstv #include <dev/pci/pcireg.h>
     33  1.1  mlelstv #include <dev/pci/pcivar.h>
     34  1.1  mlelstv #include <dev/pci/pcidevs.h>
     35  1.1  mlelstv #include <dev/pci/pciio.h>
     36  1.1  mlelstv 
     37  1.1  mlelstv #include <dev/videomode/videomode.h>
     38  1.1  mlelstv 
     39  1.1  mlelstv #include <dev/wscons/wsdisplayvar.h>
     40  1.1  mlelstv #include <dev/wscons/wsconsio.h>
     41  1.1  mlelstv #include <dev/wsfont/wsfont.h>
     42  1.1  mlelstv #include <dev/rasops/rasops.h>
     43  1.1  mlelstv #include <dev/wscons/wsdisplay_vconsvar.h>
     44  1.1  mlelstv #include <dev/pci/wsdisplay_pci.h>
     45  1.1  mlelstv 
     46  1.1  mlelstv #include <dev/pci/igmareg.h>
     47  1.1  mlelstv #include <dev/pci/igmavar.h>
     48  1.1  mlelstv 
     49  1.1  mlelstv #include "opt_voyagerfb.h"
     50  1.1  mlelstv 
     51  1.1  mlelstv struct igmafb_softc {
     52  1.1  mlelstv 	device_t		sc_dev;
     53  1.1  mlelstv 
     54  1.1  mlelstv 	int 			sc_width;
     55  1.1  mlelstv 	int 			sc_height;
     56  1.1  mlelstv 	int 			sc_depth;
     57  1.1  mlelstv 	int 			sc_stride;
     58  1.1  mlelstv 	void			*sc_fbaddr;
     59  1.1  mlelstv 	bus_size_t		sc_fbsize;
     60  1.1  mlelstv 	struct vcons_screen	sc_console_screen;
     61  1.1  mlelstv 	struct wsscreen_descr	sc_defaultscreen_descr;
     62  1.1  mlelstv 	const struct wsscreen_descr	*sc_screens[1];
     63  1.1  mlelstv 	struct wsscreen_list	sc_screenlist;
     64  1.1  mlelstv 	struct vcons_data	vd;
     65  1.1  mlelstv 
     66  1.1  mlelstv 	struct igma_chip	sc_chip;
     67  1.1  mlelstv 	void			*sc_vga_save;
     68  1.1  mlelstv 
     69  1.1  mlelstv 	int			sc_backlight;
     70  1.1  mlelstv 	int			sc_brightness;
     71  1.1  mlelstv 	int			sc_brightness_max;
     72  1.1  mlelstv };
     73  1.1  mlelstv 
     74  1.1  mlelstv static int igmafb_match(device_t, cfdata_t, void *);
     75  1.1  mlelstv static void igmafb_attach(device_t, device_t, void *);
     76  1.1  mlelstv 
     77  1.1  mlelstv CFATTACH_DECL_NEW(igmafb, sizeof(struct igmafb_softc),
     78  1.1  mlelstv     igmafb_match, igmafb_attach, NULL, NULL);
     79  1.1  mlelstv 
     80  1.1  mlelstv static int igmafb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     81  1.1  mlelstv static paddr_t igmafb_mmap(void *, void *, off_t, int);
     82  1.1  mlelstv static void igmafb_pollc(void *v, int);
     83  1.1  mlelstv 
     84  1.1  mlelstv static /*const*/ struct wsdisplay_accessops igmafb_accessops = {
     85  1.1  mlelstv 	igmafb_ioctl,
     86  1.1  mlelstv 	igmafb_mmap,
     87  1.1  mlelstv 	NULL,	/* alloc_screen */
     88  1.1  mlelstv 	NULL,	/* free_screen */
     89  1.1  mlelstv 	NULL,	/* show_screen */
     90  1.1  mlelstv 	NULL,	/* load_font */
     91  1.1  mlelstv 	igmafb_pollc,	/* pollc */
     92  1.1  mlelstv 	NULL	/* scroll */
     93  1.1  mlelstv };
     94  1.1  mlelstv 
     95  1.1  mlelstv static void igmafb_init_screen(void *, struct vcons_screen *, int, long *);
     96  1.1  mlelstv static void igmafb_guess_size(struct igmafb_softc *, int *, int*);
     97  1.1  mlelstv static void igmafb_set_mode(struct igmafb_softc *, bool);
     98  1.1  mlelstv 
     99  1.1  mlelstv static void igmafb_planestart_quirk(struct igmafb_softc *);
    100  1.1  mlelstv static void igmafb_pfitdisable_quirk(struct igmafb_softc *);
    101  1.1  mlelstv 
    102  1.1  mlelstv static void igmafb_get_brightness_max(struct igmafb_softc *, int *);
    103  1.1  mlelstv static void igmafb_get_brightness(struct igmafb_softc *, int *);
    104  1.1  mlelstv static void igmafb_set_brightness(struct igmafb_softc *, int);
    105  1.1  mlelstv 
    106  1.1  mlelstv static int
    107  1.1  mlelstv igmafb_match(device_t parent, cfdata_t match, void *aux)
    108  1.1  mlelstv {
    109  1.1  mlelstv 	struct igma_attach_args *iaa = (struct igma_attach_args *)aux;
    110  1.1  mlelstv 
    111  1.1  mlelstv 	if (strcmp(iaa->iaa_name, "igmafb") == 0) return 100;
    112  1.1  mlelstv 	return 0;
    113  1.1  mlelstv }
    114  1.1  mlelstv 
    115  1.1  mlelstv static void
    116  1.1  mlelstv igmafb_attach(device_t parent, device_t self, void *aux)
    117  1.1  mlelstv {
    118  1.1  mlelstv 	struct igmafb_softc *sc = device_private(self);
    119  1.1  mlelstv 	struct igma_attach_args *iaa = (struct igma_attach_args *)aux;
    120  1.1  mlelstv 	struct rasops_info *ri;
    121  1.1  mlelstv 	prop_dictionary_t dict;
    122  1.1  mlelstv 	bool is_console;
    123  1.1  mlelstv 	unsigned long defattr;
    124  1.1  mlelstv 	struct wsemuldisplaydev_attach_args waa;
    125  1.1  mlelstv 
    126  1.1  mlelstv 	sc->sc_dev = self;
    127  1.1  mlelstv 
    128  1.1  mlelstv 	aprint_normal("\n");
    129  1.1  mlelstv 
    130  1.1  mlelstv 	dict = device_properties(self);
    131  1.1  mlelstv 	prop_dictionary_get_bool(dict, "is_console", &is_console);
    132  1.1  mlelstv 	if (iaa->iaa_console)
    133  1.1  mlelstv 		is_console = true;
    134  1.1  mlelstv 
    135  1.1  mlelstv 	sc->sc_chip = iaa->iaa_chip;
    136  1.1  mlelstv 
    137  1.1  mlelstv 	sc->sc_fbaddr = bus_space_vaddr(sc->sc_chip.gmt, sc->sc_chip.gmh);
    138  1.1  mlelstv 	sc->sc_fbsize = 16 * 1024 * 1024;
    139  1.1  mlelstv 
    140  1.1  mlelstv 	igmafb_guess_size(sc, &sc->sc_width, &sc->sc_height);
    141  1.1  mlelstv 	sc->sc_depth = 32;
    142  1.1  mlelstv 	sc->sc_stride = (sc->sc_width*4 + 511)/512*512;
    143  1.1  mlelstv 
    144  1.1  mlelstv 	aprint_normal("%s: %d x %d, %d bit, stride %d\n", device_xname(self),
    145  1.1  mlelstv 		sc->sc_width, sc->sc_height, sc->sc_depth, sc->sc_stride);
    146  1.1  mlelstv 
    147  1.2      rin 	aprint_normal("%s: %d MB video memory at %p\n", device_xname(self),
    148  1.1  mlelstv 		(int)sc->sc_fbsize >> 20, (void *)sc->sc_chip.gmb);
    149  1.1  mlelstv 
    150  1.1  mlelstv 	sc->sc_vga_save = kmem_alloc(256*1024, KM_SLEEP);
    151  1.1  mlelstv 
    152  1.1  mlelstv 	igmafb_get_brightness(sc, &sc->sc_brightness);
    153  1.1  mlelstv 	igmafb_get_brightness_max(sc, &sc->sc_brightness_max);
    154  1.1  mlelstv 	sc->sc_backlight = sc->sc_brightness != 0;
    155  1.1  mlelstv 
    156  1.1  mlelstv 	sc->sc_defaultscreen_descr = (struct wsscreen_descr){
    157  1.1  mlelstv 		"default",
    158  1.1  mlelstv 		0, 0,
    159  1.1  mlelstv 		NULL,
    160  1.1  mlelstv 		8, 16,
    161  1.1  mlelstv 		WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
    162  1.1  mlelstv 		NULL
    163  1.1  mlelstv 	};
    164  1.1  mlelstv 	sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
    165  1.1  mlelstv 	sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
    166  1.1  mlelstv 
    167  1.1  mlelstv 	vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
    168  1.1  mlelstv 		&igmafb_accessops);
    169  1.1  mlelstv 	sc->vd.init_screen = igmafb_init_screen;
    170  1.1  mlelstv 
    171  1.1  mlelstv 	/* enable hardware display */
    172  1.1  mlelstv 	igmafb_set_mode(sc, true);
    173  1.1  mlelstv 
    174  1.1  mlelstv 	ri = &sc->sc_console_screen.scr_ri;
    175  1.1  mlelstv 
    176  1.1  mlelstv 	if (is_console) {
    177  1.1  mlelstv 		vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
    178  1.1  mlelstv 			&defattr);
    179  1.1  mlelstv 
    180  1.1  mlelstv 		sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC
    181  1.1  mlelstv 			| VCONS_NO_COPYROWS | VCONS_NO_COPYCOLS;
    182  1.1  mlelstv 		vcons_redraw_screen(&sc->sc_console_screen);
    183  1.1  mlelstv 
    184  1.1  mlelstv 		sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
    185  1.1  mlelstv 		sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
    186  1.1  mlelstv 		sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
    187  1.1  mlelstv 		sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
    188  1.1  mlelstv 
    189  1.1  mlelstv 		wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
    190  1.1  mlelstv 			defattr);
    191  1.1  mlelstv 		vcons_replay_msgbuf(&sc->sc_console_screen);
    192  1.1  mlelstv 	} else {
    193  1.1  mlelstv 		if (sc->sc_console_screen.scr_ri.ri_rows == 0) {
    194  1.1  mlelstv 			/* do some minimal setup to avoid weirdness later */
    195  1.1  mlelstv 			vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
    196  1.1  mlelstv 				&defattr);
    197  1.1  mlelstv 		} else
    198  1.1  mlelstv 			(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    199  1.1  mlelstv 	}
    200  1.1  mlelstv 
    201  1.1  mlelstv 	waa.console = is_console;
    202  1.1  mlelstv 	waa.scrdata = &sc->sc_screenlist;
    203  1.1  mlelstv 	waa.accessops = &igmafb_accessops;
    204  1.1  mlelstv 	waa.accesscookie = &sc->vd;
    205  1.1  mlelstv 
    206  1.4  thorpej 	config_found(sc->sc_dev, &waa, wsemuldisplaydevprint, CFARGS_NONE);
    207  1.1  mlelstv }
    208  1.1  mlelstv 
    209  1.1  mlelstv /*
    210  1.1  mlelstv  * wsdisplay accessops
    211  1.1  mlelstv  */
    212  1.1  mlelstv 
    213  1.1  mlelstv static int
    214  1.1  mlelstv igmafb_ioctl(void *v, void *vs, u_long cmd, void *data, int flags,
    215  1.1  mlelstv     struct lwp *l)
    216  1.1  mlelstv {
    217  1.1  mlelstv 	struct vcons_data *vd = v;
    218  1.1  mlelstv 	struct igmafb_softc *sc = vd->cookie;
    219  1.1  mlelstv 	struct wsdisplay_fbinfo *wdf;
    220  1.1  mlelstv 	struct vcons_screen *ms = vd->active;
    221  1.1  mlelstv 	struct wsdisplayio_fbinfo *fbi;
    222  1.1  mlelstv 	struct wsdisplay_param *param;
    223  1.1  mlelstv 	int val;
    224  1.1  mlelstv 
    225  1.1  mlelstv 	switch (cmd) {
    226  1.1  mlelstv 	case WSDISPLAYIO_GTYPE:
    227  1.1  mlelstv 		*(u_int *)data = WSDISPLAY_TYPE_PCIMISC;
    228  1.1  mlelstv 		return 0;
    229  1.1  mlelstv 	case WSDISPLAYIO_GINFO:
    230  1.1  mlelstv 		if (ms == NULL)
    231  1.1  mlelstv 			return ENODEV;
    232  1.1  mlelstv 		wdf = data;
    233  1.1  mlelstv 		wdf->width  = ms->scr_ri.ri_width;
    234  1.1  mlelstv 		wdf->height = ms->scr_ri.ri_height;
    235  1.1  mlelstv 		wdf->depth  = ms->scr_ri.ri_depth;
    236  1.1  mlelstv 		wdf->cmsize = 256; /* XXX */
    237  1.1  mlelstv 		return 0;
    238  1.1  mlelstv 	case WSDISPLAYIO_LINEBYTES:
    239  1.1  mlelstv 		if (ms == NULL)
    240  1.1  mlelstv 			return ENODEV;
    241  1.1  mlelstv 		*(u_int *)data = ms->scr_ri.ri_stride;
    242  1.1  mlelstv 		return 0;
    243  1.1  mlelstv 	case WSDISPLAYIO_GET_FBINFO:
    244  1.1  mlelstv 		fbi = data;
    245  1.1  mlelstv 		return wsdisplayio_get_fbinfo(&ms->scr_ri, fbi);
    246  1.1  mlelstv 	case WSDISPLAYIO_SVIDEO:
    247  1.1  mlelstv 		val = (*(u_int *)data) != WSDISPLAYIO_VIDEO_OFF;
    248  1.1  mlelstv 		sc->sc_backlight = val;
    249  1.1  mlelstv 		if (val)
    250  1.1  mlelstv 			igmafb_set_brightness(sc, sc->sc_brightness);
    251  1.1  mlelstv 		else
    252  1.1  mlelstv 			igmafb_set_brightness(sc, 0);
    253  1.1  mlelstv 		return 0;
    254  1.1  mlelstv 	case WSDISPLAYIO_GETPARAM:
    255  1.1  mlelstv 		param = (struct wsdisplay_param *)data;
    256  1.1  mlelstv 		switch (param->param) {
    257  1.1  mlelstv 		case WSDISPLAYIO_PARAM_BRIGHTNESS:
    258  1.1  mlelstv 			param->min = 0;
    259  1.1  mlelstv 			param->max = 255;
    260  1.1  mlelstv 			if (sc->sc_backlight)
    261  1.1  mlelstv 				igmafb_get_brightness(sc, &val);
    262  1.1  mlelstv 			else
    263  1.1  mlelstv 				val = sc->sc_brightness;
    264  1.1  mlelstv 			val = val * 255 / sc->sc_brightness_max;
    265  1.1  mlelstv 			param->curval = val;
    266  1.1  mlelstv 			return 0;
    267  1.1  mlelstv 		case WSDISPLAYIO_PARAM_BACKLIGHT:
    268  1.1  mlelstv 			param->min = 0;
    269  1.1  mlelstv 			param->max = 1;
    270  1.1  mlelstv 			param->curval = sc->sc_backlight;
    271  1.1  mlelstv 			return 0;
    272  1.1  mlelstv 		}
    273  1.1  mlelstv 		return EPASSTHROUGH;
    274  1.1  mlelstv 	case WSDISPLAYIO_SETPARAM:
    275  1.1  mlelstv 		param = (struct wsdisplay_param *)data;
    276  1.1  mlelstv 		switch (param->param) {
    277  1.1  mlelstv 		case WSDISPLAYIO_PARAM_BRIGHTNESS:
    278  1.1  mlelstv 			val = param->curval;
    279  1.1  mlelstv 			if (val < 0)
    280  1.1  mlelstv 				val = 0;
    281  1.1  mlelstv 			if (val > 255)
    282  1.1  mlelstv 				val = 255;
    283  1.1  mlelstv 			val = val * sc->sc_brightness_max / 255;
    284  1.1  mlelstv 			sc->sc_brightness = val;
    285  1.1  mlelstv 			if (sc->sc_backlight)
    286  1.1  mlelstv 				igmafb_set_brightness(sc, val);
    287  1.1  mlelstv 			return 0;
    288  1.1  mlelstv 		case WSDISPLAYIO_PARAM_BACKLIGHT:
    289  1.1  mlelstv 			val = param->curval;
    290  1.1  mlelstv 			sc->sc_backlight = val;
    291  1.1  mlelstv 			if (val)
    292  1.1  mlelstv 				igmafb_set_brightness(sc, sc->sc_brightness);
    293  1.1  mlelstv 			else
    294  1.1  mlelstv 				igmafb_set_brightness(sc, 0);
    295  1.1  mlelstv 			return 0;
    296  1.1  mlelstv 		}
    297  1.1  mlelstv 		return EPASSTHROUGH;
    298  1.1  mlelstv 	}
    299  1.1  mlelstv 
    300  1.1  mlelstv 	return EPASSTHROUGH;
    301  1.1  mlelstv }
    302  1.1  mlelstv 
    303  1.1  mlelstv static paddr_t
    304  1.1  mlelstv igmafb_mmap(void *v, void *vs, off_t offset, int prot)
    305  1.1  mlelstv {
    306  1.1  mlelstv 	struct vcons_data *vd = v;
    307  1.1  mlelstv 	struct igmafb_softc *sc = vd->cookie;
    308  1.1  mlelstv 
    309  1.1  mlelstv 	if ((offset & PAGE_MASK) != 0)
    310  1.1  mlelstv 		return -1;
    311  1.1  mlelstv 
    312  1.1  mlelstv 	if (offset < 0 || offset >= sc->sc_fbsize)
    313  1.1  mlelstv 		return -1;
    314  1.1  mlelstv 
    315  1.1  mlelstv 	return bus_space_mmap(sc->sc_chip.gmt, sc->sc_chip.gmb, offset, prot,
    316  1.1  mlelstv 		BUS_SPACE_MAP_LINEAR);
    317  1.1  mlelstv }
    318  1.1  mlelstv 
    319  1.1  mlelstv static void
    320  1.1  mlelstv igmafb_pollc(void *v, int on)
    321  1.1  mlelstv {
    322  1.1  mlelstv 	struct vcons_data *vd = v;
    323  1.1  mlelstv 	struct igmafb_softc *sc = vd->cookie;
    324  1.1  mlelstv 
    325  1.1  mlelstv 	if (sc == NULL)
    326  1.1  mlelstv 		return;
    327  1.1  mlelstv 	if (sc->sc_console_screen.scr_vd == NULL)
    328  1.1  mlelstv 		return;
    329  1.1  mlelstv 
    330  1.1  mlelstv 	if (on)
    331  1.1  mlelstv 		vcons_enable_polling(&sc->vd);
    332  1.1  mlelstv 	else
    333  1.1  mlelstv 		vcons_disable_polling(&sc->vd);
    334  1.1  mlelstv }
    335  1.1  mlelstv 
    336  1.1  mlelstv static void
    337  1.1  mlelstv igmafb_init_screen(void *cookie, struct vcons_screen *scr,
    338  1.1  mlelstv     int existing, long *defattr)
    339  1.1  mlelstv {
    340  1.1  mlelstv 	struct igmafb_softc *sc = cookie;
    341  1.1  mlelstv 	struct rasops_info *ri = &scr->scr_ri;
    342  1.1  mlelstv 
    343  1.1  mlelstv 	memset(ri, 0, sizeof(struct rasops_info));
    344  1.1  mlelstv 
    345  1.1  mlelstv 	ri->ri_depth = sc->sc_depth;
    346  1.1  mlelstv 	ri->ri_width = sc->sc_width;
    347  1.1  mlelstv 	ri->ri_height = sc->sc_height;
    348  1.1  mlelstv 	ri->ri_stride = sc->sc_stride;
    349  1.1  mlelstv 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
    350  1.1  mlelstv 
    351  1.1  mlelstv 	ri->ri_bits = (char *)sc->sc_fbaddr;
    352  1.1  mlelstv 
    353  1.1  mlelstv 	if (existing) {
    354  1.1  mlelstv 		ri->ri_flg |= RI_CLEAR;
    355  1.1  mlelstv 	}
    356  1.1  mlelstv 
    357  1.1  mlelstv 	switch (sc->sc_depth) {
    358  1.1  mlelstv 	case 32:
    359  1.1  mlelstv 		ri->ri_rnum = 8;
    360  1.1  mlelstv 		ri->ri_gnum = 8;
    361  1.1  mlelstv 		ri->ri_bnum = 8;
    362  1.1  mlelstv 		ri->ri_rpos = 16;
    363  1.1  mlelstv 		ri->ri_gpos = 8;
    364  1.1  mlelstv 		ri->ri_bpos = 0;
    365  1.1  mlelstv 		break;
    366  1.1  mlelstv 	}
    367  1.1  mlelstv 
    368  1.1  mlelstv 	rasops_init(ri, 0, 0);
    369  1.1  mlelstv 	ri->ri_caps = WSSCREEN_WSCOLORS;
    370  1.1  mlelstv 
    371  1.1  mlelstv 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    372  1.1  mlelstv 		sc->sc_width / ri->ri_font->fontwidth);
    373  1.1  mlelstv 
    374  1.1  mlelstv 	ri->ri_hw = scr;
    375  1.1  mlelstv }
    376  1.1  mlelstv 
    377  1.1  mlelstv static void
    378  1.1  mlelstv igmafb_guess_size(struct igmafb_softc *sc, int *widthp, int *heightp)
    379  1.1  mlelstv {
    380  1.1  mlelstv 	const struct igma_chip *cd = &sc->sc_chip;
    381  1.1  mlelstv 	const struct igma_chip_ops *co = cd->ops;
    382  1.1  mlelstv 	int pipe = cd->use_pipe;
    383  1.1  mlelstv 	u_int32_t r;
    384  1.1  mlelstv 
    385  1.1  mlelstv 	r = co->read_reg(cd, PIPE_HTOTAL(pipe));
    386  1.1  mlelstv 	*widthp = PIPE_HTOTAL_GET_ACTIVE(r);
    387  1.1  mlelstv 	r = co->read_reg(cd, PIPE_VTOTAL(pipe));
    388  1.1  mlelstv 	*heightp = PIPE_VTOTAL_GET_ACTIVE(r);
    389  1.1  mlelstv 
    390  1.1  mlelstv 	aprint_normal("%s: vga active size %d x %d\n",
    391  1.1  mlelstv 		device_xname(sc->sc_dev),
    392  1.1  mlelstv 		*widthp, *heightp);
    393  1.1  mlelstv 
    394  1.1  mlelstv 	if (*widthp < 640 || *heightp < 400) {
    395  1.1  mlelstv 		r = co->read_reg(cd, PF_WINSZ(pipe));
    396  1.1  mlelstv 		*widthp  = PF_WINSZ_GET_WIDTH(r);
    397  1.1  mlelstv 		*heightp = PF_WINSZ_GET_HEIGHT(r);
    398  1.1  mlelstv 
    399  1.1  mlelstv 		aprint_normal("%s: window size %d x %d\n",
    400  1.1  mlelstv 			device_xname(sc->sc_dev),
    401  1.1  mlelstv 			*widthp, *heightp);
    402  1.1  mlelstv 	}
    403  1.1  mlelstv 
    404  1.1  mlelstv 	if (*widthp  < 640) *widthp  = 640;
    405  1.1  mlelstv 	if (*heightp < 400) *heightp = 400;
    406  1.1  mlelstv }
    407  1.1  mlelstv 
    408  1.1  mlelstv static void
    409  1.1  mlelstv igmafb_set_mode(struct igmafb_softc *sc, bool enable)
    410  1.1  mlelstv {
    411  1.1  mlelstv 	const struct igma_chip *cd = &sc->sc_chip;
    412  1.1  mlelstv 	const struct igma_chip_ops *co = cd->ops;
    413  1.1  mlelstv 	int pipe = cd->use_pipe;
    414  1.1  mlelstv 	u_int32_t r;
    415  1.1  mlelstv 	u_int8_t b;
    416  1.1  mlelstv 	int i;
    417  1.1  mlelstv 
    418  1.1  mlelstv 	if (enable) {
    419  1.1  mlelstv 		/* disable VGA machinery */
    420  1.1  mlelstv 		b = co->read_vga(cd, 0x01);
    421  1.1  mlelstv 		co->write_vga(cd, 0x01, b | 0x20);
    422  1.1  mlelstv 
    423  1.1  mlelstv 		/* disable VGA compatible display */
    424  1.1  mlelstv 		r = co->read_reg(cd, sc->sc_chip.vga_cntrl);
    425  1.1  mlelstv 		co->write_reg(cd, sc->sc_chip.vga_cntrl, r | VGA_CNTRL_DISABLE);
    426  1.1  mlelstv 
    427  1.1  mlelstv 		/* save VGA memory */
    428  1.1  mlelstv 		memcpy(sc->sc_vga_save, sc->sc_fbaddr, 256*1024);
    429  1.1  mlelstv 
    430  1.1  mlelstv 		/* configure panel fitter */
    431  1.1  mlelstv 		co->write_reg(cd, PF_WINPOS(pipe),
    432  1.1  mlelstv 			PF_WINPOS_VAL(0, 0));
    433  1.1  mlelstv 		co->write_reg(cd, PF_WINSZ(pipe),
    434  1.1  mlelstv 			PF_WINSZ_VAL(sc->sc_width, sc->sc_height));
    435  1.1  mlelstv 
    436  1.1  mlelstv 		/* pipe size */
    437  1.1  mlelstv 		co->write_reg(cd, PIPE_SRCSZ(pipe),
    438  1.1  mlelstv 			PIPE_SRCSZ_VAL(sc->sc_width, sc->sc_height));
    439  1.1  mlelstv 
    440  1.1  mlelstv 		/* enable pipe */
    441  1.1  mlelstv 		co->write_reg(cd, PIPE_CONF(pipe),
    442  1.1  mlelstv 			PIPE_CONF_ENABLE | PIPE_CONF_8BPP);
    443  1.1  mlelstv 
    444  1.1  mlelstv 		/* configure planes */
    445  1.1  mlelstv 		r = co->read_reg(cd, PRI_CTRL(pipe));
    446  1.1  mlelstv 		r &= ~(PRI_CTRL_PIXFMTMSK | PRI_CTRL_TILED);
    447  1.1  mlelstv 		r |= PRI_CTRL_ENABLE | PRI_CTRL_BGR;
    448  1.1  mlelstv 		co->write_reg(cd, PRI_CTRL(pipe), r | cd->pri_cntrl);
    449  1.1  mlelstv 		co->write_reg(cd, PRI_LINOFF(pipe), 0);
    450  1.1  mlelstv 		co->write_reg(cd, PRI_STRIDE(pipe), sc->sc_stride);
    451  1.1  mlelstv 		co->write_reg(cd, PRI_SURF(pipe), 0);
    452  1.1  mlelstv 		co->write_reg(cd, PRI_TILEOFF(pipe), 0);
    453  1.1  mlelstv 
    454  1.1  mlelstv 		if (cd->quirks & IGMA_PLANESTART_QUIRK)
    455  1.1  mlelstv 			igmafb_planestart_quirk(sc);
    456  1.1  mlelstv 
    457  1.1  mlelstv 		if (cd->quirks & IGMA_PFITDISABLE_QUIRK)
    458  1.1  mlelstv 			igmafb_pfitdisable_quirk(sc);
    459  1.1  mlelstv 	} else {
    460  1.1  mlelstv 		/* disable planes */
    461  1.1  mlelstv 		co->write_reg(cd, PRI_CTRL(pipe), 0 | cd->pri_cntrl);
    462  1.1  mlelstv 		co->write_reg(cd, PRI_LINOFF(pipe), 0);
    463  1.1  mlelstv 		co->write_reg(cd, PRI_STRIDE(pipe), 2560);
    464  1.1  mlelstv 		co->write_reg(cd, PRI_SURF(pipe), 0);
    465  1.1  mlelstv 		co->write_reg(cd, PRI_TILEOFF(pipe), 0);
    466  1.1  mlelstv 
    467  1.1  mlelstv 		/* pipe size */
    468  1.1  mlelstv 		co->write_reg(cd, PIPE_SRCSZ(pipe),
    469  1.1  mlelstv 			PIPE_SRCSZ_VAL(720,400));
    470  1.1  mlelstv 
    471  1.1  mlelstv 		/* disable pipe */
    472  1.1  mlelstv 		co->write_reg(cd, PIPE_CONF(pipe), 0);
    473  1.1  mlelstv 		for (i=0; i<10; ++i) {
    474  1.1  mlelstv 			delay(10);
    475  1.1  mlelstv 			if ((co->read_reg(cd, PIPE_CONF(pipe)) & PIPE_CONF_STATE) == 0)
    476  1.1  mlelstv 				break;
    477  1.1  mlelstv 		}
    478  1.1  mlelstv 
    479  1.1  mlelstv 		/* workaround before enabling VGA */
    480  1.1  mlelstv 		r = co->read_reg(cd, 0x42000);
    481  1.1  mlelstv 		co->write_reg(cd, 0x42000, (r & 0x1fffffff) | 0xa0000000);
    482  1.1  mlelstv 		r = co->read_reg(cd, 0x42004);
    483  1.1  mlelstv 		co->write_reg(cd, 0x42004, (r & 0xfbffffff) | 0x00000000);
    484  1.1  mlelstv 
    485  1.1  mlelstv 		/* configure panel fitter */
    486  1.1  mlelstv 		co->write_reg(cd, PF_WINPOS(pipe),
    487  1.1  mlelstv 			PF_WINPOS_VAL(0, 0));
    488  1.1  mlelstv 		co->write_reg(cd, PF_WINSZ(pipe),
    489  1.1  mlelstv 			PF_WINSZ_VAL(sc->sc_width, sc->sc_height));
    490  1.1  mlelstv 
    491  1.1  mlelstv 		/* enable VGA compatible display */
    492  1.1  mlelstv 		r = co->read_reg(cd, sc->sc_chip.vga_cntrl);
    493  1.1  mlelstv 		co->write_reg(cd, sc->sc_chip.vga_cntrl, r & ~VGA_CNTRL_DISABLE);
    494  1.1  mlelstv 
    495  1.1  mlelstv 		/* enable VGA machinery */
    496  1.1  mlelstv 		b = co->read_vga(cd, 0x01);
    497  1.1  mlelstv 		co->write_vga(cd, 0x01, b & ~0x20);
    498  1.1  mlelstv 
    499  1.1  mlelstv 		/* restore VGA memory */
    500  1.1  mlelstv 		memcpy(sc->sc_fbaddr, sc->sc_vga_save, 256*1024);
    501  1.1  mlelstv 
    502  1.1  mlelstv 		/* enable pipe again */
    503  1.1  mlelstv 		co->write_reg(cd, PIPE_CONF(pipe),
    504  1.1  mlelstv 			PIPE_CONF_ENABLE | PIPE_CONF_6BPP | PIPE_CONF_DITHER);
    505  1.1  mlelstv 	}
    506  1.1  mlelstv }
    507  1.1  mlelstv 
    508  1.1  mlelstv static void
    509  1.1  mlelstv igmafb_planestart_quirk(struct igmafb_softc *sc)
    510  1.1  mlelstv {
    511  1.1  mlelstv 	const struct igma_chip *cd = &sc->sc_chip;
    512  1.1  mlelstv 	const struct igma_chip_ops *co = cd->ops;
    513  1.1  mlelstv 	int pipe = cd->use_pipe;
    514  1.1  mlelstv 	u_int32_t cntrl, fwbcl;
    515  1.1  mlelstv 
    516  1.1  mlelstv 	/* disable self refresh */
    517  1.1  mlelstv 	fwbcl = co->read_reg(cd, FW_BLC_SELF);
    518  1.1  mlelstv 	co->write_reg(cd, FW_BLC_SELF, fwbcl & ~FW_BLC_SELF_EN);
    519  1.1  mlelstv 
    520  1.1  mlelstv 	cntrl = co->read_reg(cd, CUR_CNTR(pipe));
    521  1.1  mlelstv 	co->write_reg(cd, CUR_CNTR(pipe), 1<<5 | 0x07);
    522  1.1  mlelstv 
    523  1.1  mlelstv 	/* "wait for vblank" */
    524  1.1  mlelstv 	delay(40000);
    525  1.1  mlelstv 
    526  1.1  mlelstv 	co->write_reg(cd, CUR_CNTR(pipe), cntrl);
    527  1.1  mlelstv 	co->write_reg(cd, CUR_BASE(pipe),
    528  1.1  mlelstv 		co->read_reg(cd, CUR_BASE(pipe)));
    529  1.1  mlelstv 
    530  1.1  mlelstv 	co->write_reg(cd, FW_BLC_SELF, fwbcl);
    531  1.1  mlelstv }
    532  1.1  mlelstv 
    533  1.1  mlelstv static void
    534  1.1  mlelstv igmafb_pfitdisable_quirk(struct igmafb_softc *sc)
    535  1.1  mlelstv {
    536  1.1  mlelstv 	const struct igma_chip *cd = &sc->sc_chip;
    537  1.1  mlelstv 	const struct igma_chip_ops *co = cd->ops;
    538  1.1  mlelstv 	u_int32_t r;
    539  1.1  mlelstv 
    540  1.1  mlelstv 	/* disable i965 panel fitter */
    541  1.1  mlelstv 	r = co->read_reg(cd, PF_CTRL_I965);
    542  1.1  mlelstv 	co->write_reg(cd, PF_CTRL_I965, r & ~PF_ENABLE);
    543  1.1  mlelstv }
    544  1.1  mlelstv 
    545  1.1  mlelstv static void
    546  1.1  mlelstv igmafb_get_brightness_max(struct igmafb_softc *sc, int *valp)
    547  1.1  mlelstv {
    548  1.1  mlelstv 	const struct igma_chip *cd = &sc->sc_chip;
    549  1.1  mlelstv 	const struct igma_chip_ops *co = cd->ops;
    550  1.1  mlelstv 	u_int32_t r, f;
    551  1.1  mlelstv 
    552  1.1  mlelstv 	r = co->read_reg(cd, cd->backlight_cntrl);
    553  1.1  mlelstv 	f = BACKLIGHT_GET_FREQ(r);
    554  1.1  mlelstv 	if (f == 0) {
    555  1.1  mlelstv 		r = co->read_reg(cd, RAWCLK_FREQ);
    556  1.1  mlelstv 		f = r * 1000000 / (200 * 128);
    557  1.1  mlelstv 		if (f == 0 || f > 32767)
    558  1.1  mlelstv 			f = 125 * 100000 / (200 * 128);
    559  1.1  mlelstv 	}
    560  1.1  mlelstv 
    561  1.1  mlelstv 	*valp = f;
    562  1.1  mlelstv }
    563  1.1  mlelstv 
    564  1.1  mlelstv static void
    565  1.1  mlelstv igmafb_get_brightness(struct igmafb_softc *sc, int *valp)
    566  1.1  mlelstv {
    567  1.1  mlelstv 	const struct igma_chip *cd = &sc->sc_chip;
    568  1.1  mlelstv 	const struct igma_chip_ops *co = cd->ops;
    569  1.1  mlelstv 	u_int32_t r, v;
    570  1.1  mlelstv 
    571  1.1  mlelstv 	r = co->read_reg(cd, cd->backlight_cntrl);
    572  1.1  mlelstv 	v = BACKLIGHT_GET_CYCLE(r);
    573  1.1  mlelstv 	*valp = v;
    574  1.1  mlelstv }
    575  1.1  mlelstv 
    576  1.1  mlelstv static void
    577  1.1  mlelstv igmafb_set_brightness(struct igmafb_softc *sc, int val)
    578  1.1  mlelstv {
    579  1.1  mlelstv 	const struct igma_chip *cd = &sc->sc_chip;
    580  1.1  mlelstv 	const struct igma_chip_ops *co = cd->ops;
    581  1.1  mlelstv 	u_int32_t r, f, l;
    582  1.1  mlelstv 
    583  1.1  mlelstv 	r = co->read_reg(cd, cd->backlight_cntrl);
    584  1.1  mlelstv 	f = BACKLIGHT_GET_FREQ(r);
    585  1.1  mlelstv 	l = BACKLIGHT_GET_LEGACY(r);
    586  1.1  mlelstv 
    587  1.1  mlelstv 	co->write_reg(cd, cd->backlight_cntrl,
    588  1.1  mlelstv 		BACKLIGHT_VAL(f,l,val));
    589  1.1  mlelstv }
    590  1.1  mlelstv 
    591