Annotation of sys/dev/vesa/vesabios.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: vesabios.c,v 1.4 2007/02/18 19:19:02 gwk Exp $ */
! 2:
! 3: /*
! 4: * Copyright (c) 2002, 2004
! 5: * Matthias Drochner. 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: *
! 16: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
! 17: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 18: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 19: * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
! 20: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 21: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 22: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 23: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 24: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 25: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 26: * SUCH DAMAGE.
! 27: */
! 28:
! 29: #include <sys/cdefs.h>
! 30:
! 31: #include <sys/param.h>
! 32: #include <sys/systm.h>
! 33: #include <sys/device.h>
! 34: #include <sys/malloc.h>
! 35: #include <machine/frame.h>
! 36: #include <machine/kvm86.h>
! 37:
! 38: #include <dev/vesa/vesabiosvar.h>
! 39: #include <dev/vesa/vesabiosreg.h>
! 40: #include <dev/vesa/vbe.h>
! 41:
! 42: struct vbeinfoblock
! 43: {
! 44: char VbeSignature[4];
! 45: uint16_t VbeVersion;
! 46: uint32_t OemStringPtr;
! 47: uint32_t Capabilities;
! 48: uint32_t VideoModePtr;
! 49: uint16_t TotalMemory;
! 50: uint16_t OemSoftwareRev;
! 51: uint32_t OemVendorNamePtr, OemProductNamePtr, OemProductRevPtr;
! 52: /* data area, in total max 512 bytes for VBE 2.0 */
! 53: } __packed;
! 54:
! 55: #define FAR2FLATPTR(p) ((p & 0xffff) + ((p >> 12) & 0xffff0))
! 56:
! 57: int vesabios_match(struct device *, void *, void *);
! 58: void vesabios_attach(struct device *, struct device *, void *);
! 59: int vesabios_print(void *, const char *);
! 60:
! 61: int vbegetinfo(struct vbeinfoblock **);
! 62: void vbefreeinfo(struct vbeinfoblock *);
! 63: #ifdef VESABIOSVERBOSE
! 64: const char *mm2txt(unsigned int);
! 65: #endif
! 66:
! 67: struct vesabios_softc *vesabios_softc;
! 68:
! 69: struct cfattach vesabios_ca = {
! 70: sizeof(struct vesabios_softc), vesabios_match, vesabios_attach
! 71: };
! 72:
! 73: struct cfdriver vesabios_cd = {
! 74: NULL, "vesabios", DV_DULL
! 75: };
! 76:
! 77: int
! 78: vesabios_match(struct device *parent, void *match, void *aux)
! 79: {
! 80:
! 81: return (1);
! 82: }
! 83:
! 84: int
! 85: vbegetinfo(struct vbeinfoblock **vip)
! 86: {
! 87: unsigned char *buf;
! 88: struct trapframe tf;
! 89: int res, error;
! 90:
! 91: if ((buf = kvm86_bios_addpage(KVM86_CALL_TASKVA)) == NULL) {
! 92: printf("vbegetinfo: kvm86_bios_addpage failed\n");
! 93: return (ENOMEM);
! 94: }
! 95:
! 96: memcpy(buf, "VBE2", 4);
! 97:
! 98: memset(&tf, 0, sizeof(struct trapframe));
! 99: tf.tf_eax = VBE_FUNC_CTRLINFO;
! 100: tf.tf_vm86_es = 0;
! 101: tf.tf_edi = KVM86_CALL_TASKVA;
! 102:
! 103: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 104: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
! 105: printf("vbecall: res=%d, ax=%x\n", res, tf.tf_eax);
! 106: error = ENXIO;
! 107: goto out;
! 108: }
! 109:
! 110: if (memcmp(((struct vbeinfoblock *)buf)->VbeSignature, "VESA", 4)) {
! 111: error = EIO;
! 112: goto out;
! 113: }
! 114:
! 115: if (vip)
! 116: *vip = (struct vbeinfoblock *)buf;
! 117: return (0);
! 118:
! 119: out:
! 120: kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
! 121: return (error);
! 122: }
! 123:
! 124: void
! 125: vbefreeinfo(struct vbeinfoblock *vip)
! 126: {
! 127:
! 128: kvm86_bios_delpage(KVM86_CALL_TASKVA, vip);
! 129: }
! 130:
! 131: int
! 132: vbeprobe(void)
! 133: {
! 134: struct vbeinfoblock *vi;
! 135: int found = 0;
! 136:
! 137: if (vbegetinfo(&vi))
! 138: return (0);
! 139: if (VBE_CTRLINFO_VERSION(vi->VbeVersion) > 1) {
! 140: /* VESA bios is at least version 2.0 */
! 141: found = 1;
! 142: }
! 143: vbefreeinfo(vi);
! 144: return (found);
! 145: }
! 146:
! 147: #ifdef VESABIOSVERBOSE
! 148: const char *
! 149: mm2txt(unsigned int mm)
! 150: {
! 151: static char buf[30];
! 152: static const char *names[] = {
! 153: "Text mode",
! 154: "CGA graphics",
! 155: "Hercules graphics",
! 156: "Planar",
! 157: "Packed pixel",
! 158: "Non-chain 4, 256 color",
! 159: "Direct Color",
! 160: "YUV"
! 161: };
! 162:
! 163: if (mm < sizeof(names)/sizeof(names[0]))
! 164: return (names[mm]);
! 165: snprintf(buf, sizeof(buf), "unknown memory model %d", mm);
! 166: return (buf);
! 167: }
! 168: #endif
! 169:
! 170: void
! 171: vesabios_attach(struct device *parent, struct device *self, void *aux)
! 172: {
! 173: struct vesabios_softc *sc = (struct vesabios_softc *)self;
! 174: struct vbeinfoblock *vi;
! 175: unsigned char *buf;
! 176: struct trapframe tf;
! 177: int res;
! 178: char name[256];
! 179: #define MAXMODES 60
! 180: uint16_t modes[MAXMODES];
! 181: int rastermodes[MAXMODES];
! 182: int textmodes[MAXMODES];
! 183: int nmodes, nrastermodes, ntextmodes, i;
! 184: uint32_t modeptr;
! 185: struct modeinfoblock *mi;
! 186:
! 187: if (vbegetinfo(&vi)) {
! 188: printf("\n");
! 189: panic("vesabios_attach: disappeared");
! 190: }
! 191:
! 192: printf(": version %d.%d",
! 193: VBE_CTRLINFO_VERSION(vi->VbeVersion),
! 194: VBE_CTRLINFO_REVISION(vi->VbeVersion));
! 195:
! 196:
! 197: res = kvm86_bios_read(FAR2FLATPTR(vi->OemVendorNamePtr),
! 198: name, sizeof(name));
! 199:
! 200: sc->sc_size = vi->TotalMemory * 65536;
! 201: if (res > 0) {
! 202: name[res - 1] = 0;
! 203: printf(", %s", name);
! 204: res = kvm86_bios_read(FAR2FLATPTR(vi->OemProductNamePtr),
! 205: name, sizeof(name));
! 206: if (res > 0) {
! 207: name[res - 1] = 0;
! 208: printf(" %s", name);
! 209: }
! 210: }
! 211: printf("\n");
! 212:
! 213: nmodes = 0;
! 214: modeptr = FAR2FLATPTR(vi->VideoModePtr);
! 215: while (nmodes < MAXMODES) {
! 216: res = kvm86_bios_read(modeptr, (char *)&modes[nmodes], 2);
! 217: if (res != 2 || modes[nmodes] == 0xffff)
! 218: break;
! 219: nmodes++;
! 220: modeptr += 2;
! 221: }
! 222:
! 223: vbefreeinfo(vi);
! 224: if (nmodes == 0)
! 225: return;
! 226:
! 227: nrastermodes = ntextmodes = 0;
! 228:
! 229: buf = kvm86_bios_addpage(KVM86_CALL_TASKVA);
! 230: if (!buf) {
! 231: printf("%s: kvm86_bios_addpage failed\n",
! 232: self->dv_xname);
! 233: return;
! 234: }
! 235: for (i = 0; i < nmodes; i++) {
! 236:
! 237: memset(&tf, 0, sizeof(struct trapframe));
! 238: tf.tf_eax = VBE_FUNC_MODEINFO;
! 239: tf.tf_ecx = modes[i];
! 240: tf.tf_vm86_es = 0;
! 241: tf.tf_edi = KVM86_CALL_TASKVA;
! 242:
! 243: res = kvm86_bioscall(BIOS_VIDEO_INTR, &tf);
! 244: if (res || VBECALL_SUPPORT(tf.tf_eax) != VBECALL_SUPPORTED) {
! 245: printf("%s: vbecall: res=%d, ax=%x\n",
! 246: self->dv_xname, res, tf.tf_eax);
! 247: printf("%s: error getting info for mode %04x\n",
! 248: self->dv_xname, modes[i]);
! 249: continue;
! 250: }
! 251: mi = (struct modeinfoblock *)buf;
! 252: #ifdef VESABIOSVERBOSE
! 253: printf("%s: VESA mode %04x: attributes %04x",
! 254: self->dv_xname, modes[i], mi->ModeAttributes);
! 255: #endif
! 256: if (!(mi->ModeAttributes & 1)) {
! 257: #ifdef VESABIOSVERBOSE
! 258: printf("\n");
! 259: #endif
! 260: continue;
! 261: }
! 262: if (mi->ModeAttributes & 0x10) {
! 263: /* graphics */
! 264: #ifdef VESABIOSVERBOSE
! 265: printf(", %dx%d %dbbp %s\n",
! 266: mi->XResolution, mi->YResolution,
! 267: mi->BitsPerPixel, mm2txt(mi->MemoryModel));
! 268: #endif
! 269: if (mi->ModeAttributes & 0x80) {
! 270: /* flat buffer */
! 271: rastermodes[nrastermodes++] = modes[i];
! 272: }
! 273: } else {
! 274: /* text */
! 275: #ifdef VESABIOSVERBOSE
! 276: printf(", text %dx%d\n",
! 277: mi->XResolution, mi->YResolution);
! 278: #endif
! 279: if (!(mi->ModeAttributes & 0x20)) /* VGA compatible */
! 280: textmodes[ntextmodes++] = modes[i];
! 281: }
! 282: }
! 283: kvm86_bios_delpage(KVM86_CALL_TASKVA, buf);
! 284: if (nrastermodes > 0) {
! 285: sc->sc_modes =
! 286: (uint16_t *)malloc(sizeof(uint16_t)*nrastermodes,
! 287: M_DEVBUF, M_NOWAIT);
! 288: if (sc->sc_modes == NULL) {
! 289: sc->sc_nmodes = 0;
! 290: return;
! 291: }
! 292: sc->sc_nmodes = nrastermodes;
! 293: for (i = 0; i < nrastermodes; i++)
! 294: sc->sc_modes[i] = rastermodes[i];
! 295: }
! 296: vesabios_softc = sc;
! 297: }
! 298:
! 299: int
! 300: vesabios_print(aux, pnp)
! 301: void *aux;
! 302: const char *pnp;
! 303: {
! 304: char *busname = aux;
! 305:
! 306: if (pnp)
! 307: printf("%s at %s", busname, pnp);
! 308: return (UNCONF);
! 309: }
CVSweb