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