Home | History | Annotate | Line # | Download | only in dev
grf_ul.c revision 1.21
      1  1.21  christos /*	$NetBSD: grf_ul.c,v 1.21 1996/10/10 23:55:53 christos Exp $	*/
      2   1.1    chopps #define UL_DEBUG
      3   1.1    chopps 
      4   1.1    chopps /*
      5   1.1    chopps  * Copyright (c) 1995 Ignatios Souvatzis
      6   1.1    chopps  * All rights reserved.
      7   1.1    chopps  *
      8   1.1    chopps  * Redistribution and use in source and binary forms, with or without
      9   1.1    chopps  * modification, are permitted provided that the following conditions
     10   1.1    chopps  * are met:
     11   1.1    chopps  * 1. Redistributions of source code must retain the above copyright
     12   1.1    chopps  *    notice, this list of conditions and the following disclaimer.
     13   1.1    chopps  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.1    chopps  *    notice, this list of conditions and the following disclaimer in the
     15   1.1    chopps  *    documentation and/or other materials provided with the distribution.
     16   1.1    chopps  * 3. All advertising materials mentioning features or use of this software
     17   1.1    chopps  *    must display the following acknowledgement:
     18  1.19        is  *      This product includes software developed by Ignatios Souvatzis for
     19  1.19        is  *      the NetBSD project.
     20  1.19        is  * 4. The name of the authors may not be used to endorse or promote products
     21   1.1    chopps  *    derived from this software without specific prior written permission
     22   1.1    chopps  *
     23   1.1    chopps  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     24   1.1    chopps  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     25   1.1    chopps  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     26   1.1    chopps  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     27   1.1    chopps  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     28   1.1    chopps  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     29   1.1    chopps  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     30   1.1    chopps  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     31   1.1    chopps  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     32   1.1    chopps  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     33   1.1    chopps  */
     34   1.1    chopps #include "grful.h"
     35   1.1    chopps #if NGRFUL > 0
     36   1.1    chopps 
     37   1.1    chopps /* Graphics routines for the University of Lowell A2410 board,
     38   1.1    chopps    using the TMS34010 processor. */
     39   1.1    chopps 
     40   1.1    chopps #include <sys/param.h>
     41   1.3    chopps #include <sys/systm.h>
     42   1.1    chopps #include <sys/errno.h>
     43   1.1    chopps #include <sys/ioctl.h>
     44   1.1    chopps #include <sys/device.h>
     45   1.1    chopps #include <sys/malloc.h>
     46   1.1    chopps #include <sys/syslog.h>
     47   1.1    chopps 
     48   1.1    chopps #include <machine/cpu.h>
     49   1.1    chopps 
     50   1.1    chopps #include <amiga/amiga/device.h>
     51   1.1    chopps #include <amiga/amiga/isr.h>
     52   1.1    chopps #include <amiga/dev/zbusvar.h>
     53   1.1    chopps #include <amiga/dev/grfioctl.h>
     54   1.1    chopps #include <amiga/dev/grfvar.h>
     55   1.1    chopps #include <amiga/dev/grf_ulreg.h>
     56   1.6    chopps 
     57   1.8       jtc extern u_int16_t tmscode[];
     58   1.1    chopps 
     59   1.5    chopps int ul_ioctl __P((struct grf_softc *, u_long, void *, dev_t));
     60   1.5    chopps int ul_getcmap __P((struct grf_softc *, struct grf_colormap *, dev_t));
     61   1.5    chopps int ul_putcmap __P((struct grf_softc *, struct grf_colormap *, dev_t));
     62   1.5    chopps int ul_bitblt __P((struct grf_softc *, struct grf_bitblt *, dev_t));
     63  1.10    chopps int ul_blank __P((struct grf_softc *, int *, dev_t));
     64   1.1    chopps 
     65  1.15     veego static int ulisr __P((void *));
     66  1.15     veego int ulowell_alive __P((struct grfvideo_mode *));
     67  1.15     veego static void ul_load_code __P((struct grf_softc *));
     68  1.15     veego static int ul_load_mon __P((struct grf_softc *, struct grfvideo_mode *));
     69  1.15     veego static int ul_getvmode __P((struct grf_softc *, struct grfvideo_mode *));
     70  1.15     veego static int ul_setvmode __P((struct grf_softc *, unsigned));
     71  1.15     veego static __inline void ul_setfb __P((struct grf_softc *, u_long));
     72  1.15     veego 
     73   1.1    chopps /*
     74   1.1    chopps  * marked true early so that ulowell_cnprobe() can tell if we are alive.
     75   1.1    chopps  */
     76   1.1    chopps int ulowell_inited;
     77   1.1    chopps 
     78   1.1    chopps /* standard-palette definition */
     79   1.1    chopps u_int8_t ul_std_palette[] = {
     80   1.1    chopps 	0,128,  0,128,   0,128,  0,128,  0,255,  0,255,   0,255,  0,255,
     81   1.1    chopps 	0,  0,128,128,   0,  0,128,128,  0,  0,255,255,   0,  0,255,255,
     82   1.1    chopps 	0,  0,  0,  0, 128,128,128,128,  0,  0,  0,  0, 255,255,255,255};
     83   1.1    chopps 
     84   1.1    chopps u_int8_t ul_ovl_palette[] = {
     85   1.1    chopps 	128, 0, 0, 0,
     86   1.1    chopps 	128, 0, 0, 0,
     87   1.1    chopps 	128, 0, 0, 0};
     88   1.1    chopps 
     89   1.2    chopps struct grfvideo_mode ul_monitor_defs[] = {
     90   1.1    chopps 
     91   1.1    chopps  	/*
     92   1.1    chopps 	 * Horizontal values are given in TMS units, that is, for the
     93   1.1    chopps 	 * A2410 board, units of 16 pixels. The ioctl multiplies (when
     94   1.8       jtc 	 * exporting) or divides (when importing) them by 16 to conform to.
     95   1.1    chopps 	 *
     96   1.8       jtc 	 * XXX This used to be in units of 8 pixel times. We
     97   1.8       jtc 	 * must also change amiga/stand/grfconfig/grfconfig.c,
     98   1.8       jtc 	 * grf_{rt,rh,cl,cv}.c and egsgrfconfig (the latter to generate the
     99   1.1    chopps 	 * horizontal timings in units of pixels instead of 8 pixels.
    100   1.1    chopps 	 * You will also have to write warnings in BIG BOLD RED BLINKING
    101   1.1    chopps 	 * LETTERS all over the docs, and still people will fry their monitors.
    102   1.1    chopps 	 *
    103   1.1    chopps 	 * btw, the _totals are always sync_start+1, to compute the frequencies
    104   1.1    chopps 	 * correctly. (see TMS34010 manual)
    105   1.1    chopps 	 */
    106   1.1    chopps 
    107   1.1    chopps 	/* 1024x768, 60Hz */
    108   1.1    chopps 	{1, "1024x768",   66667000, 1024, 768, 8,
    109   1.1    chopps 		82, 18, 86, 12, 87, 794, 26, 797, 2, 798},
    110   1.1    chopps 
    111   1.1    chopps 	/* 864x648, 70Hz */
    112   1.1    chopps 	{2, "864x648",    50000000,  864, 648, 8,
    113   1.1    chopps 		61,  7, 65,  3, 66, 667, 19, 677, 4, 678},
    114   1.1    chopps 
    115   1.1    chopps 	/* 800x600, 60Hz */
    116   1.1    chopps 	{3, "800x600",    36000000,  800, 600, 8,
    117   1.1    chopps 		57,  7, 61,  3, 62, 619, 19, 629, 4, 630},
    118   1.1    chopps 
    119   1.1    chopps 	/* 640x400, 60 Hz, interlaced */
    120   1.1    chopps 	{4, "640x400I",   14318000,  640, 400, 8,
    121   1.1    chopps 		48,  8, 56,  3, 57, 239, 39, 262, 2, 240},
    122   1.1    chopps 
    123   1.1    chopps 	/* 1024x768, 65Hz interlaced, s.th. is strange */
    124   1.1    chopps 	{5, "1024x768?I", 44980000, 1024, 768, 8,
    125   1.1    chopps 		76, 12, 79,  3, 80, 512, 24, 533, 2, 534},
    126   1.1    chopps 
    127   1.1    chopps 	/* 1024x1024, 60Hz */
    128   1.1    chopps 	{6, "1024x1024", 80000000, 1024,1024, 8,
    129   1.1    chopps 		77, 13, 78,  5, 78,1051, 27,1054, 2,1055},
    130   1.1    chopps 
    131   1.1    chopps 	/* 736x480, 60 Hz */
    132   1.1    chopps 	{7, "736x480", 28636300, 736, 480, 8,
    133   1.1    chopps 		54,  8, 57,  3, 58, 503, 23, 514, 3, 515},
    134   1.1    chopps };
    135   1.1    chopps 
    136   1.2    chopps int ulowell_mon_max = sizeof (ul_monitor_defs)/sizeof (ul_monitor_defs[0]);
    137   1.1    chopps 
    138   1.1    chopps /* option settable */
    139   1.1    chopps #ifndef ULOWELL_OSC1
    140   1.1    chopps #define ULOWELL_OSC1 36000000
    141   1.1    chopps #endif
    142   1.1    chopps 
    143   1.1    chopps #ifndef ULOWELL_OSC2
    144   1.1    chopps #define ULOWELL_OSC2 66667000
    145   1.1    chopps #endif
    146   1.1    chopps 
    147   1.1    chopps #ifndef ULOWELL_DEFAULT_MON
    148   1.1    chopps #define ULOWELL_DEFAULT_MON 1
    149   1.1    chopps #endif
    150   1.1    chopps 
    151   1.1    chopps /* patchable */
    152   1.1    chopps int ulowell_default_mon = ULOWELL_DEFAULT_MON;
    153   1.1    chopps int ulowell_default_gfx = ULOWELL_DEFAULT_MON;
    154   1.1    chopps 
    155   1.1    chopps /*
    156   1.1    chopps  * yes, this should be per board. We don't pay service to multiple boards,
    157   1.1    chopps  * anyway.
    158   1.1    chopps  */
    159   1.1    chopps 
    160   1.4    chopps u_long ulowell_clock[2] = { ULOWELL_OSC2, ULOWELL_OSC1 };
    161   1.1    chopps 
    162   1.1    chopps static struct grfvideo_mode *current_mon;
    163   1.1    chopps 
    164   1.1    chopps /*
    165   1.1    chopps  * We dont use ints at the moment, but will need this later to avoid
    166   1.1    chopps  * busy_waiting in gsp_write, and we use it for spurious int warnings.
    167   1.1    chopps  */
    168   1.1    chopps 
    169   1.1    chopps static int
    170  1.15     veego ulisr(arg)
    171  1.15     veego 	void *arg;
    172   1.1    chopps {
    173  1.15     veego 	struct grf_softc *gp = arg;
    174   1.1    chopps 	struct gspregs *ba;
    175   1.1    chopps 	u_int16_t	thebits;
    176   1.1    chopps 
    177   1.1    chopps 	if (gp == NULL)
    178   1.1    chopps 		return 0;
    179   1.1    chopps 
    180   1.1    chopps 	ba = (struct gspregs *)gp->g_regkva;
    181   1.1    chopps 
    182   1.1    chopps 	if (ba == NULL)
    183   1.1    chopps 		return 0;
    184   1.1    chopps 
    185   1.1    chopps 	thebits = ba->ctrl;
    186   1.1    chopps 	if (thebits & INTOUT) {
    187   1.1    chopps 		log(LOG_INFO, "grf4: got interrupt, ctrl=0x%4x\n", thebits);
    188   1.1    chopps 		/* clear int */
    189   1.1    chopps 		ba->ctrl = thebits & ~INTOUT;
    190   1.1    chopps 		return 1;
    191   1.1    chopps 	}
    192   1.1    chopps 	return 0;
    193   1.1    chopps }
    194   1.1    chopps 
    195   1.1    chopps /*
    196   1.1    chopps  * used to query the ulowell board to see if its alive.
    197   1.1    chopps  * for the moment, a NOP.
    198   1.1    chopps  */
    199   1.1    chopps int
    200   1.1    chopps ulowell_alive(mdp)
    201   1.1    chopps 	struct grfvideo_mode *mdp;
    202   1.1    chopps {
    203   1.1    chopps 	return 1;
    204   1.1    chopps }
    205   1.1    chopps 
    206   1.1    chopps /*
    207   1.1    chopps  * Load the (mostly) ite support code and the default colormaps.
    208   1.1    chopps  */
    209   1.1    chopps static void
    210   1.1    chopps ul_load_code(gp)
    211   1.1    chopps 	struct grf_softc *gp;
    212   1.1    chopps {
    213   1.1    chopps 	struct grf_ul_softc *gup;
    214   1.1    chopps 	struct gspregs *ba;
    215   1.1    chopps 	struct grfinfo *gi;
    216  1.15     veego 	int i,j;
    217  1.15     veego #if 0
    218   1.1    chopps 	struct grf_colormap gcm;
    219  1.15     veego #endif
    220   1.1    chopps 
    221   1.1    chopps 	gup = (struct grf_ul_softc *)gp;
    222   1.1    chopps 	ba = (struct gspregs *)gp->g_regkva;
    223   1.1    chopps 	gi = &gp->g_display;
    224   1.1    chopps 
    225   1.1    chopps 	gi->gd_regaddr	= ztwopa((caddr_t)ba);
    226   1.1    chopps 	gi->gd_regsize	= sizeof(struct gspregs);
    227   1.1    chopps 	gi->gd_fbaddr	= NULL;
    228   1.1    chopps 	gi->gd_fbsize	= 0;
    229   1.1    chopps 	gi->gd_fbwidth	= 1024;
    230   1.1    chopps 	gi->gd_fbheight	= 1024;
    231   1.1    chopps 	gi->gd_colors	= 256;
    232   1.1    chopps 
    233  1.15     veego 	ba->ctrl = (ba->ctrl & ~INCR) | (LBL | INCW);
    234   1.1    chopps 	ba->hstadrh = 0xC000;
    235   1.1    chopps 	ba->hstadrl = 0x0080;
    236   1.1    chopps 	ba->data = 0x0;		/* disable screen refresh and video output */
    237   1.1    chopps 	ba->data = 0xFFFC;	/* screen refresh base address */
    238   1.1    chopps 	ba->data = 0xFFFF;	/* no display int possible */
    239   1.1    chopps 	ba->data = 0x000C;	/* CAS before RAS refresh each 64 local clks */
    240   1.1    chopps 
    241   1.5    chopps 	ba->ctrl = (ba->ctrl & ~INCW) | LBL;
    242   1.1    chopps 	ba->hstadrh = 0xfe80;
    243   1.1    chopps 	ba->hstadrl = 0;
    244   1.1    chopps 	ba->data = 4;
    245   1.1    chopps 	ba->hstadrl = 0x20;
    246   1.1    chopps 	ba->data = 0xFF;	/* all color planes visible */
    247   1.1    chopps 
    248   1.1    chopps 	ba->hstadrl = 0;
    249   1.1    chopps 	ba->data = 5;
    250   1.1    chopps 	ba->hstadrl = 0x20;
    251   1.1    chopps 	ba->data = 0;		/* no color planes blinking */
    252   1.1    chopps 
    253   1.1    chopps 	ba->hstadrl = 0;
    254   1.1    chopps 	ba->data = 6;
    255   1.1    chopps 	ba->hstadrl = 0x20;
    256   1.1    chopps 	ba->data = gup->gus_ovslct = 0x43;
    257   1.1    chopps 	/* overlay visible, no overlay blinking, overlay color 0 transparent */
    258   1.1    chopps 
    259   1.1    chopps 	ba->hstadrl = 0;
    260   1.1    chopps 	ba->data = 7;
    261   1.1    chopps 	ba->hstadrl = 0x20;
    262   1.1    chopps 	ba->data = 0;		/* voodoo */
    263   1.1    chopps 
    264   1.1    chopps 	/* clear overlay planes */
    265   1.1    chopps 	ba->ctrl |= INCW;
    266   1.1    chopps 	ba->hstadrh = 0xff80;
    267   1.1    chopps 	ba->hstadrl = 0x0000;
    268   1.1    chopps 	for (i=0xff80000; i< 0xffa0000; ++i) {
    269   1.1    chopps 		ba->data = 0;
    270   1.1    chopps 	}
    271   1.1    chopps 
    272   1.1    chopps 	/* download tms code */
    273   1.1    chopps 
    274   1.1    chopps 	ba->ctrl = LBL | INCW | NMI | NMIM | HLT | CF;
    275   1.1    chopps 
    276  1.21  christos 	kprintf("\ndownloading TMS code");
    277   1.5    chopps 	i=0;
    278   1.5    chopps 	while ((j = tmscode[i++])) {
    279  1.21  christos 		kprintf(".");
    280   1.5    chopps 		ba->hstadrh = tmscode[i++];
    281   1.5    chopps 		ba->hstadrl = tmscode[i++];
    282   1.5    chopps 		while (j-- > 0) {
    283   1.5    chopps 			ba->data = tmscode[i++];
    284   1.1    chopps 		}
    285   1.1    chopps 	}
    286   1.1    chopps 
    287   1.1    chopps 	/* font info was uploaded in ite_ul.c(ite_ulinit). */
    288   1.1    chopps 
    289   1.9    chopps #if 1
    290   1.1    chopps 	/* XXX load image palette with some initial values, slightly hacky */
    291   1.1    chopps 
    292   1.1    chopps 	ba->hstadrh = 0xfe80;
    293   1.1    chopps 	ba->hstadrl = 0x0000;
    294   1.1    chopps 	ba->ctrl |= INCW;
    295   1.1    chopps 	ba->data = 0;
    296   1.1    chopps 	ba->ctrl &= ~INCW;
    297   1.1    chopps 
    298   1.1    chopps 	for (i=0; i<16; ++i) {
    299   1.1    chopps 		ba->data = gup->gus_imcmap[i+  0] = ul_std_palette[i+ 0];
    300   1.1    chopps 		ba->data = gup->gus_imcmap[i+256] = ul_std_palette[i+16];
    301   1.1    chopps 		ba->data = gup->gus_imcmap[i+512] = ul_std_palette[i+32];
    302   1.1    chopps 	}
    303   1.1    chopps 
    304   1.1    chopps 	/*
    305   1.1    chopps 	 * XXX load shadow overlay palette with what the TMS code will load
    306   1.9    chopps 	 * into the real one some time after the TMS code is started below.
    307   1.9    chopps 	 * This might be considered a rude hack.
    308   1.1    chopps 	 */
    309   1.1    chopps 	bcopy(ul_ovl_palette, gup->gus_ovcmap, 3*4);
    310   1.9    chopps 
    311   1.9    chopps 	/*
    312   1.9    chopps 	 * Unflush cache, unhalt cpu -> nmi starts to run. This MUST NOT BE
    313   1.9    chopps 	 * DONE before the image color map initialization above, to guarantee
    314  1.12        is 	 * the index register in the BT458 is not used by more than one CPU
    315   1.9    chopps 	 * at once.
    316   1.9    chopps 	 *
    317   1.9    chopps 	 * XXX For the same reason, we'll have to rething ul_putcmap(). For
    318   1.9    chopps 	 * details, look at comment there.
    319   1.9    chopps 	 */
    320   1.9    chopps 	ba->ctrl &= ~(HLT|CF);
    321   1.9    chopps 
    322   1.1    chopps #else
    323   1.9    chopps 	/*
    324   1.9    chopps 	 * XXX I wonder why this partially ever worked.
    325   1.9    chopps 	 *
    326   1.9    chopps 	 * This can't possibly work this way, as we are copyin()ing data in
    327   1.9    chopps 	 * ul_putcmap.
    328   1.9    chopps 	 *
    329   1.9    chopps 	 * I guess this partially worked because SFC happened to point to
    330   1.9    chopps 	 * to supervisor data space on 68030 machines coming from the old
    331   1.9    chopps 	 * boot loader.
    332   1.9    chopps 	 *
    333   1.9    chopps 	 * While this looks more correct than the hack in the other part of the
    334   1.9    chopps 	 * loop, we would have to do our own version of the loop through
    335   1.9    chopps 	 * colormap entries, set up command buffer, and call gsp_write(), or
    336   1.9    chopps 	 * factor out some code.
    337   1.9    chopps 	 */
    338   1.9    chopps 
    339   1.9    chopps 	/*
    340   1.9    chopps 	 * XXX This version will work for the overlay, if our queue codes
    341   1.1    chopps 	 * initial conditions are set at load time (not start time).
    342   1.1    chopps 	 * It further assumes that ul_putcmap only uses the
    343   1.1    chopps 	 * GRFIMDEV/GRFOVDEV bits of the dev parameter.
    344   1.1    chopps 	 */
    345   1.1    chopps 
    346   1.9    chopps 
    347   1.9    chopps 	/* unflush cache, unhalt cpu first -> nmi starts to run */
    348   1.9    chopps 	ba->ctrl &= ~(HLT|CF);
    349   1.9    chopps 
    350   1.1    chopps 	gcm.index = 0;
    351   1.1    chopps 	gcm.count = 16;
    352   1.1    chopps 	gcm.red   = ul_std_palette +  0;
    353   1.1    chopps 	gcm.green = ul_std_palette + 16;
    354   1.1    chopps 	gcm.blue  = ul_std_palette + 32;
    355   1.1    chopps 	ul_putcmap(gp, &gcm, GRFIMDEV);
    356   1.1    chopps 
    357   1.1    chopps 	gcm.index = 0;
    358   1.1    chopps 	gcm.count = 4;
    359   1.1    chopps 	gcm.red   = ul_ovl_palette + 0;
    360   1.1    chopps 	gcm.green = ul_ovl_palette + 4;
    361   1.1    chopps 	gcm.blue  = ul_ovl_palette + 8;
    362   1.1    chopps 	ul_putcmap(gp, &gcm, GRFOVDEV);
    363   1.1    chopps #endif
    364   1.1    chopps 
    365   1.1    chopps }
    366   1.1    chopps 
    367   1.1    chopps static int
    368   1.1    chopps ul_load_mon(gp, md)
    369   1.1    chopps 	struct grf_softc *gp;
    370   1.1    chopps 	struct grfvideo_mode *md;
    371   1.1    chopps {
    372   1.1    chopps 	struct grf_ul_softc *gup;
    373   1.1    chopps 	struct grfinfo *gi;
    374   1.1    chopps 	struct gspregs *ba;
    375   1.1    chopps 	u_int16_t buf[8];
    376   1.1    chopps 
    377   1.1    chopps 	gup = (struct grf_ul_softc *)gp;
    378   1.1    chopps 	gi = &gp->g_display;
    379   1.1    chopps 	ba = (struct gspregs *)gp->g_regkva;
    380   1.1    chopps 
    381   1.1    chopps 	gi->gd_dyn.gdi_fbx	= 0;
    382   1.1    chopps 	gi->gd_dyn.gdi_fby	= 0;
    383   1.1    chopps 	gi->gd_dyn.gdi_dwidth	= md->disp_width;
    384   1.1    chopps 	gi->gd_dyn.gdi_dheight	= md->disp_height;
    385   1.1    chopps 	gi->gd_dyn.gdi_dx	= 0;
    386   1.1    chopps 	gi->gd_dyn.gdi_dy	= 0;
    387   1.1    chopps 
    388  1.15     veego 	ba->ctrl = (ba->ctrl & ~INCR) | (LBL | INCW); /* XXX */
    389   1.1    chopps 
    390   1.1    chopps 	ba->hstadrh = 0xC000;
    391   1.1    chopps 	ba->hstadrl = 0x0000;
    392   1.1    chopps 	ba->data = md->hsync_stop;
    393   1.1    chopps 	ba->data = md->hblank_stop;
    394   1.1    chopps 	ba->data = md->hblank_start;
    395   1.1    chopps 	ba->data = md->hsync_start;
    396   1.1    chopps 	ba->data = md->vsync_stop;
    397   1.1    chopps 	ba->data = md->vblank_stop;
    398   1.1    chopps 	ba->data = md->vblank_start;
    399   1.1    chopps 	ba->data = md->vsync_start;
    400   1.1    chopps 
    401   1.1    chopps 	ba->ctrl &= ~INCW;
    402   1.1    chopps 	ba->hstadrh = 0xFE90;
    403   1.1    chopps 	ba->hstadrl = 0x0000;
    404   1.1    chopps 
    405   1.1    chopps 	if (abs(md->pixel_clock - ulowell_clock[0]) >
    406   1.1    chopps 	    abs(md->pixel_clock - ulowell_clock[1])) {
    407   1.1    chopps 
    408   1.5    chopps 		ba->data = (ba->data & 0xFC) | 2 | 1;
    409   1.1    chopps 		md->pixel_clock = ulowell_clock[1];
    410   1.1    chopps 
    411   1.1    chopps 	} else {
    412   1.5    chopps 		ba->data = (ba->data & 0xFC) | 2 | 0;
    413   1.1    chopps 		md->pixel_clock = ulowell_clock[0];
    414   1.1    chopps 	}
    415   1.1    chopps 
    416  1.15     veego 	ba->ctrl |= LBL | INCW;
    417   1.1    chopps 	ba->hstadrh = 0xC000;
    418   1.1    chopps 	ba->hstadrl = 0x0080;
    419   1.1    chopps 	ba->data = (md->vblank_start - md->vblank_stop == md->disp_height ?
    420   1.1    chopps 	    0xf020 : 0xb020);
    421   1.1    chopps 
    422   1.1    chopps 	/* I guess this should be in the yet unimplemented mode select ioctl */
    423   1.1    chopps 	/* Hm.. maybe not. We always put the console on overlay plane no 0. */
    424   1.1    chopps 	/* Anyway, this _IS_ called in the mode select ioctl. */
    425   1.1    chopps 
    426   1.1    chopps 	/* ite support code parameters: */
    427   1.1    chopps 	buf[0] = GCMD_MCHG;
    428   1.1    chopps 	buf[1] = md->disp_width;	/* display width */
    429   1.1    chopps 	buf[2] = md->disp_height;	/* display height */
    430   1.1    chopps 	buf[3] = 0;			/* LSW of frame buffer origin */
    431   1.1    chopps 	buf[4] = 0xFF80;		/* MSW of frame buffer origin */
    432   1.1    chopps 	buf[5] = gi->gd_fbwidth * 1;	/* frame buffer pitch */
    433   1.1    chopps 	buf[6] = 1;			/* frame buffer depth */
    434   1.1    chopps 	gsp_write(ba, buf, 7);
    435   1.1    chopps 
    436   1.1    chopps 	return(1);
    437   1.1    chopps }
    438   1.1    chopps 
    439  1.15     veego int ul_mode __P((struct grf_softc *, u_long, void *, u_long, int));
    440   1.1    chopps 
    441   1.1    chopps void grfulattach __P((struct device *, struct device *, void *));
    442  1.20       cgd int grfulprint __P((void *, const char *));
    443  1.13   thorpej int grfulmatch __P((struct device *, void *, void *));
    444   1.1    chopps 
    445  1.13   thorpej struct cfattach grful_ca = {
    446  1.13   thorpej 	sizeof(struct grf_ul_softc), grfulmatch, grfulattach
    447  1.13   thorpej };
    448  1.13   thorpej 
    449  1.14    mhitch struct cfdriver grful_cd = {
    450  1.13   thorpej 	NULL, "grful", DV_DULL, NULL, 0
    451  1.13   thorpej };
    452   1.1    chopps 
    453   1.1    chopps /*
    454   1.1    chopps  * only used in console init
    455   1.1    chopps  */
    456   1.1    chopps static struct cfdata *cfdata;
    457   1.1    chopps 
    458   1.1    chopps /*
    459   1.1    chopps  * we make sure to only init things once.  this is somewhat
    460   1.1    chopps  * tricky regarding the console.
    461   1.1    chopps  */
    462   1.1    chopps int
    463  1.13   thorpej grfulmatch(pdp, match, auxp)
    464   1.1    chopps 	struct device *pdp;
    465  1.13   thorpej 	void *match, *auxp;
    466   1.1    chopps {
    467  1.16     veego #ifdef ULOWELLCONSOLE
    468  1.13   thorpej 	struct cfdata *cfp = match;
    469   1.1    chopps 	static int ulconunit = -1;
    470   1.1    chopps #endif
    471   1.1    chopps 	struct zbus_args *zap;
    472   1.1    chopps 
    473   1.1    chopps 	zap = auxp;
    474   1.1    chopps 
    475   1.1    chopps 	/*
    476   1.1    chopps 	 * allow only one ulowell console
    477   1.1    chopps 	 */
    478   1.1    chopps         if (amiga_realconfig == 0)
    479   1.1    chopps #ifdef ULOWELLCONSOLE
    480   1.1    chopps 		if (ulconunit != -1)
    481   1.1    chopps #endif
    482   1.1    chopps 			return(0);
    483   1.1    chopps 
    484   1.1    chopps 	if (zap->manid != 1030 || zap->prodid != 0)
    485   1.1    chopps 		return(0);
    486   1.1    chopps 
    487   1.1    chopps #ifdef ULOWELLCONSOLE
    488   1.1    chopps 	if (amiga_realconfig == 0 || ulconunit != cfp->cf_unit) {
    489   1.1    chopps #endif
    490  1.11    chopps 		if ((unsigned)ulowell_default_mon > ulowell_mon_max)
    491   1.1    chopps 			ulowell_default_mon = 1;
    492   1.1    chopps 
    493   1.2    chopps 		current_mon = ul_monitor_defs + ulowell_default_mon - 1;
    494   1.1    chopps 		if (ulowell_alive(current_mon) == 0)
    495   1.1    chopps 			return(0);
    496   1.1    chopps #ifdef ULOWELLCONSOLE
    497   1.1    chopps 		if (amiga_realconfig == 0) {
    498   1.1    chopps 			ulconunit = cfp->cf_unit;
    499   1.1    chopps 			cfdata = cfp;
    500   1.1    chopps 		}
    501   1.1    chopps 	}
    502   1.1    chopps #endif
    503   1.1    chopps 	return(1);
    504   1.1    chopps }
    505   1.1    chopps 
    506   1.1    chopps /*
    507   1.1    chopps  * attach to the grfbus (zbus)
    508   1.1    chopps  */
    509   1.1    chopps void
    510   1.1    chopps grfulattach(pdp, dp, auxp)
    511   1.1    chopps 	struct device *pdp, *dp;
    512   1.1    chopps 	void *auxp;
    513   1.1    chopps {
    514   1.1    chopps 	static struct grf_ul_softc congrf;
    515   1.1    chopps 	struct zbus_args *zap;
    516   1.1    chopps 	struct grf_softc *gp;
    517   1.1    chopps 	struct grf_ul_softc *gup;
    518   1.1    chopps 
    519   1.1    chopps 	zap = auxp;
    520   1.1    chopps 
    521   1.1    chopps 	if (dp == NULL)
    522   1.1    chopps 		gup = &congrf;
    523   1.1    chopps 	else
    524   1.1    chopps 		gup = (struct grf_ul_softc *)dp;
    525   1.1    chopps 
    526   1.1    chopps 	gp = &gup->gus_sc;
    527   1.1    chopps 
    528   1.1    chopps 	if (dp != NULL && congrf.gus_sc.g_regkva != 0) {
    529   1.1    chopps 		/*
    530   1.1    chopps 		 * inited earlier, just copy (not device struct)
    531   1.1    chopps 		 */
    532   1.1    chopps 		bcopy(&congrf.gus_sc.g_display, &gp->g_display,
    533   1.1    chopps 		    (char *)&gup->gus_isr - (char *)&gp->g_display);
    534   1.1    chopps 
    535   1.1    chopps 		/* ...and transfer the isr */
    536   1.1    chopps 		gup->gus_isr.isr_ipl = 2;
    537   1.1    chopps 		gup->gus_isr.isr_intr = ulisr;
    538   1.1    chopps 		gup->gus_isr.isr_arg = (void *)gp;
    539   1.1    chopps 		/*
    540   1.1    chopps 		 * To make sure ints are always catched, first add new isr
    541   1.1    chopps 		 * then remove old:
    542   1.1    chopps 		 */
    543   1.1    chopps 		add_isr(&gup->gus_isr);
    544   1.1    chopps 		remove_isr(&congrf.gus_isr);
    545   1.1    chopps 	} else {
    546   1.1    chopps 		gp->g_regkva = (caddr_t)zap->va;
    547   1.1    chopps 		gp->g_fbkva = NULL;
    548   1.1    chopps 		gp->g_unit = GRF_ULOWELL_UNIT;
    549   1.1    chopps 		gp->g_flags = GF_ALIVE;
    550   1.1    chopps 		gp->g_mode = ul_mode;
    551   1.1    chopps 		gp->g_conpri = grful_cnprobe();
    552   1.1    chopps 		gp->g_data = NULL;
    553   1.1    chopps 
    554   1.1    chopps 		gup->gus_isr.isr_ipl = 2;
    555   1.1    chopps 		gup->gus_isr.isr_intr = ulisr;
    556   1.1    chopps 		gup->gus_isr.isr_arg = (void *)gp;
    557   1.1    chopps 		add_isr(&gup->gus_isr);
    558   1.1    chopps 
    559   1.1    chopps 		(void)ul_load_code(gp);
    560   1.1    chopps 		(void)ul_load_mon(gp, current_mon);
    561   1.1    chopps 		grful_iteinit(gp);
    562   1.1    chopps 	}
    563   1.1    chopps 	if (dp != NULL)
    564  1.21  christos 		kprintf("\n");
    565   1.1    chopps 	/*
    566   1.1    chopps 	 * attach grf
    567   1.1    chopps 	 */
    568   1.1    chopps 	amiga_config_found(cfdata, &gp->g_device, gp, grfulprint);
    569   1.1    chopps }
    570   1.1    chopps 
    571   1.1    chopps int
    572   1.1    chopps grfulprint(auxp, pnp)
    573   1.1    chopps 	void *auxp;
    574  1.20       cgd 	const char *pnp;
    575   1.1    chopps {
    576   1.1    chopps 	if (pnp)
    577  1.21  christos 		kprintf("grf%d at %s", ((struct grf_softc *)auxp)->g_unit,
    578   1.1    chopps 			pnp);
    579   1.1    chopps 	return(UNCONF);
    580   1.1    chopps }
    581   1.1    chopps 
    582   1.1    chopps static int
    583   1.1    chopps ul_getvmode (gp, vm)
    584   1.1    chopps 	struct grf_softc *gp;
    585   1.1    chopps 	struct grfvideo_mode *vm;
    586   1.1    chopps {
    587   1.1    chopps 	struct grfvideo_mode *md;
    588   1.1    chopps 
    589   1.1    chopps 	if (vm->mode_num && vm->mode_num > ulowell_mon_max)
    590   1.1    chopps 		return EINVAL;
    591   1.1    chopps 
    592   1.1    chopps 	if (! vm->mode_num)
    593   1.2    chopps 		vm->mode_num = current_mon - ul_monitor_defs + 1;
    594   1.1    chopps 
    595   1.2    chopps 	md = ul_monitor_defs + vm->mode_num - 1;
    596   1.3    chopps 	strncpy (vm->mode_descr, md->mode_descr,
    597   1.1    chopps 		sizeof (vm->mode_descr));
    598   1.1    chopps 
    599   1.1    chopps 	/* XXX should tell TMS to measure it */
    600   1.1    chopps 	vm->pixel_clock  = md->pixel_clock;
    601   1.1    chopps 	vm->disp_width   = md->disp_width;
    602   1.1    chopps 	vm->disp_height  = md->disp_height;
    603   1.1    chopps 	vm->depth        = md->depth;
    604   1.1    chopps 
    605   1.8       jtc 	vm->hblank_start = (md->hblank_start - md->hblank_stop) * 16;
    606   1.8       jtc 	vm->hblank_stop  = (md->htotal - 1) * 16;
    607   1.8       jtc 	vm->hsync_start  = (md->hsync_start  - md->hblank_stop) * 16;
    608   1.8       jtc 	vm->hsync_stop   = (md->hsync_stop + md->htotal - md->hblank_stop) * 16;
    609   1.8       jtc 	vm->htotal       = md->htotal * 16;
    610   1.1    chopps 
    611   1.7    chopps 	vm->vblank_start = md->vblank_start - md->vblank_stop;
    612   1.7    chopps 	vm->vblank_stop  = md->vtotal - 1;
    613   1.7    chopps 	vm->vsync_start  = md->vsync_start - md->vblank_stop;
    614   1.7    chopps 	vm->vsync_stop   = md->vsync_stop + md->vtotal - md->vblank_stop;
    615   1.1    chopps 	vm->vtotal       = md->vtotal;
    616   1.1    chopps 
    617   1.1    chopps 	return 0;
    618   1.1    chopps }
    619   1.1    chopps 
    620   1.1    chopps 
    621   1.1    chopps static int
    622   1.1    chopps ul_setvmode (gp, mode)
    623   1.1    chopps 	struct grf_softc *gp;
    624   1.1    chopps 	unsigned mode;
    625   1.1    chopps {
    626   1.1    chopps 	struct grf_ul_softc *gup;
    627   1.1    chopps 	struct gspregs *ba;
    628   1.1    chopps 	int error;
    629   1.1    chopps 
    630   1.1    chopps 	if (!mode || mode > ulowell_mon_max)
    631   1.1    chopps 		return EINVAL;
    632   1.1    chopps 
    633   1.1    chopps 	ba = (struct gspregs *)gp->g_regkva;
    634   1.1    chopps 	gup = (struct grf_ul_softc *)gp;
    635   1.2    chopps 	current_mon = ul_monitor_defs + mode - 1;
    636   1.1    chopps 
    637   1.1    chopps 	error = ul_load_mon (gp, current_mon) ? 0 : EINVAL;
    638   1.1    chopps 
    639   1.1    chopps 	return error;
    640   1.1    chopps }
    641   1.1    chopps 
    642   1.1    chopps /*
    643   1.1    chopps  * Set the frame buffer or overlay planes on or off.
    644   1.1    chopps  * Always succeeds.
    645   1.1    chopps  */
    646   1.1    chopps 
    647   1.1    chopps static __inline void
    648   1.1    chopps ul_setfb(gp, cmd)
    649   1.1    chopps 	struct grf_softc *gp;
    650  1.15     veego 	u_long cmd;
    651   1.1    chopps {
    652   1.1    chopps 	struct grf_ul_softc *gup;
    653   1.1    chopps 	struct gspregs *ba;
    654   1.1    chopps 
    655   1.1    chopps 	gup = (struct grf_ul_softc *)gp;
    656   1.1    chopps 
    657   1.1    chopps 	ba = (struct gspregs *)gp->g_regkva;
    658   1.1    chopps 	ba->ctrl = LBL;
    659   1.1    chopps 	ba->hstadrh = 0xfe80;
    660   1.1    chopps 	ba->hstadrl = 0x0000;
    661   1.1    chopps 	ba->data = 6;
    662   1.1    chopps 	ba->hstadrl = 0x0020;
    663   1.1    chopps 
    664   1.1    chopps 	switch (cmd) {
    665   1.1    chopps 	case GM_GRFON:
    666   1.1    chopps 		gup->gus_ovslct |= 0x40;
    667   1.1    chopps 		break;
    668   1.1    chopps 	case GM_GRFOFF:
    669   1.1    chopps 		gup->gus_ovslct &= ~0x40;
    670   1.1    chopps 		break;
    671   1.1    chopps 	case GM_GRFOVON:
    672   1.1    chopps 		gup->gus_ovslct |= 3;
    673   1.1    chopps 		break;
    674   1.1    chopps 	case GM_GRFOVOFF:
    675   1.1    chopps 		gup->gus_ovslct &= ~3;
    676   1.1    chopps 		break;
    677   1.1    chopps 	}
    678   1.1    chopps 	ba->data = gup->gus_ovslct;
    679   1.1    chopps }
    680   1.1    chopps 
    681   1.1    chopps /*
    682   1.1    chopps  * Change the mode of the display.
    683   1.1    chopps  * Return a UNIX error number or 0 for success.
    684   1.1    chopps  */
    685   1.1    chopps int
    686   1.1    chopps ul_mode(gp, cmd, arg, a2, a3)
    687   1.1    chopps 	struct grf_softc *gp;
    688  1.15     veego 	u_long cmd;
    689   1.1    chopps 	void *arg;
    690  1.15     veego 	u_long a2;
    691  1.15     veego 	int a3;
    692   1.1    chopps {
    693   1.1    chopps 	int i;
    694   1.1    chopps 	struct grfdyninfo *gd;
    695   1.1    chopps 
    696   1.1    chopps 	switch (cmd) {
    697   1.1    chopps 	case GM_GRFON:
    698   1.1    chopps 	case GM_GRFOFF:
    699   1.1    chopps 	case GM_GRFOVON:
    700   1.1    chopps 	case GM_GRFOVOFF:
    701   1.1    chopps 		ul_setfb (gp, cmd);
    702   1.1    chopps 		return 0;
    703   1.1    chopps 
    704   1.1    chopps 	case GM_GRFCONFIG:
    705   1.1    chopps 		gd = (struct grfdyninfo *)arg;
    706   1.1    chopps 		for (i=0; i<ulowell_mon_max; ++i) {
    707   1.2    chopps 			if (ul_monitor_defs[i].disp_width == gd->gdi_dwidth &&
    708   1.2    chopps 			    ul_monitor_defs[i].disp_height == gd->gdi_dheight)
    709   1.1    chopps 				return ul_setvmode(gp, i+1);
    710   1.1    chopps 		}
    711   1.1    chopps 		return EINVAL;
    712   1.1    chopps 
    713   1.1    chopps 	case GM_GRFGETVMODE:
    714   1.1    chopps 		return ul_getvmode (gp, (struct grfvideo_mode *) arg);
    715   1.1    chopps 
    716   1.1    chopps 	case GM_GRFSETVMODE:
    717   1.1    chopps 		return ul_setvmode (gp, *(unsigned *) arg);
    718   1.1    chopps 
    719   1.1    chopps 	case GM_GRFGETNUMVM:
    720   1.1    chopps 		*(int *)arg = ulowell_mon_max;
    721   1.1    chopps 		return 0;
    722   1.1    chopps 
    723   1.1    chopps 	case GM_GRFIOCTL:
    724  1.15     veego 		return ul_ioctl (gp, a2, arg, (dev_t)a3);
    725   1.1    chopps 
    726   1.1    chopps 	default:
    727   1.1    chopps 		break;
    728   1.1    chopps 	}
    729   1.1    chopps 
    730   1.1    chopps 	return EINVAL;
    731   1.1    chopps }
    732   1.1    chopps 
    733   1.1    chopps int
    734   1.1    chopps ul_ioctl (gp, cmd, data, dev)
    735   1.1    chopps 	register struct grf_softc *gp;
    736   1.1    chopps 	u_long cmd;
    737   1.1    chopps 	void *data;
    738   1.1    chopps 	dev_t dev;
    739   1.1    chopps {
    740   1.1    chopps 	switch (cmd) {
    741   1.1    chopps #if 0
    742   1.1    chopps 	/*
    743   1.1    chopps 	 * XXX we have no hardware sprites, but might implement them
    744   1.1    chopps 	 * later in TMS code.
    745   1.1    chopps 	 */
    746   1.1    chopps 
    747   1.1    chopps 	case GRFIOCGSPRITEPOS:
    748   1.1    chopps 		return ul_getspritepos (gp, (struct grf_position *) data);
    749   1.1    chopps 
    750   1.1    chopps 	case GRFIOCSSPRITEPOS:
    751   1.1    chopps 		return ul_setspritepos (gp, (struct grf_position *) data);
    752   1.1    chopps 
    753   1.1    chopps 	case GRFIOCSSPRITEINF:
    754   1.1    chopps 		return ul_setspriteinfo (gp, (struct grf_spriteinfo *) data);
    755   1.1    chopps 
    756   1.1    chopps 	case GRFIOCGSPRITEINF:
    757   1.1    chopps 		return ul_getspriteinfo (gp, (struct grf_spriteinfo *) data);
    758   1.1    chopps 
    759   1.1    chopps 	case GRFIOCGSPRITEMAX:
    760   1.1    chopps 		return ul_getspritemax (gp, (struct grf_position *) data);
    761   1.1    chopps 
    762   1.1    chopps #endif
    763   1.1    chopps 
    764   1.1    chopps 	case GRFIOCGETCMAP:
    765   1.1    chopps 		return ul_getcmap (gp, (struct grf_colormap *) data, dev);
    766   1.1    chopps 
    767   1.1    chopps 	case GRFIOCPUTCMAP:
    768   1.1    chopps 		return ul_putcmap (gp, (struct grf_colormap *) data, dev);
    769   1.1    chopps 
    770   1.1    chopps 	case GRFIOCBITBLT:
    771   1.1    chopps 		return ul_bitblt (gp, (struct grf_bitblt *) data, dev);
    772  1.10    chopps 
    773  1.10    chopps 	case GRFIOCBLANK:
    774  1.10    chopps 		return ul_blank (gp, (int *) data, dev);
    775   1.1    chopps 	}
    776   1.1    chopps 
    777   1.1    chopps 	return EINVAL;
    778   1.1    chopps }
    779   1.1    chopps 
    780   1.1    chopps int
    781   1.1    chopps ul_getcmap (gp, cmap, dev)
    782   1.1    chopps 	struct grf_softc *gp;
    783   1.1    chopps 	struct grf_colormap *cmap;
    784   1.1    chopps 	dev_t dev;
    785   1.1    chopps {
    786   1.1    chopps 	struct grf_ul_softc *gup;
    787   1.1    chopps 	u_int8_t *mymap;
    788   1.5    chopps 	int mxidx, error;
    789   1.1    chopps 
    790   1.1    chopps 	gup = (struct grf_ul_softc *)gp;
    791   1.1    chopps 
    792   1.1    chopps 	if (minor(dev) & GRFIMDEV) {
    793   1.1    chopps 		mxidx = 256;
    794   1.1    chopps 		mymap = gup->gus_imcmap;
    795   1.1    chopps 	} else {
    796   1.1    chopps 		mxidx = 4;
    797   1.1    chopps 		mymap = gup->gus_ovcmap;
    798   1.1    chopps 	}
    799   1.1    chopps 
    800   1.1    chopps 	if (cmap->count == 0 || cmap->index >= mxidx)
    801   1.1    chopps 		return 0;
    802   1.1    chopps 
    803   1.1    chopps 	if (cmap->index + cmap->count > mxidx)
    804   1.1    chopps 		cmap->count = mxidx - cmap->index;
    805   1.1    chopps 
    806   1.1    chopps 	/* just copyout from the shadow color map */
    807   1.1    chopps 
    808   1.1    chopps 	if ((error = copyout(mymap + cmap->index, cmap->red, cmap->count))
    809   1.1    chopps 
    810   1.1    chopps 	    || (error = copyout(mymap + mxidx + cmap->index, cmap->green,
    811   1.1    chopps 		cmap->count))
    812   1.1    chopps 
    813   1.1    chopps 	    || (error = copyout(mymap + mxidx * 2 + cmap->index, cmap->blue,
    814   1.1    chopps 		cmap->count)))
    815   1.1    chopps 
    816   1.1    chopps 		return(error);
    817   1.1    chopps 
    818   1.1    chopps 	return(0);
    819   1.1    chopps }
    820   1.1    chopps 
    821   1.1    chopps int
    822   1.1    chopps ul_putcmap (gp, cmap, dev)
    823   1.1    chopps 	struct grf_softc *gp;
    824   1.1    chopps 	struct grf_colormap *cmap;
    825   1.1    chopps 	dev_t dev;
    826   1.1    chopps {
    827   1.1    chopps 	struct grf_ul_softc *gup;
    828   1.1    chopps 	struct gspregs *ba;
    829   1.1    chopps 	u_int16_t cmd[8];
    830   1.1    chopps 	int x, mxidx, error;
    831   1.1    chopps 	u_int8_t *mymap;
    832   1.1    chopps 
    833   1.1    chopps 	gup = (struct grf_ul_softc *)gp;
    834   1.1    chopps 
    835   1.1    chopps 	if (minor(dev) & GRFIMDEV) {
    836   1.1    chopps 		mxidx = 256;
    837   1.1    chopps 		mymap = gup->gus_imcmap;
    838   1.1    chopps 	} else {
    839   1.1    chopps 		mxidx = 4;
    840   1.1    chopps 		mymap = gup->gus_ovcmap;
    841   1.1    chopps 	}
    842   1.1    chopps 
    843   1.1    chopps 	if (cmap->count == 0 || cmap->index >= mxidx)
    844   1.1    chopps 		return 0;
    845   1.1    chopps 
    846   1.1    chopps 	if (cmap->index + cmap->count > mxidx)
    847   1.1    chopps 		cmap->count = mxidx - cmap->index;
    848   1.1    chopps 
    849   1.1    chopps 	/* first copyin to our shadow color map */
    850   1.1    chopps 
    851   1.1    chopps 	if ((error = copyin(cmap->red, mymap + cmap->index, cmap->count))
    852   1.1    chopps 
    853   1.1    chopps 	    || (error = copyin(cmap->green, mymap + cmap->index + mxidx,
    854   1.1    chopps 		cmap->count))
    855   1.1    chopps 
    856   1.1    chopps 	    || (error = copyin(cmap->blue,  mymap + cmap->index + mxidx*2,
    857   1.1    chopps 		cmap->count)))
    858   1.1    chopps 
    859   1.1    chopps 		return error;
    860   1.1    chopps 
    861   1.1    chopps 
    862   1.1    chopps 	/* then write from there to the hardware */
    863   1.1    chopps 	ba = (struct gspregs *)gp->g_regkva;
    864   1.9    chopps 	/*
    865   1.9    chopps 	 * XXX This is a bad thing to do.
    866   1.9    chopps 	 * We should always use the gsp call, or have a means to arbitrate
    867  1.12        is 	 * the usage of the BT458 index register. Else there might be a
    868   1.9    chopps 	 * race condition (when writing both colormaps at nearly the same
    869   1.9    chopps 	 * time), where one CPU changes the index register when the other
    870   1.9    chopps 	 * one has not finished using it.
    871   1.9    chopps 	 */
    872   1.1    chopps 	if (mxidx > 4) {
    873   1.1    chopps 		/* image color map: we can write, with a hack, directly */
    874   1.1    chopps 		ba->ctrl = LBL;
    875   1.1    chopps 		ba->hstadrh = 0xfe80;
    876   1.1    chopps 		ba->hstadrl = 0x0000;
    877   1.1    chopps 		ba->ctrl |= INCW;
    878   1.1    chopps 		ba->data = cmap->index;
    879   1.1    chopps 		ba->ctrl &= ~INCW;
    880   1.1    chopps 
    881   1.1    chopps 		for (x=cmap->index; x < cmap->index + cmap->count; ++x) {
    882   1.1    chopps 			ba->data = (u_int16_t) mymap[x];
    883   1.1    chopps 			ba->data = (u_int16_t) mymap[x + mxidx];
    884   1.1    chopps 			ba->data = (u_int16_t) mymap[x + mxidx * 2];
    885   1.1    chopps 		}
    886   1.1    chopps 	} else {
    887   1.1    chopps 
    888   1.1    chopps 		/* overlay planes color map: have to call tms to do it */
    889   1.1    chopps 		cmd[0] = GCMD_CMAP;
    890   1.1    chopps 		cmd[1] = 1;
    891   1.1    chopps 		for (x=cmap->index; x < cmap->index + cmap->count; ++x) {
    892   1.1    chopps 			cmd[2] = x;
    893   1.1    chopps 			cmd[3] = mymap[x];
    894   1.1    chopps 			cmd[4] = mymap[x + mxidx];
    895   1.1    chopps 			cmd[5] = mymap[x + mxidx * 2];
    896   1.1    chopps 			gsp_write(ba, cmd, 6);
    897   1.1    chopps 		}
    898   1.1    chopps 	}
    899   1.1    chopps 	return 0;
    900   1.1    chopps }
    901   1.1    chopps 
    902  1.10    chopps int
    903  1.10    chopps ul_blank(gp, onoff, dev)
    904  1.10    chopps 	struct grf_softc *gp;
    905  1.10    chopps 	int *onoff;
    906  1.10    chopps 	dev_t dev;
    907  1.10    chopps {
    908  1.10    chopps 	struct gspregs *gsp;
    909  1.17        is 
    910  1.10    chopps 	gsp = (struct gspregs *)gp->g_regkva;
    911  1.15     veego 	gsp->ctrl = (gsp->ctrl & ~(INCR | INCW)) | LBL;
    912  1.10    chopps 	gsp->hstadrh = 0xC000;
    913  1.10    chopps 	gsp->hstadrl = 0x0080;
    914  1.18        is 	if (*onoff > 0)
    915  1.10    chopps 		gsp->data |= 0x9000;
    916  1.10    chopps 	else
    917  1.10    chopps 		gsp->data &= ~0x9000;
    918  1.10    chopps 
    919  1.10    chopps 	return 0;
    920  1.10    chopps }
    921   1.1    chopps /*
    922   1.1    chopps  * !!! THIS AREA UNDER CONSTRUCTION !!!
    923   1.1    chopps  */
    924   1.1    chopps int ul_BltOpMap[16] = {
    925   1.1    chopps 	3, 1, 2, 0, 11,  9, 10, 8,
    926   1.1    chopps 	7, 5, 6, 4, 15, 13, 14, 12
    927   1.1    chopps };
    928   1.1    chopps 
    929   1.1    chopps int
    930   1.1    chopps ul_bitblt (gp, bb, dev)
    931   1.1    chopps 	struct grf_softc *gp;
    932   1.1    chopps 	struct grf_bitblt *bb;
    933   1.1    chopps 	dev_t dev;
    934   1.1    chopps {
    935   1.1    chopps 	/* XXX not yet implemented, but pretty trivial */
    936   1.1    chopps 	return EINVAL;
    937   1.1    chopps }
    938   1.1    chopps 
    939   1.1    chopps void
    940   1.1    chopps gsp_write(gsp, ptr, size)
    941   1.1    chopps 	struct gspregs *gsp;
    942   1.1    chopps 	u_short *ptr;
    943   1.1    chopps 	size_t size;
    944   1.1    chopps {
    945   1.1    chopps 	u_short put, new_put, next, oc;
    946   1.1    chopps 	u_long put_hi, oa;
    947   1.1    chopps 	size_t n;
    948   1.1    chopps 
    949   1.1    chopps 	if (size == 0 || size > 8)
    950   1.1    chopps 	        return;
    951   1.1    chopps 
    952   1.1    chopps 	n = size;
    953   1.1    chopps 
    954   1.1    chopps 	oc = gsp->ctrl;
    955   1.1    chopps 	oa = GSPGETHADRS(gsp);
    956   1.1    chopps 
    957   1.5    chopps 	gsp->ctrl = (oc & ~INCR) | LBL | INCW;
    958   1.5    chopps 	GSPSETHADRS(gsp, GSP_MODE_ADRS);
    959   1.1    chopps 	gsp->data &= ~GMODE_FLUSH;
    960   1.1    chopps 
    961   1.5    chopps 	GSPSETHADRS(gsp, PUT_HI_PTR_ADRS);
    962   1.1    chopps 	put_hi = gsp->data << 16;
    963   1.1    chopps 
    964   1.5    chopps 	GSPSETHADRS(gsp, PUT_PTR_ADRS);
    965   1.1    chopps 	put = gsp->data;
    966   1.1    chopps 	new_put = put + (8<<4);
    967   1.1    chopps 
    968   1.5    chopps 	GSPSETHADRS(gsp, GET_PTR_ADRS);
    969   1.1    chopps 	next = gsp->data;
    970   1.1    chopps 
    971   1.1    chopps 	while (next == new_put) {
    972   1.1    chopps 		/*
    973   1.1    chopps 		 * we should use an intr. here. unfortunately, we already
    974   1.1    chopps 		 * are called from an interupt and can't use tsleep.
    975   1.1    chopps 		 * so we do busy waiting, at least for the moment.
    976   1.1    chopps 		 */
    977   1.1    chopps 
    978   1.1    chopps 		GSPSETHADRS(gsp,GET_PTR_ADRS);
    979   1.1    chopps 		next = gsp->data;
    980   1.1    chopps 	}
    981   1.1    chopps 
    982   1.1    chopps 	GSPSETHADRS(gsp,put|put_hi);
    983   1.1    chopps 	gsp->data = *ptr++ | 8<<4;
    984   1.1    chopps 	while ( --n > 0) {
    985   1.1    chopps 		gsp->data = *ptr++;
    986   1.1    chopps 	}
    987   1.1    chopps 
    988   1.1    chopps 	GSPSETHADRS(gsp,PUT_PTR_ADRS);
    989   1.1    chopps 	gsp->data = new_put;
    990   1.1    chopps 	GSPSETHADRS(gsp,oa);
    991   1.1    chopps 	gsp->ctrl = oc;
    992   1.1    chopps 
    993   1.1    chopps 	return;
    994   1.1    chopps }
    995   1.1    chopps 
    996   1.1    chopps #endif	/* NGRF */
    997