1 /* $NetBSD: p9100.c,v 1.61 2014/03/16 05:20:29 dholland Exp $ */ 2 3 /*- 4 * Copyright (c) 1998, 2005, 2006 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Matt Thomas. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 /* 33 * color display (p9100) driver. 34 * 35 * Does not handle interrupts, even though they can occur. 36 * 37 * XXX should defer colormap updates to vertical retrace interrupts 38 */ 39 40 #include <sys/cdefs.h> 41 __KERNEL_RCSID(0, "$NetBSD: p9100.c,v 1.61 2014/03/16 05:20:29 dholland Exp $"); 42 43 #include <sys/param.h> 44 #include <sys/systm.h> 45 #include <sys/buf.h> 46 #include <sys/device.h> 47 #include <sys/ioctl.h> 48 #include <sys/malloc.h> 49 #include <sys/mman.h> 50 #include <sys/tty.h> 51 #include <sys/conf.h> 52 53 #include <sys/bus.h> 54 #include <machine/autoconf.h> 55 56 #include <dev/sun/fbio.h> 57 #include <dev/sun/fbvar.h> 58 #include <dev/sun/btreg.h> 59 #include <dev/sun/btvar.h> 60 61 #include <dev/sbus/p9100reg.h> 62 63 #include <dev/sbus/sbusvar.h> 64 65 #include <dev/wscons/wsdisplayvar.h> 66 #include <dev/wscons/wsconsio.h> 67 #include <dev/wsfont/wsfont.h> 68 #include <dev/rasops/rasops.h> 69 70 #include <dev/wscons/wsdisplay_vconsvar.h> 71 #include <dev/wscons/wsdisplay_glyphcachevar.h> 72 73 #include "opt_wsemul.h" 74 #include "rasops_glue.h" 75 #include "opt_pnozz.h" 76 77 #include "ioconf.h" 78 79 #include "tctrl.h" 80 #if NTCTRL > 0 81 #include <machine/tctrl.h> 82 #include <sparc/dev/tctrlvar.h> /*XXX*/ 83 #endif 84 85 #ifdef PNOZZ_DEBUG 86 #define DPRINTF aprint_normal 87 #else 88 #define DPRINTF while (0) aprint_normal 89 #endif 90 91 struct pnozz_cursor { 92 short pc_enable; /* cursor is enabled */ 93 struct fbcurpos pc_pos; /* position */ 94 struct fbcurpos pc_hot; /* hot-spot */ 95 struct fbcurpos pc_size; /* size of mask & image fields */ 96 uint32_t pc_bits[0x100]; /* space for mask & image bits */ 97 unsigned char red[3], green[3]; 98 unsigned char blue[3]; /* cursor palette */ 99 }; 100 101 /* per-display variables */ 102 struct p9100_softc { 103 device_t sc_dev; /* base device */ 104 struct fbdevice sc_fb; /* frame buffer device */ 105 106 bus_space_tag_t sc_bustag; 107 108 bus_addr_t sc_ctl_paddr; /* phys address description */ 109 bus_size_t sc_ctl_psize; /* for device mmap() */ 110 bus_space_handle_t sc_ctl_memh; /* bus space handle */ 111 112 bus_addr_t sc_fb_paddr; /* phys address description */ 113 bus_size_t sc_fb_psize; /* for device mmap() */ 114 #ifdef PNOZZ_USE_LATCH 115 bus_space_handle_t sc_fb_memh; /* bus space handle */ 116 #endif 117 uint32_t sc_mono_width; /* for setup_mono */ 118 119 uint32_t sc_width; 120 uint32_t sc_height; /* panel width / height */ 121 uint32_t sc_stride; 122 uint32_t sc_depth; 123 int sc_depthshift; /* blitter works on bytes not pixels */ 124 125 union bt_cmap sc_cmap; /* Brooktree color map */ 126 127 struct pnozz_cursor sc_cursor; 128 129 int sc_mode; 130 int sc_video, sc_powerstate; 131 uint32_t sc_bg; 132 volatile uint32_t sc_last_offset; 133 struct vcons_data vd; 134 uint8_t sc_dac_power; 135 glyphcache sc_gc; 136 }; 137 138 139 static struct vcons_screen p9100_console_screen; 140 141 extern const u_char rasops_cmap[768]; 142 143 struct wsscreen_descr p9100_defscreendesc = { 144 "default", 145 0, 0, 146 NULL, 147 8, 16, 148 WSSCREEN_WSCOLORS, 149 }; 150 151 const struct wsscreen_descr *_p9100_scrlist[] = { 152 &p9100_defscreendesc, 153 /* XXX other formats, graphics screen? */ 154 }; 155 156 struct wsscreen_list p9100_screenlist = { 157 sizeof(_p9100_scrlist) / sizeof(struct wsscreen_descr *), 158 _p9100_scrlist 159 }; 160 161 /* autoconfiguration driver */ 162 static int p9100_sbus_match(device_t, cfdata_t, void *); 163 static void p9100_sbus_attach(device_t, device_t, void *); 164 165 static void p9100unblank(device_t); 166 167 CFATTACH_DECL_NEW(pnozz, sizeof(struct p9100_softc), 168 p9100_sbus_match, p9100_sbus_attach, NULL, NULL); 169 170 static dev_type_open(p9100open); 171 static dev_type_close(p9100close); 172 static dev_type_ioctl(p9100ioctl); 173 static dev_type_mmap(p9100mmap); 174 175 const struct cdevsw pnozz_cdevsw = { 176 .d_open = p9100open, 177 .d_close = nullclose, 178 .d_read = noread, 179 .d_write = nowrite, 180 .d_ioctl = p9100ioctl, 181 .d_stop = nostop, 182 .d_tty = notty, 183 .d_poll = nopoll, 184 .d_mmap = p9100mmap, 185 .d_kqfilter = nokqfilter, 186 .d_flag = 0 187 }; 188 189 /* frame buffer generic driver */ 190 static struct fbdriver p9100fbdriver = { 191 p9100unblank, p9100open, p9100close, p9100ioctl, nopoll, 192 p9100mmap, nokqfilter 193 }; 194 195 static void p9100loadcmap(struct p9100_softc *, int, int); 196 static void p9100_set_video(struct p9100_softc *, int); 197 static int p9100_get_video(struct p9100_softc *); 198 static uint32_t p9100_ctl_read_4(struct p9100_softc *, bus_size_t); 199 static void p9100_ctl_write_4(struct p9100_softc *, bus_size_t, uint32_t); 200 static uint8_t p9100_ramdac_read(struct p9100_softc *, bus_size_t); 201 static void p9100_ramdac_write(struct p9100_softc *, bus_size_t, uint8_t); 202 203 static uint8_t p9100_ramdac_read_ctl(struct p9100_softc *, int); 204 static void p9100_ramdac_write_ctl(struct p9100_softc *, int, uint8_t); 205 206 static void p9100_init_engine(struct p9100_softc *); 207 static int p9100_set_depth(struct p9100_softc *, int); 208 209 #if NWSDISPLAY > 0 210 static void p9100_sync(struct p9100_softc *); 211 static void p9100_bitblt(void *, int, int, int, int, int, int, int); 212 static void p9100_rectfill(void *, int, int, int, int, uint32_t); 213 static void p9100_clearscreen(struct p9100_softc *); 214 215 static void p9100_setup_mono(struct p9100_softc *, int, int, int, int, 216 uint32_t, uint32_t); 217 static void p9100_feed_line(struct p9100_softc *, int, uint8_t *); 218 static void p9100_set_color_reg(struct p9100_softc *, int, int32_t); 219 220 static void p9100_copycols(void *, int, int, int, int); 221 static void p9100_erasecols(void *, int, int, int, long); 222 static void p9100_copyrows(void *, int, int, int); 223 static void p9100_eraserows(void *, int, int, long); 224 /*static int p9100_mapchar(void *, int, u_int *);*/ 225 static void p9100_putchar(void *, int, int, u_int, long); 226 static void p9100_putchar_aa(void *, int, int, u_int, long); 227 static void p9100_cursor(void *, int, int, int); 228 229 static int p9100_putcmap(struct p9100_softc *, struct wsdisplay_cmap *); 230 static int p9100_getcmap(struct p9100_softc *, struct wsdisplay_cmap *); 231 static int p9100_ioctl(void *, void *, u_long, void *, int, struct lwp *); 232 static paddr_t p9100_mmap(void *, void *, off_t, int); 233 234 /*static int p9100_load_font(void *, void *, struct wsdisplay_font *);*/ 235 236 static void p9100_init_screen(void *, struct vcons_screen *, int, 237 long *); 238 #endif 239 240 static void p9100_init_cursor(struct p9100_softc *); 241 242 static void p9100_set_fbcursor(struct p9100_softc *); 243 static void p9100_setcursorcmap(struct p9100_softc *); 244 static void p9100_loadcursor(struct p9100_softc *); 245 246 #if 0 247 static int p9100_intr(void *); 248 #endif 249 250 /* power management stuff */ 251 static bool p9100_suspend(device_t, const pmf_qual_t *); 252 static bool p9100_resume(device_t, const pmf_qual_t *); 253 254 #if NTCTRL > 0 255 static void p9100_set_extvga(void *, int); 256 #endif 257 258 #if NWSDISPLAY > 0 259 struct wsdisplay_accessops p9100_accessops = { 260 p9100_ioctl, 261 p9100_mmap, 262 NULL, /* vcons_alloc_screen */ 263 NULL, /* vcons_free_screen */ 264 NULL, /* vcons_show_screen */ 265 NULL, /* load_font */ 266 NULL, /* polls */ 267 NULL, /* scroll */ 268 }; 269 #endif 270 271 #ifdef PNOZZ_USE_LATCH 272 #define PNOZZ_LATCH(sc, off) if(sc->sc_last_offset != (off & 0xffffff80)) { \ 273 (void)bus_space_read_4(sc->sc_bustag, sc->sc_fb_memh, off); \ 274 sc->sc_last_offset = off & 0xffffff80; } 275 #else 276 #define PNOZZ_LATCH(a, b) 277 #endif 278 279 /* 280 * Match a p9100. 281 */ 282 static int 283 p9100_sbus_match(device_t parent, cfdata_t cf, void *aux) 284 { 285 struct sbus_attach_args *sa = aux; 286 287 if (strcmp("p9100", sa->sa_name) == 0) 288 return 100; 289 return 0; 290 } 291 292 293 /* 294 * Attach a display. We need to notice if it is the console, too. 295 */ 296 static void 297 p9100_sbus_attach(device_t parent, device_t self, void *args) 298 { 299 struct p9100_softc *sc = device_private(self); 300 struct sbus_attach_args *sa = args; 301 struct fbdevice *fb = &sc->sc_fb; 302 int isconsole; 303 int node = sa->sa_node; 304 int i, j; 305 uint8_t ver, cmap[768]; 306 307 #if NWSDISPLAY > 0 308 struct wsemuldisplaydev_attach_args aa; 309 struct rasops_info *ri; 310 unsigned long defattr; 311 #endif 312 313 sc->sc_last_offset = 0xffffffff; 314 sc->sc_dev = self; 315 316 /* 317 * When the ROM has mapped in a p9100 display, the address 318 * maps only the video RAM, so in any case we have to map the 319 * registers ourselves. 320 */ 321 322 if (sa->sa_npromvaddrs != 0) 323 fb->fb_pixels = (void *)sa->sa_promvaddrs[0]; 324 325 /* Remember cookies for p9100_mmap() */ 326 sc->sc_bustag = sa->sa_bustag; 327 328 sc->sc_ctl_paddr = sbus_bus_addr(sa->sa_bustag, 329 sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base); 330 sc->sc_ctl_psize = 0x8000;/*(bus_size_t)sa->sa_reg[0].oa_size;*/ 331 332 sc->sc_fb_paddr = sbus_bus_addr(sa->sa_bustag, 333 sa->sa_reg[2].oa_space, sa->sa_reg[2].oa_base); 334 sc->sc_fb_psize = (bus_size_t)sa->sa_reg[2].oa_size; 335 336 if (sbus_bus_map(sc->sc_bustag, 337 sa->sa_reg[0].oa_space, 338 sa->sa_reg[0].oa_base, 339 /* 340 * XXX for some reason the SBus resources don't cover 341 * all registers, so we just map what we need 342 */ 343 0x8000, 344 0, &sc->sc_ctl_memh) != 0) { 345 printf("%s: cannot map control registers\n", 346 device_xname(self)); 347 return; 348 } 349 350 /* 351 * we need to map the framebuffer even though we never write to it, 352 * thanks to some weirdness in the SPARCbook's SBus glue for the 353 * P9100 - all register accesses need to be 'latched in' whenever we 354 * go to another 0x80 aligned 'page' by reading the framebuffer at the 355 * same offset 356 * XXX apparently the latter isn't true - my SP3GX works fine without 357 */ 358 #ifdef PNOZZ_USE_LATCH 359 if (fb->fb_pixels == NULL) { 360 if (sbus_bus_map(sc->sc_bustag, 361 sa->sa_reg[2].oa_space, 362 sa->sa_reg[2].oa_base, 363 sc->sc_fb_psize, 364 BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE, 365 &sc->sc_fb_memh) != 0) { 366 printf("%s: cannot map framebuffer\n", 367 device_xname(self)); 368 return; 369 } 370 fb->fb_pixels = (char *)sc->sc_fb_memh; 371 } else { 372 sc->sc_fb_memh = (bus_space_handle_t) fb->fb_pixels; 373 } 374 #endif 375 sc->sc_width = prom_getpropint(node, "width", 800); 376 sc->sc_height = prom_getpropint(node, "height", 600); 377 sc->sc_depth = prom_getpropint(node, "depth", 8) >> 3; 378 379 sc->sc_stride = prom_getpropint(node, "linebytes", 380 sc->sc_width * sc->sc_depth); 381 382 fb->fb_driver = &p9100fbdriver; 383 fb->fb_device = sc->sc_dev; 384 fb->fb_flags = device_cfdata(sc->sc_dev)->cf_flags & FB_USERMASK; 385 #ifdef PNOZZ_EMUL_CG3 386 fb->fb_type.fb_type = FBTYPE_SUN3COLOR; 387 #else 388 fb->fb_type.fb_type = FBTYPE_P9100; 389 #endif 390 fb->fb_pixels = NULL; 391 392 sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 393 394 isconsole = fb_is_console(node); 395 #if 0 396 if (!isconsole) { 397 aprint_normal("\n"); 398 aprint_error_dev(self, "fatal error: PROM didn't configure device\n"); 399 return; 400 } 401 #endif 402 403 fb->fb_type.fb_depth = 8; 404 sc->sc_depth = 1; 405 sc->sc_depthshift = 0; 406 407 /* check the RAMDAC */ 408 ver = p9100_ramdac_read_ctl(sc, DAC_VERSION); 409 410 p9100_init_engine(sc); 411 p9100_set_depth(sc, 8); 412 413 fb_setsize_obp(fb, fb->fb_type.fb_depth, sc->sc_width, sc->sc_height, 414 node); 415 416 #if 0 417 bus_intr_establish(sc->sc_bustag, sa->sa_pri, IPL_BIO, 418 p9100_intr, sc); 419 #endif 420 421 fb->fb_type.fb_cmsize = prom_getpropint(node, "cmsize", 256); 422 if ((1 << fb->fb_type.fb_depth) != fb->fb_type.fb_cmsize) 423 printf(", %d entry colormap", fb->fb_type.fb_cmsize); 424 425 /* make sure we are not blanked */ 426 if (isconsole) 427 p9100_set_video(sc, 1); 428 429 /* register with power management */ 430 sc->sc_video = 1; 431 sc->sc_powerstate = PWR_RESUME; 432 if (!pmf_device_register(self, p9100_suspend, p9100_resume)) { 433 panic("%s: could not register with PMF", 434 device_xname(sc->sc_dev)); 435 } 436 437 if (isconsole) { 438 printf(" (console)\n"); 439 #ifdef RASTERCONSOLE 440 /*p9100loadcmap(sc, 255, 1);*/ 441 fbrcons_init(fb); 442 #endif 443 } else 444 printf("\n"); 445 446 #if NWSDISPLAY > 0 447 wsfont_init(); 448 449 #ifdef PNOZZ_DEBUG 450 /* make the glyph cache visible */ 451 sc->sc_height -= 100; 452 #endif 453 454 sc->sc_gc.gc_bitblt = p9100_bitblt; 455 sc->sc_gc.gc_blitcookie = sc; 456 sc->sc_gc.gc_rop = ROP_SRC; 457 458 vcons_init(&sc->vd, sc, &p9100_defscreendesc, &p9100_accessops); 459 sc->vd.init_screen = p9100_init_screen; 460 461 vcons_init_screen(&sc->vd, &p9100_console_screen, 1, &defattr); 462 p9100_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC; 463 464 /* Initialize the default color map. */ 465 rasops_get_cmap(&p9100_console_screen.scr_ri, cmap, 768); 466 467 j = 0; 468 for (i = 0; i < 256; i++) { 469 sc->sc_cmap.cm_map[i][0] = cmap[j]; 470 j++; 471 sc->sc_cmap.cm_map[i][1] = cmap[j]; 472 j++; 473 sc->sc_cmap.cm_map[i][2] = cmap[j]; 474 j++; 475 } 476 p9100loadcmap(sc, 0, 256); 477 478 sc->sc_bg = (defattr >> 16) & 0xff; 479 p9100_clearscreen(sc); 480 481 ri = &p9100_console_screen.scr_ri; 482 483 p9100_defscreendesc.nrows = ri->ri_rows; 484 p9100_defscreendesc.ncols = ri->ri_cols; 485 p9100_defscreendesc.textops = &ri->ri_ops; 486 p9100_defscreendesc.capabilities = ri->ri_caps; 487 488 glyphcache_init(&sc->sc_gc, sc->sc_height + 5, 489 (0x200000 / sc->sc_stride) - sc->sc_height - 5, 490 sc->sc_width, 491 ri->ri_font->fontwidth, 492 ri->ri_font->fontheight, 493 defattr); 494 495 if(isconsole) { 496 wsdisplay_cnattach(&p9100_defscreendesc, ri, 0, 0, defattr); 497 vcons_replay_msgbuf(&p9100_console_screen); 498 } 499 500 aa.console = isconsole; 501 aa.scrdata = &p9100_screenlist; 502 aa.accessops = &p9100_accessops; 503 aa.accesscookie = &sc->vd; 504 505 config_found(self, &aa, wsemuldisplaydevprint); 506 #endif 507 fb->fb_type.fb_size = fb->fb_type.fb_height * fb->fb_linebytes; 508 printf("%s: rev %d / %x, %dx%d, depth %d mem %x\n", 509 device_xname(self), 510 (i & 7), ver, fb->fb_type.fb_width, fb->fb_type.fb_height, 511 fb->fb_type.fb_depth, (unsigned int)sc->sc_fb_psize); 512 /* cursor sprite handling */ 513 p9100_init_cursor(sc); 514 515 /* attach the fb */ 516 fb_attach(fb, isconsole); 517 518 #if NTCTRL > 0 519 /* register callback for external monitor status change */ 520 tadpole_register_callback(p9100_set_extvga, sc); 521 #endif 522 } 523 524 int 525 p9100open(dev_t dev, int flags, int mode, struct lwp *l) 526 { 527 int unit = minor(dev); 528 529 if (device_lookup(&pnozz_cd, unit) == NULL) 530 return (ENXIO); 531 return (0); 532 } 533 534 int 535 p9100close(dev_t dev, int flags, int mode, struct lwp *l) 536 { 537 struct p9100_softc *sc = device_lookup_private(&pnozz_cd, minor(dev)); 538 539 #if NWSDISPLAY > 0 540 p9100_init_engine(sc); 541 p9100_set_depth(sc, 8); 542 p9100loadcmap(sc, 0, 256); 543 p9100_clearscreen(sc); 544 glyphcache_wipe(&sc->sc_gc); 545 vcons_redraw_screen(sc->vd.active); 546 #endif 547 return 0; 548 } 549 550 int 551 p9100ioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l) 552 { 553 struct p9100_softc *sc = device_lookup_private(&pnozz_cd, minor(dev)); 554 struct fbgattr *fba; 555 int error, v; 556 557 switch (cmd) { 558 559 case FBIOGTYPE: 560 *(struct fbtype *)data = sc->sc_fb.fb_type; 561 break; 562 563 case FBIOGATTR: 564 fba = (struct fbgattr *)data; 565 fba->real_type = sc->sc_fb.fb_type.fb_type; 566 fba->owner = 0; /* XXX ??? */ 567 fba->fbtype = sc->sc_fb.fb_type; 568 fba->sattr.flags = 0; 569 fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type; 570 fba->sattr.dev_specific[0] = -1; 571 fba->emu_types[0] = sc->sc_fb.fb_type.fb_type; 572 fba->emu_types[1] = -1; 573 break; 574 575 case FBIOGETCMAP: 576 #define p ((struct fbcmap *)data) 577 return (bt_getcmap(p, &sc->sc_cmap, 256, 1)); 578 579 case FBIOPUTCMAP: 580 /* copy to software map */ 581 error = bt_putcmap(p, &sc->sc_cmap, 256, 1); 582 if (error) 583 return (error); 584 /* now blast them into the chip */ 585 /* XXX should use retrace interrupt */ 586 p9100loadcmap(sc, p->index, p->count); 587 #undef p 588 break; 589 590 case FBIOGVIDEO: 591 *(int *)data = p9100_get_video(sc); 592 break; 593 594 case FBIOSVIDEO: 595 p9100_set_video(sc, *(int *)data); 596 break; 597 598 /* these are for both FBIOSCURSOR and FBIOGCURSOR */ 599 #define p ((struct fbcursor *)data) 600 #define pc (&sc->sc_cursor) 601 602 case FBIOGCURSOR: 603 p->set = FB_CUR_SETALL; /* close enough, anyway */ 604 p->enable = pc->pc_enable; 605 p->pos = pc->pc_pos; 606 p->hot = pc->pc_hot; 607 p->size = pc->pc_size; 608 609 if (p->image != NULL) { 610 error = copyout(pc->pc_bits, p->image, 0x200); 611 if (error) 612 return error; 613 error = copyout(&pc->pc_bits[0x80], p->mask, 0x200); 614 if (error) 615 return error; 616 } 617 618 p->cmap.index = 0; 619 p->cmap.count = 3; 620 if (p->cmap.red != NULL) { 621 copyout(pc->red, p->cmap.red, 3); 622 copyout(pc->green, p->cmap.green, 3); 623 copyout(pc->blue, p->cmap.blue, 3); 624 } 625 break; 626 627 case FBIOSCURSOR: 628 { 629 int count; 630 uint32_t image[0x80], mask[0x80]; 631 uint8_t red[3], green[3], blue[3]; 632 633 v = p->set; 634 if (v & FB_CUR_SETCMAP) { 635 error = copyin(p->cmap.red, red, 3); 636 error |= copyin(p->cmap.green, green, 3); 637 error |= copyin(p->cmap.blue, blue, 3); 638 if (error) 639 return error; 640 } 641 if (v & FB_CUR_SETSHAPE) { 642 if (p->size.x > 64 || p->size.y > 64) 643 return EINVAL; 644 memset(&mask, 0, 0x200); 645 memset(&image, 0, 0x200); 646 count = p->size.y * 8; 647 error = copyin(p->image, image, count); 648 if (error) 649 return error; 650 error = copyin(p->mask, mask, count); 651 if (error) 652 return error; 653 } 654 655 /* parameters are OK; do it */ 656 if (v & (FB_CUR_SETCUR | FB_CUR_SETPOS | FB_CUR_SETHOT)) { 657 if (v & FB_CUR_SETCUR) 658 pc->pc_enable = p->enable; 659 if (v & FB_CUR_SETPOS) 660 pc->pc_pos = p->pos; 661 if (v & FB_CUR_SETHOT) 662 pc->pc_hot = p->hot; 663 p9100_set_fbcursor(sc); 664 } 665 666 if (v & FB_CUR_SETCMAP) { 667 memcpy(pc->red, red, 3); 668 memcpy(pc->green, green, 3); 669 memcpy(pc->blue, blue, 3); 670 p9100_setcursorcmap(sc); 671 } 672 673 if (v & FB_CUR_SETSHAPE) { 674 memcpy(pc->pc_bits, image, 0x200); 675 memcpy(&pc->pc_bits[0x80], mask, 0x200); 676 p9100_loadcursor(sc); 677 } 678 } 679 break; 680 681 #undef p 682 #undef cc 683 684 case FBIOGCURPOS: 685 *(struct fbcurpos *)data = sc->sc_cursor.pc_pos; 686 break; 687 688 case FBIOSCURPOS: 689 sc->sc_cursor.pc_pos = *(struct fbcurpos *)data; 690 p9100_set_fbcursor(sc); 691 break; 692 693 case FBIOGCURMAX: 694 /* max cursor size is 64x64 */ 695 ((struct fbcurpos *)data)->x = 64; 696 ((struct fbcurpos *)data)->y = 64; 697 break; 698 699 default: 700 return (ENOTTY); 701 } 702 return (0); 703 } 704 705 static uint32_t 706 p9100_ctl_read_4(struct p9100_softc *sc, bus_size_t off) 707 { 708 709 PNOZZ_LATCH(sc, off); 710 return bus_space_read_4(sc->sc_bustag, sc->sc_ctl_memh, off); 711 } 712 713 static void 714 p9100_ctl_write_4(struct p9100_softc *sc, bus_size_t off, uint32_t v) 715 { 716 717 PNOZZ_LATCH(sc, off); 718 bus_space_write_4(sc->sc_bustag, sc->sc_ctl_memh, off, v); 719 } 720 721 /* initialize the drawing engine */ 722 static void 723 p9100_init_engine(struct p9100_softc *sc) 724 { 725 /* reset clipping rectangles */ 726 uint32_t rmax = ((sc->sc_width & 0x3fff) << 16) | 727 (sc->sc_height & 0x3fff); 728 729 sc->sc_last_offset = 0xffffffff; 730 731 p9100_ctl_write_4(sc, WINDOW_OFFSET, 0); 732 p9100_ctl_write_4(sc, WINDOW_MIN, 0); 733 p9100_ctl_write_4(sc, WINDOW_MAX, rmax); 734 p9100_ctl_write_4(sc, BYTE_CLIP_MIN, 0); 735 p9100_ctl_write_4(sc, BYTE_CLIP_MAX, 0x3fff3fff); 736 p9100_ctl_write_4(sc, DRAW_MODE, 0); 737 p9100_ctl_write_4(sc, PLANE_MASK, 0xffffffff); 738 p9100_ctl_write_4(sc, PATTERN0, 0xffffffff); 739 p9100_ctl_write_4(sc, PATTERN1, 0xffffffff); 740 p9100_ctl_write_4(sc, PATTERN2, 0xffffffff); 741 p9100_ctl_write_4(sc, PATTERN3, 0xffffffff); 742 743 } 744 745 /* we only need these in the wsdisplay case */ 746 #if NWSDISPLAY > 0 747 748 /* wait until the engine is idle */ 749 static void 750 p9100_sync(struct p9100_softc *sc) 751 { 752 while((p9100_ctl_read_4(sc, ENGINE_STATUS) & 753 (ENGINE_BUSY | BLITTER_BUSY)) != 0); 754 } 755 756 static void 757 p9100_set_color_reg(struct p9100_softc *sc, int reg, int32_t col) 758 { 759 uint32_t out; 760 761 switch(sc->sc_depth) 762 { 763 case 1: /* 8 bit */ 764 out = (col << 8) | col; 765 out |= out << 16; 766 break; 767 case 2: /* 16 bit */ 768 out = col | (col << 16); 769 break; 770 default: 771 out = col; 772 } 773 p9100_ctl_write_4(sc, reg, out); 774 } 775 776 /* screen-to-screen blit */ 777 static void 778 p9100_bitblt(void *cookie, int xs, int ys, int xd, int yd, int wi, 779 int he, int rop) 780 { 781 struct p9100_softc *sc = cookie; 782 uint32_t src, dst, srcw, dstw; 783 784 sc->sc_last_offset = 0xffffffff; 785 786 src = ((xs & 0x3fff) << 16) | (ys & 0x3fff); 787 dst = ((xd & 0x3fff) << 16) | (yd & 0x3fff); 788 srcw = (((xs + wi - 1) & 0x3fff) << 16) | ((ys + he - 1) & 0x3fff); 789 dstw = (((xd + wi - 1) & 0x3fff) << 16) | ((yd + he - 1) & 0x3fff); 790 791 p9100_sync(sc); 792 793 p9100_ctl_write_4(sc, RASTER_OP, rop); 794 p9100_ctl_write_4(sc, BYTE_CLIP_MAX, 0x3fff3fff); 795 796 p9100_ctl_write_4(sc, ABS_XY0, src << sc->sc_depthshift); 797 p9100_ctl_write_4(sc, ABS_XY1, srcw << sc->sc_depthshift); 798 p9100_ctl_write_4(sc, ABS_XY2, dst << sc->sc_depthshift); 799 p9100_ctl_write_4(sc, ABS_XY3, dstw << sc->sc_depthshift); 800 801 (void)p9100_ctl_read_4(sc, COMMAND_BLIT); 802 } 803 804 /* solid rectangle fill */ 805 static void 806 p9100_rectfill(void *cookie, int xs, int ys, int wi, int he, uint32_t col) 807 { 808 struct p9100_softc *sc = cookie; 809 uint32_t src, srcw; 810 811 sc->sc_last_offset = 0xffffffff; 812 813 src = ((xs & 0x3fff) << 16) | (ys & 0x3fff); 814 srcw = (((xs + wi) & 0x3fff) << 16) | ((ys + he) & 0x3fff); 815 p9100_sync(sc); 816 p9100_ctl_write_4(sc, BYTE_CLIP_MAX, 0x3fff3fff); 817 p9100_set_color_reg(sc, FOREGROUND_COLOR, col); 818 p9100_set_color_reg(sc, BACKGROUND_COLOR, col); 819 p9100_ctl_write_4(sc, RASTER_OP, ROP_PAT); 820 p9100_ctl_write_4(sc, COORD_INDEX, 0); 821 p9100_ctl_write_4(sc, RECT_RTW_XY, src); 822 p9100_ctl_write_4(sc, RECT_RTW_XY, srcw); 823 (void)p9100_ctl_read_4(sc, COMMAND_QUAD); 824 } 825 826 /* setup for mono->colour expansion */ 827 static void 828 p9100_setup_mono(struct p9100_softc *sc, int x, int y, int wi, int he, 829 uint32_t fg, uint32_t bg) 830 { 831 832 sc->sc_last_offset = 0xffffffff; 833 834 p9100_sync(sc); 835 /* 836 * this doesn't make any sense to me either, but for some reason the 837 * chip applies the foreground colour to 0 pixels 838 */ 839 840 p9100_set_color_reg(sc,FOREGROUND_COLOR,bg); 841 p9100_set_color_reg(sc,BACKGROUND_COLOR,fg); 842 843 p9100_ctl_write_4(sc, BYTE_CLIP_MAX, 0x3fff3fff); 844 p9100_ctl_write_4(sc, RASTER_OP, ROP_SRC); 845 p9100_ctl_write_4(sc, ABS_X0, x); 846 p9100_ctl_write_4(sc, ABS_XY1, (x << 16) | (y & 0xFFFFL)); 847 p9100_ctl_write_4(sc, ABS_X2, (x + wi)); 848 p9100_ctl_write_4(sc, ABS_Y3, he); 849 /* now feed the data into the chip */ 850 sc->sc_mono_width = wi; 851 } 852 853 /* write monochrome data to the screen through the blitter */ 854 static void 855 p9100_feed_line(struct p9100_softc *sc, int count, uint8_t *data) 856 { 857 int i; 858 uint32_t latch = 0, bork; 859 int shift = 24; 860 int to_go = sc->sc_mono_width; 861 862 PNOZZ_LATCH(sc, PIXEL_1); 863 864 for (i = 0; i < count; i++) { 865 bork = data[i]; 866 latch |= (bork << shift); 867 if (shift == 0) { 868 /* check how many bits are significant */ 869 if (to_go > 31) { 870 bus_space_write_4(sc->sc_bustag, 871 sc->sc_ctl_memh, 872 (PIXEL_1 + (31 << 2)), latch); 873 to_go -= 32; 874 } else 875 { 876 bus_space_write_4(sc->sc_bustag, 877 sc->sc_ctl_memh, 878 (PIXEL_1 + ((to_go - 1) << 2)), latch); 879 to_go = 0; 880 } 881 latch = 0; 882 shift = 24; 883 } else 884 shift -= 8; 885 } 886 if (shift != 24) 887 p9100_ctl_write_4(sc, (PIXEL_1 + ((to_go - 1) << 2)), latch); 888 } 889 890 static void 891 p9100_clearscreen(struct p9100_softc *sc) 892 { 893 894 p9100_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height, sc->sc_bg); 895 } 896 #endif /* NWSDISPLAY > 0 */ 897 898 static uint8_t 899 p9100_ramdac_read(struct p9100_softc *sc, bus_size_t off) 900 { 901 902 (void)p9100_ctl_read_4(sc, PWRUP_CNFG); 903 return ((bus_space_read_4(sc->sc_bustag, 904 sc->sc_ctl_memh, off) >> 16) & 0xff); 905 } 906 907 static void 908 p9100_ramdac_write(struct p9100_softc *sc, bus_size_t off, uint8_t v) 909 { 910 911 (void)p9100_ctl_read_4(sc, PWRUP_CNFG); 912 bus_space_write_4(sc->sc_bustag, sc->sc_ctl_memh, off, 913 ((uint32_t)v) << 16); 914 } 915 916 static uint8_t 917 p9100_ramdac_read_ctl(struct p9100_softc *sc, int off) 918 { 919 p9100_ramdac_write(sc, DAC_INDX_LO, off & 0xff); 920 p9100_ramdac_write(sc, DAC_INDX_HI, (off & 0xff00) >> 8); 921 return p9100_ramdac_read(sc, DAC_INDX_DATA); 922 } 923 924 static void 925 p9100_ramdac_write_ctl(struct p9100_softc *sc, int off, uint8_t val) 926 { 927 p9100_ramdac_write(sc, DAC_INDX_LO, off & 0xff); 928 p9100_ramdac_write(sc, DAC_INDX_HI, (off & 0xff00) >> 8); 929 p9100_ramdac_write(sc, DAC_INDX_DATA, val); 930 } 931 932 /* 933 * Undo the effect of an FBIOSVIDEO that turns the video off. 934 */ 935 static void 936 p9100unblank(device_t dev) 937 { 938 struct p9100_softc *sc = device_private(dev); 939 940 p9100_set_video(sc, 1); 941 942 /* 943 * Check if we're in terminal mode. If not force the console screen 944 * to front so we can see ddb, panic messages and so on 945 */ 946 if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL) { 947 sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 948 if (sc->vd.active != &p9100_console_screen) { 949 SCREEN_INVISIBLE(sc->vd.active); 950 sc->vd.active = &p9100_console_screen; 951 SCREEN_VISIBLE(&p9100_console_screen); 952 } 953 p9100_init_engine(sc); 954 p9100_set_depth(sc, 8); 955 vcons_redraw_screen(&p9100_console_screen); 956 } 957 } 958 959 static void 960 p9100_set_video(struct p9100_softc *sc, int enable) 961 { 962 uint32_t v = p9100_ctl_read_4(sc, SCRN_RPNT_CTL_1); 963 964 if (enable) 965 v |= VIDEO_ENABLED; 966 else 967 v &= ~VIDEO_ENABLED; 968 p9100_ctl_write_4(sc, SCRN_RPNT_CTL_1, v); 969 #if NTCTRL > 0 970 /* Turn On/Off the TFT if we know how. 971 */ 972 tadpole_set_video(enable); 973 #endif 974 } 975 976 static int 977 p9100_get_video(struct p9100_softc *sc) 978 { 979 return (p9100_ctl_read_4(sc, SCRN_RPNT_CTL_1) & VIDEO_ENABLED) != 0; 980 } 981 982 static bool 983 p9100_suspend(device_t dev, const pmf_qual_t *qual) 984 { 985 struct p9100_softc *sc = device_private(dev); 986 987 if (sc->sc_powerstate == PWR_SUSPEND) 988 return TRUE; 989 990 sc->sc_video = p9100_get_video(sc); 991 sc->sc_dac_power = p9100_ramdac_read_ctl(sc, DAC_POWER_MGT); 992 p9100_ramdac_write_ctl(sc, DAC_POWER_MGT, 993 DAC_POWER_SCLK_DISABLE | 994 DAC_POWER_DDOT_DISABLE | 995 DAC_POWER_SYNC_DISABLE | 996 DAC_POWER_ICLK_DISABLE | 997 DAC_POWER_IPWR_DISABLE); 998 p9100_set_video(sc, 0); 999 sc->sc_powerstate = PWR_SUSPEND; 1000 return TRUE; 1001 } 1002 1003 static bool 1004 p9100_resume(device_t dev, const pmf_qual_t *qual) 1005 { 1006 struct p9100_softc *sc = device_private(dev); 1007 1008 if (sc->sc_powerstate == PWR_RESUME) 1009 return TRUE; 1010 1011 p9100_ramdac_write_ctl(sc, DAC_POWER_MGT, sc->sc_dac_power); 1012 p9100_set_video(sc, sc->sc_video); 1013 1014 sc->sc_powerstate = PWR_RESUME; 1015 return TRUE; 1016 } 1017 1018 /* 1019 * Load a subset of the current (new) colormap into the IBM RAMDAC. 1020 */ 1021 static void 1022 p9100loadcmap(struct p9100_softc *sc, int start, int ncolors) 1023 { 1024 int i; 1025 sc->sc_last_offset = 0xffffffff; 1026 1027 p9100_ramdac_write(sc, DAC_CMAP_WRIDX, start); 1028 1029 for (i=0;i<ncolors;i++) { 1030 p9100_ramdac_write(sc, DAC_CMAP_DATA, 1031 sc->sc_cmap.cm_map[i + start][0]); 1032 p9100_ramdac_write(sc, DAC_CMAP_DATA, 1033 sc->sc_cmap.cm_map[i + start][1]); 1034 p9100_ramdac_write(sc, DAC_CMAP_DATA, 1035 sc->sc_cmap.cm_map[i + start][2]); 1036 } 1037 } 1038 1039 /* 1040 * Return the address that would map the given device at the given 1041 * offset, allowing for the given protection, or return -1 for error. 1042 */ 1043 static paddr_t 1044 p9100mmap(dev_t dev, off_t off, int prot) 1045 { 1046 struct p9100_softc *sc = device_lookup_private(&pnozz_cd, minor(dev)); 1047 1048 if (off & PGOFSET) 1049 panic("p9100mmap"); 1050 if (off < 0) 1051 return (-1); 1052 1053 #ifdef PNOZZ_EMUL_CG3 1054 #define CG3_MMAP_OFFSET 0x04000000 1055 /* Make Xsun think we are a CG3 (SUN3COLOR) 1056 */ 1057 if (off >= CG3_MMAP_OFFSET && off < CG3_MMAP_OFFSET + sc->sc_fb_psize) { 1058 off -= CG3_MMAP_OFFSET; 1059 return (bus_space_mmap(sc->sc_bustag, 1060 sc->sc_fb_paddr, 1061 off, 1062 prot, 1063 BUS_SPACE_MAP_LINEAR)); 1064 } 1065 #endif 1066 1067 if (off >= sc->sc_fb_psize + sc->sc_ctl_psize/* + sc->sc_cmd_psize*/) 1068 return (-1); 1069 1070 if (off < sc->sc_fb_psize) { 1071 return (bus_space_mmap(sc->sc_bustag, 1072 sc->sc_fb_paddr, 1073 off, 1074 prot, 1075 BUS_SPACE_MAP_LINEAR)); 1076 } 1077 1078 off -= sc->sc_fb_psize; 1079 if (off < sc->sc_ctl_psize) { 1080 return (bus_space_mmap(sc->sc_bustag, 1081 sc->sc_ctl_paddr, 1082 off, 1083 prot, 1084 BUS_SPACE_MAP_LINEAR)); 1085 } 1086 1087 return EINVAL; 1088 } 1089 1090 /* wscons stuff */ 1091 #if NWSDISPLAY > 0 1092 1093 static void 1094 p9100_cursor(void *cookie, int on, int row, int col) 1095 { 1096 struct rasops_info *ri = cookie; 1097 struct vcons_screen *scr = ri->ri_hw; 1098 struct p9100_softc *sc = scr->scr_cookie; 1099 int x, y, wi,he; 1100 1101 wi = ri->ri_font->fontwidth; 1102 he = ri->ri_font->fontheight; 1103 1104 if (ri->ri_flg & RI_CURSOR) { 1105 x = ri->ri_ccol * wi + ri->ri_xorigin; 1106 y = ri->ri_crow * he + ri->ri_yorigin; 1107 p9100_bitblt(sc, x, y, x, y, wi, he, ROP_SRC ^ 0xff); 1108 ri->ri_flg &= ~RI_CURSOR; 1109 } 1110 1111 ri->ri_crow = row; 1112 ri->ri_ccol = col; 1113 1114 if (on) 1115 { 1116 x = ri->ri_ccol * wi + ri->ri_xorigin; 1117 y = ri->ri_crow * he + ri->ri_yorigin; 1118 p9100_bitblt(sc, x, y, x, y, wi, he, ROP_SRC ^ 0xff); 1119 ri->ri_flg |= RI_CURSOR; 1120 } 1121 } 1122 1123 #if 0 1124 static int 1125 p9100_mapchar(void *cookie, int uni, u_int *index) 1126 { 1127 return 0; 1128 } 1129 #endif 1130 1131 static void 1132 p9100_putchar(void *cookie, int row, int col, u_int c, long attr) 1133 { 1134 struct rasops_info *ri = cookie; 1135 struct wsdisplay_font *font = PICK_FONT(ri, c); 1136 struct vcons_screen *scr = ri->ri_hw; 1137 struct p9100_softc *sc = scr->scr_cookie; 1138 1139 int fg, bg, i; 1140 uint8_t *data; 1141 int x, y, wi, he; 1142 1143 wi = font->fontwidth; 1144 he = font->fontheight; 1145 1146 if (!CHAR_IN_FONT(c, font)) 1147 return; 1148 1149 bg = (u_char)ri->ri_devcmap[(attr >> 16) & 0xff]; 1150 fg = (u_char)ri->ri_devcmap[(attr >> 24) & 0xff]; 1151 x = ri->ri_xorigin + col * wi; 1152 y = ri->ri_yorigin + row * he; 1153 1154 if (c == 0x20) { 1155 p9100_rectfill(sc, x, y, wi, he, bg); 1156 } else { 1157 data = WSFONT_GLYPH(c, font); 1158 1159 p9100_setup_mono(sc, x, y, wi, 1, fg, bg); 1160 for (i = 0; i < he; i++) { 1161 p9100_feed_line(sc, font->stride, 1162 data); 1163 data += font->stride; 1164 } 1165 } 1166 } 1167 1168 static void 1169 p9100_putchar_aa(void *cookie, int row, int col, u_int c, long attr) 1170 { 1171 struct rasops_info *ri = cookie; 1172 struct wsdisplay_font *font = PICK_FONT(ri, c); 1173 struct vcons_screen *scr = ri->ri_hw; 1174 struct p9100_softc *sc = scr->scr_cookie; 1175 uint32_t bg, latch = 0, bg8, fg8, pixel; 1176 int i, j, x, y, wi, he, r, g, b, aval, rwi; 1177 int r1, g1, b1, r0, g0, b0, fgo, bgo; 1178 uint8_t *data8; 1179 int rv; 1180 1181 if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL) 1182 return; 1183 1184 if (!CHAR_IN_FONT(c, font)) 1185 return; 1186 1187 wi = font->fontwidth; 1188 rwi = (wi + 3) & ~3; 1189 he = font->fontheight; 1190 1191 bg = ri->ri_devcmap[(attr >> 16) & 0xf]; 1192 x = ri->ri_xorigin + col * wi; 1193 y = ri->ri_yorigin + row * he; 1194 1195 if (c == 0x20) { 1196 p9100_rectfill(sc, x, y, wi, he, bg); 1197 return; 1198 } 1199 1200 rv = glyphcache_try(&sc->sc_gc, c, x, y, attr); 1201 if (rv == GC_OK) 1202 return; 1203 1204 data8 = WSFONT_GLYPH(c, font); 1205 1206 p9100_sync(sc); 1207 1208 p9100_ctl_write_4(sc, RASTER_OP, ROP_SRC); 1209 p9100_ctl_write_4(sc, ABS_X0, x); 1210 p9100_ctl_write_4(sc, ABS_XY1, (x << 16) | (y & 0xFFFFL)); 1211 p9100_ctl_write_4(sc, ABS_X2, (x + rwi)); 1212 p9100_ctl_write_4(sc, ABS_Y3, 1); 1213 p9100_ctl_write_4(sc, BYTE_CLIP_MAX, ((x + wi - 1) << 16) | 0x3fff); 1214 1215 /* 1216 * we need the RGB colours here, so get offsets into rasops_cmap 1217 */ 1218 fgo = ((attr >> 24) & 0xf) * 3; 1219 bgo = ((attr >> 16) & 0xf) * 3; 1220 1221 r0 = rasops_cmap[bgo]; 1222 r1 = rasops_cmap[fgo]; 1223 g0 = rasops_cmap[bgo + 1]; 1224 g1 = rasops_cmap[fgo + 1]; 1225 b0 = rasops_cmap[bgo + 2]; 1226 b1 = rasops_cmap[fgo + 2]; 1227 #define R3G3B2(r, g, b) ((r & 0xe0) | ((g >> 3) & 0x1c) | (b >> 6)) 1228 bg8 = R3G3B2(r0, g0, b0); 1229 fg8 = R3G3B2(r1, g1, b1); 1230 1231 //r128fb_wait(sc, 16); 1232 1233 for (i = 0; i < he; i++) { 1234 for (j = 0; j < wi; j++) { 1235 aval = *data8; 1236 if (aval == 0) { 1237 pixel = bg8; 1238 } else if (aval == 255) { 1239 pixel = fg8; 1240 } else { 1241 r = aval * r1 + (255 - aval) * r0; 1242 g = aval * g1 + (255 - aval) * g0; 1243 b = aval * b1 + (255 - aval) * b0; 1244 pixel = ((r & 0xe000) >> 8) | 1245 ((g & 0xe000) >> 11) | 1246 ((b & 0xc000) >> 14); 1247 } 1248 latch = (latch << 8) | pixel; 1249 /* write in 32bit chunks */ 1250 if ((j & 3) == 3) { 1251 bus_space_write_4(sc->sc_bustag, sc->sc_ctl_memh, 1252 COMMAND_PIXEL8, latch); 1253 latch = 0; 1254 } 1255 data8++; 1256 } 1257 /* if we have pixels left in latch write them out */ 1258 if ((j & 3) != 0) { 1259 latch = latch << ((4 - (j & 3)) << 3); 1260 bus_space_write_4(sc->sc_bustag, sc->sc_ctl_memh, 1261 COMMAND_PIXEL8, latch); 1262 } 1263 } 1264 if (rv == GC_ADD) { 1265 glyphcache_add(&sc->sc_gc, c, x, y); 1266 } 1267 } 1268 1269 /* 1270 * wsdisplay_accessops 1271 */ 1272 1273 int 1274 p9100_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, 1275 struct lwp *l) 1276 { 1277 struct vcons_data *vd = v; 1278 struct p9100_softc *sc = vd->cookie; 1279 struct wsdisplay_fbinfo *wdf; 1280 struct vcons_screen *ms = vd->active; 1281 1282 switch (cmd) { 1283 case WSDISPLAYIO_GTYPE: 1284 *(u_int *)data = WSDISPLAY_TYPE_SB_P9100; 1285 return 0; 1286 1287 case FBIOGVIDEO: 1288 case WSDISPLAYIO_GVIDEO: 1289 *(int *)data = p9100_get_video(sc); 1290 return 0; 1291 1292 case WSDISPLAYIO_SVIDEO: 1293 case FBIOSVIDEO: 1294 p9100_set_video(sc, *(int *)data); 1295 return 0; 1296 1297 case WSDISPLAYIO_GINFO: 1298 wdf = (void *)data; 1299 wdf->height = ms->scr_ri.ri_height; 1300 wdf->width = ms->scr_ri.ri_width; 1301 wdf->depth = ms->scr_ri.ri_depth; 1302 wdf->cmsize = 256; 1303 return 0; 1304 1305 case WSDISPLAYIO_GETCMAP: 1306 return p9100_getcmap(sc, (struct wsdisplay_cmap *)data); 1307 1308 case WSDISPLAYIO_PUTCMAP: 1309 return p9100_putcmap(sc, (struct wsdisplay_cmap *)data); 1310 1311 case WSDISPLAYIO_SMODE: 1312 { 1313 int new_mode = *(int*)data; 1314 if (new_mode != sc->sc_mode) 1315 { 1316 sc->sc_mode = new_mode; 1317 if (new_mode == WSDISPLAYIO_MODE_EMUL) 1318 { 1319 p9100_init_engine(sc); 1320 p9100_set_depth(sc, 8); 1321 p9100loadcmap(sc, 0, 256); 1322 p9100_clearscreen(sc); 1323 glyphcache_wipe(&sc->sc_gc); 1324 vcons_redraw_screen(ms); 1325 } 1326 } 1327 } 1328 } 1329 return EPASSTHROUGH; 1330 } 1331 1332 static paddr_t 1333 p9100_mmap(void *v, void *vs, off_t offset, int prot) 1334 { 1335 struct vcons_data *vd = v; 1336 struct p9100_softc *sc = vd->cookie; 1337 paddr_t pa; 1338 1339 /* 'regular' framebuffer mmap()ing */ 1340 if (offset < sc->sc_fb_psize) { 1341 pa = bus_space_mmap(sc->sc_bustag, sc->sc_fb_paddr + offset, 0, 1342 prot, BUS_SPACE_MAP_LINEAR); 1343 return pa; 1344 } 1345 1346 if ((offset >= sc->sc_fb_paddr) && (offset < (sc->sc_fb_paddr + 1347 sc->sc_fb_psize))) { 1348 pa = bus_space_mmap(sc->sc_bustag, offset, 0, prot, 1349 BUS_SPACE_MAP_LINEAR); 1350 return pa; 1351 } 1352 1353 if ((offset >= sc->sc_ctl_paddr) && (offset < (sc->sc_ctl_paddr + 1354 sc->sc_ctl_psize))) { 1355 pa = bus_space_mmap(sc->sc_bustag, offset, 0, prot, 1356 BUS_SPACE_MAP_LINEAR); 1357 return pa; 1358 } 1359 1360 return -1; 1361 } 1362 1363 static void 1364 p9100_init_screen(void *cookie, struct vcons_screen *scr, 1365 int existing, long *defattr) 1366 { 1367 struct p9100_softc *sc = cookie; 1368 struct rasops_info *ri = &scr->scr_ri; 1369 1370 ri->ri_depth = sc->sc_depth << 3; 1371 ri->ri_width = sc->sc_width; 1372 ri->ri_height = sc->sc_height; 1373 ri->ri_stride = sc->sc_stride; 1374 ri->ri_flg = RI_CENTER | RI_FULLCLEAR; 1375 if (ri->ri_depth == 8) 1376 ri->ri_flg |= RI_8BIT_IS_RGB | RI_ENABLE_ALPHA; 1377 1378 #ifdef PNOZZ_USE_LATCH 1379 ri->ri_bits = bus_space_vaddr(sc->sc_bustag, sc->sc_fb_memh); 1380 DPRINTF("addr: %08lx\n",(ulong)ri->ri_bits); 1381 #endif 1382 1383 rasops_init(ri, 0, 0); 1384 ri->ri_caps = WSSCREEN_WSCOLORS; 1385 rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight, 1386 sc->sc_width / ri->ri_font->fontwidth); 1387 1388 /* enable acceleration */ 1389 ri->ri_ops.cursor = p9100_cursor; 1390 ri->ri_ops.copyrows = p9100_copyrows; 1391 ri->ri_ops.eraserows = p9100_eraserows; 1392 ri->ri_ops.copycols = p9100_copycols; 1393 ri->ri_ops.erasecols = p9100_erasecols; 1394 if (FONT_IS_ALPHA(ri->ri_font)) { 1395 ri->ri_ops.putchar = p9100_putchar_aa; 1396 } else 1397 ri->ri_ops.putchar = p9100_putchar; 1398 } 1399 1400 static int 1401 p9100_putcmap(struct p9100_softc *sc, struct wsdisplay_cmap *cm) 1402 { 1403 u_int index = cm->index; 1404 u_int count = cm->count; 1405 int i, error; 1406 u_char rbuf[256], gbuf[256], bbuf[256]; 1407 u_char *r, *g, *b; 1408 1409 if (cm->index >= 256 || cm->count > 256 || 1410 (cm->index + cm->count) > 256) 1411 return EINVAL; 1412 error = copyin(cm->red, &rbuf[index], count); 1413 if (error) 1414 return error; 1415 error = copyin(cm->green, &gbuf[index], count); 1416 if (error) 1417 return error; 1418 error = copyin(cm->blue, &bbuf[index], count); 1419 if (error) 1420 return error; 1421 1422 r = &rbuf[index]; 1423 g = &gbuf[index]; 1424 b = &bbuf[index]; 1425 1426 for (i = 0; i < count; i++) { 1427 sc->sc_cmap.cm_map[index][0] = *r; 1428 sc->sc_cmap.cm_map[index][1] = *g; 1429 sc->sc_cmap.cm_map[index][2] = *b; 1430 index++; 1431 r++, g++, b++; 1432 } 1433 p9100loadcmap(sc, 0, 256); 1434 return 0; 1435 } 1436 1437 static int 1438 p9100_getcmap(struct p9100_softc *sc, struct wsdisplay_cmap *cm) 1439 { 1440 u_int index = cm->index; 1441 u_int count = cm->count; 1442 int error, i; 1443 uint8_t red[256], green[256], blue[256]; 1444 1445 if (index >= 255 || count > 256 || index + count > 256) 1446 return EINVAL; 1447 1448 i = index; 1449 while (i < (index + count)) { 1450 red[i] = sc->sc_cmap.cm_map[i][0]; 1451 green[i] = sc->sc_cmap.cm_map[i][1]; 1452 blue[i] = sc->sc_cmap.cm_map[i][2]; 1453 i++; 1454 } 1455 error = copyout(&red[index], cm->red, count); 1456 if (error) 1457 return error; 1458 error = copyout(&green[index], cm->green, count); 1459 if (error) 1460 return error; 1461 error = copyout(&blue[index], cm->blue, count); 1462 if (error) 1463 return error; 1464 1465 return 0; 1466 } 1467 1468 static void 1469 p9100_copycols(void *cookie, int row, int srccol, int dstcol, int ncols) 1470 { 1471 struct rasops_info *ri = cookie; 1472 struct vcons_screen *scr = ri->ri_hw; 1473 int32_t xs, xd, y, width, height; 1474 1475 xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol; 1476 xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol; 1477 y = ri->ri_yorigin + ri->ri_font->fontheight * row; 1478 width = ri->ri_font->fontwidth * ncols; 1479 height = ri->ri_font->fontheight; 1480 p9100_bitblt(scr->scr_cookie, xs, y, xd, y, width, height, ROP_SRC); 1481 } 1482 1483 static void 1484 p9100_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr) 1485 { 1486 struct rasops_info *ri = cookie; 1487 struct vcons_screen *scr = ri->ri_hw; 1488 int32_t x, y, width, height, bg; 1489 1490 x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol; 1491 y = ri->ri_yorigin + ri->ri_font->fontheight * row; 1492 width = ri->ri_font->fontwidth * ncols; 1493 height = ri->ri_font->fontheight; 1494 bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff]; 1495 p9100_rectfill(scr->scr_cookie, x, y, width, height, bg); 1496 } 1497 1498 static void 1499 p9100_copyrows(void *cookie, int srcrow, int dstrow, int nrows) 1500 { 1501 struct rasops_info *ri = cookie; 1502 struct vcons_screen *scr = ri->ri_hw; 1503 int32_t x, ys, yd, width, height; 1504 1505 x = ri->ri_xorigin; 1506 ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow; 1507 yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow; 1508 width = ri->ri_emuwidth; 1509 height = ri->ri_font->fontheight * nrows; 1510 p9100_bitblt(scr->scr_cookie, x, ys, x, yd, width, height, ROP_SRC); 1511 } 1512 1513 static void 1514 p9100_eraserows(void *cookie, int row, int nrows, long fillattr) 1515 { 1516 struct rasops_info *ri = cookie; 1517 struct vcons_screen *scr = ri->ri_hw; 1518 int32_t x, y, width, height, bg; 1519 1520 if ((row == 0) && (nrows == ri->ri_rows)) { 1521 x = y = 0; 1522 width = ri->ri_width; 1523 height = ri->ri_height; 1524 } else { 1525 x = ri->ri_xorigin; 1526 y = ri->ri_yorigin + ri->ri_font->fontheight * row; 1527 width = ri->ri_emuwidth; 1528 height = ri->ri_font->fontheight * nrows; 1529 } 1530 bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff]; 1531 p9100_rectfill(scr->scr_cookie, x, y, width, height, bg); 1532 } 1533 1534 #if 0 1535 static int 1536 p9100_load_font(void *v, void *cookie, struct wsdisplay_font *data) 1537 { 1538 1539 return 0; 1540 } 1541 #endif 1542 1543 #endif /* NWSDISPLAY > 0 */ 1544 1545 #if 0 1546 static int 1547 p9100_intr(void *arg) 1548 { 1549 /*p9100_softc *sc=arg;*/ 1550 DPRINTF("."); 1551 return 1; 1552 } 1553 #endif 1554 1555 static void 1556 p9100_init_cursor(struct p9100_softc *sc) 1557 { 1558 1559 memset(&sc->sc_cursor, 0, sizeof(struct pnozz_cursor)); 1560 sc->sc_cursor.pc_size.x = 64; 1561 sc->sc_cursor.pc_size.y = 64; 1562 1563 } 1564 1565 static void 1566 p9100_set_fbcursor(struct p9100_softc *sc) 1567 { 1568 #ifdef PNOZZ_PARANOID 1569 int s; 1570 1571 s = splhigh(); /* just in case... */ 1572 #endif 1573 sc->sc_last_offset = 0xffffffff; 1574 1575 /* set position and hotspot */ 1576 p9100_ramdac_write(sc, DAC_INDX_CTL, DAC_INDX_AUTOINCR); 1577 p9100_ramdac_write(sc, DAC_INDX_HI, 0); 1578 p9100_ramdac_write(sc, DAC_INDX_LO, DAC_CURSOR_CTL); 1579 if (sc->sc_cursor.pc_enable) { 1580 p9100_ramdac_write(sc, DAC_INDX_DATA, DAC_CURSOR_X11 | 1581 DAC_CURSOR_64); 1582 } else 1583 p9100_ramdac_write(sc, DAC_INDX_DATA, DAC_CURSOR_OFF); 1584 /* next two registers - x low, high, y low, high */ 1585 p9100_ramdac_write(sc, DAC_INDX_DATA, sc->sc_cursor.pc_pos.x & 0xff); 1586 p9100_ramdac_write(sc, DAC_INDX_DATA, (sc->sc_cursor.pc_pos.x >> 8) & 1587 0xff); 1588 p9100_ramdac_write(sc, DAC_INDX_DATA, sc->sc_cursor.pc_pos.y & 0xff); 1589 p9100_ramdac_write(sc, DAC_INDX_DATA, (sc->sc_cursor.pc_pos.y >> 8) & 1590 0xff); 1591 /* hotspot */ 1592 p9100_ramdac_write(sc, DAC_INDX_DATA, sc->sc_cursor.pc_hot.x & 0xff); 1593 p9100_ramdac_write(sc, DAC_INDX_DATA, sc->sc_cursor.pc_hot.y & 0xff); 1594 1595 #ifdef PNOZZ_PARANOID 1596 splx(s); 1597 #endif 1598 1599 } 1600 1601 static void 1602 p9100_setcursorcmap(struct p9100_softc *sc) 1603 { 1604 int i; 1605 1606 #ifdef PNOZZ_PARANOID 1607 int s; 1608 s = splhigh(); /* just in case... */ 1609 #endif 1610 sc->sc_last_offset = 0xffffffff; 1611 1612 /* set cursor colours */ 1613 p9100_ramdac_write(sc, DAC_INDX_CTL, DAC_INDX_AUTOINCR); 1614 p9100_ramdac_write(sc, DAC_INDX_HI, 0); 1615 p9100_ramdac_write(sc, DAC_INDX_LO, DAC_CURSOR_COL_1); 1616 1617 for (i = 0; i < 3; i++) { 1618 p9100_ramdac_write(sc, DAC_INDX_DATA, sc->sc_cursor.red[i]); 1619 p9100_ramdac_write(sc, DAC_INDX_DATA, sc->sc_cursor.green[i]); 1620 p9100_ramdac_write(sc, DAC_INDX_DATA, sc->sc_cursor.blue[i]); 1621 } 1622 1623 #ifdef PNOZZ_PARANOID 1624 splx(s); 1625 #endif 1626 } 1627 1628 static void 1629 p9100_loadcursor(struct p9100_softc *sc) 1630 { 1631 uint32_t *image, *mask; 1632 uint32_t bit, bbit, im, ma; 1633 int i, j, k; 1634 uint8_t latch1, latch2; 1635 1636 #ifdef PNOZZ_PARANOID 1637 int s; 1638 s = splhigh(); /* just in case... */ 1639 #endif 1640 sc->sc_last_offset = 0xffffffff; 1641 1642 /* set cursor shape */ 1643 p9100_ramdac_write(sc, DAC_INDX_CTL, DAC_INDX_AUTOINCR); 1644 p9100_ramdac_write(sc, DAC_INDX_HI, 1); 1645 p9100_ramdac_write(sc, DAC_INDX_LO, 0); 1646 1647 image = sc->sc_cursor.pc_bits; 1648 mask = &sc->sc_cursor.pc_bits[0x80]; 1649 1650 for (i = 0; i < 0x80; i++) { 1651 bit = 0x80000000; 1652 im = image[i]; 1653 ma = mask[i]; 1654 for (k = 0; k < 4; k++) { 1655 bbit = 0x1; 1656 latch1 = 0; 1657 for (j = 0; j < 4; j++) { 1658 if (im & bit) 1659 latch1 |= bbit; 1660 bbit <<= 1; 1661 if (ma & bit) 1662 latch1 |= bbit; 1663 bbit <<= 1; 1664 bit >>= 1; 1665 } 1666 bbit = 0x1; 1667 latch2 = 0; 1668 for (j = 0; j < 4; j++) { 1669 if (im & bit) 1670 latch2 |= bbit; 1671 bbit <<= 1; 1672 if (ma & bit) 1673 latch2 |= bbit; 1674 bbit <<= 1; 1675 bit >>= 1; 1676 } 1677 p9100_ramdac_write(sc, DAC_INDX_DATA, latch1); 1678 p9100_ramdac_write(sc, DAC_INDX_DATA, latch2); 1679 } 1680 } 1681 #ifdef PNOZZ_DEBUG_CURSOR 1682 printf("image:\n"); 1683 for (i=0;i<0x80;i+=2) 1684 printf("%08x %08x\n", image[i], image[i+1]); 1685 printf("mask:\n"); 1686 for (i=0;i<0x80;i+=2) 1687 printf("%08x %08x\n", mask[i], mask[i+1]); 1688 #endif 1689 #ifdef PNOZZ_PARANOID 1690 splx(s); 1691 #endif 1692 } 1693 1694 #if NTCTRL > 0 1695 static void 1696 p9100_set_extvga(void *cookie, int status) 1697 { 1698 struct p9100_softc *sc = cookie; 1699 #ifdef PNOZZ_PARANOID 1700 int s; 1701 1702 s = splhigh(); 1703 #endif 1704 1705 #ifdef PNOZZ_DEBUG 1706 printf("%s: external VGA %s\n", device_xname(sc->sc_dev), 1707 status ? "on" : "off"); 1708 #endif 1709 1710 sc->sc_last_offset = 0xffffffff; 1711 1712 if (status) { 1713 p9100_ramdac_write_ctl(sc, DAC_POWER_MGT, 1714 p9100_ramdac_read_ctl(sc, DAC_POWER_MGT) & 1715 ~DAC_POWER_IPWR_DISABLE); 1716 } else { 1717 p9100_ramdac_write_ctl(sc, DAC_POWER_MGT, 1718 p9100_ramdac_read_ctl(sc, DAC_POWER_MGT) | 1719 DAC_POWER_IPWR_DISABLE); 1720 } 1721 #ifdef PNOZZ_PARANOID 1722 splx(s); 1723 #endif 1724 } 1725 #endif /* NTCTRL > 0 */ 1726 1727 static int 1728 upper_bit(uint32_t b) 1729 { 1730 uint32_t mask=0x80000000; 1731 int cnt = 31; 1732 if (b == 0) 1733 return -1; 1734 while ((mask != 0) && ((b & mask) == 0)) { 1735 mask = mask >> 1; 1736 cnt--; 1737 } 1738 return cnt; 1739 } 1740 1741 static int 1742 p9100_set_depth(struct p9100_softc *sc, int depth) 1743 { 1744 int new_sls; 1745 uint32_t bits, scr, memctl, mem; 1746 int s0, s1, s2, s3, ps, crtcline; 1747 uint8_t pf, mc3, es; 1748 1749 switch (depth) { 1750 case 8: 1751 sc->sc_depthshift = 0; 1752 ps = 2; 1753 pf = 3; 1754 mc3 = 0; 1755 es = 0; /* no swapping */ 1756 memctl = 3; 1757 break; 1758 case 16: 1759 sc->sc_depthshift = 1; 1760 ps = 3; 1761 pf = 4; 1762 mc3 = 0; 1763 es = 2; /* swap bytes in 16bit words */ 1764 memctl = 2; 1765 break; 1766 case 24: 1767 /* boo */ 1768 printf("We don't DO 24bit pixels dammit!\n"); 1769 return 0; 1770 case 32: 1771 sc->sc_depthshift = 2; 1772 ps = 5; 1773 pf = 6; 1774 mc3 = 0; 1775 es = 6; /* swap both half-words and bytes */ 1776 memctl = 1; /* 0 */ 1777 break; 1778 default: 1779 aprint_error("%s: bogus colour depth (%d)\n", 1780 __func__, depth); 1781 return FALSE; 1782 } 1783 /* 1784 * this could be done a lot shorter and faster but then nobody would 1785 * understand what the hell we're doing here without getting a major 1786 * headache. Scanline size is encoded as 4 shift values, 3 of them 3 bits 1787 * wide, 16 << n for n>0, one 2 bits, 512 << n for n>0. n==0 means 0 1788 */ 1789 new_sls = sc->sc_width << sc->sc_depthshift; 1790 sc->sc_stride = new_sls; 1791 bits = new_sls; 1792 s3 = upper_bit(bits); 1793 if (s3 > 9) { 1794 bits &= ~(1 << s3); 1795 s3 -= 9; 1796 } else 1797 s3 = 0; 1798 s2 = upper_bit(bits); 1799 if (s2 > 0) { 1800 bits &= ~(1 << s2); 1801 s2 -= 4; 1802 } else 1803 s2 = 0; 1804 s1 = upper_bit(bits); 1805 if (s1 > 0) { 1806 bits &= ~(1 << s1); 1807 s1 -= 4; 1808 } else 1809 s1 = 0; 1810 s0 = upper_bit(bits); 1811 if (s0 > 0) { 1812 bits &= ~(1 << s0); 1813 s0 -= 4; 1814 } else 1815 s0 = 0; 1816 1817 1818 DPRINTF("sls: %x sh: %d %d %d %d leftover: %x\n", new_sls, s0, s1, 1819 s2, s3, bits); 1820 1821 /* 1822 * now let's put these values into the System Config Register. No need to 1823 * read it here since we (hopefully) just saved the content 1824 */ 1825 scr = p9100_ctl_read_4(sc, SYS_CONF); 1826 scr = (s0 << SHIFT_0) | (s1 << SHIFT_1) | (s2 << SHIFT_2) | 1827 (s3 << SHIFT_3) | (ps << PIXEL_SHIFT) | (es << SWAP_SHIFT); 1828 1829 DPRINTF("new scr: %x DAC %x %x\n", scr, pf, mc3); 1830 1831 mem = p9100_ctl_read_4(sc, VID_MEM_CONFIG); 1832 1833 DPRINTF("old memctl: %08x\n", mem); 1834 1835 /* set shift and crtc clock */ 1836 mem &= ~(0x0000fc00); 1837 mem |= (memctl << 10) | (memctl << 13); 1838 p9100_ctl_write_4(sc, VID_MEM_CONFIG, mem); 1839 1840 DPRINTF("new memctl: %08x\n", mem); 1841 1842 /* whack the engine... */ 1843 p9100_ctl_write_4(sc, SYS_CONF, scr); 1844 1845 /* ok, whack the DAC */ 1846 p9100_ramdac_write_ctl(sc, DAC_MISC_1, 0x11); 1847 p9100_ramdac_write_ctl(sc, DAC_MISC_2, 0x45); 1848 p9100_ramdac_write_ctl(sc, DAC_MISC_3, mc3); 1849 /* 1850 * despite the 3GX manual saying otherwise we don't need to mess with 1851 * any clock dividers here 1852 */ 1853 p9100_ramdac_write_ctl(sc, DAC_MISC_CLK, 1); 1854 p9100_ramdac_write_ctl(sc, 3, 0); 1855 p9100_ramdac_write_ctl(sc, 4, 0); 1856 1857 p9100_ramdac_write_ctl(sc, DAC_POWER_MGT, 0); 1858 p9100_ramdac_write_ctl(sc, DAC_OPERATION, 0); 1859 p9100_ramdac_write_ctl(sc, DAC_PALETTE_CTRL, 0); 1860 1861 p9100_ramdac_write_ctl(sc, DAC_PIXEL_FMT, pf); 1862 1863 /* TODO: distinguish between 15 and 16 bit */ 1864 p9100_ramdac_write_ctl(sc, DAC_8BIT_CTRL, 0); 1865 /* direct colour, linear, 565 */ 1866 p9100_ramdac_write_ctl(sc, DAC_16BIT_CTRL, 0xc6); 1867 /* direct colour */ 1868 p9100_ramdac_write_ctl(sc, DAC_32BIT_CTRL, 3); 1869 1870 /* From the 3GX manual. Needs magic number reduction */ 1871 p9100_ramdac_write_ctl(sc, 0x10, 2); 1872 p9100_ramdac_write_ctl(sc, 0x11, 0); 1873 p9100_ramdac_write_ctl(sc, 0x14, 5); 1874 p9100_ramdac_write_ctl(sc, 0x08, 1); 1875 p9100_ramdac_write_ctl(sc, 0x15, 5); 1876 p9100_ramdac_write_ctl(sc, 0x16, 0x63); 1877 1878 /* whack the CRTC */ 1879 /* we always transfer 64bit in one go */ 1880 crtcline = sc->sc_stride >> 3; 1881 1882 DPRINTF("crtcline: %d\n", crtcline); 1883 1884 p9100_ctl_write_4(sc, VID_HTOTAL, (24 << sc->sc_depthshift) + crtcline); 1885 p9100_ctl_write_4(sc, VID_HSRE, 8 << sc->sc_depthshift); 1886 p9100_ctl_write_4(sc, VID_HBRE, 18 << sc->sc_depthshift); 1887 p9100_ctl_write_4(sc, VID_HBFE, (18 << sc->sc_depthshift) + crtcline); 1888 1889 #ifdef PNOZZ_DEBUG 1890 { 1891 uint32_t sscr; 1892 sscr = p9100_ctl_read_4(sc, SYS_CONF); 1893 printf("scr: %x\n", sscr); 1894 } 1895 #endif 1896 return TRUE; 1897 } 1898