#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>
#include <dev/ic/bt458reg.h>
#define CGTHREE_CTRL_OFFSET 0x400000
#define CGTHREE_CTRL_SIZE (sizeof(u_int32_t) * 8)
#define CGTHREE_VID_OFFSET 0x800000
#define CGTHREE_VID_SIZE (1024 * 1024)
union bt_cmap {
u_int8_t cm_map[256][3];
u_int32_t cm_chip[256 * 3 / 4];
};
#define BT_ADDR 0x00
#define BT_CMAP 0x04
#define BT_CTRL 0x08
#define BT_OMAP 0x0c
#define CG3_FBC_CTRL 0x10
#define CG3_FBC_STAT 0x11
#define CG3_FBC_START 0x12
#define CG3_FBC_END 0x13
#define CG3_FBC_VCTRL 0x14
#define BT_WRITE(sc, reg, val) \
bus_space_write_4((sc)->sc_bustag, (sc)->sc_ctrl_regs, (reg), (val))
#define BT_READ(sc, reg) \
bus_space_read_4((sc)->sc_bustag, (sc)->sc_ctrl_regs, (reg))
#define BT_BARRIER(sc,reg,flags) \
bus_space_barrier((sc)->sc_bustag, (sc)->sc_ctrl_regs, (reg), \
sizeof(u_int32_t), (flags))
#define BT_D4M3(x) ((((x) >> 2) << 1) + ((x) >> 2))
#define BT_D4M4(x) ((x) & ~3)
#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 cgthree_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;
union bt_cmap sc_cmap;
u_int sc_mode;
};
int cgthree_ioctl(void *, u_long, caddr_t, int, struct proc *);
paddr_t cgthree_mmap(void *, off_t, int);
int cgthree_is_console(int);
void cgthree_loadcmap(struct cgthree_softc *, u_int, u_int);
int cg3_bt_putcmap(union bt_cmap *, struct wsdisplay_cmap *);
int cg3_bt_getcmap(union bt_cmap *, struct wsdisplay_cmap *);
void cgthree_setcolor(void *, u_int, u_int8_t, u_int8_t, u_int8_t);
void cgthree_burner(void *, u_int, u_int);
void cgthree_reset(struct cgthree_softc *);
struct wsdisplay_accessops cgthree_accessops = {
.ioctl = cgthree_ioctl,
.mmap = cgthree_mmap,
.burn_screen = cgthree_burner
};
int cgthreematch(struct device *, void *, void *);
void cgthreeattach(struct device *, struct device *, void *);
const struct cfattach cgthree_ca = {
sizeof (struct cgthree_softc), cgthreematch, cgthreeattach
};
struct cfdriver cgthree_cd = {
NULL, "cgthree", DV_DULL
};
#define CG3_TYPE_DEFAULT 0
#define CG3_TYPE_76HZ 1
#define CG3_TYPE_SMALL 2
struct cg3_videoctrl {
u_int8_t sense;
u_int8_t vctrl[12];
u_int8_t ctrl;
} cg3_videoctrl[] = {
{
FBC_STAT_RES_1152 | FBC_STAT_ID_COLOR,
{ 0xbb, 0x2b, 0x04, 0x14, 0xae, 0x03,
0xa8, 0x24, 0x01, 0x05, 0xff, 0x01 },
FBC_CTRL_XTAL_0 | FBC_CTRL_DIV_1
},
{
FBC_STAT_RES_1152A | FBC_STAT_ID_COLOR,
{ 0xb7, 0x27, 0x03, 0x0f, 0xae, 0x03,
0xae, 0x2a, 0x01, 0x09, 0xff, 0x01 },
FBC_CTRL_XTAL_1 | FBC_CTRL_DIV_1
},
{
0xff,
{ 0xbb, 0x2b, 0x03, 0x0b, 0xb3, 0x03,
0xaf, 0x2b, 0x02, 0x0a, 0xff, 0x01 },
0,
},
};
int
cgthreematch(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
cgthreeattach(struct device *parent, struct device *self, void *aux)
{
struct cgthree_softc *sc = (struct cgthree_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, 8, 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 + CGTHREE_CTRL_OFFSET,
CGTHREE_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 + CGTHREE_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 = cgthree_is_console(node);
cgthree_reset(sc);
cgthree_burner(sc, 1, 0);
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;
printf(", %dx%d\n", sc->sc_sunfb.sf_width, sc->sc_sunfb.sf_height);
fbwscons_init(&sc->sc_sunfb, 0, console);
fbwscons_setcolormap(&sc->sc_sunfb, cgthree_setcolor);
if (console)
fbwscons_console_init(&sc->sc_sunfb, -1);
fbwscons_attach(&sc->sc_sunfb, &cgthree_accessops, console);
return;
fail_vid:
bus_space_unmap(sa->sa_bustag, sc->sc_ctrl_regs, CGTHREE_CTRL_SIZE);
fail_ctrl:
fail:
;
}
int
cgthree_ioctl(void *v, u_long cmd, caddr_t data, int flags, struct proc *p)
{
struct cgthree_softc *sc = v;
struct wsdisplay_fbinfo *wdf;
struct wsdisplay_cmap *cm;
int error;
switch (cmd) {
case WSDISPLAYIO_GTYPE:
*(u_int *)data = WSDISPLAY_TYPE_SUNCG3;
break;
case WSDISPLAYIO_SMODE:
sc->sc_mode = *(u_int *)data;
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 = 256;
break;
case WSDISPLAYIO_LINEBYTES:
*(u_int *)data = sc->sc_sunfb.sf_linebytes;
break;
case WSDISPLAYIO_GETCMAP:
cm = (struct wsdisplay_cmap *)data;
error = cg3_bt_getcmap(&sc->sc_cmap, cm);
if (error)
return (error);
break;
case WSDISPLAYIO_PUTCMAP:
cm = (struct wsdisplay_cmap *)data;
error = cg3_bt_putcmap(&sc->sc_cmap, cm);
if (error)
return (error);
cgthree_loadcmap(sc, cm->index, cm->count);
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);
}
#define START (128 * 1024 + 128 * 1024)
#define NOOVERLAY (0x04000000)
paddr_t
cgthree_mmap(void *v, off_t offset, int prot)
{
struct cgthree_softc *sc = v;
if (offset & PGOFSET || offset < 0)
return (-1);
switch (sc->sc_mode) {
case WSDISPLAYIO_MODE_MAPPED:
if (offset >= NOOVERLAY)
offset -= NOOVERLAY;
else if (offset >= START)
offset -= START;
else
offset = 0;
if (offset >= sc->sc_sunfb.sf_fbsize)
return (-1);
return (bus_space_mmap(sc->sc_bustag, sc->sc_paddr,
CGTHREE_VID_OFFSET + offset, prot, BUS_SPACE_MAP_LINEAR));
case WSDISPLAYIO_MODE_DUMBFB:
if (offset < sc->sc_sunfb.sf_fbsize)
return (bus_space_mmap(sc->sc_bustag, sc->sc_paddr,
CGTHREE_VID_OFFSET + offset, prot,
BUS_SPACE_MAP_LINEAR));
break;
}
return (-1);
}
int
cgthree_is_console(int node)
{
extern int fbnode;
return (fbnode == node);
}
void
cgthree_setcolor(void *v, u_int index, u_int8_t r, u_int8_t g, u_int8_t b)
{
struct cgthree_softc *sc = v;
union bt_cmap *bcm = &sc->sc_cmap;
bcm->cm_map[index][0] = r;
bcm->cm_map[index][1] = g;
bcm->cm_map[index][2] = b;
cgthree_loadcmap(sc, index, 1);
}
void
cgthree_loadcmap(struct cgthree_softc *sc, u_int start, u_int ncolors)
{
u_int cstart;
int count;
cstart = BT_D4M3(start);
count = BT_D4M3(start + ncolors - 1) - BT_D4M3(start) + 3;
BT_WRITE(sc, BT_ADDR, BT_D4M4(start));
while (--count >= 0) {
BT_WRITE(sc, BT_CMAP, sc->sc_cmap.cm_chip[cstart]);
cstart++;
}
}
int
cg3_bt_getcmap(union bt_cmap *bcm, struct wsdisplay_cmap *rcm)
{
u_int index = rcm->index, count = rcm->count, i;
int error;
if (index >= 256 || count > 256 - index)
return (EINVAL);
for (i = 0; i < count; i++) {
if ((error = copyout(&bcm->cm_map[index + i][0],
&rcm->red[i], 1)) != 0)
return (error);
if ((error = copyout(&bcm->cm_map[index + i][1],
&rcm->green[i], 1)) != 0)
return (error);
if ((error = copyout(&bcm->cm_map[index + i][2],
&rcm->blue[i], 1)) != 0)
return (error);
}
return (0);
}
int
cg3_bt_putcmap(union bt_cmap *bcm, struct wsdisplay_cmap *rcm)
{
u_int index = rcm->index, count = rcm->count, i;
int error;
if (index >= 256 || count > 256 - index)
return (EINVAL);
for (i = 0; i < count; i++) {
if ((error = copyin(&rcm->red[i],
&bcm->cm_map[index + i][0], 1)) != 0)
return (error);
if ((error = copyin(&rcm->green[i],
&bcm->cm_map[index + i][1], 1)) != 0)
return (error);
if ((error = copyin(&rcm->blue[i],
&bcm->cm_map[index + i][2], 1)) != 0)
return (error);
}
return (0);
}
void
cgthree_reset(struct cgthree_softc *sc)
{
int i, j;
u_int8_t sts, ctrl;
sts = FBC_READ(sc, CG3_FBC_STAT);
ctrl = FBC_READ(sc, CG3_FBC_CTRL);
if (ctrl & FBC_CTRL_TIME) {
return;
}
for (i = 0; i < nitems(cg3_videoctrl); i++) {
if (cg3_videoctrl[i].sense == 0xff ||
(cg3_videoctrl[i].sense ==
(sts & (FBC_STAT_RES | FBC_STAT_ID)))) {
for (j = 0; j < 12; j++)
FBC_WRITE(sc, CG3_FBC_VCTRL + j,
cg3_videoctrl[i].vctrl[j]);
ctrl &= ~(FBC_CTRL_XTAL | FBC_CTRL_DIV);
ctrl |= cg3_videoctrl[i].ctrl |
FBC_CTRL_TIME;
FBC_WRITE(sc, CG3_FBC_CTRL, ctrl);
break;
}
}
BT_WRITE(sc, BT_ADDR, BT_RMR);
BT_BARRIER(sc, BT_ADDR, BUS_SPACE_BARRIER_WRITE);
BT_WRITE(sc, BT_CTRL, 0xff);
BT_BARRIER(sc, BT_CTRL, BUS_SPACE_BARRIER_WRITE);
BT_WRITE(sc, BT_ADDR, BT_BMR);
BT_BARRIER(sc, BT_ADDR, BUS_SPACE_BARRIER_WRITE);
BT_WRITE(sc, BT_CTRL, 0x00);
BT_BARRIER(sc, BT_CTRL, BUS_SPACE_BARRIER_WRITE);
BT_WRITE(sc, BT_ADDR, BT_CR);
BT_BARRIER(sc, BT_ADDR, BUS_SPACE_BARRIER_WRITE);
BT_WRITE(sc, BT_CTRL,
(BTCR_MPLX_4 | BTCR_RAMENA | BTCR_BLINK_6464));
BT_BARRIER(sc, BT_CTRL, BUS_SPACE_BARRIER_WRITE);
BT_WRITE(sc, BT_ADDR, BT_CTR);
BT_BARRIER(sc, BT_ADDR, BUS_SPACE_BARRIER_WRITE);
BT_WRITE(sc, BT_CTRL, 0x00);
BT_BARRIER(sc, BT_CTRL, BUS_SPACE_BARRIER_WRITE);
}
void
cgthree_burner(void *vsc, u_int on, u_int flags)
{
struct cgthree_softc *sc = vsc;
int s;
u_int8_t fbc;
s = splhigh();
fbc = FBC_READ(sc, CG3_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, CG3_FBC_CTRL, fbc);
splx(s);
}