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