Home | History | Annotate | Line # | Download | only in pci
gten.c revision 1.12.12.1
      1  1.12.12.1      tron /*	$NetBSD: gten.c,v 1.12.12.1 2006/05/24 15:48:20 tron Exp $	*/
      2        1.2      matt 
      3        1.2      matt /*-
      4        1.2      matt  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5        1.2      matt  * All rights reserved.
      6        1.2      matt  *
      7        1.2      matt  * This code is derived from software contributed to The NetBSD Foundation
      8        1.2      matt  * by Matt Thomas <matt (at) 3am-software.com>
      9        1.2      matt  *
     10        1.2      matt  * Redistribution and use in source and binary forms, with or without
     11        1.2      matt  * modification, are permitted provided that the following conditions
     12        1.2      matt  * are met:
     13        1.2      matt  * 1. Redistributions of source code must retain the above copyright
     14        1.2      matt  *    notice, this list of conditions and the following disclaimer.
     15        1.2      matt  * 2. Redistributions in binary form must reproduce the above copyright
     16        1.2      matt  *    notice, this list of conditions and the following disclaimer in the
     17        1.2      matt  *    documentation and/or other materials provided with the distribution.
     18        1.2      matt  * 3. All advertising materials mentioning features or use of this software
     19        1.2      matt  *    must display the following acknowledgement:
     20        1.2      matt  *        This product includes software developed by the NetBSD
     21        1.2      matt  *        Foundation, Inc. and its contributors.
     22        1.2      matt  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23        1.2      matt  *    contributors may be used to endorse or promote products derived
     24        1.2      matt  *    from this software without specific prior written permission.
     25        1.2      matt  *
     26        1.2      matt  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27        1.2      matt  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28        1.2      matt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29        1.2      matt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30        1.2      matt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31        1.2      matt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32        1.2      matt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33        1.2      matt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34        1.2      matt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35        1.2      matt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36        1.2      matt  * POSSIBILITY OF SUCH DAMAGE.
     37        1.2      matt  */
     38        1.9     lukem 
     39        1.9     lukem #include <sys/cdefs.h>
     40  1.12.12.1      tron __KERNEL_RCSID(0, "$NetBSD: gten.c,v 1.12.12.1 2006/05/24 15:48:20 tron Exp $");
     41        1.1      matt 
     42        1.1      matt #include <sys/param.h>
     43        1.1      matt #include <sys/buf.h>
     44        1.1      matt #include <sys/conf.h>
     45        1.1      matt #include <sys/device.h>
     46        1.1      matt #include <sys/ioctl.h>
     47        1.1      matt #include <sys/kernel.h>
     48        1.1      matt #include <sys/malloc.h>
     49        1.1      matt #include <sys/systm.h>
     50        1.1      matt 
     51        1.1      matt #include <uvm/uvm_extern.h>
     52        1.1      matt 
     53        1.1      matt #include <dev/pci/pcidevs.h>
     54        1.1      matt #include <dev/pci/pcireg.h>
     55        1.1      matt #include <dev/pci/pcivar.h>
     56        1.1      matt 
     57        1.1      matt #include <dev/wscons/wsconsio.h>
     58        1.1      matt #include <dev/wscons/wsdisplayvar.h>
     59        1.1      matt #include <dev/rasops/rasops.h>
     60        1.1      matt 
     61        1.1      matt #include <machine/bus.h>
     62        1.1      matt #include <machine/gtenvar.h>
     63        1.1      matt 
     64  1.12.12.1      tron static	int	gten_match(struct device *, struct cfdata *, void *);
     65  1.12.12.1      tron static	void	gten_attach(struct device *, struct device *, void *);
     66  1.12.12.1      tron static	int	gten_print(void *, const char *);
     67        1.1      matt 
     68        1.7   thorpej CFATTACH_DECL(gten, sizeof(struct gten_softc),
     69        1.8   thorpej     gten_match, gten_attach, NULL, NULL);
     70        1.1      matt 
     71        1.1      matt static struct rasops_info gten_console_ri;
     72        1.1      matt static pcitag_t gten_console_pcitag;
     73        1.1      matt 
     74        1.1      matt static struct wsscreen_descr gten_stdscreen = {
     75        1.1      matt 	"std",
     76        1.1      matt 	0, 0,
     77        1.1      matt 	0,
     78        1.1      matt 	0, 0,
     79        1.1      matt 	WSSCREEN_REVERSE
     80        1.1      matt };
     81        1.1      matt 
     82        1.1      matt static const struct wsscreen_descr *_gten_scrlist[] = {
     83        1.1      matt 	&gten_stdscreen,
     84        1.1      matt 	/* XXX other formats, graphics screen? */
     85        1.1      matt };
     86        1.1      matt 
     87        1.1      matt static struct wsscreen_list gten_screenlist = {
     88        1.1      matt 	sizeof(_gten_scrlist) / sizeof(struct wsscreen_descr *), _gten_scrlist
     89        1.1      matt };
     90        1.1      matt 
     91  1.12.12.1      tron static int gten_ioctl(void *, void *, u_long, caddr_t, int, struct proc *);
     92  1.12.12.1      tron static paddr_t gten_mmap(void *, void *, off_t, int);
     93  1.12.12.1      tron static int gten_alloc_screen(void *, const struct wsscreen_descr *,
     94  1.12.12.1      tron 			     void **, int *, int *, long *);
     95  1.12.12.1      tron static void gten_free_screen(void *, void *);
     96  1.12.12.1      tron static int gten_show_screen(void *, void *, int,
     97  1.12.12.1      tron 			    void (*) (void *, int, int), void *);
     98        1.1      matt 
     99        1.2      matt static struct wsdisplay_accessops gten_accessops = {
    100        1.1      matt 	gten_ioctl,
    101        1.1      matt 	gten_mmap,
    102        1.1      matt 	gten_alloc_screen,
    103        1.1      matt 	gten_free_screen,
    104        1.1      matt 	gten_show_screen,
    105        1.1      matt 	0 /* load_font */
    106        1.1      matt };
    107        1.1      matt 
    108  1.12.12.1      tron static void gten_common_init(struct rasops_info *);
    109  1.12.12.1      tron static int gten_getcmap(struct gten_softc *, struct wsdisplay_cmap *);
    110  1.12.12.1      tron static int gten_putcmap(struct gten_softc *, struct wsdisplay_cmap *);
    111        1.1      matt 
    112        1.2      matt #define	GTEN_VRAM_OFFSET	0xf00000
    113        1.2      matt 
    114        1.2      matt static int
    115        1.1      matt gten_match(struct device *parent, struct cfdata *match, void *aux)
    116        1.1      matt {
    117        1.1      matt 	struct pci_attach_args *pa = aux;
    118        1.1      matt 
    119        1.1      matt 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_WD &&
    120        1.1      matt 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_WD_90C)
    121        1.1      matt 		return 2;
    122        1.1      matt 
    123        1.1      matt 	return 0;
    124        1.1      matt }
    125        1.1      matt 
    126        1.2      matt static void
    127        1.1      matt gten_attach(struct device *parent, struct device *self, void *aux)
    128        1.1      matt {
    129        1.1      matt 	struct gten_softc *gt = (struct gten_softc *)self;
    130        1.1      matt 	struct pci_attach_args *pa = aux;
    131        1.1      matt 	struct wsemuldisplaydev_attach_args a;
    132        1.1      matt 	int console = (pa->pa_tag == gten_console_pcitag);
    133        1.1      matt 	int error;
    134        1.1      matt 	char devinfo[256], pbuf[10];
    135        1.1      matt 
    136        1.1      matt 	error = pci_mapreg_info(pa->pa_pc, pa->pa_tag, 0x14,
    137        1.1      matt 		PCI_MAPREG_TYPE_MEM|PCI_MAPREG_MEM_TYPE_32BIT,
    138        1.1      matt 		&gt->gt_memaddr, &gt->gt_memsize, NULL);
    139        1.1      matt 	if (error) {
    140        1.1      matt 		printf(": can't determine memory size: error=%d\n",
    141        1.1      matt 			error);
    142        1.1      matt 		return;
    143        1.1      matt 	}
    144        1.1      matt 	if (console) {
    145        1.1      matt 		gt->gt_ri = &gten_console_ri;
    146        1.1      matt 		gt->gt_nscreens = 1;
    147        1.1      matt 	} else {
    148        1.1      matt 		MALLOC(gt->gt_ri, struct rasops_info *, sizeof(*gt->gt_ri),
    149        1.1      matt 			M_DEVBUF, M_NOWAIT);
    150        1.1      matt 		if (gt->gt_ri == NULL) {
    151        1.1      matt 			printf(": can't alloc memory\n");
    152        1.1      matt 			return;
    153        1.1      matt 		}
    154        1.1      matt 		memset(gt->gt_ri, 0, sizeof(*gt->gt_ri));
    155        1.1      matt #if 0
    156        1.1      matt 		error = pci_mapreg_map(pa, 0x14,
    157        1.1      matt 			PCI_MAPREG_TYPE_MEM|PCI_MAPREG_MEM_TYPE_32BIT,
    158        1.1      matt 			BUS_SPACE_MAP_LINEAR, NULL,
    159        1.1      matt 			(bus_space_handle_t *) &gt->gt_ri->ri_bits,
    160        1.1      matt 			NULL, NULL);
    161        1.1      matt #else
    162        1.2      matt 		error = bus_space_map(pa->pa_memt, gt->gt_memaddr + GTEN_VRAM_OFFSET,
    163        1.2      matt 			960*1024, BUS_SPACE_MAP_LINEAR,
    164        1.1      matt 			(bus_space_handle_t *) &gt->gt_ri->ri_bits);
    165        1.1      matt #endif
    166        1.1      matt 		if (error) {
    167        1.1      matt 			printf(": can't map frame buffer: error=%d\n", error);
    168        1.1      matt 			return;
    169        1.1      matt 		}
    170        1.1      matt 
    171        1.1      matt 		gten_common_init(gt->gt_ri);
    172        1.1      matt 	}
    173        1.1      matt 
    174        1.1      matt 	gt->gt_paddr = vtophys((vaddr_t)gt->gt_ri->ri_bits);
    175        1.1      matt 	if (gt->gt_paddr == 0) {
    176        1.1      matt 		printf(": cannot map framebuffer\n");
    177        1.1      matt 		return;
    178        1.1      matt 	}
    179        1.2      matt 	gt->gt_psize = gt->gt_memsize - GTEN_VRAM_OFFSET;
    180        1.1      matt 
    181       1.11    itojun 	pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo));
    182        1.1      matt 	printf(": %s\n", devinfo);
    183        1.2      matt 	format_bytes(pbuf, sizeof(pbuf), gt->gt_psize);
    184        1.2      matt 	printf("%s: %s, %dx%d, %dbpp\n", self->dv_xname, pbuf,
    185        1.2      matt 	       gt->gt_ri->ri_width, gt->gt_ri->ri_height,
    186        1.2      matt 	       gt->gt_ri->ri_depth);
    187        1.2      matt #if defined(DEBUG)
    188        1.2      matt 	printf("%s: text %dx%d, =+%d+%d\n", self->dv_xname,
    189        1.2      matt 	       gt->gt_ri->ri_cols, gt->gt_ri->ri_rows,
    190        1.2      matt 	       gt->gt_ri->ri_xorigin, gt->gt_ri->ri_yorigin);
    191        1.2      matt 
    192        1.2      matt 	{ int i;
    193        1.2      matt 	  struct rasops_info *ri = gt->gt_ri;
    194        1.2      matt 	for (i = 0; i < 64; i++) {
    195        1.2      matt 		int j = i * ri->ri_stride;
    196        1.2      matt 		int k = (ri->ri_height - i - 1) * gt->gt_ri->ri_stride;
    197        1.2      matt 		memset(ri->ri_bits + j, 0, 64 - i);
    198        1.2      matt 		memset(ri->ri_bits + j + 64 - i, 255, i);
    199        1.2      matt 
    200        1.2      matt 		memset(ri->ri_bits + j + ri->ri_width - 64 + i, 0, 64 - i);
    201        1.2      matt 		memset(ri->ri_bits + j + ri->ri_width - 64, 255, i);
    202        1.2      matt 
    203        1.2      matt 		memset(ri->ri_bits + k, 0, 64 - i);
    204        1.2      matt 		memset(ri->ri_bits + k + 64 - i, 255, i);
    205        1.2      matt 
    206        1.2      matt 		memset(ri->ri_bits + k + ri->ri_width - 64 + i, 0, 64 - i);
    207        1.2      matt 		memset(ri->ri_bits + k + ri->ri_width - 64, 255, i);
    208        1.2      matt 	}}
    209        1.2      matt #endif
    210        1.1      matt 
    211        1.1      matt 	gt->gt_cmap_red[0] = gt->gt_cmap_green[0] = gt->gt_cmap_blue[0] = 0;
    212        1.1      matt 	gt->gt_cmap_red[15] = gt->gt_cmap_red[255] = 0xff;
    213        1.1      matt 	gt->gt_cmap_green[15] = gt->gt_cmap_green[255] = 0xff;
    214        1.1      matt 	gt->gt_cmap_blue[15] = gt->gt_cmap_blue[255] = 0xff;
    215        1.1      matt 
    216        1.1      matt 	a.console = console;
    217        1.1      matt 	a.scrdata = &gten_screenlist;
    218        1.1      matt 	a.accessops = &gten_accessops;
    219        1.1      matt 	a.accesscookie = gt;
    220        1.1      matt 
    221        1.1      matt 	config_found(self, &a, wsemuldisplaydevprint);
    222        1.1      matt }
    223        1.1      matt 
    224        1.1      matt static void
    225        1.1      matt gten_common_init(struct rasops_info *ri)
    226        1.1      matt {
    227        1.1      matt 	int32_t addr, width, height, linebytes, depth;
    228        1.1      matt 	int i, screenbytes;
    229        1.1      matt 
    230        1.1      matt 	/* initialize rasops */
    231        1.1      matt 	ri->ri_width = 640;
    232        1.1      matt 	ri->ri_height = 480;
    233        1.1      matt 	ri->ri_depth = 8;
    234        1.1      matt 	ri->ri_stride = 640;
    235        1.2      matt 	ri->ri_flg = RI_FORCEMONO | RI_FULLCLEAR;
    236        1.1      matt 
    237        1.2      matt 	rasops_init(ri, 30, 80);
    238        1.1      matt 	/* black on white */
    239        1.1      matt 	ri->ri_devcmap[0] = 0xffffffff;			/* bg */
    240        1.1      matt 	ri->ri_devcmap[1] = 0;				/* fg */
    241        1.1      matt 
    242        1.2      matt 	memset(ri->ri_bits, 0xff, ri->ri_stride * ri->ri_height);
    243        1.2      matt 
    244        1.1      matt 	gten_stdscreen.nrows = ri->ri_rows;
    245        1.1      matt 	gten_stdscreen.ncols = ri->ri_cols;
    246        1.1      matt 	gten_stdscreen.textops = &ri->ri_ops;
    247        1.1      matt 	gten_stdscreen.capabilities = ri->ri_caps;
    248        1.1      matt }
    249        1.1      matt 
    250        1.2      matt static int
    251  1.12.12.1      tron gten_ioctl(void *v, void *vs, u_long cmd, caddr_t data, int flag,
    252  1.12.12.1      tron     struct proc *p)
    253        1.1      matt {
    254        1.1      matt 	struct gten_softc *gt = v;
    255        1.1      matt 	struct wsdisplay_fbinfo *wdf;
    256        1.1      matt 	struct grfinfo *gm;
    257        1.1      matt 
    258        1.1      matt 	switch (cmd) {
    259        1.1      matt 	case WSDISPLAYIO_GTYPE:
    260        1.1      matt 		*(u_int *)data = WSDISPLAY_TYPE_PCIMISC;	/* XXX ? */
    261        1.1      matt 		return 0;
    262        1.1      matt 
    263        1.1      matt 	case WSDISPLAYIO_GINFO:
    264        1.1      matt 		wdf = (void *)data;
    265        1.1      matt 		wdf->height = gt->gt_ri->ri_height;
    266        1.1      matt 		wdf->width = gt->gt_ri->ri_width;
    267        1.1      matt 		wdf->depth = gt->gt_ri->ri_depth;
    268        1.1      matt 		wdf->cmsize = 256;
    269        1.1      matt 		return 0;
    270        1.1      matt 
    271        1.1      matt 	case WSDISPLAYIO_GETCMAP:
    272        1.1      matt 		return gten_getcmap(gt, (struct wsdisplay_cmap *)data);
    273        1.1      matt 
    274        1.1      matt 	case WSDISPLAYIO_PUTCMAP:
    275        1.1      matt 		return gten_putcmap(gt, (struct wsdisplay_cmap *)data);
    276        1.1      matt 	}
    277        1.4    atatat 	return EPASSTHROUGH;
    278        1.1      matt }
    279        1.1      matt 
    280        1.2      matt static paddr_t
    281  1.12.12.1      tron gten_mmap(void *v, void *vs, off_t offset, int prot)
    282        1.1      matt {
    283        1.1      matt 	struct gten_softc *gt = v;
    284        1.1      matt 
    285        1.2      matt 	if (offset >= 0 && offset < gt->gt_psize)
    286        1.1      matt 		return gt->gt_paddr + offset;
    287        1.2      matt 	if (offset >= 0x1000000 && offset < gt->gt_memsize)
    288        1.2      matt 		return gt->gt_memaddr + offset - 0x1000000;
    289        1.1      matt 
    290        1.1      matt 	return -1;
    291        1.1      matt }
    292        1.1      matt 
    293        1.2      matt static int
    294  1.12.12.1      tron gten_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
    295  1.12.12.1      tron     int *curxp, int *curyp, long *attrp)
    296        1.1      matt {
    297        1.1      matt 	struct gten_softc *gt = v;
    298        1.1      matt 	struct rasops_info *ri = gt->gt_ri;
    299        1.1      matt 	long defattr;
    300        1.1      matt 
    301        1.1      matt 	if (gt->gt_nscreens > 0)
    302        1.1      matt 		return (ENOMEM);
    303        1.1      matt 
    304        1.1      matt 	*cookiep = ri;			/* one and only for now */
    305        1.1      matt 	*curxp = 0;
    306        1.1      matt 	*curyp = 0;
    307        1.5  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    308        1.1      matt 	*attrp = defattr;
    309        1.1      matt 	gt->gt_nscreens++;
    310        1.1      matt 	return 0;
    311        1.1      matt }
    312        1.1      matt 
    313        1.2      matt static void
    314  1.12.12.1      tron gten_free_screen(void *v, void *cookie)
    315        1.1      matt {
    316        1.1      matt 	struct gten_softc *gt = v;
    317        1.1      matt 
    318        1.1      matt 	if (gt->gt_ri == &gten_console_ri)
    319        1.1      matt 		panic("gten_free_screen: console");
    320        1.1      matt 
    321        1.1      matt 	gt->gt_nscreens--;
    322        1.1      matt }
    323        1.1      matt 
    324        1.2      matt static int
    325  1.12.12.1      tron gten_show_screen(void *v, void *cookie, int waitok,
    326  1.12.12.1      tron     void (*cb)(void *, int, int), void *cbarg)
    327        1.1      matt {
    328        1.1      matt 	return (0);
    329        1.1      matt }
    330        1.1      matt 
    331        1.1      matt int
    332        1.3    kleink gten_cnattach(pci_chipset_tag_t pc, bus_space_tag_t memt)
    333        1.1      matt {
    334        1.1      matt 	struct rasops_info *ri = &gten_console_ri;
    335        1.1      matt 	u_int32_t mapreg, id, mask, mapsize;
    336        1.1      matt 	long defattr;
    337        1.1      matt 	pcitag_t tag;
    338        1.1      matt 	int s, error;
    339        1.1      matt 	bus_size_t bussize;
    340        1.1      matt 	bus_addr_t busaddr;
    341        1.1      matt 
    342        1.3    kleink 	tag = pci_make_tag(pc, 0, 14, 0);
    343        1.1      matt 
    344        1.3    kleink 	id = pci_conf_read(pc, tag, PCI_ID_REG);
    345        1.1      matt 	if (PCI_VENDOR(id) != PCI_VENDOR_WD ||
    346        1.1      matt 	    PCI_PRODUCT(id) != PCI_PRODUCT_WD_90C)
    347        1.1      matt 		return ENXIO;
    348        1.1      matt 
    349        1.3    kleink 	mapreg = pci_conf_read(pc, tag, 0x14);
    350        1.1      matt 	if (PCI_MAPREG_TYPE(mapreg) != PCI_MAPREG_TYPE_MEM ||
    351        1.1      matt 	    PCI_MAPREG_MEM_TYPE(mapreg) != PCI_MAPREG_MEM_TYPE_32BIT)
    352        1.1      matt 		return ENXIO;
    353        1.1      matt 
    354        1.1      matt         s = splhigh();
    355        1.3    kleink         pci_conf_write(pc, tag, 0x14, 0xffffffff);
    356        1.3    kleink         mask = pci_conf_read(pc, tag, 0x14);
    357        1.3    kleink         pci_conf_write(pc, tag, 0x14, mapreg);
    358        1.1      matt 	splx(s);
    359        1.1      matt 	bussize = PCI_MAPREG_MEM_SIZE(mask);
    360        1.1      matt 	busaddr = PCI_MAPREG_MEM_ADDR(mapreg);
    361        1.1      matt 
    362        1.2      matt 	error = bus_space_map(memt, busaddr + GTEN_VRAM_OFFSET, 960*1024,
    363        1.1      matt 		BUS_SPACE_MAP_LINEAR, (bus_space_handle_t *) &ri->ri_bits);
    364        1.1      matt 	if (error)
    365        1.1      matt 		return error;
    366        1.1      matt 
    367        1.1      matt 	gten_common_init(ri);
    368        1.1      matt 
    369        1.5  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    370        1.1      matt 	wsdisplay_cnattach(&gten_stdscreen, ri, 0, 0, defattr);
    371        1.1      matt 
    372        1.1      matt 	gten_console_pcitag = tag;
    373        1.1      matt 
    374        1.1      matt 	return 0;
    375        1.1      matt }
    376        1.1      matt 
    377        1.2      matt static int
    378  1.12.12.1      tron gten_getcmap(struct gten_softc *gt, struct wsdisplay_cmap *cm)
    379        1.1      matt {
    380        1.1      matt 	u_int index = cm->index;
    381        1.1      matt 	u_int count = cm->count;
    382        1.1      matt 	int error;
    383        1.1      matt 
    384        1.1      matt 	if (index >= 256 || count > 256 || index + count > 256)
    385        1.1      matt 		return EINVAL;
    386        1.1      matt 
    387        1.1      matt 	error = copyout(&gt->gt_cmap_red[index],   cm->red,   count);
    388        1.1      matt 	if (error)
    389        1.1      matt 		return error;
    390        1.1      matt 	error = copyout(&gt->gt_cmap_green[index], cm->green, count);
    391        1.1      matt 	if (error)
    392        1.1      matt 		return error;
    393        1.1      matt 	error = copyout(&gt->gt_cmap_blue[index],  cm->blue,  count);
    394        1.1      matt 	if (error)
    395        1.1      matt 		return error;
    396        1.1      matt 
    397        1.1      matt 	return 0;
    398        1.1      matt }
    399        1.1      matt 
    400        1.2      matt static int
    401  1.12.12.1      tron gten_putcmap(struct gten_softc *gt, struct wsdisplay_cmap *cm)
    402        1.1      matt {
    403        1.1      matt 	int index = cm->index;
    404        1.1      matt 	int count = cm->count;
    405       1.10       chs 	int i, error;
    406       1.10       chs 	u_char rbuf[256], gbuf[256], bbuf[256];
    407        1.1      matt 
    408        1.1      matt 	if (cm->index >= 256 || cm->count > 256 ||
    409        1.1      matt 	    (cm->index + cm->count) > 256)
    410        1.1      matt 		return EINVAL;
    411       1.10       chs 	error = copyin(cm->red, &rbuf[index], count);
    412       1.10       chs 	if (error)
    413       1.10       chs 		return error;
    414       1.10       chs 	error = copyin(cm->green, &gbuf[index], count);
    415       1.10       chs 	if (error)
    416       1.10       chs 		return error;
    417       1.10       chs 	error = copyin(cm->blue, &bbuf[index], count);
    418       1.10       chs 	if (error)
    419       1.10       chs 		return error;
    420        1.1      matt 
    421       1.10       chs 	memcpy(&gt->gt_cmap_red[index], &rbuf[index], count);
    422       1.10       chs 	memcpy(&gt->gt_cmap_green[index], &gbuf[index], count);
    423       1.10       chs 	memcpy(&gt->gt_cmap_blue[index], &bbuf[index], count);
    424        1.1      matt 	return 0;
    425        1.1      matt }
    426