Home | History | Annotate | Line # | Download | only in ic
igsfb.c revision 1.47
      1  1.47  macallan /*	$NetBSD: igsfb.c,v 1.47 2009/11/18 21:59:38 macallan Exp $ */
      2   1.1       uwe 
      3   1.1       uwe /*
      4   1.8       uwe  * Copyright (c) 2002, 2003 Valeriy E. Ushakov
      5   1.1       uwe  * All rights reserved.
      6   1.1       uwe  *
      7   1.1       uwe  * Redistribution and use in source and binary forms, with or without
      8   1.1       uwe  * modification, are permitted provided that the following conditions
      9   1.1       uwe  * are met:
     10   1.1       uwe  * 1. Redistributions of source code must retain the above copyright
     11   1.1       uwe  *    notice, this list of conditions and the following disclaimer.
     12   1.1       uwe  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1       uwe  *    notice, this list of conditions and the following disclaimer in the
     14   1.1       uwe  *    documentation and/or other materials provided with the distribution.
     15   1.1       uwe  * 3. The name of the author may not be used to endorse or promote products
     16   1.1       uwe  *    derived from this software without specific prior written permission
     17   1.1       uwe  *
     18   1.1       uwe  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19   1.1       uwe  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     20   1.1       uwe  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     21   1.1       uwe  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     22   1.1       uwe  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     23   1.1       uwe  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     24   1.1       uwe  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     25   1.1       uwe  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     26   1.1       uwe  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     27   1.1       uwe  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     28   1.1       uwe  */
     29   1.1       uwe 
     30   1.1       uwe /*
     31   1.4       uwe  * Integraphics Systems IGA 168x and CyberPro series.
     32   1.1       uwe  */
     33   1.1       uwe #include <sys/cdefs.h>
     34  1.47  macallan __KERNEL_RCSID(0, "$NetBSD: igsfb.c,v 1.47 2009/11/18 21:59:38 macallan Exp $");
     35   1.1       uwe 
     36   1.1       uwe #include <sys/param.h>
     37   1.1       uwe #include <sys/systm.h>
     38   1.1       uwe #include <sys/kernel.h>
     39   1.1       uwe #include <sys/device.h>
     40   1.1       uwe #include <sys/malloc.h>
     41   1.2       uwe #include <sys/ioctl.h>
     42   1.1       uwe 
     43  1.43        ad #include <sys/bus.h>
     44   1.1       uwe 
     45   1.1       uwe #include <dev/wscons/wsdisplayvar.h>
     46   1.8       uwe #include <dev/wscons/wsconsio.h>
     47   1.8       uwe #include <dev/wsfont/wsfont.h>
     48   1.1       uwe #include <dev/rasops/rasops.h>
     49   1.1       uwe 
     50  1.27  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     51  1.27  macallan 
     52   1.1       uwe #include <dev/ic/igsfbreg.h>
     53   1.1       uwe #include <dev/ic/igsfbvar.h>
     54   1.1       uwe 
     55   1.1       uwe 
     56  1.46  macallan struct igsfb_devconfig igsfb_console_dc = {
     57  1.46  macallan 	.dc_mmap = NULL,
     58  1.46  macallan 	.dc_modestring = "",
     59  1.46  macallan };
     60   1.8       uwe 
     61   1.1       uwe /*
     62   1.1       uwe  * wsscreen
     63   1.1       uwe  */
     64   1.1       uwe 
     65  1.33       uwe /* filled from rasops_info in igsfb_init_wsdisplay */
     66   1.1       uwe static struct wsscreen_descr igsfb_stdscreen = {
     67  1.33       uwe 	.name = "std",
     68   1.1       uwe };
     69   1.1       uwe 
     70   1.1       uwe static const struct wsscreen_descr *_igsfb_scrlist[] = {
     71   1.1       uwe 	&igsfb_stdscreen,
     72   1.1       uwe };
     73   1.1       uwe 
     74   1.1       uwe static const struct wsscreen_list igsfb_screenlist = {
     75  1.33       uwe 	.nscreens = sizeof(_igsfb_scrlist) / sizeof(_igsfb_scrlist[0]),
     76  1.33       uwe 	.screens = _igsfb_scrlist,
     77   1.1       uwe };
     78   1.1       uwe 
     79   1.1       uwe 
     80   1.1       uwe /*
     81   1.1       uwe  * wsdisplay_accessops
     82   1.1       uwe  */
     83   1.1       uwe 
     84  1.42  christos static int	igsfb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     85  1.38      jmmv static paddr_t	igsfb_mmap(void *, void *, off_t, int);
     86   1.1       uwe 
     87  1.27  macallan static struct wsdisplay_accessops igsfb_accessops = {
     88  1.33       uwe 	.ioctl = igsfb_ioctl,
     89  1.33       uwe 	.mmap = igsfb_mmap,
     90   1.1       uwe };
     91   1.1       uwe 
     92   1.1       uwe 
     93   1.1       uwe /*
     94  1.11       uwe  * acceleration
     95  1.11       uwe  */
     96  1.27  macallan static int	igsfb_make_text_cursor(struct igsfb_devconfig *,
     97  1.31       uwe 				       struct vcons_screen *);
     98  1.11       uwe static void	igsfb_accel_cursor(void *, int, int, int);
     99  1.11       uwe 
    100  1.12       uwe static int	igsfb_accel_wait(struct igsfb_devconfig *);
    101  1.12       uwe static void	igsfb_accel_fill(struct igsfb_devconfig *,
    102  1.19       uwe 				 uint32_t, uint32_t, uint16_t, uint16_t);
    103  1.12       uwe static void	igsfb_accel_copy(struct igsfb_devconfig *,
    104  1.19       uwe 				 uint32_t, uint32_t, uint16_t, uint16_t);
    105  1.12       uwe 
    106  1.12       uwe static void	igsfb_accel_copycols(void *, int, int, int, int);
    107  1.12       uwe static void	igsfb_accel_erasecols(void *, int, int, int, long);
    108  1.12       uwe static void	igsfb_accel_copyrows(void *, int, int, int);
    109  1.12       uwe static void	igsfb_accel_eraserows(void *, int, int, long);
    110  1.12       uwe static void	igsfb_accel_putchar(void *, int, int, u_int, long);
    111  1.12       uwe 
    112  1.11       uwe 
    113  1.11       uwe /*
    114   1.1       uwe  * internal functions
    115   1.1       uwe  */
    116   1.8       uwe static int	igsfb_init_video(struct igsfb_devconfig *);
    117   1.8       uwe static void	igsfb_init_cmap(struct igsfb_devconfig *);
    118  1.19       uwe static uint16_t	igsfb_spread_bits_8(uint8_t);
    119  1.10       uwe static void	igsfb_init_bit_table(struct igsfb_devconfig *);
    120  1.27  macallan static void	igsfb_init_wsdisplay(void *, struct vcons_screen *, int,
    121  1.31       uwe 				     long *);
    122  1.27  macallan 
    123   1.8       uwe 
    124   1.8       uwe static void	igsfb_blank_screen(struct igsfb_devconfig *, int);
    125   1.8       uwe static int	igsfb_get_cmap(struct igsfb_devconfig *,
    126   1.8       uwe 			       struct wsdisplay_cmap *);
    127   1.8       uwe static int	igsfb_set_cmap(struct igsfb_devconfig *,
    128   1.9       uwe 			       const struct wsdisplay_cmap *);
    129   1.8       uwe static void	igsfb_update_cmap(struct igsfb_devconfig *, u_int, u_int);
    130   1.8       uwe static void	igsfb_set_curpos(struct igsfb_devconfig *,
    131   1.9       uwe 				 const struct wsdisplay_curpos *);
    132   1.8       uwe static void	igsfb_update_curpos(struct igsfb_devconfig *);
    133   1.8       uwe static int	igsfb_get_cursor(struct igsfb_devconfig *,
    134   1.1       uwe 				 struct wsdisplay_cursor *);
    135   1.8       uwe static int	igsfb_set_cursor(struct igsfb_devconfig *,
    136   1.9       uwe 				 const struct wsdisplay_cursor *);
    137   1.8       uwe static void	igsfb_update_cursor(struct igsfb_devconfig *, u_int);
    138   1.8       uwe static void	igsfb_convert_cursor_data(struct igsfb_devconfig *,
    139   1.8       uwe 					  u_int, u_int);
    140   1.8       uwe 
    141   1.8       uwe 
    142   1.8       uwe int
    143  1.36       uwe igsfb_cnattach_subr(struct igsfb_devconfig *dc)
    144   1.8       uwe {
    145   1.8       uwe 	struct rasops_info *ri;
    146   1.8       uwe 	long defattr;
    147   1.1       uwe 
    148   1.8       uwe 	KASSERT(dc == &igsfb_console_dc);
    149   1.8       uwe 
    150   1.8       uwe 	igsfb_init_video(dc);
    151  1.27  macallan 	dc->dc_vd.active = NULL;
    152  1.27  macallan 	igsfb_init_wsdisplay(dc, &dc->dc_console, 1, &defattr);
    153   1.1       uwe 
    154  1.27  macallan 	ri = &dc->dc_console.scr_ri;
    155  1.27  macallan 	ri->ri_hw = &dc->dc_console;
    156  1.27  macallan 	dc->dc_console.scr_cookie = dc;
    157  1.37       uwe 
    158   1.8       uwe 	(*ri->ri_ops.allocattr)(ri,
    159  1.27  macallan 				WS_DEFAULT_FG, /* fg */
    160  1.27  macallan 				WS_DEFAULT_BG, /* bg */
    161   1.8       uwe 				0,           /* wsattrs */
    162   1.8       uwe 				&defattr);
    163   1.8       uwe 
    164   1.8       uwe 	wsdisplay_cnattach(&igsfb_stdscreen,
    165   1.8       uwe 			   ri,   /* emulcookie */
    166   1.8       uwe 			   0, 0, /* cursor position */
    167   1.8       uwe 			   defattr);
    168  1.37       uwe 	return 0;
    169   1.8       uwe }
    170   1.1       uwe 
    171   1.1       uwe 
    172   1.1       uwe /*
    173   1.1       uwe  * Finish off the attach.  Bus specific attach method should have
    174   1.8       uwe  * enabled io and memory accesses and mapped io (and cop?) registers.
    175   1.1       uwe  */
    176   1.1       uwe void
    177  1.36       uwe igsfb_attach_subr(struct igsfb_softc *sc, int isconsole)
    178   1.1       uwe {
    179   1.8       uwe 	struct igsfb_devconfig *dc = sc->sc_dc;
    180   1.8       uwe 	struct wsemuldisplaydev_attach_args waa;
    181  1.27  macallan 	struct rasops_info *ri;
    182  1.27  macallan 	long defattr;
    183   1.8       uwe 
    184   1.8       uwe 	KASSERT(dc != NULL);
    185   1.8       uwe 
    186   1.8       uwe 	if (!isconsole) {
    187   1.8       uwe 		igsfb_init_video(dc);
    188   1.8       uwe 	}
    189   1.8       uwe 
    190  1.27  macallan 	vcons_init(&dc->dc_vd, dc, &igsfb_stdscreen, &igsfb_accessops);
    191  1.27  macallan 	dc->dc_vd.init_screen = igsfb_init_wsdisplay;
    192  1.37       uwe 
    193  1.27  macallan 	vcons_init_screen(&dc->dc_vd, &dc->dc_console, 1, &defattr);
    194  1.27  macallan 	dc->dc_console.scr_flags |= VCONS_SCREEN_IS_STATIC;
    195  1.37       uwe 
    196   1.8       uwe 	printf("%s: %dMB, %s%dx%d, %dbpp\n",
    197  1.44    cegger 	       device_xname(&sc->sc_dev),
    198  1.19       uwe 	       (uint32_t)(dc->dc_vmemsz >> 20),
    199   1.8       uwe 	       (dc->dc_hwflags & IGSFB_HW_BSWAP)
    200   1.8       uwe 		   ? (dc->dc_hwflags & IGSFB_HW_BE_SELECT)
    201   1.8       uwe 		       ? "hardware bswap, " : "software bswap, "
    202   1.8       uwe 		   : "",
    203   1.8       uwe 	       dc->dc_width, dc->dc_height, dc->dc_depth);
    204  1.47  macallan 	printf("%s: using %dbpp for X\n", device_xname(&sc->sc_dev),
    205  1.47  macallan 	       dc->dc_maxdepth);
    206  1.27  macallan 	ri = &dc->dc_console.scr_ri;
    207  1.27  macallan 	ri->ri_ops.eraserows(ri, 0, ri->ri_rows, defattr);
    208  1.27  macallan 
    209  1.46  macallan 	if (isconsole)
    210  1.46  macallan 		vcons_replay_msgbuf(&dc->dc_console);
    211  1.46  macallan 
    212   1.8       uwe 	/* attach wsdisplay */
    213   1.8       uwe 	waa.console = isconsole;
    214   1.8       uwe 	waa.scrdata = &igsfb_screenlist;
    215   1.8       uwe 	waa.accessops = &igsfb_accessops;
    216  1.27  macallan 	waa.accesscookie = &dc->dc_vd;
    217   1.8       uwe 
    218   1.8       uwe 	config_found(&sc->sc_dev, &waa, wsemuldisplaydevprint);
    219   1.8       uwe }
    220   1.8       uwe 
    221   1.8       uwe 
    222   1.8       uwe static int
    223  1.36       uwe igsfb_init_video(struct igsfb_devconfig *dc)
    224   1.8       uwe {
    225   1.4       uwe 	bus_space_handle_t tmph;
    226  1.19       uwe 	uint8_t *p;
    227   1.4       uwe 	int need_bswap;
    228   1.8       uwe 	bus_addr_t fbaddr, craddr;
    229   1.1       uwe 	off_t croffset;
    230  1.19       uwe 	uint8_t busctl, curctl;
    231  1.41      cube 	void *va;
    232   1.1       uwe 
    233   1.8       uwe 	/* Total amount of video memory. */
    234   1.8       uwe 	busctl = igs_ext_read(dc->dc_iot, dc->dc_ioh, IGS_EXT_BUS_CTL);
    235   1.1       uwe 	if (busctl & 0x2)
    236   1.8       uwe 		dc->dc_vmemsz = 4;
    237   1.1       uwe 	else if (busctl & 0x1)
    238   1.8       uwe 		dc->dc_vmemsz = 2;
    239   1.1       uwe 	else
    240   1.8       uwe 		dc->dc_vmemsz = 1;
    241   1.8       uwe 	dc->dc_vmemsz <<= 20;	/* megabytes -> bytes */
    242   1.4       uwe 
    243   1.4       uwe 	/*
    244   1.8       uwe 	 * Check for endianness mismatch by writing a word at the end of
    245   1.8       uwe 	 * the video memory (off-screen) and reading it back byte-by-byte.
    246   1.4       uwe 	 */
    247   1.8       uwe 	if (bus_space_map(dc->dc_memt,
    248  1.19       uwe 			  dc->dc_memaddr + dc->dc_vmemsz - sizeof(uint32_t),
    249  1.19       uwe 			  sizeof(uint32_t),
    250   1.8       uwe 			  dc->dc_memflags | BUS_SPACE_MAP_LINEAR,
    251   1.4       uwe 			  &tmph) != 0)
    252   1.4       uwe 	{
    253   1.4       uwe 		printf("unable to map video memory for endianness test\n");
    254  1.37       uwe 		return 1;
    255   1.4       uwe 	}
    256   1.4       uwe 
    257   1.8       uwe 	p = bus_space_vaddr(dc->dc_memt, tmph);
    258   1.4       uwe #if BYTE_ORDER == BIG_ENDIAN
    259  1.19       uwe 	*((uint32_t *)p) = 0x12345678;
    260   1.4       uwe #else
    261  1.19       uwe 	*((uint32_t *)p) = 0x78563412;
    262   1.4       uwe #endif
    263   1.4       uwe 	if (p[0] == 0x12 && p[1] == 0x34 && p[2] == 0x56 && p[3] == 0x78)
    264   1.4       uwe 		need_bswap = 0;
    265   1.4       uwe 	else
    266   1.4       uwe 		need_bswap = 1;
    267   1.4       uwe 
    268  1.19       uwe 	bus_space_unmap(dc->dc_memt, tmph, sizeof(uint32_t));
    269   1.4       uwe 
    270   1.4       uwe 	/*
    271   1.4       uwe 	 * On CyberPro we can use magic bswap bit in linear address.
    272   1.4       uwe 	 */
    273   1.8       uwe 	fbaddr = dc->dc_memaddr;
    274   1.8       uwe 	if (need_bswap) {
    275   1.8       uwe 		dc->dc_hwflags |= IGSFB_HW_BSWAP;
    276   1.8       uwe 		if (dc->dc_id >= 0x2000) {
    277   1.8       uwe 			dc->dc_hwflags |= IGSFB_HW_BE_SELECT;
    278   1.4       uwe 			fbaddr |= IGS_MEM_BE_SELECT;
    279   1.4       uwe 		}
    280   1.8       uwe 	}
    281   1.8       uwe 
    282   1.8       uwe 	/*
    283   1.8       uwe 	 * XXX: TODO: make it possible to select the desired video mode.
    284   1.8       uwe 	 * For now - hardcode to 1024x768/8bpp.  This is what Krups OFW uses.
    285   1.8       uwe 	 */
    286   1.8       uwe 	igsfb_hw_setup(dc);
    287   1.8       uwe 
    288   1.1       uwe 	/*
    289   1.8       uwe 	 * Don't map in all N megs, just the amount we need for the wsscreen.
    290   1.1       uwe 	 */
    291  1.46  macallan 	dc->dc_fbsz = dc->dc_stride * dc->dc_height;
    292   1.8       uwe 	if (bus_space_map(dc->dc_memt, fbaddr, dc->dc_fbsz,
    293   1.8       uwe 			  dc->dc_memflags | BUS_SPACE_MAP_LINEAR,
    294   1.8       uwe 			  &dc->dc_fbh) != 0)
    295   1.1       uwe 	{
    296   1.8       uwe 		bus_space_unmap(dc->dc_iot, dc->dc_ioh, IGS_REG_SIZE);
    297   1.1       uwe 		printf("unable to map framebuffer\n");
    298  1.37       uwe 		return 1;
    299   1.1       uwe 	}
    300   1.1       uwe 
    301   1.8       uwe 	igsfb_init_cmap(dc);
    302   1.8       uwe 
    303   1.1       uwe 	/*
    304   1.8       uwe 	 * 1KB for cursor sprite data at the very end of the video memory.
    305   1.1       uwe 	 */
    306   1.8       uwe 	croffset = dc->dc_vmemsz - IGS_CURSOR_DATA_SIZE;
    307   1.4       uwe 	craddr = fbaddr + croffset;
    308   1.8       uwe 	if (bus_space_map(dc->dc_memt, craddr, IGS_CURSOR_DATA_SIZE,
    309   1.8       uwe 			  dc->dc_memflags | BUS_SPACE_MAP_LINEAR,
    310   1.8       uwe 			  &dc->dc_crh) != 0)
    311   1.1       uwe 	{
    312   1.8       uwe 		bus_space_unmap(dc->dc_iot, dc->dc_ioh, IGS_REG_SIZE);
    313   1.8       uwe 		bus_space_unmap(dc->dc_memt, dc->dc_fbh, dc->dc_fbsz);
    314   1.1       uwe 		printf("unable to map cursor sprite region\n");
    315  1.37       uwe 		return 1;
    316   1.1       uwe 	}
    317   1.1       uwe 
    318   1.1       uwe 	/*
    319   1.8       uwe 	 * Tell the device where cursor sprite data are located in the
    320   1.8       uwe 	 * linear space (it takes data offset in 1KB units).
    321   1.1       uwe 	 */
    322   1.8       uwe 	croffset >>= 10;	/* bytes -> kilobytes */
    323   1.8       uwe 	igs_ext_write(dc->dc_iot, dc->dc_ioh,
    324   1.1       uwe 		      IGS_EXT_SPRITE_DATA_LO, croffset & 0xff);
    325   1.8       uwe 	igs_ext_write(dc->dc_iot, dc->dc_ioh,
    326   1.1       uwe 		      IGS_EXT_SPRITE_DATA_HI, (croffset >> 8) & 0xf);
    327   1.1       uwe 
    328  1.10       uwe 	/* init the bit expansion table for cursor sprite data conversion */
    329  1.10       uwe 	igsfb_init_bit_table(dc);
    330   1.8       uwe 
    331   1.8       uwe 	/* XXX: fill dc_cursor and use igsfb_update_cursor() instead? */
    332   1.8       uwe 	memset(&dc->dc_cursor, 0, sizeof(struct igs_hwcursor));
    333  1.41      cube 	va = bus_space_vaddr(dc->dc_memt, dc->dc_crh);
    334  1.41      cube 	memset(va, /* transparent */ 0xaa, IGS_CURSOR_DATA_SIZE);
    335   1.1       uwe 
    336   1.8       uwe 	curctl = igs_ext_read(dc->dc_iot, dc->dc_ioh, IGS_EXT_SPRITE_CTL);
    337   1.1       uwe 	curctl |= IGS_EXT_SPRITE_64x64;
    338   1.1       uwe 	curctl &= ~IGS_EXT_SPRITE_VISIBLE;
    339   1.8       uwe 	igs_ext_write(dc->dc_iot, dc->dc_ioh, IGS_EXT_SPRITE_CTL, curctl);
    340   1.8       uwe 	dc->dc_curenb = 0;
    341   1.1       uwe 
    342  1.12       uwe 	/*
    343  1.18       uwe 	 * Map and init graphic coprocessor for accelerated rasops.
    344  1.12       uwe 	 */
    345  1.12       uwe 	if (dc->dc_id >= 0x2000) { /* XXX */
    346  1.12       uwe 		if (bus_space_map(dc->dc_iot,
    347  1.12       uwe 				  dc->dc_iobase + IGS_COP_BASE_B, IGS_COP_SIZE,
    348  1.12       uwe 				  dc->dc_ioflags,
    349  1.12       uwe 				  &dc->dc_coph) != 0)
    350  1.12       uwe 		{
    351  1.12       uwe 			printf("unable to map COP registers\n");
    352  1.37       uwe 			return 1;
    353  1.12       uwe 		}
    354  1.12       uwe 
    355  1.12       uwe 		/* XXX: hardcoded 8bpp */
    356  1.12       uwe 		bus_space_write_2(dc->dc_iot, dc->dc_coph,
    357  1.12       uwe 				  IGS_COP_SRC_MAP_WIDTH_REG,
    358  1.12       uwe 				  dc->dc_width - 1);
    359  1.12       uwe 		bus_space_write_2(dc->dc_iot, dc->dc_coph,
    360  1.12       uwe 				  IGS_COP_DST_MAP_WIDTH_REG,
    361  1.12       uwe 				  dc->dc_width - 1);
    362  1.12       uwe 
    363  1.12       uwe 		bus_space_write_1(dc->dc_iot, dc->dc_coph,
    364  1.12       uwe 				  IGS_COP_MAP_FMT_REG,
    365  1.12       uwe 				  IGS_COP_MAP_8BPP);
    366  1.12       uwe 	}
    367  1.12       uwe 
    368   1.8       uwe 	/* make sure screen is not blanked */
    369   1.8       uwe 	dc->dc_blanked = 0;
    370   1.8       uwe 	igsfb_blank_screen(dc, dc->dc_blanked);
    371   1.1       uwe 
    372  1.37       uwe 	return 0;
    373   1.1       uwe }
    374   1.1       uwe 
    375   1.1       uwe 
    376   1.8       uwe static void
    377  1.36       uwe igsfb_init_cmap(struct igsfb_devconfig *dc)
    378   1.4       uwe {
    379   1.8       uwe 	bus_space_tag_t iot = dc->dc_iot;
    380   1.8       uwe 	bus_space_handle_t ioh = dc->dc_ioh;
    381  1.19       uwe 	const uint8_t *p;
    382   1.8       uwe 	int i;
    383   1.4       uwe 
    384   1.8       uwe 	p = rasops_cmap;	/* "ANSI" color map */
    385   1.4       uwe 
    386   1.8       uwe 	/* init software copy */
    387   1.8       uwe 	for (i = 0; i < IGS_CMAP_SIZE; ++i, p += 3) {
    388   1.8       uwe 		dc->dc_cmap.r[i] = p[0];
    389   1.8       uwe 		dc->dc_cmap.g[i] = p[1];
    390   1.8       uwe 		dc->dc_cmap.b[i] = p[2];
    391   1.8       uwe 	}
    392   1.4       uwe 
    393   1.8       uwe 	/* propagate to the device */
    394   1.8       uwe 	igsfb_update_cmap(dc, 0, IGS_CMAP_SIZE);
    395   1.1       uwe 
    396  1.11       uwe 	/* set overscan color (XXX: use defattr's background?) */
    397   1.8       uwe 	igs_ext_write(iot, ioh, IGS_EXT_OVERSCAN_RED,   0);
    398   1.8       uwe 	igs_ext_write(iot, ioh, IGS_EXT_OVERSCAN_GREEN, 0);
    399   1.8       uwe 	igs_ext_write(iot, ioh, IGS_EXT_OVERSCAN_BLUE,  0);
    400   1.1       uwe }
    401   1.1       uwe 
    402   1.8       uwe 
    403   1.1       uwe static void
    404  1.27  macallan igsfb_init_wsdisplay(void *cookie, struct vcons_screen *scr, int existing,
    405  1.36       uwe 		     long *defattr)
    406   1.1       uwe {
    407  1.27  macallan 	struct igsfb_devconfig *dc = cookie;
    408  1.27  macallan 	struct rasops_info *ri = &scr->scr_ri;
    409   1.1       uwe 	int wsfcookie;
    410   1.1       uwe 
    411  1.27  macallan 	if ((scr == &dc->dc_console) && (dc->dc_vd.active != NULL))
    412  1.27  macallan 		return;
    413  1.27  macallan 
    414   1.1       uwe 
    415  1.28  macallan 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
    416   1.8       uwe 	if (IGSFB_HW_SOFT_BSWAP(dc))
    417  1.31       uwe 		ri->ri_flg |= RI_BSWAP;
    418   1.1       uwe 
    419   1.8       uwe 	ri->ri_depth = dc->dc_depth;
    420   1.8       uwe 	ri->ri_width = dc->dc_width;
    421   1.8       uwe 	ri->ri_height = dc->dc_height;
    422  1.35       uwe 	ri->ri_stride = dc->dc_stride;
    423  1.34       uwe 	ri->ri_bits = bus_space_vaddr(dc->dc_memt, dc->dc_fbh);
    424   1.1       uwe 
    425   1.1       uwe 	/*
    426   1.1       uwe 	 * Initialize wsfont related stuff.
    427   1.1       uwe 	 */
    428   1.1       uwe 	wsfont_init();
    429   1.1       uwe 
    430   1.1       uwe 	/* prefer gallant that is identical to the one the prom uses */
    431   1.1       uwe 	wsfcookie = wsfont_find("Gallant", 12, 22, 0,
    432   1.1       uwe 				WSDISPLAY_FONTORDER_L2R,
    433   1.1       uwe 				WSDISPLAY_FONTORDER_L2R);
    434   1.1       uwe 	if (wsfcookie <= 0) {
    435   1.1       uwe #ifdef DIAGNOSTIC
    436   1.8       uwe 		printf("unable to find font Gallant 12x22\n");
    437   1.1       uwe #endif
    438   1.8       uwe 		wsfcookie = wsfont_find(NULL, 0, 0, 0, /* any font at all? */
    439   1.1       uwe 					WSDISPLAY_FONTORDER_L2R,
    440   1.1       uwe 					WSDISPLAY_FONTORDER_L2R);
    441   1.1       uwe 	}
    442   1.1       uwe 
    443   1.1       uwe 	if (wsfcookie <= 0) {
    444   1.8       uwe 		printf("unable to find any fonts\n");
    445   1.1       uwe 		return;
    446   1.1       uwe 	}
    447   1.1       uwe 
    448   1.1       uwe 	if (wsfont_lock(wsfcookie, &ri->ri_font) != 0) {
    449   1.8       uwe 		printf("unable to lock font\n");
    450   1.1       uwe 		return;
    451   1.1       uwe 	}
    452   1.1       uwe 	ri->ri_wsfcookie = wsfcookie;
    453   1.1       uwe 
    454   1.1       uwe 
    455  1.11       uwe 	/* XXX: TODO: compute term size based on font dimensions? */
    456   1.1       uwe 	rasops_init(ri, 34, 80);
    457  1.22  macallan 	rasops_reconfig(ri, ri->ri_height / ri->ri_font->fontheight,
    458  1.22  macallan 	    ri->ri_width / ri->ri_font->fontwidth);
    459   1.1       uwe 
    460  1.12       uwe 
    461  1.11       uwe 	/* use the sprite for the text mode cursor */
    462  1.27  macallan 	igsfb_make_text_cursor(dc, scr);
    463  1.11       uwe 
    464  1.11       uwe 	/* the cursor is "busy" while we are in the text mode */
    465  1.11       uwe 	dc->dc_hwflags |= IGSFB_HW_TEXT_CURSOR;
    466  1.11       uwe 
    467  1.11       uwe 	/* propagate sprite data to the device */
    468  1.11       uwe 	igsfb_update_cursor(dc, WSDISPLAY_CURSOR_DOSHAPE);
    469  1.11       uwe 
    470  1.12       uwe 	/* accelerated text cursor */
    471  1.11       uwe 	ri->ri_ops.cursor = igsfb_accel_cursor;
    472  1.11       uwe 
    473  1.14       uwe 	if (dc->dc_id >= 0x2000) { /* XXX */
    474  1.31       uwe 		/* accelerated erase/copy */
    475  1.31       uwe 		ri->ri_ops.copycols = igsfb_accel_copycols;
    476  1.31       uwe 		ri->ri_ops.erasecols = igsfb_accel_erasecols;
    477  1.31       uwe 		ri->ri_ops.copyrows = igsfb_accel_copyrows;
    478  1.31       uwe 		ri->ri_ops.eraserows = igsfb_accel_eraserows;
    479  1.31       uwe 
    480  1.31       uwe 		/* putchar hook to sync with the cop */
    481  1.31       uwe 		dc->dc_ri_putchar = ri->ri_ops.putchar;
    482  1.31       uwe 		ri->ri_ops.putchar = igsfb_accel_putchar;
    483  1.14       uwe 	}
    484  1.12       uwe 
    485   1.1       uwe 	igsfb_stdscreen.nrows = ri->ri_rows;
    486   1.1       uwe 	igsfb_stdscreen.ncols = ri->ri_cols;
    487   1.1       uwe 	igsfb_stdscreen.textops = &ri->ri_ops;
    488   1.1       uwe 	igsfb_stdscreen.capabilities = ri->ri_caps;
    489   1.1       uwe }
    490   1.1       uwe 
    491   1.1       uwe 
    492   1.1       uwe /*
    493  1.11       uwe  * Init cursor data in dc_cursor for the accelerated text cursor.
    494  1.11       uwe  */
    495  1.11       uwe static int
    496  1.36       uwe igsfb_make_text_cursor(struct igsfb_devconfig *dc, struct vcons_screen *scr)
    497  1.11       uwe {
    498  1.27  macallan 	struct rasops_info *ri = &scr->scr_ri;
    499  1.27  macallan 	struct wsdisplay_font *f = ri->ri_font;
    500  1.19       uwe 	uint16_t cc_scan[8];	/* one sprite scanline */
    501  1.19       uwe 	uint16_t s;
    502  1.11       uwe 	int w, i;
    503  1.11       uwe 
    504  1.11       uwe 	KASSERT(f->fontwidth <= IGS_CURSOR_MAX_SIZE);
    505  1.11       uwe 	KASSERT(f->fontheight <= IGS_CURSOR_MAX_SIZE);
    506  1.11       uwe 
    507  1.11       uwe 	w = f->fontwidth;
    508  1.11       uwe 	for (i = 0; i < f->stride; ++i) {
    509  1.11       uwe 		if (w >= 8) {
    510  1.11       uwe 			s = 0xffff; /* all inverted */
    511  1.11       uwe 			w -= 8;
    512  1.11       uwe 		} else {
    513  1.11       uwe 			/* first w pixels inverted, the rest is transparent */
    514  1.11       uwe 			s = ~(0x5555 << (w * 2));
    515  1.29       uwe 			s = htole16(s);
    516  1.11       uwe 			w = 0;
    517  1.11       uwe 		}
    518  1.11       uwe 		cc_scan[i] = s;
    519  1.11       uwe 	}
    520  1.11       uwe 
    521  1.11       uwe 	dc->dc_cursor.cc_size.x = f->fontwidth;
    522  1.11       uwe 	dc->dc_cursor.cc_size.y = f->fontheight;
    523  1.11       uwe 
    524  1.11       uwe 	dc->dc_cursor.cc_hot.x = 0;
    525  1.11       uwe 	dc->dc_cursor.cc_hot.y = 0;
    526  1.11       uwe 
    527  1.11       uwe 	/* init sprite array to be all transparent */
    528  1.11       uwe 	memset(dc->dc_cursor.cc_sprite, 0xaa, IGS_CURSOR_DATA_SIZE);
    529  1.11       uwe 
    530  1.11       uwe 	for (i = 0; i < f->fontheight; ++i)
    531  1.11       uwe 		memcpy(&dc->dc_cursor.cc_sprite[i * 8],
    532  1.19       uwe 		       cc_scan, f->stride * sizeof(uint16_t));
    533  1.11       uwe 
    534  1.37       uwe 	return 0;
    535  1.11       uwe }
    536  1.11       uwe 
    537  1.11       uwe 
    538  1.11       uwe /*
    539   1.8       uwe  * Spread a byte (abcd.efgh) into two (0a0b.0c0d 0e0f.0g0h).
    540  1.10       uwe  * Helper function for igsfb_init_bit_table().
    541   1.8       uwe  */
    542  1.19       uwe static uint16_t
    543  1.36       uwe igsfb_spread_bits_8(uint8_t b)
    544   1.8       uwe {
    545  1.19       uwe 	uint16_t s = b;
    546   1.8       uwe 
    547   1.8       uwe 	s = ((s & 0x00f0) << 4) | (s & 0x000f);
    548   1.8       uwe 	s = ((s & 0x0c0c) << 2) | (s & 0x0303);
    549   1.8       uwe 	s = ((s & 0x2222) << 1) | (s & 0x1111);
    550  1.37       uwe 	return s;
    551   1.8       uwe }
    552   1.8       uwe 
    553   1.8       uwe 
    554   1.8       uwe /*
    555   1.8       uwe  * Cursor sprite data are in 2bpp.  Incoming image/mask are in 1bpp.
    556  1.18       uwe  * Prebuild the table to expand 1bpp->2bpp, with bswapping if necessary.
    557   1.8       uwe  */
    558   1.8       uwe static void
    559  1.36       uwe igsfb_init_bit_table(struct igsfb_devconfig *dc)
    560   1.8       uwe {
    561  1.19       uwe 	uint16_t *expand = dc->dc_bexpand;
    562  1.19       uwe 	uint16_t s;
    563   1.8       uwe 	u_int i;
    564   1.8       uwe 
    565   1.8       uwe 	for (i = 0; i < 256; ++i) {
    566  1.10       uwe 		s = igsfb_spread_bits_8(i);
    567  1.29       uwe 		expand[i] = htole16(s);
    568   1.8       uwe 	}
    569   1.8       uwe }
    570   1.8       uwe 
    571   1.8       uwe 
    572   1.8       uwe /*
    573   1.1       uwe  * wsdisplay_accessops: mmap()
    574   1.4       uwe  *   XXX: allow mmapping i/o mapped i/o regs if INSECURE???
    575   1.1       uwe  */
    576   1.1       uwe static paddr_t
    577  1.38      jmmv igsfb_mmap(void *v, void *vs, off_t offset, int prot)
    578   1.1       uwe {
    579  1.27  macallan 	struct vcons_data *vd = v;
    580  1.27  macallan 	struct igsfb_devconfig *dc = vd->cookie;
    581   1.1       uwe 
    582  1.45  macallan 	if (offset < dc->dc_memsz && offset >= 0)
    583  1.45  macallan 		return bus_space_mmap(dc->dc_memt, dc->dc_memaddr, offset,
    584  1.45  macallan 		    prot, dc->dc_memflags | BUS_SPACE_MAP_LINEAR);
    585  1.45  macallan 	if (dc->dc_mmap)
    586  1.45  macallan 		return dc->dc_mmap(v, vs, offset, prot);
    587  1.45  macallan 	return -1;
    588   1.1       uwe }
    589   1.1       uwe 
    590   1.1       uwe 
    591   1.1       uwe /*
    592   1.1       uwe  * wsdisplay_accessops: ioctl()
    593   1.1       uwe  */
    594   1.1       uwe static int
    595  1.42  christos igsfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    596  1.38      jmmv 	struct lwp *l)
    597   1.1       uwe {
    598  1.27  macallan 	struct vcons_data *vd = v;
    599  1.27  macallan 	struct igsfb_devconfig *dc = vd->cookie;
    600  1.11       uwe 	int cursor_busy;
    601   1.1       uwe 	int turnoff;
    602   1.1       uwe 
    603  1.11       uwe 	/* don't permit cursor ioctls if we use sprite for text cursor */
    604  1.11       uwe 	cursor_busy = !dc->dc_mapped
    605  1.11       uwe 		&& (dc->dc_hwflags & IGSFB_HW_TEXT_CURSOR);
    606  1.11       uwe 
    607   1.1       uwe 	switch (cmd) {
    608   1.1       uwe 
    609   1.1       uwe 	case WSDISPLAYIO_GTYPE:
    610   1.1       uwe 		*(u_int *)data = WSDISPLAY_TYPE_PCIMISC;
    611  1.37       uwe 		return 0;
    612   1.1       uwe 
    613   1.1       uwe 	case WSDISPLAYIO_GINFO:
    614   1.1       uwe #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    615  1.35       uwe 		wsd_fbip->height = dc->dc_height;
    616  1.35       uwe 		wsd_fbip->width = dc->dc_width;
    617  1.47  macallan 		wsd_fbip->depth = dc->dc_maxdepth;
    618   1.1       uwe 		wsd_fbip->cmsize = IGS_CMAP_SIZE;
    619   1.1       uwe #undef wsd_fbip
    620  1.37       uwe 		return 0;
    621  1.37       uwe 
    622  1.21  macallan 	case WSDISPLAYIO_LINEBYTES:
    623  1.47  macallan 		*(int *)data = dc->dc_width * (dc->dc_maxdepth >> 3);
    624  1.37       uwe 		return 0;
    625   1.1       uwe 
    626  1.11       uwe 	case WSDISPLAYIO_SMODE:
    627  1.11       uwe #define d (*(int *)data)
    628  1.25  macallan 		if (d != WSDISPLAYIO_MODE_EMUL) {
    629  1.11       uwe 			dc->dc_mapped = 1;
    630  1.23  macallan 			/* turn off hardware cursor */
    631  1.23  macallan 			if (dc->dc_hwflags & IGSFB_HW_TEXT_CURSOR) {
    632  1.23  macallan 				dc->dc_curenb = 0;
    633  1.23  macallan 				igsfb_update_cursor(dc,
    634  1.23  macallan 					WSDISPLAY_CURSOR_DOCUR);
    635  1.23  macallan 			}
    636  1.47  macallan 			if ((dc->dc_mode != NULL) && (dc->dc_maxdepth != 8))
    637  1.47  macallan 				igsfb_set_mode(dc, dc->dc_mode,
    638  1.47  macallan 				    dc->dc_maxdepth);
    639  1.25  macallan 		} else {
    640  1.11       uwe 			dc->dc_mapped = 0;
    641  1.47  macallan 			if ((dc->dc_mode != NULL) && (dc->dc_maxdepth != 8))
    642  1.47  macallan 				igsfb_set_mode(dc, dc->dc_mode, 8);
    643  1.47  macallan 			igsfb_init_cmap(dc);
    644  1.11       uwe 			/* reinit sprite for text cursor */
    645  1.11       uwe 			if (dc->dc_hwflags & IGSFB_HW_TEXT_CURSOR) {
    646  1.27  macallan 				igsfb_make_text_cursor(dc, dc->dc_vd.active);
    647  1.11       uwe 				dc->dc_curenb = 0;
    648  1.11       uwe 				igsfb_update_cursor(dc,
    649  1.11       uwe 					  WSDISPLAY_CURSOR_DOSHAPE
    650  1.11       uwe 					| WSDISPLAY_CURSOR_DOCUR);
    651  1.11       uwe 			}
    652  1.27  macallan 			vcons_redraw_screen(vd->active);
    653  1.11       uwe 		}
    654  1.37       uwe 		return 0;
    655  1.11       uwe 
    656   1.1       uwe 	case WSDISPLAYIO_GVIDEO:
    657   1.8       uwe 		*(u_int *)data = dc->dc_blanked ?
    658   1.1       uwe 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
    659  1.37       uwe 		return 0;
    660   1.1       uwe 
    661   1.1       uwe 	case WSDISPLAYIO_SVIDEO:
    662   1.1       uwe 		turnoff = (*(u_int *)data == WSDISPLAYIO_VIDEO_OFF);
    663   1.8       uwe 		if (dc->dc_blanked != turnoff) {
    664   1.8       uwe 			dc->dc_blanked = turnoff;
    665   1.8       uwe 			igsfb_blank_screen(dc, dc->dc_blanked);
    666   1.1       uwe 		}
    667  1.37       uwe 		return 0;
    668   1.1       uwe 
    669   1.1       uwe 	case WSDISPLAYIO_GETCMAP:
    670  1.37       uwe 		return igsfb_get_cmap(dc, (struct wsdisplay_cmap *)data);
    671   1.1       uwe 
    672   1.1       uwe 	case WSDISPLAYIO_PUTCMAP:
    673  1.37       uwe 		return igsfb_set_cmap(dc, (struct wsdisplay_cmap *)data);
    674   1.1       uwe 
    675   1.1       uwe 	case WSDISPLAYIO_GCURMAX:
    676   1.1       uwe 		((struct wsdisplay_curpos *)data)->x = IGS_CURSOR_MAX_SIZE;
    677   1.1       uwe 		((struct wsdisplay_curpos *)data)->y = IGS_CURSOR_MAX_SIZE;
    678  1.37       uwe 		return 0;
    679   1.1       uwe 
    680   1.1       uwe 	case WSDISPLAYIO_GCURPOS:
    681  1.11       uwe 		if (cursor_busy)
    682  1.37       uwe 			return EBUSY;
    683   1.8       uwe 		*(struct wsdisplay_curpos *)data = dc->dc_cursor.cc_pos;
    684  1.37       uwe 		return 0;
    685   1.1       uwe 
    686   1.1       uwe 	case WSDISPLAYIO_SCURPOS:
    687  1.11       uwe 		if (cursor_busy)
    688  1.37       uwe 			return EBUSY;
    689   1.8       uwe 		igsfb_set_curpos(dc, (struct wsdisplay_curpos *)data);
    690  1.37       uwe 		return 0;
    691   1.1       uwe 
    692   1.1       uwe 	case WSDISPLAYIO_GCURSOR:
    693  1.11       uwe 		if (cursor_busy)
    694  1.37       uwe 			return EBUSY;
    695  1.37       uwe 		return igsfb_get_cursor(dc, (struct wsdisplay_cursor *)data);
    696   1.1       uwe 
    697   1.1       uwe 	case WSDISPLAYIO_SCURSOR:
    698  1.24       uwe 		if (cursor_busy)
    699  1.37       uwe 			return EBUSY;
    700  1.37       uwe 		return igsfb_set_cursor(dc, (struct wsdisplay_cursor *)data);
    701   1.1       uwe 	}
    702   1.1       uwe 
    703  1.37       uwe 	return EPASSTHROUGH;
    704   1.1       uwe }
    705   1.1       uwe 
    706   1.1       uwe 
    707   1.1       uwe /*
    708   1.1       uwe  * wsdisplay_accessops: ioctl(WSDISPLAYIO_SVIDEO)
    709   1.1       uwe  */
    710   1.1       uwe static void
    711  1.36       uwe igsfb_blank_screen(struct igsfb_devconfig *dc, int blank)
    712   1.1       uwe {
    713   1.1       uwe 
    714   1.8       uwe 	igs_ext_write(dc->dc_iot, dc->dc_ioh,
    715   1.1       uwe 		      IGS_EXT_SYNC_CTL,
    716   1.1       uwe 		      blank ? IGS_EXT_SYNC_H0 | IGS_EXT_SYNC_V0
    717   1.1       uwe 			    : 0);
    718   1.1       uwe }
    719   1.1       uwe 
    720   1.1       uwe 
    721   1.1       uwe /*
    722   1.1       uwe  * wsdisplay_accessops: ioctl(WSDISPLAYIO_GETCMAP)
    723   1.8       uwe  *   Served from the software cmap copy.
    724   1.1       uwe  */
    725   1.1       uwe static int
    726  1.36       uwe igsfb_get_cmap(struct igsfb_devconfig *dc, struct wsdisplay_cmap *p)
    727   1.1       uwe {
    728  1.11       uwe 	u_int index, count;
    729  1.11       uwe 	int err;
    730  1.11       uwe 
    731  1.11       uwe 	index = p->index;
    732  1.11       uwe 	count = p->count;
    733   1.1       uwe 
    734   1.5    itojun 	if (index >= IGS_CMAP_SIZE || count > IGS_CMAP_SIZE - index)
    735  1.37       uwe 		return EINVAL;
    736   1.1       uwe 
    737  1.11       uwe 	err = copyout(&dc->dc_cmap.r[index], p->red, count);
    738  1.11       uwe 	if (err)
    739  1.37       uwe 		return err;
    740  1.11       uwe 	err = copyout(&dc->dc_cmap.g[index], p->green, count);
    741  1.11       uwe 	if (err)
    742  1.37       uwe 		return err;
    743  1.11       uwe 	err = copyout(&dc->dc_cmap.b[index], p->blue, count);
    744  1.11       uwe 	if (err)
    745  1.37       uwe 		return err;
    746   1.1       uwe 
    747  1.37       uwe 	return 0;
    748   1.1       uwe }
    749   1.1       uwe 
    750   1.1       uwe 
    751   1.1       uwe /*
    752  1.15       uwe  * wsdisplay_accessops: ioctl(WSDISPLAYIO_PUTCMAP)
    753   1.8       uwe  *   Set the software cmap copy and propagate changed range to the device.
    754   1.1       uwe  */
    755   1.1       uwe static int
    756  1.36       uwe igsfb_set_cmap(struct igsfb_devconfig *dc, const struct wsdisplay_cmap *p)
    757   1.1       uwe {
    758  1.11       uwe 	u_int index, count;
    759  1.17       chs 	uint8_t r[IGS_CMAP_SIZE];
    760  1.17       chs 	uint8_t g[IGS_CMAP_SIZE];
    761  1.17       chs 	uint8_t b[IGS_CMAP_SIZE];
    762  1.17       chs 	int error;
    763  1.11       uwe 
    764  1.11       uwe 	index = p->index;
    765  1.11       uwe 	count = p->count;
    766   1.5    itojun 	if (index >= IGS_CMAP_SIZE || count > IGS_CMAP_SIZE - index)
    767  1.37       uwe 		return EINVAL;
    768  1.17       chs 	error = copyin(p->red, &r[index], count);
    769  1.17       chs 	if (error)
    770  1.17       chs 		return error;
    771  1.17       chs 	error = copyin(p->green, &g[index], count);
    772  1.17       chs 	if (error)
    773  1.17       chs 		return error;
    774  1.17       chs 	error = copyin(p->blue, &b[index], count);
    775  1.17       chs 	if (error)
    776  1.17       chs 		return error;
    777  1.17       chs 
    778  1.17       chs 	memcpy(&dc->dc_cmap.r[index], &r[index], count);
    779  1.17       chs 	memcpy(&dc->dc_cmap.g[index], &g[index], count);
    780  1.17       chs 	memcpy(&dc->dc_cmap.b[index], &b[index], count);
    781   1.1       uwe 
    782  1.11       uwe 	/* propagate changes to the device */
    783  1.11       uwe 	igsfb_update_cmap(dc, index, count);
    784  1.37       uwe 	return 0;
    785   1.1       uwe }
    786   1.1       uwe 
    787   1.1       uwe 
    788   1.1       uwe /*
    789   1.8       uwe  * Propagate specified part of the software cmap copy to the device.
    790   1.1       uwe  */
    791   1.1       uwe static void
    792  1.36       uwe igsfb_update_cmap(struct igsfb_devconfig *dc, u_int index, u_int count)
    793   1.1       uwe {
    794   1.1       uwe 	bus_space_tag_t t;
    795   1.1       uwe 	bus_space_handle_t h;
    796   1.1       uwe 	u_int last, i;
    797   1.1       uwe 
    798   1.1       uwe 	if (index >= IGS_CMAP_SIZE)
    799   1.1       uwe 		return;
    800   1.1       uwe 
    801   1.1       uwe 	last = index + count;
    802   1.1       uwe 	if (last > IGS_CMAP_SIZE)
    803   1.1       uwe 		last = IGS_CMAP_SIZE;
    804   1.1       uwe 
    805   1.8       uwe 	t = dc->dc_iot;
    806   1.8       uwe 	h = dc->dc_ioh;
    807   1.1       uwe 
    808   1.1       uwe 	/* start palette writing, index is autoincremented by hardware */
    809   1.1       uwe 	bus_space_write_1(t, h, IGS_DAC_PEL_WRITE_IDX, index);
    810   1.1       uwe 
    811   1.1       uwe 	for (i = index; i < last; ++i) {
    812   1.8       uwe 		bus_space_write_1(t, h, IGS_DAC_PEL_DATA, dc->dc_cmap.r[i]);
    813   1.8       uwe 		bus_space_write_1(t, h, IGS_DAC_PEL_DATA, dc->dc_cmap.g[i]);
    814   1.8       uwe 		bus_space_write_1(t, h, IGS_DAC_PEL_DATA, dc->dc_cmap.b[i]);
    815   1.1       uwe 	}
    816   1.1       uwe }
    817   1.1       uwe 
    818   1.1       uwe 
    819   1.1       uwe /*
    820   1.1       uwe  * wsdisplay_accessops: ioctl(WSDISPLAYIO_SCURPOS)
    821   1.1       uwe  */
    822   1.1       uwe static void
    823  1.36       uwe igsfb_set_curpos(struct igsfb_devconfig *dc,
    824  1.36       uwe 		 const struct wsdisplay_curpos *curpos)
    825   1.1       uwe {
    826  1.27  macallan 	struct rasops_info *ri = &dc->dc_vd.active->scr_ri;
    827   1.9       uwe 	u_int x = curpos->x, y = curpos->y;
    828   1.9       uwe 
    829   1.9       uwe 	if (x >= ri->ri_width)
    830   1.9       uwe 		x = ri->ri_width - 1;
    831   1.9       uwe 	if (y >= ri->ri_height)
    832   1.9       uwe 		y = ri->ri_height - 1;
    833   1.1       uwe 
    834   1.8       uwe 	dc->dc_cursor.cc_pos.x = x;
    835   1.8       uwe 	dc->dc_cursor.cc_pos.y = y;
    836   1.1       uwe 
    837  1.11       uwe 	/* propagate changes to the device */
    838   1.8       uwe 	igsfb_update_curpos(dc);
    839   1.1       uwe }
    840   1.1       uwe 
    841   1.1       uwe 
    842   1.1       uwe static void
    843  1.36       uwe igsfb_update_curpos(struct igsfb_devconfig *dc)
    844   1.1       uwe {
    845   1.1       uwe 	bus_space_tag_t t;
    846   1.1       uwe 	bus_space_handle_t h;
    847   1.1       uwe 	int x, xoff, y, yoff;
    848   1.1       uwe 
    849   1.1       uwe 	xoff = 0;
    850   1.8       uwe 	x = dc->dc_cursor.cc_pos.x - dc->dc_cursor.cc_hot.x;
    851   1.1       uwe 	if (x < 0) {
    852   1.8       uwe 		xoff = -x;
    853   1.1       uwe 		x = 0;
    854   1.1       uwe 	}
    855   1.1       uwe 
    856   1.1       uwe 	yoff = 0;
    857   1.8       uwe 	y = dc->dc_cursor.cc_pos.y - dc->dc_cursor.cc_hot.y;
    858   1.1       uwe 	if (y < 0) {
    859   1.8       uwe 		yoff = -y;
    860   1.1       uwe 		y = 0;
    861   1.1       uwe 	}
    862   1.1       uwe 
    863   1.8       uwe 	t = dc->dc_iot;
    864   1.8       uwe 	h = dc->dc_ioh;
    865   1.1       uwe 
    866   1.1       uwe 	igs_ext_write(t, h, IGS_EXT_SPRITE_HSTART_LO, x & 0xff);
    867   1.1       uwe 	igs_ext_write(t, h, IGS_EXT_SPRITE_HSTART_HI, (x >> 8) & 0x07);
    868   1.1       uwe 	igs_ext_write(t, h, IGS_EXT_SPRITE_HPRESET, xoff & 0x3f);
    869   1.1       uwe 
    870   1.1       uwe 	igs_ext_write(t, h, IGS_EXT_SPRITE_VSTART_LO, y & 0xff);
    871   1.1       uwe 	igs_ext_write(t, h, IGS_EXT_SPRITE_VSTART_HI, (y >> 8) & 0x07);
    872   1.1       uwe 	igs_ext_write(t, h, IGS_EXT_SPRITE_VPRESET, yoff & 0x3f);
    873   1.1       uwe }
    874   1.1       uwe 
    875   1.1       uwe 
    876   1.1       uwe /*
    877   1.1       uwe  * wsdisplay_accessops: ioctl(WSDISPLAYIO_GCURSOR)
    878   1.1       uwe  */
    879   1.1       uwe static int
    880  1.36       uwe igsfb_get_cursor(struct igsfb_devconfig *dc, struct wsdisplay_cursor *p)
    881   1.1       uwe {
    882   1.1       uwe 
    883   1.1       uwe 	/* XXX: TODO */
    884  1.37       uwe 	return 0;
    885   1.1       uwe }
    886   1.1       uwe 
    887   1.1       uwe 
    888   1.1       uwe /*
    889   1.1       uwe  * wsdisplay_accessops: ioctl(WSDISPLAYIO_SCURSOR)
    890   1.1       uwe  */
    891   1.1       uwe static int
    892  1.36       uwe igsfb_set_cursor(struct igsfb_devconfig *dc, const struct wsdisplay_cursor *p)
    893   1.1       uwe {
    894   1.1       uwe 	struct igs_hwcursor *cc;
    895   1.9       uwe 	struct wsdisplay_curpos pos, hot;
    896   1.1       uwe 	u_int v, index, count, icount, iwidth;
    897  1.17       chs 	uint8_t r[2], g[2], b[2], image[512], mask[512];
    898  1.17       chs 	int error;
    899   1.1       uwe 
    900   1.8       uwe 	cc = &dc->dc_cursor;
    901   1.1       uwe 	v = p->which;
    902  1.17       chs 	index = count = icount = iwidth = 0;	/* XXX: gcc */
    903  1.39       mrg 	pos.x = pos.y = 0;			/* XXX: gcc */
    904  1.24       uwe 
    905  1.17       chs 	/* copy in the new cursor colormap */
    906   1.1       uwe 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    907   1.1       uwe 		index = p->cmap.index;
    908   1.1       uwe 		count = p->cmap.count;
    909   1.1       uwe 		if (index >= 2 || (index + count) > 2)
    910  1.37       uwe 			return EINVAL;
    911  1.17       chs 		error = copyin(p->cmap.red, &r[index], count);
    912  1.17       chs 		if (error)
    913  1.17       chs 			return error;
    914  1.17       chs 		error = copyin(p->cmap.green, &g[index], count);
    915  1.17       chs 		if (error)
    916  1.17       chs 			return error;
    917  1.17       chs 		error = copyin(p->cmap.blue, &b[index], count);
    918  1.17       chs 		if (error)
    919  1.17       chs 			return error;
    920   1.1       uwe 	}
    921   1.1       uwe 
    922   1.9       uwe 	/* verify that the new cursor data are valid */
    923   1.1       uwe 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    924   1.1       uwe 		if (p->size.x > IGS_CURSOR_MAX_SIZE
    925   1.1       uwe 		    || p->size.y > IGS_CURSOR_MAX_SIZE)
    926  1.37       uwe 			return EINVAL;
    927   1.1       uwe 
    928   1.1       uwe 		iwidth = (p->size.x + 7) >> 3; /* bytes per scan line */
    929   1.1       uwe 		icount = iwidth * p->size.y;
    930  1.17       chs 		error = copyin(p->image, image, icount);
    931  1.17       chs 		if (error)
    932  1.17       chs 			return error;
    933  1.17       chs 		error = copyin(p->mask, mask, icount);
    934  1.17       chs 		if (error)
    935  1.17       chs 			return error;
    936   1.1       uwe 	}
    937   1.1       uwe 
    938   1.9       uwe 	/* enforce that the position is within screen bounds */
    939   1.9       uwe 	if (v & WSDISPLAY_CURSOR_DOPOS) {
    940  1.27  macallan 		struct rasops_info *ri = &dc->dc_vd.active->scr_ri;
    941   1.9       uwe 
    942   1.9       uwe 		pos = p->pos;	/* local copy we can write to */
    943  1.25  macallan 		if (pos.x >= ri->ri_width)
    944  1.25  macallan 			pos.x = ri->ri_width - 1;
    945  1.25  macallan 		if (pos.y >= ri->ri_height)
    946  1.25  macallan 			pos.y = ri->ri_height - 1;
    947   1.9       uwe 	}
    948   1.9       uwe 
    949   1.9       uwe 	/* enforce that the hot spot is within sprite bounds */
    950   1.9       uwe 	if (v & WSDISPLAY_CURSOR_DOHOT)
    951   1.9       uwe 		hot = p->hot;	/* local copy we can write to */
    952   1.9       uwe 
    953   1.9       uwe 	if (v & (WSDISPLAY_CURSOR_DOHOT | WSDISPLAY_CURSOR_DOSHAPE)) {
    954   1.9       uwe 		const struct wsdisplay_curpos *nsize;
    955   1.9       uwe 		struct wsdisplay_curpos *nhot;
    956   1.1       uwe 
    957   1.9       uwe 		nsize = (v & WSDISPLAY_CURSOR_DOSHAPE) ?
    958   1.9       uwe 			    &p->size : &cc->cc_size;
    959   1.9       uwe 		nhot = (v & WSDISPLAY_CURSOR_DOHOT) ? &hot : &cc->cc_hot;
    960   1.1       uwe 
    961   1.9       uwe 		if (nhot->x >= nsize->x)
    962   1.9       uwe 			nhot->x = nsize->x - 1;
    963   1.9       uwe 		if (nhot->y >= nsize->y)
    964   1.9       uwe 			nhot->y = nsize->y - 1;
    965   1.9       uwe 	}
    966   1.9       uwe 
    967  1.17       chs 	/* copy data to the driver's cursor info */
    968   1.1       uwe 	if (v & WSDISPLAY_CURSOR_DOCUR)
    969   1.8       uwe 		dc->dc_curenb = p->enable;
    970   1.1       uwe 	if (v & WSDISPLAY_CURSOR_DOPOS)
    971   1.9       uwe 		cc->cc_pos = pos; /* local copy, possibly corrected */
    972   1.1       uwe 	if (v & WSDISPLAY_CURSOR_DOHOT)
    973   1.9       uwe 		cc->cc_hot = hot; /* local copy, possibly corrected */
    974   1.1       uwe 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    975  1.17       chs 		memcpy(&cc->cc_color[index], &r[index], count);
    976  1.17       chs 		memcpy(&cc->cc_color[index + 2], &g[index], count);
    977  1.17       chs 		memcpy(&cc->cc_color[index + 4], &b[index], count);
    978   1.1       uwe 	}
    979   1.1       uwe 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    980   1.1       uwe 		u_int trailing_bits;
    981   1.1       uwe 
    982  1.17       chs 		memcpy(cc->cc_image, image, icount);
    983  1.17       chs 		memcpy(cc->cc_mask, mask, icount);
    984   1.1       uwe 		cc->cc_size = p->size;
    985   1.1       uwe 
    986   1.1       uwe 		/* clear trailing bits in the "partial" mask bytes */
    987   1.1       uwe 		trailing_bits = p->size.x & 0x07;
    988   1.1       uwe 		if (trailing_bits != 0) {
    989   1.1       uwe 			const u_int cutmask = ~((~0) << trailing_bits);
    990   1.1       uwe 			u_char *mp;
    991   1.1       uwe 			u_int i;
    992   1.1       uwe 
    993   1.1       uwe 			mp = cc->cc_mask + iwidth - 1;
    994   1.1       uwe 			for (i = 0; i < p->size.y; ++i) {
    995   1.1       uwe 				*mp &= cutmask;
    996   1.1       uwe 				mp += iwidth;
    997   1.1       uwe 			}
    998   1.1       uwe 		}
    999   1.8       uwe 		igsfb_convert_cursor_data(dc, iwidth, p->size.y);
   1000   1.1       uwe 	}
   1001   1.1       uwe 
   1002   1.9       uwe 	/* propagate changes to the device */
   1003   1.8       uwe 	igsfb_update_cursor(dc, v);
   1004   1.9       uwe 
   1005  1.37       uwe 	return 0;
   1006   1.1       uwe }
   1007   1.1       uwe 
   1008   1.4       uwe 
   1009   1.1       uwe /*
   1010   1.1       uwe  * Convert incoming 1bpp cursor image/mask into native 2bpp format.
   1011   1.1       uwe  */
   1012   1.1       uwe static void
   1013  1.36       uwe igsfb_convert_cursor_data(struct igsfb_devconfig *dc,
   1014  1.36       uwe 			  u_int width, u_int height)
   1015   1.1       uwe {
   1016   1.8       uwe 	struct igs_hwcursor *cc = &dc->dc_cursor;
   1017  1.19       uwe 	uint16_t *expand = dc->dc_bexpand;
   1018  1.19       uwe 	uint8_t *ip, *mp;
   1019  1.19       uwe 	uint16_t is, ms, *dp;
   1020   1.1       uwe 	u_int line, i;
   1021   1.1       uwe 
   1022   1.1       uwe 	/* init sprite to be all transparent */
   1023   1.1       uwe 	memset(cc->cc_sprite, 0xaa, IGS_CURSOR_DATA_SIZE);
   1024   1.1       uwe 
   1025   1.1       uwe 	/* first scanline */
   1026   1.1       uwe 	ip = cc->cc_image;
   1027   1.1       uwe 	mp = cc->cc_mask;
   1028   1.1       uwe 	dp = cc->cc_sprite;
   1029   1.1       uwe 
   1030  1.10       uwe 	for (line = 0; line < height; ++line) {
   1031  1.10       uwe 		for (i = 0; i < width; ++i) {
   1032  1.10       uwe 			is = expand[ip[i]]; /* image: 0 -> 00, 1 -> 01 */
   1033  1.10       uwe 			ms = expand[mp[i]]; /*  mask: 0 -> 00, 1 -> 11 */
   1034   1.8       uwe 			ms |= (ms << 1);
   1035   1.1       uwe 			dp[i] = (0xaaaa & ~ms) | (is & ms);
   1036   1.1       uwe 		}
   1037   1.1       uwe 
   1038   1.1       uwe 		/* next scanline */
   1039  1.10       uwe 		ip += width;
   1040  1.10       uwe 		mp += width;
   1041  1.10       uwe 		dp += 8; /* 64 pixels, 2bpp, 8 pixels per short = 8 shorts */
   1042   1.1       uwe 	}
   1043   1.1       uwe }
   1044   1.1       uwe 
   1045   1.1       uwe 
   1046   1.1       uwe /*
   1047   1.8       uwe  * Propagate cursor changes to the device.
   1048   1.8       uwe  * "which" is composed of WSDISPLAY_CURSOR_DO* bits.
   1049   1.1       uwe  */
   1050   1.1       uwe static void
   1051  1.36       uwe igsfb_update_cursor(struct igsfb_devconfig *dc, u_int which)
   1052   1.1       uwe {
   1053   1.8       uwe 	bus_space_tag_t iot = dc->dc_iot;
   1054   1.8       uwe 	bus_space_handle_t ioh = dc->dc_ioh;
   1055  1.19       uwe 	uint8_t curctl;
   1056  1.16       uwe 
   1057  1.16       uwe 	curctl = 0;		/* XXX: gcc */
   1058   1.1       uwe 
   1059   1.1       uwe 	/*
   1060   1.1       uwe 	 * We will need to tweak sprite control register for cursor
   1061  1.18       uwe 	 * visibility and cursor color map manipulation.
   1062   1.1       uwe 	 */
   1063   1.1       uwe 	if (which & (WSDISPLAY_CURSOR_DOCUR | WSDISPLAY_CURSOR_DOCMAP)) {
   1064   1.1       uwe 		curctl = igs_ext_read(iot, ioh, IGS_EXT_SPRITE_CTL);
   1065   1.1       uwe 	}
   1066   1.1       uwe 
   1067   1.1       uwe 	if (which & WSDISPLAY_CURSOR_DOSHAPE) {
   1068  1.19       uwe 		uint8_t *dst = bus_space_vaddr(dc->dc_memt, dc->dc_crh);
   1069   1.1       uwe 
   1070   1.1       uwe 		/*
   1071   1.1       uwe 		 * memcpy between spaces of different endianness would
   1072   1.8       uwe 		 * be ... special.  We cannot be sure if memcpy gonna
   1073   1.1       uwe 		 * push data in 4-byte chunks, we can't pre-bswap it,
   1074   1.1       uwe 		 * so do it byte-by-byte to preserve byte ordering.
   1075   1.1       uwe 		 */
   1076   1.8       uwe 		if (IGSFB_HW_SOFT_BSWAP(dc)) {
   1077  1.19       uwe 			uint8_t *src = (uint8_t *)dc->dc_cursor.cc_sprite;
   1078   1.1       uwe 			int i;
   1079   1.1       uwe 
   1080   1.8       uwe 			for (i = 0; i < IGS_CURSOR_DATA_SIZE; ++i)
   1081   1.1       uwe 				*dst++ = *src++;
   1082   1.1       uwe 		} else {
   1083   1.8       uwe 			memcpy(dst, dc->dc_cursor.cc_sprite,
   1084   1.8       uwe 			       IGS_CURSOR_DATA_SIZE);
   1085   1.1       uwe 		}
   1086   1.1       uwe 	}
   1087   1.1       uwe 
   1088   1.1       uwe 	if (which & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOHOT)) {
   1089   1.1       uwe 		/* code shared with WSDISPLAYIO_SCURPOS */
   1090   1.8       uwe 		igsfb_update_curpos(dc);
   1091   1.1       uwe 	}
   1092   1.1       uwe 
   1093   1.1       uwe 	if (which & WSDISPLAY_CURSOR_DOCMAP) {
   1094  1.19       uwe 		uint8_t *p;
   1095   1.1       uwe 
   1096   1.1       uwe 		/* tell DAC we want access to the cursor palette */
   1097   1.1       uwe 		igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL,
   1098   1.4       uwe 			      curctl | IGS_EXT_SPRITE_DAC_PEL);
   1099   1.1       uwe 
   1100   1.8       uwe 		p = dc->dc_cursor.cc_color;
   1101   1.1       uwe 
   1102   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_WRITE_IDX, 0);
   1103   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[0]);
   1104   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[2]);
   1105   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[4]);
   1106   1.1       uwe 
   1107   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_WRITE_IDX, 1);
   1108   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[1]);
   1109   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[3]);
   1110   1.1       uwe 		bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[5]);
   1111   1.1       uwe 
   1112   1.8       uwe 		/* restore access to the normal palette */
   1113   1.1       uwe 		igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL, curctl);
   1114   1.1       uwe 	}
   1115   1.1       uwe 
   1116   1.1       uwe 	if (which & WSDISPLAY_CURSOR_DOCUR) {
   1117   1.1       uwe 		if ((curctl & IGS_EXT_SPRITE_VISIBLE) == 0
   1118   1.8       uwe 		    && dc->dc_curenb)
   1119   1.1       uwe 			igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL,
   1120   1.1       uwe 				      curctl | IGS_EXT_SPRITE_VISIBLE);
   1121   1.1       uwe 		else if ((curctl & IGS_EXT_SPRITE_VISIBLE) != 0
   1122   1.8       uwe 			 && !dc->dc_curenb)
   1123   1.1       uwe 			igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL,
   1124   1.1       uwe 				      curctl & ~IGS_EXT_SPRITE_VISIBLE);
   1125   1.1       uwe 	}
   1126   1.1       uwe }
   1127   1.1       uwe 
   1128   1.1       uwe 
   1129   1.1       uwe /*
   1130  1.11       uwe  * Accelerated text mode cursor that uses hardware sprite.
   1131  1.11       uwe  */
   1132  1.11       uwe static void
   1133  1.36       uwe igsfb_accel_cursor(void *cookie, int on, int row, int col)
   1134  1.11       uwe {
   1135  1.11       uwe 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1136  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1137  1.27  macallan 	struct igsfb_devconfig *dc = scr->scr_cookie;
   1138  1.11       uwe 	struct igs_hwcursor *cc = &dc->dc_cursor;
   1139  1.11       uwe 	u_int which;
   1140  1.11       uwe 
   1141  1.11       uwe 	ri->ri_crow = row;
   1142  1.11       uwe 	ri->ri_ccol = col;
   1143  1.11       uwe 
   1144  1.11       uwe 	which = 0;
   1145  1.11       uwe 	if (on) {
   1146  1.11       uwe 		ri->ri_flg |= RI_CURSOR;
   1147  1.11       uwe 
   1148  1.18       uwe 		/* only bother to move the cursor if it's visible */
   1149  1.11       uwe 		cc->cc_pos.x = ri->ri_xorigin
   1150  1.11       uwe 			+ ri->ri_ccol * ri->ri_font->fontwidth;
   1151  1.11       uwe 		cc->cc_pos.y = ri->ri_yorigin
   1152  1.11       uwe 			+ ri->ri_crow * ri->ri_font->fontheight;
   1153  1.11       uwe 		which |= WSDISPLAY_CURSOR_DOPOS;
   1154  1.11       uwe 	} else
   1155  1.11       uwe 		ri->ri_flg &= ~RI_CURSOR;
   1156  1.11       uwe 
   1157  1.11       uwe 	if (dc->dc_curenb != on) {
   1158  1.11       uwe 		dc->dc_curenb = on;
   1159  1.11       uwe 		which |= WSDISPLAY_CURSOR_DOCUR;
   1160  1.11       uwe 	}
   1161  1.11       uwe 
   1162  1.11       uwe 	/* propagate changes to the device */
   1163  1.11       uwe 	igsfb_update_cursor(dc, which);
   1164  1.12       uwe }
   1165  1.12       uwe 
   1166  1.12       uwe 
   1167  1.12       uwe 
   1168  1.12       uwe /*
   1169  1.12       uwe  * Accelerated raster ops that use graphic coprocessor.
   1170  1.12       uwe  */
   1171  1.12       uwe 
   1172  1.12       uwe static int
   1173  1.36       uwe igsfb_accel_wait(struct igsfb_devconfig *dc)
   1174  1.12       uwe {
   1175  1.12       uwe 	bus_space_tag_t t = dc->dc_iot;
   1176  1.12       uwe 	bus_space_handle_t h = dc->dc_coph;
   1177  1.12       uwe 	int timo = 100000;
   1178  1.19       uwe 	uint8_t reg;
   1179  1.12       uwe 
   1180  1.47  macallan 	bus_space_write_1(t, h, IGS_COP_MAP_FMT_REG, (dc->dc_depth >> 3) - 1);
   1181  1.12       uwe 	while (timo--) {
   1182  1.12       uwe 		reg = bus_space_read_1(t, h, IGS_COP_CTL_REG);
   1183  1.12       uwe 		if ((reg & IGS_COP_CTL_BUSY) == 0)
   1184  1.37       uwe 			return 0;
   1185  1.12       uwe 	}
   1186  1.12       uwe 
   1187  1.37       uwe 	return 1;
   1188  1.12       uwe }
   1189  1.12       uwe 
   1190  1.12       uwe 
   1191  1.12       uwe static void
   1192  1.36       uwe igsfb_accel_copy(struct igsfb_devconfig *dc, uint32_t src, uint32_t dst,
   1193  1.36       uwe 		 uint16_t width, uint16_t height)
   1194  1.12       uwe {
   1195  1.12       uwe 	bus_space_tag_t t = dc->dc_iot;
   1196  1.12       uwe 	bus_space_handle_t h = dc->dc_coph;
   1197  1.19       uwe 	uint32_t toend;
   1198  1.19       uwe 	uint8_t drawcmd;
   1199  1.12       uwe 
   1200  1.12       uwe 	drawcmd = IGS_COP_DRAW_ALL;
   1201  1.12       uwe 	if (dst > src) {
   1202  1.27  macallan 		toend = dc->dc_vd.active->scr_ri.ri_width * (height - 1) + (width - 1);
   1203  1.12       uwe 		src += toend;
   1204  1.12       uwe 		dst += toend;
   1205  1.12       uwe 		drawcmd |= IGS_COP_OCTANT_X_NEG | IGS_COP_OCTANT_Y_NEG;
   1206  1.12       uwe 	}
   1207  1.12       uwe 
   1208  1.12       uwe 	igsfb_accel_wait(dc);
   1209  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_CTL_REG, 0);
   1210  1.12       uwe 
   1211  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_FG_MIX_REG, IGS_COP_MIX_S);
   1212  1.12       uwe 
   1213  1.12       uwe 	bus_space_write_2(t, h, IGS_COP_WIDTH_REG, width - 1);
   1214  1.12       uwe 	bus_space_write_2(t, h, IGS_COP_HEIGHT_REG, height - 1);
   1215  1.12       uwe 
   1216  1.12       uwe 	bus_space_write_4(t, h, IGS_COP_SRC_START_REG, src);
   1217  1.12       uwe 	bus_space_write_4(t, h, IGS_COP_DST_START_REG, dst);
   1218  1.12       uwe 
   1219  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_0_REG, drawcmd);
   1220  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_1_REG, IGS_COP_PPM_FIXED_FG);
   1221  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_2_REG, 0);
   1222  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_3_REG,
   1223  1.12       uwe 			  IGS_COP_OP_PXBLT | IGS_COP_OP_FG_FROM_SRC);
   1224  1.12       uwe }
   1225  1.12       uwe 
   1226  1.36       uwe 
   1227  1.12       uwe static void
   1228  1.36       uwe igsfb_accel_fill(struct igsfb_devconfig *dc, uint32_t color, uint32_t dst,
   1229  1.36       uwe 		 uint16_t width, uint16_t height)
   1230  1.12       uwe {
   1231  1.12       uwe 	bus_space_tag_t t = dc->dc_iot;
   1232  1.12       uwe 	bus_space_handle_t h = dc->dc_coph;
   1233  1.12       uwe 
   1234  1.12       uwe 	igsfb_accel_wait(dc);
   1235  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_CTL_REG, 0);
   1236  1.12       uwe 
   1237  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_FG_MIX_REG, IGS_COP_MIX_S);
   1238  1.12       uwe 
   1239  1.12       uwe 	bus_space_write_2(t, h, IGS_COP_WIDTH_REG, width - 1);
   1240  1.12       uwe 	bus_space_write_2(t, h, IGS_COP_HEIGHT_REG, height - 1);
   1241  1.12       uwe 
   1242  1.12       uwe 	bus_space_write_4(t, h, IGS_COP_DST_START_REG, dst);
   1243  1.12       uwe 	bus_space_write_4(t, h, IGS_COP_FG_REG, color);
   1244  1.12       uwe 
   1245  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_0_REG, IGS_COP_DRAW_ALL);
   1246  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_1_REG, IGS_COP_PPM_FIXED_FG);
   1247  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_2_REG, 0);
   1248  1.12       uwe 	bus_space_write_1(t, h, IGS_COP_PIXEL_OP_3_REG, IGS_COP_OP_PXBLT);
   1249  1.12       uwe }
   1250  1.12       uwe 
   1251  1.12       uwe 
   1252  1.12       uwe static void
   1253  1.36       uwe igsfb_accel_copyrows(void *cookie, int src, int dst, int num)
   1254  1.12       uwe {
   1255  1.12       uwe 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1256  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1257  1.27  macallan 	struct igsfb_devconfig *dc = (struct igsfb_devconfig *)scr->scr_cookie;
   1258  1.19       uwe 	uint32_t srp, dsp;
   1259  1.19       uwe 	uint16_t width, height;
   1260  1.12       uwe 
   1261  1.12       uwe 	width = ri->ri_emuwidth;
   1262  1.12       uwe 	height = num * ri->ri_font->fontheight;
   1263  1.12       uwe 
   1264  1.12       uwe 	srp = ri->ri_xorigin
   1265  1.12       uwe 		+ ri->ri_width * (ri->ri_yorigin
   1266  1.12       uwe 				  + src * ri->ri_font->fontheight);
   1267  1.12       uwe 	dsp = ri->ri_xorigin
   1268  1.12       uwe 		+ ri->ri_width * (ri->ri_yorigin
   1269  1.12       uwe 				  + dst * ri->ri_font->fontheight);
   1270  1.12       uwe 
   1271  1.12       uwe 	igsfb_accel_copy(dc, srp, dsp, width, height);
   1272  1.12       uwe }
   1273  1.12       uwe 
   1274  1.12       uwe 
   1275  1.36       uwe static void
   1276  1.36       uwe igsfb_accel_copycols(void *cookie, int row, int src, int dst, int num)
   1277  1.12       uwe {
   1278  1.12       uwe 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1279  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1280  1.27  macallan 	struct igsfb_devconfig *dc = (struct igsfb_devconfig *)scr->scr_cookie;
   1281  1.19       uwe 	uint32_t rowp, srp, dsp;
   1282  1.19       uwe 	uint16_t width, height;
   1283  1.20     perry 
   1284  1.12       uwe 	width = num * ri->ri_font->fontwidth;
   1285  1.12       uwe 	height = ri->ri_font->fontheight;
   1286  1.12       uwe 
   1287  1.12       uwe 	rowp = ri->ri_xorigin
   1288  1.12       uwe 		+ ri->ri_width * (ri->ri_yorigin
   1289  1.12       uwe 				  + row * ri->ri_font->fontheight);
   1290  1.12       uwe 
   1291  1.12       uwe 	srp = rowp + src * ri->ri_font->fontwidth;
   1292  1.12       uwe 	dsp = rowp + dst * ri->ri_font->fontwidth;
   1293  1.12       uwe 
   1294  1.20     perry 	igsfb_accel_copy(dc, srp, dsp, width, height);
   1295  1.12       uwe }
   1296  1.12       uwe 
   1297  1.12       uwe 
   1298  1.12       uwe static void
   1299  1.36       uwe igsfb_accel_eraserows(void *cookie, int row, int num, long attr)
   1300  1.12       uwe {
   1301  1.12       uwe 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1302  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1303  1.27  macallan 	struct igsfb_devconfig *dc = (struct igsfb_devconfig *)scr->scr_cookie;
   1304  1.19       uwe 	uint32_t color;
   1305  1.19       uwe 	uint32_t dsp;
   1306  1.19       uwe 	uint16_t width, height;
   1307  1.12       uwe 
   1308  1.30       uwe 	if (num == ri->ri_rows && (ri->ri_flg & RI_FULLCLEAR) != 0) {
   1309  1.30       uwe 		width = ri->ri_width;
   1310  1.30       uwe 		height = ri->ri_height;
   1311  1.30       uwe 		dsp = 0;
   1312  1.30       uwe 	} else {
   1313  1.30       uwe 		width = ri->ri_emuwidth;
   1314  1.30       uwe 		height = num * ri->ri_font->fontheight;
   1315  1.30       uwe 
   1316  1.30       uwe 		dsp = ri->ri_xorigin
   1317  1.30       uwe 			+ ri->ri_width * (ri->ri_yorigin
   1318  1.30       uwe 					  + row * ri->ri_font->fontheight);
   1319  1.30       uwe 	}
   1320  1.12       uwe 
   1321  1.12       uwe 	/* XXX: we "know" the encoding that rasops' allocattr uses */
   1322  1.12       uwe 	color = (attr >> 16) & 0xff;
   1323  1.12       uwe 
   1324  1.12       uwe 	igsfb_accel_fill(dc, color, dsp, width, height);
   1325  1.12       uwe }
   1326  1.12       uwe 
   1327  1.12       uwe 
   1328  1.36       uwe static void
   1329  1.36       uwe igsfb_accel_erasecols(void *cookie, int row, int col, int num, long attr)
   1330  1.12       uwe {
   1331  1.12       uwe 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1332  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1333  1.27  macallan 	struct igsfb_devconfig *dc = (struct igsfb_devconfig *)scr->scr_cookie;
   1334  1.19       uwe 	uint32_t color;
   1335  1.19       uwe 	uint32_t rowp, dsp;
   1336  1.19       uwe 	uint16_t width, height;
   1337  1.12       uwe 
   1338  1.12       uwe 	width = num * ri->ri_font->fontwidth;
   1339  1.12       uwe 	height = ri->ri_font->fontheight;
   1340  1.12       uwe 
   1341  1.12       uwe 	rowp = ri->ri_xorigin
   1342  1.12       uwe 		+ ri->ri_width * (ri->ri_yorigin
   1343  1.12       uwe 				  + row * ri->ri_font->fontheight);
   1344  1.12       uwe 
   1345  1.12       uwe 	dsp = rowp + col * ri->ri_font->fontwidth;
   1346  1.12       uwe 
   1347  1.12       uwe 	/* XXX: we "know" the encoding that rasops' allocattr uses */
   1348  1.12       uwe 	color = (attr >> 16) & 0xff;
   1349  1.12       uwe 
   1350  1.12       uwe 	igsfb_accel_fill(dc, color, dsp, width, height);
   1351  1.12       uwe }
   1352  1.12       uwe 
   1353  1.12       uwe 
   1354  1.12       uwe /*
   1355  1.12       uwe  * Not really implemented here, but we need to hook into the one
   1356  1.12       uwe  * supplied by rasops so that we can synchronize with the COP.
   1357  1.12       uwe  */
   1358  1.12       uwe static void
   1359  1.36       uwe igsfb_accel_putchar(void *cookie, int row, int col, u_int uc, long attr)
   1360  1.12       uwe {
   1361  1.12       uwe 	struct rasops_info *ri = (struct rasops_info *)cookie;
   1362  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1363  1.27  macallan 	struct igsfb_devconfig *dc = (struct igsfb_devconfig *)scr->scr_cookie;
   1364  1.12       uwe 
   1365  1.12       uwe 	igsfb_accel_wait(dc);
   1366  1.12       uwe 	(*dc->dc_ri_putchar)(cookie, row, col, uc, attr);
   1367   1.1       uwe }
   1368