NetBSD/sys/dev/ic/igsfb.c
uwe 782296b588 First cut at framebuffer driver for Integraphics Systems IGA1682.
It's not finished yet, but it can do enough to get wscons working for
Krups JavaStation.
2002-03-30 19:48:55 +00:00

953 lines
23 KiB
C

/* $NetBSD: igsfb.c,v 1.1 2002/03/30 19:48:55 uwe Exp $ */
/*
* Copyright (c) 2002 Valeriy E. Ushakov
* 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. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 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.
*/
/*
* Integraphics Systems IGA 1682 and (untested) CyberPro 2k.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: igsfb.c,v 1.1 2002/03/30 19:48:55 uwe Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/buf.h>
#include <sys/ioctl.h>
#include <machine/autoconf.h>
#include <machine/bus.h>
#include <machine/intr.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/rasops/rasops.h>
#include <dev/wsfont/wsfont.h>
#include <dev/ic/igsfbreg.h>
#include <dev/ic/igsfbvar.h>
#include <uvm/uvm_extern.h>
/*
* wsscreen
*/
/* filled from rasops_info in igsfb_common_init */
static struct wsscreen_descr igsfb_stdscreen = {
"std", /* name */
0, 0, /* ncols, nrows */
NULL, /* textops */
0, 0, /* fontwidth, fontheight */
0 /* capabilities */
};
static const struct wsscreen_descr *_igsfb_scrlist[] = {
&igsfb_stdscreen,
};
static const struct wsscreen_list igsfb_screenlist = {
sizeof(_igsfb_scrlist) / sizeof(struct wsscreen_descr *),
_igsfb_scrlist
};
/*
* wsdisplay_accessops
*/
static int igsfb_ioctl(void *, u_long, caddr_t, int, struct proc *);
static paddr_t igsfb_mmap(void *, off_t, int);
static int igsfb_alloc_screen(void *, const struct wsscreen_descr *,
void **, int *, int *, long *);
static void igsfb_free_screen(void *, void *);
static int igsfb_show_screen(void *, void *, int,
void (*) (void *, int, int), void *);
static const struct wsdisplay_accessops igsfb_accessops = {
igsfb_ioctl,
igsfb_mmap,
igsfb_alloc_screen,
igsfb_free_screen,
igsfb_show_screen,
NULL /* load_font */
};
/*
* internal functions
*/
static void igsfb_common_init(struct igsfb_softc *);
static void igsfb_init_bit_tables(struct igsfb_softc *);
static void igsfb_blank_screen(struct igsfb_softc *, int);
static int igsfb_get_cmap(struct igsfb_softc *, struct wsdisplay_cmap *);
static int igsfb_set_cmap(struct igsfb_softc *, struct wsdisplay_cmap *);
static void igsfb_update_cmap(struct igsfb_softc *sc, u_int, u_int);
static void igsfb_set_curpos(struct igsfb_softc *,
struct wsdisplay_curpos *);
static void igsfb_update_curpos(struct igsfb_softc *);
static int igsfb_get_cursor(struct igsfb_softc *,
struct wsdisplay_cursor *);
static int igsfb_set_cursor(struct igsfb_softc *,
struct wsdisplay_cursor *);
static void igsfb_update_cursor(struct igsfb_softc *, u_int);
static void igsfb_convert_cursor_data(struct igsfb_softc *, u_int, u_int);
/*
* bit expanders
*/
static u_int16_t igsfb_spread_bits_8(u_int8_t);
struct igs_bittab *igsfb_bittab = NULL;
struct igs_bittab *igsfb_bittab_bswap = NULL;
static __inline__ u_int16_t
igsfb_spread_bits_8(b)
u_int8_t b;
{
u_int16_t s = b;
s = ((s & 0x00f0) << 4) | (s & 0x000f);
s = ((s & 0x0c0c) << 2) | (s & 0x0303);
s = ((s & 0x2222) << 1) | (s & 0x1111);
return (s);
}
/*
* Enable Video. This might go through either memory or i/o space and
* requires access to registers that we don't need for normal
* operation. So for greater flexibility this function takes bus tag
* and base address, not the igsfb_softc.
*/
int
igsfb_io_enable(bt, base)
bus_space_tag_t bt;
bus_addr_t base;
{
bus_space_handle_t vdoh;
bus_space_handle_t vseh;
int ret;
ret = bus_space_map(bt, base + IGS_VDO, 1, 0, &vdoh);
if (ret != 0) {
printf("unable to map VDO register\n");
return (ret);
}
ret = bus_space_map(bt, base + IGS_VSE, 1, 0, &vseh);
if (ret != 0) {
bus_space_unmap(bt, vdoh, 1);
printf("unable to map VSE register\n");
return (ret);
}
/* enable video: start decoding i/o space accesses */
bus_space_write_1(bt, vdoh, 0, IGS_VDO_ENABLE | IGS_VDO_SETUP);
bus_space_write_1(bt, vseh, 0, IGS_VSE_ENABLE);
bus_space_write_1(bt, vdoh, 0, IGS_VDO_ENABLE);
bus_space_unmap(bt, vdoh, 1);
bus_space_unmap(bt, vseh, 1);
return (0);
}
/*
* Enable linear: start decoding memory space accesses.
* while here, enable coprocessor and set its addrress to 0xbf000.
*/
void
igsfb_mem_enable(sc)
struct igsfb_softc *sc;
{
igs_ext_write(sc->sc_iot, sc->sc_ioh, IGS_EXT_BIU_MISC_CTL,
IGS_EXT_BIU_LINEAREN
| IGS_EXT_BIU_COPREN
| IGS_EXT_BIU_COPASELB);
}
/*
* Finish off the attach. Bus specific attach method should have
* enabled io and memory accesses and mapped io and cop registers.
*/
void
igsfb_common_attach(sc, isconsole)
struct igsfb_softc *sc;
int isconsole;
{
bus_addr_t craddr;
off_t croffset;
struct rasops_info *ri;
struct wsemuldisplaydev_attach_args waa;
u_int8_t busctl, curctl;
busctl = igs_ext_read(sc->sc_iot, sc->sc_ioh, IGS_EXT_BUS_CTL);
if (busctl & 0x2)
sc->sc_memsz = 4 * 1024 * 1024;
else if (busctl & 0x1)
sc->sc_memsz = 2 * 1024 * 1024;
else
sc->sc_memsz = 1 * 1024 * 1024;
/*
* Don't map in all N megs, just the amount we need for wsscreen
*/
sc->sc_fbsz = 1024 * 768; /* XXX: 8bpp specific */
if (bus_space_map(sc->sc_memt, sc->sc_memaddr, sc->sc_fbsz,
sc->sc_memflags | BUS_SPACE_MAP_LINEAR,
&sc->sc_fbh) != 0)
{
bus_space_unmap(sc->sc_iot, sc->sc_ioh, IGS_IO_SIZE);
printf("unable to map framebuffer\n");
return;
}
/*
* 1Kb for cursor sprite data at the very end of linear space
*/
croffset = sc->sc_memsz - IGS_CURSOR_DATA_SIZE;
craddr = sc->sc_memaddr + croffset;
if (bus_space_map(sc->sc_memt, craddr, IGS_CURSOR_DATA_SIZE,
sc->sc_memflags | BUS_SPACE_MAP_LINEAR,
&sc->sc_crh) != 0)
{
bus_space_unmap(sc->sc_iot, sc->sc_ioh, IGS_IO_SIZE);
bus_space_unmap(sc->sc_memt, sc->sc_fbh, sc->sc_fbsz);
printf("unable to map cursor sprite region\n");
return;
}
/*
* Tell device where cursor sprite data are located in linear
* space (it takes data offset in 1k units).
*/
croffset >>= 10;
igs_ext_write(sc->sc_iot, sc->sc_ioh,
IGS_EXT_SPRITE_DATA_LO, croffset & 0xff);
igs_ext_write(sc->sc_iot, sc->sc_ioh,
IGS_EXT_SPRITE_DATA_HI, (croffset >> 8) & 0xf);
memset(&sc->sc_cursor, 0, sizeof(struct igs_hwcursor));
memset(bus_space_vaddr(sc->sc_memt, sc->sc_crh),
0xaa, IGS_CURSOR_DATA_SIZE); /* transparent */
curctl = igs_ext_read(sc->sc_iot, sc->sc_ioh, IGS_EXT_SPRITE_CTL);
curctl |= IGS_EXT_SPRITE_64x64;
curctl &= ~IGS_EXT_SPRITE_VISIBLE;
igs_ext_write(sc->sc_iot, sc->sc_ioh, IGS_EXT_SPRITE_CTL, curctl);
/* bit expanders for cursor sprite data */
igsfb_init_bit_tables(sc);
/* alloc and cross-link raster ops */
ri = malloc(sizeof(struct rasops_info), M_DEVBUF, M_NOWAIT | M_ZERO);
if (ri == NULL)
panic("unable to allocate rasops");
ri->ri_hw = sc;
sc->sc_ri = ri;
igsfb_common_init(sc);
/*
* XXX: console attachment needs rethinking
*/
if (isconsole) {
long defattr;
(*ri->ri_ops.alloc_attr)(ri, 0, 0, 0, &defattr);
wsdisplay_cnattach(&igsfb_stdscreen, ri, 0, 0, defattr);
}
printf("%s: %dx%d, %dbpp\n",
sc->sc_dev.dv_xname, ri->ri_width, ri->ri_height, ri->ri_depth);
/* attach wsdisplay */
waa.console = isconsole;
waa.scrdata = &igsfb_screenlist;
waa.accessops = &igsfb_accessops;
waa.accesscookie = sc;
config_found(&sc->sc_dev, &waa, wsemuldisplaydevprint);
}
/*
* Cursor sprite data are in 2bpp. Incoming image/mask are in 1bpp.
* Prebuild tables to expand 1bpp->2bpp with bswapping if neccessary.
*/
static void
igsfb_init_bit_tables(sc)
struct igsfb_softc *sc;
{
struct igs_bittab *tab;
u_int i;
if (sc->sc_hwflags & IGSFB_HW_BSWAP) {
if (igsfb_bittab_bswap == NULL) {
tab = malloc(sizeof(struct igs_bittab),
M_DEVBUF, M_NOWAIT);
for (i = 0; i < 256; ++i) {
u_int16_t s = igsfb_spread_bits_8(i);
tab->iexpand[i] = bswap16(s);
tab->mexpand[i] = bswap16((s << 1) | s);
}
igsfb_bittab_bswap = tab;
}
sc->sc_bittab = igsfb_bittab_bswap;
} else {
if (igsfb_bittab == NULL) {
tab = malloc(sizeof(struct igs_bittab),
M_DEVBUF, M_NOWAIT);
for (i = 0; i < 256; ++i) {
u_int16_t s = igsfb_spread_bits_8(i);
tab->iexpand[i] = s;
tab->mexpand[i] = (s << 1) | s;
}
igsfb_bittab = tab;
}
sc->sc_bittab = igsfb_bittab;
}
}
/*
* I/O and memory are mapped, video enabled, structures allocated.
*/
static void
igsfb_common_init(sc)
struct igsfb_softc *sc;
{
bus_space_tag_t iot = sc->sc_iot;
bus_space_handle_t ioh = sc->sc_ioh;
struct rasops_info *ri = sc->sc_ri;
int wsfcookie;
const u_int8_t *p;
int i;
sc->sc_blanked = 0;
ri->ri_flg = RI_CENTER | RI_CLEAR;
if (sc->sc_hwflags & IGSFB_HW_BSWAP)
ri->ri_flg |= RI_BSWAP;
ri->ri_depth = 8;
ri->ri_width = 1024;
ri->ri_height = 768;
ri->ri_stride = 1024;
ri->ri_bits = (u_char *)sc->sc_fbh;
/*
* Initialize wsfont related stuff.
*/
wsfont_init();
/* prefer gallant that is identical to the one the prom uses */
wsfcookie = wsfont_find("Gallant", 12, 22, 0,
WSDISPLAY_FONTORDER_L2R,
WSDISPLAY_FONTORDER_L2R);
if (wsfcookie <= 0) {
#ifdef DIAGNOSTIC
printf("%s: unable to find font Gallant 12x22\n",
sc->sc_dev.dv_xname);
#endif
/* any font at all? */
wsfcookie = wsfont_find(NULL, 0, 0, 0,
WSDISPLAY_FONTORDER_L2R,
WSDISPLAY_FONTORDER_L2R);
}
if (wsfcookie <= 0) {
printf("%s: unable to find any fonts\n", sc->sc_dev.dv_xname);
return;
}
if (wsfont_lock(wsfcookie, &ri->ri_font) != 0) {
printf("%s: unable to lock font\n", sc->sc_dev.dv_xname);
return;
}
ri->ri_wsfcookie = wsfcookie;
/*
* Initialize colormap related stuff.
*/
/* ANSI color map */
p = rasops_cmap;
for (i = 0; i < IGS_CMAP_SIZE; ++i, p += 3) { /* software copy */
sc->sc_cmap.r[i] = p[0];
sc->sc_cmap.g[i] = p[1];
sc->sc_cmap.b[i] = p[2];
}
igsfb_update_cmap(sc, 0, IGS_CMAP_SIZE);
/* set overscan color r/g/b (XXX: use defattr's rgb?) */
igs_ext_write(iot, ioh, IGS_EXT_OVERSCAN_RED, 0);
igs_ext_write(iot, ioh, IGS_EXT_OVERSCAN_GREEN, 0);
igs_ext_write(iot, ioh, IGS_EXT_OVERSCAN_BLUE, 0);
/* TODO: compute term size based on font dimensions? */
rasops_init(ri, 34, 80);
igsfb_stdscreen.nrows = ri->ri_rows;
igsfb_stdscreen.ncols = ri->ri_cols;
igsfb_stdscreen.textops = &ri->ri_ops;
igsfb_stdscreen.capabilities = ri->ri_caps;
}
/*
* wsdisplay_accessops: mmap()
*/
static paddr_t
igsfb_mmap(v, offset, prot)
void *v;
off_t offset;
int prot;
{
struct igsfb_softc *sc = v;
if (offset >= sc->sc_memsz || offset < 0)
return (-1);
return (bus_space_mmap(sc->sc_memt, sc->sc_memaddr, offset, prot,
sc->sc_memflags | BUS_SPACE_MAP_LINEAR));
}
/*
* wsdisplay_accessops: ioctl()
*/
static int
igsfb_ioctl(v, cmd, data, flag, p)
void *v;
u_long cmd;
caddr_t data;
int flag;
struct proc *p;
{
struct igsfb_softc *sc = v;
struct rasops_info *ri = sc->sc_ri;
int turnoff;
switch (cmd) {
case WSDISPLAYIO_GTYPE:
*(u_int *)data = WSDISPLAY_TYPE_PCIMISC;
return (0);
case WSDISPLAYIO_GINFO:
#define wsd_fbip ((struct wsdisplay_fbinfo *)data)
wsd_fbip->height = ri->ri_height;
wsd_fbip->width = ri->ri_width;
wsd_fbip->depth = ri->ri_depth;
wsd_fbip->cmsize = IGS_CMAP_SIZE;
#undef wsd_fbip
return (0);
case WSDISPLAYIO_GVIDEO:
*(u_int *)data = sc->sc_blanked ?
WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
return (0);
case WSDISPLAYIO_SVIDEO:
turnoff = (*(u_int *)data == WSDISPLAYIO_VIDEO_OFF);
if (sc->sc_blanked != turnoff) {
sc->sc_blanked = turnoff;
igsfb_blank_screen(sc, sc->sc_blanked);
}
return (0);
case WSDISPLAYIO_GETCMAP:
return (igsfb_get_cmap(sc, (struct wsdisplay_cmap *)data));
case WSDISPLAYIO_PUTCMAP:
return (igsfb_set_cmap(sc, (struct wsdisplay_cmap *)data));
case WSDISPLAYIO_GCURMAX:
((struct wsdisplay_curpos *)data)->x = IGS_CURSOR_MAX_SIZE;
((struct wsdisplay_curpos *)data)->y = IGS_CURSOR_MAX_SIZE;
return (0);
case WSDISPLAYIO_GCURPOS:
*(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
return (0);
case WSDISPLAYIO_SCURPOS:
igsfb_set_curpos(sc, (struct wsdisplay_curpos *)data);
return (0);
case WSDISPLAYIO_GCURSOR:
return (igsfb_get_cursor(sc, (struct wsdisplay_cursor *)data));
case WSDISPLAYIO_SCURSOR:
return (igsfb_set_cursor(sc, (struct wsdisplay_cursor *)data));
}
return (EPASSTHROUGH);
}
/*
* wsdisplay_accessops: ioctl(WSDISPLAYIO_SVIDEO)
*/
static void
igsfb_blank_screen(sc, blank)
struct igsfb_softc *sc;
int blank;
{
igs_ext_write(sc->sc_iot, sc->sc_ioh,
IGS_EXT_SYNC_CTL,
blank ? IGS_EXT_SYNC_H0 | IGS_EXT_SYNC_V0
: 0);
}
/*
* wsdisplay_accessops: ioctl(WSDISPLAYIO_GETCMAP)
* Served from software cmap copy.
*/
static int
igsfb_get_cmap(sc, p)
struct igsfb_softc *sc;
struct wsdisplay_cmap *p;
{
u_int index = p->index, count = p->count;
if (index >= IGS_CMAP_SIZE || (index + count) > IGS_CMAP_SIZE)
return (EINVAL);
if (!uvm_useracc(p->red, count, B_WRITE) ||
!uvm_useracc(p->green, count, B_WRITE) ||
!uvm_useracc(p->blue, count, B_WRITE))
return (EFAULT);
copyout(&sc->sc_cmap.r[index], p->red, count);
copyout(&sc->sc_cmap.g[index], p->green, count);
copyout(&sc->sc_cmap.b[index], p->blue, count);
return (0);
}
/*
* wsdisplay_accessops: ioctl(WSDISPLAYIO_SETCMAP)
* Set software cmap copy and propagate changed range to device.
*/
static int
igsfb_set_cmap(sc, p)
struct igsfb_softc *sc;
struct wsdisplay_cmap *p;
{
u_int index = p->index, count = p->count;
if (index >= IGS_CMAP_SIZE || (index + count) > IGS_CMAP_SIZE)
return (EINVAL);
if (!uvm_useracc(p->red, count, B_READ) ||
!uvm_useracc(p->green, count, B_READ) ||
!uvm_useracc(p->blue, count, B_READ))
return (EFAULT);
copyin(p->red, &sc->sc_cmap.r[index], count);
copyin(p->green, &sc->sc_cmap.g[index], count);
copyin(p->blue, &sc->sc_cmap.b[index], count);
igsfb_update_cmap(sc, p->index, p->count);
return (0);
}
/*
* Propagate specified part of the software cmap copy to device.
*/
static void
igsfb_update_cmap(sc, index, count)
struct igsfb_softc *sc;
u_int index, count;
{
bus_space_tag_t t;
bus_space_handle_t h;
u_int last, i;
if (index >= IGS_CMAP_SIZE)
return;
last = index + count;
if (last > IGS_CMAP_SIZE)
last = IGS_CMAP_SIZE;
t = sc->sc_iot;
h = sc->sc_ioh;
/* start palette writing, index is autoincremented by hardware */
bus_space_write_1(t, h, IGS_DAC_PEL_WRITE_IDX, index);
for (i = index; i < last; ++i) {
bus_space_write_1(t, h, IGS_DAC_PEL_DATA, sc->sc_cmap.r[i]);
bus_space_write_1(t, h, IGS_DAC_PEL_DATA, sc->sc_cmap.g[i]);
bus_space_write_1(t, h, IGS_DAC_PEL_DATA, sc->sc_cmap.b[i]);
}
}
/*
* wsdisplay_accessops: ioctl(WSDISPLAYIO_SCURPOS)
*/
static void
igsfb_set_curpos(sc, curpos)
struct igsfb_softc *sc;
struct wsdisplay_curpos *curpos;
{
struct rasops_info *ri = sc->sc_ri;
int x = curpos->x, y = curpos->y;
if (y < 0)
y = 0;
else if (y > ri->ri_height)
y = ri->ri_height;
if (x < 0)
x = 0;
else if (x > ri->ri_width)
x = ri->ri_width;
sc->sc_cursor.cc_pos.x = x;
sc->sc_cursor.cc_pos.y = y;
igsfb_update_curpos(sc);
}
static void
igsfb_update_curpos(sc)
struct igsfb_softc *sc;
{
bus_space_tag_t t;
bus_space_handle_t h;
int x, xoff, y, yoff;
xoff = 0;
x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
if (x < 0) {
x = 0;
xoff = -x;
}
yoff = 0;
y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
if (y < 0) {
y = 0;
yoff = -y;
}
t = sc->sc_iot;
h = sc->sc_ioh;
igs_ext_write(t, h, IGS_EXT_SPRITE_HSTART_LO, x & 0xff);
igs_ext_write(t, h, IGS_EXT_SPRITE_HSTART_HI, (x >> 8) & 0x07);
igs_ext_write(t, h, IGS_EXT_SPRITE_HPRESET, xoff & 0x3f);
igs_ext_write(t, h, IGS_EXT_SPRITE_VSTART_LO, y & 0xff);
igs_ext_write(t, h, IGS_EXT_SPRITE_VSTART_HI, (y >> 8) & 0x07);
igs_ext_write(t, h, IGS_EXT_SPRITE_VPRESET, yoff & 0x3f);
}
/*
* wsdisplay_accessops: ioctl(WSDISPLAYIO_GCURSOR)
*/
static int
igsfb_get_cursor(sc, p)
struct igsfb_softc *sc;
struct wsdisplay_cursor *p;
{
/* XXX: TODO */
return (0);
}
/*
* wsdisplay_accessops: ioctl(WSDISPLAYIO_SCURSOR)
*/
static int
igsfb_set_cursor(sc, p)
struct igsfb_softc *sc;
struct wsdisplay_cursor *p;
{
struct igs_hwcursor *cc;
u_int v, index, count, icount, iwidth;
cc = &sc->sc_cursor;
v = p->which;
if (v & WSDISPLAY_CURSOR_DOCMAP) {
index = p->cmap.index;
count = p->cmap.count;
if (index >= 2 || (index + count) > 2)
return (EINVAL);
if (!uvm_useracc(p->cmap.red, count, B_READ)
|| !uvm_useracc(p->cmap.green, count, B_READ)
|| !uvm_useracc(p->cmap.blue, count, B_READ))
return (EFAULT);
}
if (v & WSDISPLAY_CURSOR_DOSHAPE) {
if (p->size.x > IGS_CURSOR_MAX_SIZE
|| p->size.y > IGS_CURSOR_MAX_SIZE)
return (EINVAL);
iwidth = (p->size.x + 7) >> 3; /* bytes per scan line */
icount = iwidth * p->size.y;
if (!uvm_useracc(p->image, icount, B_READ)
|| !uvm_useracc(p->mask, icount, B_READ))
return (EFAULT);
}
/* XXX: verify that hot is within size, pos within screen? */
/* arguments verified, do the processing */
if (v & WSDISPLAY_CURSOR_DOCUR)
sc->sc_curenb = p->enable;
if (v & WSDISPLAY_CURSOR_DOPOS)
cc->cc_pos = p->pos;
if (v & WSDISPLAY_CURSOR_DOHOT)
cc->cc_hot = p->hot;
if (v & WSDISPLAY_CURSOR_DOCMAP) {
copyin(p->cmap.red, &cc->cc_color[index], count);
copyin(p->cmap.green, &cc->cc_color[index + 2], count);
copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
}
if (v & WSDISPLAY_CURSOR_DOSHAPE) {
u_int trailing_bits;
copyin(p->image, cc->cc_image, icount);
copyin(p->mask, cc->cc_mask, icount);
cc->cc_size = p->size;
/* clear trailing bits in the "partial" mask bytes */
trailing_bits = p->size.x & 0x07;
if (trailing_bits != 0) {
const u_int cutmask = ~((~0) << trailing_bits);
u_char *mp;
u_int i;
mp = cc->cc_mask + iwidth - 1;
for (i = 0; i < p->size.y; ++i) {
*mp &= cutmask;
mp += iwidth;
}
}
igsfb_convert_cursor_data(sc, iwidth, p->size.y);
}
igsfb_update_cursor(sc, v);
return (0);
}
/*
* Convert incoming 1bpp cursor image/mask into native 2bpp format.
*/
static void
igsfb_convert_cursor_data(sc, w, h)
struct igsfb_softc *sc;
u_int w, h;
{
struct igs_hwcursor *cc = &sc->sc_cursor;
struct igs_bittab *btab = sc->sc_bittab;
u_int8_t *ip, *mp;
u_int16_t *dp;
u_int line, i;
/* init sprite to be all transparent */
memset(cc->cc_sprite, 0xaa, IGS_CURSOR_DATA_SIZE);
/* first scanline */
ip = cc->cc_image;
mp = cc->cc_mask;
dp = cc->cc_sprite;
for (line = 0; line < h; ++line) {
for (i = 0; i < w; ++i) {
u_int16_t is = btab->iexpand[ip[i]];
u_int16_t ms = btab->mexpand[mp[i]];
/* NB: tables are pre-bswapped if needed */
dp[i] = (0xaaaa & ~ms) | (is & ms);
}
/* next scanline */
ip += w;
mp += w;
dp += 8; /* 2bpp, 8 pixels per short = 8 shorts */
}
}
/*
* Propagate cursor changes to device.
* "which" is composed from WSDISPLAY_CURSOR_DO* bits.
*/
static void
igsfb_update_cursor(sc, which)
struct igsfb_softc *sc;
u_int which;
{
bus_space_tag_t iot = sc->sc_iot;
bus_space_handle_t ioh = sc->sc_ioh;
u_int8_t curctl;
/*
* We will need to tweak sprite control register for cursor
* visibility and cursor color map manipualtion.
*/
if (which & (WSDISPLAY_CURSOR_DOCUR | WSDISPLAY_CURSOR_DOCMAP)) {
curctl = igs_ext_read(iot, ioh, IGS_EXT_SPRITE_CTL);
}
if (which & WSDISPLAY_CURSOR_DOSHAPE) {
u_int8_t *dst = bus_space_vaddr(sc->sc_memt, sc->sc_crh);
/*
* memcpy between spaces of different endianness would
* be ... special. We cannot be sure if memset gonna
* push data in 4-byte chunks, we can't pre-bswap it,
* so do it byte-by-byte to preserve byte ordering.
*/
if (sc->sc_hwflags & IGSFB_HW_BSWAP) {
u_int8_t *src = (u_int8_t *)sc->sc_cursor.cc_sprite;
int i;
for (i = 0; i < 1024; ++i)
*dst++ = *src++;
} else {
memcpy(dst, sc->sc_cursor.cc_sprite, 1024);
}
}
if (which & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOHOT)) {
/* code shared with WSDISPLAYIO_SCURPOS */
igsfb_update_curpos(sc);
}
if (which & WSDISPLAY_CURSOR_DOCMAP) {
u_int8_t *p;
/* tell DAC we want access to the cursor palette */
igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL,
curctl | IGS_EXT_SPRITE_SELECT);
p = sc->sc_cursor.cc_color;
bus_space_write_1(iot, ioh, IGS_DAC_PEL_WRITE_IDX, 0);
bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[0]);
bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[2]);
bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[4]);
bus_space_write_1(iot, ioh, IGS_DAC_PEL_WRITE_IDX, 1);
bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[1]);
bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[3]);
bus_space_write_1(iot, ioh, IGS_DAC_PEL_DATA, p[5]);
/* restore access to normal palette */
igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL, curctl);
}
if (which & WSDISPLAY_CURSOR_DOCUR) {
if ((curctl & IGS_EXT_SPRITE_VISIBLE) == 0
&& sc->sc_curenb)
igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL,
curctl | IGS_EXT_SPRITE_VISIBLE);
else if ((curctl & IGS_EXT_SPRITE_VISIBLE) != 0
&& !sc->sc_curenb)
igs_ext_write(iot, ioh, IGS_EXT_SPRITE_CTL,
curctl & ~IGS_EXT_SPRITE_VISIBLE);
}
}
/*
* wsdisplay_accessops: alloc_screen()
*/
static int
igsfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
void *v;
const struct wsscreen_descr *type;
void **cookiep;
int *curxp, *curyp;
long *attrp;
{
/* TODO */
return (ENOMEM);
}
/*
* wsdisplay_accessops: free_screen()
*/
static void
igsfb_free_screen(v, cookie)
void *v;
void *cookie;
{
/* TODO */
return;
}
/*
* wsdisplay_accessops: show_screen()
*/
static int
igsfb_show_screen(v, cookie, waitok, cb, cbarg)
void *v;
void *cookie;
int waitok;
void (*cb)(void *, int, int);
void *cbarg;
{
return (0);
}