#include "wsdisplay.h"
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: cgfour.c,v 1.52 2026/05/25 13:47:08 christos Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/buf.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include <sys/tty.h>
#include <sys/conf.h>
#include <machine/autoconf.h>
#include <machine/eeprom.h>
#include <dev/sun/fbio.h>
#include <dev/sun/fbvar.h>
#include <dev/sun/btreg.h>
#include <dev/sun/btvar.h>
#include <dev/sun/pfourreg.h>
#if NWSDISPLAY > 0
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplay_vconsvar.h>
#include <dev/wsfont/wsfont.h>
#include <dev/rasops/rasops.h>
#include "opt_wsemul.h"
#endif
#define CGFOUR_OVERLAY_SIZE 0x20000
#define CGFOUR_RAM_SIZE 0x100000
struct cgfour_softc {
struct fbdevice sc_fb;
bus_space_tag_t sc_bustag;
bus_addr_t sc_paddr;
volatile struct fbcontrol *sc_fbc;
#if NWSDISPLAY > 0
uint32_t sc_width;
uint32_t sc_height;
uint32_t sc_stride;
int sc_mode;
struct vcons_data sc_vd;
char *sc_overlay;
char *sc_enable;
#endif
union bt_cmap sc_cmap;
};
static int cgfourmatch(device_t, cfdata_t, void *);
static void cgfourattach(device_t, device_t, void *);
#if defined(SUN4)
static void cgfourunblank(device_t);
#endif
static int cg4_pfour_probe(void *, void *);
CFATTACH_DECL_NEW(cgfour, sizeof(struct cgfour_softc),
cgfourmatch, cgfourattach, NULL, NULL);
extern struct cfdriver cgfour_cd;
dev_type_open(cgfouropen);
dev_type_ioctl(cgfourioctl);
dev_type_mmap(cgfourmmap);
const struct cdevsw cgfour_cdevsw = {
.d_open = cgfouropen,
.d_close = nullclose,
.d_read = noread,
.d_write = nowrite,
.d_ioctl = cgfourioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = nopoll,
.d_mmap = cgfourmmap,
.d_kqfilter = nokqfilter,
.d_discard = nodiscard,
.d_flag = 0
};
#if defined(SUN4)
static struct fbdriver cgfourfbdriver = {
cgfourunblank, cgfouropen, nullclose, cgfourioctl, nopoll,
cgfourmmap, nokqfilter
};
static void cgfourloadcmap(struct cgfour_softc *, int, int);
static int cgfour_get_video(struct cgfour_softc *);
static void cgfour_set_video(struct cgfour_softc *, int);
#if NWSDISPLAY > 0
static void cgfour_setup_palette(struct cgfour_softc *);
struct wsscreen_descr cgfour_defaultscreen = {
"std",
0, 0,
NULL,
8, 16,
WSSCREEN_WSCOLORS,
NULL
};
static int cgfour_ioctl(void *, void *, u_long, void *, int, struct lwp *);
static paddr_t cgfour_mmap(void *, void *, off_t, int);
static void cgfour_init_screen(void *, struct vcons_screen *, int, long *);
static void cgfour_clear_screen(struct cgfour_softc *, int);
static int cgfour_putcmap(struct cgfour_softc *, struct wsdisplay_cmap *);
static int cgfour_getcmap(struct cgfour_softc *, struct wsdisplay_cmap *);
struct wsdisplay_accessops cgfour_accessops = {
.ioctl = cgfour_ioctl,
.mmap = cgfour_mmap,
.alloc_screen = NULL,
.free_screen = NULL,
.show_screen = NULL,
.load_font = NULL,
.pollc = NULL,
.scroll = NULL
};
const struct wsscreen_descr *_cgfour_scrlist[] = {
&cgfour_defaultscreen
};
struct wsscreen_list cgfour_screenlist = {
.nscreens = sizeof(_cgfour_scrlist) / sizeof(struct wsscreen_descr *),
.screens = _cgfour_scrlist
};
static struct vcons_screen cgfour_console_screen;
#endif
#endif
static int
cgfourmatch(device_t parent, cfdata_t cf, void *aux)
{
union obio_attach_args *uoba = aux;
struct obio4_attach_args *oba;
if (uoba->uoba_isobio4 == 0)
return (0);
oba = &uoba->uoba_oba4;
return (bus_space_probe(oba->oba_bustag, oba->oba_paddr,
4,
0,
0,
cg4_pfour_probe, NULL));
}
static int
cg4_pfour_probe(void *vaddr, void *arg)
{
return (fb_pfour_id(vaddr) == PFOUR_ID_COLOR8P1);
}
static void
cgfourattach(device_t parent, device_t self, void *aux)
{
#if defined(SUN4)
struct cgfour_softc *sc = device_private(self);
union obio_attach_args *uoba = aux;
struct obio4_attach_args *oba = &uoba->uoba_oba4;
bus_space_handle_t bh;
volatile struct bt_regs *bt;
struct fbdevice *fb = &sc->sc_fb;
int i, isconsole;
#if NWSDISPLAY > 0
struct wsemuldisplaydev_attach_args wsemul_aa;
struct rasops_info *ri = &cgfour_console_screen.scr_ri;
unsigned long defattr = 0;
#endif
sc->sc_bustag = oba->oba_bustag;
sc->sc_paddr = (bus_addr_t)oba->oba_paddr;
if (bus_space_map(oba->oba_bustag, oba->oba_paddr,
sizeof(uint32_t),
BUS_SPACE_MAP_LINEAR,
&bh) != 0) {
printf("%s: cannot map control registers\n",
device_xname(self));
return;
}
fb->fb_pfour = (volatile uint32_t *)bh;
fb->fb_driver = &cgfourfbdriver;
fb->fb_device = self;
fb->fb_type.fb_type = FBTYPE_SUN4COLOR;
fb->fb_flags = device_cfdata(self)->cf_flags & FB_USERMASK;
fb->fb_flags |= FB_PFOUR;
fb->fb_type.fb_depth = 8;
fb_setsize_eeprom(fb, fb->fb_type.fb_depth, 1152, 900);
fb->fb_type.fb_cmsize = 256;
fb->fb_type.fb_size = CGFOUR_RAM_SIZE;
printf(": cgfour/p4, %d x %d",
fb->fb_type.fb_width, fb->fb_type.fb_height);
isconsole = 0;
if (CPU_ISSUN4) {
struct eeprom *eep = (struct eeprom *)eeprom_va;
if (eep == NULL || eep->eeConsole == EE_CONS_P4OPT)
isconsole = fb_is_console(0);
}
if (isconsole) {
if (bus_space_map(oba->oba_bustag,
oba->oba_paddr + PFOUR_COLOR_OFF_OVERLAY,
CGFOUR_OVERLAY_SIZE,
BUS_SPACE_MAP_LINEAR,
&bh) != 0) {
printf("%s: cannot map overlay plane\n",
device_xname(self));
return;
}
sc->sc_overlay = (char *)bh;
if (bus_space_map(oba->oba_bustag,
oba->oba_paddr + PFOUR_COLOR_OFF_ENABLE,
CGFOUR_OVERLAY_SIZE,
BUS_SPACE_MAP_LINEAR,
&bh) != 0) {
printf("%s: cannot map enable plane\n",
device_xname(self));
return;
}
sc->sc_enable = (char *)bh;
if (bus_space_map(oba->oba_bustag,
oba->oba_paddr + PFOUR_COLOR_OFF_COLOR,
CGFOUR_RAM_SIZE,
BUS_SPACE_MAP_LINEAR,
&bh) != 0) {
printf("%s: cannot map pixels\n",
device_xname(self));
return;
}
fb->fb_pixels = (char *)bh;
}
if (bus_space_map(oba->oba_bustag,
oba->oba_paddr + PFOUR_COLOR_OFF_CMAP,
sizeof(struct fbcontrol),
BUS_SPACE_MAP_LINEAR,
&bh) != 0) {
printf("%s: cannot map control registers\n",
device_xname(self));
return;
}
sc->sc_fbc = (volatile struct fbcontrol *)bh;
bt = &sc->sc_fbc->fbc_dac;
bt->bt_addr = 0;
for (i = 0; i < 256 * 3 / 4; i++)
((char *)&sc->sc_cmap)[i] = bt->bt_cmap >> 24;
BT_INIT(bt, 24);
if (isconsole) {
printf(" (console)\n");
} else
printf("\n");
fb_attach(fb, isconsole);
#if NWSDISPLAY > 0
sc->sc_width = fb->fb_type.fb_width;
sc->sc_stride = fb->fb_type.fb_width;
sc->sc_height = fb->fb_type.fb_height;
sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
vcons_init(&sc->sc_vd, sc, &cgfour_defaultscreen, &cgfour_accessops);
sc->sc_vd.init_screen = cgfour_init_screen;
if (isconsole) {
vcons_init_screen(&sc->sc_vd, &cgfour_console_screen, 1,
&defattr);
cgfour_clear_screen(sc, (defattr >> 16) & 0xff);
cgfour_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
cgfour_defaultscreen.textops = &ri->ri_ops;
cgfour_defaultscreen.capabilities = ri->ri_caps;
cgfour_defaultscreen.nrows = ri->ri_rows;
cgfour_defaultscreen.ncols = ri->ri_cols;
SCREEN_VISIBLE(&cgfour_console_screen);
sc->sc_vd.active = &cgfour_console_screen;
wsdisplay_cnattach(&cgfour_defaultscreen, ri, 0, 0, defattr);
vcons_replay_msgbuf(&cgfour_console_screen);
} else {
}
cgfour_setup_palette(sc);
wsemul_aa.scrdata = &cgfour_screenlist;
wsemul_aa.console = isconsole;
wsemul_aa.accessops = &cgfour_accessops;
wsemul_aa.accesscookie = &sc->sc_vd;
config_found(self, &wsemul_aa, wsemuldisplaydevprint,
CFARGS_NONE);
#endif
#endif
}
int
cgfouropen(dev_t dev, int flags, int mode, struct lwp *l)
{
int unit = minor(dev);
if (device_lookup(&cgfour_cd, unit) == NULL)
return (ENXIO);
return (0);
}
int
cgfourioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
{
#if defined(SUN4)
struct cgfour_softc *sc = device_lookup_private(&cgfour_cd, minor(dev));
struct fbgattr *fba;
int error;
switch (cmd) {
case FBIOGTYPE:
*(struct fbtype *)data = sc->sc_fb.fb_type;
break;
case FBIOGATTR:
fba = (struct fbgattr *)data;
fba->real_type = sc->sc_fb.fb_type.fb_type;
fba->owner = 0;
fba->fbtype = sc->sc_fb.fb_type;
fba->sattr.flags = 0;
fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
fba->sattr.dev_specific[0] = -1;
fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
fba->emu_types[1] = -1;
break;
case FBIOGETCMAP:
#define p ((struct fbcmap *)data)
return (bt_getcmap(p, &sc->sc_cmap, 256, 1));
case FBIOPUTCMAP:
error = bt_putcmap(p, &sc->sc_cmap, 256, 1);
if (error)
return (error);
cgfourloadcmap(sc, p->index, p->count);
#undef p
break;
case FBIOGVIDEO:
*(int *)data = cgfour_get_video(sc);
break;
case FBIOSVIDEO:
cgfour_set_video(sc, *(int *)data);
break;
default:
return (ENOTTY);
}
#endif
return (0);
}
paddr_t
cgfourmmap(dev_t dev, off_t off, int prot)
{
struct cgfour_softc *sc = device_lookup_private(&cgfour_cd, minor(dev));
off_t poff;
#define START_ENABLE (128*1024)
#define START_COLOR ((128*1024) + (128*1024))
#define COLOR_SIZE (sc->sc_fb.fb_type.fb_width * \
sc->sc_fb.fb_type.fb_height)
#define END_COLOR (START_COLOR + COLOR_SIZE)
#define NOOVERLAY (0x04000000)
if (off & PGOFSET)
panic("cgfourmap");
if (off < 0)
return (-1);
else if ((u_int)off >= NOOVERLAY) {
off -= NOOVERLAY;
while ((u_int)off >= COLOR_SIZE)
off -= COLOR_SIZE;
poff = off + PFOUR_COLOR_OFF_COLOR;
} else if ((u_int)off < START_ENABLE) {
poff = PFOUR_COLOR_OFF_OVERLAY + off;
} else if ((u_int)off < START_COLOR) {
poff = (off - START_ENABLE) + PFOUR_COLOR_OFF_ENABLE;
} else if ((u_int)off < sc->sc_fb.fb_type.fb_size) {
poff = (off - START_COLOR) + PFOUR_COLOR_OFF_COLOR;
} else
return (-1);
return (bus_space_mmap(sc->sc_bustag,
sc->sc_paddr, poff,
prot, BUS_SPACE_MAP_LINEAR));
}
#if defined(SUN4)
static void
cgfourunblank(device_t dev)
{
cgfour_set_video(device_private(dev), 1);
}
static int
cgfour_get_video(struct cgfour_softc *sc)
{
return (fb_pfour_get_video(&sc->sc_fb));
}
static void
cgfour_set_video(struct cgfour_softc *sc, int enable)
{
fb_pfour_set_video(&sc->sc_fb, enable);
}
static void
cgfourloadcmap(struct cgfour_softc *sc, int start, int ncolors)
{
volatile struct bt_regs *bt;
u_int *ip, i;
int count;
ip = &sc->sc_cmap.cm_chip[BT_D4M3(start)];
count = BT_D4M3(start + ncolors - 1) - BT_D4M3(start) + 3;
bt = &sc->sc_fbc->fbc_dac;
bt->bt_addr = BT_D4M4(start) << 24;
while (--count >= 0) {
i = *ip++;
bt->bt_cmap = i;
bt->bt_cmap = i << 8;
bt->bt_cmap = i << 16;
bt->bt_cmap = i << 24;
}
}
#if NWSDISPLAY > 0
static void
cgfour_setup_palette(struct cgfour_softc *sc)
{
int i, j;
j = 0;
for (i = 0; i < 256; i++) {
sc->sc_cmap.cm_map[i][0] = rasops_cmap[j];
j++;
sc->sc_cmap.cm_map[i][1] = rasops_cmap[j];
j++;
sc->sc_cmap.cm_map[i][2] = rasops_cmap[j];
j++;
}
cgfourloadcmap(sc, 0, 256);
}
static int
cgfour_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
struct lwp *l)
{
struct vcons_data *vd = v;
struct cgfour_softc *sc = vd->cookie;
struct wsdisplay_fbinfo *wdf;
struct vcons_screen *ms = sc->sc_vd.active;
struct rasops_info *ri = &ms->scr_ri;
switch (cmd) {
case WSDISPLAYIO_GTYPE:
*(u_int *)data = WSDISPLAY_TYPE_SUNTCX;
return 0;
case WSDISPLAYIO_GINFO:
wdf = (void *)data;
wdf->height = ri->ri_height;
wdf->width = ri->ri_width;
wdf->depth = 8;
wdf->cmsize = 256;
return 0;
case WSDISPLAYIO_GETCMAP:
return cgfour_getcmap(sc,
(struct wsdisplay_cmap *)data);
case WSDISPLAYIO_PUTCMAP:
return cgfour_putcmap(sc,
(struct wsdisplay_cmap *)data);
case WSDISPLAYIO_SMODE:
{
int new_mode = *(int *)data;
if (new_mode != sc->sc_mode) {
sc->sc_mode = new_mode;
if (new_mode == WSDISPLAYIO_MODE_EMUL) {
cgfour_setup_palette(sc);
cgfour_clear_screen(sc, 0xff);
vcons_redraw_screen(ms);
}
}
}
return 0;
case WSDISPLAYIO_GET_FBINFO:
{
struct wsdisplayio_fbinfo *fbi = data;
return wsdisplayio_get_fbinfo(&ms->scr_ri, fbi);
}
}
return EPASSTHROUGH;
}
static paddr_t
cgfour_mmap(void *v, void *vs, off_t offset, int prot)
{
struct vcons_data *vd = v;
struct cgfour_softc *sc = vd->cookie;
paddr_t cookie = -1;
switch (sc->sc_mode) {
case WSDISPLAYIO_MODE_DUMBFB:
if (offset >= 0 && offset <= sc->sc_fb.fb_type.fb_size) {
cookie = bus_space_mmap(sc->sc_bustag,
sc->sc_paddr, PFOUR_COLOR_OFF_COLOR + offset,
prot, BUS_SPACE_MAP_LINEAR);
}
break;
default:
break;
}
return cookie;
}
static int
cgfour_putcmap(struct cgfour_softc *sc, struct wsdisplay_cmap *cm)
{
u_int index = cm->index;
u_int count = cm->count;
int error,i;
if (index >= 256 || count > 256 || index + count > 256)
return EINVAL;
for (i = 0; i < count; i++)
{
error = copyin(&cm->red[i],
&sc->sc_cmap.cm_map[index + i][0], 1);
if (error)
return error;
error = copyin(&cm->green[i],
&sc->sc_cmap.cm_map[index + i][1],
1);
if (error)
return error;
error = copyin(&cm->blue[i],
&sc->sc_cmap.cm_map[index + i][2], 1);
if (error)
return error;
}
cgfourloadcmap(sc, index, count);
return 0;
}
static int
cgfour_getcmap(struct cgfour_softc *sc, struct wsdisplay_cmap *cm)
{
u_int index = cm->index;
u_int count = cm->count;
int error,i;
if (index >= 256 || count > 256 || index + count > 256)
return EINVAL;
for (i = 0; i < count; i++)
{
error = copyout(&sc->sc_cmap.cm_map[index + i][0],
&cm->red[i], 1);
if (error)
return error;
error = copyout(&sc->sc_cmap.cm_map[index + i][1],
&cm->green[i], 1);
if (error)
return error;
error = copyout(&sc->sc_cmap.cm_map[index + i][2],
&cm->blue[i], 1);
if (error)
return error;
}
return 0;
}
static void
cgfour_init_screen(void *cookie, struct vcons_screen *scr,
int existing, long *defattr)
{
struct cgfour_softc *sc = cookie;
struct rasops_info *ri = &scr->scr_ri;
scr->scr_flags |= VCONS_DONT_READ;
ri->ri_depth = 8;
ri->ri_width = sc->sc_width;
ri->ri_height = sc->sc_height;
ri->ri_stride = sc->sc_stride;
ri->ri_flg = RI_CENTER;
ri->ri_bits = sc->sc_fb.fb_pixels;
rasops_init(ri, 0, 0);
ri->ri_caps = WSSCREEN_WSCOLORS | WSSCREEN_REVERSE;
rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
sc->sc_width / ri->ri_font->fontwidth);
ri->ri_hw = scr;
}
static void
cgfour_clear_screen(struct cgfour_softc *sc, int bg)
{
char *bits;
for (bits = (char *)sc->sc_enable;
bits < (char *)sc->sc_enable + CGFOUR_OVERLAY_SIZE;
bits += 4)
memset(bits, 0x00, 4);
for (bits = (char *)sc->sc_fb.fb_pixels;
bits < (char *)sc->sc_fb.fb_pixels + sc->sc_stride * sc->sc_height;
bits += 4)
memset(bits, bg, 4);
}
#endif
#endif