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