svn commit: r197022 - in head/sys/dev: dpms fb
Xin LI
delphij at FreeBSD.org
Wed Sep 9 07:45:09 UTC 2009
Author: delphij
Date: Wed Sep 9 07:45:08 2009
New Revision: 197022
URL: http://svn.freebsd.org/changeset/base/197022
Log:
Copy the following files to new places, a subsequent commit would remove
them from the old place. This commit necessary so that the tree would not
enter a broken state.
sys/i386/isa/vesa.c -> dev/fb/vesa.c
sys/i386/include/pc/vesa.h -> dev/fb/vesa.h
sys/i386/isa/dpms.c -> dev/dpms/dpms.c
Added:
head/sys/dev/dpms/dpms.c
- copied unchanged from r197019, head/sys/i386/isa/dpms.c
head/sys/dev/fb/vesa.c
- copied unchanged from r197019, head/sys/i386/isa/vesa.c
head/sys/dev/fb/vesa.h
- copied unchanged from r197019, head/sys/i386/include/pc/vesa.h
Copied: head/sys/dev/dpms/dpms.c (from r197019, head/sys/i386/isa/dpms.c)
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ head/sys/dev/dpms/dpms.c Wed Sep 9 07:45:08 2009 (r197022, copy of r197019, head/sys/i386/isa/dpms.c)
@@ -0,0 +1,230 @@
+/*-
+ * Copyright (c) 2008 Yahoo!, Inc.
+ * All rights reserved.
+ * Written by: John Baldwin <jhb at FreeBSD.org>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ * 3. Neither the name of the author nor the names of any co-contributors
+ * may be used to endorse or promote products derived from this software
+ * without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+/*
+ * Copyright (c) 2004 Benjamin Close <Benjamin.Close at clearchain.com>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+/*
+ * Support for managing the display via DPMS for suspend/resume.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/kernel.h>
+#include <sys/libkern.h>
+#include <sys/module.h>
+
+#include <machine/vm86.h>
+
+/*
+ * VESA DPMS States
+ */
+#define DPMS_ON 0x00
+#define DPMS_STANDBY 0x01
+#define DPMS_SUSPEND 0x02
+#define DPMS_OFF 0x04
+#define DPMS_REDUCEDON 0x08
+
+#define VBE_DPMS_FUNCTION 0x4F10
+#define VBE_DPMS_GET_SUPPORTED_STATES 0x00
+#define VBE_DPMS_GET_STATE 0x02
+#define VBE_DPMS_SET_STATE 0x01
+#define VBE_MAJORVERSION_MASK 0x0F
+#define VBE_MINORVERSION_MASK 0xF0
+
+struct dpms_softc {
+ int dpms_supported_states;
+ int dpms_initial_state;
+};
+
+static int dpms_attach(device_t);
+static int dpms_detach(device_t);
+static int dpms_get_supported_states(int *);
+static int dpms_get_current_state(int *);
+static void dpms_identify(driver_t *, device_t);
+static int dpms_probe(device_t);
+static int dpms_resume(device_t);
+static int dpms_set_state(int);
+static int dpms_suspend(device_t);
+
+static device_method_t dpms_methods[] = {
+ DEVMETHOD(device_identify, dpms_identify),
+ DEVMETHOD(device_probe, dpms_probe),
+ DEVMETHOD(device_attach, dpms_attach),
+ DEVMETHOD(device_detach, dpms_detach),
+ DEVMETHOD(device_suspend, dpms_suspend),
+ DEVMETHOD(device_resume, dpms_resume),
+ { 0, 0 }
+};
+
+static driver_t dpms_driver = {
+ "dpms",
+ dpms_methods,
+ sizeof(struct dpms_softc),
+};
+
+static devclass_t dpms_devclass;
+
+DRIVER_MODULE(dpms, vgapci, dpms_driver, dpms_devclass, NULL, NULL);
+
+static void
+dpms_identify(driver_t *driver, device_t parent)
+{
+
+ /*
+ * XXX: The DPMS VBE only allows for manipulating a single
+ * monitor, but we don't know which one. Just attach to the
+ * first vgapci(4) device we encounter and hope it is the
+ * right one.
+ */
+ if (devclass_get_device(dpms_devclass, 0) == NULL)
+ device_add_child(parent, "dpms", 0);
+}
+
+static int
+dpms_probe(device_t dev)
+{
+ int error, states;
+
+ error = dpms_get_supported_states(&states);
+ if (error)
+ return (error);
+ device_set_desc(dev, "DPMS suspend/resume");
+ device_quiet(dev);
+ return (BUS_PROBE_DEFAULT);
+}
+
+static int
+dpms_attach(device_t dev)
+{
+ struct dpms_softc *sc;
+ int error;
+
+ sc = device_get_softc(dev);
+ error = dpms_get_supported_states(&sc->dpms_supported_states);
+ if (error)
+ return (error);
+ error = dpms_get_current_state(&sc->dpms_initial_state);
+ return (error);
+}
+
+static int
+dpms_detach(device_t dev)
+{
+
+ return (0);
+}
+
+static int
+dpms_suspend(device_t dev)
+{
+
+ dpms_set_state(DPMS_OFF);
+ return (0);
+}
+
+static int
+dpms_resume(device_t dev)
+{
+ struct dpms_softc *sc;
+
+ sc = device_get_softc(dev);
+ dpms_set_state(sc->dpms_initial_state);
+ return (0);
+}
+
+static int
+dpms_call_bios(int subfunction, int *bh)
+{
+ struct vm86frame vmf;
+ int error;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_ax = VBE_DPMS_FUNCTION;
+ vmf.vmf_bl = subfunction;
+ vmf.vmf_bh = *bh;
+ vmf.vmf_es = 0;
+ vmf.vmf_di = 0;
+ error = vm86_intcall(0x10, &vmf);
+ if (error == 0 && (vmf.vmf_eax & 0xffff) != 0x004f)
+ error = ENXIO;
+ if (error == 0)
+ *bh = vmf.vmf_bh;
+ return (error);
+}
+
+static int
+dpms_get_supported_states(int *states)
+{
+
+ *states = 0;
+ return (dpms_call_bios(VBE_DPMS_GET_SUPPORTED_STATES, states));
+}
+
+static int
+dpms_get_current_state(int *state)
+{
+
+ *state = 0;
+ return (dpms_call_bios(VBE_DPMS_GET_STATE, state));
+}
+
+static int
+dpms_set_state(int state)
+{
+
+ return (dpms_call_bios(VBE_DPMS_SET_STATE, &state));
+}
Copied: head/sys/dev/fb/vesa.c (from r197019, head/sys/i386/isa/vesa.c)
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ head/sys/dev/fb/vesa.c Wed Sep 9 07:45:08 2009 (r197022, copy of r197019, head/sys/i386/isa/vesa.c)
@@ -0,0 +1,1696 @@
+/*-
+ * Copyright (c) 1998 Kazutaka YOKOTA and Michael Smith
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer as
+ * the first lines of this file unmodified.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include "opt_vga.h"
+#include "opt_vesa.h"
+
+#ifndef VGA_NO_MODE_CHANGE
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/malloc.h>
+#include <sys/fbio.h>
+
+#include <vm/vm.h>
+#include <vm/vm_extern.h>
+#include <vm/vm_kern.h>
+#include <vm/vm_param.h>
+#include <vm/pmap.h>
+
+#include <machine/md_var.h>
+#include <machine/vm86.h>
+#include <machine/pc/bios.h>
+#include <machine/pc/vesa.h>
+
+#include <dev/fb/fbreg.h>
+#include <dev/fb/vgareg.h>
+
+#ifndef __i386__
+#include <isa/isareg.h>
+#else
+#include <i386/isa/isa.h>
+#endif
+
+#define VESA_VIA_CLE266 "VIA CLE266\r\n"
+
+#ifndef VESA_DEBUG
+#define VESA_DEBUG 0
+#endif
+
+/* VESA video adapter state buffer stub */
+struct adp_state {
+ int sig;
+#define V_STATE_SIG 0x61736576
+ u_char regs[1];
+};
+typedef struct adp_state adp_state_t;
+
+/* VESA video adapter */
+static video_adapter_t *vesa_adp = NULL;
+static int vesa_state_buf_size = 0;
+#define VESA_VM86_BUFSIZE (3 * PAGE_SIZE)
+static void *vesa_vm86_buf;
+
+/* VESA functions */
+#if 0
+static int vesa_nop(void);
+#endif
+static int vesa_error(void);
+static vi_probe_t vesa_probe;
+static vi_init_t vesa_init;
+static vi_get_info_t vesa_get_info;
+static vi_query_mode_t vesa_query_mode;
+static vi_set_mode_t vesa_set_mode;
+static vi_save_font_t vesa_save_font;
+static vi_load_font_t vesa_load_font;
+static vi_show_font_t vesa_show_font;
+static vi_save_palette_t vesa_save_palette;
+static vi_load_palette_t vesa_load_palette;
+static vi_set_border_t vesa_set_border;
+static vi_save_state_t vesa_save_state;
+static vi_load_state_t vesa_load_state;
+static vi_set_win_org_t vesa_set_origin;
+static vi_read_hw_cursor_t vesa_read_hw_cursor;
+static vi_set_hw_cursor_t vesa_set_hw_cursor;
+static vi_set_hw_cursor_shape_t vesa_set_hw_cursor_shape;
+static vi_blank_display_t vesa_blank_display;
+static vi_mmap_t vesa_mmap;
+static vi_ioctl_t vesa_ioctl;
+static vi_clear_t vesa_clear;
+static vi_fill_rect_t vesa_fill_rect;
+static vi_bitblt_t vesa_bitblt;
+static vi_diag_t vesa_diag;
+static int vesa_bios_info(int level);
+static struct vm86context vesa_vmcontext;
+
+static video_switch_t vesavidsw = {
+ vesa_probe,
+ vesa_init,
+ vesa_get_info,
+ vesa_query_mode,
+ vesa_set_mode,
+ vesa_save_font,
+ vesa_load_font,
+ vesa_show_font,
+ vesa_save_palette,
+ vesa_load_palette,
+ vesa_set_border,
+ vesa_save_state,
+ vesa_load_state,
+ vesa_set_origin,
+ vesa_read_hw_cursor,
+ vesa_set_hw_cursor,
+ vesa_set_hw_cursor_shape,
+ vesa_blank_display,
+ vesa_mmap,
+ vesa_ioctl,
+ vesa_clear,
+ vesa_fill_rect,
+ vesa_bitblt,
+ vesa_error,
+ vesa_error,
+ vesa_diag,
+};
+
+static video_switch_t *prevvidsw;
+
+/* VESA BIOS video modes */
+#define VESA_MAXMODES 64
+#define EOT (-1)
+#define NA (-2)
+
+#define MODE_TABLE_DELTA 8
+
+static int vesa_vmode_max = 0;
+static video_info_t vesa_vmode_empty = { EOT };
+static video_info_t *vesa_vmode = &vesa_vmode_empty;
+
+static int vesa_init_done = FALSE;
+static int has_vesa_bios = FALSE;
+static struct vesa_info *vesa_adp_info = NULL;
+static u_int16_t *vesa_vmodetab = NULL;
+static char *vesa_oemstr = NULL;
+static char *vesa_venderstr = NULL;
+static char *vesa_prodstr = NULL;
+static char *vesa_revstr = NULL;
+
+/* local macros and functions */
+#define BIOS_SADDRTOLADDR(p) ((((p) & 0xffff0000) >> 12) + ((p) & 0x0000ffff))
+
+static int int10_set_mode(int mode);
+static int vesa_bios_get_mode(int mode, struct vesa_mode *vmode);
+static int vesa_bios_set_mode(int mode);
+static int vesa_bios_get_dac(void);
+static int vesa_bios_set_dac(int bits);
+static int vesa_bios_save_palette(int start, int colors, u_char *palette,
+ int bits);
+static int vesa_bios_save_palette2(int start, int colors, u_char *r, u_char *g,
+ u_char *b, int bits);
+static int vesa_bios_load_palette(int start, int colors, u_char *palette,
+ int bits);
+#ifdef notyet
+static int vesa_bios_load_palette2(int start, int colors, u_char *r, u_char *g,
+ u_char *b, int bits);
+#endif
+#define STATE_SIZE 0
+#define STATE_SAVE 1
+#define STATE_LOAD 2
+#define STATE_HW (1<<0)
+#define STATE_DATA (1<<1)
+#define STATE_DAC (1<<2)
+#define STATE_REG (1<<3)
+#define STATE_MOST (STATE_HW | STATE_DATA | STATE_REG)
+#define STATE_ALL (STATE_HW | STATE_DATA | STATE_DAC | STATE_REG)
+static int vesa_bios_state_buf_size(void);
+static int vesa_bios_save_restore(int code, void *p, size_t size);
+static int vesa_bios_get_line_length(void);
+static int vesa_bios_set_line_length(int pixel, int *bytes, int *lines);
+#if 0
+static int vesa_bios_get_start(int *x, int *y);
+#endif
+static int vesa_bios_set_start(int x, int y);
+static int vesa_map_gen_mode_num(int type, int color, int mode);
+static int vesa_translate_flags(u_int16_t vflags);
+static int vesa_translate_mmodel(u_int8_t vmodel);
+static void *vesa_fix_ptr(u_int32_t p, u_int16_t seg, u_int16_t off,
+ u_char *buf);
+static int vesa_bios_init(void);
+static void vesa_clear_modes(video_info_t *info, int color);
+static vm_offset_t vesa_map_buffer(u_int paddr, size_t size);
+static void vesa_unmap_buffer(vm_offset_t vaddr, size_t size);
+
+#if 0
+static int vesa_get_origin(video_adapter_t *adp, off_t *offset);
+#endif
+
+static void
+dump_buffer(u_char *buf, size_t len)
+{
+ int i;
+
+ for(i = 0; i < len;) {
+ printf("%02x ", buf[i]);
+ if ((++i % 16) == 0)
+ printf("\n");
+ }
+}
+
+/* INT 10 BIOS calls */
+static int
+int10_set_mode(int mode)
+{
+ struct vm86frame vmf;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x0000 | mode;
+ vm86_intcall(0x10, &vmf);
+ return 0;
+}
+
+/* VESA BIOS calls */
+static int
+vesa_bios_get_mode(int mode, struct vesa_mode *vmode)
+{
+ struct vm86frame vmf;
+ u_char *buf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f01;
+ vmf.vmf_ecx = mode;
+ buf = vesa_vm86_buf;
+ vm86_getptr(&vesa_vmcontext, (vm_offset_t)buf, &vmf.vmf_es, &vmf.vmf_di);
+
+ err = vm86_datacall(0x10, &vmf, &vesa_vmcontext);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 1;
+ bcopy(buf, vmode, sizeof(*vmode));
+ return 0;
+}
+
+static int
+vesa_bios_set_mode(int mode)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f02;
+ vmf.vmf_ebx = mode;
+ err = vm86_intcall(0x10, &vmf);
+ return ((err != 0) || (vmf.vmf_ax != 0x4f));
+}
+
+static int
+vesa_bios_get_dac(void)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f08;
+ vmf.vmf_ebx = 1; /* get DAC width */
+ err = vm86_intcall(0x10, &vmf);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 6; /* XXX */
+ return ((vmf.vmf_ebx >> 8) & 0x00ff);
+}
+
+static int
+vesa_bios_set_dac(int bits)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f08;
+ vmf.vmf_ebx = (bits << 8);
+ err = vm86_intcall(0x10, &vmf);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 6; /* XXX */
+ return ((vmf.vmf_ebx >> 8) & 0x00ff);
+}
+
+static int
+vesa_bios_save_palette(int start, int colors, u_char *palette, int bits)
+{
+ struct vm86frame vmf;
+ u_char *p;
+ int err;
+ int i;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f09;
+ vmf.vmf_ebx = 1; /* get primary palette data */
+ vmf.vmf_ecx = colors;
+ vmf.vmf_edx = start;
+ p = vesa_vm86_buf;
+ vm86_getptr(&vesa_vmcontext, (vm_offset_t)p, &vmf.vmf_es, &vmf.vmf_di);
+
+ err = vm86_datacall(0x10, &vmf, &vesa_vmcontext);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 1;
+
+ bits = 8 - bits;
+ for (i = 0; i < colors; ++i) {
+ palette[i*3] = p[i*4 + 2] << bits;
+ palette[i*3 + 1] = p[i*4 + 1] << bits;
+ palette[i*3 + 2] = p[i*4] << bits;
+ }
+ return 0;
+}
+
+static int
+vesa_bios_save_palette2(int start, int colors, u_char *r, u_char *g, u_char *b,
+ int bits)
+{
+ struct vm86frame vmf;
+ u_char *p;
+ int err;
+ int i;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f09;
+ vmf.vmf_ebx = 1; /* get primary palette data */
+ vmf.vmf_ecx = colors;
+ vmf.vmf_edx = start;
+ p = vesa_vm86_buf;
+ vm86_getptr(&vesa_vmcontext, (vm_offset_t)p, &vmf.vmf_es, &vmf.vmf_di);
+
+ err = vm86_datacall(0x10, &vmf, &vesa_vmcontext);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 1;
+
+ bits = 8 - bits;
+ for (i = 0; i < colors; ++i) {
+ r[i] = p[i*4 + 2] << bits;
+ g[i] = p[i*4 + 1] << bits;
+ b[i] = p[i*4] << bits;
+ }
+ return 0;
+}
+
+static int
+vesa_bios_load_palette(int start, int colors, u_char *palette, int bits)
+{
+ struct vm86frame vmf;
+ u_char *p;
+ int err;
+ int i;
+
+ p = vesa_vm86_buf;
+ bits = 8 - bits;
+ for (i = 0; i < colors; ++i) {
+ p[i*4] = palette[i*3 + 2] >> bits;
+ p[i*4 + 1] = palette[i*3 + 1] >> bits;
+ p[i*4 + 2] = palette[i*3] >> bits;
+ p[i*4 + 3] = 0;
+ }
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f09;
+ vmf.vmf_ebx = 0; /* set primary palette data */
+ vmf.vmf_ecx = colors;
+ vmf.vmf_edx = start;
+ vm86_getptr(&vesa_vmcontext, (vm_offset_t)p, &vmf.vmf_es, &vmf.vmf_di);
+
+ err = vm86_datacall(0x10, &vmf, &vesa_vmcontext);
+ return ((err != 0) || (vmf.vmf_ax != 0x4f));
+}
+
+#ifdef notyet
+static int
+vesa_bios_load_palette2(int start, int colors, u_char *r, u_char *g, u_char *b,
+ int bits)
+{
+ struct vm86frame vmf;
+ u_char *p;
+ int err;
+ int i;
+
+ p = vesa_vm86_buf;
+ bits = 8 - bits;
+ for (i = 0; i < colors; ++i) {
+ p[i*4] = b[i] >> bits;
+ p[i*4 + 1] = g[i] >> bits;
+ p[i*4 + 2] = r[i] >> bits;
+ p[i*4 + 3] = 0;
+ }
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f09;
+ vmf.vmf_ebx = 0; /* set primary palette data */
+ vmf.vmf_ecx = colors;
+ vmf.vmf_edx = start;
+ vm86_getptr(&vesa_vmcontext, (vm_offset_t)p, &vmf.vmf_es, &vmf.vmf_di);
+
+ err = vm86_datacall(0x10, &vmf, &vesa_vmcontext);
+ return ((err != 0) || (vmf.vmf_ax != 0x4f));
+}
+#endif
+
+static int
+vesa_bios_state_buf_size(void)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f04;
+ vmf.vmf_ecx = STATE_ALL;
+ vmf.vmf_edx = STATE_SIZE;
+ err = vm86_intcall(0x10, &vmf);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 0;
+ return vmf.vmf_bx*64;
+}
+
+static int
+vesa_bios_save_restore(int code, void *p, size_t size)
+{
+ struct vm86frame vmf;
+ u_char *buf;
+ int err;
+
+ if (size > VESA_VM86_BUFSIZE)
+ return (1);
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f04;
+ vmf.vmf_ecx = STATE_ALL;
+ vmf.vmf_edx = code; /* STATE_SAVE/STATE_LOAD */
+ buf = vesa_vm86_buf;
+ vm86_getptr(&vesa_vmcontext, (vm_offset_t)buf, &vmf.vmf_es, &vmf.vmf_bx);
+ bcopy(p, buf, size);
+
+ err = vm86_datacall(0x10, &vmf, &vesa_vmcontext);
+ bcopy(buf, p, size);
+ return ((err != 0) || (vmf.vmf_ax != 0x4f));
+}
+
+static int
+vesa_bios_get_line_length(void)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f06;
+ vmf.vmf_ebx = 1; /* get scan line length */
+ err = vm86_intcall(0x10, &vmf);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return -1;
+ return vmf.vmf_bx; /* line length in bytes */
+}
+
+static int
+vesa_bios_set_line_length(int pixel, int *bytes, int *lines)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f06;
+ vmf.vmf_ebx = 0; /* set scan line length in pixel */
+ vmf.vmf_ecx = pixel;
+ err = vm86_intcall(0x10, &vmf);
+#if VESA_DEBUG > 1
+ printf("bx:%d, cx:%d, dx:%d\n", vmf.vmf_bx, vmf.vmf_cx, vmf.vmf_dx);
+#endif
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 1;
+ if (bytes)
+ *bytes = vmf.vmf_bx;
+ if (lines)
+ *lines = vmf.vmf_dx;
+ return 0;
+}
+
+#if 0
+static int
+vesa_bios_get_start(int *x, int *y)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f07;
+ vmf.vmf_ebx = 1; /* get display start */
+ err = vm86_intcall(0x10, &vmf);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f))
+ return 1;
+ *x = vmf.vmf_cx;
+ *y = vmf.vmf_dx;
+ return 0;
+}
+#endif
+
+static int
+vesa_bios_set_start(int x, int y)
+{
+ struct vm86frame vmf;
+ int err;
+
+ bzero(&vmf, sizeof(vmf));
+ vmf.vmf_eax = 0x4f07;
+ vmf.vmf_ebx = 0x80; /* set display start */
+ vmf.vmf_edx = y;
+ vmf.vmf_ecx = x;
+ err = vm86_intcall(0x10, &vmf);
+ return ((err != 0) || (vmf.vmf_ax != 0x4f));
+}
+
+/* map a generic video mode to a known mode */
+static int
+vesa_map_gen_mode_num(int type, int color, int mode)
+{
+ static struct {
+ int from;
+ int to;
+ } mode_map[] = {
+ { M_TEXT_132x25, M_VESA_C132x25 },
+ { M_TEXT_132x43, M_VESA_C132x43 },
+ { M_TEXT_132x50, M_VESA_C132x50 },
+ { M_TEXT_132x60, M_VESA_C132x60 },
+ };
+ int i;
+
+ for (i = 0; i < sizeof(mode_map)/sizeof(mode_map[0]); ++i) {
+ if (mode_map[i].from == mode)
+ return mode_map[i].to;
+ }
+ return mode;
+}
+
+static int
+vesa_translate_flags(u_int16_t vflags)
+{
+ static struct {
+ u_int16_t mask;
+ int set;
+ int reset;
+ } ftable[] = {
+ { V_MODECOLOR, V_INFO_COLOR, 0 },
+ { V_MODEGRAPHICS, V_INFO_GRAPHICS, 0 },
+ { V_MODELFB, V_INFO_LINEAR, 0 },
+ };
+ int flags;
+ int i;
+
+ for (flags = 0, i = 0; i < sizeof(ftable)/sizeof(ftable[0]); ++i) {
+ flags |= (vflags & ftable[i].mask) ?
+ ftable[i].set : ftable[i].reset;
+ }
+ return flags;
+}
+
+static int
+vesa_translate_mmodel(u_int8_t vmodel)
+{
+ static struct {
+ u_int8_t vmodel;
+ int mmodel;
+ } mtable[] = {
+ { V_MMTEXT, V_INFO_MM_TEXT },
+ { V_MMCGA, V_INFO_MM_CGA },
+ { V_MMHGC, V_INFO_MM_HGC },
+ { V_MMEGA, V_INFO_MM_PLANAR },
+ { V_MMPACKED, V_INFO_MM_PACKED },
+ { V_MMDIRCOLOR, V_INFO_MM_DIRECT },
+ };
+ int i;
+
+ for (i = 0; mtable[i].mmodel >= 0; ++i) {
+ if (mtable[i].vmodel == vmodel)
+ return mtable[i].mmodel;
+ }
+ return V_INFO_MM_OTHER;
+}
+
+static void
+*vesa_fix_ptr(u_int32_t p, u_int16_t seg, u_int16_t off, u_char *buf)
+{
+ if (p == 0)
+ return NULL;
+ if (((p >> 16) == seg) && ((p & 0xffff) >= off))
+ return (void *)(buf + ((p & 0xffff) - off));
+ else {
+ p = BIOS_SADDRTOLADDR(p);
+ return (void *)BIOS_PADDRTOVADDR(p);
+ }
+}
+
+static int
+vesa_bios_init(void)
+{
+ static u_char buf[512];
+ struct vm86frame vmf;
+ struct vesa_mode vmode;
+ video_info_t *p;
+ u_char *vmbuf;
+ int is_via_cle266;
+ int modes;
+ int err;
+ int i;
+
+ if (vesa_init_done)
+ return 0;
+
+ has_vesa_bios = FALSE;
+ vesa_adp_info = NULL;
+ vesa_vmode_max = 0;
+ vesa_vmode[0].vi_mode = EOT;
+
+ /* Allocate a buffer and add each page to the vm86 context. */
+ vesa_vm86_buf = malloc(VESA_VM86_BUFSIZE, M_DEVBUF, M_WAITOK | M_ZERO);
+ KASSERT(((vm_offset_t)vesa_vm86_buf & PAGE_MASK) == 0,
+ ("bad vesa_vm86_buf alignment"));
+ for (i = 0; i < howmany(VESA_VM86_BUFSIZE, PAGE_SIZE); i++)
+ vm86_addpage(&vesa_vmcontext, i + 1,
+ (vm_offset_t)vesa_vm86_buf + PAGE_SIZE * i);
+
+ vmbuf = vesa_vm86_buf;
+ bzero(&vmf, sizeof(vmf)); /* paranoia */
+ bcopy("VBE2", vmbuf, 4); /* try for VBE2 data */
+ vmf.vmf_eax = 0x4f00;
+ vm86_getptr(&vesa_vmcontext, (vm_offset_t)vmbuf, &vmf.vmf_es, &vmf.vmf_di);
+
+ err = vm86_datacall(0x10, &vmf, &vesa_vmcontext);
+ if ((err != 0) || (vmf.vmf_ax != 0x4f) || bcmp("VESA", vmbuf, 4))
+ return 1;
+ bcopy(vmbuf, buf, sizeof(buf));
+ vesa_adp_info = (struct vesa_info *)buf;
+ if (bootverbose) {
+ printf("VESA: information block\n");
+ dump_buffer(buf, 64);
+ }
+ if (vesa_adp_info->v_version < 0x0102) {
+ printf("VESA: VBE version %d.%d is not supported; "
+ "version 1.2 or later is required.\n",
+ ((vesa_adp_info->v_version & 0xf000) >> 12) * 10
+ + ((vesa_adp_info->v_version & 0x0f00) >> 8),
+ ((vesa_adp_info->v_version & 0x00f0) >> 4) * 10
+ + (vesa_adp_info->v_version & 0x000f));
+ return 1;
+ }
+
+ /* fix string ptrs */
+ vesa_oemstr = (char *)vesa_fix_ptr(vesa_adp_info->v_oemstr,
+ vmf.vmf_es, vmf.vmf_di, buf);
+ is_via_cle266 = strcmp(vesa_oemstr, VESA_VIA_CLE266) == 0;
+
+ if (vesa_adp_info->v_version >= 0x0200) {
+ vesa_venderstr =
+ (char *)vesa_fix_ptr(vesa_adp_info->v_venderstr,
+ vmf.vmf_es, vmf.vmf_di, buf);
+ vesa_prodstr =
+ (char *)vesa_fix_ptr(vesa_adp_info->v_prodstr,
+ vmf.vmf_es, vmf.vmf_di, buf);
+ vesa_revstr =
+ (char *)vesa_fix_ptr(vesa_adp_info->v_revstr,
+ vmf.vmf_es, vmf.vmf_di, buf);
+ }
+
+ /* obtain video mode information */
+ vesa_vmodetab = (u_int16_t *)vesa_fix_ptr(vesa_adp_info->v_modetable,
+ vmf.vmf_es, vmf.vmf_di, buf);
+ if (vesa_vmodetab == NULL)
+ return 1;
+ for (i = 0, modes = 0;
+ (i < (M_VESA_MODE_MAX - M_VESA_BASE + 1))
+ && (vesa_vmodetab[i] != 0xffff); ++i) {
+ if (vesa_bios_get_mode(vesa_vmodetab[i], &vmode))
+ continue;
+
+ /* reject unsupported modes */
+#if 0
+ if ((vmode.v_modeattr & (V_MODESUPP | V_MODEOPTINFO
+ | V_MODENONVGA))
+ != (V_MODESUPP | V_MODEOPTINFO))
+ continue;
+#else
+ if ((vmode.v_modeattr & V_MODEOPTINFO) == 0) {
+#if VESA_DEBUG > 1
+ printf(
+ "Rejecting VESA %s mode: %d x %d x %d bpp attr = %x\n",
+ vmode.v_modeattr & V_MODEGRAPHICS ? "graphics" : "text",
+ vmode.v_width, vmode.v_height, vmode.v_bpp,
+ vmode.v_modeattr);
+#endif
+ continue;
+ }
+#endif
+
+ /* expand the array if necessary */
+ if (modes >= vesa_vmode_max) {
+ vesa_vmode_max += MODE_TABLE_DELTA;
+ p = malloc(sizeof(*vesa_vmode)*(vesa_vmode_max + 1),
+ M_DEVBUF, M_WAITOK);
+#if VESA_DEBUG > 1
+ printf("vesa_bios_init(): modes:%d, vesa_mode_max:%d\n",
+ modes, vesa_vmode_max);
+#endif
+ if (modes > 0) {
+ bcopy(vesa_vmode, p, sizeof(*vesa_vmode)*modes);
+ free(vesa_vmode, M_DEVBUF);
+ }
+ vesa_vmode = p;
+ }
+
+#if VESA_DEBUG > 1
+ printf("Found VESA %s mode: %d x %d x %d bpp\n",
+ vmode.v_modeattr & V_MODEGRAPHICS ? "graphics" : "text",
+ vmode.v_width, vmode.v_height, vmode.v_bpp);
+#endif
+ if (is_via_cle266) {
+ if ((vmode.v_width & 0xff00) >> 8 == vmode.v_height - 1) {
+ vmode.v_width &= 0xff;
+ vmode.v_waseg = 0xb8000 >> 4;
+ }
+ }
+
+ /* copy some fields */
+ bzero(&vesa_vmode[modes], sizeof(vesa_vmode[modes]));
+ vesa_vmode[modes].vi_mode = vesa_vmodetab[i];
+ vesa_vmode[modes].vi_width = vmode.v_width;
+ vesa_vmode[modes].vi_height = vmode.v_height;
+ vesa_vmode[modes].vi_depth = vmode.v_bpp;
+ vesa_vmode[modes].vi_planes = vmode.v_planes;
+ vesa_vmode[modes].vi_cwidth = vmode.v_cwidth;
+ vesa_vmode[modes].vi_cheight = vmode.v_cheight;
+ vesa_vmode[modes].vi_window = (u_int)vmode.v_waseg << 4;
+ /* XXX window B */
+ vesa_vmode[modes].vi_window_size = vmode.v_wsize*1024;
+ vesa_vmode[modes].vi_window_gran = vmode.v_wgran*1024;
+ if (vmode.v_modeattr & V_MODELFB)
+ vesa_vmode[modes].vi_buffer = vmode.v_lfb;
+ else
+ vesa_vmode[modes].vi_buffer = 0;
+ /* XXX */
+ vesa_vmode[modes].vi_buffer_size
+ = vesa_adp_info->v_memsize*64*1024;
+#if 0
+ if (vmode.v_offscreen > vmode.v_lfb)
+ vesa_vmode[modes].vi_buffer_size
+ = vmode.v_offscreen + vmode.v_offscreensize*1024
+ - vmode.v_lfb;
*** DIFF OUTPUT TRUNCATED AT 1000 LINES ***
More information about the svn-src-head
mailing list