#include <sys/param.h>
#include <sys/systm.h>
#include <sys/buf.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/malloc.h>
#include <sys/mman.h>
#include <sys/tty.h>
#include <sys/conf.h>
#include <uvm/uvm_extern.h>
#include <machine/autoconf.h>
#include <machine/pmap.h>
#include <machine/cpu.h>
#include <machine/conf.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/rasops/rasops.h>
#include <machine/fbvar.h>
#include <dev/ic/p9000.h>
#include <dev/ic/ibm561reg.h>
#include <dev/sbus/sbusvar.h>
struct agten_cmap {
u_int8_t cm_red[256];
u_int8_t cm_green[256];
u_int8_t cm_blue[256];
};
struct agten_softc {
struct sunfb sc_sunfb;
bus_space_tag_t sc_bustag;
bus_addr_t sc_paddr;
off_t sc_physoffset;
volatile u_int8_t *sc_p9100;
struct agten_cmap sc_cmap;
volatile u_int32_t *sc_i128_fb;
int sc_nscreens;
};
int agten_ioctl(void *, u_long, caddr_t, int, struct proc *);
paddr_t agten_mmap(void *, off_t, int);
void agten_setcolor(void *, u_int, u_int8_t, u_int8_t, u_int8_t);
static __inline__ void ibm561_write(struct agten_softc *, u_int32_t, u_int32_t);
int agten_getcmap(struct agten_cmap *, struct wsdisplay_cmap *);
int agten_putcmap(struct agten_cmap *, struct wsdisplay_cmap *);
void agten_loadcmap(struct agten_softc *, u_int, u_int);
struct wsdisplay_accessops agten_accessops = {
.ioctl = agten_ioctl,
.mmap = agten_mmap
};
int agtenmatch(struct device *, void *, void *);
void agtenattach(struct device *, struct device *, void *);
const struct cfattach agten_ca = {
sizeof(struct agten_softc), agtenmatch, agtenattach
};
struct cfdriver agten_cd = {
NULL, "agten", DV_DULL
};
int
agtenmatch(struct device *parent, void *vcf, void *aux)
{
struct sbus_attach_args *sa = aux;
if (strcmp(sa->sa_name, "PFU,aga") != 0)
return (0);
return (1);
}
void
agtenattach(struct device *parent, struct device *self, void *args)
{
struct agten_softc *sc = (struct agten_softc *)self;
struct sbus_attach_args *sa = args;
bus_space_tag_t bt;
bus_space_handle_t bh;
int node, isconsole;
char *nam;
bt = sa->sa_bustag;
node = sa->sa_node;
nam = getpropstring(node, "model");
printf(": model %s", nam);
isconsole = node == fbnode;
sc->sc_bustag = bt;
sc->sc_paddr = sbus_bus_addr(bt, sa->sa_slot, sa->sa_offset);
sc->sc_physoffset =
(off_t)getpropint(node, "i128_fb_physaddr", 0x8000000);
if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + sc->sc_physoffset,
getpropint(node, "i128_fb_size", 0x400000), BUS_SPACE_MAP_LINEAR,
0, &bh) != 0) {
printf("\n%s: couldn't map video memory\n", self->dv_xname);
return;
}
sc->sc_i128_fb = bus_space_vaddr(bt, bh);
if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset +
getpropint(node, "p9100_reg_physaddr", 0x10a0000), 0x4000,
BUS_SPACE_MAP_LINEAR, 0, &bh) != 0) {
printf("\n%s: couldn't map control registers\n", self->dv_xname);
return;
}
sc->sc_p9100 = bus_space_vaddr(bt, bh);
#ifdef notyet
sc->sc_sunfb.sf_depth = 32;
#else
sc->sc_sunfb.sf_depth = getpropint(node, "ffb_depth", 8);
#endif
sc->sc_sunfb.sf_width = getpropint(node, "ffb_width", 1152);
sc->sc_sunfb.sf_height = getpropint(node, "ffb_height", 900);
sc->sc_sunfb.sf_linebytes =
roundup(sc->sc_sunfb.sf_width, sc->sc_sunfb.sf_depth) *
sc->sc_sunfb.sf_depth / 8;
sc->sc_sunfb.sf_fbsize =
sc->sc_sunfb.sf_height * sc->sc_sunfb.sf_linebytes;
printf(", %dx%d, depth %d\n",
sc->sc_sunfb.sf_width, sc->sc_sunfb.sf_height,
sc->sc_sunfb.sf_depth);
sc->sc_sunfb.sf_ro.ri_bits = (void *)sc->sc_i128_fb;
sc->sc_sunfb.sf_ro.ri_hw = sc;
fbwscons_init(&sc->sc_sunfb, 0, isconsole);
fbwscons_setcolormap(&sc->sc_sunfb, agten_setcolor);
if (isconsole)
fbwscons_console_init(&sc->sc_sunfb, -1);
fbwscons_attach(&sc->sc_sunfb, &agten_accessops, isconsole);
}
int
agten_ioctl(void *dev, u_long cmd, caddr_t data, int flags, struct proc *p)
{
struct agten_softc *sc = dev;
struct wsdisplay_cmap *cm;
struct wsdisplay_fbinfo *wdf;
int error;
switch (cmd) {
case WSDISPLAYIO_GTYPE:
*(u_int *)data = WSDISPLAY_TYPE_AGTEN;
break;
case WSDISPLAYIO_GINFO:
wdf = (struct wsdisplay_fbinfo *)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 = (sc->sc_sunfb.sf_depth == 8) ? 256 : 0;
break;
case WSDISPLAYIO_LINEBYTES:
*(u_int *)data = sc->sc_sunfb.sf_linebytes;
break;
case WSDISPLAYIO_GETCMAP:
if (sc->sc_sunfb.sf_depth == 8) {
cm = (struct wsdisplay_cmap *)data;
error = agten_getcmap(&sc->sc_cmap, cm);
if (error)
return (error);
}
break;
case WSDISPLAYIO_PUTCMAP:
if (sc->sc_sunfb.sf_depth == 8) {
cm = (struct wsdisplay_cmap *)data;
error = agten_putcmap(&sc->sc_cmap, cm);
if (error)
return (error);
agten_loadcmap(sc, 0, 256);
}
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
agten_mmap(void *v, off_t offset, int prot)
{
struct agten_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,
sc->sc_physoffset + offset, prot, BUS_SPACE_MAP_LINEAR));
}
return (-1);
}
void
agten_setcolor(void *v, u_int index, u_int8_t r, u_int8_t g, u_int8_t b)
{
struct agten_softc *sc = v;
sc->sc_cmap.cm_red[index] = r;
sc->sc_cmap.cm_green[index] = g;
sc->sc_cmap.cm_blue[index] = b;
agten_loadcmap(sc, index, 1);
}
int
agten_getcmap(struct agten_cmap *cm, struct wsdisplay_cmap *rcm)
{
u_int index = rcm->index, count = rcm->count;
int error;
if (index >= 256 || count > 256 - index)
return (EINVAL);
if ((error = copyout(&cm->cm_red[index], rcm->red, count)) != 0)
return (error);
if ((error = copyout(&cm->cm_green[index], rcm->green, count)) != 0)
return (error);
if ((error = copyout(&cm->cm_blue[index], rcm->blue, count)) != 0)
return (error);
return (0);
}
int
agten_putcmap(struct agten_cmap *cm, struct wsdisplay_cmap *rcm)
{
u_int index = rcm->index, count = rcm->count;
int error;
if (index >= 256 || count > 256 - index)
return (EINVAL);
if ((error = copyin(rcm->red, &cm->cm_red[index], count)) != 0)
return (error);
if ((error = copyin(rcm->green, &cm->cm_green[index], count)) != 0)
return (error);
if ((error = copyin(rcm->blue, &cm->cm_blue[index], count)) != 0)
return (error);
return (0);
}
static __inline__ void
ibm561_write(struct agten_softc *sc, u_int32_t reg, u_int32_t value)
{
*(volatile u_int32_t *)(sc->sc_p9100 + P9100_RAMDAC_REGISTER(reg)) =
(value) << 16;
}
void
agten_loadcmap(struct agten_softc *sc, u_int start, u_int ncolors)
{
int i;
u_int8_t *red, *green, *blue;
ibm561_write(sc, IBM561_ADDR_LOW,
(IBM561_CMAP_TABLE + start) & 0xff);
ibm561_write(sc, IBM561_ADDR_HIGH,
((IBM561_CMAP_TABLE + start) >> 8) & 0xff);
red = sc->sc_cmap.cm_red;
green = sc->sc_cmap.cm_green;
blue = sc->sc_cmap.cm_blue;
for (i = start; i < start + ncolors; i++) {
ibm561_write(sc, IBM561_CMD_CMAP, *red++);
ibm561_write(sc, IBM561_CMD_CMAP, *green++);
ibm561_write(sc, IBM561_CMD_CMAP, *blue++);
}
}