1 /* $NetBSD: grf.c,v 1.61 2014/03/29 12:54:27 mlelstv Exp $ */ 2 3 /* 4 * Copyright (c) 1988 University of Utah. 5 * Copyright (c) 1990 The Regents of the University of California. 6 * All rights reserved. 7 * 8 * This code is derived from software contributed to Berkeley by 9 * the Systems Programming Group of the University of Utah Computer 10 * Science Department. 11 * 12 * Redistribution and use in source and binary forms, with or without 13 * modification, are permitted provided that the following conditions 14 * are met: 15 * 1. Redistributions of source code must retain the above copyright 16 * notice, this list of conditions and the following disclaimer. 17 * 2. Redistributions in binary form must reproduce the above copyright 18 * notice, this list of conditions and the following disclaimer in the 19 * documentation and/or other materials provided with the distribution. 20 * 3. Neither the name of the University nor the names of its contributors 21 * may be used to endorse or promote products derived from this software 22 * without specific prior written permission. 23 * 24 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 27 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 30 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 31 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 33 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 34 * SUCH DAMAGE. 35 * 36 * from: Utah $Hdr: grf.c 1.31 91/01/21$ 37 * 38 * @(#)grf.c 7.8 (Berkeley) 5/7/91 39 */ 40 41 #include <sys/cdefs.h> 42 __KERNEL_RCSID(0, "$NetBSD: grf.c,v 1.61 2014/03/29 12:54:27 mlelstv Exp $"); 43 44 /* 45 * Graphics display driver for the Amiga 46 * This is the hardware-independent portion of the driver. 47 * Hardware access is through the grf_softc->g_mode routine. 48 */ 49 50 #include "view.h" 51 #include "grf.h" 52 #include "kbd.h" 53 #include "wsdisplay.h" 54 55 #include <sys/param.h> 56 #include <sys/proc.h> 57 #include <sys/ioctl.h> 58 #include <sys/device.h> 59 #include <sys/file.h> 60 #include <sys/malloc.h> 61 #include <sys/systm.h> 62 #include <sys/vnode.h> 63 #include <sys/mman.h> 64 #include <sys/bus.h> 65 #include <sys/kauth.h> 66 67 #include <machine/cpu.h> 68 69 #include <dev/cons.h> 70 #include <dev/sun/fbio.h> 71 #include <dev/wscons/wsconsio.h> 72 #include <dev/wscons/wsdisplayvar.h> 73 #include <dev/rasops/rasops.h> 74 #include <dev/wscons/wsdisplay_vconsvar.h> 75 76 #include <amiga/amiga/color.h> /* DEBUG */ 77 #include <amiga/amiga/device.h> 78 #include <amiga/dev/grfioctl.h> 79 #include <amiga/dev/grfws.h> 80 #include <amiga/dev/grfvar.h> 81 #include <amiga/dev/itevar.h> 82 #include <amiga/dev/kbdvar.h> 83 #include <amiga/dev/viewioctl.h> 84 85 #include <sys/conf.h> 86 87 #if NGRF > 0 88 #include "ite.h" 89 #if NITE == 0 90 #define ite_on(u,f) 91 #define ite_off(u,f) 92 #define ite_reinit(d) 93 #endif 94 95 int grfon(dev_t); 96 int grfoff(dev_t); 97 int grfsinfo(dev_t, struct grfdyninfo *); 98 99 void grfattach(device_t, device_t, void *); 100 int grfmatch(device_t, cfdata_t, void *); 101 int grfprint(void *, const char *); 102 #ifdef DEBUG 103 void grfdebug(struct grf_softc *, const char *, ...); 104 #endif 105 /* 106 * pointers to grf drivers device structs 107 */ 108 struct grf_softc *grfsp[NGRF]; 109 110 CFATTACH_DECL_NEW(grf, 0, 111 grfmatch, grfattach, NULL, NULL); 112 113 dev_type_open(grfopen); 114 dev_type_close(grfclose); 115 dev_type_ioctl(grfioctl); 116 dev_type_mmap(grfmmap); 117 118 const struct cdevsw grf_cdevsw = { 119 .d_open = grfopen, 120 .d_close = grfclose, 121 .d_read = nullread, 122 .d_write = nullwrite, 123 .d_ioctl = grfioctl, 124 .d_stop = nostop, 125 .d_tty = notty, 126 .d_poll = nopoll, 127 .d_mmap = grfmmap, 128 .d_kqfilter = nokqfilter, 129 .d_flag = 0 130 }; 131 132 /* 133 * only used in console init. 134 */ 135 static cfdata_t cfdata; 136 137 #if NWSDISPLAY > 0 138 static struct vcons_screen console_vcons; 139 140 static void grf_init_screen(void *, struct vcons_screen *, int, long *); 141 static struct rasops_info *grf_setup_rasops(struct grf_softc *, 142 struct vcons_screen *); 143 static paddr_t grf_wsmmap_md(off_t off); 144 145 cons_decl(grf); 146 #endif 147 148 /* 149 * match if the unit of grf matches its perspective 150 * low level board driver. 151 */ 152 int 153 grfmatch(device_t parent, cfdata_t cf, void *aux) 154 { 155 struct grf_softc *psc; 156 157 psc = device_private(parent); 158 if (cf->cf_unit != psc->g_unit) 159 return(0); 160 cfdata = cf; 161 return(1); 162 } 163 164 /* 165 * Attach.. plug pointer in and print some info. 166 * Then try and attach a wsdisplay or ite to us. 167 * Note: self is NULL durring console init. 168 */ 169 void 170 grfattach(device_t parent, device_t self, void *aux) 171 { 172 #if NWSDISPLAY > 0 173 struct wsemuldisplaydev_attach_args wa; 174 long defattr; 175 #endif 176 struct grf_softc *gp; 177 int maj; 178 179 gp = device_private(parent); 180 gp->g_device = self; 181 grfsp[gp->g_unit] = gp; 182 183 /* 184 * find our major device number 185 */ 186 maj = cdevsw_lookup_major(&grf_cdevsw); 187 188 gp->g_grfdev = makedev(maj, gp->g_unit); 189 if (self != NULL) { 190 printf(": width %d height %d", gp->g_display.gd_dwidth, 191 gp->g_display.gd_dheight); 192 if (gp->g_display.gd_colors == 2) 193 printf(" monochrome\n"); 194 else 195 printf(" colors %d\n", gp->g_display.gd_colors); 196 #if NWSDISPLAY > 0 197 vcons_init(&gp->g_vd, gp, gp->g_screens[0], gp->g_accessops); 198 gp->g_vd.init_screen = grf_init_screen; 199 if (gp->g_flags & GF_CONSOLE) { 200 console_vcons.scr_flags |= VCONS_SCREEN_IS_STATIC; 201 vcons_init_screen(&gp->g_vd, 202 &console_vcons, 1, &defattr); 203 gp->g_screens[0]->textops = 204 &console_vcons.scr_ri.ri_ops; 205 wsdisplay_cnattach(gp->g_screens[0], 206 &console_vcons.scr_ri, 0, 0, defattr); 207 vcons_replay_msgbuf(&console_vcons); 208 } 209 210 /* attach wsdisplay */ 211 wa.console = (gp->g_flags & GF_CONSOLE) != 0; 212 wa.scrdata = &gp->g_screenlist; 213 wa.accessops = gp->g_accessops; 214 wa.accesscookie = &gp->g_vd; 215 config_found(self, &wa, wsemuldisplaydevprint); 216 #endif /* NWSDISPLAY > 0 */ 217 } 218 219 #if NWSDISPLAY == 0 220 /* 221 * try and attach an ite 222 */ 223 amiga_config_found(cfdata, self, gp, grfprint); 224 #endif 225 } 226 227 int 228 grfprint(void *aux, const char *pnp) 229 { 230 if (pnp) 231 aprint_normal("ite at %s", pnp); 232 return(UNCONF); 233 } 234 235 /*ARGSUSED*/ 236 int 237 grfopen(dev_t dev, int flags, int devtype, struct lwp *l) 238 { 239 struct grf_softc *gp; 240 241 if (GRFUNIT(dev) >= NGRF || (gp = grfsp[GRFUNIT(dev)]) == NULL) 242 return(ENXIO); 243 244 if ((gp->g_flags & GF_ALIVE) == 0) 245 return(ENXIO); 246 247 if ((gp->g_flags & (GF_OPEN|GF_EXCLUDE)) == (GF_OPEN|GF_EXCLUDE)) 248 return(EBUSY); 249 250 return(0); 251 } 252 253 /*ARGSUSED*/ 254 int 255 grfclose(dev_t dev, int flags, int mode, struct lwp *l) 256 { 257 struct grf_softc *gp; 258 259 gp = grfsp[GRFUNIT(dev)]; 260 (void)grfoff(dev); 261 gp->g_flags &= GF_ALIVE; 262 return(0); 263 } 264 265 /*ARGSUSED*/ 266 int 267 grfioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l) 268 { 269 struct grf_softc *gp; 270 int error; 271 272 gp = grfsp[GRFUNIT(dev)]; 273 error = 0; 274 275 switch (cmd) { 276 case OGRFIOCGINFO: 277 /* argl.. no bank-member.. */ 278 memcpy(data, (void *)&gp->g_display, sizeof(struct grfinfo)-4); 279 break; 280 case GRFIOCGINFO: 281 memcpy(data, (void *)&gp->g_display, sizeof(struct grfinfo)); 282 break; 283 case GRFIOCON: 284 error = grfon(dev); 285 break; 286 case GRFIOCOFF: 287 error = grfoff(dev); 288 break; 289 case GRFIOCSINFO: 290 error = grfsinfo(dev, (struct grfdyninfo *) data); 291 break; 292 case GRFGETVMODE: 293 return(gp->g_mode(gp, GM_GRFGETVMODE, data, 0, 0)); 294 case GRFSETVMODE: 295 error = gp->g_mode(gp, GM_GRFSETVMODE, data, 0, 0); 296 if (error == 0 && gp->g_itedev && !(gp->g_flags & GF_GRFON)) 297 ite_reinit(gp->g_itedev); 298 break; 299 case GRFGETNUMVM: 300 return(gp->g_mode(gp, GM_GRFGETNUMVM, data, 0, 0)); 301 /* 302 * these are all hardware dependent, and have to be resolved 303 * in the respective driver. 304 */ 305 case GRFIOCPUTCMAP: 306 case GRFIOCGETCMAP: 307 case GRFIOCSSPRITEPOS: 308 case GRFIOCGSPRITEPOS: 309 case GRFIOCSSPRITEINF: 310 case GRFIOCGSPRITEINF: 311 case GRFIOCGSPRITEMAX: 312 case GRFIOCBITBLT: 313 case GRFIOCSETMON: 314 case GRFTOGGLE: /* Toggles between Cirrus boards and native ECS on 315 Amiga. 15/11/94 ill */ 316 /* 317 * We need the minor dev number to get the overlay/image 318 * information for grf_ul. 319 */ 320 return(gp->g_mode(gp, GM_GRFIOCTL, data, cmd, dev)); 321 322 case GRFIOCBLANK: /* blank ioctl, IOCON/OFF will turn ite on */ 323 case FBIOSVIDEO: 324 error = gp->g_mode(gp, GM_GRFIOCTL, data, GRFIOCBLANK, dev); 325 if (!error) 326 gp->g_blank = *(int *)data; 327 return (error); 328 329 case FBIOGVIDEO: 330 *(int *)data = gp->g_blank; 331 return (0); 332 333 default: 334 #if NVIEW > 0 335 /* 336 * check to see whether it's a command recognized by the 337 * view code if the unit is 0 338 * XXX 339 */ 340 if (GRFUNIT(dev) == 0) { 341 extern const struct cdevsw view_cdevsw; 342 343 return((*view_cdevsw.d_ioctl)(dev, cmd, data, flag, l)); 344 } 345 #endif 346 error = EPASSTHROUGH; 347 break; 348 349 } 350 return(error); 351 } 352 353 /* 354 * map the contents of a graphics display card into process' 355 * memory space. 356 */ 357 paddr_t 358 grfmmap(dev_t dev, off_t off, int prot) 359 { 360 struct grf_softc *gp; 361 struct grfinfo *gi; 362 363 gp = grfsp[GRFUNIT(dev)]; 364 gi = &gp->g_display; 365 366 /* 367 * control registers 368 */ 369 if (off >= 0 && off < gi->gd_regsize) 370 return(((paddr_t)gi->gd_regaddr + off) >> PGSHIFT); 371 372 /* 373 * frame buffer 374 */ 375 if (off >= gi->gd_regsize && off < gi->gd_regsize+gi->gd_fbsize) { 376 off -= gi->gd_regsize; 377 return(((paddr_t)gi->gd_fbaddr + off) >> PGSHIFT); 378 } 379 /* bogus */ 380 return(-1); 381 } 382 383 int 384 grfon(dev_t dev) 385 { 386 struct grf_softc *gp; 387 388 gp = grfsp[GRFUNIT(dev)]; 389 390 if (gp->g_flags & GF_GRFON) 391 return(0); 392 393 gp->g_flags |= GF_GRFON; 394 if (gp->g_itedev != NODEV) 395 ite_off(gp->g_itedev, 3); 396 397 return(gp->g_mode(gp, (dev & GRFOVDEV) ? GM_GRFOVON : GM_GRFON, 398 NULL, 0, 0)); 399 } 400 401 int 402 grfoff(dev_t dev) 403 { 404 struct grf_softc *gp; 405 int error; 406 407 gp = grfsp[GRFUNIT(dev)]; 408 409 if ((gp->g_flags & GF_GRFON) == 0) 410 return(0); 411 412 gp->g_flags &= ~GF_GRFON; 413 error = gp->g_mode(gp, (dev & GRFOVDEV) ? GM_GRFOVOFF : GM_GRFOFF, 414 NULL, 0, 0); 415 416 /* 417 * Closely tied together no X's 418 */ 419 if (gp->g_itedev != NODEV) 420 ite_on(gp->g_itedev, 2); 421 422 return(error); 423 } 424 425 int 426 grfsinfo(dev_t dev, struct grfdyninfo *dyninfo) 427 { 428 struct grf_softc *gp; 429 int error; 430 431 gp = grfsp[GRFUNIT(dev)]; 432 error = gp->g_mode(gp, GM_GRFCONFIG, dyninfo, 0, 0); 433 434 /* 435 * Closely tied together no X's 436 */ 437 if (gp->g_itedev != NODEV) 438 ite_reinit(gp->g_itedev); 439 return(error); 440 } 441 442 #if NWSDISPLAY > 0 443 void 444 grfcnprobe(struct consdev *cd) 445 { 446 struct grf_softc *gp; 447 int unit; 448 449 /* 450 * Find the first working grf device for being console. 451 * Ignore unit 0 (grfcc), which should use amidisplaycc instead. 452 */ 453 for (unit = 1; unit < NGRF; unit++) { 454 gp = grfsp[unit]; 455 if (gp != NULL && (gp->g_flags & GF_ALIVE)) { 456 cd->cn_pri = CN_INTERNAL; 457 cd->cn_dev = NODEV; /* initialized later by wscons */ 458 return; 459 } 460 } 461 462 /* no grf console alive */ 463 cd->cn_pri = CN_DEAD; 464 } 465 466 void 467 grfcninit(struct consdev *cd) 468 { 469 struct grf_softc *gp; 470 struct rasops_info *ri; 471 long defattr; 472 int unit; 473 474 /* find console grf and set up wsdisplay for it */ 475 for (unit = 1; unit < NGRF; unit++) { 476 gp = grfsp[unit]; 477 if (gp != NULL && (gp->g_flags & GF_ALIVE)) { 478 gp->g_flags |= GF_CONSOLE; /* we are console! */ 479 gp->g_screens[0]->ncols = gp->g_display.gd_fbwidth / 480 gp->g_screens[0]->fontwidth; 481 gp->g_screens[0]->nrows = gp->g_display.gd_fbheight / 482 gp->g_screens[0]->fontheight; 483 484 ri = grf_setup_rasops(gp, &console_vcons); 485 console_vcons.scr_cookie = gp; 486 defattr = 0; /* XXX */ 487 488 wsdisplay_preattach(gp->g_screens[0], ri, 0, 0, 489 defattr); 490 #if NKBD > 0 491 /* tell kbd device it is used as console keyboard */ 492 kbd_cnattach(); 493 #endif 494 return; 495 } 496 } 497 panic("grfcninit: lost console"); 498 } 499 500 static void 501 grf_init_screen(void *cookie, struct vcons_screen *scr, int existing, 502 long *defattr) 503 { 504 struct grf_softc *gp; 505 struct rasops_info *ri __unused; 506 507 gp = cookie; 508 ri = grf_setup_rasops(gp, scr); 509 } 510 511 static struct rasops_info * 512 grf_setup_rasops(struct grf_softc *gp, struct vcons_screen *scr) 513 { 514 struct rasops_info *ri; 515 int i; 516 517 ri = &scr->scr_ri; 518 scr->scr_flags |= VCONS_DONT_READ; 519 memset(ri, 0, sizeof(struct rasops_info)); 520 521 ri->ri_rows = gp->g_screens[0]->nrows; 522 ri->ri_cols = gp->g_screens[0]->ncols; 523 ri->ri_hw = scr; 524 ri->ri_ops.cursor = gp->g_emulops->cursor; 525 ri->ri_ops.mapchar = gp->g_emulops->mapchar; 526 ri->ri_ops.copyrows = gp->g_emulops->copyrows; 527 ri->ri_ops.eraserows = gp->g_emulops->eraserows; 528 ri->ri_ops.copycols = gp->g_emulops->copycols; 529 ri->ri_ops.erasecols = gp->g_emulops->erasecols; 530 ri->ri_ops.putchar = gp->g_emulops->putchar; 531 ri->ri_ops.allocattr = gp->g_emulops->allocattr; 532 533 /* multiplication table for row-offsets */ 534 for (i = 0; i < ri->ri_rows; i++) 535 gp->g_rowoffset[i] = i * ri->ri_cols; 536 537 return ri; 538 } 539 540 paddr_t 541 grf_wsmmap(void *v, void *vs, off_t off, int prot) 542 { 543 struct vcons_data *vd; 544 struct grf_softc *gp; 545 struct grfinfo *gi; 546 547 vd = v; 548 gp = vd->cookie; 549 gi = &gp->g_display; 550 551 /* Normal fb mapping */ 552 if (off < gi->gd_fbsize) 553 return grf_wsmmap_md(((bus_addr_t)gp->g_fbkva) + off); 554 555 if (kauth_authorize_machdep(kauth_cred_get(), KAUTH_MACHDEP_UNMANAGEDMEM, 556 NULL, NULL, NULL, NULL) != 0) { 557 aprint_normal("%s: permission to mmap denied.\n", 558 device_xname(gp->g_device)); 559 return -1; 560 } 561 562 if ((off >= (bus_addr_t)gp->g_fbkva ) && 563 (off < ( (bus_addr_t)gp->g_fbkva + (size_t)gi->gd_fbsize))) 564 return grf_wsmmap_md(off); 565 566 /* Handle register mapping */ 567 if ((off >= (bus_addr_t)gi->gd_regaddr) && 568 (off < ((bus_addr_t)gi->gd_regaddr + (size_t)gi->gd_regsize))) 569 return grf_wsmmap_md(off); 570 571 return -1; 572 } 573 574 static paddr_t 575 grf_wsmmap_md(off_t off) 576 { 577 #if defined(__m68k__) 578 return (paddr_t) m68k_btop(off); 579 #else 580 return -1; /* FIXME */ 581 #endif 582 } 583 584 int 585 grf_wsioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l) 586 { 587 struct vcons_data *vd; 588 struct grf_softc *gp; 589 590 vd = v; 591 gp = vd->cookie; 592 593 switch (cmd) { 594 /* XXX: check if ptr to implementation is not null */ 595 case WSDISPLAYIO_GINFO: 596 return gp->g_wsioctl->ginfo(gp, data); 597 case WSDISPLAYIO_SMODE: 598 return gp->g_wsioctl->smode(gp, data); 599 case WSDISPLAYIO_GMODE: 600 return gp->g_wsioctl->gmode(gp, data); 601 case WSDISPLAYIO_GTYPE: 602 return gp->g_wsioctl->gtype(gp, data); 603 case WSDISPLAYIO_SVIDEO: 604 return gp->g_wsioctl->svideo(gp, data); 605 case WSDISPLAYIO_GVIDEO: 606 return gp->g_wsioctl->gvideo(gp, data); 607 case WSDISPLAYIO_GETCMAP: 608 return gp->g_wsioctl->getcmap(gp, data); 609 case WSDISPLAYIO_PUTCMAP: 610 return gp->g_wsioctl->putcmap(gp, data); 611 } 612 613 return EPASSTHROUGH; 614 } 615 616 /* wsdisplay_accessops ioctls */ 617 618 int 619 grf_wsaogetcmap(void *c, void *data) 620 { 621 u_int index, count; 622 struct grf_softc *gp; 623 struct wsdisplay_cmap *cm __unused; 624 625 cm = (struct wsdisplay_cmap*) data; 626 gp = c; 627 index = 0; 628 count = 0; 629 630 if (gp->g_wsmode == WSDISPLAYIO_MODE_EMUL) 631 return EINVAL; 632 633 if (index >= 255 || count > 256 || index + count > 256) 634 return EINVAL; 635 636 /* 637 * TODO: copyout values for r, g, b. This function should be 638 * driver-specific... 639 */ 640 641 return 0; 642 } 643 644 int 645 grf_wsaoputcmap(void *c, void *data) 646 { 647 /* 648 * We probably couldn't care less about color map in MODE_EMUL, 649 * I don't know about X11 yet. Also, these ioctls could be used by 650 * fullscreen console programs (think wsdisplay picture viewer, or 651 * the wsimgshow tool written by Yasushi Oshima). 652 */ 653 struct grf_softc *gp; 654 655 gp = c; 656 657 if (gp->g_wsmode == WSDISPLAYIO_MODE_EMUL) 658 return EINVAL; 659 /* ... */ 660 661 return 0; 662 } 663 664 int 665 grf_wsaosvideo(void *c, void *data) 666 { 667 #if 0 668 struct grf_softc *gp; 669 dev_t dev; 670 int rv; 671 672 gp = c; 673 dev = (dev_t) &gp->g_grfdev; 674 675 if (*(u_int *)data == WSDISPLAYIO_VIDEO_OFF) { 676 if ((gp->g_flags & GF_GRFON) == 0) 677 rv = 0; 678 else { 679 gp->g_flags &= ~GF_GRFON; 680 rv = gp->g_mode(gp, (dev & GRFOVDEV) ? 681 GM_GRFOVOFF : GM_GRFOFF, NULL, 0, 0); 682 } 683 684 } else { 685 if ((gp->g_flags & GF_GRFON)) 686 rv = 0; 687 else 688 gp->g_flags |= GF_GRFON; 689 rv = gp->g_mode(gp, (dev & GRFOVDEV) ? 690 GM_GRFOVON : GM_GRFON, NULL, 0, 0); 691 } 692 693 return rv; 694 #endif 695 return 0; 696 } 697 698 int 699 grf_wsaogvideo(void *c, void *data) 700 { 701 struct grf_softc *gp; 702 703 gp = c; 704 705 if(gp->g_flags & GF_GRFON) 706 *(u_int *)data = WSDISPLAYIO_VIDEO_ON; 707 else 708 *(u_int *)data = WSDISPLAYIO_VIDEO_OFF; 709 710 return 0; 711 } 712 713 int 714 grf_wsaogtype(void *c, void *data) 715 { 716 struct grf_softc *gp __unused; 717 718 gp = c; 719 720 *(u_int *)data = WSDISPLAY_TYPE_GRF; 721 return 0; 722 } 723 724 int 725 grf_wsaogmode(void *c, void *data) 726 { 727 struct grf_softc *gp; 728 729 gp = c; 730 731 *(u_int *)data = gp->g_wsmode; 732 return 0; 733 } 734 735 int 736 grf_wsaosmode(void *c, void *data) 737 { 738 /* XXX: should provide hw-dependent impl of this in grf_xxx driver? */ 739 struct grf_softc *gp; 740 741 gp = c; 742 743 if ((*(int*) data) != gp->g_wsmode) { 744 gp->g_wsmode = (*(int*) data); 745 if ((*(int*) data) == WSDISPLAYIO_MODE_EMUL) { 746 //vcons_redraw_screen( active vcons screen ); 747 } 748 } 749 return 0; 750 } 751 752 int 753 grf_wsaoginfo(void *c, void *data) 754 { 755 struct wsdisplay_fbinfo *fbinfo; 756 struct grf_softc *gp; 757 struct grfinfo *gi; 758 759 gp = c; 760 761 fbinfo = (struct wsdisplay_fbinfo *)data; 762 gi = &gp->g_display; 763 764 /* 765 * TODO: better sanity checking, it is possible that 766 * wsdisplay is initialized, but no screen is opened 767 * (for example, device is not used). 768 */ 769 770 /* 771 * We shold return truth about current mode here because 772 * X11 wsfb driver denepds on this! 773 */ 774 fbinfo->height = gi->gd_fbheight; 775 fbinfo->width = gi->gd_fbwidth; 776 fbinfo->depth = gi->gd_planes; 777 fbinfo->cmsize = gi->gd_colors; 778 779 return 0; 780 } 781 782 #endif /* NWSDISPLAY > 0 */ 783 784 #ifdef DEBUG 785 void 786 grfdebug(struct grf_softc *gp, const char *fmt, ...) 787 { 788 static int ccol = 0, crow = 1; 789 volatile char *cp; 790 char buf[256]; 791 va_list ap; 792 int ncols; 793 char *bp; 794 795 va_start(ap, fmt); 796 vsnprintf(buf, 256, fmt, ap); 797 va_end(ap); 798 799 cp = gp->g_fbkva; 800 ncols = gp->g_display.gd_fbwidth / 8; 801 cp += (crow * ncols + ccol) << 2; 802 for (bp = buf; *bp != '\0'; bp++) { 803 if (*bp == '\n') { 804 ccol = 0; 805 crow++; 806 continue; 807 } 808 *cp++ = *bp; 809 *cp = 0x0a; 810 cp += 3; 811 ccol++; 812 } 813 } 814 #endif /* DEBUG */ 815 816 #endif /* NGRF > 0 */ 817