Annotation of sys/dev/vesa/vesafb.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: vesafb.c,v 1.4 2007/02/18 19:19:02 gwk Exp $ */
! 2:
! 3: /*-
! 4: * Copyright (c) 2006 Jared D. McNeill <jmcneill@invisible.ca>
! 5: * All rights reserved.
! 6: *
! 7: * Redistribution and use in source and binary forms, with or without
! 8: * modification, are permitted provided that the following conditions
! 9: * are met:
! 10: * 1. Redistributions of source code must retain the above copyright
! 11: * notice, this list of conditions and the following disclaimer.
! 12: * 2. Redistributions in binary form must reproduce the above copyright
! 13: * notice, this list of conditions and the following disclaimer in the
! 14: * documentation and/or other materials provided with the distribution.
! 15: * 3. All advertising materials mentioning features or use of this software
! 16: * must display the following acknowledgement:
! 17: * This product includes software developed by the NetBSD
! 18: * Foundation, Inc. and its contributors.
! 19: * 4. Neither the name of The NetBSD Foundation nor the names of its
! 20: * contributors may be used to endorse or promote products derived
! 21: * from this software without specific prior written permission.
! 22: *
! 23: * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
! 24: * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
! 25: * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
! 26: * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
! 27: * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
! 28: * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
! 29: * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
! 30: * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
! 31: * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
! 32: * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
! 33: * POSSIBILITY OF SUCH DAMAGE.
! 34: */
! 35: /*
! 36: * Copyright (c) 2006 Matthieu Herrb
! 37: *
! 38: * Permission to use, copy, modify, and distribute this software for any
! 39: * purpose with or without fee is hereby granted, provided that the above
! 40: * copyright notice and this permission notice appear in all copies.
! 41: *
! 42: * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
! 43: * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
! 44: * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
! 45: * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
! 46: * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
! 47: * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
! 48: * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
! 49: */
! 50:
! 51: #include <sys/param.h>
! 52: #include <sys/systm.h>
! 53: #include <sys/kernel.h>
! 54: #include <sys/device.h>
! 55:
! 56: #include <machine/bus.h>
! 57:
! 58: #include <dev/pci/pcireg.h>
! 59: #include <dev/pci/pcivar.h>
! 60: #include <dev/pci/pcidevs.h>
! 61:
! 62: #include <dev/ic/mc6845reg.h>
! 63: #include <dev/ic/pcdisplayvar.h>
! 64: #include <dev/ic/vgareg.h>
! 65: #include <dev/ic/vgavar.h>
! 66: #include <dev/pci/vga_pcivar.h>
! 67:
! 68: #include <dev/vesa/vesabiosreg.h>
! 69: #include <dev/vesa/vesabiosvar.h>
! 70: #include <dev/vesa/vbe.h>
! 71:
! 72: #include <machine/frame.h>
! 73: #include <machine/kvm86.h>
! 74:
! 75: #include <dev/wscons/wsconsio.h>
! 76: #include <dev/wscons/wsdisplayvar.h>
! 77:
! 78: #include <uvm/uvm_extern.h>
! 79:
! 80:
! 81: void vesafb_set_mode(struct vga_pci_softc *, int);
! 82: int vesafb_get_mode(struct vga_pci_softc *);
! 83: void vesafb_get_mode_info(struct vga_pci_softc *, int, struct modeinfoblock *);
! 84: void vesafb_set_palette(struct vga_pci_softc *, int, struct paletteentry);
! 85: int vesafb_putcmap(struct vga_pci_softc *, struct wsdisplay_cmap *);
! 86: int vesafb_getcmap(struct vga_pci_softc *, struct wsdisplay_cmap *);
! 87: int vesafb_get_ddc_version(struct vga_pci_softc *);
! 88: int vesafb_get_ddc_info(struct vga_pci_softc *, struct edid *);
! 89:
! 90: int
! 91: vesafb_get_ddc_version(struct vga_pci_softc *sc)
! 92: {
! 93: struct trapframe tf;
! 94: int res;
! 95:
! 96: bzero(&tf, sizeof(struct trapframe));
! 97: tf.tf_eax = VBE_FUNC_DDC;
! 98:
! 99: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 100: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED)
! 101: return 0;
! 102:
! 103: return VBECALL_SUCESS(tf.tf_eax);
! 104: }
! 105:
! 106:
! 107: int
! 108: vesafb_get_ddc_info(struct vga_pci_softc *sc, struct edid *info)
! 109: {
! 110: struct trapframe tf;
! 111: unsigned char *buf;
! 112: int res;
! 113:
! 114: if ((buf = kvm86_bios_addpage(KVM86_CALL_TASKVA)) == NULL) {
! 115: printf("%s: kvm86_bios_addpage failed.\n",
! 116: sc->sc_dev.dv_xname);
! 117: return 1;
! 118: }
! 119:
! 120: bzero(&tf, sizeof(struct trapframe));
! 121: tf.tf_eax = VBE_FUNC_DDC;
! 122: tf.tf_ebx = VBE_DDC_GET;
! 123: tf.tf_vm86_es = 0;
! 124: tf.tf_edi = KVM86_CALL_TASKVA;
! 125:
! 126: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 127: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
! 128: kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
! 129: return 1;
! 130: }
! 131:
! 132: memcpy(info, buf, sizeof(struct edid));
! 133: kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
! 134: return VBECALL_SUCESS(tf.tf_eax);
! 135: }
! 136:
! 137: int
! 138: vesafb_get_mode(struct vga_pci_softc *sc)
! 139: {
! 140: struct trapframe tf;
! 141: int res;
! 142:
! 143: bzero(&tf, sizeof(struct trapframe));
! 144: tf.tf_eax = VBE_FUNC_GETMODE;
! 145:
! 146: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 147: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
! 148: printf("%s: vbecall: res=%d, ax=%x\n",
! 149: sc->sc_dev.dv_xname, res, tf.tf_eax);
! 150: }
! 151: return tf.tf_ebx & 0xffff;
! 152: }
! 153:
! 154: void
! 155: vesafb_get_mode_info(struct vga_pci_softc *sc, int mode,
! 156: struct modeinfoblock *mi)
! 157: {
! 158: struct trapframe tf;
! 159: unsigned char *buf;
! 160: int res;
! 161:
! 162: if ((buf = kvm86_bios_addpage(KVM86_CALL_TASKVA)) == NULL) {
! 163: printf("%s: kvm86_bios_addpage failed.\n",
! 164: sc->sc_dev.dv_xname);
! 165: return;
! 166: }
! 167: memset(&tf, 0, sizeof(struct trapframe));
! 168: tf.tf_eax = VBE_FUNC_MODEINFO;
! 169: tf.tf_ecx = mode;
! 170: tf.tf_vm86_es = 0;
! 171: tf.tf_edi = KVM86_CALL_TASKVA;
! 172:
! 173: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 174: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
! 175: printf("%s: vbecall: res=%d, ax=%x\n",
! 176: sc->sc_dev.dv_xname, res, tf.tf_eax);
! 177: printf("%s: error getting info for mode %05x\n",
! 178: sc->sc_dev.dv_xname, mode);
! 179: kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
! 180: return;
! 181: }
! 182: memcpy(mi, buf, sizeof(struct modeinfoblock));
! 183: kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
! 184: }
! 185:
! 186: void
! 187: vesafb_set_palette(struct vga_pci_softc *sc, int reg, struct paletteentry pe)
! 188: {
! 189: struct trapframe tf;
! 190: int res;
! 191: char *buf;
! 192:
! 193: if ((buf = kvm86_bios_addpage(KVM86_CALL_TASKVA)) == NULL) {
! 194: printf("%s: kvm86_bios_addpage failed.\n",
! 195: sc->sc_dev.dv_xname);
! 196: return;
! 197: }
! 198: /*
! 199: * this function takes 8 bit per palette as input, but we're
! 200: * working in 6 bit mode here
! 201: */
! 202: pe.Red >>= 2;
! 203: pe.Green >>= 2;
! 204: pe.Blue >>= 2;
! 205:
! 206: memcpy(buf, &pe, sizeof(struct paletteentry));
! 207:
! 208: /* set palette */
! 209: memset(&tf, 0, sizeof(struct trapframe));
! 210: tf.tf_eax = VBE_FUNC_PALETTE;
! 211: tf.tf_ebx = 0x0600; /* 6 bit per primary, set format */
! 212: tf.tf_ecx = 1;
! 213: tf.tf_edx = reg;
! 214: tf.tf_vm86_es = 0;
! 215: tf.tf_edi = KVM86_CALL_TASKVA;
! 216:
! 217: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 218: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED)
! 219: printf("%s: vbecall: res=%d, ax=%x\n",
! 220: sc->sc_dev.dv_xname, res, tf.tf_eax);
! 221:
! 222: kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
! 223: return;
! 224: }
! 225:
! 226: void
! 227: vesafb_set_mode(struct vga_pci_softc *sc, int mode)
! 228: {
! 229: struct trapframe tf;
! 230: int res;
! 231:
! 232: bzero(&tf, sizeof(struct trapframe));
! 233: tf.tf_eax = VBE_FUNC_SETMODE;
! 234: tf.tf_ebx = mode | 0x4000; /* flat */
! 235:
! 236: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 237: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
! 238: printf("%s: vbecall: res=%d, ax=%x\n",
! 239: sc->sc_dev.dv_xname, res, tf.tf_eax);
! 240: return;
! 241: }
! 242: }
! 243:
! 244: int
! 245: vesafb_find_mode(struct vga_pci_softc *sc, int width, int height, int bpp)
! 246: {
! 247: struct modeinfoblock mi;
! 248: int i;
! 249:
! 250: if (vesabios_softc == NULL || vesabios_softc->sc_nmodes == 0)
! 251: return -1;
! 252: #ifdef VESABIOSVERBOSE
! 253: printf("vesafb_find_mode %d %d %d\n", width, height, bpp);
! 254: #endif
! 255: /* Choose a graphics mode */
! 256: for (i = 0; i < vesabios_softc->sc_nmodes; i++) {
! 257: vesafb_get_mode_info(sc, vesabios_softc->sc_modes[i], &mi);
! 258: if (mi.XResolution == width &&
! 259: mi.YResolution == height &&
! 260: mi.BitsPerPixel == bpp) {
! 261: sc->sc_width = mi.XResolution;
! 262: sc->sc_height = mi.YResolution;
! 263: sc->sc_depth = mi.BitsPerPixel;
! 264: sc->sc_linebytes = mi.BytesPerScanLine;
! 265: sc->sc_base = mi.PhysBasePtr;
! 266: break;
! 267: }
! 268: }
! 269: if (i == vesabios_softc->sc_nmodes)
! 270: return -1;
! 271: else
! 272: return vesabios_softc->sc_modes[i];
! 273: }
! 274:
! 275: int
! 276: vesafb_putcmap(struct vga_pci_softc *sc, struct wsdisplay_cmap *cm)
! 277: {
! 278: struct paletteentry pe;
! 279: u_int idx, cnt;
! 280: u_char r[256], g[256], b[256];
! 281: u_char *rp, *gp, *bp;
! 282: int rv, i;
! 283:
! 284: idx = cm->index;
! 285: cnt = cm->count;
! 286:
! 287: if (idx >= 256 || cnt > 256 - idx)
! 288: return EINVAL;
! 289:
! 290: rv = copyin(cm->red, &r[idx], cnt);
! 291: if (rv)
! 292: return rv;
! 293: rv = copyin(cm->green, &g[idx], cnt);
! 294: if (rv)
! 295: return rv;
! 296: rv = copyin(cm->blue, &b[idx], cnt);
! 297: if (rv)
! 298: return rv;
! 299:
! 300: memcpy(&sc->sc_cmap_red[idx], &r[idx], cnt);
! 301: memcpy(&sc->sc_cmap_green[idx], &g[idx], cnt);
! 302: memcpy(&sc->sc_cmap_blue[idx], &b[idx], cnt);
! 303:
! 304: rp = &sc->sc_cmap_red[idx];
! 305: gp = &sc->sc_cmap_green[idx];
! 306: bp = &sc->sc_cmap_blue[idx];
! 307:
! 308: for (i = 0; i < cnt; i++) {
! 309: pe.Blue = *bp;
! 310: pe.Green = *gp;
! 311: pe.Red = *rp;
! 312: pe.Alignment = 0;
! 313: vesafb_set_palette(sc, idx, pe);
! 314: idx++;
! 315: rp++, gp++, bp++;
! 316: }
! 317:
! 318: return 0;
! 319: }
! 320:
! 321: int
! 322: vesafb_getcmap(struct vga_pci_softc *sc, struct wsdisplay_cmap *cm)
! 323: {
! 324: u_int idx, cnt;
! 325: int rv;
! 326:
! 327: idx = cm->index;
! 328: cnt = cm->count;
! 329:
! 330: if (idx >= 256 || cnt > 256 - idx)
! 331: return EINVAL;
! 332:
! 333: rv = copyout(&sc->sc_cmap_red[idx], cm->red, cnt);
! 334: if (rv)
! 335: return rv;
! 336: rv = copyout(&sc->sc_cmap_green[idx], cm->green, cnt);
! 337: if (rv)
! 338: return rv;
! 339: rv = copyout(&sc->sc_cmap_blue[idx], cm->blue, cnt);
! 340: if (rv)
! 341: return rv;
! 342:
! 343: return 0;
! 344: }
! 345:
! 346: static int
! 347: vesafb_getdepthflag(struct modeinfoblock *mi)
! 348: {
! 349: int bpp, depth;
! 350:
! 351: depth = mi->RedMaskSize + mi->GreenMaskSize + mi->BlueMaskSize;
! 352: bpp = mi->BitsPerPixel;
! 353: switch (depth) {
! 354: case 1:
! 355: return WSDISPLAYIO_DEPTH_1;
! 356: case 4:
! 357: return WSDISPLAYIO_DEPTH_4;
! 358: case 8:
! 359: return WSDISPLAYIO_DEPTH_8;
! 360: case 15:
! 361: return WSDISPLAYIO_DEPTH_15;
! 362: case 16:
! 363: return WSDISPLAYIO_DEPTH_16;
! 364: case 24:
! 365: switch (bpp) {
! 366: case 24:
! 367: return WSDISPLAYIO_DEPTH_24_24;
! 368: case 32:
! 369: return WSDISPLAYIO_DEPTH_24_32;
! 370: }
! 371: }
! 372: return 0;
! 373: }
! 374:
! 375:
! 376: int
! 377: vesafb_get_supported_depth(struct vga_pci_softc *sc)
! 378: {
! 379: int i, depths;
! 380: struct modeinfoblock mi;
! 381:
! 382: depths = 0;
! 383:
! 384: if (vesabios_softc == NULL || vesabios_softc->sc_nmodes == 0)
! 385: return 0;
! 386:
! 387: for (i = 0; i < vesabios_softc->sc_nmodes; i++) {
! 388: vesafb_get_mode_info(sc, vesabios_softc->sc_modes[i], &mi);
! 389: depths |= vesafb_getdepthflag(&mi);
! 390: }
! 391: return depths;
! 392: }
CVSweb