NetBSD/sys/arch/i386/bios/vesafb.c

/* $NetBSD: vesafb.c,v 1.20 2007/03/04 05:59:56 christos Exp $ */

/*-
 * Copyright (c) 2006 Jared D. McNeill <jmcneill@invisible.ca>
 * 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.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *        This product includes software developed by the NetBSD
 *        Foundation, Inc. and its contributors.
 * 4. Neither the name of The NetBSD Foundation nor the names of its
 *    contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
 */


#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: vesafb.c,v 1.20 2007/03/04 05:59:56 christos Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/malloc.h>

#include <uvm/uvm_extern.h>

#include <machine/frame.h>
#include <machine/kvm86.h>
#include <machine/bus.h>

#if notyet
#include <machine/bioscall.h>
#endif

#include "opt_vesafb.h"

#include <arch/i386/bios/vesabios.h>
#include <arch/i386/bios/vesabiosreg.h>
#include <arch/i386/bios/vesafbvar.h>

MALLOC_DEFINE(M_VESAFB, "vesafb", "vesafb shadow framebuffer");

static int vesafb_match(struct device *, struct cfdata *, void *);
static void vesafb_attach(struct device *, struct device *, void *);

struct wsscreen_descr vesafb_stdscreen = {
	"fb",
	0, 0,
	NULL,
	8, 16,
	0,	/* capabilities */
	NULL,	/* modecookie */
};

static int	vesafb_ioctl(void *, void *, u_long, void *, int,
		    struct lwp *);
static paddr_t	vesafb_mmap(void *, void *, off_t, int);

static void	vesafb_init_screen(void *, struct vcons_screen *,
					int, long *);

static void	vesafb_init(struct vesafb_softc *);
static void	vesafb_powerhook(int, void *);

static int	vesafb_svideo(struct vesafb_softc *, u_int *);
static int	vesafb_gvideo(struct vesafb_softc *, u_int *);
static int	vesafb_putcmap(struct vesafb_softc *,
				    struct wsdisplay_cmap *);
static int	vesafb_getcmap(struct vesafb_softc *,
				    struct wsdisplay_cmap *);

static void	vesafb_set_palette(struct vesafb_softc *, int, struct paletteentry);

struct wsdisplay_accessops vesafb_accessops = {
	vesafb_ioctl,
	vesafb_mmap,
	NULL,	/* alloc_screen */
	NULL,	/* free_screen */
	NULL,	/* show_screen */
	NULL,	/* load_font */
	NULL,	/* pollc */
	NULL,	/* scroll */
};

static struct vcons_screen vesafb_console_screen;

const struct wsscreen_descr *_vesafb_scrlist[] = {
	&vesafb_stdscreen,
};

struct wsscreen_list vesafb_screenlist = {
	sizeof(_vesafb_scrlist) / sizeof(struct wsscreen_descr *),
	_vesafb_scrlist
};

CFATTACH_DECL(vesafb, sizeof(struct vesafb_softc),
    vesafb_match, vesafb_attach, NULL, NULL);

static int
vesafb_match(struct device *parent, struct cfdata *match,
	void *aux)
{
	struct vesabiosdev_attach_args *vaa = aux;

	if (strcmp(vaa->vbaa_type, "raster"))
		return (0);

	return (1);
}

static void
vesafb_attach(struct device *parent, struct device *dev, void *aux)
{
	struct vesafb_softc *sc = (struct vesafb_softc *)dev;
	struct vesabiosdev_attach_args *vaa = aux;
	unsigned char *buf;
	struct trapframe tf;
	int res, i, j;
	long defattr;
	struct modeinfoblock *mi;
	struct rasops_info *ri;
	struct wsemuldisplaydev_attach_args aa;
	bus_space_handle_t h;

	aprint_naive("\n");
	aprint_normal(": VESA frame buffer\n");

	buf = kvm86_bios_addpage(0x2000);
	if (!buf) {
		aprint_error("%s: kvm86_bios_addpage(0x2000) failed\n",
		    sc->sc_dev.dv_xname);
		return;
	}
	sc->sc_buf = buf;

	if (vaa->vbaa_nmodes == 0)
		goto out;

	sc->sc_nscreens = 1; /* XXX console */
	sc->sc_wsmode = WSDISPLAYIO_MODE_EMUL;
	sc->sc_mode = vaa->vbaa_modes[0]; /* XXX */
	sc->sc_pm = 0;
	sc->sc_pmstates = 0;
	sc->sc_isconsole = 0;
	mi = NULL;
	j = 0;

	/* XXX */
	for (i = 0; i < vaa->vbaa_nmodes; i++) {
		memset(&tf, 0, sizeof(struct trapframe));
		tf.tf_eax = 0x4f01; /* function code */
		tf.tf_ecx = vaa->vbaa_modes[i];
		tf.tf_vm86_es = 0;
		tf.tf_edi = 0x2000; /* buf ptr */

		res = kvm86_bioscall(0x10, &tf);
		if (res || (tf.tf_eax & 0xff) != 0x4f) {
			aprint_error("%s: vbecall: res=%d, ax=%x\n",
			    sc->sc_dev.dv_xname, res, tf.tf_eax);
			goto out;
		}
		mi = (struct modeinfoblock *)buf;

		if (mi->XResolution == VESAFB_WIDTH &&
		    mi->YResolution == VESAFB_HEIGHT &&
		    mi->BitsPerPixel == VESAFB_DEPTH) {
			sc->sc_mode = vaa->vbaa_modes[i];
			break;
		}
	}

	if (i == vaa->vbaa_nmodes) {
		aprint_error("%s: no supported mode found\n",
		    sc->sc_dev.dv_xname);
		goto out;
	}

	sc->sc_mi = *mi;

	/* Check for power management support */
	memset(&tf, 0, sizeof(struct trapframe));
	tf.tf_eax = 0x4f10; /* function code */
	tf.tf_ebx = 0;
	tf.tf_edi = 0x2000; /* buf ptr */

	res = kvm86_bioscall(0x10, &tf);
	if (res || (tf.tf_eax & 0xff) != 0x4f)
		sc->sc_pm = 0; /* power management not supported */
	else {
		sc->sc_pm = 1; /* power management is supported */
		sc->sc_pmver = tf.tf_ebx & 0xff;
		sc->sc_pmstates = (tf.tf_ebx >> 8);
	}

	ri = &vesafb_console_screen.scr_ri;
	memset(ri, 0, sizeof(struct rasops_info));

	vcons_init(&sc->sc_vd, sc, &vesafb_stdscreen,
	    &vesafb_accessops);
	sc->sc_vd.init_screen = vesafb_init_screen;

	aprint_normal("%s: fb %dx%dx%d @0x%x\n", sc->sc_dev.dv_xname,
	       mi->XResolution, mi->YResolution,
	       mi->BitsPerPixel, mi->PhysBasePtr);
	if (sc->sc_pm) {
		aprint_normal("%s: VBE/PM %d.%d", sc->sc_dev.dv_xname,
		    (sc->sc_pmver >> 4), sc->sc_pmver & 0xf);
		if (sc->sc_pmstates & 1)
			aprint_normal(" [standby]");
		if (sc->sc_pmstates & 2)
			aprint_normal(" [suspend]");
		if (sc->sc_pmstates & 4)
			aprint_normal(" [off]");
		if (sc->sc_pmstates & 8)
			aprint_normal(" [reduced on]");
		aprint_normal("\n");
	}

	res = _x86_memio_map(X86_BUS_SPACE_MEM, mi->PhysBasePtr,
			      mi->YResolution * mi->BytesPerScanLine,
			      BUS_SPACE_MAP_LINEAR, &h);
	if (res) {
		aprint_error("%s: framebuffer mapping failed\n",
		    sc->sc_dev.dv_xname);
		goto out;
	}
	sc->sc_bits = bus_space_vaddr(X86_BUS_SPACE_MEM, h);

#ifdef VESAFB_SHADOW_FB
	sc->sc_shadowbits = malloc(mi->YResolution * mi->BytesPerScanLine,
				   M_VESAFB, M_NOWAIT);
	if (sc->sc_shadowbits == NULL) {
		aprint_error("%s: unable to allocate %d bytes for shadowfb\n",
		    sc->sc_dev.dv_xname, mi->YResolution*mi->BytesPerScanLine);
		/* Not fatal; we'll just have to continue without shadowfb */
	}
#endif

	vesafb_init(sc);

	vesafb_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
	vcons_init_screen(&sc->sc_vd, &vesafb_console_screen, 1, &defattr);
#ifndef SPLASHSCREEN
	vcons_redraw_screen(&vesafb_console_screen);
#endif

	vesafb_stdscreen.ncols = ri->ri_cols;
	vesafb_stdscreen.nrows = ri->ri_rows;
	vesafb_stdscreen.textops = &ri->ri_ops;
	vesafb_stdscreen.capabilities = ri->ri_caps;
	vesafb_stdscreen.modecookie = NULL;

	wsdisplay_cnattach(&vesafb_stdscreen, ri, 0, 0, defattr);

#ifdef SPLASHSCREEN
	sc->sc_si.si_depth = ri->ri_depth;
	sc->sc_si.si_bits = ri->ri_bits;
	sc->sc_si.si_hwbits = ri->ri_hwbits;
	sc->sc_si.si_width = ri->ri_width;
	sc->sc_si.si_height = ri->ri_height;
	sc->sc_si.si_stride = ri->ri_stride;
	sc->sc_si.si_fillrect = NULL;
	splash_render(&sc->sc_si, SPLASH_F_CENTER|SPLASH_F_FILL);
#endif

#ifdef SPLASHSCREEN_PROGRESS
	sc->sc_sp.sp_top = (mi->YResolution / 8) * 7;
	sc->sc_sp.sp_width = (mi->XResolution / 4) * 3;
	sc->sc_sp.sp_left = (mi->XResolution - sc->sc_sp.sp_width) / 2;
	sc->sc_sp.sp_height = 20;
	sc->sc_sp.sp_state = -1;
	sc->sc_sp.sp_si = &sc->sc_si;
	splash_progress_init(&sc->sc_sp);
#endif

	aa.console = 1; /* XXX */
	aa.scrdata = &vesafb_screenlist;
	aa.accessops = &vesafb_accessops;
	aa.accesscookie = &sc->sc_vd;

#ifdef VESAFB_DISABLE_TEXT
	SCREEN_DISABLE_DRAWING(&vesafb_console_screen);
#endif /* !VESAFB_DISABLE_TEXT */

	sc->sc_isconsole = 1;

	sc->sc_powerhook = powerhook_establish(sc->sc_dev.dv_xname,
	    vesafb_powerhook, sc);
	if (sc->sc_powerhook == NULL)
		aprint_error("%s: unable to establish powerhook\n",
		    sc->sc_dev.dv_xname);

	config_found(dev, &aa, wsemuldisplaydevprint);

out:
	return;
}

static int
vesafb_ioctl(void *v, void *vs, u_long cmd, void *data,
    int flag, struct lwp *l)
{
	struct vcons_data *vd;
	struct vesafb_softc *sc;
	struct wsdisplay_fbinfo *fb;

	vd = (struct vcons_data *)v;
	sc = (struct vesafb_softc *)vd->cookie;

	switch (cmd) {
	case WSDISPLAYIO_GTYPE:
		*(u_int *)data = WSDISPLAY_TYPE_VESA;
		return 0;
	case WSDISPLAYIO_GINFO:
		if (vd->active != NULL) {
			fb = (struct wsdisplay_fbinfo *)data;
			fb->width = sc->sc_mi.XResolution;
			fb->height = sc->sc_mi.YResolution;
			fb->depth = sc->sc_mi.BitsPerPixel;
			fb->cmsize = 256;
			return 0;
		} else
			return ENODEV;
	case WSDISPLAYIO_GVIDEO:
		if (sc->sc_pm)
			return vesafb_gvideo(sc, (u_int *)data);
		else
			return ENODEV;
	case WSDISPLAYIO_SVIDEO:
		if (sc->sc_pm)
			return vesafb_svideo(sc, (u_int *)data);
		else
			return ENODEV;
	case WSDISPLAYIO_GETCMAP:
		if (sc->sc_mi.BitsPerPixel == 8)
			return vesafb_getcmap(sc,
			    (struct wsdisplay_cmap *)data);
		else
			return EINVAL;
	case WSDISPLAYIO_PUTCMAP:
		if (sc->sc_mi.BitsPerPixel == 8)
			return vesafb_putcmap(sc,
			    (struct wsdisplay_cmap *)data);
		else
			return EINVAL;
	case WSDISPLAYIO_LINEBYTES:
		*(u_int *)data = sc->sc_mi.BytesPerScanLine;
		return 0;
	case WSDISPLAYIO_SMODE:
		{
			int new_mode = *(int *)data;
			if (new_mode != sc->sc_wsmode) {
				sc->sc_wsmode = new_mode;
				if (new_mode == WSDISPLAYIO_MODE_EMUL)
					vcons_redraw_screen(vd->active);
			}
		}
		return 0;
	case WSDISPLAYIO_SSPLASH:
#if defined(SPLASHSCREEN)
		if (*(int *)data == 1) {
			SCREEN_DISABLE_DRAWING(&vesafb_console_screen);
			splash_render(&sc->sc_si, SPLASH_F_CENTER|SPLASH_F_FILL);
		} else
			SCREEN_ENABLE_DRAWING(&vesafb_console_screen);
		return 0;
#else
		return ENODEV;
#endif
	case WSDISPLAYIO_SPROGRESS:
#if defined(SPLASHSCREEN) && defined(SPLASHSCREEN_PROGRESS)
		sc->sc_sp.sp_force = 1;
		splash_progress_update(&sc->sc_sp);
		sc->sc_sp.sp_force = 0;
		return 0;
#else
		return ENODEV;
#endif
	}

	return EPASSTHROUGH;
}

static paddr_t
vesafb_mmap(void *v, void *vs, off_t offset, int prot)
{
	struct vcons_data *vd;
	struct vesafb_softc *sc;
	paddr_t pa;

	vd = (struct vcons_data *)v;
	sc = (struct vesafb_softc *)vd->cookie;

	/* XXX */
	if (offset >= 0 && offset <
	    sc->sc_mi.YResolution*sc->sc_mi.BytesPerScanLine) {
		pa = x86_memio_mmap(X86_BUS_SPACE_MEM, sc->sc_mi.PhysBasePtr,
		    offset, prot, BUS_SPACE_MAP_LINEAR);
		return pa;
	}

	return -1;
}

static void
vesafb_init_screen(void *c, struct vcons_screen *scr, int existing,
    long *defattr)
{
	struct vesafb_softc *sc;
	struct rasops_info *ri;
	struct modeinfoblock *mi;

	sc = (struct vesafb_softc *)c;
	mi = &sc->sc_mi;
	ri = &scr->scr_ri;
	ri->ri_flg = RI_CENTER;
	ri->ri_depth = mi->BitsPerPixel;
	ri->ri_width = mi->XResolution;
	ri->ri_height = mi->YResolution;
	ri->ri_stride = mi->BytesPerScanLine;
#ifdef VESAFB_SHADOW_FB
	ri->ri_bits = sc->sc_shadowbits;
	ri->ri_hwbits = sc->sc_bits;
#else
	ri->ri_bits = sc->sc_bits;
#endif /* !VESAFB_SHADOW_FB */
	ri->ri_caps = WSSCREEN_WSCOLORS;
	ri->ri_rnum = mi->RedMaskSize;
	ri->ri_gnum = mi->GreenMaskSize;
	ri->ri_bnum = mi->BlueMaskSize;
	ri->ri_rpos = mi->RedFieldPosition;
	ri->ri_gpos = mi->GreenFieldPosition;
	ri->ri_bpos = mi->BlueFieldPosition;

	rasops_init(ri, mi->YResolution / 16, mi->XResolution / 8);

#ifdef VESA_DISABLE_TEXT
	if (scr == &vesafb_console_screen)
		SCREEN_DISABLE_DRAWING(&vesafb_console_screen);
#endif
}

static void
vesafb_init(struct vesafb_softc *sc)
{
	struct trapframe tf;
#if notyet
	struct bioscallregs regs;
#endif
	struct modeinfoblock *mi;
	struct paletteentry pe;
	int res;
	int i, j;

	mi = &sc->sc_mi;

	/* set mode */
#if 1
	memset(&tf, 0, sizeof(struct trapframe));
	tf.tf_eax = 0x4f02; /* function code */
	tf.tf_ebx = sc->sc_mode | 0x4000; /* flat */

	res = kvm86_bioscall(0x10, &tf);
	if (res || (tf.tf_eax & 0xff) != 0x4f) {
		aprint_error("%s: vbecall: res=%d, ax=%x\n",
		    sc->sc_dev.dv_xname, res, tf.tf_eax);
		return;
	}
#else
	regs.EAX = 0x4f02;
	regs.EBX = sc->sc_mode | 0x4000;
	bioscall(0x10, &regs);
	if ((regs.EAX & 0xff) != 0x4f) {
		aprint_error("%s: bioscall failed\n",
		    sc->sc_dev.dv_xname);
		return;
	}
#endif

	/* setup palette, not required in direct colour mode */
	if (mi->BitsPerPixel == 8) {
		memset(&tf, 0, sizeof(struct trapframe));
		tf.tf_eax = 0x4f08; /* function code */
		tf.tf_ebx = 0x0600; /* we want a 6-bit palette */

		res = kvm86_bioscall(0x10, &tf);
		if (res || (tf.tf_eax & 0xff) != 0x4f) {
			aprint_error("%s: vbecall: res=%d, ax=%x\n",
			    sc->sc_dev.dv_xname, res, tf.tf_eax);
			return;
		}

		j = 0;

		/* setup ansi / rasops palette */
		for (i = 0; i < 256; i++) {
#ifndef SPLASHSCREEN
			pe.Blue = rasops_cmap[(i * 3) + 2];
			pe.Green = rasops_cmap[(i * 3) + 1];
			pe.Red = rasops_cmap[(i * 3) + 0];
			pe.Alignment = 0;
			vesafb_set_palette(sc, i, pe);
#else
			if (i >= SPLASH_CMAP_OFFSET &&
			    i < SPLASH_CMAP_OFFSET +
			    SPLASH_CMAP_SIZE) {
				pe.Blue = _splash_header_data_cmap[j][2];
				pe.Green = _splash_header_data_cmap[j][1];
				pe.Red = _splash_header_data_cmap[j][0];
				pe.Alignment = 0;
				j++;
				vesafb_set_palette(sc, i, pe);
			} else {
				pe.Blue = rasops_cmap[(i * 3) + 2];
				pe.Green = rasops_cmap[(i * 3) + 1];
				pe.Red = rasops_cmap[(i * 3) + 0];
				pe.Alignment = 0;
				vesafb_set_palette(sc, i, pe);
			}
#endif

			/* Fill in the softc colourmap arrays */
			sc->sc_cmap_red[i / 3] = rasops_cmap[i + 0];
			sc->sc_cmap_green[i / 3] = rasops_cmap[i + 1];
			sc->sc_cmap_blue[i / 3] = rasops_cmap[i + 2];
		}
	}

	return;
}

static void
vesafb_powerhook(int why, void *opaque)
{
#if notyet
	struct vesafb_softc *sc;

	sc = (struct vesafb_softc *)opaque;

	switch (why) {
	case PWR_STANDBY:
	case PWR_SUSPEND:
		break;
	case PWR_RESUME:
		vesafb_init(sc);
		break;
	}
#endif

	return;
}

static void
vesafb_set_palette(struct vesafb_softc *sc, int reg,
    struct paletteentry pe)
{
	struct trapframe tf;
	int res;
	char *buf;

	buf = sc->sc_buf;

	/*
	 * this function takes 8 bit per palette as input, but we're
	 * working in 6 bit mode here
	 */
	pe.Red >>= 2;
	pe.Green >>= 2;
	pe.Blue >>= 2;

	memcpy(buf, &pe, sizeof(struct paletteentry));

	/* set palette */
	memset(&tf, 0, sizeof(struct trapframe));
	tf.tf_eax = 0x4f09; /* function code */
	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 = 0x2000;

	res = kvm86_bioscall(0x10, &tf);
	if (res || (tf.tf_eax & 0xff) != 0x4f)
		aprint_error("%s: vbecall: res=%d, ax=%x\n",
		    sc->sc_dev.dv_xname, res, tf.tf_eax);

	return;
}

static int
vesafb_svideo(struct vesafb_softc *sc, u_int *on)
{
#ifdef VESAFB_PM
	struct trapframe tf;
	int res, bh;

	if (*on == WSDISPLAYIO_VIDEO_OFF)
		bh = 1; /* 1:standby 2:suspend, 4:off, 8:reduced_on */
	else
		bh = 0; /* 0:on */

	/* set video pm state */
	memset(&tf, 0, sizeof(struct trapframe));
	tf.tf_eax = 0x4f10; /* function code */
	tf.tf_ebx = (bh << 8) | 1;

	res = kvm86_bioscall(0x10, &tf);
	if (res || (tf.tf_eax & 0xff) != 0x4f) {
		aprint_error("%s: unable to set power state (0x%04x)\n",
		    sc->sc_dev.dv_xname, (tf.tf_eax & 0xffff));
		return ENODEV;
	}

	return 0;
#else
	return ENODEV;
#endif
}

static int
vesafb_gvideo(struct vesafb_softc *sc, u_int *on)
{
#ifdef VESAFB_PM
	struct trapframe tf;
	int res, bh;

	/* get video pm state */
	memset(&tf, 0, sizeof(struct trapframe));
	tf.tf_eax = 0x4f10; /* function code */
	tf.tf_ebx = 2;

	res = kvm86_bioscall(0x10, &tf);
	if (res || (tf.tf_eax & 0xff) != 0x4f) {
		aprint_error("%s: unable to get power state (0x%04x)\n",
		    sc->sc_dev.dv_xname, (tf.tf_eax & 0xffff));
		return ENODEV;
	}

	bh = (tf.tf_ebx & 0xff00) >> 8;

	switch (bh) {
	case 0: /* 0:on */
		*on = WSDISPLAYIO_VIDEO_ON;
		break;
	default: /* 1:standby, 2:suspend, 4:off, 8:reduced_on */
		*on = WSDISPLAYIO_VIDEO_OFF;
		break;
	}

	return 0;
#else
	return ENODEV;
#endif
}

static int
vesafb_putcmap(struct vesafb_softc *sc,
		    struct wsdisplay_cmap *cm)
{
	struct paletteentry pe;
	u_int idx, cnt;
	u_char r[256], g[256], b[256];
	u_char *rp, *gp, *bp;
	int rv, i;

	idx = cm->index;
	cnt = cm->count;

	if (idx >= 255 || cnt > 256 || idx + cnt > 256)
		return EINVAL;

	rv = copyin(cm->red, &r[idx], cnt);
	if (rv)
		return rv;
	rv = copyin(cm->green, &g[idx], cnt);
	if (rv)
		return rv;
	rv = copyin(cm->blue, &b[idx], cnt);
	if (rv)
		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];

	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++;
	}

	return 0;
}

static int
vesafb_getcmap(struct vesafb_softc *sc,
		    struct wsdisplay_cmap *cm)
{
	u_int idx, cnt;
	int rv;

	idx = cm->index;
	cnt = cm->count;

	if (idx >= 255 || cnt > 256 || idx + cnt > 256)
		return EINVAL;

	rv = copyout(&sc->sc_cmap_red[idx], cm->red, cnt);
	if (rv)
		return rv;
	rv = copyout(&sc->sc_cmap_green[idx], cm->green, cnt);
	if (rv)
		return rv;
	rv = copyout(&sc->sc_cmap_blue[idx], cm->blue, cnt);
	if (rv)
		return rv;

	return 0;
}

int
vesafb_cnattach(void)
{
	/* XXX i386 calls consinit too early for us to use
	 *     kvm86; assume that we've attached
	 */

	return 0;
}