1 /* $NetBSD: grf_cl.c,v 1.25 1999/06/29 19:51:28 is 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 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