1 /* $NetBSD: igsfb_subr.c,v 1.13 2017/01/25 17:31:55 jakllsch Exp $ */ 2 3 /* 4 * Copyright (c) 2002 Valeriy E. Ushakov 5 * 2009 Michael Lorenz 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. The name of the author may not be used to endorse or promote products 17 * derived from this software without specific prior written permission 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 22 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 28 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 29 */ 30 31 /* 32 * Integraphics Systems IGA 168x and CyberPro series. 33 */ 34 #include <sys/cdefs.h> 35 __KERNEL_RCSID(0, "$NetBSD: igsfb_subr.c,v 1.13 2017/01/25 17:31:55 jakllsch Exp $"); 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/kernel.h> 40 #include <sys/device.h> 41 42 #include <sys/bus.h> 43 44 #include <dev/wscons/wsdisplayvar.h> 45 #include <dev/wscons/wsconsio.h> 46 #include <dev/rasops/rasops.h> 47 #include <dev/wscons/wsdisplay_vconsvar.h> 48 49 #include <dev/ic/igsfbreg.h> 50 #include <dev/ic/igsfbvar.h> 51 52 #ifdef IGSFB_DEBUG 53 #define DPRINTF printf 54 #else 55 #define DPRINTF while (0) printf 56 #endif 57 58 static void igsfb_init_seq(struct igsfb_devconfig *); 59 static void igsfb_init_crtc(struct igsfb_devconfig *); 60 static void igsfb_init_grfx(struct igsfb_devconfig *); 61 static void igsfb_init_attr(struct igsfb_devconfig *); 62 static void igsfb_init_ext(struct igsfb_devconfig *); 63 static void igsfb_init_dac(struct igsfb_devconfig *); 64 65 static void igsfb_freq_latch(struct igsfb_devconfig *); 66 static void igsfb_video_on(struct igsfb_devconfig *); 67 static void igsfb_calc_pll(int, int *, int *, int *, int, int, int, int); 68 69 70 71 /* 72 * Enable chip. 73 */ 74 int 75 igsfb_enable(bus_space_tag_t iot, bus_addr_t iobase, int ioflags) 76 { 77 bus_space_handle_t vdoh; 78 bus_space_handle_t vseh; 79 bus_space_handle_t regh; 80 int ret; 81 82 ret = bus_space_map(iot, iobase + IGS_VDO, 1, ioflags, &vdoh); 83 if (ret != 0) { 84 printf("unable to map VDO register\n"); 85 goto out0; 86 } 87 88 ret = bus_space_map(iot, iobase + IGS_VSE, 1, ioflags, &vseh); 89 if (ret != 0) { 90 printf("unable to map VSE register\n"); 91 goto out1; 92 } 93 94 ret = bus_space_map(iot, iobase + IGS_REG_BASE, IGS_REG_SIZE, ioflags, 95 ®h); 96 if (ret != 0) { 97 printf("unable to map I/O registers\n"); 98 goto out2; 99 } 100 101 /* 102 * Start decoding i/o space accesses. 103 */ 104 bus_space_write_1(iot, vdoh, 0, IGS_VDO_ENABLE | IGS_VDO_SETUP); 105 bus_space_write_1(iot, vseh, 0, IGS_VSE_ENABLE); 106 bus_space_write_1(iot, vdoh, 0, IGS_VDO_ENABLE); 107 108 /* 109 * Start decoding memory space accesses (XXX: move out of here? 110 * we program this register in igsfb_init_ext). 111 * While here, enable coprocessor and select IGS_COP_BASE_B. 112 */ 113 igs_ext_write(iot, regh, IGS_EXT_BIU_MISC_CTL, 114 (IGS_EXT_BIU_LINEAREN 115 | IGS_EXT_BIU_COPREN | IGS_EXT_BIU_COPASELB)); 116 117 bus_space_unmap(iot, regh, IGS_REG_SIZE); 118 out2: bus_space_unmap(iot, vseh, 1); 119 out1: bus_space_unmap(iot, vdoh, 1); 120 out0: return ret; 121 } 122 123 124 /* 125 * Init sequencer. 126 * This is common for all video modes. 127 */ 128 static void 129 igsfb_init_seq(struct igsfb_devconfig *dc) 130 { 131 bus_space_tag_t iot = dc->dc_iot; 132 bus_space_handle_t ioh = dc->dc_ioh; 133 134 /* start messing with sequencer */ 135 igs_seq_write(iot, ioh, IGS_SEQ_RESET, 0); 136 137 igs_seq_write(iot, ioh, 1, 0x01); /* 8 dot clock */ 138 igs_seq_write(iot, ioh, 2, 0x0f); /* enable all maps */ 139 igs_seq_write(iot, ioh, 3, 0x00); /* character generator */ 140 igs_seq_write(iot, ioh, 4, 0x0e); /* memory mode */ 141 142 /* this selects color mode among other things */ 143 bus_space_write_1(iot, ioh, IGS_MISC_OUTPUT_W, 0xef); 144 145 /* normal sequencer operation */ 146 igs_seq_write(iot, ioh, IGS_SEQ_RESET, 147 IGS_SEQ_RESET_SYNC | IGS_SEQ_RESET_ASYNC); 148 } 149 150 151 /* 152 * Init CRTC to 640x480 8bpp at 60Hz 153 */ 154 static void 155 igsfb_init_crtc(struct igsfb_devconfig *dc) 156 { 157 bus_space_tag_t iot = dc->dc_iot; 158 bus_space_handle_t ioh = dc->dc_ioh; 159 160 igs_crtc_write(iot, ioh, 0x00, 0x5f); 161 igs_crtc_write(iot, ioh, 0x01, 0x4f); 162 igs_crtc_write(iot, ioh, 0x02, 0x50); 163 igs_crtc_write(iot, ioh, 0x03, 0x80); 164 igs_crtc_write(iot, ioh, 0x04, 0x52); 165 igs_crtc_write(iot, ioh, 0x05, 0x9d); 166 igs_crtc_write(iot, ioh, 0x06, 0x0b); 167 igs_crtc_write(iot, ioh, 0x07, 0x3e); 168 169 /* next block is almost constant, only bit 6 in reg 9 differs */ 170 igs_crtc_write(iot, ioh, 0x08, 0x00); 171 igs_crtc_write(iot, ioh, 0x09, 0x40); /* <- either 0x40 or 0x60 */ 172 igs_crtc_write(iot, ioh, 0x0a, 0x00); 173 igs_crtc_write(iot, ioh, 0x0b, 0x00); 174 igs_crtc_write(iot, ioh, 0x0c, 0x00); 175 igs_crtc_write(iot, ioh, 0x0d, 0x00); 176 igs_crtc_write(iot, ioh, 0x0e, 0x00); 177 igs_crtc_write(iot, ioh, 0x0f, 0x00); 178 179 igs_crtc_write(iot, ioh, 0x10, 0xe9); 180 igs_crtc_write(iot, ioh, 0x11, 0x8b); 181 igs_crtc_write(iot, ioh, 0x12, 0xdf); 182 igs_crtc_write(iot, ioh, 0x13, 0x50); 183 igs_crtc_write(iot, ioh, 0x14, 0x00); 184 igs_crtc_write(iot, ioh, 0x15, 0xe6); 185 igs_crtc_write(iot, ioh, 0x16, 0x04); 186 igs_crtc_write(iot, ioh, 0x17, 0xc3); 187 188 igs_crtc_write(iot, ioh, 0x18, 0xff); 189 } 190 191 192 /* 193 * Init graphics controller. 194 * This is common for all video modes. 195 */ 196 static void 197 igsfb_init_grfx(struct igsfb_devconfig *dc) 198 { 199 bus_space_tag_t iot = dc->dc_iot; 200 bus_space_handle_t ioh = dc->dc_ioh; 201 202 igs_grfx_write(iot, ioh, 0, 0x00); 203 igs_grfx_write(iot, ioh, 1, 0x00); 204 igs_grfx_write(iot, ioh, 2, 0x00); 205 igs_grfx_write(iot, ioh, 3, 0x00); 206 igs_grfx_write(iot, ioh, 4, 0x00); 207 igs_grfx_write(iot, ioh, 5, 0x60); /* SRMODE, MODE256 */ 208 igs_grfx_write(iot, ioh, 6, 0x05); /* 64k @ a0000, GRAPHICS */ 209 igs_grfx_write(iot, ioh, 7, 0x0f); /* color compare all */ 210 igs_grfx_write(iot, ioh, 8, 0xff); /* bitmask = all bits mutable */ 211 } 212 213 214 /* 215 * Init attribute controller. 216 * This is common for all video modes. 217 */ 218 static void 219 igsfb_init_attr(struct igsfb_devconfig *dc) 220 { 221 bus_space_tag_t iot = dc->dc_iot; 222 bus_space_handle_t ioh = dc->dc_ioh; 223 int i; 224 225 igs_attr_flip_flop(iot, ioh); /* reset attr flip-flop to address */ 226 227 for (i = 0; i < 16; ++i) /* crt palette */ 228 igs_attr_write(iot, ioh, i, i); 229 230 igs_attr_write(iot, ioh, 0x10, 0x01); /* select graphic mode */ 231 igs_attr_write(iot, ioh, 0x11, 0x00); /* crt overscan color */ 232 igs_attr_write(iot, ioh, 0x12, 0x0f); /* color plane enable */ 233 igs_attr_write(iot, ioh, 0x13, 0x00); 234 igs_attr_write(iot, ioh, 0x14, 0x00); 235 } 236 237 238 /* 239 * When done with ATTR controller, call this to unblank the screen. 240 */ 241 static void 242 igsfb_video_on(struct igsfb_devconfig *dc) 243 { 244 bus_space_tag_t iot = dc->dc_iot; 245 bus_space_handle_t ioh = dc->dc_ioh; 246 247 igs_attr_flip_flop(iot, ioh); 248 bus_space_write_1(iot, ioh, IGS_ATTR_IDX, 0x20); 249 bus_space_write_1(iot, ioh, IGS_ATTR_IDX, 0x20); 250 } 251 252 253 /* 254 * Latch VCLK (b0/b1) and MCLK (b2/b3) values. 255 */ 256 static void 257 igsfb_freq_latch(struct igsfb_devconfig *dc) 258 { 259 bus_space_tag_t iot = dc->dc_iot; 260 bus_space_handle_t ioh = dc->dc_ioh; 261 262 bus_space_write_1(iot, ioh, IGS_EXT_IDX, 0xb9); 263 bus_space_write_1(iot, ioh, IGS_EXT_PORT, 0x80); 264 bus_space_write_1(iot, ioh, IGS_EXT_PORT, 0x00); 265 } 266 267 268 static void 269 igsfb_init_ext(struct igsfb_devconfig *dc) 270 { 271 bus_space_tag_t iot = dc->dc_iot; 272 bus_space_handle_t ioh = dc->dc_ioh; 273 int is_cyberpro = (dc->dc_id >= 0x2000); 274 275 igs_ext_write(iot, ioh, 0x10, 0x10); /* IGS_EXT_START_ADDR enable */ 276 igs_ext_write(iot, ioh, 0x12, 0x00); /* IGS_EXT_IRQ_CTL disable */ 277 igs_ext_write(iot, ioh, 0x13, 0x00); /* MBZ for normal operation */ 278 279 igs_ext_write(iot, ioh, 0x31, 0x00); /* segment write ptr */ 280 igs_ext_write(iot, ioh, 0x32, 0x00); /* segment read ptr */ 281 282 /* IGS_EXT_BIU_MISC_CTL: linearen, copren, copaselb, segon */ 283 igs_ext_write(iot, ioh, 0x33, 0x1d); 284 285 /* sprite location */ 286 igs_ext_write(iot, ioh, 0x50, 0x00); 287 igs_ext_write(iot, ioh, 0x51, 0x00); 288 igs_ext_write(iot, ioh, 0x52, 0x00); 289 igs_ext_write(iot, ioh, 0x53, 0x00); 290 igs_ext_write(iot, ioh, 0x54, 0x00); 291 igs_ext_write(iot, ioh, 0x55, 0x00); 292 igs_ext_write(iot, ioh, 0x56, 0x00); /* sprite control */ 293 294 /* IGS_EXT_GRFX_MODE */ 295 igs_ext_write(iot, ioh, 0x57, 0x01); /* raster fb */ 296 297 /* overscan R/G/B */ 298 igs_ext_write(iot, ioh, 0x58, 0x00); 299 igs_ext_write(iot, ioh, 0x59, 0x00); 300 igs_ext_write(iot, ioh, 0x5A, 0x00); 301 302 /* 303 * Video memory size &c. We rely on firmware to program 304 * BUS_CTL(30), MEM_CTL1(71), MEM_CTL2(72) appropriately. 305 */ 306 307 /* ext memory ctl0 */ 308 igs_ext_write(iot, ioh, 0x70, 0x0B); /* enable fifo, seq */ 309 310 /* ext hidden ctl1 */ 311 igs_ext_write(iot, ioh, 0x73, 0x30); /* XXX: krups: 0x20 */ 312 313 /* ext fifo control */ 314 igs_ext_write(iot, ioh, 0x74, 0x10); /* XXX: krups: 0x1b */ 315 igs_ext_write(iot, ioh, 0x75, 0x10); /* XXX: krups: 0x1e */ 316 317 igs_ext_write(iot, ioh, 0x76, 0x00); /* ext seq. */ 318 igs_ext_write(iot, ioh, 0x7A, 0xC8); /* ext. hidden ctl */ 319 320 /* ext graphics ctl: GCEXTPATH. krups 1, nettrom 1, docs 3 */ 321 igs_ext_write(iot, ioh, 0x90, 0x01); 322 323 if (is_cyberpro) /* select normal vclk/mclk registers */ 324 igs_ext_write(iot, ioh, 0xBF, 0x00); 325 326 igs_ext_write(iot, ioh, 0xB0, 0xD2); /* VCLK = 25.175MHz */ 327 igs_ext_write(iot, ioh, 0xB1, 0xD3); 328 igs_ext_write(iot, ioh, 0xB2, 0xDB); /* MCLK = 75MHz*/ 329 igs_ext_write(iot, ioh, 0xB3, 0x54); 330 igsfb_freq_latch(dc); 331 332 if (is_cyberpro) 333 igs_ext_write(iot, ioh, 0xF8, 0x04); /* XXX: ??? */ 334 335 /* 640x480 8bpp at 60Hz */ 336 igs_ext_write(iot, ioh, 0x11, 0x00); 337 igs_ext_write(iot, ioh, 0x77, 0x01); /* 8bpp, indexed */ 338 igs_ext_write(iot, ioh, 0x14, 0x51); 339 igs_ext_write(iot, ioh, 0x15, 0x00); 340 } 341 342 343 static void 344 igsfb_init_dac(struct igsfb_devconfig *dc) 345 { 346 bus_space_tag_t iot = dc->dc_iot; 347 bus_space_handle_t ioh = dc->dc_ioh; 348 uint8_t reg; 349 350 /* RAMDAC address 2 select */ 351 reg = igs_ext_read(iot, ioh, IGS_EXT_SPRITE_CTL); 352 igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL, 353 reg | IGS_EXT_SPRITE_DAC_PEL); 354 355 /* VREFEN, DAC8 */ 356 bus_space_write_1(iot, ioh, IGS_DAC_CMD, 0x06); 357 358 /* restore */ 359 igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL, reg); 360 361 bus_space_write_1(iot, ioh, IGS_PEL_MASK, 0xff); 362 } 363 364 365 void 366 igsfb_1024x768_8bpp_60Hz(struct igsfb_devconfig *dc) 367 { 368 bus_space_tag_t iot = dc->dc_iot; 369 bus_space_handle_t ioh = dc->dc_ioh; 370 371 igs_crtc_write(iot, ioh, 0x11, 0x00); /* write enable CRTC 0..7 */ 372 373 igs_crtc_write(iot, ioh, 0x00, 0xa3); 374 igs_crtc_write(iot, ioh, 0x01, 0x7f); 375 igs_crtc_write(iot, ioh, 0x02, 0x7f); /* krups: 80 */ 376 igs_crtc_write(iot, ioh, 0x03, 0x85); /* krups: 84 */ 377 igs_crtc_write(iot, ioh, 0x04, 0x84); /* krups: 88 */ 378 igs_crtc_write(iot, ioh, 0x05, 0x95); /* krups: 99 */ 379 igs_crtc_write(iot, ioh, 0x06, 0x24); 380 igs_crtc_write(iot, ioh, 0x07, 0xfd); 381 382 /* next block is almost constant, only bit 6 in reg 9 differs */ 383 igs_crtc_write(iot, ioh, 0x08, 0x00); 384 igs_crtc_write(iot, ioh, 0x09, 0x60); /* <- either 0x40 or 0x60 */ 385 igs_crtc_write(iot, ioh, 0x0a, 0x00); 386 igs_crtc_write(iot, ioh, 0x0b, 0x00); 387 igs_crtc_write(iot, ioh, 0x0c, 0x00); 388 igs_crtc_write(iot, ioh, 0x0d, 0x00); 389 igs_crtc_write(iot, ioh, 0x0e, 0x00); 390 igs_crtc_write(iot, ioh, 0x0f, 0x00); 391 392 igs_crtc_write(iot, ioh, 0x10, 0x06); 393 igs_crtc_write(iot, ioh, 0x11, 0x8c); 394 igs_crtc_write(iot, ioh, 0x12, 0xff); 395 igs_crtc_write(iot, ioh, 0x13, 0x80); /* depends on BPP */ 396 igs_crtc_write(iot, ioh, 0x14, 0x0f); 397 igs_crtc_write(iot, ioh, 0x15, 0x02); 398 igs_crtc_write(iot, ioh, 0x16, 0x21); 399 igs_crtc_write(iot, ioh, 0x17, 0xe3); 400 igs_crtc_write(iot, ioh, 0x18, 0xff); 401 402 igs_ext_write(iot, ioh, 0xB0, 0xE2); /* VCLK */ 403 igs_ext_write(iot, ioh, 0xB1, 0x58); 404 #if 1 405 /* XXX: hmm, krups does this */ 406 igs_ext_write(iot, ioh, 0xB2, 0xE2); /* MCLK */ 407 igs_ext_write(iot, ioh, 0xB3, 0x58); 408 #endif 409 igsfb_freq_latch(dc); 410 411 igs_ext_write(iot, ioh, 0x11, 0x00); 412 igs_ext_write(iot, ioh, 0x77, 0x01); /* 8bpp, indexed */ 413 igs_ext_write(iot, ioh, 0x14, 0x81); 414 igs_ext_write(iot, ioh, 0x15, 0x00); 415 416 dc->dc_width = 1024; 417 dc->dc_height = 768; 418 dc->dc_depth = 8; 419 dc->dc_stride = dc->dc_width; 420 } 421 422 423 /* 424 * igs-video-init from krups prom 425 */ 426 void 427 igsfb_hw_setup(struct igsfb_devconfig *dc) 428 { 429 const struct videomode *mode = NULL; 430 int i, size, d; 431 432 igsfb_init_seq(dc); 433 igsfb_init_crtc(dc); 434 igsfb_init_attr(dc); 435 igsfb_init_grfx(dc); 436 igsfb_init_ext(dc); 437 igsfb_init_dac(dc); 438 439 i = 0; 440 while ((strcmp(dc->dc_modestring, videomode_list[i].name) != 0) && 441 ( i < videomode_count)) { 442 i++; 443 } 444 445 if (i < videomode_count) { 446 size = videomode_list[i].hdisplay * videomode_list[i].vdisplay; 447 /* found a mode, now let's see if we can display it */ 448 if ((videomode_list[i].dot_clock <= IGS_MAX_CLOCK) && 449 (videomode_list[i].hdisplay <= 2048) && 450 (videomode_list[i].hdisplay >= 320) && 451 (videomode_list[i].vdisplay <= 2048) && 452 (videomode_list[i].vdisplay >= 200) && 453 (size <= (dc->dc_memsz - 0x1000))) { 454 mode = &videomode_list[i]; 455 /* 456 * now let's see which maximum depth we can support 457 * in that mode 458 */ 459 d = (dc->dc_vmemsz - 0x1000) / size; 460 if (d >= 4) { 461 dc->dc_maxdepth = 32; 462 } else if (d >= 2) { 463 dc->dc_maxdepth = 16; 464 } else 465 dc->dc_maxdepth = 8; 466 } 467 } 468 dc->dc_mode = mode; 469 470 if (mode != NULL) { 471 igsfb_set_mode(dc, mode, 8); 472 } else { 473 igsfb_1024x768_8bpp_60Hz(dc); 474 dc->dc_maxdepth = 8; 475 } 476 477 igsfb_video_on(dc); 478 } 479 480 void 481 igsfb_set_mode(struct igsfb_devconfig *dc, const struct videomode *mode, 482 int depth) 483 { 484 bus_space_tag_t iot = dc->dc_iot; 485 bus_space_handle_t ioh = dc->dc_ioh; 486 int i, m, n, p, hoffset, bytes_per_pixel, memfetch; 487 int vsync_start, hsync_start, vsync_end, hsync_end; 488 int vblank_start, vblank_end, hblank_start, hblank_end; 489 int croffset; 490 uint8_t vclk1, vclk2, vclk3, overflow, reg, seq_mode; 491 492 switch (depth) { 493 case 8: 494 seq_mode = IGS_EXT_SEQ_8BPP; 495 break; 496 case 15: 497 seq_mode = IGS_EXT_SEQ_15BPP; /* 5-5-5 */ 498 break; 499 case 16: 500 seq_mode = IGS_EXT_SEQ_16BPP; /* 5-6-5 */ 501 break; 502 case 24: 503 seq_mode = IGS_EXT_SEQ_24BPP; /* 8-8-8 */ 504 break; 505 case 32: 506 seq_mode = IGS_EXT_SEQ_32BPP; 507 break; 508 default: 509 aprint_error("igsfb: unsupported depth (%d), reverting" 510 " to 8 bit\n", depth); 511 depth = 8; 512 seq_mode = IGS_EXT_SEQ_8BPP; 513 } 514 bytes_per_pixel = howmany(depth, NBBY); 515 516 hoffset = (mode->hdisplay >> 3) * bytes_per_pixel; 517 memfetch = hoffset + 1; 518 overflow = (((mode->vtotal - 2) & 0x400) >> 10) | 519 (((mode->vdisplay -1) & 0x400) >> 9) | 520 ((mode->vsync_start & 0x400) >> 8) | 521 ((mode->vsync_start & 0x400) >> 7) | 522 0x10; 523 524 /* RAMDAC address 2 select */ 525 reg = igs_ext_read(iot, ioh, IGS_EXT_SPRITE_CTL); 526 igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL, 527 reg | IGS_EXT_SPRITE_DAC_PEL); 528 529 if (depth == 8) { 530 /* palette mode */ 531 bus_space_write_1(dc->dc_iot, dc->dc_ioh, IGS_DAC_CMD, 0x06); 532 } else { 533 /* bypass palette */ 534 bus_space_write_1(dc->dc_iot, dc->dc_ioh, IGS_DAC_CMD, 0x16); 535 } 536 /* restore */ 537 igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL, reg); 538 539 bus_space_write_1(iot, ioh, IGS_PEL_MASK, 0xff); 540 541 igs_crtc_write(iot, ioh, 0x11, 0x00); /* write enable CRTC 0..7 */ 542 543 hsync_start = mode->hsync_start; 544 hsync_end = mode->hsync_end; 545 546 hblank_start = min(mode->hsync_start, mode->hdisplay); 547 hblank_end = hsync_end; 548 if ((hblank_end - hblank_start) >= 63 * 8) { 549 550 /* 551 * H Blanking size must be < 63*8. Same remark as above. 552 */ 553 hblank_start = hblank_end - 63 * 8; 554 } 555 556 vblank_start = min(mode->vsync_start, mode->vdisplay); 557 vblank_end = mode->vsync_end; 558 559 vsync_start = mode->vsync_start; 560 vsync_end = mode->vsync_end; 561 igs_crtc_write(iot, ioh, 0x00, (mode->htotal >> 3) - 5); 562 igs_crtc_write(iot, ioh, 0x01, (mode->hdisplay >> 3) - 1); 563 igs_crtc_write(iot, ioh, 0x02, (hblank_start >> 3) - 1); 564 igs_crtc_write(iot, ioh, 0x03, 0x80 | (((hblank_end >> 3) - 1) & 0x1f)); 565 igs_crtc_write(iot, ioh, 0x04, hsync_start >> 3); 566 igs_crtc_write(iot, ioh, 0x05, ((((hblank_end >> 3) - 1) & 0x20) << 2) 567 | ((hsync_end >> 3) & 0x1f)); 568 igs_crtc_write(iot, ioh, 0x06, (mode->vtotal - 2) & 0xff); 569 igs_crtc_write(iot, ioh, 0x07, 570 ((vsync_start & 0x200) >> 2) | 571 (((mode->vdisplay - 1) & 0x200) >> 3) | 572 (((mode->vtotal - 2) & 0x200) >> 4) | 573 0x10 | 574 (((vblank_start - 1) & 0x100) >> 5) | 575 ((vsync_start & 0x100) >> 6) | 576 (((mode->vdisplay - 1) & 0x100) >> 7) | 577 ((mode->vtotal & 0x100) >> 8)); 578 579 igs_crtc_write(iot, ioh, 0x08, 0x00); 580 igs_crtc_write(iot, ioh, 0x09, 0x40 | 581 (((vblank_start - 1) & 0x200) >> 4)); 582 igs_crtc_write(iot, ioh, 0x0a, 0x00); 583 igs_crtc_write(iot, ioh, 0x0b, 0x00); 584 igs_crtc_write(iot, ioh, 0x0c, 0x00); 585 igs_crtc_write(iot, ioh, 0x0d, 0x00); 586 igs_crtc_write(iot, ioh, 0x0e, 0x00); 587 igs_crtc_write(iot, ioh, 0x0f, 0x00); 588 589 igs_crtc_write(iot, ioh, 0x10, vsync_start & 0xff); 590 igs_crtc_write(iot, ioh, 0x11, (vsync_end & 0x0f) | 0x20); 591 igs_crtc_write(iot, ioh, 0x12, (mode->vdisplay - 1) & 0xff); 592 igs_crtc_write(iot, ioh, 0x13, hoffset & 0xff); 593 igs_crtc_write(iot, ioh, 0x14, 0x0f); 594 igs_crtc_write(iot, ioh, 0x15, (vblank_start - 1) & 0xff); 595 igs_crtc_write(iot, ioh, 0x16, (vblank_end - 1) & 0xff); 596 igs_crtc_write(iot, ioh, 0x17, 0xe3); 597 igs_crtc_write(iot, ioh, 0x18, 0xff); 598 599 for (i = 0; i < 0x10; i++) 600 igs_attr_write(iot, ioh, i, i); 601 602 igs_attr_write(iot, ioh, 0x10, 0x01); 603 igs_attr_write(iot, ioh, 0x11, 0x00); 604 igs_attr_write(iot, ioh, 0x12, 0x0f); 605 igs_attr_write(iot, ioh, 0x13, 0x00); 606 607 igs_grfx_write(iot, ioh, 0x00, 0x00); 608 igs_grfx_write(iot, ioh, 0x01, 0x00); 609 igs_grfx_write(iot, ioh, 0x02, 0x00); 610 igs_grfx_write(iot, ioh, 0x03, 0x00); 611 igs_grfx_write(iot, ioh, 0x04, 0x00); 612 igs_grfx_write(iot, ioh, 0x05, 0x60); 613 igs_grfx_write(iot, ioh, 0x06, 0x05); 614 igs_grfx_write(iot, ioh, 0x07, 0x0f); 615 igs_grfx_write(iot, ioh, 0x08, 0xff); 616 617 /* crank up memory clock to 95MHz - needed for higher resolutions */ 618 igs_ext_write(iot, ioh, IGS_EXT_MCLK0, 0x91); 619 igs_ext_write(iot, ioh, IGS_EXT_MCLK1, 0x6a); 620 igsfb_freq_latch(dc); 621 622 igs_ext_write(iot, ioh, IGS_EXT_VOVFL, overflow); 623 igs_ext_write(iot, ioh, IGS_EXT_SEQ_MISC, seq_mode); 624 igs_ext_write(iot, ioh, 0x14, memfetch & 0xff); 625 igs_ext_write(iot, ioh, 0x15, 626 ((memfetch & 0x300) >> 8) | ((hoffset & 0x300) >> 4)); 627 628 /* finally set the dot clock */ 629 igsfb_calc_pll(mode->dot_clock, &m, &n, &p, 2047, 255, 7, IGS_MIN_VCO); 630 DPRINTF("m: %x, n: %x, p: %x\n", m, n, p); 631 vclk1 = m & 0xff; 632 vclk2 = (n & 0x1f) | ((p << 6) & 0xc0) | 633 (mode->dot_clock > 180000 ? 0x20 : 0); 634 vclk3 = ((m >> 8) & 0x7) | ((n >> 2) & 0x38) | ((p << 4) & 0x40); 635 DPRINTF("clk: %02x %02x %02x\n", vclk1, vclk2, vclk3); 636 igs_ext_write(iot, ioh, IGS_EXT_VCLK0, vclk1); 637 igs_ext_write(iot, ioh, IGS_EXT_VCLK1, vclk2); 638 igs_ext_write(iot, ioh, 0xBA, vclk3); 639 igsfb_freq_latch(dc); 640 DPRINTF("clock: %d\n", IGS_CLOCK(m, n, p)); 641 642 if (dc->dc_id > 0x2000) { 643 /* we have a blitter, so configure it as well */ 644 bus_space_write_1(dc->dc_iot, dc->dc_coph, IGS_COP_MAP_FMT_REG, 645 bytes_per_pixel - 1); 646 bus_space_write_2(dc->dc_iot, dc->dc_coph, 647 IGS_COP_SRC_MAP_WIDTH_REG, dc->dc_width - 1); 648 bus_space_write_2(dc->dc_iot, dc->dc_coph, 649 IGS_COP_DST_MAP_WIDTH_REG, dc->dc_width - 1); 650 } 651 652 /* re-init the cursor data address too */ 653 croffset = dc->dc_vmemsz - IGS_CURSOR_DATA_SIZE; 654 croffset >>= 10; /* bytes -> kilobytes */ 655 igs_ext_write(dc->dc_iot, dc->dc_ioh, 656 IGS_EXT_SPRITE_DATA_LO, croffset & 0xff); 657 igs_ext_write(dc->dc_iot, dc->dc_ioh, 658 IGS_EXT_SPRITE_DATA_HI, (croffset >> 8) & 0xf); 659 660 dc->dc_width = mode->hdisplay; 661 dc->dc_height = mode->vdisplay; 662 dc->dc_depth = depth; 663 dc->dc_stride = dc->dc_width * howmany(depth, NBBY); 664 665 igsfb_video_on(dc); 666 } 667 668 669 static void 670 igsfb_calc_pll(int target, int *Mp, int *Np, int *Pp, int maxM, int maxN, 671 int maxP, int minVco) 672 { 673 int M, N, P, bestM = 0, bestN = 0; 674 int f_vco, f_out; 675 int err, besterr; 676 677 /* 678 * Compute correct P value to keep VCO in range 679 */ 680 for (P = 0; P <= maxP; P++) 681 { 682 f_vco = target * IGS_SCALE(P); 683 if (f_vco >= minVco) 684 break; 685 } 686 687 /* M = f_out / f_ref * ((N + 1) * IGS_SCALE(P)); */ 688 besterr = target; 689 for (N = 1; N <= maxN; N++) 690 { 691 M = ((target * (N + 1) * IGS_SCALE(P) + (IGS_CLOCK_REF/2)) + 692 IGS_CLOCK_REF/2) / IGS_CLOCK_REF - 1; 693 if (0 <= M && M <= maxM) 694 { 695 f_out = IGS_CLOCK(M,N,P); 696 err = target - f_out; 697 if (err < 0) 698 err = -err; 699 if (err < besterr) 700 { 701 besterr = err; 702 bestM = M; 703 bestN = N; 704 } 705 } 706 } 707 *Mp = bestM; 708 *Np = bestN; 709 *Pp = P; 710 } 711