#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: cg2.c,v 1.34 2024/12/21 17:40:11 tsutsui Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <sys/proc.h>
#include <sys/tty.h>
#include <uvm/uvm_extern.h>
#include <dev/sun/fbio.h>
#include <machine/autoconf.h>
#include <machine/pmap.h>
#include <machine/cg2reg.h>
#include "ioconf.h"
#include "fbvar.h"
#define CMSIZE 256
#define PLANEMAP_SIZE 0x100000
#define PIXELMAP_SIZE 0x100000
#define ROWOPMAP_SIZE 0x100000
#define CTLREGS_OFF 0x300000
#define CTLREGS_SIZE 0x10600
#define CG2_MAPPED_OFFSET (PLANEMAP_SIZE + PIXELMAP_SIZE)
#define CG2_MAPPED_SIZE (CTLREGS_OFF + CTLREGS_SIZE)
struct cg2_softc {
device_t sc_dev;
struct fbdevice sc_fb;
int sc_phys;
int sc_pmtype;
struct cg2fb *sc_ctlreg;
};
static int cg2match(device_t, cfdata_t, void *);
static void cg2attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(cgtwo, sizeof(struct cg2_softc),
cg2match, cg2attach, NULL, NULL);
static dev_type_open(cg2open);
static dev_type_ioctl(cg2ioctl);
static dev_type_mmap(cg2mmap);
const struct cdevsw cgtwo_cdevsw = {
.d_open = cg2open,
.d_close = nullclose,
.d_read = noread,
.d_write = nowrite,
.d_ioctl = cg2ioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = nopoll,
.d_mmap = cg2mmap,
.d_kqfilter = nokqfilter,
.d_discard = nodiscard,
.d_flag = 0
};
static int cg2gattr(struct fbdevice *, void *);
static int cg2gvideo(struct fbdevice *, void *);
static int cg2svideo(struct fbdevice *, void *);
static int cg2getcmap(struct fbdevice *, void *);
static int cg2putcmap(struct fbdevice *, void *);
static struct fbdriver cg2fbdriver = {
cg2open, nullclose, cg2mmap, nokqfilter, cg2gattr,
cg2gvideo, cg2svideo,
cg2getcmap, cg2putcmap };
static int cg2intr(void *);
static int
cg2match(device_t parent, cfdata_t cf, void *aux)
{
struct confargs *ca = aux;
int probe_addr;
if (ca->ca_paddr == -1)
return 0;
probe_addr = ca->ca_paddr + CTLREGS_OFF;
if (bus_peek(ca->ca_bustype, probe_addr, 1) == -1)
return 0;
if (ca->ca_intpri == -1)
ca->ca_intpri = 4;
return 1;
}
static void
cg2attach(device_t parent, device_t self, void *args)
{
struct cg2_softc *sc = device_private(self);
struct fbdevice *fb = &sc->sc_fb;
struct confargs *ca = args;
struct fbtype *fbt;
sc->sc_dev = self;
sc->sc_phys = ca->ca_paddr;
sc->sc_pmtype = PMAP_NC | PMAP_VME16;
sc->sc_ctlreg = (struct cg2fb *)bus_mapin(ca->ca_bustype,
ca->ca_paddr + CTLREGS_OFF, CTLREGS_SIZE);
isr_add_vectored(cg2intr, sc, ca->ca_intpri, ca->ca_intvec);
sc->sc_ctlreg->intrptvec.reg = ca->ca_intvec;
sc->sc_ctlreg->status.word = 1;
fb->fb_driver = &cg2fbdriver;
fb->fb_private = sc;
fb->fb_name = device_xname(self);
fbt = &fb->fb_fbtype;
fbt->fb_type = FBTYPE_SUN2COLOR;
fbt->fb_depth = 8;
fbt->fb_cmsize = CMSIZE;
fbt->fb_width = 1152;
fbt->fb_height = 900;
fbt->fb_size = CG2_MAPPED_SIZE;
aprint_normal(" (%dx%d)\n", fbt->fb_width, fbt->fb_height);
fb_attach(fb, 2);
}
static int
cg2open(dev_t dev, int flags, int mode, struct lwp *l)
{
struct cg2_softc *sc;
int unit = minor(dev);
sc = device_lookup_private(&cgtwo_cd, unit);
if (sc == NULL)
return ENXIO;
return 0;
}
static int
cg2ioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
{
struct cg2_softc *sc = device_lookup_private(&cgtwo_cd, minor(dev));
return fbioctlfb(&sc->sc_fb, cmd, data);
}
static paddr_t
cg2mmap(dev_t dev, off_t off, int prot)
{
struct cg2_softc *sc = device_lookup_private(&cgtwo_cd, minor(dev));
if (off & PGOFSET)
panic("%s: bad offset", __func__);
if (off >= CG2_MAPPED_SIZE)
return -1;
return (sc->sc_phys + off) | sc->sc_pmtype;
}
static int
cg2gattr(struct fbdevice *fb, void *data)
{
struct fbgattr *fba = data;
fba->real_type = fb->fb_fbtype.fb_type;
fba->owner = 0;
fba->fbtype = fb->fb_fbtype;
fba->sattr.flags = 0;
fba->sattr.emu_type = fb->fb_fbtype.fb_type;
fba->sattr.dev_specific[0] = -1;
fba->emu_types[0] = fb->fb_fbtype.fb_type;
fba->emu_types[1] = -1;
return 0;
}
static int
cg2gvideo(struct fbdevice *fb, void *data)
{
int *on = data;
struct cg2_softc *sc = fb->fb_private;
*on = sc->sc_ctlreg->status.reg.video_enab;
return 0;
}
static int
cg2svideo(struct fbdevice *fb, void *data)
{
int *on = data;
struct cg2_softc *sc = fb->fb_private;
sc->sc_ctlreg->status.reg.video_enab = (*on) & 1;
return 0;
}
static int
cg2getcmap(struct fbdevice *fb, void *data)
{
struct fbcmap *cmap = data;
struct cg2_softc *sc = fb->fb_private;
uint8_t red[CMSIZE], green[CMSIZE], blue[CMSIZE];
int error, start, count, ecount;
u_int i;
uint16_t *p;
start = cmap->index;
count = cmap->count;
ecount = start + count;
if (start >= CMSIZE || count > CMSIZE - start)
return EINVAL;
p = &sc->sc_ctlreg->redmap[start];
for (i = start; i < ecount; i++)
red[i] = *p++;
p = &sc->sc_ctlreg->greenmap[start];
for (i = start; i < ecount; i++)
green[i] = *p++;
p = &sc->sc_ctlreg->bluemap[start];
for (i = start; i < ecount; i++)
blue[i] = *p++;
if ((error = copyout(red + start, cmap->red, count)) != 0)
return error;
if ((error = copyout(green + start, cmap->green, count)) != 0)
return error;
if ((error = copyout(blue + start, cmap->blue, count)) != 0)
return error;
return 0;
}
static int
cg2putcmap(struct fbdevice *fb, void *data)
{
struct fbcmap *cmap = data;
struct cg2_softc *sc = fb->fb_private;
uint8_t red[CMSIZE], green[CMSIZE], blue[CMSIZE];
int error;
u_int start, count, ecount;
u_int i;
uint16_t *p;
start = cmap->index;
count = cmap->count;
ecount = start + count;
if (start >= CMSIZE || count > CMSIZE - start)
return EINVAL;
if ((error = copyin(cmap->red, red + start, count)) != 0)
return error;
if ((error = copyin(cmap->green, green + start, count)) != 0)
return error;
if ((error = copyin(cmap->blue, blue + start, count)) != 0)
return error;
p = &sc->sc_ctlreg->redmap[start];
for (i = start; i < ecount; i++)
*p++ = red[i];
p = &sc->sc_ctlreg->greenmap[start];
for (i = start; i < ecount; i++)
*p++ = green[i];
p = &sc->sc_ctlreg->bluemap[start];
for (i = start; i < ecount; i++)
*p++ = blue[i];
return 0;
}
static int
cg2intr(void *vsc)
{
struct cg2_softc *sc = vsc;
sc->sc_ctlreg->status.reg.inten = 0;
printf("cg2intr\n");
return 1;
}