grf.c revision 1.58 1 /* $NetBSD: grf.c,v 1.58 2012/03/13 18:40:27 elad 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.58 2012/03/13 18:40:27 elad 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 grfopen, grfclose, nullread, nullwrite, grfioctl,
120 nostop, notty, nopoll, grfmmap, nokqfilter,
121 };
122
123 /*
124 * only used in console init.
125 */
126 static cfdata_t cfdata;
127
128 #if NWSDISPLAY > 0
129 static struct vcons_screen console_vcons;
130
131 static void grf_init_screen(void *, struct vcons_screen *, int, long *);
132 static struct rasops_info *grf_setup_rasops(struct grf_softc *,
133 struct vcons_screen *);
134 static paddr_t grf_wsmmap_md(off_t off);
135
136 cons_decl(grf);
137 #endif
138
139 /*
140 * match if the unit of grf matches its perspective
141 * low level board driver.
142 */
143 int
144 grfmatch(device_t pdp, cfdata_t cfp, void *auxp)
145 {
146
147 if (cfp->cf_unit != ((struct grf_softc *)pdp)->g_unit)
148 return(0);
149 cfdata = cfp;
150 return(1);
151 }
152
153 /*
154 * Attach.. plug pointer in and print some info.
155 * Then try and attach a wsdisplay or ite to us.
156 * Note: dp is NULL durring console init.
157 */
158 void
159 grfattach(device_t pdp, device_t dp, void *auxp)
160 {
161 #if NWSDISPLAY > 0
162 struct wsemuldisplaydev_attach_args wa;
163 long defattr;
164 #endif
165 struct grf_softc *gp;
166 int maj;
167
168 gp = (struct grf_softc *)pdp;
169 grfsp[gp->g_unit] = (struct grf_softc *)pdp;
170
171 /*
172 * find our major device number
173 */
174 maj = cdevsw_lookup_major(&grf_cdevsw);
175
176 gp->g_grfdev = makedev(maj, gp->g_unit);
177 if (dp != NULL) {
178 printf(": width %d height %d", gp->g_display.gd_dwidth,
179 gp->g_display.gd_dheight);
180 if (gp->g_display.gd_colors == 2)
181 printf(" monochrome\n");
182 else
183 printf(" colors %d\n", gp->g_display.gd_colors);
184 #if NWSDISPLAY > 0
185 vcons_init(&gp->g_vd, gp, gp->g_screens[0], gp->g_accessops);
186 gp->g_vd.init_screen = grf_init_screen;
187 if (gp->g_flags & GF_CONSOLE) {
188 console_vcons.scr_flags |= VCONS_SCREEN_IS_STATIC;
189 vcons_init_screen(&gp->g_vd,
190 &console_vcons, 1, &defattr);
191 gp->g_screens[0]->textops =
192 &console_vcons.scr_ri.ri_ops;
193 wsdisplay_cnattach(gp->g_screens[0],
194 &console_vcons.scr_ri, 0, 0, defattr);
195 vcons_replay_msgbuf(&console_vcons);
196 }
197
198 /* attach wsdisplay */
199 wa.console = (gp->g_flags & GF_CONSOLE) != 0;
200 wa.scrdata = &gp->g_screenlist;
201 wa.accessops = gp->g_accessops;
202 wa.accesscookie = &gp->g_vd;
203 config_found(dp, &wa, wsemuldisplaydevprint);
204 #endif /* NWSDISPLAY > 0 */
205 }
206
207 #if NWSDISPLAY == 0
208 /*
209 * try and attach an ite
210 */
211 amiga_config_found(cfdata, dp, gp, grfprint);
212 #endif
213 }
214
215 int
216 grfprint(void *auxp, const char *pnp)
217 {
218 if (pnp)
219 aprint_normal("ite at %s", pnp);
220 return(UNCONF);
221 }
222
223 /*ARGSUSED*/
224 int
225 grfopen(dev_t dev, int flags, int devtype, struct lwp *l)
226 {
227 struct grf_softc *gp;
228
229 if (GRFUNIT(dev) >= NGRF || (gp = grfsp[GRFUNIT(dev)]) == NULL)
230 return(ENXIO);
231
232 if ((gp->g_flags & GF_ALIVE) == 0)
233 return(ENXIO);
234
235 if ((gp->g_flags & (GF_OPEN|GF_EXCLUDE)) == (GF_OPEN|GF_EXCLUDE))
236 return(EBUSY);
237
238 return(0);
239 }
240
241 /*ARGSUSED*/
242 int
243 grfclose(dev_t dev, int flags, int mode, struct lwp *l)
244 {
245 struct grf_softc *gp;
246
247 gp = grfsp[GRFUNIT(dev)];
248 (void)grfoff(dev);
249 gp->g_flags &= GF_ALIVE;
250 return(0);
251 }
252
253 /*ARGSUSED*/
254 int
255 grfioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
256 {
257 struct grf_softc *gp;
258 int error;
259
260 gp = grfsp[GRFUNIT(dev)];
261 error = 0;
262
263 switch (cmd) {
264 case OGRFIOCGINFO:
265 /* argl.. no bank-member.. */
266 memcpy(data, (void *)&gp->g_display, sizeof(struct grfinfo)-4);
267 break;
268 case GRFIOCGINFO:
269 memcpy(data, (void *)&gp->g_display, sizeof(struct grfinfo));
270 break;
271 case GRFIOCON:
272 error = grfon(dev);
273 break;
274 case GRFIOCOFF:
275 error = grfoff(dev);
276 break;
277 case GRFIOCSINFO:
278 error = grfsinfo(dev, (struct grfdyninfo *) data);
279 break;
280 case GRFGETVMODE:
281 return(gp->g_mode(gp, GM_GRFGETVMODE, data, 0, 0));
282 case GRFSETVMODE:
283 error = gp->g_mode(gp, GM_GRFSETVMODE, data, 0, 0);
284 if (error == 0 && gp->g_itedev && !(gp->g_flags & GF_GRFON))
285 ite_reinit(gp->g_itedev);
286 break;
287 case GRFGETNUMVM:
288 return(gp->g_mode(gp, GM_GRFGETNUMVM, data, 0, 0));
289 /*
290 * these are all hardware dependent, and have to be resolved
291 * in the respective driver.
292 */
293 case GRFIOCPUTCMAP:
294 case GRFIOCGETCMAP:
295 case GRFIOCSSPRITEPOS:
296 case GRFIOCGSPRITEPOS:
297 case GRFIOCSSPRITEINF:
298 case GRFIOCGSPRITEINF:
299 case GRFIOCGSPRITEMAX:
300 case GRFIOCBITBLT:
301 case GRFIOCSETMON:
302 case GRFTOGGLE: /* Toggles between Cirrus boards and native ECS on
303 Amiga. 15/11/94 ill */
304 /*
305 * We need the minor dev number to get the overlay/image
306 * information for grf_ul.
307 */
308 return(gp->g_mode(gp, GM_GRFIOCTL, data, cmd, dev));
309
310 case GRFIOCBLANK: /* blank ioctl, IOCON/OFF will turn ite on */
311 case FBIOSVIDEO:
312 error = gp->g_mode(gp, GM_GRFIOCTL, data, GRFIOCBLANK, dev);
313 if (!error)
314 gp->g_blank = *(int *)data;
315 return (error);
316
317 case FBIOGVIDEO:
318 *(int *)data = gp->g_blank;
319 return (0);
320
321 default:
322 #if NVIEW > 0
323 /*
324 * check to see whether it's a command recognized by the
325 * view code if the unit is 0
326 * XXX
327 */
328 if (GRFUNIT(dev) == 0) {
329 extern const struct cdevsw view_cdevsw;
330
331 return((*view_cdevsw.d_ioctl)(dev, cmd, data, flag, l));
332 }
333 #endif
334 error = EPASSTHROUGH;
335 break;
336
337 }
338 return(error);
339 }
340
341 /*
342 * map the contents of a graphics display card into process'
343 * memory space.
344 */
345 paddr_t
346 grfmmap(dev_t dev, off_t off, int prot)
347 {
348 struct grf_softc *gp;
349 struct grfinfo *gi;
350
351 gp = grfsp[GRFUNIT(dev)];
352 gi = &gp->g_display;
353
354 /*
355 * control registers
356 */
357 if (off >= 0 && off < gi->gd_regsize)
358 return(((paddr_t)gi->gd_regaddr + off) >> PGSHIFT);
359
360 /*
361 * frame buffer
362 */
363 if (off >= gi->gd_regsize && off < gi->gd_regsize+gi->gd_fbsize) {
364 off -= gi->gd_regsize;
365 return(((paddr_t)gi->gd_fbaddr + off) >> PGSHIFT);
366 }
367 /* bogus */
368 return(-1);
369 }
370
371 int
372 grfon(dev_t dev)
373 {
374 struct grf_softc *gp;
375
376 gp = grfsp[GRFUNIT(dev)];
377
378 if (gp->g_flags & GF_GRFON)
379 return(0);
380
381 gp->g_flags |= GF_GRFON;
382 if (gp->g_itedev != NODEV)
383 ite_off(gp->g_itedev, 3);
384
385 return(gp->g_mode(gp, (dev & GRFOVDEV) ? GM_GRFOVON : GM_GRFON,
386 NULL, 0, 0));
387 }
388
389 int
390 grfoff(dev_t dev)
391 {
392 struct grf_softc *gp;
393 int error;
394
395 gp = grfsp[GRFUNIT(dev)];
396
397 if ((gp->g_flags & GF_GRFON) == 0)
398 return(0);
399
400 gp->g_flags &= ~GF_GRFON;
401 error = gp->g_mode(gp, (dev & GRFOVDEV) ? GM_GRFOVOFF : GM_GRFOFF,
402 NULL, 0, 0);
403
404 /*
405 * Closely tied together no X's
406 */
407 if (gp->g_itedev != NODEV)
408 ite_on(gp->g_itedev, 2);
409
410 return(error);
411 }
412
413 int
414 grfsinfo(dev_t dev, struct grfdyninfo *dyninfo)
415 {
416 struct grf_softc *gp;
417 int error;
418
419 gp = grfsp[GRFUNIT(dev)];
420 error = gp->g_mode(gp, GM_GRFCONFIG, dyninfo, 0, 0);
421
422 /*
423 * Closely tied together no X's
424 */
425 if (gp->g_itedev != NODEV)
426 ite_reinit(gp->g_itedev);
427 return(error);
428 }
429
430 #if NWSDISPLAY > 0
431 void
432 grfcnprobe(struct consdev *cd)
433 {
434 struct grf_softc *gp;
435 int unit;
436
437 /*
438 * Find the first working grf device for being console.
439 * Ignore unit 0 (grfcc), which should use amidisplaycc instead.
440 */
441 for (unit = 1; unit < NGRF; unit++) {
442 gp = grfsp[unit];
443 if (gp != NULL && (gp->g_flags & GF_ALIVE)) {
444 cd->cn_pri = CN_INTERNAL;
445 cd->cn_dev = NODEV; /* initialized later by wscons */
446 return;
447 }
448 }
449
450 /* no grf console alive */
451 cd->cn_pri = CN_DEAD;
452 }
453
454 void
455 grfcninit(struct consdev *cd)
456 {
457 struct grf_softc *gp;
458 struct rasops_info *ri;
459 long defattr;
460 int unit;
461
462 /* find console grf and set up wsdisplay for it */
463 for (unit = 1; unit < NGRF; unit++) {
464 gp = grfsp[unit];
465 if (gp != NULL && (gp->g_flags & GF_ALIVE)) {
466 gp->g_flags |= GF_CONSOLE; /* we are console! */
467 gp->g_screens[0]->ncols = gp->g_display.gd_fbwidth /
468 gp->g_screens[0]->fontwidth;
469 gp->g_screens[0]->nrows = gp->g_display.gd_fbheight /
470 gp->g_screens[0]->fontheight;
471
472 ri = grf_setup_rasops(gp, &console_vcons);
473 console_vcons.scr_cookie = gp;
474 defattr = 0; /* XXX */
475
476 wsdisplay_preattach(gp->g_screens[0], ri, 0, 0,
477 defattr);
478 #if NKBD > 0
479 /* tell kbd device it is used as console keyboard */
480 kbd_cnattach();
481 #endif
482 return;
483 }
484 }
485 panic("grfcninit: lost console");
486 }
487
488 static void
489 grf_init_screen(void *cookie, struct vcons_screen *scr, int existing,
490 long *defattr)
491 {
492 struct grf_softc *gp;
493 struct rasops_info *ri;
494
495 gp = cookie;
496 ri = grf_setup_rasops(gp, scr);
497 }
498
499 static struct rasops_info *
500 grf_setup_rasops(struct grf_softc *gp, struct vcons_screen *scr)
501 {
502 struct rasops_info *ri;
503 int i;
504
505 ri = &scr->scr_ri;
506 scr->scr_flags |= VCONS_DONT_READ;
507 memset(ri, 0, sizeof(struct rasops_info));
508
509 ri->ri_rows = gp->g_screens[0]->nrows;
510 ri->ri_cols = gp->g_screens[0]->ncols;
511 ri->ri_hw = scr;
512 ri->ri_ops.cursor = gp->g_emulops->cursor;
513 ri->ri_ops.mapchar = gp->g_emulops->mapchar;
514 ri->ri_ops.copyrows = gp->g_emulops->copyrows;
515 ri->ri_ops.eraserows = gp->g_emulops->eraserows;
516 ri->ri_ops.copycols = gp->g_emulops->copycols;
517 ri->ri_ops.erasecols = gp->g_emulops->erasecols;
518 ri->ri_ops.putchar = gp->g_emulops->putchar;
519 ri->ri_ops.allocattr = gp->g_emulops->allocattr;
520
521 /* multiplication table for row-offsets */
522 for (i = 0; i < ri->ri_rows; i++)
523 gp->g_rowoffset[i] = i * ri->ri_cols;
524
525 return ri;
526 }
527
528 paddr_t
529 grf_wsmmap(void *v, void *vs, off_t off, int prot)
530 {
531 struct vcons_data *vd;
532 struct grf_softc *gp;
533 struct grfinfo *gi;
534
535 vd = v;
536 gp = vd->cookie;
537 gi = &gp->g_display;
538
539 /* Normal fb mapping */
540 if (off < gi->gd_fbsize)
541 return grf_wsmmap_md(((bus_addr_t)gp->g_fbkva) + off);
542
543 if (kauth_authorize_machdep(kauth_cred_get(), KAUTH_MACHDEP_UNMANAGEDMEM,
544 NULL, NULL, NULL, NULL) != 0) {
545 aprint_normal("%s: permission to mmap denied.\n",
546 device_xname(&gp->g_device));
547 return -1;
548 }
549
550 if ((off >= (bus_addr_t)gp->g_fbkva ) &&
551 (off < ( (bus_addr_t)gp->g_fbkva + (size_t)gi->gd_fbsize)))
552 return grf_wsmmap_md(off);
553
554 /* Handle register mapping */
555 if ((off >= (bus_addr_t)gi->gd_regaddr) &&
556 (off < ((bus_addr_t)gi->gd_regaddr + (size_t)gi->gd_regsize)))
557 return grf_wsmmap_md(off);
558
559 return -1;
560 }
561
562 static paddr_t
563 grf_wsmmap_md(off_t off)
564 {
565 #if defined(__m68k__)
566 return (paddr_t) m68k_btop(off);
567 #else
568 return -1; /* FIXME */
569 #endif
570 }
571
572 int
573 grf_wsioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
574 {
575 struct vcons_data *vd;
576 struct grf_softc *gp;
577
578 vd = v;
579 gp = vd->cookie;
580
581 switch (cmd) {
582 /* XXX: check if ptr to implementation is not null */
583 case WSDISPLAYIO_GINFO:
584 return gp->g_wsioctl->ginfo(gp, data);
585 case WSDISPLAYIO_SMODE:
586 return gp->g_wsioctl->smode(gp, data);
587 case WSDISPLAYIO_GMODE:
588 return gp->g_wsioctl->gmode(gp, data);
589 case WSDISPLAYIO_GTYPE:
590 return gp->g_wsioctl->gtype(gp, data);
591 case WSDISPLAYIO_SVIDEO:
592 return gp->g_wsioctl->svideo(gp, data);
593 case WSDISPLAYIO_GVIDEO:
594 return gp->g_wsioctl->gvideo(gp, data);
595 case WSDISPLAYIO_GETCMAP:
596 return gp->g_wsioctl->getcmap(gp, data);
597 case WSDISPLAYIO_PUTCMAP:
598 return gp->g_wsioctl->putcmap(gp, data);
599 }
600
601 return EPASSTHROUGH;
602 }
603
604 /* wsdisplay_accessops ioctls */
605
606 int
607 grf_wsaogetcmap(void *c, void *data)
608 {
609 u_int index, count;
610 struct grf_softc *gp;
611 struct wsdisplay_cmap *cm;
612
613 cm = (struct wsdisplay_cmap*) data;
614 gp = c;
615 index = 0;
616 count = 0;
617
618 if (gp->g_wsmode == WSDISPLAYIO_MODE_EMUL)
619 return EINVAL;
620
621 if (index >= 255 || count > 256 || index + count > 256)
622 return EINVAL;
623
624 /*
625 * TODO: copyout values for r, g, b. This function should be
626 * driver-specific...
627 */
628
629 return 0;
630 }
631
632 int
633 grf_wsaoputcmap(void *c, void *data)
634 {
635 /*
636 * We probably couldn't care less about color map in MODE_EMUL,
637 * I don't know about X11 yet. Also, these ioctls could be used by
638 * fullscreen console programs (think wsdisplay picture viewer, or
639 * the wsimgshow tool written by Yasushi Oshima).
640 */
641 struct grf_softc *gp;
642
643 gp = c;
644
645 if (gp->g_wsmode == WSDISPLAYIO_MODE_EMUL)
646 return EINVAL;
647 /* ... */
648
649 return 0;
650 }
651
652 int
653 grf_wsaosvideo(void *c, void *data)
654 {
655 #if 0
656 struct grf_softc *gp;
657 dev_t dev;
658 int rv;
659
660 gp = c;
661 dev = (dev_t) &gp->g_grfdev;
662
663 if (*(u_int *)data == WSDISPLAYIO_VIDEO_OFF) {
664 if ((gp->g_flags & GF_GRFON) == 0)
665 rv = 0;
666 else {
667 gp->g_flags &= ~GF_GRFON;
668 rv = gp->g_mode(gp, (dev & GRFOVDEV) ?
669 GM_GRFOVOFF : GM_GRFOFF, NULL, 0, 0);
670 }
671
672 } else {
673 if ((gp->g_flags & GF_GRFON))
674 rv = 0;
675 else
676 gp->g_flags |= GF_GRFON;
677 rv = gp->g_mode(gp, (dev & GRFOVDEV) ?
678 GM_GRFOVON : GM_GRFON, NULL, 0, 0);
679 }
680
681 return rv;
682 #endif
683 return 0;
684 }
685
686 int
687 grf_wsaogvideo(void *c, void *data)
688 {
689 struct grf_softc *gp;
690
691 gp = c;
692
693 if(gp->g_flags & GF_GRFON)
694 *(u_int *)data = WSDISPLAYIO_VIDEO_ON;
695 else
696 *(u_int *)data = WSDISPLAYIO_VIDEO_OFF;
697
698 return 0;
699 }
700
701 int
702 grf_wsaogtype(void *c, void *data)
703 {
704 struct grf_softc *gp;
705
706 gp = c;
707
708 *(u_int *)data = WSDISPLAY_TYPE_GRF;
709 return 0;
710 }
711
712 int
713 grf_wsaogmode(void *c, void *data)
714 {
715 struct grf_softc *gp;
716
717 gp = c;
718
719 *(u_int *)data = gp->g_wsmode;
720 return 0;
721 }
722
723 int
724 grf_wsaosmode(void *c, void *data)
725 {
726 /* XXX: should provide hw-dependent impl of this in grf_xxx driver? */
727 struct grf_softc *gp;
728
729 gp = c;
730
731 if ((*(int*) data) != gp->g_wsmode) {
732 gp->g_wsmode = (*(int*) data);
733 if ((*(int*) data) == WSDISPLAYIO_MODE_EMUL) {
734 //vcons_redraw_screen( active vcons screen );
735 }
736 }
737 return 0;
738 }
739
740 int
741 grf_wsaoginfo(void *c, void *data)
742 {
743 struct wsdisplay_fbinfo *fbinfo;
744 struct grf_softc *gp;
745 struct grfinfo *gi;
746
747 gp = c;
748
749 fbinfo = (struct wsdisplay_fbinfo *)data;
750 gi = &gp->g_display;
751
752 /*
753 * TODO: better sanity checking, it is possible that
754 * wsdisplay is initialized, but no screen is opened
755 * (for example, device is not used).
756 */
757
758 /*
759 * We shold return truth about current mode here because
760 * X11 wsfb driver denepds on this!
761 */
762 fbinfo->height = gi->gd_fbheight;
763 fbinfo->width = gi->gd_fbwidth;
764 fbinfo->depth = gi->gd_planes;
765 fbinfo->cmsize = gi->gd_colors;
766
767 return 0;
768 }
769
770 #endif /* NWSDISPLAY > 0 */
771
772 #ifdef DEBUG
773 void
774 grfdebug(struct grf_softc *gp, const char *fmt, ...)
775 {
776 static int ccol = 0, crow = 1;
777 volatile char *cp;
778 char buf[256];
779 va_list ap;
780 int ncols;
781 char *bp;
782
783 va_start(ap, fmt);
784 vsnprintf(buf, 256, fmt, ap);
785 va_end(ap);
786
787 cp = gp->g_fbkva;
788 ncols = gp->g_display.gd_fbwidth / 8;
789 cp += (crow * ncols + ccol) << 2;
790 for (bp = buf; *bp != '\0'; bp++) {
791 if (*bp == '\n') {
792 ccol = 0;
793 crow++;
794 continue;
795 }
796 *cp++ = *bp;
797 *cp = 0x0a;
798 cp += 3;
799 ccol++;
800 }
801 }
802 #endif /* DEBUG */
803
804 #endif /* NGRF > 0 */
805