#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/errno.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/malloc.h>
#include <machine/bus.h>
#include <machine/intr.h>
#include <machine/autoconf.h>
#include <machine/openfirm.h>
#include <dev/sbus/sbusvar.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/rasops/rasops.h>
#include <machine/fbvar.h>
#define BWTWO_CTRL_OFFSET 0x400000
#define BWTWO_CTRL_SIZE (sizeof(u_int32_t) * 8)
#define BWTWO_VID_OFFSET 0x800000
#define BWTWO_VID_SIZE (1024 * 1024)
#define FBC_CTRL 0x10
#define FBC_STAT 0x11
#define FBC_START 0x12
#define FBC_END 0x13
#define FBC_VCTRL 0x14
#define FBC_CTRL_IENAB 0x80
#define FBC_CTRL_VENAB 0x40
#define FBC_CTRL_TIME 0x20
#define FBC_CTRL_CURS 0x10
#define FBC_CTRL_XTAL 0x0c
#define FBC_CTRL_XTAL_0 0x00
#define FBC_CTRL_XTAL_1 0x04
#define FBC_CTRL_XTAL_2 0x08
#define FBC_CTRL_XTAL_TEST 0x0c
#define FBC_CTRL_DIV 0x03
#define FBC_CTRL_DIV_1 0x00
#define FBC_CTRL_DIV_2 0x01
#define FBC_CTRL_DIV_3 0x02
#define FBC_CTRL_DIV_4 0x03
#define FBC_STAT_INTR 0x80
#define FBC_STAT_RES 0x70
#define FBC_STAT_RES_1024 0x10
#define FBC_STAT_RES_1280 0x40
#define FBC_STAT_RES_1152 0x30
#define FBC_STAT_RES_1152A 0x40
#define FBC_STAT_RES_1600 0x50
#define FBC_STAT_RES_1152B 0x60
#define FBC_STAT_ID 0x0f
#define FBC_STAT_ID_COLOR 0x01
#define FBC_STAT_ID_MONO 0x02
#define FBC_STAT_ID_MONOECL 0x03
#define FBC_READ(sc, reg) \
bus_space_read_1((sc)->sc_bustag, (sc)->sc_ctrl_regs, (reg))
#define FBC_WRITE(sc, reg, val) \
bus_space_write_1((sc)->sc_bustag, (sc)->sc_ctrl_regs, (reg), (val))
struct bwtwo_softc {
struct sunfb sc_sunfb;
bus_space_tag_t sc_bustag;
bus_addr_t sc_paddr;
bus_space_handle_t sc_ctrl_regs;
bus_space_handle_t sc_vid_regs;
int sc_nscreens;
};
int bwtwo_ioctl(void *, u_long, caddr_t, int, struct proc *);
paddr_t bwtwo_mmap(void *, off_t, int);
int bwtwo_is_console(int);
void bwtwo_burner(void *, u_int, u_int);
struct wsdisplay_accessops bwtwo_accessops = {
.ioctl = bwtwo_ioctl,
.mmap = bwtwo_mmap,
.burn_screen = bwtwo_burner
};
int bwtwomatch(struct device *, void *, void *);
void bwtwoattach(struct device *, struct device *, void *);
const struct cfattach bwtwo_ca = {
sizeof (struct bwtwo_softc), bwtwomatch, bwtwoattach
};
struct cfdriver bwtwo_cd = {
NULL, "bwtwo", DV_DULL
};
int
bwtwomatch(struct device *parent, void *vcf, void *aux)
{
struct cfdata *cf = vcf;
struct sbus_attach_args *sa = aux;
return (strcmp(cf->cf_driver->cd_name, sa->sa_name) == 0);
}
void
bwtwoattach(struct device *parent, struct device *self, void *aux)
{
struct bwtwo_softc *sc = (struct bwtwo_softc *)self;
struct sbus_attach_args *sa = aux;
int node, console;
const char *nam;
node = sa->sa_node;
sc->sc_bustag = sa->sa_bustag;
sc->sc_paddr = sbus_bus_addr(sa->sa_bustag, sa->sa_slot, sa->sa_offset);
fb_setsize(&sc->sc_sunfb, 1, 1152, 900, node, 0);
if (sa->sa_nreg != 1) {
printf(": expected %d registers, got %d\n", 1, sa->sa_nreg);
goto fail;
}
if (sbus_bus_map(sa->sa_bustag, sa->sa_reg[0].sbr_slot,
sa->sa_reg[0].sbr_offset + BWTWO_CTRL_OFFSET,
BWTWO_CTRL_SIZE, 0, 0, &sc->sc_ctrl_regs) != 0) {
printf(": cannot map ctrl registers\n");
goto fail_ctrl;
}
if (sbus_bus_map(sa->sa_bustag, sa->sa_reg[0].sbr_slot,
sa->sa_reg[0].sbr_offset + BWTWO_VID_OFFSET,
sc->sc_sunfb.sf_fbsize, BUS_SPACE_MAP_LINEAR,
0, &sc->sc_vid_regs) != 0) {
printf(": cannot map vid registers\n");
goto fail_vid;
}
nam = getpropstring(node, "model");
if (*nam == '\0')
nam = sa->sa_name;
printf(": %s", nam);
console = bwtwo_is_console(node);
bwtwo_burner(sc, 1, 0);
printf(", %dx%d\n", sc->sc_sunfb.sf_width, sc->sc_sunfb.sf_height);
sc->sc_sunfb.sf_ro.ri_bits = (void *)bus_space_vaddr(sc->sc_bustag,
sc->sc_vid_regs);
sc->sc_sunfb.sf_ro.ri_hw = sc;
fbwscons_init(&sc->sc_sunfb, 0, console);
if (console)
fbwscons_console_init(&sc->sc_sunfb, -1);
fbwscons_attach(&sc->sc_sunfb, &bwtwo_accessops, console);
return;
fail_vid:
bus_space_unmap(sa->sa_bustag, sc->sc_ctrl_regs, BWTWO_CTRL_SIZE);
fail_ctrl:
fail:
;
}
int
bwtwo_ioctl(void *v, u_long cmd, caddr_t data, int flags, struct proc *p)
{
struct bwtwo_softc *sc = v;
struct wsdisplay_fbinfo *wdf;
switch (cmd) {
case WSDISPLAYIO_GTYPE:
*(u_int *)data = WSDISPLAY_TYPE_SUNBW;
break;
case WSDISPLAYIO_GINFO:
wdf = (void *)data;
wdf->height = sc->sc_sunfb.sf_height;
wdf->width = sc->sc_sunfb.sf_width;
wdf->depth = sc->sc_sunfb.sf_depth;
wdf->stride = sc->sc_sunfb.sf_linebytes;
wdf->offset = 0;
wdf->cmsize = 0;
break;
case WSDISPLAYIO_LINEBYTES:
*(u_int *)data = sc->sc_sunfb.sf_linebytes;
break;
case WSDISPLAYIO_GETCMAP:
case WSDISPLAYIO_PUTCMAP:
break;
case WSDISPLAYIO_SVIDEO:
case WSDISPLAYIO_GVIDEO:
break;
case WSDISPLAYIO_GCURPOS:
case WSDISPLAYIO_SCURPOS:
case WSDISPLAYIO_GCURMAX:
case WSDISPLAYIO_GCURSOR:
case WSDISPLAYIO_SCURSOR:
default:
return -1;
}
return (0);
}
paddr_t
bwtwo_mmap(void *v, off_t offset, int prot)
{
struct bwtwo_softc *sc = v;
if (offset & PGOFSET)
return (-1);
if (offset >= 0 && offset < sc->sc_sunfb.sf_fbsize)
return (bus_space_mmap(sc->sc_bustag, sc->sc_paddr,
BWTWO_VID_OFFSET + offset, prot, BUS_SPACE_MAP_LINEAR));
return (-1);
}
int
bwtwo_is_console(int node)
{
extern int fbnode;
return (fbnode == node);
}
void
bwtwo_burner(void *vsc, u_int on, u_int flags)
{
struct bwtwo_softc *sc = vsc;
int s;
u_int8_t fbc;
s = splhigh();
fbc = FBC_READ(sc, FBC_CTRL);
if (on)
fbc |= FBC_CTRL_VENAB | FBC_CTRL_TIME;
else {
fbc &= ~FBC_CTRL_VENAB;
if (flags & WSDISPLAY_BURN_VBLANK)
fbc &= ~FBC_CTRL_TIME;
}
FBC_WRITE(sc, FBC_CTRL, fbc);
splx(s);
}