#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: px.c,v 1.41 2019/11/10 21:16:37 chs Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/callout.h>
#include <uvm/uvm.h>
#if defined(pmax)
#include <mips/cpuregs.h>
#elif defined(alpha)
#include <alpha/alpha_cpu.h>
#endif
#include <machine/autoconf.h>
#include <sys/cpu.h>
#include <sys/bus.h>
#include <dev/cons.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/ic/bt459reg.h>
#include <dev/tc/tcvar.h>
#include <dev/tc/sticreg.h>
#include <dev/tc/sticio.h>
#include <dev/tc/sticvar.h>
#define PX_STIC_POLL_OFFSET 0x000000
#define PX_STAMP_OFFSET 0x0c0000
#define PX_STIC_OFFSET 0x180000
#define PX_VDAC_OFFSET 0x200000
#define PX_VDAC_RESET_OFFSET 0x300000
#define PX_ROM_OFFSET 0x300000
#define PX_BUF_COUNT 16
#define PX_BUF_INC(x) ((x + 1) & (PX_BUF_COUNT - 1))
#define PX_BUF_SIZE \
(STIC_PACKET_SIZE * PX_BUF_COUNT + STIC_IMGBUF_SIZE*2 + STIC_XCOMM_SIZE)
#define PX_BUF_ALIGN 32768
#define PXF_QUEUE 0x01
static void px_attach(device_t, device_t, void *);
static void px_init(struct stic_info *, int);
static int px_ioctl(struct stic_info *, u_long, void *, int,
struct lwp *);
static int px_match(device_t, cfdata_t, void *);
static int px_intr(void *);
static uint32_t *px_pbuf_get(struct stic_info *);
static int px_pbuf_post(struct stic_info *, uint32_t *);
void px_cnattach(tc_addr_t);
struct px_softc {
device_t px_dev;
struct stic_info *px_si;
volatile uint32_t *px_qpoll[PX_BUF_COUNT];
};
CFATTACH_DECL_NEW(px, sizeof(struct px_softc),
px_match, px_attach, NULL, NULL);
static int
px_match(device_t parent, cfdata_t match, void *aux)
{
struct tc_attach_args *ta;
ta = aux;
return (strncmp("PMAG-CA ", ta->ta_modname, TC_ROM_LLEN) == 0);
}
static void
px_attach(device_t parent, device_t self, void *aux)
{
struct stic_info *si;
struct tc_attach_args *ta;
struct px_softc *px;
int console, i;
u_long v;
px = device_private(self);
ta = aux;
px->px_dev = self;
if (ta->ta_addr == stic_consinfo.si_slotbase) {
si = &stic_consinfo;
console = 1;
} else {
if (stic_consinfo.si_slotbase == 0)
si = &stic_consinfo;
else {
si = malloc(sizeof(*si), M_DEVBUF, M_WAITOK | M_ZERO);
}
si->si_slotbase = ta->ta_addr;
px_init(si, 0);
console = 0;
}
px->px_si = si;
si->si_dv = self;
tc_intr_establish(parent, ta->ta_cookie, IPL_TTY, px_intr, si);
printf(": 8 plane, %dx%d stamp\n", si->si_stampw, si->si_stamph);
for (i = 0; i < PX_BUF_COUNT; i++) {
v = i * STIC_PACKET_SIZE +
si->si_buf_phys + STIC_XCOMM_SIZE;
v = ((v & 0xffff8000) << 3) | (v & 0x7fff);
px->px_qpoll[i] = (volatile uint32_t *)
((char *)si->si_slotbase + (v >> 9));
}
stic_attach(self, si, console);
}
void
px_cnattach(tc_addr_t addr)
{
struct stic_info *si;
si = &stic_consinfo;
si->si_slotbase = addr;
px_init(si, 1);
stic_cnattach(si);
}
static void
px_init(struct stic_info *si, int bootstrap)
{
struct pglist pglist;
char *kva, *bva;
paddr_t bpa;
kva = (void *)si->si_slotbase;
if (bootstrap) {
bva = (char *)uvm_pageboot_alloc(PX_BUF_SIZE + PX_BUF_ALIGN);
bpa = (STIC_KSEG_TO_PHYS(bva) + PX_BUF_ALIGN - 1) &
~(PX_BUF_ALIGN - 1);
if (bpa + PX_BUF_SIZE > 8192*1024)
panic("px_init: allocation out of bounds");
} else {
if (uvm_pglistalloc(PX_BUF_SIZE, 0, 8192*1024, PX_BUF_ALIGN,
0, &pglist, 1, 0) != 0)
panic("px_init: allocation failure");
bpa = VM_PAGE_TO_PHYS(TAILQ_FIRST(&pglist));
}
si->si_vdac = (uint32_t *)(kva + PX_VDAC_OFFSET);
si->si_vdac_reset = (uint32_t *)(kva + PX_VDAC_RESET_OFFSET);
si->si_stic = (volatile struct stic_regs *)(kva + PX_STIC_OFFSET);
si->si_stamp = (uint32_t *)(kva + PX_STAMP_OFFSET);
si->si_buf = (uint32_t *)TC_PHYS_TO_UNCACHED(bpa);
si->si_buf_phys = bpa;
si->si_buf_size = PX_BUF_SIZE;
si->si_disptype = WSDISPLAY_TYPE_PX;
si->si_depth = 8;
si->si_sxc = (volatile struct stic_xcomm *)si->si_buf;
si->si_pbuf_get = px_pbuf_get;
si->si_pbuf_post = px_pbuf_post;
si->si_ioctl = px_ioctl;
memset(si->si_buf, 0, PX_BUF_SIZE);
stic_init(si);
}
static int
px_intr(void *cookie)
{
volatile struct stic_regs *sr;
volatile struct stic_xcomm *sxc;
struct stic_info *si;
struct px_softc *px;
int state;
si = cookie;
px = device_private(si->si_dv);
sr = si->si_stic;
state = sr->sr_ipdvint;
sxc = si->si_sxc;
if ((state & STIC_INT_V) != 0) {
sr->sr_ipdvint = STIC_INT_V_WE | STIC_INT_V_EN;
tc_wmb();
stic_flush(si);
}
if ((state & STIC_INT_E) != 0) {
aprint_error_dev(px->px_dev, "error intr, %x %x %x %x %x",
sr->sr_ipdvint, sr->sr_sticsr, sr->sr_buscsr,
sr->sr_busadr, sr->sr_busdat);
sr->sr_ipdvint = STIC_INT_E_WE | STIC_INT_E_EN;
tc_wmb();
}
if (sxc->sxc_tail != sxc->sxc_head && !sxc->sxc_busy)
state |= STIC_INT_P;
if ((si->si_hwflags & PXF_QUEUE) != 0 && (state & STIC_INT_P) != 0) {
sr->sr_ipdvint = STIC_INT_P_WE | STIC_INT_P_EN;
tc_wmb();
if (sxc->sxc_tail != sxc->sxc_head) {
sxc->sxc_done[sxc->sxc_tail] = 0;
sxc->sxc_tail = PX_BUF_INC(sxc->sxc_tail);
}
if (sxc->sxc_tail != sxc->sxc_head) {
if (*px->px_qpoll[sxc->sxc_tail] != STAMP_OK) {
sxc->sxc_nreject++;
sxc->sxc_busy = 0;
} else
sxc->sxc_busy = 1;
} else
sxc->sxc_busy = 0;
}
if ((si->si_hwflags & PXF_QUEUE) != 0 && (state & STIC_INT_P_EN) == 0)
printf("px_intr: STIC_INT_P_EN == 0\n");
return (1);
}
static uint32_t *
px_pbuf_get(struct stic_info *si)
{
u_long off;
si->si_pbuf_select ^= STIC_PACKET_SIZE;
off = si->si_pbuf_select + STIC_XCOMM_SIZE;
return ((uint32_t *)((char *)si->si_buf + off));
}
static int
px_pbuf_post(struct stic_info *si, uint32_t *buf)
{
volatile uint32_t *poll, junk;
volatile struct stic_regs *sr;
u_long v;
int c;
sr = si->si_stic;
v = (u_long)STIC_KSEG_TO_PHYS(buf);
v = ((v & 0xffff8000) << 3) | (v & 0x7fff);
poll = (volatile uint32_t *)((char *)si->si_slotbase + (v >> 9));
tc_mb();
for (c = STAMP_RETRIES; c != 0; c--) {
if ((sr->sr_ipdvint & STIC_INT_P) != 0) {
sr->sr_ipdvint = STIC_INT_P_WE;
tc_wmb();
junk = *poll;
__USE(junk);
return (0);
}
DELAY(STAMP_DELAY);
}
stic_reset(si);
return (-1);
}
static int
px_ioctl(struct stic_info *si, u_long cmd, void *data, int flag,
struct lwp *l)
{
volatile struct stic_xcomm *sxc;
volatile struct stic_regs *sr;
struct stic_xinfo *sxi;
int rv, s;
sr = si->si_stic;
switch (cmd) {
case STICIO_STARTQ:
if (si->si_dispmode != WSDISPLAYIO_MODE_MAPPED ||
(si->si_hwflags & PXF_QUEUE) != 0) {
rv = EBUSY;
break;
}
sxc = si->si_sxc;
memset((void *)__UNVOLATILE(sxc->sxc_done), 0,
sizeof(sxc->sxc_done));
sxc->sxc_head = 0;
sxc->sxc_tail = 0;
sxc->sxc_nreject = 0;
sxc->sxc_nstall = 0;
s = spltty();
si->si_hwflags |= PXF_QUEUE;
sr->sr_ipdvint = STIC_INT_P_WE | STIC_INT_P_EN;
tc_wmb();
splx(s);
rv = 0;
break;
case STICIO_STOPQ:
s = spltty();
si->si_hwflags &= ~PXF_QUEUE;
sr->sr_ipdvint = STIC_INT_P_WE | STIC_INT_P;
tc_wmb();
splx(s);
rv = 0;
break;
case STICIO_GXINFO:
sxi = (struct stic_xinfo *)data;
sxi->sxi_unit = si->si_unit;
sxi->sxi_stampw = si->si_stampw;
sxi->sxi_stamph = si->si_stamph;
sxi->sxi_buf_size = si->si_buf_size;
sxi->sxi_buf_phys = (u_int)si->si_buf_phys;
sxi->sxi_buf_pktoff = STIC_XCOMM_SIZE;
sxi->sxi_buf_pktcnt = PX_BUF_COUNT;
sxi->sxi_buf_imgoff =
STIC_XCOMM_SIZE + STIC_PACKET_SIZE * PX_BUF_COUNT;
rv = 0;
break;
default:
rv = EPASSTHROUGH;
break;
}
return (rv);
}