root/dev/vesa/vesafb.c

DEFINITIONS

1. vesafb_get_ddc_version
2. vesafb_get_ddc_info
3. vesafb_get_mode
4. vesafb_get_mode_info
5. vesafb_set_palette
6. vesafb_set_mode
7. vesafb_find_mode
8. vesafb_putcmap
9. vesafb_getcmap
10. vesafb_getdepthflag
11. vesafb_get_supported_depth

    1 /* $OpenBSD: vesafb.c,v 1.4 2007/02/18 19:19:02 gwk Exp $ */
    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  */
   51 #include <sys/param.h>
   52 #include <sys/systm.h>
   53 #include <sys/kernel.h>
   54 #include <sys/device.h>
   56 #include <machine/bus.h>
   58 #include <dev/pci/pcireg.h>
   59 #include <dev/pci/pcivar.h>
   60 #include <dev/pci/pcidevs.h>
   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>
   68 #include <dev/vesa/vesabiosreg.h>
   69 #include <dev/vesa/vesabiosvar.h>
   70 #include <dev/vesa/vbe.h>
   72 #include <machine/frame.h>
   73 #include <machine/kvm86.h>
   75 #include <dev/wscons/wsconsio.h>
   76 #include <dev/wscons/wsdisplayvar.h>
   78 #include <uvm/uvm_extern.h>
   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 *);
   90 int
vesafb_get_ddc_version(struct vga_pci_softc *sc)
   92 {
   93         struct trapframe tf;
   94         int res;
bzero(&tf, sizeof(struct trapframe));
tf.tf_eax = VBE_FUNC_DDC;
res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
  100         if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED)
  101                 return 0;
  103         return VBECALL_SUCESS(tf.tf_eax);
  104 }
  107 int
vesafb_get_ddc_info(struct vga_pci_softc *sc, struct edid *info)
  109 {
  110         struct trapframe tf;
  111         unsigned char *buf;
  112         int res;
  114         if ((buf = kvm86_bios_addpage(KVM86_CALL_TASKVA)) == NULL) {
printf("%s: kvm86_bios_addpage failed.\n",
sc->sc_dev.dv_xname);
  117                 return 1;
  118         }
bzero(&tf, sizeof(struct trapframe));
tf.tf_eax = VBE_FUNC_DDC;
tf.tf_ebx = VBE_DDC_GET;
tf.tf_vm86_es = 0;
tf.tf_edi = KVM86_CALL_TASKVA;
res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
  127         if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
  129                 return 1;
  130         }
memcpy(info, buf, sizeof(struct edid));
kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
  134         return VBECALL_SUCESS(tf.tf_eax);
  135 }
  137 int
vesafb_get_mode(struct vga_pci_softc *sc)
  139 {
  140         struct trapframe tf;
  141         int res;
bzero(&tf, sizeof(struct trapframe));
tf.tf_eax = VBE_FUNC_GETMODE;
res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
  147         if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
printf("%s: vbecall: res=%d, ax=%x\n",
sc->sc_dev.dv_xname, res, tf.tf_eax);
  150         }
  151         return tf.tf_ebx & 0xffff;
  152 }
  154 void
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;
  162         if ((buf = kvm86_bios_addpage(KVM86_CALL_TASKVA)) == NULL) {
printf("%s: kvm86_bios_addpage failed.\n",
sc->sc_dev.dv_xname);
  165                 return;
  166         }
memset(&tf, 0, sizeof(struct trapframe));
tf.tf_eax = VBE_FUNC_MODEINFO;
tf.tf_ecx = mode;
tf.tf_vm86_es = 0;
tf.tf_edi = KVM86_CALL_TASKVA;
res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
  174         if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
printf("%s: vbecall: res=%d, ax=%x\n",
sc->sc_dev.dv_xname, res, tf.tf_eax);
printf("%s: error getting info for mode %05x\n",
sc->sc_dev.dv_xname, mode);
kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
  180                 return;
  181         }
memcpy(mi, buf, sizeof(struct modeinfoblock));
kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
  184 }
  186 void
vesafb_set_palette(struct vga_pci_softc *sc, int reg, struct paletteentry pe)
  188 {
  189         struct trapframe tf;
  190         int res;
  191         char *buf;
  193         if ((buf = kvm86_bios_addpage(KVM86_CALL_TASKVA)) == NULL) {
printf("%s: kvm86_bios_addpage failed.\n",
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          */
pe.Red >>= 2;
pe.Green >>= 2;
pe.Blue >>= 2;
memcpy(buf, &pe, sizeof(struct paletteentry));
  208         /* set palette */
memset(&tf, 0, sizeof(struct trapframe));
tf.tf_eax = VBE_FUNC_PALETTE;
tf.tf_ebx = 0x0600; /* 6 bit per primary, set format */
tf.tf_ecx = 1;
tf.tf_edx = reg;
tf.tf_vm86_es = 0;
tf.tf_edi = KVM86_CALL_TASKVA;
res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
  218         if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED)
printf("%s: vbecall: res=%d, ax=%x\n",
sc->sc_dev.dv_xname, res, tf.tf_eax);
kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
  223         return;
  224 }
  226 void
vesafb_set_mode(struct vga_pci_softc *sc, int mode)
  228 {
  229         struct trapframe tf;
  230         int res;
bzero(&tf, sizeof(struct trapframe));
tf.tf_eax = VBE_FUNC_SETMODE;
tf.tf_ebx = mode | 0x4000; /* flat */
res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
  237         if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
printf("%s: vbecall: res=%d, ax=%x\n",
sc->sc_dev.dv_xname, res, tf.tf_eax);
  240                 return;
  241         }
  242 }
  244 int
vesafb_find_mode(struct vga_pci_softc *sc, int width, int height, int bpp)
  246 {
  247         struct modeinfoblock mi;
  248         int i;
  250         if (vesabios_softc == NULL || vesabios_softc->sc_nmodes == 0)
  251                 return -1;
  252 #ifdef VESABIOSVERBOSE
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++) {
vesafb_get_mode_info(sc, vesabios_softc->sc_modes[i], &mi);
  258                 if (mi.XResolution == width &&
mi.YResolution == height &&
mi.BitsPerPixel == bpp) {
sc->sc_width = mi.XResolution;
sc->sc_height = mi.YResolution;
sc->sc_depth = mi.BitsPerPixel;
sc->sc_linebytes = mi.BytesPerScanLine;
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 }
  275 int
vesafb_putcmap(struct vga_pci_softc *sc, struct wsdisplay_cmap *cm)
  277 {
  278         struct paletteentry pe;
u_int idx, cnt;
u_char r[256], g[256], b[256];
u_char *rp, *gp, *bp;
  282         int rv, i;
idx = cm->index;
cnt = cm->count;
  287         if (idx >= 256 || cnt > 256 - idx)
  288                 return EINVAL;
rv = copyin(cm->red, &r[idx], cnt);
  291         if (rv)
  292                 return rv;
rv = copyin(cm->green, &g[idx], cnt);
  294         if (rv)
  295                 return rv;
rv = copyin(cm->blue, &b[idx], cnt);
  297         if (rv)
  298                 return rv;
memcpy(&sc->sc_cmap_red[idx], &r[idx], cnt);
memcpy(&sc->sc_cmap_green[idx], &g[idx], cnt);
memcpy(&sc->sc_cmap_blue[idx], &b[idx], cnt);
rp = &sc->sc_cmap_red[idx];
gp = &sc->sc_cmap_green[idx];
bp = &sc->sc_cmap_blue[idx];
  308         for (i = 0; i < cnt; i++) {
pe.Blue = *bp;
pe.Green = *gp;
pe.Red = *rp;
pe.Alignment = 0;
vesafb_set_palette(sc, idx, pe);
idx++;
rp++, gp++, bp++;
  316         }
  318         return 0;
  319 }
  321 int
vesafb_getcmap(struct vga_pci_softc *sc, struct wsdisplay_cmap *cm)
  323 {
u_int idx, cnt;
  325         int rv;
idx = cm->index;
cnt = cm->count;
  330         if (idx >= 256 || cnt > 256 - idx)
  331                 return EINVAL;
rv = copyout(&sc->sc_cmap_red[idx], cm->red, cnt);
  334         if (rv)
  335                 return rv;
rv = copyout(&sc->sc_cmap_green[idx], cm->green, cnt);
  337         if (rv)
  338                 return rv;
rv = copyout(&sc->sc_cmap_blue[idx], cm->blue, cnt);
  340         if (rv)
  341                 return rv;
  343         return 0;
  344 }
  346 static int
vesafb_getdepthflag(struct modeinfoblock *mi)
  348 {
  349         int bpp, depth;
depth = mi->RedMaskSize + mi->GreenMaskSize + mi->BlueMaskSize;
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 }
  376 int
vesafb_get_supported_depth(struct vga_pci_softc *sc)
  378 {
  379         int i, depths;
  380         struct modeinfoblock mi;
depths = 0;
  384         if (vesabios_softc == NULL || vesabios_softc->sc_nmodes == 0)
  385                 return 0;
  387         for (i = 0; i < vesabios_softc->sc_nmodes; i++) {
vesafb_get_mode_info(sc, vesabios_softc->sc_modes[i], &mi);
depths |= vesafb_getdepthflag(&mi);
  390         }
  391         return depths;
  392 }