#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: cg4.c,v 1.44 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/kmem.h>
#include <sys/mman.h>
#include <sys/proc.h>
#include <sys/tty.h>
#include <uvm/uvm_extern.h>
#include <machine/autoconf.h>
#include <machine/cpu.h>
#include <dev/sun/fbio.h>
#include <machine/idprom.h>
#include <machine/pmap.h>
#include <sun3/dev/fbvar.h>
#include <sun3/dev/btreg.h>
#include <sun3/dev/cg4reg.h>
#include <sun3/dev/p4reg.h>
#include "ioconf.h"
union bt_cmap_u {
uint8_t btcm_char[256 * 3];
uint8_t btcm_rgb[256][3];
u_int btcm_int[256 * 3 / 4];
};
#define CG4_TYPE_A 0
#define CG4_TYPE_B 1
#define CG4_MMAP_SIZE (CG4_OVERLAY_SIZE + CG4_ENABLE_SIZE + CG4_PIXMAP_SIZE)
#define CMAP_SIZE 256
struct soft_cmap {
uint8_t r[CMAP_SIZE];
uint8_t g[CMAP_SIZE];
uint8_t b[CMAP_SIZE];
};
struct cg4_softc {
device_t sc_dev;
struct fbdevice sc_fb;
int sc_cg4type;
int sc_pa_overlay;
int sc_pa_enable;
int sc_pa_pixmap;
int sc_video_on;
void *sc_va_cmap;
void *sc_btcm;
void (*sc_ldcmap)(struct cg4_softc *);
struct soft_cmap sc_cmap;
};
static int cg4match(device_t, cfdata_t, void *);
static void cg4attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(cgfour, sizeof(struct cg4_softc),
cg4match, cg4attach, NULL, NULL);
static dev_type_open(cg4open);
static dev_type_ioctl(cg4ioctl);
static dev_type_mmap(cg4mmap);
const struct cdevsw cgfour_cdevsw = {
.d_open = cg4open,
.d_close = nullclose,
.d_read = noread,
.d_write = nowrite,
.d_ioctl = cg4ioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = nopoll,
.d_mmap = cg4mmap,
.d_kqfilter = nokqfilter,
.d_discard = nodiscard,
.d_flag = 0
};
static int cg4gattr (struct fbdevice *, void *);
static int cg4gvideo (struct fbdevice *, void *);
static int cg4svideo (struct fbdevice *, void *);
static int cg4getcmap(struct fbdevice *, void *);
static int cg4putcmap(struct fbdevice *, void *);
#ifdef _SUN3_
static void cg4a_init (struct cg4_softc *);
static void cg4a_ldcmap(struct cg4_softc *);
#endif
static void cg4b_init (struct cg4_softc *);
static void cg4b_ldcmap(struct cg4_softc *);
static struct fbdriver cg4_fbdriver = {
cg4open, nullclose, cg4mmap, nokqfilter, cg4gattr,
cg4gvideo, cg4svideo,
cg4getcmap, cg4putcmap };
static int
cg4match(device_t parent, cfdata_t cf, void *args)
{
struct confargs *ca = args;
int mid, p4id, peekval, tmp;
void *p4reg;
if (ca->ca_paddr == -1)
return 0;
mid = cf->cf_flags & IDM_IMPL_MASK;
if (mid && (mid != (cpu_machine_id & IDM_IMPL_MASK)))
return 0;
if (cf->cf_flags & 0x10) {
#ifdef _SUN3_
if (bus_peek(BUS_OBIO, CG4A_OBIO_CMAP, 1) == -1)
return 0;
tmp = ca->ca_paddr + CG4A_OFF_OVERLAY;
if (bus_peek(ca->ca_bustype, tmp, 1) == -1)
return 0;
return 1;
#else
return 0;
#endif
}
if ((cf->cf_flags & 0x20) == 0) {
p4reg = bus_tmapin(ca->ca_bustype, ca->ca_paddr);
peekval = peek_long(p4reg);
p4id = (peekval == -1) ?
P4_NOTFOUND : fb_pfour_id(p4reg);
bus_tmapout(p4reg);
if (peekval == -1)
return (0);
if (p4id != P4_ID_COLOR8P1) {
#ifdef DEBUG
aprint_debug("cgfour at 0x%lx match p4id=0x%x fails\n",
ca->ca_paddr, p4id & 0xFF);
#endif
return 0;
}
}
tmp = ca->ca_paddr + CG4B_OFF_CMAP;
if (bus_peek(ca->ca_bustype, tmp, 4) == -1)
return 0;
tmp = ca->ca_paddr + CG4B_OFF_OVERLAY;
if (bus_peek(ca->ca_bustype, tmp, 1) == -1)
return 0;
return 1;
}
static void
cg4attach(device_t parent, device_t self, void *args)
{
struct cg4_softc *sc = device_private(self);
struct fbdevice *fb = &sc->sc_fb;
struct confargs *ca = args;
struct fbtype *fbt;
int tmp;
sc->sc_dev = self;
fbt = &fb->fb_fbtype;
fbt->fb_type = FBTYPE_SUN4COLOR;
fbt->fb_width = 1152;
fbt->fb_height = 900;
fbt->fb_depth = 8;
fbt->fb_cmsize = 256;
fbt->fb_size = CG4_MMAP_SIZE;
fb->fb_driver = &cg4_fbdriver;
fb->fb_private = sc;
fb->fb_name = device_xname(self);
fb->fb_flags = device_cfdata(self)->cf_flags;
if (fb->fb_flags & 0x10) {
#ifdef _SUN3_
sc->sc_cg4type = CG4_TYPE_A;
sc->sc_ldcmap = cg4a_ldcmap;
sc->sc_pa_overlay = ca->ca_paddr + CG4A_OFF_OVERLAY;
sc->sc_pa_enable = ca->ca_paddr + CG4A_OFF_ENABLE;
sc->sc_pa_pixmap = ca->ca_paddr + CG4A_OFF_PIXMAP;
sc->sc_va_cmap = bus_mapin(BUS_OBIO, CG4A_OBIO_CMAP,
sizeof(struct amd_regs));
cg4a_init(sc);
#else
panic("cgfour flags 0x10");
#endif
} else {
sc->sc_cg4type = CG4_TYPE_B;
sc->sc_ldcmap = cg4b_ldcmap;
sc->sc_pa_overlay = ca->ca_paddr + CG4B_OFF_OVERLAY;
sc->sc_pa_enable = ca->ca_paddr + CG4B_OFF_ENABLE;
sc->sc_pa_pixmap = ca->ca_paddr + CG4B_OFF_PIXMAP;
tmp = ca->ca_paddr + CG4B_OFF_CMAP;
sc->sc_va_cmap = bus_mapin(ca->ca_bustype, tmp,
sizeof(struct bt_regs));
cg4b_init(sc);
}
if ((fb->fb_flags & 0x20) == 0) {
fb->fb_pfour = bus_mapin(ca->ca_bustype, ca->ca_paddr, 4);
}
if (fb->fb_pfour)
fb_pfour_setsize(fb);
else if (device_unit(self) == 0)
fb_eeprom_setsize(fb);
else {
switch (cpu_machine_id) {
default:
break;
}
}
aprint_normal(" (%dx%d)\n", fbt->fb_width, fbt->fb_height);
tmp = 1;
cg4svideo(fb, &tmp);
if (fb->fb_pfour)
fb_pfour_set_video(fb, 1);
else
enable_video(1);
fb_attach(fb, 4);
}
static int
cg4open(dev_t dev, int flags, int mode, struct lwp *l)
{
struct cg4_softc *sc;
int unit = minor(dev);
sc = device_lookup_private(&cgfour_cd, unit);
if (sc == NULL)
return ENXIO;
return 0;
}
static int
cg4ioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
{
struct cg4_softc *sc = device_lookup_private(&cgfour_cd, minor(dev));
return fbioctlfb(&sc->sc_fb, cmd, data);
}
static paddr_t
cg4mmap(dev_t dev, off_t off, int prot)
{
struct cg4_softc *sc = device_lookup_private(&cgfour_cd, minor(dev));
int physbase;
if (off & PGOFSET)
panic("%s: bad offset", __func__);
if ((off < 0) || (off >= CG4_MMAP_SIZE))
return -1;
if (off < 0x40000) {
if (off < 0x20000) {
physbase = sc->sc_pa_overlay;
} else {
off -= 0x20000;
physbase = sc->sc_pa_enable;
}
} else {
off -= 0x40000;
physbase = sc->sc_pa_pixmap;
}
return (physbase + off) | PMAP_NC;
}
static int
cg4gattr(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
cg4gvideo(struct fbdevice *fb, void *data)
{
struct cg4_softc *sc = fb->fb_private;
int *on = data;
*on = sc->sc_video_on;
return 0;
}
static int
cg4svideo(struct fbdevice *fb, void *data)
{
struct cg4_softc *sc = fb->fb_private;
int *on = data;
if (sc->sc_video_on == *on)
return 0;
sc->sc_video_on = *on;
(*sc->sc_ldcmap)(sc);
return 0;
}
static int
cg4getcmap(struct fbdevice *fb, void *data)
{
struct cg4_softc *sc = fb->fb_private;
struct soft_cmap *cm = &sc->sc_cmap;
struct fbcmap *fbcm = data;
u_int start, count;
int error;
start = fbcm->index;
count = fbcm->count;
if (start >= CMAP_SIZE || count > CMAP_SIZE - start)
return EINVAL;
if ((error = copyout(&cm->r[start], fbcm->red, count)) != 0)
return error;
if ((error = copyout(&cm->g[start], fbcm->green, count)) != 0)
return error;
if ((error = copyout(&cm->b[start], fbcm->blue, count)) != 0)
return error;
return 0;
}
static int
cg4putcmap(struct fbdevice *fb, void *data)
{
struct cg4_softc *sc = fb->fb_private;
struct soft_cmap *cm = &sc->sc_cmap;
struct fbcmap *fbcm = data;
u_int start, count;
int error;
start = fbcm->index;
count = fbcm->count;
if (start >= CMAP_SIZE || count > CMAP_SIZE - start)
return EINVAL;
if ((error = copyin(fbcm->red, &cm->r[start], count)) != 0)
return error;
if ((error = copyin(fbcm->green, &cm->g[start], count)) != 0)
return error;
if ((error = copyin(fbcm->blue, &cm->b[start], count)) != 0)
return error;
(*sc->sc_ldcmap)(sc);
return 0;
}
#ifdef _SUN3_
static void
cg4a_init(struct cg4_softc *sc)
{
volatile struct amd_regs *ar = sc->sc_va_cmap;
struct soft_cmap *cm = &sc->sc_cmap;
int i;
for(i = 0; i < 256; i++) {
cm->r[i] = ar->r[i];
cm->g[i] = ar->g[i];
cm->b[i] = ar->b[i];
}
}
static void
cg4a_ldcmap(struct cg4_softc *sc)
{
volatile struct amd_regs *ar = sc->sc_va_cmap;
struct soft_cmap *cm = &sc->sc_cmap;
int i;
if (sc->sc_video_on) {
for (i = 0; i < 256; i++) {
ar->r[i] = cm->r[i];
ar->g[i] = cm->g[i];
ar->b[i] = cm->b[i];
}
} else {
for (i = 0; i < 256; i++) {
ar->r[i] = 0;
ar->g[i] = 0;
ar->b[i] = 0;
}
}
}
#endif
static void
cg4b_init(struct cg4_softc *sc)
{
volatile struct bt_regs *bt = sc->sc_va_cmap;
struct soft_cmap *cm = &sc->sc_cmap;
union bt_cmap_u *btcm;
int i;
btcm = kmem_alloc(sizeof(*btcm), KM_SLEEP);
sc->sc_btcm = btcm;
bt->bt_addr = 0x04040404;
bt->bt_ctrl = ~0;
bt->bt_addr = 0x05050505;
bt->bt_ctrl = 0;
bt->bt_addr = 0x06060606;
bt->bt_ctrl = 0x43434343;
bt->bt_addr = 0x07070707;
bt->bt_ctrl = 0;
bt->bt_addr = 0;
#ifdef _SUN3_
for (i = 0; i < (256 * 3 / 4); i++)
btcm->btcm_int[i] = bt->bt_cmap;
#else
for (i = 0; i < (256 * 3); i++)
btcm->btcm_char[i] = bt->bt_cmap >> 24;
#endif
for (i = 0; i < 256; i++) {
cm->r[i] = btcm->btcm_rgb[i][0];
cm->g[i] = btcm->btcm_rgb[i][1];
cm->b[i] = btcm->btcm_rgb[i][2];
}
}
static void
cg4b_ldcmap(struct cg4_softc *sc)
{
volatile struct bt_regs *bt = sc->sc_va_cmap;
struct soft_cmap *cm = &sc->sc_cmap;
union bt_cmap_u *btcm = sc->sc_btcm;
int i;
for (i = 0; i < 256; i++) {
btcm->btcm_rgb[i][0] = cm->r[i];
btcm->btcm_rgb[i][1] = cm->g[i];
btcm->btcm_rgb[i][2] = cm->b[i];
}
bt->bt_addr = 0;
#ifdef _SUN3_
if (sc->sc_video_on) {
for (i = 0; i < (256 * 3 / 4); i++)
bt->bt_cmap = btcm->btcm_int[i];
} else {
for (i = 0; i < (256 * 3 / 4); i++)
bt->bt_cmap = 0;
}
#else
if (sc->sc_video_on) {
for (i = 0; i < (256 * 3); i++)
bt->bt_cmap = btcm->btcm_char[i] << 24;
} else {
for (i = 0; i < (256 * 3); i++)
bt->bt_cmap = 0;
}
#endif
}