grf_cl.c revision 1.7 1 1.7 thorpej /* $NetBSD: grf_cl.c,v 1.7 1996/03/17 01:17:11 thorpej Exp $ */
2 1.1 chopps
3 1.1 chopps /*
4 1.1 chopps * Copyright (c) 1995 Ezra Story
5 1.1 chopps * Copyright (c) 1995 Kari Mettinen
6 1.1 chopps * Copyright (c) 1994 Markus Wild
7 1.1 chopps * Copyright (c) 1994 Lutz Vieweg
8 1.1 chopps * All rights reserved.
9 1.1 chopps *
10 1.1 chopps * Redistribution and use in source and binary forms, with or without
11 1.1 chopps * modification, are permitted provided that the following conditions
12 1.1 chopps * are met:
13 1.1 chopps * 1. Redistributions of source code must retain the above copyright
14 1.1 chopps * notice, this list of conditions and the following disclaimer.
15 1.1 chopps * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 chopps * notice, this list of conditions and the following disclaimer in the
17 1.1 chopps * documentation and/or other materials provided with the distribution.
18 1.1 chopps * 3. All advertising materials mentioning features or use of this software
19 1.1 chopps * must display the following acknowledgement:
20 1.1 chopps * This product includes software developed by Lutz Vieweg.
21 1.1 chopps * 4. The name of the author may not be used to endorse or promote products
22 1.1 chopps * derived from this software without specific prior written permission
23 1.1 chopps *
24 1.1 chopps * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
25 1.1 chopps * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
26 1.1 chopps * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
27 1.1 chopps * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
28 1.1 chopps * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
29 1.1 chopps * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
30 1.1 chopps * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
31 1.1 chopps * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
32 1.1 chopps * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
33 1.5 chopps * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
34 1.1 chopps */
35 1.5 chopps #include "grfcl.h"
36 1.5 chopps #if NGRFCL > 0
37 1.1 chopps
38 1.1 chopps /*
39 1.1 chopps * Graphics routines for Cirrus CL GD 5426 boards,
40 1.1 chopps *
41 1.1 chopps * This code offers low-level routines to access Cirrus Cl GD 5426
42 1.1 chopps * graphics-boards from within NetBSD for the Amiga.
43 1.1 chopps * No warranties for any kind of function at all - this
44 1.1 chopps * code may crash your hardware and scratch your harddisk. Use at your
45 1.1 chopps * own risk. Freely distributable.
46 1.1 chopps *
47 1.1 chopps * Modified for Cirrus CL GD 5426 from
48 1.1 chopps * Lutz Vieweg's retina driver by Kari Mettinen 08/94
49 1.1 chopps * Contributions by Ill, ScottE, MiL
50 1.1 chopps * Extensively hacked and rewritten by Ezra Story (Ezy) 01/95
51 1.6 is * Picasso/040 patches (wee!) by crest 01/96
52 1.1 chopps *
53 1.1 chopps * Thanks to Village Tronic Marketing Gmbh for providing me with
54 1.1 chopps * a Picasso-II board.
55 1.1 chopps * Thanks for Integrated Electronics Oy Ab for providing me with
56 1.1 chopps * Cirrus CL GD 542x family documentation.
57 1.1 chopps *
58 1.1 chopps * TODO:
59 1.5 chopps * Mouse support (almost there! :-))
60 1.1 chopps * Blitter support
61 1.1 chopps *
62 1.1 chopps */
63 1.1 chopps
64 1.1 chopps #include <sys/param.h>
65 1.4 chopps #include <sys/systm.h>
66 1.1 chopps #include <sys/errno.h>
67 1.1 chopps #include <sys/ioctl.h>
68 1.1 chopps #include <sys/device.h>
69 1.1 chopps #include <sys/malloc.h>
70 1.5 chopps
71 1.1 chopps #include <machine/cpu.h>
72 1.1 chopps #include <dev/cons.h>
73 1.1 chopps #include <amiga/amiga/device.h>
74 1.1 chopps #include <amiga/dev/grfioctl.h>
75 1.1 chopps #include <amiga/dev/grfvar.h>
76 1.1 chopps #include <amiga/dev/grf_clreg.h>
77 1.1 chopps #include <amiga/dev/zbusvar.h>
78 1.1 chopps
79 1.5 chopps static int cl_mondefok __P((struct grfvideo_mode * gv));
80 1.1 chopps static void cl_boardinit();
81 1.5 chopps static void CompFQ __P((u_int fq, u_char * num, u_char * denom));
82 1.5 chopps static int cl_getvmode __P((struct grf_softc * gp, struct grfvideo_mode * vm));
83 1.5 chopps static int cl_setvmode __P((struct grf_softc * gp, unsigned int mode));
84 1.5 chopps static int cl_toggle __P((struct grf_softc * gp, unsigned short));
85 1.5 chopps static int cl_getcmap __P((struct grf_softc * gfp, struct grf_colormap * cmap));
86 1.5 chopps static int cl_putcmap __P((struct grf_softc * gfp, struct grf_colormap * cmap));
87 1.5 chopps static void cl_off __P((struct grf_softc * gp));
88 1.5 chopps static void cl_inittextmode __P((struct grf_softc * gp));
89 1.5 chopps static int cl_ioctl __P((register struct grf_softc * gp, int cmd, void *data));
90 1.5 chopps static int cl_getmousepos __P((struct grf_softc * gp, struct grf_position * data));
91 1.5 chopps static int cl_setmousepos __P((struct grf_softc * gp, struct grf_position * data));
92 1.5 chopps static int cl_setspriteinfo __P((struct grf_softc * gp, struct grf_spriteinfo * data));
93 1.5 chopps static int cl_getspriteinfo __P((struct grf_softc * gp, struct grf_spriteinfo * data));
94 1.5 chopps static int cl_getspritemax __P((struct grf_softc * gp, struct grf_position * data));
95 1.5 chopps static int cl_blank __P((struct grf_softc * gp, int * on));
96 1.5 chopps
97 1.1 chopps
98 1.1 chopps void grfclattach __P((struct device *, struct device *, void *));
99 1.5 chopps int grfclprint __P((void *, char *));
100 1.7 thorpej int grfclmatch __P((struct device *, void *, void *));
101 1.5 chopps void cl_memset __P((unsigned char *d, unsigned char c, int l));
102 1.1 chopps
103 1.5 chopps /* Graphics display definitions.
104 1.1 chopps * These are filled by 'grfconfig' using GRFIOCSETMON.
105 1.1 chopps */
106 1.1 chopps #define monitor_def_max 8
107 1.1 chopps static struct grfvideo_mode monitor_def[8] = {
108 1.1 chopps {0}, {0}, {0}, {0}, {0}, {0}, {0}, {0}
109 1.1 chopps };
110 1.1 chopps static struct grfvideo_mode *monitor_current = &monitor_def[0];
111 1.1 chopps
112 1.1 chopps /* Patchable maximum pixel clock */
113 1.5 chopps unsigned long cl_maxpixelclock = 86000000;
114 1.1 chopps
115 1.1 chopps /* Console display definition.
116 1.1 chopps * Default hardcoded text mode. This grf_cl is set up to
117 1.1 chopps * use one text mode only, and this is it. You may use
118 1.1 chopps * grfconfig to change the mode after boot.
119 1.5 chopps */
120 1.1 chopps /* Console font */
121 1.2 chopps #ifdef KFONT_8X11
122 1.2 chopps #define CIRRUSFONT kernel_font_8x11
123 1.2 chopps #define CIRRUSFONTY 11
124 1.2 chopps #else
125 1.1 chopps #define CIRRUSFONT kernel_font_8x8
126 1.1 chopps #define CIRRUSFONTY 8
127 1.2 chopps #endif
128 1.1 chopps extern unsigned char CIRRUSFONT[];
129 1.1 chopps
130 1.1 chopps struct grfcltext_mode clconsole_mode = {
131 1.5 chopps {255, "", 25200000, 640, 480, 4, 80, 100, 94, 99, 100, 481, 522, 490,
132 1.5 chopps 498, 522},
133 1.5 chopps 8, CIRRUSFONTY, 80, 480 / CIRRUSFONTY, CIRRUSFONT, 32, 255
134 1.1 chopps };
135 1.1 chopps /* Console colors */
136 1.5 chopps unsigned char clconscolors[3][3] = { /* background, foreground, hilite */
137 1.5 chopps {0, 0x40, 0x50}, {152, 152, 152}, {255, 255, 255}
138 1.1 chopps };
139 1.1 chopps
140 1.5 chopps int cltype = 0; /* Picasso, Spectrum or Piccolo */
141 1.5 chopps unsigned char pass_toggle; /* passthru status tracker */
142 1.1 chopps
143 1.5 chopps /* because all 5426-boards have 2 configdev entries, one for
144 1.1 chopps * framebuffer mem and the other for regs, we have to hold onto
145 1.1 chopps * the pointers globally until we match on both. This and 'cltype'
146 1.1 chopps * are the primary obsticles to multiple board support, but if you
147 1.1 chopps * have multiple boards you have bigger problems than grf_cl.
148 1.1 chopps */
149 1.5 chopps static void *cl_fbaddr = 0; /* framebuffer */
150 1.5 chopps static void *cl_regaddr = 0; /* registers */
151 1.5 chopps static int cl_fbsize; /* framebuffer size */
152 1.5 chopps
153 1.5 chopps /* current sprite info, if you add summport for multiple boards
154 1.5 chopps * make this an array or something
155 1.5 chopps */
156 1.5 chopps struct grf_spriteinfo cl_cursprite;
157 1.5 chopps
158 1.5 chopps /* sprite bitmaps in kernel stack, you'll need to arrayize these too if
159 1.5 chopps * you add multiple board support
160 1.5 chopps */
161 1.5 chopps static unsigned char cl_imageptr[8 * 64], cl_maskptr[8 * 64];
162 1.5 chopps static unsigned char cl_sprred[2], cl_sprgreen[2], cl_sprblue[2];
163 1.1 chopps
164 1.1 chopps /* standard driver stuff */
165 1.7 thorpej struct cfattac grfcl_ca = {
166 1.7 thorpej sizeof(struct grf_softc), grfclmatch, grfclattach
167 1.7 thorpej };
168 1.7 thorpej
169 1.7 thorpej struct cfdriver grfcl_cd = {
170 1.7 thorpej NULL, "grfcl", DV_DULL, NULL, 0
171 1.1 chopps };
172 1.1 chopps static struct cfdata *cfdata;
173 1.1 chopps
174 1.1 chopps int
175 1.7 thorpej grfclmatch(pdp, match, auxp)
176 1.1 chopps struct device *pdp;
177 1.7 thorpej void *match, *auxp;
178 1.1 chopps {
179 1.7 thorpej struct cfdata *cfp = match;
180 1.1 chopps struct zbus_args *zap;
181 1.1 chopps static int regprod, fbprod;
182 1.1 chopps
183 1.1 chopps zap = auxp;
184 1.1 chopps
185 1.1 chopps #ifndef CL5426CONSOLE
186 1.1 chopps if (amiga_realconfig == 0)
187 1.5 chopps return (0);
188 1.1 chopps #endif
189 1.1 chopps
190 1.5 chopps /* Grab the first board we encounter as the preferred one. This will
191 1.5 chopps * allow one board to work in a multiple 5426 board system, but not
192 1.5 chopps * multiple boards at the same time. */
193 1.1 chopps if (cltype == 0) {
194 1.1 chopps switch (zap->manid) {
195 1.1 chopps case PICASSO:
196 1.3 chopps if (zap->prodid != 12 && zap->prodid != 11)
197 1.3 chopps return (0);
198 1.1 chopps regprod = 12;
199 1.1 chopps fbprod = 11;
200 1.1 chopps break;
201 1.1 chopps case SPECTRUM:
202 1.3 chopps if (zap->prodid != 2 && zap->prodid != 1)
203 1.3 chopps return (0);
204 1.1 chopps regprod = 2;
205 1.1 chopps fbprod = 1;
206 1.1 chopps break;
207 1.1 chopps case PICCOLO:
208 1.3 chopps if (zap->prodid != 6 && zap->prodid != 5)
209 1.3 chopps return (0);
210 1.1 chopps regprod = 6;
211 1.1 chopps fbprod = 5;
212 1.1 chopps break;
213 1.1 chopps default:
214 1.5 chopps return (0);
215 1.1 chopps }
216 1.1 chopps cltype = zap->manid;
217 1.1 chopps } else {
218 1.1 chopps if (cltype != zap->manid) {
219 1.5 chopps return (0);
220 1.1 chopps }
221 1.1 chopps }
222 1.1 chopps
223 1.5 chopps /* Configure either registers or framebuffer in any order */
224 1.1 chopps if (zap->prodid == regprod)
225 1.1 chopps cl_regaddr = zap->va;
226 1.5 chopps else
227 1.5 chopps if (zap->prodid == fbprod) {
228 1.5 chopps cl_fbaddr = zap->va;
229 1.5 chopps cl_fbsize = zap->size;
230 1.5 chopps } else
231 1.5 chopps return (0);
232 1.1 chopps
233 1.1 chopps #ifdef CL5426CONSOLE
234 1.1 chopps if (amiga_realconfig == 0) {
235 1.1 chopps cfdata = cfp;
236 1.1 chopps }
237 1.5 chopps #endif
238 1.1 chopps
239 1.5 chopps return (1);
240 1.1 chopps }
241 1.1 chopps
242 1.1 chopps void
243 1.1 chopps grfclattach(pdp, dp, auxp)
244 1.1 chopps struct device *pdp, *dp;
245 1.5 chopps void *auxp;
246 1.1 chopps {
247 1.1 chopps static struct grf_softc congrf;
248 1.1 chopps struct zbus_args *zap;
249 1.1 chopps struct grf_softc *gp;
250 1.5 chopps int x;
251 1.1 chopps static char attachflag = 0;
252 1.1 chopps
253 1.1 chopps zap = auxp;
254 1.1 chopps
255 1.1 chopps printf("\n");
256 1.1 chopps
257 1.1 chopps /* make sure both halves have matched */
258 1.1 chopps if (!cl_regaddr || !cl_fbaddr)
259 1.1 chopps return;
260 1.1 chopps
261 1.1 chopps /* do all that messy console/grf stuff */
262 1.1 chopps if (dp == NULL)
263 1.1 chopps gp = &congrf;
264 1.1 chopps else
265 1.5 chopps gp = (struct grf_softc *) dp;
266 1.1 chopps
267 1.1 chopps if (dp != NULL && congrf.g_regkva != 0) {
268 1.1 chopps /*
269 1.1 chopps * inited earlier, just copy (not device struct)
270 1.1 chopps */
271 1.1 chopps bcopy(&congrf.g_display, &gp->g_display,
272 1.5 chopps (char *) &gp[1] - (char *) &gp->g_display);
273 1.1 chopps } else {
274 1.5 chopps gp->g_regkva = (volatile caddr_t) cl_regaddr;
275 1.5 chopps gp->g_fbkva = (volatile caddr_t) cl_fbaddr;
276 1.1 chopps
277 1.1 chopps gp->g_unit = GRF_CL5426_UNIT;
278 1.1 chopps gp->g_mode = cl_mode;
279 1.1 chopps gp->g_conpri = grfcl_cnprobe();
280 1.1 chopps gp->g_flags = GF_ALIVE;
281 1.1 chopps
282 1.1 chopps /* wakeup the board */
283 1.1 chopps cl_boardinit(gp);
284 1.1 chopps
285 1.1 chopps #ifdef CL5426CONSOLE
286 1.1 chopps grfcl_iteinit(gp);
287 1.5 chopps (void) cl_load_mon(gp, &clconsole_mode);
288 1.1 chopps #endif
289 1.1 chopps
290 1.1 chopps }
291 1.1 chopps
292 1.1 chopps /*
293 1.1 chopps * attach grf (once)
294 1.1 chopps */
295 1.1 chopps if (amiga_config_found(cfdata, &gp->g_device, gp, grfclprint)) {
296 1.1 chopps attachflag = 1;
297 1.5 chopps printf("grfcl: %dMB ", cl_fbsize / 0x100000);
298 1.1 chopps switch (cltype) {
299 1.1 chopps case PICASSO:
300 1.1 chopps printf("Picasso II");
301 1.5 chopps cl_maxpixelclock = 86000000;
302 1.1 chopps break;
303 1.1 chopps case SPECTRUM:
304 1.1 chopps printf("Spectrum");
305 1.5 chopps cl_maxpixelclock = 90000000;
306 1.1 chopps break;
307 1.1 chopps case PICCOLO:
308 1.1 chopps printf("Piccolo");
309 1.5 chopps cl_maxpixelclock = 90000000;
310 1.1 chopps break;
311 1.1 chopps }
312 1.1 chopps printf(" being used\n");
313 1.5 chopps #ifdef CL_OVERCLOCK
314 1.5 chopps cl_maxpixelclock = 115000000;
315 1.5 chopps #endif
316 1.1 chopps } else {
317 1.1 chopps if (!attachflag)
318 1.1 chopps printf("grfcl unattached!!\n");
319 1.1 chopps }
320 1.1 chopps }
321 1.1 chopps
322 1.1 chopps int
323 1.1 chopps grfclprint(auxp, pnp)
324 1.5 chopps void *auxp;
325 1.5 chopps char *pnp;
326 1.1 chopps {
327 1.1 chopps if (pnp)
328 1.1 chopps printf("ite at %s: ", pnp);
329 1.5 chopps return (UNCONF);
330 1.1 chopps }
331 1.1 chopps
332 1.1 chopps void
333 1.1 chopps cl_boardinit(gp)
334 1.5 chopps struct grf_softc *gp;
335 1.1 chopps {
336 1.1 chopps unsigned char *ba = gp->g_regkva;
337 1.5 chopps int x;
338 1.5 chopps void *bah;
339 1.1 chopps
340 1.1 chopps /* wakeup board and flip passthru OFF */
341 1.1 chopps
342 1.1 chopps RegWakeup(ba);
343 1.1 chopps RegOnpass(ba);
344 1.1 chopps
345 1.1 chopps vgaw(ba, 0x46e8, 0x16);
346 1.1 chopps vgaw(ba, 0x102, 1);
347 1.1 chopps vgaw(ba, 0x46e8, 0x0e);
348 1.1 chopps vgaw(ba, 0x3c3, 1);
349 1.1 chopps
350 1.1 chopps /* setup initial unchanging parameters */
351 1.1 chopps
352 1.5 chopps WSeq(ba, SEQ_ID_CLOCKING_MODE, 0x21); /* 8 dot - display off */
353 1.5 chopps vgaw(ba, GREG_MISC_OUTPUT_W, 0xe1); /* mem disable */
354 1.1 chopps
355 1.5 chopps WGfx(ba, GCT_ID_OFFSET_1, 0xec); /* magic cookie */
356 1.5 chopps WSeq(ba, SEQ_ID_UNLOCK_EXT, 0x12); /* yum! cookies! */
357 1.1 chopps
358 1.5 chopps WSeq(ba, SEQ_ID_DRAM_CNTL, 0xb0);
359 1.5 chopps WSeq(ba, SEQ_ID_RESET, 0x03);
360 1.1 chopps WSeq(ba, SEQ_ID_MAP_MASK, 0xff);
361 1.5 chopps WSeq(ba, SEQ_ID_CHAR_MAP_SELECT, 0x00);
362 1.5 chopps WSeq(ba, SEQ_ID_MEMORY_MODE, 0x0e); /* a or 6? */
363 1.1 chopps WSeq(ba, SEQ_ID_EXT_SEQ_MODE, (cltype == PICASSO) ? 0x20 : 0x80);
364 1.1 chopps WSeq(ba, SEQ_ID_EEPROM_CNTL, 0x00);
365 1.5 chopps WSeq(ba, SEQ_ID_PERF_TUNE, 0x0a); /* mouse 0a fa */
366 1.1 chopps WSeq(ba, SEQ_ID_SIG_CNTL, 0x02);
367 1.5 chopps WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x04);
368 1.1 chopps
369 1.1 chopps WSeq(ba, SEQ_ID_MCLK_SELECT, 0x22);
370 1.1 chopps
371 1.1 chopps WCrt(ba, CRT_ID_PRESET_ROW_SCAN, 0x00);
372 1.1 chopps WCrt(ba, CRT_ID_CURSOR_START, 0x00);
373 1.1 chopps WCrt(ba, CRT_ID_CURSOR_END, 0x08);
374 1.1 chopps WCrt(ba, CRT_ID_START_ADDR_HIGH, 0x00);
375 1.1 chopps WCrt(ba, CRT_ID_START_ADDR_LOW, 0x00);
376 1.1 chopps WCrt(ba, CRT_ID_CURSOR_LOC_HIGH, 0x00);
377 1.1 chopps WCrt(ba, CRT_ID_CURSOR_LOC_LOW, 0x00);
378 1.1 chopps
379 1.1 chopps WCrt(ba, CRT_ID_UNDERLINE_LOC, 0x07);
380 1.5 chopps WCrt(ba, CRT_ID_MODE_CONTROL, 0xa3); /* c3 */
381 1.5 chopps WCrt(ba, CRT_ID_LINE_COMPARE, 0xff); /* ff */
382 1.1 chopps WCrt(ba, CRT_ID_EXT_DISP_CNTL, 0x22);
383 1.5 chopps WSeq(ba, SEQ_ID_CURSOR_STORE, 0x3c); /* mouse 0x00 */
384 1.1 chopps
385 1.1 chopps WGfx(ba, GCT_ID_SET_RESET, 0x00);
386 1.1 chopps WGfx(ba, GCT_ID_ENABLE_SET_RESET, 0x00);
387 1.1 chopps WGfx(ba, GCT_ID_DATA_ROTATE, 0x00);
388 1.1 chopps WGfx(ba, GCT_ID_READ_MAP_SELECT, 0x00);
389 1.1 chopps WGfx(ba, GCT_ID_GRAPHICS_MODE, 0x00);
390 1.1 chopps WGfx(ba, GCT_ID_MISC, 0x01);
391 1.1 chopps WGfx(ba, GCT_ID_COLOR_XCARE, 0x0f);
392 1.1 chopps WGfx(ba, GCT_ID_BITMASK, 0xff);
393 1.1 chopps WGfx(ba, GCT_ID_MODE_EXT, 0x28);
394 1.1 chopps
395 1.5 chopps for (x = 0; x < 0x10; x++)
396 1.5 chopps WAttr(ba, x, x);
397 1.1 chopps WAttr(ba, ACT_ID_ATTR_MODE_CNTL, 0x01);
398 1.1 chopps WAttr(ba, ACT_ID_OVERSCAN_COLOR, 0x00);
399 1.1 chopps WAttr(ba, ACT_ID_COLOR_PLANE_ENA, 0x0f);
400 1.1 chopps WAttr(ba, ACT_ID_HOR_PEL_PANNING, 0x00);
401 1.1 chopps WAttr(ba, ACT_ID_COLOR_SELECT, 0x00);
402 1.1 chopps
403 1.1 chopps delay(200000);
404 1.5 chopps WAttr(ba, 0x34, 0x00);
405 1.1 chopps delay(200000);
406 1.1 chopps
407 1.1 chopps vgaw(ba, VDAC_MASK, 0xff);
408 1.1 chopps delay(200000);
409 1.5 chopps vgaw(ba, GREG_MISC_OUTPUT_W, 0xe3); /* c3 */
410 1.1 chopps
411 1.1 chopps WGfx(ba, GCT_ID_BLT_STAT_START, 0x40);
412 1.1 chopps WGfx(ba, GCT_ID_BLT_STAT_START, 0x00);
413 1.1 chopps
414 1.1 chopps /* colors initially set to greyscale */
415 1.1 chopps
416 1.1 chopps vgaw(ba, VDAC_ADDRESS_W, 0);
417 1.5 chopps for (x = 255; x >= 0; x--) {
418 1.1 chopps vgaw(ba, VDAC_DATA, x);
419 1.1 chopps vgaw(ba, VDAC_DATA, x);
420 1.1 chopps vgaw(ba, VDAC_DATA, x);
421 1.1 chopps }
422 1.5 chopps /* set sprite bitmap pointers */
423 1.5 chopps cl_cursprite.image = cl_imageptr;
424 1.5 chopps cl_cursprite.mask = cl_maskptr;
425 1.5 chopps cl_cursprite.cmap.red = cl_sprred;
426 1.5 chopps cl_cursprite.cmap.green = cl_sprgreen;
427 1.5 chopps cl_cursprite.cmap.blue = cl_sprblue;
428 1.1 chopps }
429 1.1 chopps
430 1.1 chopps
431 1.1 chopps int
432 1.1 chopps cl_getvmode(gp, vm)
433 1.1 chopps struct grf_softc *gp;
434 1.1 chopps struct grfvideo_mode *vm;
435 1.1 chopps {
436 1.1 chopps struct grfvideo_mode *gv;
437 1.1 chopps
438 1.1 chopps #ifdef CL5426CONSOLE
439 1.1 chopps /* Handle grabbing console mode */
440 1.1 chopps if (vm->mode_num == 255) {
441 1.1 chopps bcopy(&clconsole_mode, vm, sizeof(struct grfvideo_mode));
442 1.5 chopps /* XXX so grfconfig can tell us the correct text dimensions. */
443 1.1 chopps vm->depth = clconsole_mode.fy;
444 1.5 chopps } else
445 1.1 chopps #endif
446 1.5 chopps {
447 1.5 chopps if (vm->mode_num == 0)
448 1.5 chopps vm->mode_num = (monitor_current - monitor_def) + 1;
449 1.5 chopps if (vm->mode_num < 1 || vm->mode_num > monitor_def_max)
450 1.5 chopps return (EINVAL);
451 1.5 chopps gv = monitor_def + (vm->mode_num - 1);
452 1.5 chopps if (gv->mode_num == 0)
453 1.5 chopps return (EINVAL);
454 1.5 chopps
455 1.5 chopps bcopy(gv, vm, sizeof(struct grfvideo_mode));
456 1.5 chopps }
457 1.5 chopps
458 1.5 chopps /* adjust internal values to pixel values */
459 1.5 chopps
460 1.5 chopps vm->hblank_start *= 8;
461 1.5 chopps vm->hblank_stop *= 8;
462 1.5 chopps vm->hsync_start *= 8;
463 1.5 chopps vm->hsync_stop *= 8;
464 1.5 chopps vm->htotal *= 8;
465 1.5 chopps
466 1.5 chopps return (0);
467 1.1 chopps }
468 1.1 chopps
469 1.1 chopps
470 1.1 chopps int
471 1.1 chopps cl_setvmode(gp, mode)
472 1.1 chopps struct grf_softc *gp;
473 1.1 chopps unsigned mode;
474 1.1 chopps {
475 1.5 chopps if (!mode || (mode > monitor_def_max) ||
476 1.5 chopps monitor_def[mode - 1].mode_num == 0)
477 1.5 chopps return (EINVAL);
478 1.1 chopps
479 1.1 chopps monitor_current = monitor_def + (mode - 1);
480 1.1 chopps
481 1.5 chopps return (0);
482 1.1 chopps }
483 1.1 chopps
484 1.1 chopps void
485 1.1 chopps cl_off(gp)
486 1.5 chopps struct grf_softc *gp;
487 1.1 chopps {
488 1.5 chopps char *ba = gp->g_regkva;
489 1.1 chopps
490 1.5 chopps /* we'll put the pass-through on for cc ite and set Full Bandwidth bit
491 1.5 chopps * on just in case it didn't work...but then it doesn't matter does
492 1.5 chopps * it? =) */
493 1.1 chopps RegOnpass(ba);
494 1.1 chopps WSeq(ba, SEQ_ID_CLOCKING_MODE, 0x21);
495 1.1 chopps }
496 1.1 chopps
497 1.5 chopps int
498 1.5 chopps cl_blank(gp, on)
499 1.5 chopps struct grf_softc *gp;
500 1.5 chopps int *on;
501 1.5 chopps {
502 1.5 chopps WSeq(gp->g_regkva, SEQ_ID_CLOCKING_MODE, *on ? 0x21 : 0x01);
503 1.5 chopps return(0);
504 1.5 chopps }
505 1.5 chopps
506 1.1 chopps /*
507 1.1 chopps * Change the mode of the display.
508 1.1 chopps * Return a UNIX error number or 0 for success.
509 1.1 chopps */
510 1.1 chopps cl_mode(gp, cmd, arg, a2, a3)
511 1.1 chopps register struct grf_softc *gp;
512 1.5 chopps int cmd;
513 1.5 chopps void *arg;
514 1.5 chopps int a2, a3;
515 1.1 chopps {
516 1.5 chopps int error;
517 1.1 chopps
518 1.1 chopps switch (cmd) {
519 1.1 chopps case GM_GRFON:
520 1.5 chopps error = cl_load_mon(gp,
521 1.1 chopps (struct grfcltext_mode *) monitor_current) ? 0 : EINVAL;
522 1.5 chopps return (error);
523 1.1 chopps
524 1.1 chopps case GM_GRFOFF:
525 1.1 chopps #ifndef CL5426CONSOLE
526 1.1 chopps cl_off(gp);
527 1.1 chopps #else
528 1.1 chopps cl_load_mon(gp, &clconsole_mode);
529 1.1 chopps #endif
530 1.5 chopps return (0);
531 1.1 chopps
532 1.1 chopps case GM_GRFCONFIG:
533 1.5 chopps return (0);
534 1.1 chopps
535 1.1 chopps case GM_GRFGETVMODE:
536 1.5 chopps return (cl_getvmode(gp, (struct grfvideo_mode *) arg));
537 1.1 chopps
538 1.1 chopps case GM_GRFSETVMODE:
539 1.5 chopps error = cl_setvmode(gp, *(unsigned *) arg);
540 1.5 chopps if (!error && (gp->g_flags & GF_GRFON))
541 1.5 chopps cl_load_mon(gp,
542 1.1 chopps (struct grfcltext_mode *) monitor_current);
543 1.5 chopps return (error);
544 1.1 chopps
545 1.1 chopps case GM_GRFGETNUMVM:
546 1.5 chopps *(int *) arg = monitor_def_max;
547 1.5 chopps return (0);
548 1.1 chopps
549 1.1 chopps case GM_GRFIOCTL:
550 1.5 chopps return (cl_ioctl(gp, (int) arg, (caddr_t) a2));
551 1.1 chopps
552 1.1 chopps default:
553 1.1 chopps break;
554 1.1 chopps }
555 1.1 chopps
556 1.5 chopps return (EINVAL);
557 1.1 chopps }
558 1.1 chopps
559 1.1 chopps int
560 1.5 chopps cl_ioctl(gp, cmd, data)
561 1.1 chopps register struct grf_softc *gp;
562 1.5 chopps int cmd;
563 1.5 chopps void *data;
564 1.1 chopps {
565 1.1 chopps switch (cmd) {
566 1.1 chopps case GRFIOCGSPRITEPOS:
567 1.5 chopps return (cl_getmousepos(gp, (struct grf_position *) data));
568 1.5 chopps
569 1.1 chopps case GRFIOCSSPRITEPOS:
570 1.5 chopps return (cl_setmousepos(gp, (struct grf_position *) data));
571 1.5 chopps
572 1.1 chopps case GRFIOCSSPRITEINF:
573 1.5 chopps return (cl_setspriteinfo(gp, (struct grf_spriteinfo *) data));
574 1.5 chopps
575 1.1 chopps case GRFIOCGSPRITEINF:
576 1.5 chopps return (cl_getspriteinfo(gp, (struct grf_spriteinfo *) data));
577 1.5 chopps
578 1.1 chopps case GRFIOCGSPRITEMAX:
579 1.5 chopps return (cl_getspritemax(gp, (struct grf_position *) data));
580 1.1 chopps
581 1.1 chopps case GRFIOCGETCMAP:
582 1.5 chopps return (cl_getcmap(gp, (struct grf_colormap *) data));
583 1.1 chopps
584 1.1 chopps case GRFIOCPUTCMAP:
585 1.5 chopps return (cl_putcmap(gp, (struct grf_colormap *) data));
586 1.1 chopps
587 1.1 chopps case GRFIOCBITBLT:
588 1.1 chopps break;
589 1.1 chopps
590 1.1 chopps case GRFTOGGLE:
591 1.5 chopps return (cl_toggle(gp, 0));
592 1.1 chopps
593 1.1 chopps case GRFIOCSETMON:
594 1.5 chopps return (cl_setmonitor(gp, (struct grfvideo_mode *) data));
595 1.5 chopps
596 1.5 chopps case GRFIOCBLANK:
597 1.5 chopps return (cl_blank(gp, (int *)data));
598 1.5 chopps
599 1.5 chopps }
600 1.5 chopps return (EINVAL);
601 1.5 chopps }
602 1.5 chopps
603 1.5 chopps int
604 1.5 chopps cl_getmousepos(gp, data)
605 1.5 chopps struct grf_softc *gp;
606 1.5 chopps struct grf_position *data;
607 1.5 chopps {
608 1.5 chopps data->x = cl_cursprite.pos.x;
609 1.5 chopps data->y = cl_cursprite.pos.y;
610 1.5 chopps return (0);
611 1.5 chopps }
612 1.5 chopps
613 1.5 chopps void
614 1.5 chopps cl_writesprpos(ba, x, y)
615 1.5 chopps volatile char *ba;
616 1.5 chopps short x;
617 1.5 chopps short y;
618 1.5 chopps {
619 1.5 chopps /* we want to use a 16-bit write to 3c4 so no macros used */
620 1.5 chopps volatile unsigned char *cwp;
621 1.5 chopps volatile unsigned short *wp;
622 1.5 chopps
623 1.5 chopps cwp = ba + 0x3c4;
624 1.5 chopps wp = (unsigned short *)cwp;
625 1.5 chopps
626 1.5 chopps /* don't ask me why, but apparently you can't do a 16-bit write with
627 1.5 chopps * x-position like with y-position below (dagge) */
628 1.5 chopps cwp[0] = 0x10 | ((x << 5) & 0xff);
629 1.5 chopps cwp[1] = (x >> 3) & 0xff;
630 1.5 chopps
631 1.5 chopps *wp = 0x1100 | ((y & 7) << 13) | ((y >> 3) & 0xff);
632 1.5 chopps
633 1.5 chopps }
634 1.5 chopps
635 1.5 chopps void
636 1.5 chopps writeshifted(to, shiftx, shifty)
637 1.5 chopps unsigned char *to;
638 1.5 chopps char shiftx;
639 1.5 chopps char shifty;
640 1.5 chopps {
641 1.5 chopps register char y;
642 1.5 chopps unsigned long long *tptr, *iptr, *mptr, line;
643 1.5 chopps
644 1.5 chopps tptr = (unsigned long long *) to;
645 1.5 chopps iptr = (unsigned long long *) cl_cursprite.image;
646 1.5 chopps mptr = (unsigned long long *) cl_cursprite.mask;
647 1.5 chopps
648 1.5 chopps shiftx = shiftx < 0 ? 0 : shiftx;
649 1.5 chopps shifty = shifty < 0 ? 0 : shifty;
650 1.5 chopps
651 1.5 chopps /* start reading shifty lines down, and
652 1.5 chopps * shift each line in by shiftx
653 1.5 chopps */
654 1.5 chopps for (y = shifty; y < 64; y++) {
655 1.5 chopps
656 1.5 chopps /* image */
657 1.5 chopps line = iptr[y];
658 1.5 chopps *tptr++ = line << shiftx;
659 1.5 chopps
660 1.5 chopps /* mask */
661 1.5 chopps line = mptr[y];
662 1.5 chopps *tptr++ = line << shiftx;
663 1.5 chopps }
664 1.5 chopps
665 1.5 chopps /* clear the remainder */
666 1.5 chopps for (y = shifty; y > 0; y--) {
667 1.5 chopps *tptr++ = 0;
668 1.5 chopps *tptr++ = 0;
669 1.5 chopps }
670 1.5 chopps }
671 1.5 chopps
672 1.5 chopps int
673 1.5 chopps cl_setmousepos(gp, data)
674 1.5 chopps struct grf_softc *gp;
675 1.5 chopps struct grf_position *data;
676 1.5 chopps {
677 1.5 chopps volatile char *ba = gp->g_regkva;
678 1.5 chopps volatile char *fb = gp->g_fbkva;
679 1.5 chopps volatile char *sprite = fb + (cl_fbsize - 1024);
680 1.5 chopps short rx, ry, prx, pry;
681 1.5 chopps
682 1.5 chopps /* no movement */
683 1.5 chopps if (cl_cursprite.pos.x == data->x && cl_cursprite.pos.y == data->y)
684 1.5 chopps return (0);
685 1.5 chopps
686 1.5 chopps /* current and previous real coordinates */
687 1.5 chopps rx = data->x - cl_cursprite.hot.x;
688 1.5 chopps ry = data->y - cl_cursprite.hot.y;
689 1.5 chopps prx = cl_cursprite.pos.x - cl_cursprite.hot.x;
690 1.5 chopps pry = cl_cursprite.pos.y - cl_cursprite.hot.y;
691 1.5 chopps
692 1.5 chopps /* if we are/were on an edge, create (un)shifted bitmap --
693 1.5 chopps * ripped out optimization (not extremely worthwhile,
694 1.5 chopps * and kind of buggy anyhow).
695 1.5 chopps */
696 1.5 chopps #ifdef CL_SHIFTSPRITE
697 1.5 chopps if (rx < 0 || ry < 0 || prx < 0 || pry < 0) {
698 1.5 chopps writeshifted(sprite, rx < 0 ? -rx : 0, ry < 0 ? -ry : 0);
699 1.5 chopps }
700 1.5 chopps #endif
701 1.5 chopps
702 1.5 chopps /* do movement, save position */
703 1.5 chopps cl_writesprpos(ba, rx < 0 ? 0 : rx, ry < 0 ? 0 : ry);
704 1.5 chopps cl_cursprite.pos.x = data->x;
705 1.5 chopps cl_cursprite.pos.y = data->y;
706 1.5 chopps
707 1.5 chopps return (0);
708 1.5 chopps }
709 1.5 chopps
710 1.5 chopps int
711 1.5 chopps cl_getspriteinfo(gp, data)
712 1.5 chopps struct grf_softc *gp;
713 1.5 chopps struct grf_spriteinfo *data;
714 1.5 chopps {
715 1.5 chopps copyout(&cl_cursprite, data, sizeof(struct grf_spriteinfo));
716 1.5 chopps copyout(cl_cursprite.image, data->image, 64 * 8);
717 1.5 chopps copyout(cl_cursprite.mask, data->mask, 64 * 8);
718 1.5 chopps return (0);
719 1.5 chopps }
720 1.5 chopps
721 1.5 chopps static
722 1.5 chopps int
723 1.5 chopps cl_setspriteinfo(gp, data)
724 1.5 chopps struct grf_softc *gp;
725 1.5 chopps struct grf_spriteinfo *data;
726 1.5 chopps {
727 1.5 chopps volatile unsigned char *ba = gp->g_regkva, *fb = gp->g_fbkva;
728 1.5 chopps volatile char *sprite = fb + (cl_fbsize - 1024);
729 1.5 chopps
730 1.5 chopps if (data->set & GRFSPRSET_SHAPE) {
731 1.5 chopps
732 1.5 chopps short dsx, dsy, i;
733 1.5 chopps unsigned long *di, *dm, *si, *sm;
734 1.5 chopps unsigned long ssi[128], ssm[128];
735 1.5 chopps struct grf_position gpos;
736 1.5 chopps
737 1.5 chopps
738 1.5 chopps /* check for a too large sprite (no clipping!) */
739 1.5 chopps dsy = data->size.y;
740 1.5 chopps dsx = data->size.x;
741 1.5 chopps if (dsy > 64 || dsx > 64)
742 1.5 chopps return(EINVAL);
743 1.5 chopps
744 1.5 chopps /* prepare destination */
745 1.5 chopps di = (unsigned long *)cl_cursprite.image;
746 1.5 chopps dm = (unsigned long *)cl_cursprite.mask;
747 1.5 chopps cl_memset((unsigned char *)di, 0, 8*64);
748 1.5 chopps cl_memset((unsigned char *)dm, 0, 8*64);
749 1.5 chopps
750 1.5 chopps /* two alternatives: 64 across, then it's
751 1.5 chopps * the same format we use, just copy. Otherwise,
752 1.5 chopps * copy into tmp buf and recopy skipping the
753 1.5 chopps * unused 32 bits.
754 1.5 chopps */
755 1.5 chopps if ((dsx - 1) / 32) {
756 1.5 chopps copyin(data->image, di, 8 * dsy);
757 1.5 chopps copyin(data->mask, dm, 8 * dsy);
758 1.5 chopps } else {
759 1.5 chopps si = ssi; sm = ssm;
760 1.5 chopps copyin(data->image, si, 4 * dsy);
761 1.5 chopps copyin(data->mask, sm, 4 * dsy);
762 1.5 chopps for (i = 0; i < dsy; i++) {
763 1.5 chopps *di = *si++;
764 1.5 chopps *dm = *sm++;
765 1.5 chopps di += 2;
766 1.5 chopps dm += 2;
767 1.5 chopps }
768 1.5 chopps }
769 1.5 chopps
770 1.5 chopps /* set size */
771 1.5 chopps cl_cursprite.size.x = data->size.x;
772 1.5 chopps cl_cursprite.size.y = data->size.y;
773 1.5 chopps
774 1.5 chopps /* forcably load into board */
775 1.5 chopps gpos.x = cl_cursprite.pos.x;
776 1.5 chopps gpos.y = cl_cursprite.pos.y;
777 1.5 chopps cl_cursprite.pos.x = -1;
778 1.5 chopps cl_cursprite.pos.y = -1;
779 1.5 chopps writeshifted(sprite, 0, 0);
780 1.5 chopps cl_setmousepos(gp, &gpos);
781 1.5 chopps
782 1.5 chopps }
783 1.5 chopps if (data->set & GRFSPRSET_HOT) {
784 1.5 chopps
785 1.5 chopps cl_cursprite.hot = data->hot;
786 1.5 chopps
787 1.5 chopps }
788 1.5 chopps if (data->set & GRFSPRSET_CMAP) {
789 1.5 chopps
790 1.5 chopps u_char red[2], green[2], blue[2];
791 1.5 chopps
792 1.5 chopps copyin(data->cmap.red, red, 2);
793 1.5 chopps copyin(data->cmap.green, green, 2);
794 1.5 chopps copyin(data->cmap.blue, blue, 2);
795 1.5 chopps bcopy(red, cl_cursprite.cmap.red, 2);
796 1.5 chopps bcopy(green, cl_cursprite.cmap.green, 2);
797 1.5 chopps bcopy(blue, cl_cursprite.cmap.blue, 2);
798 1.5 chopps
799 1.5 chopps /* enable and load colors 256 & 257 */
800 1.5 chopps WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x06);
801 1.5 chopps
802 1.5 chopps /* 256 */
803 1.5 chopps vgaw(ba, VDAC_ADDRESS_W, 0x00);
804 1.5 chopps if (cltype == PICASSO) {
805 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (red[0] >> 2));
806 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (green[0] >> 2));
807 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (blue[0] >> 2));
808 1.5 chopps } else {
809 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (blue[0] >> 2));
810 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (green[0] >> 2));
811 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (red[0] >> 2));
812 1.5 chopps }
813 1.5 chopps
814 1.5 chopps /* 257 */
815 1.5 chopps vgaw(ba, VDAC_ADDRESS_W, 0x0f);
816 1.5 chopps if (cltype == PICASSO) {
817 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (red[1] >> 2));
818 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (green[1] >> 2));
819 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (blue[1] >> 2));
820 1.5 chopps } else {
821 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (blue[1] >> 2));
822 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (green[1] >> 2));
823 1.5 chopps vgaw(ba, VDAC_DATA, (u_char) (red[1] >> 2));
824 1.5 chopps }
825 1.5 chopps
826 1.5 chopps /* turn on/off sprite */
827 1.5 chopps if (cl_cursprite.enable) {
828 1.5 chopps WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x05);
829 1.5 chopps } else {
830 1.5 chopps WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x04);
831 1.5 chopps }
832 1.5 chopps
833 1.5 chopps }
834 1.5 chopps if (data->set & GRFSPRSET_ENABLE) {
835 1.5 chopps
836 1.5 chopps if (data->enable == 1) {
837 1.5 chopps WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x05);
838 1.5 chopps cl_cursprite.enable = 1;
839 1.5 chopps } else {
840 1.5 chopps WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x04);
841 1.5 chopps cl_cursprite.enable = 0;
842 1.5 chopps }
843 1.5 chopps
844 1.5 chopps }
845 1.5 chopps if (data->set & GRFSPRSET_POS) {
846 1.5 chopps
847 1.5 chopps /* force placement */
848 1.5 chopps cl_cursprite.pos.x = -1;
849 1.5 chopps cl_cursprite.pos.y = -1;
850 1.1 chopps
851 1.5 chopps /* do it */
852 1.5 chopps cl_setmousepos(gp, &data->pos);
853 1.5 chopps
854 1.1 chopps }
855 1.5 chopps return (0);
856 1.5 chopps }
857 1.5 chopps
858 1.5 chopps static
859 1.5 chopps int
860 1.5 chopps cl_getspritemax(gp, data)
861 1.5 chopps struct grf_softc *gp;
862 1.5 chopps struct grf_position *data;
863 1.5 chopps {
864 1.5 chopps if (gp->g_display.gd_planes == 24)
865 1.5 chopps return (EINVAL);
866 1.5 chopps data->x = 64;
867 1.5 chopps data->y = 64;
868 1.5 chopps return (0);
869 1.1 chopps }
870 1.1 chopps
871 1.1 chopps int
872 1.1 chopps cl_setmonitor(gp, gv)
873 1.1 chopps struct grf_softc *gp;
874 1.1 chopps struct grfvideo_mode *gv;
875 1.1 chopps {
876 1.5 chopps struct grfvideo_mode *md;
877 1.5 chopps
878 1.5 chopps if (!cl_mondefok(gv))
879 1.5 chopps return(EINVAL);
880 1.1 chopps
881 1.1 chopps #ifdef CL5426CONSOLE
882 1.1 chopps /* handle interactive setting of console mode */
883 1.5 chopps if (gv->mode_num == 255) {
884 1.1 chopps bcopy(gv, &clconsole_mode.gv, sizeof(struct grfvideo_mode));
885 1.5 chopps clconsole_mode.gv.hblank_start /= 8;
886 1.5 chopps clconsole_mode.gv.hblank_stop /= 8;
887 1.5 chopps clconsole_mode.gv.hsync_start /= 8;
888 1.5 chopps clconsole_mode.gv.hsync_stop /= 8;
889 1.5 chopps clconsole_mode.gv.htotal /= 8;
890 1.1 chopps clconsole_mode.rows = gv->disp_height / clconsole_mode.fy;
891 1.1 chopps clconsole_mode.cols = gv->disp_width / clconsole_mode.fx;
892 1.1 chopps if (!(gp->g_flags & GF_GRFON))
893 1.5 chopps cl_load_mon(gp, &clconsole_mode);
894 1.1 chopps ite_reinit(gp->g_itedev);
895 1.5 chopps return (0);
896 1.1 chopps }
897 1.1 chopps #endif
898 1.1 chopps
899 1.5 chopps md = monitor_def + (gv->mode_num - 1);
900 1.5 chopps bcopy(gv, md, sizeof(struct grfvideo_mode));
901 1.5 chopps
902 1.5 chopps /* adjust pixel oriented values to internal rep. */
903 1.1 chopps
904 1.5 chopps md->hblank_start /= 8;
905 1.5 chopps md->hblank_stop /= 8;
906 1.5 chopps md->hsync_start /= 8;
907 1.5 chopps md->hsync_stop /= 8;
908 1.5 chopps md->htotal /= 8;
909 1.1 chopps
910 1.5 chopps return (0);
911 1.1 chopps }
912 1.1 chopps
913 1.1 chopps int
914 1.5 chopps cl_getcmap(gfp, cmap)
915 1.1 chopps struct grf_softc *gfp;
916 1.1 chopps struct grf_colormap *cmap;
917 1.1 chopps {
918 1.1 chopps volatile unsigned char *ba;
919 1.5 chopps u_char red[256], green[256], blue[256], *rp, *gp, *bp;
920 1.5 chopps short x;
921 1.5 chopps int error;
922 1.1 chopps
923 1.1 chopps if (cmap->count == 0 || cmap->index >= 256)
924 1.1 chopps return 0;
925 1.1 chopps
926 1.1 chopps if (cmap->index + cmap->count > 256)
927 1.1 chopps cmap->count = 256 - cmap->index;
928 1.1 chopps
929 1.1 chopps ba = gfp->g_regkva;
930 1.1 chopps /* first read colors out of the chip, then copyout to userspace */
931 1.6 is vgaw(ba, VDAC_ADDRESS_R, cmap->index);
932 1.1 chopps x = cmap->count - 1;
933 1.1 chopps
934 1.1 chopps /* Some sort 'o Magic. Spectrum has some changes on the board to speed
935 1.1 chopps * up 15 and 16Bit modes. They can access these modes with easy-to-programm
936 1.1 chopps * rgbrgbrgb instead of rrrgggbbb. Side effect: when in 8Bit mode, rgb
937 1.1 chopps * is swapped to bgr. I wonder if we need to check for 8Bit though, ill
938 1.1 chopps */
939 1.1 chopps
940 1.5 chopps switch (cltype) {
941 1.5 chopps case SPECTRUM:
942 1.1 chopps case PICCOLO:
943 1.5 chopps rp = blue + cmap->index;
944 1.1 chopps gp = green + cmap->index;
945 1.1 chopps bp = red + cmap->index;
946 1.1 chopps break;
947 1.1 chopps case PICASSO:
948 1.5 chopps rp = red + cmap->index;
949 1.1 chopps gp = green + cmap->index;
950 1.1 chopps bp = blue + cmap->index;
951 1.1 chopps break;
952 1.1 chopps }
953 1.1 chopps
954 1.1 chopps do {
955 1.5 chopps *rp++ = vgar(ba, VDAC_DATA) << 2;
956 1.5 chopps *gp++ = vgar(ba, VDAC_DATA) << 2;
957 1.5 chopps *bp++ = vgar(ba, VDAC_DATA) << 2;
958 1.1 chopps } while (x-- > 0);
959 1.1 chopps
960 1.5 chopps if (!(error = copyout(red + cmap->index, cmap->red, cmap->count))
961 1.5 chopps && !(error = copyout(green + cmap->index, cmap->green, cmap->count))
962 1.5 chopps && !(error = copyout(blue + cmap->index, cmap->blue, cmap->count)))
963 1.5 chopps return (0);
964 1.1 chopps
965 1.5 chopps return (error);
966 1.1 chopps }
967 1.1 chopps
968 1.1 chopps int
969 1.5 chopps cl_putcmap(gfp, cmap)
970 1.1 chopps struct grf_softc *gfp;
971 1.1 chopps struct grf_colormap *cmap;
972 1.1 chopps {
973 1.1 chopps volatile unsigned char *ba;
974 1.5 chopps u_char red[256], green[256], blue[256], *rp, *gp, *bp;
975 1.5 chopps short x;
976 1.5 chopps int error;
977 1.1 chopps
978 1.1 chopps if (cmap->count == 0 || cmap->index >= 256)
979 1.5 chopps return (0);
980 1.1 chopps
981 1.1 chopps if (cmap->index + cmap->count > 256)
982 1.1 chopps cmap->count = 256 - cmap->index;
983 1.1 chopps
984 1.1 chopps /* first copy the colors into kernelspace */
985 1.5 chopps if (!(error = copyin(cmap->red, red + cmap->index, cmap->count))
986 1.5 chopps && !(error = copyin(cmap->green, green + cmap->index, cmap->count))
987 1.5 chopps && !(error = copyin(cmap->blue, blue + cmap->index, cmap->count))) {
988 1.1 chopps ba = gfp->g_regkva;
989 1.5 chopps vgaw(ba, VDAC_ADDRESS_W, cmap->index);
990 1.1 chopps x = cmap->count - 1;
991 1.1 chopps
992 1.5 chopps switch (cltype) {
993 1.5 chopps case SPECTRUM:
994 1.1 chopps case PICCOLO:
995 1.1 chopps rp = blue + cmap->index;
996 1.1 chopps gp = green + cmap->index;
997 1.1 chopps bp = red + cmap->index;
998 1.1 chopps break;
999 1.1 chopps case PICASSO:
1000 1.1 chopps rp = red + cmap->index;
1001 1.1 chopps gp = green + cmap->index;
1002 1.1 chopps bp = blue + cmap->index;
1003 1.1 chopps break;
1004 1.5 chopps }
1005 1.1 chopps
1006 1.1 chopps do {
1007 1.5 chopps vgaw(ba, VDAC_DATA, *rp++ >> 2);
1008 1.5 chopps vgaw(ba, VDAC_DATA, *gp++ >> 2);
1009 1.5 chopps vgaw(ba, VDAC_DATA, *bp++ >> 2);
1010 1.1 chopps } while (x-- > 0);
1011 1.5 chopps return (0);
1012 1.5 chopps } else
1013 1.5 chopps return (error);
1014 1.1 chopps }
1015 1.1 chopps
1016 1.1 chopps
1017 1.1 chopps int
1018 1.5 chopps cl_toggle(gp, wopp)
1019 1.1 chopps struct grf_softc *gp;
1020 1.5 chopps unsigned short wopp; /* don't need that one yet, ill */
1021 1.1 chopps {
1022 1.1 chopps volatile unsigned char *ba;
1023 1.1 chopps
1024 1.1 chopps ba = gp->g_regkva;
1025 1.1 chopps
1026 1.1 chopps if (pass_toggle) {
1027 1.1 chopps RegOffpass(ba);
1028 1.1 chopps } else {
1029 1.1 chopps /* This was in the original.. is it needed? */
1030 1.1 chopps if (cltype == PICASSO || cltype == PICCOLO)
1031 1.1 chopps RegWakeup(ba);
1032 1.1 chopps RegOnpass(ba);
1033 1.1 chopps }
1034 1.5 chopps return (0);
1035 1.1 chopps }
1036 1.1 chopps
1037 1.1 chopps static void
1038 1.5 chopps CompFQ(fq, num, denom)
1039 1.5 chopps u_int fq;
1040 1.5 chopps u_char *num;
1041 1.5 chopps u_char *denom;
1042 1.1 chopps {
1043 1.1 chopps #define OSC 14318180
1044 1.1 chopps /* OK, here's what we're doing here:
1045 1.5 chopps *
1046 1.1 chopps * OSC * NUMERATOR
1047 1.1 chopps * VCLK = ------------------- Hz
1048 1.1 chopps * DENOMINATOR * (1+P)
1049 1.1 chopps *
1050 1.1 chopps * so we're given VCLK and we should give out some useful
1051 1.1 chopps * values....
1052 1.1 chopps *
1053 1.5 chopps * NUMERATOR is 7 bits wide
1054 1.1 chopps * DENOMINATOR is 5 bits wide with bit P in the same char as bit 0.
1055 1.1 chopps *
1056 1.1 chopps * We run through all the possible combinations and
1057 1.1 chopps * return the values which deviate the least from the chosen frequency.
1058 1.5 chopps *
1059 1.1 chopps */
1060 1.1 chopps #define OSC 14318180
1061 1.1 chopps #define count(n,d,p) ((OSC * n)/(d * (1+p)))
1062 1.1 chopps
1063 1.1 chopps unsigned char n, d, p, minn, mind, minp;
1064 1.1 chopps unsigned long err, minerr;
1065 1.1 chopps
1066 1.1 chopps /*
1067 1.5 chopps numer = 0x00 - 0x7f
1068 1.1 chopps denom = 0x00 - 0x1f (1) 0x20 - 0x3e (even)
1069 1.1 chopps */
1070 1.1 chopps
1071 1.5 chopps /* find lowest error in 6144 iterations. */
1072 1.1 chopps minerr = fq;
1073 1.1 chopps minn = 0;
1074 1.1 chopps mind = 0;
1075 1.1 chopps p = 0;
1076 1.1 chopps
1077 1.5 chopps for (d = 1; d < 0x20; d++) {
1078 1.5 chopps for (n = 1; n < 0x80; n++) {
1079 1.1 chopps err = abs(count(n, d, p) - fq);
1080 1.1 chopps if (err < minerr) {
1081 1.1 chopps minerr = err;
1082 1.1 chopps minn = n;
1083 1.1 chopps mind = d;
1084 1.1 chopps minp = p;
1085 1.1 chopps }
1086 1.1 chopps }
1087 1.1 chopps if (d == 0x1f && p == 0) {
1088 1.1 chopps p = 1;
1089 1.1 chopps d = 0x0f;
1090 1.1 chopps }
1091 1.1 chopps }
1092 1.1 chopps
1093 1.1 chopps *num = minn;
1094 1.1 chopps *denom = (mind << 1) | minp;
1095 1.1 chopps if (minerr > 500000)
1096 1.5 chopps printf("Warning: CompFQ minimum error = %d\n", minerr);
1097 1.1 chopps return;
1098 1.1 chopps }
1099 1.1 chopps
1100 1.1 chopps int
1101 1.5 chopps cl_mondefok(gv)
1102 1.5 chopps struct grfvideo_mode *gv;
1103 1.1 chopps {
1104 1.5 chopps unsigned long maxpix;
1105 1.5 chopps
1106 1.5 chopps if (gv->mode_num < 1 || gv->mode_num > monitor_def_max)
1107 1.5 chopps if (gv->mode_num != 255 || gv->depth != 4)
1108 1.5 chopps return(0);
1109 1.1 chopps
1110 1.5 chopps switch (gv->depth) {
1111 1.5 chopps case 4:
1112 1.5 chopps if (gv->mode_num != 255)
1113 1.5 chopps return(0);
1114 1.1 chopps case 1:
1115 1.1 chopps case 8:
1116 1.5 chopps maxpix = cl_maxpixelclock;
1117 1.5 chopps break;
1118 1.1 chopps case 15:
1119 1.1 chopps case 16:
1120 1.5 chopps maxpix = cl_maxpixelclock - (cl_maxpixelclock / 3);
1121 1.5 chopps break;
1122 1.1 chopps case 24:
1123 1.5 chopps maxpix = cl_maxpixelclock / 3;
1124 1.5 chopps break;
1125 1.1 chopps default:
1126 1.5 chopps return (0);
1127 1.1 chopps }
1128 1.5 chopps if (gv->pixel_clock > maxpix)
1129 1.5 chopps return (0);
1130 1.5 chopps return (1);
1131 1.1 chopps }
1132 1.1 chopps
1133 1.1 chopps int
1134 1.1 chopps cl_load_mon(gp, md)
1135 1.1 chopps struct grf_softc *gp;
1136 1.1 chopps struct grfcltext_mode *md;
1137 1.1 chopps {
1138 1.1 chopps struct grfvideo_mode *gv;
1139 1.1 chopps struct grfinfo *gi;
1140 1.1 chopps volatile unsigned char *ba;
1141 1.1 chopps volatile unsigned char *fb;
1142 1.5 chopps unsigned char num0, denom0;
1143 1.5 chopps unsigned short HT, HDE, HBS, HBE, HSS, HSE, VDE, VBS, VBE, VSS,
1144 1.5 chopps VSE, VT;
1145 1.5 chopps char LACE, DBLSCAN, TEXT;
1146 1.1 chopps unsigned short clkdiv, clksel;
1147 1.5 chopps int uplim, lowlim;
1148 1.1 chopps
1149 1.1 chopps /* identity */
1150 1.1 chopps gv = &md->gv;
1151 1.1 chopps TEXT = (gv->depth == 4);
1152 1.1 chopps
1153 1.1 chopps if (!cl_mondefok(gv)) {
1154 1.1 chopps printf("mondef not ok\n");
1155 1.5 chopps return (0);
1156 1.1 chopps }
1157 1.1 chopps ba = gp->g_regkva;
1158 1.1 chopps fb = gp->g_fbkva;
1159 1.1 chopps
1160 1.5 chopps /* provide all needed information in grf device-independant locations */
1161 1.5 chopps gp->g_data = (caddr_t) gv;
1162 1.1 chopps gi = &gp->g_display;
1163 1.5 chopps gi->gd_regaddr = (caddr_t) ztwopa(ba);
1164 1.5 chopps gi->gd_regsize = 64 * 1024;
1165 1.5 chopps gi->gd_fbaddr = (caddr_t) kvtop(fb);
1166 1.5 chopps gi->gd_fbsize = cl_fbsize;
1167 1.5 chopps gi->gd_colors = 1 << gv->depth;
1168 1.5 chopps gi->gd_planes = gv->depth;
1169 1.5 chopps gi->gd_fbwidth = gv->disp_width;
1170 1.5 chopps gi->gd_fbheight = gv->disp_height;
1171 1.5 chopps gi->gd_fbx = 0;
1172 1.5 chopps gi->gd_fby = 0;
1173 1.1 chopps if (TEXT) {
1174 1.5 chopps gi->gd_dwidth = md->fx * md->cols;
1175 1.5 chopps gi->gd_dheight = md->fy * md->rows;
1176 1.1 chopps } else {
1177 1.5 chopps gi->gd_dwidth = gv->disp_width;
1178 1.5 chopps gi->gd_dheight = gv->disp_height;
1179 1.1 chopps }
1180 1.5 chopps gi->gd_dx = 0;
1181 1.5 chopps gi->gd_dy = 0;
1182 1.1 chopps
1183 1.1 chopps /* get display mode parameters */
1184 1.1 chopps
1185 1.1 chopps HBS = gv->hblank_start;
1186 1.1 chopps HBE = gv->hblank_stop;
1187 1.1 chopps HSS = gv->hsync_start;
1188 1.1 chopps HSE = gv->hsync_stop;
1189 1.5 chopps HT = gv->htotal;
1190 1.1 chopps VBS = gv->vblank_start;
1191 1.1 chopps VSS = gv->vsync_start;
1192 1.1 chopps VSE = gv->vsync_stop;
1193 1.1 chopps VBE = gv->vblank_stop;
1194 1.5 chopps VT = gv->vtotal;
1195 1.1 chopps
1196 1.5 chopps if (TEXT)
1197 1.5 chopps HDE = ((gv->disp_width + md->fx - 1) / md->fx) - 1;
1198 1.1 chopps else
1199 1.5 chopps HDE = (gv->disp_width + 3) / 8 - 1; /* HBS; */
1200 1.5 chopps VDE = gv->disp_height - 1;
1201 1.1 chopps
1202 1.1 chopps /* figure out whether lace or dblscan is needed */
1203 1.1 chopps
1204 1.1 chopps uplim = gv->disp_height + (gv->disp_height / 4);
1205 1.5 chopps lowlim = gv->disp_height - (gv->disp_height / 4);
1206 1.5 chopps LACE = (((VT * 2) > lowlim) && ((VT * 2) < uplim)) ? 1 : 0;
1207 1.5 chopps DBLSCAN = (((VT / 2) > lowlim) && ((VT / 2) < uplim)) ? 1 : 0;
1208 1.1 chopps
1209 1.1 chopps /* adjustments */
1210 1.1 chopps
1211 1.1 chopps if (LACE)
1212 1.1 chopps VDE /= 2;
1213 1.1 chopps
1214 1.1 chopps WSeq(ba, SEQ_ID_MEMORY_MODE, (TEXT || (gv->depth == 1)) ? 0x06 : 0x0e);
1215 1.5 chopps WSeq(ba, SEQ_ID_DRAM_CNTL, (TEXT || (gv->depth == 1)) ? 0x90 : 0xb0);
1216 1.5 chopps WGfx(ba, GCT_ID_READ_MAP_SELECT, 0x00);
1217 1.1 chopps WSeq(ba, SEQ_ID_MAP_MASK, (gv->depth == 1) ? 0x01 : 0xff);
1218 1.5 chopps WSeq(ba, SEQ_ID_CHAR_MAP_SELECT, 0x00);
1219 1.1 chopps
1220 1.1 chopps /* Set clock */
1221 1.1 chopps
1222 1.5 chopps CompFQ((gv->depth == 24) ? gv->pixel_clock * 3 : gv->pixel_clock,
1223 1.1 chopps &num0, &denom0);
1224 1.1 chopps WSeq(ba, SEQ_ID_VCLK_0_NUM, num0);
1225 1.1 chopps WSeq(ba, SEQ_ID_VCLK_0_DENOM, denom0);
1226 1.1 chopps
1227 1.1 chopps /* load display parameters into board */
1228 1.1 chopps
1229 1.1 chopps WCrt(ba, CRT_ID_HOR_TOTAL, HT);
1230 1.5 chopps WCrt(ba, CRT_ID_HOR_DISP_ENA_END, ((HDE >= HBS) ? HBS - 1 : HDE));
1231 1.1 chopps WCrt(ba, CRT_ID_START_HOR_BLANK, HBS);
1232 1.5 chopps WCrt(ba, CRT_ID_END_HOR_BLANK, (HBE & 0x1f) | 0x80); /* | 0x80? */
1233 1.1 chopps WCrt(ba, CRT_ID_START_HOR_RETR, HSS);
1234 1.1 chopps WCrt(ba, CRT_ID_END_HOR_RETR,
1235 1.5 chopps (HSE & 0x1f) |
1236 1.5 chopps ((HBE & 0x20) ? 0x80 : 0x00));
1237 1.1 chopps WCrt(ba, CRT_ID_VER_TOTAL, VT);
1238 1.1 chopps WCrt(ba, CRT_ID_OVERFLOW,
1239 1.1 chopps 0x10 |
1240 1.5 chopps ((VT & 0x100) ? 0x01 : 0x00) |
1241 1.1 chopps ((VDE & 0x100) ? 0x02 : 0x00) |
1242 1.1 chopps ((VSS & 0x100) ? 0x04 : 0x00) |
1243 1.1 chopps ((VBS & 0x100) ? 0x08 : 0x00) |
1244 1.5 chopps ((VT & 0x200) ? 0x20 : 0x00) |
1245 1.1 chopps ((VDE & 0x200) ? 0x40 : 0x00) |
1246 1.5 chopps ((VSS & 0x200) ? 0x80 : 0x00));
1247 1.1 chopps
1248 1.1 chopps
1249 1.1 chopps WCrt(ba, CRT_ID_CHAR_HEIGHT,
1250 1.5 chopps 0x40 | /* TEXT ? 0x00 ??? */
1251 1.1 chopps (DBLSCAN ? 0x80 : 0x00) |
1252 1.1 chopps ((VBS & 0x200) ? 0x20 : 0x00) |
1253 1.5 chopps (TEXT ? ((md->fy - 1) & 0x1f) : 0x00));
1254 1.5 chopps WCrt(ba, CRT_ID_MODE_CONTROL,
1255 1.1 chopps ((TEXT || (gv->depth == 1)) ? 0xc3 : 0xa3));
1256 1.1 chopps
1257 1.1 chopps /* text cursor */
1258 1.1 chopps
1259 1.1 chopps if (TEXT) {
1260 1.5 chopps #if CL_ULCURSOR
1261 1.1 chopps WCrt(ba, CRT_ID_CURSOR_START, (md->fy & 0x1f) - 2);
1262 1.1 chopps WCrt(ba, CRT_ID_CURSOR_END, (md->fy & 0x1f) - 1);
1263 1.1 chopps #else
1264 1.1 chopps WCrt(ba, CRT_ID_CURSOR_START, 0x00);
1265 1.1 chopps WCrt(ba, CRT_ID_CURSOR_END, md->fy & 0x1f);
1266 1.1 chopps #endif
1267 1.5 chopps WCrt(ba, CRT_ID_UNDERLINE_LOC, md->fy - 1 & 0x1f);
1268 1.1 chopps
1269 1.1 chopps WCrt(ba, CRT_ID_CURSOR_LOC_HIGH, 0x00);
1270 1.5 chopps WCrt(ba, CRT_ID_CURSOR_LOC_LOW, 0x00);
1271 1.1 chopps }
1272 1.1 chopps WCrt(ba, CRT_ID_START_ADDR_HIGH, 0x00);
1273 1.1 chopps WCrt(ba, CRT_ID_START_ADDR_LOW, 0x00);
1274 1.1 chopps
1275 1.1 chopps WCrt(ba, CRT_ID_START_VER_RETR, VSS);
1276 1.1 chopps WCrt(ba, CRT_ID_END_VER_RETR, (VSE & 0x0f) | 0x30);
1277 1.1 chopps WCrt(ba, CRT_ID_VER_DISP_ENA_END, VDE);
1278 1.1 chopps WCrt(ba, CRT_ID_START_VER_BLANK, VBS);
1279 1.1 chopps WCrt(ba, CRT_ID_END_VER_BLANK, VBE);
1280 1.1 chopps
1281 1.1 chopps WCrt(ba, CRT_ID_LINE_COMPARE, 0xff);
1282 1.5 chopps WCrt(ba, CRT_ID_LACE_END, HT / 2); /* MW/16 */
1283 1.1 chopps WCrt(ba, CRT_ID_LACE_CNTL,
1284 1.1 chopps (LACE ? 0x01 : 0x00) |
1285 1.1 chopps ((HBE & 0x40) ? 0x10 : 0x00) |
1286 1.1 chopps ((HBE & 0x80) ? 0x20 : 0x00) |
1287 1.1 chopps ((VBE & 0x100) ? 0x40 : 0x00) |
1288 1.5 chopps ((VBE & 0x200) ? 0x80 : 0x00));
1289 1.1 chopps
1290 1.1 chopps /* depth dependent stuff */
1291 1.1 chopps
1292 1.1 chopps switch (gv->depth) {
1293 1.1 chopps case 1:
1294 1.1 chopps case 4:
1295 1.1 chopps case 8:
1296 1.5 chopps clkdiv = 0;
1297 1.5 chopps break;
1298 1.1 chopps case 15:
1299 1.1 chopps case 16:
1300 1.5 chopps clkdiv = 3;
1301 1.5 chopps break;
1302 1.1 chopps case 24:
1303 1.5 chopps clkdiv = 2;
1304 1.5 chopps break;
1305 1.1 chopps }
1306 1.5 chopps
1307 1.5 chopps WGfx(ba, GCT_ID_GRAPHICS_MODE,
1308 1.1 chopps ((TEXT || (gv->depth == 1)) ? 0x00 : 0x40));
1309 1.1 chopps WGfx(ba, GCT_ID_MISC, (TEXT ? 0x04 : 0x01));
1310 1.1 chopps
1311 1.5 chopps WSeq(ba, SEQ_ID_EXT_SEQ_MODE,
1312 1.5 chopps ((TEXT || (gv->depth == 1)) ? 0x00 : 0x01) |
1313 1.5 chopps ((cltype == PICASSO) ? 0x20 : 0x80) |
1314 1.5 chopps (clkdiv << 1));
1315 1.1 chopps
1316 1.5 chopps delay(200000);
1317 1.6 is
1318 1.6 is /* write 0x00 to VDAC_MASK before accessing HDR this helps
1319 1.6 is sometimes, out of "secret" application note (crest) */
1320 1.6 is vgaw(ba, VDAC_MASK, 0);
1321 1.6 is delay(200000);
1322 1.6 is /* reset HDR "magic" access counter (crest) */
1323 1.6 is vgar(ba, VDAC_ADDRESS);
1324 1.6 is
1325 1.1 chopps delay(200000);
1326 1.1 chopps vgar(ba, VDAC_MASK);
1327 1.1 chopps delay(200000);
1328 1.1 chopps vgar(ba, VDAC_MASK);
1329 1.1 chopps delay(200000);
1330 1.1 chopps vgar(ba, VDAC_MASK);
1331 1.1 chopps delay(200000);
1332 1.1 chopps vgar(ba, VDAC_MASK);
1333 1.1 chopps delay(200000);
1334 1.1 chopps switch (gv->depth) {
1335 1.1 chopps case 1:
1336 1.5 chopps case 4: /* text */
1337 1.1 chopps vgaw(ba, VDAC_MASK, 0);
1338 1.1 chopps HDE = gv->disp_width / 16;
1339 1.1 chopps break;
1340 1.1 chopps case 8:
1341 1.1 chopps vgaw(ba, VDAC_MASK, 0);
1342 1.1 chopps HDE = gv->disp_width / 8;
1343 1.1 chopps break;
1344 1.1 chopps case 15:
1345 1.1 chopps vgaw(ba, VDAC_MASK, 0xd0);
1346 1.1 chopps HDE = gv->disp_width / 4;
1347 1.1 chopps break;
1348 1.1 chopps case 16:
1349 1.5 chopps vgaw(ba, VDAC_MASK, 0xc1);
1350 1.1 chopps HDE = gv->disp_width / 4;
1351 1.1 chopps break;
1352 1.1 chopps case 24:
1353 1.5 chopps vgaw(ba, VDAC_MASK, 0xc5);
1354 1.1 chopps HDE = (gv->disp_width / 8) * 3;
1355 1.1 chopps break;
1356 1.1 chopps }
1357 1.6 is delay(20000);
1358 1.6 is
1359 1.6 is /* reset HDR "magic" access counter (crest) */
1360 1.6 is vgar(ba, VDAC_ADDRESS);
1361 1.1 chopps delay(200000);
1362 1.6 is /* then enable all bit in VDAC_MASK afterwards (crest) */
1363 1.6 is vgaw(ba, VDAC_MASK, 0xff);
1364 1.6 is delay(20000);
1365 1.1 chopps
1366 1.5 chopps WCrt(ba, CRT_ID_OFFSET, HDE);
1367 1.5 chopps WCrt(ba, CRT_ID_EXT_DISP_CNTL,
1368 1.1 chopps ((TEXT && gv->pixel_clock > 29000000) ? 0x40 : 0x00) |
1369 1.5 chopps 0x22 |
1370 1.5 chopps ((HDE > 0xff) ? 0x10 : 0x00)); /* text? */
1371 1.1 chopps
1372 1.1 chopps delay(200000);
1373 1.1 chopps WAttr(ba, ACT_ID_ATTR_MODE_CNTL, (TEXT ? 0x0a : 0x01));
1374 1.1 chopps delay(200000);
1375 1.5 chopps WAttr(ba, 0x20 | ACT_ID_COLOR_PLANE_ENA,
1376 1.1 chopps (gv->depth == 1) ? 0x01 : 0x0f);
1377 1.1 chopps delay(200000);
1378 1.1 chopps
1379 1.1 chopps /* text initialization */
1380 1.1 chopps
1381 1.1 chopps if (TEXT) {
1382 1.1 chopps cl_inittextmode(gp);
1383 1.1 chopps }
1384 1.1 chopps WSeq(ba, SEQ_ID_CURSOR_ATTR, 0x14);
1385 1.1 chopps WSeq(ba, SEQ_ID_CLOCKING_MODE, 0x01);
1386 1.1 chopps
1387 1.1 chopps /* Pass-through */
1388 1.1 chopps
1389 1.1 chopps RegOffpass(ba);
1390 1.1 chopps
1391 1.5 chopps return (1);
1392 1.1 chopps }
1393 1.1 chopps
1394 1.1 chopps void
1395 1.1 chopps cl_inittextmode(gp)
1396 1.1 chopps struct grf_softc *gp;
1397 1.1 chopps {
1398 1.5 chopps struct grfcltext_mode *tm = (struct grfcltext_mode *) gp->g_data;
1399 1.1 chopps volatile unsigned char *ba = gp->g_regkva;
1400 1.1 chopps unsigned char *fb = gp->g_fbkva;
1401 1.1 chopps unsigned char *c, *f, y;
1402 1.1 chopps unsigned short z;
1403 1.1 chopps
1404 1.1 chopps
1405 1.5 chopps /* load text font into beginning of display memory. Each character
1406 1.5 chopps * cell is 32 bytes long (enough for 4 planes) */
1407 1.1 chopps
1408 1.1 chopps SetTextPlane(ba, 0x02);
1409 1.5 chopps cl_memset(fb, 0, 256 * 32);
1410 1.5 chopps c = (unsigned char *) (fb) + (32 * tm->fdstart);
1411 1.1 chopps f = tm->fdata;
1412 1.5 chopps for (z = tm->fdstart; z <= tm->fdend; z++, c += (32 - tm->fy))
1413 1.5 chopps for (y = 0; y < tm->fy; y++)
1414 1.1 chopps *c++ = *f++;
1415 1.1 chopps
1416 1.1 chopps /* clear out text/attr planes (three screens worth) */
1417 1.1 chopps
1418 1.1 chopps SetTextPlane(ba, 0x01);
1419 1.5 chopps cl_memset(fb, 0x07, tm->cols * tm->rows * 3);
1420 1.1 chopps SetTextPlane(ba, 0x00);
1421 1.5 chopps cl_memset(fb, 0x20, tm->cols * tm->rows * 3);
1422 1.1 chopps
1423 1.1 chopps /* print out a little init msg */
1424 1.1 chopps
1425 1.5 chopps c = (unsigned char *) (fb) + (tm->cols - 16);
1426 1.1 chopps strcpy(c, "CIRRUS");
1427 1.1 chopps c[6] = 0x20;
1428 1.1 chopps
1429 1.1 chopps /* set colors (B&W) */
1430 1.1 chopps
1431 1.1 chopps
1432 1.1 chopps vgaw(ba, VDAC_ADDRESS_W, 0);
1433 1.5 chopps for (z = 0; z < 256; z++) {
1434 1.1 chopps unsigned char r, g, b;
1435 1.1 chopps
1436 1.1 chopps y = (z & 1) ? ((z > 7) ? 2 : 1) : 0;
1437 1.1 chopps
1438 1.1 chopps if (cltype == PICASSO) {
1439 1.1 chopps r = clconscolors[y][0];
1440 1.1 chopps g = clconscolors[y][1];
1441 1.1 chopps b = clconscolors[y][2];
1442 1.1 chopps } else {
1443 1.1 chopps b = clconscolors[y][0];
1444 1.1 chopps g = clconscolors[y][1];
1445 1.1 chopps r = clconscolors[y][2];
1446 1.1 chopps }
1447 1.1 chopps vgaw(ba, VDAC_DATA, r >> 2);
1448 1.1 chopps vgaw(ba, VDAC_DATA, g >> 2);
1449 1.1 chopps vgaw(ba, VDAC_DATA, b >> 2);
1450 1.1 chopps }
1451 1.1 chopps }
1452 1.1 chopps
1453 1.1 chopps void
1454 1.5 chopps cl_memset(d, c, l)
1455 1.1 chopps unsigned char *d;
1456 1.1 chopps unsigned char c;
1457 1.5 chopps int l;
1458 1.1 chopps {
1459 1.5 chopps for (; l > 0; l--)
1460 1.1 chopps *d++ = c;
1461 1.1 chopps }
1462 1.5 chopps #endif /* NGRFCL */
1463