#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: bpp.c,v 1.47 2021/09/26 01:16:09 thorpej Exp $");
#include <sys/param.h>
#include <sys/ioctl.h>
#include <sys/fcntl.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/vnode.h>
#include <sys/poll.h>
#include <sys/select.h>
#include <sys/malloc.h>
#include <sys/proc.h>
#include <sys/signalvar.h>
#include <sys/conf.h>
#include <sys/errno.h>
#include <sys/device.h>
#include <sys/bus.h>
#include <sys/intr.h>
#include <machine/autoconf.h>
#include <dev/ic/lsi64854reg.h>
#include <dev/ic/lsi64854var.h>
#include <dev/sbus/sbusvar.h>
#include <dev/sbus/bppreg.h>
#include "ioconf.h"
#define splbpp() spltty()
#ifdef DEBUG
#define DPRINTF(x) do { if (bppdebug) printf x ; } while (0)
int bppdebug = 1;
#else
#define DPRINTF(x)
#endif
#if 0
struct bpp_param {
int bpp_dss;
int bpp_dsw;
int bpp_outputpins;
int bpp_inputpins;
};
#endif
struct hwstate {
uint16_t hw_hcr;
uint16_t hw_ocr;
uint8_t hw_tcr;
uint8_t hw_or;
uint16_t hw_irq;
};
struct bpp_softc {
struct lsi64854_softc sc_lsi64854;
size_t sc_bufsz;
uint8_t *sc_buf;
int sc_error;
int sc_flags;
#define BPP_OPEN 0x01
#define BPP_XCLUDE 0x02
#define BPP_ASYNC 0x04
#define BPP_LOCKED 0x08
#define BPP_WANT 0x10
struct selinfo sc_rsel;
struct selinfo sc_wsel;
struct proc *sc_asyncproc;
void *sc_sih;
struct hwstate sc_hwdefault;
struct hwstate sc_hwcurrent;
};
static int bppmatch(device_t, cfdata_t, void *);
static void bppattach(device_t, device_t, void *);
static int bppintr(void *);
static void bppsoftintr(void *);
static void bpp_setparams(struct bpp_softc *, struct hwstate *);
CFATTACH_DECL_NEW(bpp, sizeof(struct bpp_softc),
bppmatch, bppattach, NULL, NULL);
dev_type_open(bppopen);
dev_type_close(bppclose);
dev_type_write(bppwrite);
dev_type_ioctl(bppioctl);
dev_type_poll(bpppoll);
dev_type_kqfilter(bppkqfilter);
const struct cdevsw bpp_cdevsw = {
.d_open = bppopen,
.d_close = bppclose,
.d_read = noread,
.d_write = bppwrite,
.d_ioctl = bppioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = bpppoll,
.d_mmap = nommap,
.d_kqfilter = bppkqfilter,
.d_discard = nodiscard,
.d_flag = D_TTY
};
#define BPPUNIT(dev) (minor(dev))
int
bppmatch(device_t parent, cfdata_t cf, void *aux)
{
struct sbus_attach_args *sa = aux;
return strcmp("SUNW,bpp", sa->sa_name) == 0;
}
void
bppattach(device_t parent, device_t self, void *aux)
{
struct bpp_softc *dsc = device_private(self);
struct lsi64854_softc *sc = &dsc->sc_lsi64854;
struct sbus_softc *sbsc = device_private(parent);
struct sbus_attach_args *sa = aux;
int burst, sbusburst;
int node;
sc->sc_dev = self;
selinit(&dsc->sc_rsel);
selinit(&dsc->sc_wsel);
dsc->sc_sih = softint_establish(SOFTINT_CLOCK, bppsoftintr, dsc);
sc->sc_bustag = sa->sa_bustag;
sc->sc_dmatag = sa->sa_dmatag;
node = sa->sa_node;
if (sbus_bus_map(sa->sa_bustag,
sa->sa_slot, sa->sa_offset, sa->sa_size,
0, &sc->sc_regs) != 0) {
aprint_error(": cannot map registers\n");
return;
}
sbusburst = sbsc->sc_burst;
if (sbusburst == 0)
sbusburst = SBUS_BURST_32 - 1;
burst = prom_getpropint(node, "burst-sizes", -1);
if (burst == -1)
burst = sbusburst;
burst &= sbusburst;
sc->sc_burst = (burst & SBUS_BURST_32) ? 32 :
(burst & SBUS_BURST_16) ? 16 : 0;
sc->sc_channel = L64854_CHANNEL_PP;
lsi64854_attach(sc);
if (sa->sa_nintr) {
sc->sc_intrchain = bppintr;
sc->sc_intrchainarg = dsc;
(void)bus_intr_establish(sa->sa_bustag, sa->sa_pri, IPL_TTY,
bppintr, sc);
}
dsc->sc_bufsz = 1024;
dsc->sc_buf = malloc(dsc->sc_bufsz, M_DEVBUF, M_WAITOK);
{
bus_space_handle_t h = sc->sc_regs;
struct hwstate *hw = &dsc->sc_hwdefault;
int ack_rate = sa->sa_frequency / 1000000;
hw->hw_hcr = bus_space_read_2(sc->sc_bustag, h, L64854_REG_HCR);
hw->hw_ocr = bus_space_read_2(sc->sc_bustag, h, L64854_REG_OCR);
hw->hw_tcr = bus_space_read_1(sc->sc_bustag, h, L64854_REG_TCR);
hw->hw_or = bus_space_read_1(sc->sc_bustag, h, L64854_REG_OR);
DPRINTF(("bpp: hcr %x ocr %x tcr %x or %x\n",
hw->hw_hcr, hw->hw_ocr, hw->hw_tcr, hw->hw_or));
hw->hw_hcr = ((ack_rate<<BPP_HCR_DSS_SHFT)&BPP_HCR_DSS_MASK)
| ((ack_rate<<BPP_HCR_DSW_SHFT)&BPP_HCR_DSW_MASK);
hw->hw_ocr |= BPP_OCR_ACK_OP;
}
}
void
bpp_setparams(struct bpp_softc *sc, struct hwstate *hw)
{
uint16_t irq;
bus_space_tag_t t = sc->sc_lsi64854.sc_bustag;
bus_space_handle_t h = sc->sc_lsi64854.sc_regs;
bus_space_write_2(t, h, L64854_REG_HCR, hw->hw_hcr);
bus_space_write_2(t, h, L64854_REG_OCR, hw->hw_ocr);
bus_space_write_1(t, h, L64854_REG_TCR, hw->hw_tcr);
bus_space_write_1(t, h, L64854_REG_OR, hw->hw_or);
irq = bus_space_read_2(t, h, L64854_REG_ICR);
irq &= ~BPP_ALLIRP;
irq |= (hw->hw_irq & BPP_ALLIRP);
bus_space_write_2(t, h, L64854_REG_ICR, irq);
DPRINTF(("bpp_setparams: hcr %x ocr %x tcr %x or %x, irq %x\n",
hw->hw_hcr, hw->hw_ocr, hw->hw_tcr, hw->hw_or, irq));
}
int
bppopen(dev_t dev, int flags, int mode, struct lwp *l)
{
int unit = BPPUNIT(dev);
struct bpp_softc *sc;
struct lsi64854_softc *lsi;
uint16_t irq;
int s;
if (unit >= bpp_cd.cd_ndevs)
return ENXIO;
sc = device_lookup_private(&bpp_cd, unit);
if ((sc->sc_flags & (BPP_OPEN|BPP_XCLUDE)) == (BPP_OPEN|BPP_XCLUDE))
return EBUSY;
lsi = &sc->sc_lsi64854;
sc->sc_hwcurrent = sc->sc_hwdefault;
s = splbpp();
bpp_setparams(sc, &sc->sc_hwdefault);
splx(s);
irq = BPP_ERR_IRQ_EN;
irq |= sc->sc_hwdefault.hw_irq;
bus_space_write_2(lsi->sc_bustag, lsi->sc_regs, L64854_REG_ICR, irq);
return 0;
}
int
bppclose(dev_t dev, int flags, int mode, struct lwp *l)
{
struct bpp_softc *sc;
struct lsi64854_softc *lsi;
uint16_t irq;
sc = device_lookup_private(&bpp_cd, BPPUNIT(dev));
lsi = &sc->sc_lsi64854;
irq = sc->sc_hwdefault.hw_irq | BPP_ALLIRQ;
irq &= ~BPP_ALLEN;
bus_space_write_2(lsi->sc_bustag, lsi->sc_regs, L64854_REG_ICR, irq);
mutex_enter(&proc_lock);
sc->sc_asyncproc = NULL;
mutex_exit(&proc_lock);
sc->sc_flags = 0;
return 0;
}
int
bppwrite(dev_t dev, struct uio *uio, int flags)
{
struct bpp_softc *sc;
struct lsi64854_softc *lsi;
int error = 0;
int s;
sc = device_lookup_private(&bpp_cd, BPPUNIT(dev));
lsi = &sc->sc_lsi64854;
s = splbpp();
while ((sc->sc_flags & BPP_LOCKED) != 0) {
if ((flags & IO_NDELAY) != 0) {
splx(s);
return EWOULDBLOCK;
}
sc->sc_flags |= BPP_WANT;
error = tsleep(sc->sc_buf, PZERO|PCATCH, "bppwrite", 0);
if (error != 0) {
splx(s);
return error;
}
}
sc->sc_flags |= BPP_LOCKED;
splx(s);
while (uio->uio_resid > 0) {
uint8_t *bp = sc->sc_buf;
size_t len = uimin(sc->sc_bufsz, uio->uio_resid);
if ((error = uiomove(bp, len, uio)) != 0)
break;
while (len > 0) {
uint8_t tcr;
size_t size = len;
DMA_SETUP(lsi, &bp, &len, 0, &size);
#ifdef DEBUG
if (bppdebug) {
int i;
uint8_t *b = bp;
printf("bpp: writing %ld : ", len);
for (i = 0; i < len; i++)
printf("%c(0x%x)", b[i], b[i]);
printf("\n");
}
#endif
tcr = bus_space_read_1(lsi->sc_bustag, lsi->sc_regs,
L64854_REG_TCR);
tcr &= ~BPP_TCR_DIR;
bus_space_write_1(lsi->sc_bustag, lsi->sc_regs,
L64854_REG_TCR, tcr);
s = splbpp();
DMA_GO(lsi);
error = tsleep(sc, PZERO|PCATCH, "bppdma", 0);
splx(s);
if (error != 0)
goto out;
if ((error = sc->sc_error) != 0)
goto out;
}
}
out:
DPRINTF(("bpp done %x\n", error));
s = splbpp();
sc->sc_flags &= ~BPP_LOCKED;
if ((sc->sc_flags & BPP_WANT) != 0) {
sc->sc_flags &= ~BPP_WANT;
wakeup(sc->sc_buf);
}
splx(s);
return error;
}
#define BPPIOCSPARAM _IOW('P', 0x1, struct hwstate)
#define BPPIOCGPARAM _IOR('P', 0x2, struct hwstate)
int
bppioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
{
struct bpp_softc *sc;
struct proc *p = l->l_proc;
struct hwstate *hw, *chw;
int error = 0;
int s;
sc = device_lookup_private(&bpp_cd, BPPUNIT(dev));
switch(cmd) {
case BPPIOCSPARAM:
chw = &sc->sc_hwcurrent;
hw = (struct hwstate *)data;
#define _bpp_set(reg,mask) do { \
chw->reg &= ~(mask); \
chw->reg |= (hw->reg & (mask)); \
} while ( 0)
_bpp_set(hw_hcr, BPP_HCR_DSS_MASK|BPP_HCR_DSW_MASK);
_bpp_set(hw_ocr, BPP_OCR_USER);
_bpp_set(hw_tcr, BPP_TCR_USER);
_bpp_set(hw_or, BPP_OR_USER);
_bpp_set(hw_irq, BPP_IRQ_USER);
#undef _bpp_set
s = splbpp();
bpp_setparams(sc, chw);
splx(s);
break;
case BPPIOCGPARAM:
*((struct hwstate *)data) = sc->sc_hwcurrent;
break;
case TIOCEXCL:
s = splbpp();
sc->sc_flags |= BPP_XCLUDE;
splx(s);
break;
case TIOCNXCL:
s = splbpp();
sc->sc_flags &= ~BPP_XCLUDE;
splx(s);
break;
case FIOASYNC:
mutex_enter(&proc_lock);
if (*(int *)data) {
if (sc->sc_asyncproc != NULL)
error = EBUSY;
else
sc->sc_asyncproc = p;
} else
sc->sc_asyncproc = NULL;
mutex_exit(&proc_lock);
break;
default:
break;
}
return error;
}
int
bpppoll(dev_t dev, int events, struct lwp *l)
{
struct bpp_softc *sc;
int revents = 0;
sc = device_lookup_private(&bpp_cd, BPPUNIT(dev));
if (events & (POLLIN | POLLRDNORM)) {
}
if (events & (POLLOUT | POLLWRNORM)) {
if ((sc->sc_flags & BPP_LOCKED) == 0)
revents |= (POLLOUT | POLLWRNORM);
}
if (revents == 0) {
if (events & (POLLIN | POLLRDNORM))
selrecord(l, &sc->sc_rsel);
if (events & (POLLOUT | POLLWRNORM))
selrecord(l, &sc->sc_wsel);
}
return revents;
}
static void
filt_bpprdetach(struct knote *kn)
{
struct bpp_softc *sc = kn->kn_hook;
int s;
s = splbpp();
selremove_knote(&sc->sc_rsel, kn);
splx(s);
}
static int
filt_bppread(struct knote *kn, long hint)
{
return 0;
}
static const struct filterops bppread_filtops = {
.f_flags = FILTEROP_ISFD,
.f_attach = NULL,
.f_detach = filt_bpprdetach,
.f_event = filt_bppread,
};
static void
filt_bppwdetach(struct knote *kn)
{
struct bpp_softc *sc = kn->kn_hook;
int s;
s = splbpp();
selremove_knote(&sc->sc_wsel, kn);
splx(s);
}
static int
filt_bpfwrite(struct knote *kn, long hint)
{
struct bpp_softc *sc = kn->kn_hook;
if (sc->sc_flags & BPP_LOCKED)
return 0;
kn->kn_data = 0;
return 1;
}
static const struct filterops bppwrite_filtops = {
.f_flags = FILTEROP_ISFD,
.f_attach = NULL,
.f_detach = filt_bppwdetach,
.f_event = filt_bpfwrite,
};
int
bppkqfilter(dev_t dev, struct knote *kn)
{
struct bpp_softc *sc;
struct selinfo *sip;
int s;
sc = device_lookup_private(&bpp_cd, BPPUNIT(dev));
switch (kn->kn_filter) {
case EVFILT_READ:
sip = &sc->sc_rsel;
kn->kn_fop = &bppread_filtops;
break;
case EVFILT_WRITE:
sip = &sc->sc_wsel;
kn->kn_fop = &bppwrite_filtops;
break;
default:
return EINVAL;
}
kn->kn_hook = sc;
s = splbpp();
selrecord_knote(sip, kn);
splx(s);
return 0;
}
int
bppintr(void *arg)
{
struct bpp_softc *sc = arg;
struct lsi64854_softc *lsi = &sc->sc_lsi64854;
uint16_t irq;
if (lsi64854_pp_intr((void *)lsi) == -1)
sc->sc_error = 1;
irq = bus_space_read_2(lsi->sc_bustag, lsi->sc_regs, L64854_REG_ICR);
bus_space_write_2(lsi->sc_bustag, lsi->sc_regs, L64854_REG_ICR,
irq | BPP_ALLIRQ);
DPRINTF(("%s: %x\n", __func__, irq));
if ((irq & BPP_ALLIRQ) == 0)
return 0;
if ((sc->sc_flags & BPP_LOCKED) != 0)
wakeup(sc);
else if ((sc->sc_flags & BPP_WANT) != 0) {
sc->sc_flags &= ~BPP_WANT;
wakeup(sc->sc_buf);
} else {
selnotify(&sc->sc_wsel, 0, 0);
if (sc->sc_asyncproc != NULL)
softint_schedule(sc->sc_sih);
}
return 1;
}
static void
bppsoftintr(void *cookie)
{
struct bpp_softc *sc = cookie;
mutex_enter(&proc_lock);
if (sc->sc_asyncproc)
psignal(sc->sc_asyncproc, SIGIO);
mutex_exit(&proc_lock);
}