Home | History | Annotate | Line # | Download | only in dev
grf_rt.c revision 1.40
      1  1.40   aymeric /*	$NetBSD: grf_rt.c,v 1.40 2002/01/26 13:40:55 aymeric Exp $ */
      2   1.6    chopps 
      3  1.21    chopps /*
      4  1.21    chopps  * Copyright (c) 1993 Markus Wild
      5  1.21    chopps  * Copyright (c) 1993 Lutz Vieweg
      6  1.21    chopps  * All rights reserved.
      7  1.21    chopps  *
      8  1.21    chopps  * Redistribution and use in source and binary forms, with or without
      9  1.21    chopps  * modification, are permitted provided that the following conditions
     10  1.21    chopps  * are met:
     11  1.21    chopps  * 1. Redistributions of source code must retain the above copyright
     12  1.21    chopps  *    notice, this list of conditions and the following disclaimer.
     13  1.21    chopps  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.21    chopps  *    notice, this list of conditions and the following disclaimer in the
     15  1.21    chopps  *    documentation and/or other materials provided with the distribution.
     16  1.21    chopps  * 3. All advertising materials mentioning features or use of this software
     17  1.21    chopps  *    must display the following acknowledgement:
     18  1.21    chopps  *      This product includes software developed by Lutz Vieweg.
     19  1.21    chopps  * 4. The name of the author may not be used to endorse or promote products
     20  1.21    chopps  *    derived from this software without specific prior written permission
     21  1.21    chopps  *
     22  1.21    chopps  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23  1.21    chopps  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24  1.21    chopps  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25  1.21    chopps  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26  1.21    chopps  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27  1.21    chopps  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28  1.21    chopps  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29  1.21    chopps  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30  1.21    chopps  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31  1.21    chopps  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32  1.21    chopps  */
     33  1.37        is #include "opt_amigacons.h"
     34  1.15    chopps #include "grfrt.h"
     35  1.15    chopps #if NGRFRT > 0
     36   1.1        mw 
     37  1.40   aymeric /* Graphics routines for the Retina board,
     38   1.1        mw    using the NCR 77C22E+ VGA controller. */
     39   1.1        mw 
     40   1.4        mw #include <sys/param.h>
     41  1.25     veego #include <sys/systm.h>
     42   1.4        mw #include <sys/errno.h>
     43   1.4        mw #include <sys/ioctl.h>
     44  1.11    chopps #include <sys/device.h>
     45  1.11    chopps #include <machine/cpu.h>
     46  1.11    chopps #include <amiga/amiga/device.h>
     47  1.20    chopps #include <amiga/dev/zbusvar.h>
     48   1.7    chopps #include <amiga/dev/grfioctl.h>
     49   1.7    chopps #include <amiga/dev/grfvar.h>
     50   1.7    chopps #include <amiga/dev/grf_rtreg.h>
     51   1.1        mw 
     52  1.40   aymeric int rt_ioctl(struct grf_softc *gp, u_long, void *);
     53  1.19    chopps 
     54  1.11    chopps /*
     55  1.40   aymeric  * marked true early so that retina_cnprobe() can tell if we are alive.
     56  1.11    chopps  */
     57  1.11    chopps int retina_inited;
     58   1.8    chopps 
     59   1.8    chopps 
     60  1.21    chopps /*
     61  1.21    chopps  * This driver for the MacroSystem Retina board was only possible,
     62  1.21    chopps  * because MacroSystem provided information about the pecularities
     63  1.40   aymeric  * of the board. THANKS! Competition in Europe among gfx board
     64  1.21    chopps  * manufacturers is rather tough, so Lutz Vieweg, who wrote the
     65  1.21    chopps  * initial driver, has made an agreement with MS not to document
     66  1.21    chopps  * the driver source (see also his comment below).
     67  1.40   aymeric  * -> ALL comments after
     68  1.25     veego  * -> " -------------- START OF CODE -------------- "
     69  1.21    chopps  * -> have been added by myself (mw) from studying the publically
     70  1.21    chopps  * -> available "NCR 77C22E+" Data Manual
     71  1.40   aymeric  */
     72  1.21    chopps /*
     73  1.21    chopps  * This code offers low-level routines to access the Retina graphics-board
     74  1.21    chopps  * manufactured by MS MacroSystem GmbH from within NetBSD for the Amiga.
     75  1.40   aymeric  *
     76  1.38       wiz  * Thanks to MacroSystem for providing me with the necessary information
     77  1.21    chopps  * to create theese routines. The sparse documentation of this code
     78  1.21    chopps  * results from the agreements between MS and me.
     79  1.21    chopps  */
     80   1.1        mw 
     81   1.9    chopps extern unsigned char kernel_font_8x8_width, kernel_font_8x8_height;
     82   1.9    chopps extern unsigned char kernel_font_8x8_lo, kernel_font_8x8_hi;
     83   1.9    chopps extern unsigned char kernel_font_8x8[];
     84   1.1        mw 
     85   1.1        mw 
     86  1.40   aymeric #define MDF_DBL 1
     87  1.40   aymeric #define MDF_LACE 2
     88  1.40   aymeric #define MDF_CLKDIV2 4
     89   1.1        mw 
     90   1.1        mw 
     91   1.1        mw /* standard-palette definition */
     92   1.1        mw 
     93   1.1        mw unsigned char NCRStdPalette[16*3] = {
     94   1.1        mw /*   R   G   B  */
     95   1.1        mw 	  0,  0,  0,
     96   1.1        mw 	192,192,192,
     97  1.40   aymeric 	128,  0,  0,
     98   1.1        mw 	  0,128,  0,
     99   1.1        mw 	  0,  0,128,
    100  1.40   aymeric 	128,128,  0,
    101  1.40   aymeric 	  0,128,128,
    102   1.1        mw 	128,  0,128,
    103   1.1        mw 	 64, 64, 64, /* the higher 8 colors have more intensity for  */
    104   1.1        mw 	255,255,255, /* compatibility with standard attributes       */
    105  1.40   aymeric 	255,  0,  0,
    106   1.1        mw 	  0,255,  0,
    107   1.1        mw 	  0,  0,255,
    108  1.40   aymeric 	255,255,  0,
    109  1.40   aymeric 	  0,255,255,
    110  1.40   aymeric 	255,  0,255
    111   1.1        mw };
    112   1.1        mw 
    113   1.1        mw 
    114   1.1        mw /* The following structures are examples for monitor-definitions. To make one
    115   1.1        mw    of your own, first use "DefineMonitor" and create the 8-bit monitor-mode of
    116   1.1        mw    your dreams. Then save it, and make a structure from the values provided in
    117   1.1        mw    the file DefineMonitor stored - the labels in the comment above the
    118   1.1        mw    structure definition show where to put what value.
    119  1.40   aymeric 
    120   1.1        mw    Then you'll need to adapt your monitor-definition to the font you want to
    121   1.1        mw    use. Be FX the width of the font, then the following modifications have to
    122   1.1        mw    be applied to your values:
    123  1.40   aymeric 
    124   1.1        mw    HBS = (HBS * 4) / FX
    125   1.1        mw    HSS = (HSS * 4) / FX
    126   1.1        mw    HSE = (HSE * 4) / FX
    127   1.1        mw    HBE = (HBE * 4) / FX
    128   1.1        mw    HT  = (HT  * 4) / FX
    129   1.1        mw 
    130   1.1        mw    Make sure your maximum width (MW) and height (MH) are even multiples of
    131   1.1        mw    the fonts' width and height.
    132   1.1        mw */
    133   1.1        mw 
    134   1.1        mw #if 0
    135   1.1        mw /* horizontal 31.5 kHz */
    136   1.1        mw 
    137   1.1        mw /*                                      FQ     FLG    MW   MH   HBS HSS HSE HBE  HT  VBS  VSS  VSE  VBE   VT  */
    138   1.1        mw    struct MonDef MON_640_512_60  = { 50000000,  28,  640, 512,   81, 86, 93, 98, 95, 513, 513, 521, 535, 535,
    139   1.1        mw    /* Depth,           PAL, TX,  TY,    XY,FontX, FontY,    FontData,  FLo,  Fhi */
    140  1.40   aymeric           4, NCRStdPalette, 80,  64,  5120,    8,     8, kernel_font_8x8,   32,  255};
    141   1.1        mw 
    142   1.4        mw  struct MonDef MON_640_480_62_G  = { 50000000,   4,  640, 480,  161,171,184,196,195, 481, 484, 492, 502, 502,
    143  1.40   aymeric           8, NCRStdPalette,640,480,  5120,    8,     8, kernel_font_8x8,   32,  255};
    144   1.4        mw /* Enter higher values here ^   ^ for panning! */
    145   1.4        mw 
    146   1.1        mw /* horizontal 38kHz */
    147   1.1        mw 
    148   1.1        mw    struct MonDef MON_768_600_60  = { 75000000,  28,  768, 600,   97, 99,107,120,117, 601, 615, 625, 638, 638,
    149  1.40   aymeric           4, NCRStdPalette, 96,  75,  7200,    8,     8, kernel_font_8x8,   32,  255};
    150   1.1        mw 
    151   1.1        mw /* horizontal 64kHz */
    152   1.1        mw 
    153   1.1        mw    struct MonDef MON_768_600_80  = { 50000000, 24,  768, 600,   97,104,112,122,119, 601, 606, 616, 628, 628,
    154  1.40   aymeric           4, NCRStdPalette, 96,  75,  7200,    8,     8, kernel_font_8x8,   32,  255};
    155   1.1        mw 
    156   1.1        mw    struct MonDef MON_1024_768_80 = { 90000000, 24, 1024, 768,  129,130,141,172,169, 769, 770, 783, 804, 804,
    157  1.40   aymeric           4, NCRStdPalette,128,  96, 12288,    8,     8, kernel_font_8x8,   32,  255};
    158   1.4        mw 
    159   1.4        mw /*                                     FQ     FLG    MW   MH   HBS HSS HSE HBE  HT  VBS  VSS  VSE  VBE   VT  */
    160   1.4        mw  struct MonDef MON_1024_768_80_G = { 90000000, 0,  1024, 768,  257,258,280,344,343, 769, 770, 783, 804, 804,
    161  1.40   aymeric           8, NCRStdPalette, 1024, 768, 12288,    8,     8, kernel_font_8x8,   32,  255};
    162   1.1        mw 
    163   1.1        mw    struct MonDef MON_1024_1024_59= { 90000000, 24, 1024,1024,  129,130,141,173,170,1025,1059,1076,1087,1087,
    164  1.40   aymeric           4, NCRStdPalette,128, 128, 16384,    8,     8, kernel_font_8x8,   32,  255};
    165   1.1        mw 
    166   1.1        mw /* WARNING: THE FOLLOWING MONITOR MODES EXCEED THE 90-MHz LIMIT THE PROCESSOR
    167   1.1        mw             HAS BEEN SPECIFIED FOR. USE AT YOUR OWN RISK (AND THINK ABOUT
    168   1.1        mw             MOUNTING SOME COOLING DEVICE AT THE PROCESSOR AND RAMDAC)!     */
    169   1.1        mw 
    170   1.1        mw    struct MonDef MON_1280_1024_60= {110000000,  24, 1280,1024,  161,162,176,211,208,1025,1026,1043,1073,1073,
    171  1.40   aymeric           4, NCRStdPalette,160, 128, 20480,    8,     8, kernel_font_8x8,   32,  255};
    172   1.1        mw 
    173   1.4        mw  struct MonDef MON_1280_1024_60_G= {110000000,   0, 1280,1024,  321,322,349,422,421,1025,1026,1043,1073,1073,
    174  1.40   aymeric           8, NCRStdPalette,1280,1024, 20480,    8,     8, kernel_font_8x8,   32,  255};
    175   1.4        mw 
    176   1.1        mw /* horizontal 75kHz */
    177   1.1        mw 
    178  1.40   aymeric    struct MonDef MON_1280_1024_69= {120000000,  24, 1280,1024,  161,162,175,200,197,1025,1026,1043,1073,1073,
    179  1.40   aymeric           4, NCRStdPalette,160, 128, 20480,    8,     8, kernel_font_8x8,   32,  255};
    180   1.1        mw 
    181   1.1        mw #else
    182   1.1        mw 
    183   1.1        mw struct MonDef monitor_defs[] = {
    184   1.1        mw /* horizontal 31.5 kHz */
    185   1.1        mw 
    186   1.1        mw    { 50000000,  28,  640, 512,   81, 86, 93, 98, 95, 513, 513, 521, 535, 535,
    187   1.9    chopps           4, NCRStdPalette, 80,  64,  5120,    8,     8, kernel_font_8x8,   32,  255},
    188   1.1        mw 
    189   1.1        mw /* horizontal 38kHz */
    190   1.1        mw 
    191   1.1        mw    { 75000000,  28,  768, 600,   97, 99,107,120,117, 601, 615, 625, 638, 638,
    192   1.9    chopps           4, NCRStdPalette, 96,  75,  7200,    8,     8, kernel_font_8x8,   32,  255},
    193   1.1        mw 
    194   1.1        mw /* horizontal 64kHz */
    195   1.1        mw 
    196   1.1        mw    { 50000000, 24,  768, 600,   97,104,112,122,119, 601, 606, 616, 628, 628,
    197   1.9    chopps           4, NCRStdPalette, 96,  75,  7200,    8,     8, kernel_font_8x8,   32,  255},
    198  1.40   aymeric 
    199   1.1        mw    { 90000000, 24, 1024, 768,  129,130,141,172,169, 769, 770, 783, 804, 804,
    200   1.9    chopps           4, NCRStdPalette,128,  96, 12288,    8,     8, kernel_font_8x8,   32,  255},
    201   1.1        mw 
    202   1.4        mw    /* GFX modes */
    203   1.2        mw 
    204   1.4        mw /* horizontal 31.5 kHz */
    205   1.2        mw 
    206   1.4        mw    { 50000000,   4,  640, 480,  161,171,184,196,195, 481, 484, 492, 502, 502,
    207   1.9    chopps           8, NCRStdPalette,640, 480,  5120,    8,     8, kernel_font_8x8,   32,  255},
    208   1.2        mw 
    209   1.4        mw /* horizontal 64kHz */
    210   1.2        mw 
    211   1.4        mw    { 90000000, 0,  1024, 768,  257,258,280,344,343, 769, 770, 783, 804, 804,
    212   1.9    chopps           8, NCRStdPalette, 1024, 768, 12288,    8,     8, kernel_font_8x8,   32,  255},
    213   1.1        mw 
    214   1.1        mw /* WARNING: THE FOLLOWING MONITOR MODES EXCEED THE 90-MHz LIMIT THE PROCESSOR
    215   1.1        mw             HAS BEEN SPECIFIED FOR. USE AT YOUR OWN RISK (AND THINK ABOUT
    216   1.1        mw             MOUNTING SOME COOLING DEVICE AT THE PROCESSOR AND RAMDAC)!     */
    217   1.1        mw 
    218   1.4        mw    {110000000,   0, 1280,1024,  321,322,349,422,421,1025,1026,1043,1073,1073,
    219   1.9    chopps           8, NCRStdPalette,1280,1024, 20480,    8,     8, kernel_font_8x8,   32,  255},
    220   1.1        mw };
    221   1.1        mw 
    222   1.1        mw static const char *monitor_descr[] = {
    223   1.1        mw   "80x64 (640x512) 31.5kHz",
    224   1.1        mw   "96x75 (768x600) 38kHz",
    225   1.1        mw   "96x75 (768x600) 64kHz",
    226   1.1        mw   "128x96 (1024x768) 64kHz",
    227   1.4        mw 
    228   1.4        mw   "GFX (640x480) 31.5kHz",
    229   1.4        mw   "GFX (1024x768) 64kHz",
    230  1.40   aymeric   "GFX (1280x1024) 64kHz ***EXCEEDS CHIP LIMIT!!!***",
    231   1.1        mw };
    232   1.1        mw 
    233   1.1        mw int retina_mon_max = sizeof (monitor_defs)/sizeof (monitor_defs[0]);
    234   1.1        mw 
    235   1.1        mw /* patchable */
    236  1.17    chopps int retina_default_mon = 0;
    237  1.17    chopps int retina_default_gfx = 4;
    238  1.40   aymeric 
    239   1.1        mw #endif
    240   1.1        mw 
    241   1.1        mw 
    242   1.1        mw static struct MonDef *current_mon;
    243   1.1        mw 
    244   1.1        mw /* -------------- START OF CODE -------------- */
    245   1.1        mw 
    246   1.1        mw 
    247   1.1        mw static const long FQTab[16] =
    248   1.1        mw { 25175000,  28322000,  36000000,  65000000,
    249   1.1        mw   44900000,  50000000,  80000000,  75000000,
    250   1.1        mw   56644000,  63000000,  72000000, 130000000,
    251   1.1        mw   90000000, 100000000, 110000000, 120000000 };
    252   1.1        mw 
    253   1.1        mw 
    254   1.1        mw /*--------------------------------------------------*/
    255   1.1        mw /*--------------------------------------------------*/
    256   1.1        mw 
    257   1.1        mw #if 0
    258   1.1        mw static struct MonDef *default_monitor = &DEFAULT_MONDEF;
    259   1.1        mw #endif
    260   1.1        mw 
    261  1.40   aymeric int retina_alive(struct MonDef *);
    262  1.40   aymeric static int rt_load_mon(struct grf_softc *, struct MonDef *);
    263  1.25     veego 
    264  1.25     veego 
    265  1.11    chopps /*
    266  1.11    chopps  * used to query the retina to see if its alive (?)
    267  1.11    chopps  */
    268  1.11    chopps int
    269  1.40   aymeric retina_alive(struct MonDef *mdp)
    270  1.11    chopps {
    271  1.11    chopps 	short clksel;
    272  1.11    chopps 
    273  1.11    chopps 	for (clksel = 15; clksel; clksel--) {
    274  1.11    chopps 		if (FQTab[clksel] == mdp->FQ)
    275  1.11    chopps 			break;
    276  1.11    chopps 	}
    277  1.40   aymeric 	if (clksel < 0)
    278  1.11    chopps 		return(0);
    279  1.11    chopps 	if (mdp->DEP != 4)
    280  1.11    chopps 		return(1);
    281  1.11    chopps 	if (mdp->FX == 4 || (mdp->FX >= 7 && mdp->FX <= 16))
    282  1.11    chopps 		return(1);
    283  1.11    chopps 	return(0);
    284  1.11    chopps }
    285   1.1        mw 
    286  1.11    chopps static int
    287  1.40   aymeric rt_load_mon(struct grf_softc *gp, struct MonDef *md)
    288   1.1        mw {
    289   1.1        mw 	struct grfinfo *gi = &gp->g_display;
    290  1.25     veego 	volatile caddr_t ba, fb;
    291   1.1        mw 	short FW, clksel, HDE, VDE;
    292   1.1        mw 
    293   1.1        mw 	for (clksel = 15; clksel; clksel--) {
    294   1.1        mw 		if (FQTab[clksel] == md->FQ) break;
    295   1.1        mw 	}
    296  1.11    chopps 	if (clksel < 0)
    297  1.11    chopps 		return(0);
    298  1.40   aymeric 
    299   1.1        mw 	ba = gp->g_regkva;;
    300   1.1        mw 	fb = gp->g_fbkva;
    301   1.4        mw 
    302   1.4        mw 	FW = 0;
    303   1.4        mw 	if (md->DEP == 4) {
    304   1.4        mw 		switch (md->FX) {
    305  1.27     veego 		    case 4:
    306   1.4        mw 			FW = 0;
    307   1.4        mw 			break;
    308  1.27     veego 		    case 7:
    309   1.4        mw 			FW = 1;
    310   1.4        mw 			break;
    311  1.27     veego 		    case 8:
    312   1.4        mw 			FW = 2;
    313   1.4        mw 			break;
    314  1.27     veego 		    case 9:
    315   1.4        mw 			FW = 3;
    316   1.4        mw 			break;
    317  1.27     veego 		    case 10:
    318   1.4        mw 			FW = 4;
    319   1.4        mw 			break;
    320  1.27     veego 		    case 11:
    321   1.4        mw 			FW = 5;
    322   1.4        mw 			break;
    323  1.27     veego 		    case 12:
    324   1.4        mw 			FW = 6;
    325   1.4        mw 			break;
    326  1.27     veego 		    case 13:
    327   1.4        mw 			FW = 7;
    328   1.4        mw 			break;
    329  1.27     veego 		    case 14:
    330   1.4        mw 			FW = 8;
    331   1.4        mw 			break;
    332  1.27     veego 		    case 15:
    333   1.4        mw 			FW = 9;
    334   1.4        mw 			break;
    335  1.27     veego 		    case 16:
    336   1.4        mw 			FW = 11;
    337   1.4        mw 			break;
    338  1.27     veego 		    default:
    339  1.11    chopps 			return(0);
    340   1.4        mw 			break;
    341   1.4        mw 		};
    342   1.4        mw 	}
    343  1.40   aymeric 
    344   1.4        mw         if (md->DEP == 4) HDE = (md->MW+md->FX-1)/md->FX;
    345   1.4        mw         else              HDE = (md->MW+3)/4;
    346   1.1        mw 	VDE = md->MH-1;
    347  1.40   aymeric 
    348   1.1        mw 	/* hmm... */
    349   1.1        mw 	fb[0x8000] = 0;
    350   1.1        mw 
    351   1.2        mw 		/* enable extension registers */
    352   1.2        mw 	WSeq (ba, SEQ_ID_EXTENDED_ENABLE,	0x05);
    353   1.2        mw 
    354   1.2        mw #if 0
    355  1.40   aymeric 	/* program the clock oscillator */
    356   1.1        mw 	vgaw (ba, GREG_MISC_OUTPUT_W, 0xe3 | ((clksel & 3) * 0x04));
    357   1.1        mw 	vgaw (ba, GREG_FEATURE_CONTROL_W, 0x00);
    358  1.40   aymeric 
    359   1.1        mw 	/* XXXX according to the NCR specs, this register should be set to 1
    360   1.1        mw 	   XXXX before doing the MISC_OUTPUT setting and CLOCKING_MODE
    361   1.1        mw 	   XXXX setting. */
    362  1.40   aymeric 	WSeq (ba, SEQ_ID_RESET, 		0x03);
    363   1.1        mw 
    364  1.40   aymeric 	WSeq (ba, SEQ_ID_CLOCKING_MODE, 	0x01 | ((md->FLG & MDF_CLKDIV2)/ MDF_CLKDIV2 * 8));
    365  1.40   aymeric 	WSeq (ba, SEQ_ID_MAP_MASK, 		0x0f);
    366   1.1        mw 	WSeq (ba, SEQ_ID_CHAR_MAP_SELECT, 	0x00);
    367  1.40   aymeric 		/* odd/even write select + extended memory */
    368   1.1        mw 	WSeq (ba, SEQ_ID_MEMORY_MODE, 	0x06);
    369   1.1        mw 	/* XXXX I think this order of setting RESET is wrong... */
    370  1.40   aymeric 	WSeq (ba, SEQ_ID_RESET, 		0x01);
    371  1.40   aymeric 	WSeq (ba, SEQ_ID_RESET, 		0x03);
    372   1.2        mw #else
    373  1.40   aymeric 	WSeq (ba, SEQ_ID_RESET, 		0x01);
    374   1.2        mw 
    375   1.2        mw 		/* set font width + rest of clocks */
    376  1.40   aymeric 	WSeq (ba, SEQ_ID_EXT_CLOCK_MODE,	0x30 | (FW & 0x0f) | ((clksel & 4) / 4 * 0x40) );
    377  1.40   aymeric 		/* another clock bit, plus hw stuff */
    378  1.40   aymeric 	WSeq (ba, SEQ_ID_MISC_FEATURE_SEL,	0xf4 | (clksel & 8) );
    379   1.2        mw 
    380  1.40   aymeric 	/* program the clock oscillator */
    381   1.2        mw 	vgaw (ba, GREG_MISC_OUTPUT_W, 		0xe3 | ((clksel & 3) * 0x04));
    382   1.2        mw 	vgaw (ba, GREG_FEATURE_CONTROL_W, 	0x00);
    383  1.40   aymeric 
    384  1.40   aymeric 	WSeq (ba, SEQ_ID_CLOCKING_MODE, 	0x01 | ((md->FLG & MDF_CLKDIV2)/ MDF_CLKDIV2 * 8));
    385  1.40   aymeric 	WSeq (ba, SEQ_ID_MAP_MASK, 		0x0f);
    386   1.2        mw 	WSeq (ba, SEQ_ID_CHAR_MAP_SELECT, 	0x00);
    387  1.40   aymeric 		/* odd/even write select + extended memory */
    388   1.2        mw 	WSeq (ba, SEQ_ID_MEMORY_MODE, 		0x06);
    389  1.40   aymeric 	WSeq (ba, SEQ_ID_RESET, 		0x03);
    390   1.2        mw #endif
    391  1.40   aymeric 
    392   1.1        mw 		/* monochrome cursor */
    393  1.40   aymeric 	WSeq (ba, SEQ_ID_CURSOR_CONTROL,	0x00);
    394   1.1        mw 		/* bank0 */
    395  1.40   aymeric 	WSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI,	0x00);
    396  1.40   aymeric 	WSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO,	0x00);
    397   1.4        mw 	WSeq (ba, SEQ_ID_DISP_OFF_HI , 		0x00);
    398   1.4        mw 	WSeq (ba, SEQ_ID_DISP_OFF_LO , 		0x00);
    399   1.1        mw 		/* bank0 */
    400  1.40   aymeric 	WSeq (ba, SEQ_ID_SEC_HOST_OFF_HI,	0x00);
    401  1.40   aymeric 	WSeq (ba, SEQ_ID_SEC_HOST_OFF_LO,	0x00);
    402   1.1        mw 		/* 1M-chips + ena SEC + ena EMem + rw PrimA0/rw Sec/B0 */
    403   1.1        mw 	WSeq (ba, SEQ_ID_EXTENDED_MEM_ENA,	0x3 | 0x4 | 0x10 | 0x40);
    404   1.2        mw #if 0
    405   1.1        mw 		/* set font width + rest of clocks */
    406  1.40   aymeric 	WSeq (ba, SEQ_ID_EXT_CLOCK_MODE,	0x30 | (FW & 0x0f) | ((clksel & 4) / 4 * 0x40) );
    407   1.2        mw #endif
    408   1.4        mw 	if (md->DEP == 4) {
    409   1.4        mw 			/* no ext-chain4 + no host-addr-bit-16 */
    410  1.40   aymeric 		WSeq (ba, SEQ_ID_EXT_VIDEO_ADDR,	0x00);
    411   1.4        mw 			/* no packed/nibble + no 256bit gfx format */
    412   1.4        mw 		WSeq (ba, SEQ_ID_EXT_PIXEL_CNTL,	0x00);
    413   1.4        mw 	}
    414   1.4        mw 	else {
    415  1.40   aymeric 		WSeq (ba, SEQ_ID_EXT_VIDEO_ADDR,	0x02);
    416   1.4        mw 			/* 256bit gfx format */
    417   1.4        mw 		WSeq (ba, SEQ_ID_EXT_PIXEL_CNTL,	0x01);
    418   1.4        mw 	}
    419   1.1        mw 		/* AT-interface */
    420  1.40   aymeric 	WSeq (ba, SEQ_ID_BUS_WIDTH_FEEDB,	0x06);
    421   1.1        mw 		/* see fg/bg color expansion */
    422  1.40   aymeric 	WSeq (ba, SEQ_ID_COLOR_EXP_WFG,		0x01);
    423   1.1        mw 	WSeq (ba, SEQ_ID_COLOR_EXP_WBG,		0x00);
    424   1.1        mw 	WSeq (ba, SEQ_ID_EXT_RW_CONTROL,	0x00);
    425   1.2        mw #if 0
    426  1.40   aymeric 		/* another clock bit, plus hw stuff */
    427  1.40   aymeric 	WSeq (ba, SEQ_ID_MISC_FEATURE_SEL,	0xf4 | (clksel & 8) );
    428   1.2        mw #endif
    429   1.1        mw 		/* don't tristate PCLK and PIX */
    430  1.40   aymeric 	WSeq (ba, SEQ_ID_COLOR_KEY_CNTL,	0x40 );
    431   1.1        mw 		/* reset CRC circuit */
    432  1.40   aymeric 	WSeq (ba, SEQ_ID_CRC_CONTROL,		0x00 );
    433   1.1        mw 		/* set RAS/CAS swap */
    434  1.40   aymeric 	WSeq (ba, SEQ_ID_PERF_SELECT,		0x20);
    435  1.40   aymeric 
    436  1.40   aymeric 	WCrt (ba, CRT_ID_END_VER_RETR,		(md->VSE & 0xf ) | 0x20);
    437   1.1        mw 	WCrt (ba, CRT_ID_HOR_TOTAL,		md->HT   & 0xff);
    438   1.1        mw 	WCrt (ba, CRT_ID_HOR_DISP_ENA_END,	(HDE-1)  & 0xff);
    439   1.1        mw 	WCrt (ba, CRT_ID_START_HOR_BLANK,	md->HBS  & 0xff);
    440   1.1        mw 	WCrt (ba, CRT_ID_END_HOR_BLANK,		(md->HBE & 0x1f) | 0x80);
    441  1.40   aymeric 
    442   1.1        mw 	WCrt (ba, CRT_ID_START_HOR_RETR,	md->HSS  & 0xff);
    443   1.1        mw 	WCrt (ba, CRT_ID_END_HOR_RETR,		(md->HSE & 0x1f) | ((md->HBE & 0x20)/ 0x20 * 0x80));
    444   1.1        mw 	WCrt (ba, CRT_ID_VER_TOTAL,		(md->VT  & 0xff));
    445  1.40   aymeric 	WCrt (ba, CRT_ID_OVERFLOW,		(( (md->VSS  & 0x200) / 0x200 * 0x80)
    446  1.40   aymeric 						 | ((VDE     & 0x200) / 0x200 * 0x40)
    447   1.1        mw 						 | ((md->VT  & 0x200) / 0x200 * 0x20)
    448   1.1        mw 						 | 				0x10
    449   1.1        mw 						 | ((md->VBS & 0x100) / 0x100 * 8   )
    450  1.40   aymeric 						 | ((md->VSS & 0x100) / 0x100 * 4   )
    451  1.40   aymeric 						 | ((VDE     & 0x100) / 0x100 * 2   )
    452   1.1        mw 						 | ((md->VT  & 0x100) / 0x100       )));
    453   1.1        mw 	WCrt (ba, CRT_ID_PRESET_ROW_SCAN,	0x00);
    454  1.40   aymeric 
    455   1.4        mw 	if (md->DEP == 4) {
    456  1.40   aymeric 		WCrt (ba, CRT_ID_MAX_SCAN_LINE,	((  (md->FLG & MDF_DBL)/ MDF_DBL * 0x80)
    457  1.40   aymeric 						 | 				   0x40
    458  1.40   aymeric 						 | ((md->VBS & 0x200)/0x200	 * 0x20)
    459  1.27     veego 						 | ((md->FY-1) 			 & 0x1f)));
    460   1.4        mw 	}
    461   1.4        mw 	else {
    462  1.40   aymeric 		WCrt (ba, CRT_ID_MAX_SCAN_LINE,	((  (md->FLG & MDF_DBL)/ MDF_DBL * 0x80)
    463  1.40   aymeric 						 | 				   0x40
    464  1.40   aymeric 						 | ((md->VBS & 0x200)/0x200	 * 0x20)
    465  1.27     veego 						 | (0	 			 & 0x1f)));
    466   1.4        mw 	}
    467  1.40   aymeric 
    468  1.27     veego 	WCrt (ba, CRT_ID_CURSOR_START, (md->FY & 0x1f) - 2);
    469  1.27     veego 	WCrt (ba, CRT_ID_CURSOR_END, (md->FY & 0x1f) - 1);
    470  1.40   aymeric 
    471  1.27     veego 	WCrt (ba, CRT_ID_START_ADDR_HIGH, 0x00);
    472  1.27     veego 	WCrt (ba, CRT_ID_START_ADDR_LOW, 0x00);
    473  1.40   aymeric 
    474  1.27     veego 	WCrt (ba, CRT_ID_CURSOR_LOC_HIGH, 0x00);
    475  1.27     veego 	WCrt (ba, CRT_ID_CURSOR_LOC_LOW, 0x00);
    476  1.40   aymeric 
    477  1.27     veego 	WCrt (ba, CRT_ID_START_VER_RETR, md->VSS & 0xff);
    478  1.40   aymeric 	WCrt (ba, CRT_ID_END_VER_RETR, (md->VSE & 0x0f) | 0x80 | 0x20);
    479  1.27     veego 	WCrt (ba, CRT_ID_VER_DISP_ENA_END, VDE & 0xff);
    480   1.4        mw 	if (md->DEP == 4)
    481  1.27     veego 		WCrt (ba, CRT_ID_OFFSET, (HDE / 2)  & 0xff);
    482   1.4        mw 	else
    483  1.27     veego 		WCrt (ba, CRT_ID_OFFSET, (md->TX / 8)  & 0xff);
    484   1.4        mw 
    485  1.27     veego 	WCrt (ba, CRT_ID_UNDERLINE_LOC, (md->FY-1) & 0x1f);
    486  1.27     veego 	WCrt (ba, CRT_ID_START_VER_BLANK, md->VBS  & 0xff);
    487  1.27     veego 	WCrt (ba, CRT_ID_END_VER_BLANK, md->VBE & 0xff);
    488   1.1        mw 		/* byte mode + wrap + select row scan counter + cms */
    489  1.40   aymeric 	WCrt (ba, CRT_ID_MODE_CONTROL, 0xe3);
    490  1.40   aymeric 	WCrt (ba, CRT_ID_LINE_COMPARE, 0xff);
    491  1.40   aymeric 
    492   1.1        mw 		/* enable extended end bits + those bits */
    493  1.40   aymeric 	WCrt (ba, CRT_ID_EXT_HOR_TIMING1, ( 					 0x20
    494  1.40   aymeric 					 | ((md->FLG & MDF_LACE)  / MDF_LACE   * 0x10)
    495  1.40   aymeric 					 | ((md->HT  & 0x100) / 0x100          * 0x01)
    496  1.40   aymeric 					 | (((HDE-1) & 0x100) / 0x100 	       * 0x02)
    497  1.40   aymeric 					 | ((md->HBS & 0x100) / 0x100 	       * 0x04)
    498  1.27     veego 					 | ((md->HSS & 0x100) / 0x100 	       * 0x08)));
    499  1.27     veego 
    500   1.4        mw 	if (md->DEP == 4)
    501  1.40   aymeric 		WCrt (ba, CRT_ID_EXT_START_ADDR, (((HDE / 2) & 0x100)/0x100 * 16));
    502   1.4        mw 	else
    503  1.40   aymeric 		WCrt (ba, CRT_ID_EXT_START_ADDR, (((md->TX / 8) & 0x100)/0x100 * 16));
    504  1.40   aymeric 
    505  1.40   aymeric 	WCrt (ba, CRT_ID_EXT_HOR_TIMING2,  ( ((md->HT  & 0x200)/ 0x200	* 0x01)
    506  1.40   aymeric 					 | (((HDE-1) & 0x200)/ 0x200	* 0x02)
    507  1.27     veego 					 | ((md->HBS & 0x200)/ 0x200	* 0x04)
    508  1.40   aymeric 					 | ((md->HSS & 0x200)/ 0x200	* 0x08)
    509  1.27     veego 					 | ((md->HBE & 0xc0) / 0x40	* 0x10)
    510  1.27     veego 					 | ((md->HSE & 0x60) / 0x20	* 0x40)));
    511  1.27     veego 
    512  1.40   aymeric 	WCrt (ba, CRT_ID_EXT_VER_TIMING, ( ((md->VSE & 0x10) / 0x10	* 0x80)
    513  1.40   aymeric 					 | ((md->VBE & 0x300)/ 0x100	* 0x20)
    514  1.40   aymeric 					 |				0x10
    515  1.40   aymeric 					 | ((md->VSS & 0x400)/ 0x400	* 0x08)
    516  1.40   aymeric 					 | ((md->VBS & 0x400)/ 0x400	* 0x04)
    517  1.40   aymeric 					 | ((VDE     & 0x400)/ 0x400	* 0x02)
    518  1.27     veego 					 | ((md->VT  & 0x400)/ 0x400	* 0x01)));
    519  1.27     veego 
    520  1.40   aymeric 	WGfx (ba, GCT_ID_SET_RESET, 0x00);
    521  1.40   aymeric 	WGfx (ba, GCT_ID_ENABLE_SET_RESET, 0x00);
    522  1.40   aymeric 	WGfx (ba, GCT_ID_COLOR_COMPARE, 0x00);
    523  1.40   aymeric 	WGfx (ba, GCT_ID_DATA_ROTATE, 0x00);
    524  1.40   aymeric 	WGfx (ba, GCT_ID_READ_MAP_SELECT, 0x00);
    525  1.27     veego 	WGfx (ba, GCT_ID_GRAPHICS_MODE, 0x00);
    526   1.4        mw 	if (md->DEP == 4)
    527  1.27     veego 		WGfx (ba, GCT_ID_MISC, 0x04);
    528   1.4        mw 	else
    529  1.27     veego 		WGfx (ba, GCT_ID_MISC, 0x05);
    530  1.40   aymeric 	WGfx (ba, GCT_ID_COLOR_XCARE, 0xff);
    531  1.40   aymeric 	WGfx (ba, GCT_ID_BITMASK, 0xff);
    532  1.40   aymeric 
    533   1.1        mw 	/* reset the Attribute Controller flipflop */
    534   1.1        mw 	vgar (ba, GREG_STATUS1_R);
    535  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE0, 0x00);
    536  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE1, 0x01);
    537  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE2, 0x02);
    538  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE3, 0x03);
    539  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE4, 0x04);
    540  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE5, 0x05);
    541  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE6, 0x06);
    542  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE7, 0x07);
    543  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE8, 0x08);
    544  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE9, 0x09);
    545  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE10, 0x0a);
    546  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE11, 0x0b);
    547  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE12, 0x0c);
    548  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE13, 0x0d);
    549  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE14, 0x0e);
    550  1.40   aymeric 	WAttr (ba, ACT_ID_PALETTE15, 0x0f);
    551  1.40   aymeric 
    552   1.1        mw 	vgar (ba, GREG_STATUS1_R);
    553   1.4        mw 	if (md->DEP == 4)
    554  1.40   aymeric 		WAttr (ba, ACT_ID_ATTR_MODE_CNTL, 0x08);
    555   1.4        mw 	else
    556  1.27     veego 		WAttr (ba, ACT_ID_ATTR_MODE_CNTL, 0x09);
    557  1.40   aymeric 
    558  1.40   aymeric 	WAttr (ba, ACT_ID_OVERSCAN_COLOR, 0x00);
    559  1.40   aymeric 	WAttr (ba, ACT_ID_COLOR_PLANE_ENA, 0x0f);
    560  1.40   aymeric 	WAttr (ba, ACT_ID_HOR_PEL_PANNING, 0x00);
    561  1.40   aymeric 	WAttr (ba, ACT_ID_COLOR_SELECT,	0x00);
    562  1.40   aymeric 
    563   1.1        mw 	vgar (ba, GREG_STATUS1_R);
    564   1.1        mw 		/* I have *NO* idea what strobing reg-0x20 might do... */
    565  1.40   aymeric 	vgaw (ba, ACT_ADDRESS_W, 0x20);
    566  1.40   aymeric 
    567   1.4        mw 	if (md->DEP == 4)
    568  1.40   aymeric 		WCrt (ba, CRT_ID_MAX_SCAN_LINE,	( ((md->FLG & MDF_DBL)/ MDF_DBL * 0x80)
    569  1.40   aymeric 						|	                          0x40
    570  1.40   aymeric 						| ((md->VBS & 0x200)/0x200	* 0x20)
    571   1.4        mw 						| ((md->FY-1) 			& 0x1f)));
    572   1.4        mw 	else
    573  1.40   aymeric 		WCrt (ba, CRT_ID_MAX_SCAN_LINE,	( ((md->FLG & MDF_DBL)/ MDF_DBL * 0x80)
    574  1.40   aymeric 						|	                          0x40
    575  1.40   aymeric 						| ((md->VBS & 0x200)/0x200	* 0x20)
    576   1.4        mw 						| (0	 			& 0x1f)));
    577   1.4        mw 
    578   1.1        mw 
    579   1.1        mw 	/* not it's time for guessing... */
    580   1.1        mw 
    581  1.40   aymeric 	vgaw (ba, VDAC_REG_D, 	   0x02);
    582  1.40   aymeric 
    583  1.40   aymeric 		/* if this does what I think it does, it selects DAC
    584   1.1        mw 		   register 0, and writes the palette in subsequent
    585  1.40   aymeric 		   registers, thus it works similar to the WD33C93
    586   1.1        mw 		   select/data mechanism */
    587   1.1        mw 	vgaw (ba, VDAC_REG_SELECT, 0x00);
    588  1.27     veego 
    589  1.40   aymeric 	{
    590  1.27     veego 
    591   1.1        mw 		short x = 15;
    592   1.1        mw 		const unsigned char * col = md->PAL;
    593   1.1        mw 		do {
    594  1.40   aymeric 
    595   1.1        mw 			vgaw (ba, VDAC_REG_DATA, *col++);
    596   1.1        mw 			vgaw (ba, VDAC_REG_DATA, *col++);
    597   1.1        mw 			vgaw (ba, VDAC_REG_DATA, *col++);
    598  1.40   aymeric 
    599  1.40   aymeric 
    600   1.1        mw 		} while (x--);
    601   1.4        mw 
    602   1.4        mw 		if (md->DEP != 4) {
    603   1.4        mw 			short x = 256-17;
    604   1.4        mw 			unsigned char col = 16;
    605   1.4        mw 			do {
    606  1.40   aymeric 
    607   1.4        mw 				vgaw(ba, VDAC_REG_DATA, col);
    608   1.4        mw 				vgaw(ba, VDAC_REG_DATA, col);
    609   1.4        mw 				vgaw(ba, VDAC_REG_DATA, col);
    610   1.4        mw 				col++;
    611  1.40   aymeric 
    612   1.4        mw 			} while (x--);
    613   1.4        mw 		}
    614   1.1        mw 	}
    615   1.1        mw 
    616   1.1        mw 
    617   1.1        mw 	/* now load the font into maps 2 (and 3 for fonts wider than 8 pixels) */
    618   1.4        mw 	if (md->DEP == 4) {
    619  1.40   aymeric 
    620  1.40   aymeric 		/* first set the whole font memory to a test-pattern, so we
    621   1.1        mw 		   can see if something that shouldn't be drawn IS drawn.. */
    622   1.1        mw 		{
    623  1.25     veego 			volatile caddr_t c = fb;
    624   1.1        mw 			long x;
    625   1.1        mw 			Map(2);
    626  1.40   aymeric 
    627   1.1        mw 			for (x = 0; x < 65536; x++) {
    628   1.1        mw 				*c++ = (x & 1)? 0xaa : 0x55;
    629   1.1        mw 			}
    630   1.1        mw 		}
    631  1.40   aymeric 
    632   1.1        mw 		{
    633  1.25     veego 			volatile caddr_t c = fb;
    634   1.1        mw 			long x;
    635   1.1        mw 			Map(3);
    636  1.40   aymeric 
    637   1.1        mw 			for (x = 0; x < 65536; x++) {
    638   1.1        mw 				*c++ = (x & 1)? 0xaa : 0x55;
    639   1.1        mw 			}
    640   1.1        mw 		}
    641  1.40   aymeric 
    642   1.1        mw 		{
    643   1.1        mw 		  /* ok, now position at first defined character, and
    644   1.1        mw 		     copy over the images */
    645  1.25     veego 		  volatile caddr_t c = fb + md->FLo * 32;
    646   1.1        mw 		  const unsigned char * f = md->FData;
    647   1.1        mw 		  unsigned short z;
    648  1.40   aymeric 
    649   1.1        mw 		  Map(2);
    650   1.1        mw 		  for (z = md->FLo; z <= md->FHi; z++) {
    651  1.40   aymeric 
    652   1.1        mw 			short y = md->FY-1;
    653   1.1        mw 			if (md->FX > 8){
    654   1.1        mw 				do {
    655   1.1        mw 					*c++ = *f;
    656   1.1        mw 					f += 2;
    657   1.1        mw 				} while (y--);
    658   1.1        mw 			}
    659   1.1        mw 			else {
    660   1.1        mw 				do {
    661   1.1        mw 					*c++ = *f++;
    662   1.1        mw 				} while (y--);
    663   1.1        mw 			}
    664  1.40   aymeric 
    665   1.1        mw 			c += 32-md->FY;
    666  1.40   aymeric 
    667   1.1        mw 		  }
    668  1.40   aymeric 
    669   1.1        mw 		  if (md->FX > 8) {
    670   1.1        mw 			unsigned short z;
    671  1.40   aymeric 
    672   1.1        mw 			Map(3);
    673   1.1        mw 			c = fb + md->FLo*32;
    674   1.1        mw 			f = md->FData+1;
    675   1.1        mw 			for (z = md->FLo; z <= md->FHi; z++) {
    676  1.40   aymeric 
    677   1.1        mw 				short y = md->FY-1;
    678   1.1        mw 				do {
    679   1.1        mw 					*c++ = *f;
    680   1.1        mw 					f += 2;
    681   1.1        mw 				} while (y--);
    682  1.40   aymeric 
    683   1.1        mw 				c += 32-md->FY;
    684  1.40   aymeric 
    685   1.1        mw 			}
    686   1.1        mw 		  }
    687   1.1        mw 		}
    688  1.40   aymeric 
    689   1.1        mw 	}
    690  1.40   aymeric 
    691   1.1        mw 		/* select map 0 */
    692   1.1        mw 	WGfx (ba, GCT_ID_READ_MAP_SELECT,	0);
    693   1.4        mw 	if (md->DEP == 4)
    694   1.4        mw 			/* allow writes into maps 0 and 1 */
    695   1.4        mw 		WSeq (ba, SEQ_ID_MAP_MASK,		3);
    696   1.4        mw 	else
    697   1.4        mw 			/* allow writes into all maps */
    698   1.4        mw 		WSeq (ba, SEQ_ID_MAP_MASK,		0x0f);
    699   1.4        mw 
    700   1.1        mw 		/* select extended chain4 addressing:
    701   1.1        mw 		    !A0/!A1	map 0	character to be displayed
    702   1.1        mw 		    !A1/ A1	map 1	attribute of that character
    703   1.1        mw 		     A0/!A1	map 2	not used (masked out, ignored)
    704   1.1        mw 		     A0/ A1 	map 3	not used (masked out, ignored) */
    705   1.1        mw 	WSeq (ba, SEQ_ID_EXT_VIDEO_ADDR,	RSeq(ba, SEQ_ID_EXT_VIDEO_ADDR) | 0x02);
    706  1.40   aymeric 
    707   1.4        mw 	if (md->DEP == 4) {
    708   1.1        mw 		/* position in display memory */
    709   1.1        mw 		unsigned short * c = (unsigned short *) fb;
    710  1.40   aymeric 
    711   1.1        mw 		/* fill with blank, white on black */
    712   1.1        mw 		const unsigned short fill_val = 0x2010;
    713   1.1        mw 		short x = md->XY;
    714   1.1        mw 		do {
    715   1.1        mw 			*c = fill_val;
    716  1.11    chopps 			c += 2; } while (x--);
    717  1.40   aymeric 
    718   1.1        mw 		/* I won't comment this :-)) */
    719   1.1        mw 		c = (unsigned short *) fb;
    720   1.1        mw 		c += (md->TX-6)*2;
    721   1.1        mw 		{
    722   1.1        mw 		  unsigned short init_msg[6] = {0x520a, 0x450b, 0x540c, 0x490d, 0x4e0e, 0x410f};
    723   1.1        mw 		  unsigned short * f = init_msg;
    724   1.1        mw 		  x = 5;
    725   1.1        mw 		  do {
    726   1.1        mw 			*c = *f++;
    727   1.1        mw 			c += 2;
    728   1.1        mw 	 	  } while (x--);
    729   1.1        mw 	 	}
    730   1.1        mw 	}
    731   1.4        mw 	else if (md->DEP == 8) {
    732   1.4        mw 		/* could clear the gfx screen here, but that's what the X server does anyway */
    733   1.4        mw 	        ;
    734   1.4        mw 	}
    735   1.1        mw 
    736  1.13    chopps 	gp->g_data	= (caddr_t)md;
    737  1.16    chopps 	gi->gd_regaddr  = (caddr_t)ztwopa(ba);
    738   1.3        mw 	gi->gd_regsize  = 64*1024;
    739   1.1        mw 
    740  1.16    chopps 	gi->gd_fbaddr   = (caddr_t)ztwopa(fb);
    741   1.4        mw #ifdef BANKEDDEVPAGER
    742   1.4        mw 	gi->gd_fbsize	= 4*1024*1024;  /* XXX */
    743   1.4        mw 	gi->gd_bank_size = 64*1024;
    744   1.4        mw #else
    745   1.1        mw 	gi->gd_fbsize   = 64*1024;	/* larger, but that's whats mappable */
    746   1.4        mw #endif
    747  1.40   aymeric 
    748   1.1        mw 	gi->gd_colors   = 1 << md->DEP;
    749   1.1        mw 	gi->gd_planes   = md->DEP;
    750  1.40   aymeric 
    751   1.1        mw 	gi->gd_fbwidth  = md->MW;
    752   1.1        mw 	gi->gd_fbheight = md->MH;
    753   1.1        mw 	gi->gd_fbx	= 0;
    754   1.1        mw 	gi->gd_fby	= 0;
    755   1.1        mw 	gi->gd_dwidth   = md->TX * md->FX;
    756   1.1        mw 	gi->gd_dheight  = md->TY * md->FY;
    757   1.1        mw 	gi->gd_dx	= 0;
    758   1.1        mw 	gi->gd_dy	= 0;
    759  1.40   aymeric 
    760   1.1        mw 	/* initialized, works, return 1 */
    761  1.11    chopps 	return(1);
    762   1.1        mw }
    763   1.1        mw 
    764  1.40   aymeric void grfrtattach(struct device *, struct device *, void *);
    765  1.40   aymeric int grfrtprint(void *, const char *);
    766  1.40   aymeric int grfrtmatch(struct device *, struct cfdata *, void *);
    767  1.40   aymeric 
    768  1.40   aymeric int rt_mode(struct grf_softc *, u_long, void *, u_long, int);
    769  1.40   aymeric static int rt_getvmode(struct grf_softc *, struct grfvideo_mode *);
    770  1.40   aymeric static int rt_setvmode(struct grf_softc *, unsigned, int);
    771  1.40   aymeric int rt_getspritepos(struct grf_softc *, struct grf_position *);
    772  1.40   aymeric int rt_setspritepos(struct grf_softc *, struct grf_position *);
    773  1.40   aymeric int rt_getspriteinfo(struct grf_softc *, struct grf_spriteinfo *);
    774  1.40   aymeric int rt_setspriteinfo(struct grf_softc *, struct grf_spriteinfo *);
    775  1.40   aymeric int rt_getspritemax(struct grf_softc *, struct grf_position *);
    776  1.40   aymeric int rt_getcmap(struct grf_softc *, struct grf_colormap *);
    777  1.40   aymeric int rt_putcmap(struct grf_softc *, struct grf_colormap *);
    778  1.40   aymeric int rt_bitblt(struct grf_softc *, struct grf_bitblt *);
    779  1.40   aymeric int rt_blank(struct grf_softc *, int *);
    780  1.24   thorpej 
    781  1.24   thorpej struct cfattach grfrt_ca = {
    782  1.24   thorpej 	sizeof(struct grf_softc), grfrtmatch, grfrtattach
    783  1.24   thorpej };
    784  1.40   aymeric 
    785  1.11    chopps /*
    786  1.11    chopps  * only used in console init
    787  1.11    chopps  */
    788  1.11    chopps static struct cfdata *cfdata;
    789  1.11    chopps 
    790  1.11    chopps /*
    791  1.11    chopps  * we make sure to only init things once.  this is somewhat
    792  1.11    chopps  * tricky regarding the console.
    793  1.11    chopps  */
    794  1.40   aymeric int
    795  1.40   aymeric grfrtmatch(struct device *pdp, struct cfdata *cfp, void *auxp)
    796   1.1        mw {
    797  1.26     veego #ifdef RETINACONSOLE
    798  1.11    chopps 	static int rtconunit = -1;
    799  1.12    chopps #endif
    800  1.20    chopps 	struct zbus_args *zap;
    801  1.11    chopps 
    802  1.11    chopps 	zap = auxp;
    803  1.11    chopps 
    804  1.11    chopps 	/*
    805  1.11    chopps 	 * allow only one retina console
    806  1.11    chopps 	 */
    807  1.12    chopps 	if (amiga_realconfig == 0)
    808  1.12    chopps #ifdef RETINACONSOLE
    809  1.12    chopps 		if (rtconunit != -1)
    810  1.12    chopps #endif
    811  1.12    chopps 			return(0);
    812  1.11    chopps 	/*
    813  1.11    chopps 	 * check that this is a retina board.
    814  1.11    chopps 	 */
    815  1.11    chopps 	if (zap->manid != 18260 || zap->prodid != 6)
    816  1.11    chopps 		return(0);
    817  1.11    chopps 
    818  1.14    chopps #ifdef RETINACONSOLE
    819  1.11    chopps 	if (amiga_realconfig == 0 || rtconunit != cfp->cf_unit) {
    820  1.14    chopps #endif
    821  1.11    chopps 		if ((unsigned)retina_default_mon >= retina_mon_max ||
    822  1.11    chopps 		    monitor_defs[retina_default_mon].DEP == 8)
    823  1.11    chopps 			retina_default_mon = 0;
    824  1.11    chopps 
    825  1.11    chopps 		current_mon = monitor_defs + retina_default_mon;
    826  1.11    chopps 		if (retina_alive(current_mon) == 0)
    827  1.11    chopps 			return(0);
    828  1.14    chopps #ifdef RETINACONSOLE
    829  1.11    chopps 		if (amiga_realconfig == 0) {
    830  1.11    chopps 			rtconunit = cfp->cf_unit;
    831  1.11    chopps 			cfdata = cfp;
    832  1.11    chopps 		}
    833  1.11    chopps 	}
    834  1.14    chopps #endif
    835  1.11    chopps 	return(1);
    836  1.11    chopps }
    837   1.1        mw 
    838  1.40   aymeric /*
    839  1.20    chopps  * attach to the grfbus (zbus)
    840  1.11    chopps  */
    841  1.11    chopps void
    842  1.40   aymeric grfrtattach(struct device *pdp, struct device *dp, void *auxp)
    843  1.11    chopps {
    844  1.11    chopps 	static struct grf_softc congrf;
    845  1.20    chopps 	struct zbus_args *zap;
    846  1.11    chopps 	struct grf_softc *gp;
    847  1.11    chopps 
    848  1.11    chopps 	zap = auxp;
    849  1.40   aymeric 
    850  1.40   aymeric 	if (dp == NULL)
    851  1.11    chopps 		gp = &congrf;
    852  1.11    chopps 	else
    853  1.11    chopps 		gp = (struct grf_softc *)dp;
    854  1.11    chopps 
    855  1.11    chopps 	if (dp != NULL && congrf.g_regkva != 0) {
    856  1.11    chopps 		/*
    857  1.11    chopps 		 * we inited earlier just copy the info
    858  1.11    chopps 		 * take care not to copy the device struct though.
    859  1.11    chopps 		 */
    860  1.40   aymeric 		bcopy(&congrf.g_display, &gp->g_display,
    861  1.11    chopps 		    (char *)&gp[1] - (char *)&gp->g_display);
    862  1.11    chopps 	} else {
    863  1.11    chopps 		gp->g_regkva = (volatile caddr_t)zap->va;
    864  1.11    chopps 		gp->g_fbkva = (volatile caddr_t)zap->va + 64 * 1024;
    865  1.11    chopps 		gp->g_unit = GRF_RETINAII_UNIT;
    866  1.14    chopps 		gp->g_flags = GF_ALIVE;
    867  1.11    chopps 		gp->g_mode = rt_mode;
    868  1.11    chopps 		gp->g_conpri = grfrt_cnprobe();
    869  1.11    chopps 		grfrt_iteinit(gp);
    870  1.11    chopps 		(void)rt_load_mon(gp, current_mon);
    871  1.11    chopps 	}
    872  1.11    chopps 	if (dp != NULL)
    873  1.33  christos 		printf("\n");
    874  1.11    chopps 	/*
    875  1.11    chopps 	 * attach grf
    876  1.11    chopps 	 */
    877  1.11    chopps 	amiga_config_found(cfdata, &gp->g_device, gp, grfrtprint);
    878  1.11    chopps }
    879  1.11    chopps 
    880  1.11    chopps int
    881  1.40   aymeric grfrtprint(void *auxp, const char *pnp)
    882  1.11    chopps {
    883  1.11    chopps 	if (pnp)
    884  1.33  christos 		printf("grf%d at %s", ((struct grf_softc *)auxp)->g_unit,
    885  1.11    chopps 			pnp);
    886  1.11    chopps 	return(UNCONF);
    887   1.1        mw }
    888   1.1        mw 
    889  1.40   aymeric static int
    890  1.40   aymeric rt_getvmode(struct grf_softc *gp, struct grfvideo_mode *vm)
    891   1.1        mw {
    892  1.27     veego 	struct MonDef *md;
    893  1.35     veego 	int vmul;
    894   1.1        mw 
    895  1.27     veego 	if (vm->mode_num && vm->mode_num > retina_mon_max)
    896  1.27     veego 		return (EINVAL);
    897  1.27     veego 
    898  1.27     veego 	if (! vm->mode_num)
    899  1.27     veego 		vm->mode_num = (current_mon - monitor_defs) + 1;
    900  1.27     veego 
    901  1.27     veego 	md = monitor_defs + (vm->mode_num - 1);
    902  1.40   aymeric 	strncpy (vm->mode_descr, monitor_descr[vm->mode_num - 1],
    903  1.27     veego 	    sizeof (vm->mode_descr));
    904  1.27     veego 	vm->pixel_clock  = md->FQ;
    905  1.27     veego 	vm->disp_width   = md->MW;
    906  1.27     veego 	vm->disp_height  = md->MH;
    907  1.27     veego 	vm->depth        = md->DEP;
    908   1.1        mw 
    909  1.27     veego 	/*
    910  1.27     veego 	 * From observation of the monitor definition table above, I guess that
    911  1.27     veego 	 * the horizontal timings are in units of longwords. Hence, I get the
    912  1.27     veego 	 * pixels by multiplication with 32 and division by the depth.
    913  1.39       wiz 	 * The text modes, apparently marked by depth == 4, are even more weird.
    914  1.27     veego 	 * According to a comment above, they are computed from a depth==8 mode
    915  1.27     veego 	 * (thats for us: * 32 / 8) by applying another factor of 4 / font width.
    916  1.27     veego 	 * Reverse applying the latter formula most of the constants cancel
    917  1.27     veego 	 * themselves and we are left with a nice (* font width).
    918  1.40   aymeric 	 * That is, internal timings are in units of longwords for graphics
    919  1.27     veego 	 * modes, or in units of characters widths for text modes.
    920  1.27     veego 	 * We better don't WRITE modes until this has been real live checked.
    921  1.27     veego 	 * 			- Ignatios Souvatzis
    922  1.27     veego 	 */
    923   1.1        mw 
    924  1.35     veego 	if (md->DEP != 4) {
    925  1.27     veego 		vm->hblank_start = md->HBS * 32 / md->DEP;
    926  1.27     veego 		vm->hsync_start  = md->HSS * 32 / md->DEP;
    927  1.27     veego 		vm->hsync_stop   = md->HSE * 32 / md->DEP;
    928  1.27     veego 		vm->htotal       = md->HT * 32 / md->DEP;
    929  1.27     veego 	} else {
    930  1.27     veego 		vm->hblank_start = md->HBS * md->FX;
    931  1.27     veego 		vm->hsync_start  = md->HSS * md->FX;
    932  1.27     veego 		vm->hsync_stop   = md->HSE * md->FX;
    933  1.27     veego 		vm->htotal       = md->HT * md->FX;
    934  1.27     veego 	}
    935  1.35     veego 
    936  1.35     veego 
    937  1.35     veego 	/* XXX move vm->disp_flags and vmul to rt_load_mon
    938  1.35     veego 	* if rt_setvmode can add new modes with grfconfig */
    939  1.35     veego 	vm->disp_flags = 0;
    940  1.35     veego 	vmul = 2;
    941  1.35     veego 	if (md->FLG & MDF_DBL) {
    942  1.35     veego 		vm->disp_flags |= GRF_FLAGS_DBLSCAN;
    943  1.35     veego 		vmul = 4;
    944  1.35     veego 	}
    945  1.35     veego 	if (md->FLG & MDF_LACE) {
    946  1.35     veego 		vm->disp_flags |= GRF_FLAGS_LACE;
    947  1.35     veego 		vmul = 1;
    948  1.35     veego 	}
    949  1.35     veego 	vm->vblank_start = md->VBS * vmul / 2;
    950  1.35     veego 	vm->vsync_start  = md->VSS * vmul / 2;
    951  1.35     veego 	vm->vsync_stop   = md->VSE * vmul / 2;
    952  1.35     veego 	vm->vtotal       = md->VT * vmul / 2;
    953   1.1        mw 
    954  1.27     veego 	return (0);
    955   1.1        mw }
    956   1.1        mw 
    957   1.1        mw 
    958  1.40   aymeric static int
    959  1.40   aymeric rt_setvmode(struct grf_softc *gp, unsigned mode, int txtonly)
    960   1.1        mw {
    961  1.27     veego 	int error;
    962   1.1        mw 
    963  1.27     veego 	if (!mode || mode > retina_mon_max)
    964  1.27     veego 		return (EINVAL);
    965   1.1        mw 
    966  1.27     veego 	if (txtonly && monitor_defs[mode-1].DEP == 8)
    967  1.27     veego 		return (EINVAL);
    968   1.4        mw 
    969  1.27     veego 	current_mon = monitor_defs + (mode - 1);
    970   1.4        mw 
    971  1.27     veego 	error = rt_load_mon (gp, current_mon) ? 0 : EINVAL;
    972   1.4        mw 
    973  1.27     veego 	return (error);
    974   1.1        mw }
    975   1.1        mw 
    976   1.1        mw 
    977   1.1        mw /*
    978   1.1        mw  * Change the mode of the display.
    979   1.1        mw  * Return a UNIX error number or 0 for success.
    980   1.1        mw  */
    981  1.11    chopps int
    982  1.40   aymeric rt_mode(struct grf_softc *gp, u_long cmd, void *arg, u_long a2, int a3)
    983   1.1        mw {
    984  1.40   aymeric /* implement these later... */
    985   1.1        mw 
    986  1.27     veego 	switch (cmd) {
    987  1.27     veego 	    case GM_GRFON:
    988  1.27     veego 		rt_setvmode (gp, retina_default_gfx + 1, 0);
    989  1.27     veego 		return (0);
    990  1.40   aymeric 
    991  1.27     veego 	    case GM_GRFOFF:
    992  1.27     veego 		rt_setvmode (gp, retina_default_mon + 1, 0);
    993  1.27     veego 		return (0);
    994  1.40   aymeric 
    995  1.27     veego 	    case GM_GRFCONFIG:
    996  1.27     veego 		return (0);
    997   1.1        mw 
    998  1.27     veego 	    case GM_GRFGETVMODE:
    999  1.27     veego 		return (rt_getvmode (gp, (struct grfvideo_mode *) arg));
   1000   1.1        mw 
   1001  1.27     veego 	    case GM_GRFSETVMODE:
   1002  1.27     veego 		return (rt_setvmode (gp, *(unsigned *) arg, 1));
   1003   1.1        mw 
   1004  1.27     veego 	    case GM_GRFGETNUMVM:
   1005  1.27     veego 		*(int *)arg = retina_mon_max;
   1006  1.27     veego 		return (0);
   1007   1.1        mw 
   1008   1.4        mw #ifdef BANKEDDEVPAGER
   1009  1.27     veego 	    case GM_GRFGETBANK:
   1010  1.27     veego 		*(int *)arg = rt_getbank (gp, a2, a3);
   1011  1.27     veego 		return (0);
   1012  1.27     veego 
   1013  1.27     veego 	    case GM_GRFGETCURBANK:
   1014  1.27     veego 		*(int *)arg = rt_getcurbank (gp);
   1015  1.27     veego 		return (0);
   1016   1.4        mw 
   1017  1.27     veego 	    case GM_GRFSETBANK:
   1018  1.27     veego 		return (rt_setbank (gp, arg));
   1019   1.4        mw #endif
   1020  1.27     veego 	    case GM_GRFIOCTL:
   1021  1.27     veego 		return (rt_ioctl (gp, a2, arg));
   1022   1.4        mw 
   1023  1.27     veego 	    default:
   1024  1.27     veego 		break;
   1025  1.27     veego 	}
   1026  1.27     veego 
   1027  1.27     veego 	return (EINVAL);
   1028   1.1        mw }
   1029   1.4        mw 
   1030   1.4        mw int
   1031  1.40   aymeric rt_ioctl(register struct grf_softc *gp, u_long cmd, void *data)
   1032   1.4        mw {
   1033  1.27     veego 	switch (cmd) {
   1034  1.27     veego 	    case GRFIOCGSPRITEPOS:
   1035  1.27     veego 		return (rt_getspritepos (gp, (struct grf_position *) data));
   1036  1.27     veego 
   1037  1.27     veego 	    case GRFIOCSSPRITEPOS:
   1038  1.27     veego 		return (rt_setspritepos (gp, (struct grf_position *) data));
   1039   1.4        mw 
   1040  1.27     veego 	    case GRFIOCSSPRITEINF:
   1041  1.27     veego 		return (rt_setspriteinfo (gp, (struct grf_spriteinfo *) data));
   1042   1.4        mw 
   1043  1.27     veego 	    case GRFIOCGSPRITEINF:
   1044  1.27     veego 		return (rt_getspriteinfo (gp, (struct grf_spriteinfo *) data));
   1045   1.4        mw 
   1046  1.27     veego 	    case GRFIOCGSPRITEMAX:
   1047  1.27     veego 		return (rt_getspritemax (gp, (struct grf_position *) data));
   1048   1.4        mw 
   1049  1.27     veego 	    case GRFIOCGETCMAP:
   1050  1.27     veego 		return (rt_getcmap (gp, (struct grf_colormap *) data));
   1051   1.4        mw 
   1052  1.27     veego 	    case GRFIOCPUTCMAP:
   1053  1.27     veego 		return (rt_putcmap (gp, (struct grf_colormap *) data));
   1054   1.4        mw 
   1055  1.27     veego 	    case GRFIOCBITBLT:
   1056  1.27     veego 		return (rt_bitblt (gp, (struct grf_bitblt *) data));
   1057   1.4        mw 
   1058  1.27     veego 	    case GRFIOCBLANK:
   1059  1.27     veego 		return (rt_blank(gp, (int *)data));
   1060  1.27     veego 	}
   1061   1.4        mw 
   1062  1.27     veego 	return (EINVAL);
   1063  1.40   aymeric }
   1064   1.4        mw 
   1065   1.4        mw #ifdef BANKEDDEVPAGER
   1066   1.4        mw 
   1067   1.4        mw /* Retina banks can overlap. Don't use this information (yet?), and
   1068   1.4        mw    only switch 64k sized banks. */
   1069   1.4        mw 
   1070   1.4        mw int
   1071  1.40   aymeric rt_getbank(struct grf_softc *gp, u_long offs, int prot)
   1072  1.27     veego {
   1073  1.27     veego 	/* XXX */
   1074  1.27     veego 	if (offs <  0 || offs >= 4*1024*1024)
   1075  1.27     veego 		return (-1);
   1076  1.27     veego 	else
   1077  1.27     veego 		return (offs >> 16);
   1078   1.4        mw }
   1079   1.4        mw 
   1080  1.27     veego 
   1081   1.4        mw int
   1082  1.40   aymeric rt_getcurbank(struct grf_softc *gp)
   1083   1.4        mw {
   1084  1.27     veego 	struct grfinfo *gi = &gp->g_display;
   1085  1.27     veego 	volatile unsigned char *ba;
   1086  1.27     veego 	int bank;
   1087   1.4        mw 
   1088  1.27     veego 	ba = gp->g_regkva;
   1089  1.27     veego 	bank = RSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO) |
   1090  1.27     veego 			(RSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI) << 8);
   1091  1.27     veego 
   1092  1.27     veego 	/* bank register is multiple of 64 byte, make this multiple of 64k */
   1093  1.27     veego 	bank >>= 10;
   1094  1.27     veego 	return (bank);
   1095  1.27     veego }
   1096   1.4        mw 
   1097   1.4        mw 
   1098   1.4        mw int
   1099  1.40   aymeric rt_setbank(struct grf_softc *gp, int bank)
   1100   1.4        mw {
   1101  1.27     veego 	volatile unsigned char *ba;
   1102   1.4        mw 
   1103  1.27     veego 	ba = gp->g_regkva;
   1104  1.27     veego 	/* bank register is multiple of 64 byte, make this multiple of 64k */
   1105  1.27     veego 	bank <<= 10;
   1106  1.27     veego 	WSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO, (unsigned char) bank);
   1107  1.27     veego 	bank >>= 8;
   1108  1.27     veego 	WSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI, (unsigned char) bank);
   1109   1.4        mw 
   1110  1.27     veego 	return (0);
   1111   1.4        mw }
   1112   1.4        mw 
   1113  1.27     veego #endif	/* BANKEDDEVPAGER */
   1114  1.27     veego 
   1115   1.4        mw 
   1116   1.4        mw int
   1117  1.40   aymeric rt_getcmap(struct grf_softc *gfp, struct grf_colormap *cmap)
   1118   1.4        mw {
   1119  1.27     veego 	volatile unsigned char *ba;
   1120  1.27     veego 	u_char red[256], green[256], blue[256], *rp, *gp, *bp;
   1121  1.27     veego 	short x;
   1122  1.27     veego 	int error;
   1123  1.27     veego 
   1124  1.27     veego 	if (cmap->count == 0 || cmap->index >= 256)
   1125  1.27     veego 		return (0);
   1126  1.27     veego 
   1127  1.27     veego 	if (cmap->index + cmap->count > 256)
   1128  1.27     veego 		cmap->count = 256 - cmap->index;
   1129  1.27     veego 
   1130  1.27     veego 	ba = gfp->g_regkva;
   1131  1.27     veego 	/* first read colors out of the chip, then copyout to userspace */
   1132  1.27     veego 	vgaw (ba, VDAC_REG_SELECT, cmap->index);
   1133  1.27     veego 	x = cmap->count - 1;
   1134  1.40   aymeric 	rp = red + cmap->index;
   1135  1.40   aymeric 	gp = green + cmap->index;
   1136  1.27     veego 	bp = blue + cmap->index;
   1137  1.27     veego 	do {
   1138  1.27     veego 		*rp++ = vgar (ba, VDAC_REG_DATA);
   1139  1.27     veego 		*gp++ = vgar (ba, VDAC_REG_DATA);
   1140  1.27     veego 		*bp++ = vgar (ba, VDAC_REG_DATA);
   1141  1.27     veego 	}
   1142  1.27     veego 	while (x--);
   1143   1.4        mw 
   1144  1.27     veego 	if (!(error = copyout (red + cmap->index, cmap->red, cmap->count))
   1145  1.27     veego 	    && !(error = copyout (green + cmap->index, cmap->green, cmap->count))
   1146  1.27     veego 	    && !(error = copyout (blue + cmap->index, cmap->blue, cmap->count)))
   1147  1.27     veego 		return (0);
   1148   1.4        mw 
   1149  1.27     veego 	return (error);
   1150   1.4        mw }
   1151   1.4        mw 
   1152   1.4        mw int
   1153  1.40   aymeric rt_putcmap(struct grf_softc *gfp, struct grf_colormap *cmap)
   1154   1.4        mw {
   1155  1.27     veego 	volatile unsigned char *ba;
   1156  1.27     veego 	u_char red[256], green[256], blue[256], *rp, *gp, *bp;
   1157  1.27     veego 	short x;
   1158  1.27     veego 	int error;
   1159  1.27     veego 
   1160  1.27     veego 	if (cmap->count == 0 || cmap->index >= 256)
   1161  1.27     veego 		return 0;
   1162  1.27     veego 
   1163  1.27     veego 	if (cmap->index + cmap->count > 256)
   1164  1.27     veego 		cmap->count = 256 - cmap->index;
   1165  1.27     veego 
   1166  1.27     veego 	/* first copy the colors into kernelspace */
   1167  1.27     veego 	if (!(error = copyin (cmap->red, red + cmap->index, cmap->count))
   1168  1.27     veego 	    && !(error = copyin (cmap->green, green + cmap->index, cmap->count))
   1169  1.27     veego 	    && !(error = copyin (cmap->blue, blue + cmap->index, cmap->count)))
   1170   1.4        mw 	{
   1171  1.27     veego 		ba = gfp->g_regkva;
   1172  1.27     veego 		vgaw (ba, VDAC_REG_SELECT, cmap->index);
   1173  1.27     veego 		x = cmap->count - 1;
   1174  1.40   aymeric 		rp = red + cmap->index;
   1175  1.40   aymeric 		gp = green + cmap->index;
   1176  1.27     veego 		bp = blue + cmap->index;
   1177  1.27     veego 		do {
   1178  1.27     veego 			vgaw (ba, VDAC_REG_DATA, *rp++);
   1179  1.27     veego 			vgaw (ba, VDAC_REG_DATA, *gp++);
   1180  1.27     veego 			vgaw (ba, VDAC_REG_DATA, *bp++);
   1181  1.27     veego 		}
   1182  1.27     veego 		while (x--);
   1183  1.27     veego 		return (0);
   1184  1.27     veego 	} else
   1185  1.27     veego 		return (error);
   1186   1.4        mw }
   1187   1.4        mw 
   1188  1.27     veego 
   1189   1.4        mw int
   1190  1.40   aymeric rt_getspritepos(struct grf_softc *gp, struct grf_position *pos)
   1191   1.4        mw {
   1192  1.27     veego 	volatile unsigned char *ba;
   1193   1.4        mw 
   1194  1.27     veego 	ba = gp->g_regkva;
   1195  1.27     veego 	pos->x = vgar (ba, SEQ_ID_CURSOR_X_LOC_LO) |
   1196  1.27     veego 			(vgar (ba, SEQ_ID_CURSOR_X_LOC_HI) << 8);
   1197  1.27     veego 	pos->y = vgar (ba, SEQ_ID_CURSOR_Y_LOC_LO) |
   1198  1.27     veego 			(vgar (ba, SEQ_ID_CURSOR_Y_LOC_HI) << 8);
   1199  1.27     veego 	return (0);
   1200   1.4        mw }
   1201   1.4        mw 
   1202   1.4        mw int
   1203  1.40   aymeric rt_setspritepos(struct grf_softc *gp, struct grf_position *pos)
   1204   1.4        mw {
   1205  1.27     veego 	volatile unsigned char *ba;
   1206   1.4        mw 
   1207  1.27     veego 	ba = gp->g_regkva;
   1208  1.27     veego 	vgaw (ba, SEQ_ID_CURSOR_X_LOC_LO, pos->x & 0xff);
   1209  1.27     veego 	vgaw (ba, SEQ_ID_CURSOR_X_LOC_HI, (pos->x >> 8) & 0x07);
   1210  1.27     veego 	vgaw (ba, SEQ_ID_CURSOR_Y_LOC_LO, pos->y & 0xff);
   1211  1.27     veego 	vgaw (ba, SEQ_ID_CURSOR_Y_LOC_HI, (pos->y >> 8) & 0x07);
   1212  1.27     veego 	return (0);
   1213   1.4        mw }
   1214   1.4        mw 
   1215   1.4        mw /* assume an at least 2M retina (XXX), sprite is last in memory.
   1216  1.27     veego  * According to the bogus docs, the cursor can be at most 128 lines
   1217  1.27     veego  * in height, and the x-hostspot can be placed at most at pos 31,
   1218  1.27     veego  * this gives width of a long
   1219  1.27     veego  */
   1220   1.4        mw #define SPRITE_ADDR (2*1024*1024 - 128*4)
   1221   1.4        mw 
   1222   1.4        mw int
   1223  1.40   aymeric rt_getspriteinfo(struct grf_softc *gp, struct grf_spriteinfo *info)
   1224   1.4        mw {
   1225  1.27     veego 	volatile caddr_t ba, fb;
   1226   1.4        mw 
   1227  1.27     veego 	ba = gp->g_regkva;
   1228  1.27     veego 	fb = gp->g_fbkva;
   1229  1.27     veego 	if (info->set & GRFSPRSET_ENABLE)
   1230  1.27     veego 		info->enable = vgar (ba, SEQ_ID_CURSOR_CONTROL) & 0x01;
   1231  1.27     veego 	if (info->set & GRFSPRSET_POS)
   1232  1.27     veego 		rt_getspritepos (gp, &info->pos);
   1233  1.27     veego 	if (info->set & GRFSPRSET_HOT) {
   1234  1.27     veego 		info->hot.x = vgar (ba, SEQ_ID_CURSOR_X_INDEX) & 0x1f;
   1235  1.27     veego 		info->hot.y = vgar (ba, SEQ_ID_CURSOR_Y_INDEX) & 0x7f;
   1236  1.27     veego 	}
   1237  1.27     veego 	if (info->set & GRFSPRSET_CMAP) {
   1238  1.27     veego 		struct grf_colormap cmap;
   1239  1.27     veego 		int index;
   1240  1.27     veego 		cmap.index = 0;
   1241  1.27     veego 		cmap.count = 256;
   1242  1.27     veego 		rt_getcmap (gp, &cmap);
   1243  1.27     veego 		index = vgar (ba, SEQ_ID_CURSOR_COLOR0);
   1244  1.27     veego 		info->cmap.red[0] = cmap.red[index];
   1245  1.27     veego 		info->cmap.green[0] = cmap.green[index];
   1246  1.27     veego 		info->cmap.blue[0] = cmap.blue[index];
   1247  1.27     veego 		index = vgar (ba, SEQ_ID_CURSOR_COLOR1);
   1248  1.27     veego 		info->cmap.red[1] = cmap.red[index];
   1249  1.27     veego 		info->cmap.green[1] = cmap.green[index];
   1250  1.27     veego 		info->cmap.blue[1] = cmap.blue[index];
   1251  1.27     veego 	}
   1252  1.27     veego 	if (info->set & GRFSPRSET_SHAPE) {
   1253  1.27     veego 		int saved_bank_lo = RSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO);
   1254  1.27     veego 		int saved_bank_hi = RSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI);
   1255  1.27     veego 		int last_bank = SPRITE_ADDR >> 6;
   1256  1.27     veego 		int last_bank_lo = last_bank & 0xff;
   1257  1.27     veego 		int last_bank_hi = last_bank >> 8;
   1258  1.27     veego 		u_char mask;
   1259  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO, last_bank_lo);
   1260  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI, last_bank_hi);
   1261  1.27     veego 		copyout (fb, info->image, 128*4);
   1262  1.27     veego 		mask = RSeq (ba, SEQ_ID_CURSOR_PIXELMASK);
   1263  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO, saved_bank_lo);
   1264  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI, saved_bank_hi);
   1265  1.27     veego 		copyout (&mask, info->mask, 1);
   1266  1.27     veego 		info->size.x = 32; /* ??? */
   1267  1.27     veego 		info->size.y = (RSeq (ba, SEQ_ID_CURSOR_CONTROL) & 6) << 4;
   1268  1.27     veego 	}
   1269   1.4        mw 
   1270  1.27     veego 	return (0);
   1271   1.4        mw }
   1272   1.4        mw 
   1273  1.27     veego 
   1274   1.4        mw int
   1275  1.40   aymeric rt_setspriteinfo(struct grf_softc *gp, struct grf_spriteinfo *info)
   1276   1.4        mw {
   1277  1.27     veego 	volatile caddr_t ba, fb;
   1278  1.27     veego 	u_char control;
   1279   1.4        mw 
   1280  1.27     veego 	ba = gp->g_regkva;
   1281  1.27     veego 	fb = gp->g_fbkva;
   1282  1.27     veego 	control = vgar (ba, SEQ_ID_CURSOR_CONTROL);
   1283  1.27     veego 	if (info->set & GRFSPRSET_ENABLE) {
   1284  1.27     veego 		if (info->enable)
   1285  1.27     veego 			control |= 1;
   1286  1.27     veego 		else
   1287  1.27     veego 			control &= ~1;
   1288  1.27     veego 	vgaw (ba, SEQ_ID_CURSOR_CONTROL, control);
   1289  1.27     veego 	}
   1290  1.27     veego 	if (info->set & GRFSPRSET_POS)
   1291  1.27     veego 		rt_setspritepos (gp, &info->pos);
   1292  1.27     veego 	if (info->set & GRFSPRSET_HOT) {
   1293  1.27     veego 		vgaw (ba, SEQ_ID_CURSOR_X_INDEX, info->hot.x & 0x1f);
   1294  1.27     veego 		vgaw (ba, SEQ_ID_CURSOR_Y_INDEX, info->hot.y & 0x7f);
   1295  1.27     veego 	}
   1296  1.27     veego 	if (info->set & GRFSPRSET_CMAP) {
   1297  1.27     veego 		/* hey cheat a bit here.. XXX */
   1298  1.27     veego 		vgaw (ba, SEQ_ID_CURSOR_COLOR0, 0);
   1299  1.27     veego 		vgaw (ba, SEQ_ID_CURSOR_COLOR1, 1);
   1300  1.27     veego 	}
   1301  1.27     veego 	if (info->set & GRFSPRSET_SHAPE) {
   1302  1.27     veego 		int saved_bank_lo = RSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO);
   1303  1.27     veego 		int saved_bank_hi = RSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI);
   1304  1.27     veego 		int last_bank = SPRITE_ADDR >> 6;
   1305  1.27     veego 		int last_bank_lo = last_bank & 0xff;
   1306  1.27     veego 		int last_bank_hi = last_bank >> 8;
   1307  1.27     veego 		u_char mask;
   1308  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO, last_bank_lo);
   1309  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI, last_bank_hi);
   1310  1.27     veego 		copyin (info->image, fb, 128*4);
   1311  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO, saved_bank_lo);
   1312  1.27     veego 		WSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI, saved_bank_hi);
   1313  1.27     veego 		copyin (info->mask, &mask, 1);
   1314  1.27     veego 		WSeq (ba, SEQ_ID_CURSOR_PIXELMASK, mask);
   1315  1.27     veego 		/* info->size.x = 32; *//* ??? */
   1316  1.27     veego 
   1317  1.27     veego 		info->size.y = (RSeq (ba, SEQ_ID_CURSOR_CONTROL) & 6) << 4;
   1318  1.27     veego 		control = (control & ~6) | ((info->size.y >> 4) & 6);
   1319  1.27     veego 		vgaw (ba, SEQ_ID_CURSOR_CONTROL, control);
   1320  1.27     veego 
   1321  1.27     veego 		/* sick intel bull-addressing.. */
   1322  1.27     veego 		WSeq (ba, SEQ_ID_CURSOR_STORE_LO, SPRITE_ADDR & 0x0f);
   1323  1.27     veego 		WSeq (ba, SEQ_ID_CURSOR_STORE_HI, 0);
   1324  1.27     veego 		WSeq (ba, SEQ_ID_CURSOR_ST_OFF_LO, (SPRITE_ADDR >> 4) & 0xff);
   1325  1.27     veego 		WSeq (ba, SEQ_ID_CURSOR_ST_OFF_HI, ((SPRITE_ADDR >> 4) >> 8) & 0xff);
   1326  1.27     veego 	}
   1327  1.40   aymeric 
   1328  1.27     veego 	return (0);
   1329   1.4        mw }
   1330   1.4        mw 
   1331  1.27     veego 
   1332   1.4        mw int
   1333  1.40   aymeric rt_getspritemax(struct grf_softc *gp, struct grf_position *pos)
   1334   1.4        mw {
   1335  1.27     veego 	pos->x = 32;
   1336  1.27     veego 	pos->y = 128;
   1337   1.4        mw 
   1338  1.27     veego 	return (0);
   1339   1.4        mw }
   1340   1.4        mw 
   1341   1.4        mw 
   1342   1.4        mw /*
   1343   1.4        mw  * !!! THIS AREA UNDER CONSTRUCTION !!!
   1344   1.4        mw  */
   1345   1.4        mw 
   1346   1.4        mw int
   1347  1.40   aymeric rt_bitblt(struct grf_softc *gp, struct grf_bitblt *bb)
   1348   1.4        mw {
   1349  1.27     veego 	return (EINVAL);
   1350   1.4        mw 
   1351   1.4        mw #if 0
   1352  1.25     veego   volatile caddr_t ba, fb;
   1353   1.4        mw   u_char control;
   1354   1.4        mw   u_char saved_bank_lo;
   1355   1.4        mw   u_char saved_bank_hi;
   1356   1.4        mw   u_char src_bank_lo, src_bank_hi;
   1357   1.4        mw   u_char dst_bank_lo, dst_bank_hi;
   1358   1.4        mw   u_long src_offset, dst_offset;
   1359   1.4        mw   u_short src_bank, dst_bank;
   1360   1.4        mw   u_char *srcp, *dstp;
   1361   1.4        mw   short x, y;
   1362   1.4        mw   u_long tot;
   1363   1.4        mw 
   1364   1.4        mw   ba = gp->g_regkva;
   1365   1.4        mw   fb = gp->g_fbkva;
   1366   1.4        mw 
   1367   1.4        mw   saved_bank_lo = RSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO);
   1368   1.4        mw   saved_bank_hi = RSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI);
   1369   1.4        mw 
   1370   1.4        mw   /* for now, only GRFBBcopy is supported, and only for depth 8. No
   1371   1.4        mw      clipping is performed, either... */
   1372   1.4        mw 
   1373   1.4        mw   if (bb->op != GRFBBcopy && gp->g_display.gd_planes != 8)
   1374   1.4        mw     return EINVAL;
   1375   1.4        mw 
   1376   1.4        mw   src_offset = op->src_x + op->src_y * gp->g_display.gd_fbwidth;
   1377   1.4        mw   dst_offset = op->dst_x + op->dst_y * gp->g_display.gd_fbwidth;
   1378   1.4        mw   tot = op->w * op->h;
   1379   1.4        mw 
   1380   1.4        mw   /* set write mode 1, "[...] data in the read latches is written
   1381   1.4        mw      to memory during CPU memory write cycles. [...]" */
   1382  1.40   aymeric   WGfx (ba, GCT_ID_GRAPHICS_MODE, (RGfx(ba, GCT_ID_GRAPHICS_MODE) & 0xfc) | 1);
   1383   1.4        mw   /* write to primary, read from secondary */
   1384  1.40   aymeric   WSeq (ba, SEQ_ID_EXTENDED_MEM_ENA, (RSeq(ba, SEQ_ID_EXTENDED_MEM_ENA) & 0x1f) | 0 );
   1385   1.4        mw 
   1386   1.4        mw   if (src_offset < dst_offset)
   1387   1.4        mw     {
   1388   1.4        mw       /* start at end */
   1389   1.4        mw       src_offset += tot;
   1390   1.4        mw       dst_offset += tot;
   1391   1.4        mw     }
   1392   1.4        mw 
   1393   1.4        mw   src_bank_lo = (src_offset >> 6) & 0xff;
   1394   1.4        mw   src_bank_hi = (src_offset >> 14) & 0xff;
   1395   1.4        mw   dst_bank_lo = (dst_offset >> 6) & 0xff;
   1396   1.4        mw   dst_bank_hi = (dst_offset >> 14) & 0xff;
   1397   1.4        mw 
   1398   1.4        mw   while (tot)
   1399   1.4        mw     {
   1400   1.4        mw       WSeq (ba, SEQ_ID_SEC_HOST_OFF_LO, src_bank_lo);
   1401   1.4        mw       WSeq (ba, SEQ_ID_SEC_HOST_OFF_HI, src_bank_hi);
   1402   1.4        mw       WSeq (ba, SEQ_ID_PRIM_HOST_OFF_LO, dst_bank_lo);
   1403   1.4        mw       WSeq (ba, SEQ_ID_PRIM_HOST_OFF_HI, dst_bank_hi);
   1404  1.40   aymeric 
   1405   1.4        mw       if (src_offset < dst_offset)
   1406   1.4        mw 	{
   1407  1.40   aymeric 
   1408  1.40   aymeric 
   1409   1.4        mw 	}
   1410   1.4        mw       else
   1411   1.4        mw 	{
   1412  1.40   aymeric 
   1413   1.4        mw 	}
   1414   1.4        mw     }
   1415  1.40   aymeric 
   1416   1.4        mw 
   1417   1.4        mw #endif
   1418   1.4        mw }
   1419   1.4        mw 
   1420  1.27     veego 
   1421  1.27     veego int
   1422  1.40   aymeric rt_blank(struct grf_softc *gp, int *on)
   1423  1.27     veego {
   1424  1.28        is 	struct MonDef *md = (struct MonDef *)gp->g_data;
   1425  1.27     veego 	int r;
   1426  1.27     veego 
   1427  1.29        is 	r = 0x01 | ((md->FLG & MDF_CLKDIV2)/ MDF_CLKDIV2 * 8);
   1428  1.27     veego 
   1429  1.30        is 	WSeq(gp->g_regkva, SEQ_ID_CLOCKING_MODE, *on > 0 ? r : 0x21);
   1430  1.27     veego 
   1431  1.27     veego 	return(0);
   1432  1.40   aymeric }
   1433   1.1        mw 
   1434   1.1        mw #endif	/* NGRF */
   1435