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