#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: grf_obio.c,v 1.59 2019/07/26 10:48:44 rin Exp $");
#include <sys/param.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/kmem.h>
#include <sys/file.h>
#include <sys/mman.h>
#include <sys/proc.h>
#include <sys/systm.h>
#include <machine/autoconf.h>
#include <machine/bus.h>
#include <machine/cpu.h>
#include <machine/grfioctl.h>
#include <machine/viareg.h>
#include <machine/video.h>
#include <mac68k/nubus/nubus.h>
#include <mac68k/obio/grf_obioreg.h>
#include <mac68k/obio/obiovar.h>
#include <mac68k/dev/grfvar.h>
static int grfiv_mode(struct grf_softc *, int, void *);
static int grfiv_match(device_t, cfdata_t, void *);
static void grfiv_attach(device_t, device_t, void *);
static void dafb_set_mapreg(void *, int, int, int, int);
static void civic_set_mapreg(void *, int, int, int, int);
static void valkyrie_set_mapreg(void *, int, int, int, int);
static void rbv_set_mapreg(void *, int, int, int, int);
CFATTACH_DECL_NEW(intvid, sizeof(struct grfbus_softc),
grfiv_match, grfiv_attach, NULL, NULL);
static int
grfiv_match(device_t parent, cfdata_t cf, void *aux)
{
struct obio_attach_args *oa = (struct obio_attach_args *)aux;
bus_space_handle_t bsh;
int found;
u_int base;
found = 1;
switch (current_mac_model->class) {
case MACH_CLASSQ2:
if (current_mac_model->machineid != MACH_MACLC575) {
base = VALKYRIE_CONTROL_BASE;
if (bus_space_map(oa->oa_tag, base, 0x40, 0, &bsh))
return 0;
bus_space_write_1(oa->oa_tag, bsh, 0x18, 0x1);
bus_space_unmap(oa->oa_tag, bsh, 0x40);
break;
}
case MACH_CLASSQ:
base = DAFB_CONTROL_BASE;
if (bus_space_map(oa->oa_tag, base, 0x20, 0, &bsh))
return 0;
if (mac68k_bus_space_probe(oa->oa_tag, bsh, 0x1c, 4) == 0) {
bus_space_unmap(oa->oa_tag, bsh, 0x20);
return 0;
}
bus_space_unmap(oa->oa_tag, bsh, 0x20);
if (bus_space_map(oa->oa_tag, base + 0x100, 0x20, 0, &bsh))
return 0;
if (mac68k_bus_space_probe(oa->oa_tag, bsh, 0x04, 4) == 0) {
bus_space_unmap(oa->oa_tag, bsh, 0x20);
return 0;
}
bus_space_write_4(oa->oa_tag, bsh, 0x04, 0);
bus_space_write_4(oa->oa_tag, bsh, 0x0C, 0);
bus_space_write_4(oa->oa_tag, bsh, 0x10, 0);
bus_space_write_4(oa->oa_tag, bsh, 0x14, 0);
bus_space_unmap(oa->oa_tag, bsh, 0x20);
break;
case MACH_CLASSAV:
base = CIVIC_CONTROL_BASE;
if (bus_space_map(oa->oa_tag, base, 0x1000, 0, &bsh))
return 0;
bus_space_write_1(oa->oa_tag, bsh, 0x120, 0);
bus_space_unmap(oa->oa_tag, bsh, 0x1000);
break;
case MACH_CLASSIIci:
case MACH_CLASSIIsi:
if (mac68k_video.mv_len == 0 ||
(via2_reg(rMonitor) & RBVMonitorMask) == RBVMonIDNone)
found = 0;
break;
default:
if (mac68k_video.mv_len == 0)
found = 0;
break;
}
return found;
}
static void
grfiv_attach(device_t parent, device_t self, void *aux)
{
struct obio_attach_args *oa = (struct obio_attach_args *)aux;
struct grfbus_softc *sc;
struct grfmode *gm;
u_long base, length;
u_int32_t vbase1, vbase2;
sc = device_private(self);
sc->sc_dev = self;
sc->card_id = 0;
switch (current_mac_model->class) {
case MACH_CLASSQ2:
if (current_mac_model->machineid != MACH_MACLC575) {
sc->sc_basepa = VALKYRIE_FB_BASE;
length = 0x00100000;
if (sc->sc_basepa <= mac68k_video.mv_phys &&
mac68k_video.mv_phys < (sc->sc_basepa + length)) {
sc->sc_fbofs =
mac68k_video.mv_phys - sc->sc_basepa;
} else {
sc->sc_basepa =
m68k_trunc_page(mac68k_video.mv_phys);
sc->sc_fbofs =
m68k_page_offset(mac68k_video.mv_phys);
length = mac68k_video.mv_len + sc->sc_fbofs;
}
if (bus_space_map(sc->sc_tag, VALKYRIE_CMAP_BASE,
VALKYRIE_CMAP_LEN, 0, &sc->sc_cmh) == 0)
sc->sc_set_mapreg = valkyrie_set_mapreg;
printf(" @ %lx: Valkyrie video subsystem\n",
sc->sc_basepa + sc->sc_fbofs);
break;
}
case MACH_CLASSQ:
base = DAFB_CONTROL_BASE;
sc->sc_tag = oa->oa_tag;
if (bus_space_map(sc->sc_tag, base, 0x20, 0, &sc->sc_regh)) {
printf(": failed to map DAFB register space\n");
return;
}
sc->sc_basepa = DAFB_FB_BASE;
length = 0x00100000;
vbase1 = bus_space_read_4(sc->sc_tag, sc->sc_regh, 0x0) & 0xfff;
#if 1
switch (current_mac_model->machineid) {
case MACH_MACLC475:
case MACH_MACLC475_33:
case MACH_MACLC575:
case MACH_MACQ605:
case MACH_MACQ605_33:
vbase1 &= 0x3f;
break;
}
#endif
vbase2 = bus_space_read_4(sc->sc_tag, sc->sc_regh, 0x4) & 0xf;
sc->sc_fbofs = (vbase1 << 9) | (vbase2 << 5);
if (bus_space_map(sc->sc_tag, DAFB_CMAP_BASE, DAFB_CMAP_LEN,
0, &sc->sc_cmh) == 0) {
uint8_t *buf = kmem_zalloc(256 * 3, KM_SLEEP);
sc->sc_cmap.red = buf;
sc->sc_cmap.green = buf + 256;
sc->sc_cmap.blue = buf + 256 * 2;
sc->sc_set_mapreg = dafb_set_mapreg;
}
printf(" @ %lx: DAFB video subsystem, monitor sense %x\n",
sc->sc_basepa + sc->sc_fbofs,
(bus_space_read_4(sc->sc_tag, sc->sc_regh, 0x1c) & 0x7));
bus_space_unmap(sc->sc_tag, sc->sc_regh, 0x20);
break;
case MACH_CLASSAV:
sc->sc_basepa = CIVIC_FB_BASE;
length = 0x00200000;
if (mac68k_video.mv_phys >= sc->sc_basepa &&
mac68k_video.mv_phys < (sc->sc_basepa + length)) {
sc->sc_fbofs = mac68k_video.mv_phys - sc->sc_basepa;
} else {
sc->sc_basepa = m68k_trunc_page(mac68k_video.mv_phys);
sc->sc_fbofs = m68k_page_offset(mac68k_video.mv_phys);
length = mac68k_video.mv_len + sc->sc_fbofs;
}
if (bus_space_map(sc->sc_tag, CIVIC_CMAP_BASE, CIVIC_CMAP_LEN,
0, &sc->sc_cmh) == 0)
sc->sc_set_mapreg = civic_set_mapreg;
printf(" @ %lx: CIVIC video subsystem\n",
sc->sc_basepa + sc->sc_fbofs);
break;
case MACH_CLASSIIci:
case MACH_CLASSIIsi:
sc->sc_basepa = m68k_trunc_page(mac68k_video.mv_phys);
sc->sc_fbofs = m68k_page_offset(mac68k_video.mv_phys);
length = mac68k_video.mv_len + sc->sc_fbofs;
if (bus_space_map(sc->sc_tag, RBV_CMAP_BASE, RBV_CMAP_LEN,
0, &sc->sc_cmh) == 0)
sc->sc_set_mapreg = rbv_set_mapreg;
printf(" @ %lx: RBV video subsystem, ",
sc->sc_basepa + sc->sc_fbofs);
switch (via2_reg(rMonitor) & RBVMonitorMask) {
case RBVMonIDBWP:
printf("15\" monochrome portrait");
break;
case RBVMonIDRGB12:
printf("12\" color");
break;
case RBVMonIDRGB15:
printf("15\" color");
break;
case RBVMonIDStd:
printf("Macintosh II");
break;
default:
printf("unrecognized");
break;
}
printf(" display\n");
break;
default:
sc->sc_basepa = m68k_trunc_page(mac68k_video.mv_phys);
sc->sc_fbofs = m68k_page_offset(mac68k_video.mv_phys);
length = mac68k_video.mv_len + sc->sc_fbofs;
printf(" @ %lx: On-board video\n",
sc->sc_basepa + sc->sc_fbofs);
break;
}
if (bus_space_map(sc->sc_tag, sc->sc_basepa, length, 0,
&sc->sc_handle)) {
printf("%s: failed to map video RAM\n", device_xname(sc->sc_dev));
return;
}
if (sc->sc_basepa <= mac68k_video.mv_phys &&
mac68k_video.mv_phys < (sc->sc_basepa + length)) {
mac68k_video.mv_kvaddr = sc->sc_handle.base + sc->sc_fbofs;
}
gm = &(sc->curr_mode);
gm->mode_id = 0;
gm->psize = mac68k_video.mv_depth;
gm->ptype = 0;
gm->width = mac68k_video.mv_width;
gm->height = mac68k_video.mv_height;
gm->rowbytes = mac68k_video.mv_stride;
gm->hres = 80;
gm->vres = 80;
gm->fbsize = gm->height * gm->rowbytes;
gm->fbbase = (void *)sc->sc_handle.base;
gm->fboff = sc->sc_fbofs;
grf_establish(sc, NULL, grfiv_mode);
}
static int
grfiv_mode(struct grf_softc *sc, int cmd, void *arg)
{
switch (cmd) {
case GM_GRFON:
case GM_GRFOFF:
return 0;
case GM_CURRMODE:
break;
case GM_NEWMODE:
break;
case GM_LISTMODES:
break;
}
return EINVAL;
}
#define CHECK_INDEX(index) \
do { \
size_t depth = mac68k_video.mv_depth; \
if (depth == 1 || depth > 8 || (index) >= (1 << depth)) \
return; \
} while (0 )
static void
dafb_set_mapreg(void *cookie, int index, int r, int g, int b)
{
struct grfbus_softc *sc = (struct grfbus_softc *)cookie;
static int last = -2;
CHECK_INDEX(index);
#define dafb_write_lut(val) \
bus_space_write_1(sc->sc_tag, sc->sc_cmh, DAFB_CMAP_LUT, val)
if (index != last + 1) {
bus_space_write_4(sc->sc_tag, sc->sc_cmh, DAFB_CMAP_RESET, 0);
for (int i = 0; i < index; i++) {
dafb_write_lut(sc->sc_cmap.red[i]);
dafb_write_lut(sc->sc_cmap.green[i]);
dafb_write_lut(sc->sc_cmap.blue[i]);
}
}
dafb_write_lut(r);
dafb_write_lut(g);
dafb_write_lut(b);
last = index;
sc->sc_cmap.red[index] = r;
sc->sc_cmap.green[index] = g;
sc->sc_cmap.blue[index] = b;
#undef dafb_write_lut
}
static void
civic_set_mapreg(void *cookie, int index, int r, int g, int b)
{
struct grfbus_softc *sc = (struct grfbus_softc *)cookie;
uint8_t status, junk = 0;
CHECK_INDEX(index);
#define civic_read_lut \
bus_space_read_1(sc->sc_tag, sc->sc_cmh, CIVIC_CMAP_LUT)
#define civic_write_lut(val) \
bus_space_write_1(sc->sc_tag, sc->sc_cmh, CIVIC_CMAP_LUT, val)
bus_space_write_1(sc->sc_tag, sc->sc_cmh, CIVIC_CMAP_ADDR, index);
status = bus_space_read_1(sc->sc_tag, sc->sc_cmh, CIVIC_CMAP_STATUS2);
if (status & 0x08) {
junk = civic_read_lut;
junk = civic_read_lut;
junk = civic_read_lut;
junk = civic_read_lut;
if (status & 0x0d) {
civic_write_lut(0);
civic_write_lut(0);
}
}
civic_write_lut(r);
civic_write_lut(g);
civic_write_lut(b);
civic_write_lut(junk);
#undef civic_read_lut
#undef civic_write_lut
}
static void
valkyrie_set_mapreg(void *cookie, int index, int r, int g, int b)
{
struct grfbus_softc *sc = (struct grfbus_softc *)cookie;
CHECK_INDEX(index);
#define valkyrie_write_lut(val) \
bus_space_write_1(sc->sc_tag, sc->sc_cmh, VALKYRIE_CMAP_LUT, val)
bus_space_write_1(sc->sc_tag, sc->sc_cmh, VALKYRIE_CMAP_ADDR, index);
delay(1);
valkyrie_write_lut(r);
valkyrie_write_lut(g);
valkyrie_write_lut(b);
#undef valkyrie_write_lut
}
static void
rbv_set_mapreg(void *cookie, int index, int r, int g, int b)
{
struct grfbus_softc *sc = (struct grfbus_softc *)cookie;
CHECK_INDEX(index);
#define rbv_write_lut(val) \
bus_space_write_1(sc->sc_tag, sc->sc_cmh, RBV_CMAP_LUT, val)
index += 256 - (1 << mac68k_video.mv_depth);
bus_space_write_1(sc->sc_tag, sc->sc_cmh, RBV_CMAP_CNTL, 0xff);
bus_space_write_1(sc->sc_tag, sc->sc_cmh, RBV_CMAP_ADDR, index);
rbv_write_lut(r);
rbv_write_lut(g);
rbv_write_lut(b);
#undef rbv_write_lut
}
#undef CHECK_INDEX