#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: vr4181giu.c,v 1.9 2025/02/27 15:28:01 riastradh Exp $");
#include <sys/param.h>
#include <sys/device.h>
#include <sys/kmem.h>
#include <sys/queue.h>
#include <sys/systm.h>
#include <machine/bus.h>
#include <hpcmips/vr/vripif.h>
#include <hpcmips/vr/vr4181giureg.h>
#define MAX_GIU4181INTR 16
struct vr4181giu_intr_entry {
int ih_port;
int (*ih_fun)(void *);
void *ih_arg;
TAILQ_ENTRY(vr4181giu_intr_entry) ih_link;
};
struct vr4181giu_softc {
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
vrip_chipset_tag_t sc_vc;
void *sc_ih;
u_int32_t sc_intr_mode[MAX_GIU4181INTR];
TAILQ_HEAD(, vr4181giu_intr_entry)
sc_intr_head[MAX_GIU4181INTR];
struct hpcio_chip sc_iochip;
struct hpcio_attach_args sc_haa;
};
static int vr4181giu_match(device_t, cfdata_t, void *);
static void vr4181giu_attach(device_t, device_t, void *);
static void vr4181giu_callback(device_t);
static int vr4181giu_print(void *, const char *);
static int vr4181giu_port_read(hpcio_chip_t, int);
static void vr4181giu_port_write(hpcio_chip_t, int, int);
static void vr4181giu_update(hpcio_chip_t);
static void vr4181giu_dump(hpcio_chip_t);
static hpcio_chip_t vr4181giu_getchip(void *, int);
static void *vr4181giu_intr_establish(hpcio_chip_t, int, int,
int (*)(void *),void *);
static void vr4181giu_intr_disestablish(hpcio_chip_t, void *);
static void vr4181giu_intr_clear(hpcio_chip_t, void *);
static void vr4181giu_register_iochip(hpcio_chip_t, hpcio_chip_t);
static int vr4181giu_intr(void *);
static struct hpcio_chip vr4181giu_iochip = {
.hc_portread = vr4181giu_port_read,
.hc_portwrite = vr4181giu_port_write,
.hc_intr_establish = vr4181giu_intr_establish,
.hc_intr_disestablish = vr4181giu_intr_disestablish,
.hc_intr_clear = vr4181giu_intr_clear,
.hc_register_iochip = vr4181giu_register_iochip,
.hc_update = vr4181giu_update,
.hc_dump = vr4181giu_dump,
};
CFATTACH_DECL_NEW(vr4181giu, sizeof(struct vr4181giu_softc),
vr4181giu_match, vr4181giu_attach, NULL, NULL);
static int
vr4181giu_match(device_t parent, cfdata_t match, void *aux)
{
return (2);
}
static void
vr4181giu_attach(device_t parent, device_t self, void *aux)
{
struct vr4181giu_softc *sc = device_private(self);
struct vrip_attach_args *va = aux;
int i;
sc->sc_iot = va->va_iot;
sc->sc_vc = va->va_vc;
if (bus_space_map(sc->sc_iot, va->va_addr, va->va_size,
0 , &sc->sc_ioh)) {
printf(": can't map i/o space\n");
return;
}
for (i = 0; i < MAX_GIU4181INTR; i++)
TAILQ_INIT(&sc->sc_intr_head[i]);
if (!(sc->sc_ih
= vrip_intr_establish(va->va_vc, va->va_unit, 0,
IPL_BIO, vr4181giu_intr, sc))) {
printf("%s: can't establish interrupt\n", device_xname(self));
return;
}
sc->sc_iochip = vr4181giu_iochip;
sc->sc_iochip.hc_chipid = VRIP_IOCHIP_VR4181GIU;
sc->sc_iochip.hc_name = device_xname(self);
sc->sc_iochip.hc_sc = sc;
vrip_register_gpio(va->va_vc, &sc->sc_iochip);
printf("\n");
sc->sc_haa.haa_busname = HPCIO_BUSNAME;
sc->sc_haa.haa_sc = sc;
sc->sc_haa.haa_getchip = vr4181giu_getchip;
sc->sc_haa.haa_iot = sc->sc_iot;
while (config_found(self, &sc->sc_haa, vr4181giu_print, CFARGS_NONE)) ;
#if 1
config_defer(self, vr4181giu_callback);
#else
vr4181giu_callback(self);
#endif
}
static void
vr4181giu_callback(device_t self)
{
struct vr4181giu_softc *sc = device_private(self);
sc->sc_haa.haa_busname = "vrisab";
config_found(self, &sc->sc_haa, vr4181giu_print, CFARGS_NONE);
}
static int
vr4181giu_print(void *aux, const char *pnp)
{
if (pnp)
return (QUIET);
return (UNCONF);
}
static int
vr4181giu_port_read(hpcio_chip_t hc, int port)
{
struct vr4181giu_softc *sc = hc->hc_sc;
u_int16_t r;
if (port < 0 || 32 <= port)
panic("vr4181giu_port_read: invalid gpio port");
if (port < 16) {
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_PIOD_L_REG_W)
& 1 << port;
} else {
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_PIOD_H_REG_W)
& 1 << (port - 16);
}
return r ? 1 : 0;
}
static void
vr4181giu_port_write(hpcio_chip_t hc, int port, int onoff)
{
struct vr4181giu_softc *sc = hc->hc_sc;
u_int16_t r;
if (port < 16) {
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_PIOD_L_REG_W);
if (onoff) {
r |= 1 << port;
} else {
r &= ~(1 << port);
}
bus_space_write_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_PIOD_L_REG_W, r);
} else {
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_PIOD_H_REG_W);
if (onoff) {
r |= 1 << (port - 16);
} else {
r &= ~(1 << (port - 16));
}
bus_space_write_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_PIOD_H_REG_W, r);
}
}
static void
vr4181giu_update(hpcio_chip_t hc)
{
}
static void
vr4181giu_dump(hpcio_chip_t hc)
{
}
static hpcio_chip_t
vr4181giu_getchip(void* scx, int chipid)
{
struct vr4181giu_softc *sc = scx;
return (&sc->sc_iochip);
}
static void *
vr4181giu_intr_establish(
hpcio_chip_t hc,
int port,
int mode,
int (*ih_fun)(void *),
void *ih_arg)
{
struct vr4181giu_softc *sc = hc->hc_sc;
struct vr4181giu_intr_entry *ih;
int s;
u_int32_t mask;
u_int32_t raw_intr_type;
int regmod;
int reghl;
int bitoff;
u_int16_t r;
static u_int32_t intr_mode_trans[8] = {
VR4181GIU_INTTYP_LOW_LEVEL,
VR4181GIU_INTTYP_RISING_EDGE,
VR4181GIU_INTTYP_LOW_LEVEL,
VR4181GIU_INTTYP_RISING_EDGE,
VR4181GIU_INTTYP_HIGH_LEVEL,
VR4181GIU_INTTYP_FALLING_EDGE,
VR4181GIU_INTTYP_HIGH_LEVEL,
VR4181GIU_INTTYP_FALLING_EDGE,
};
raw_intr_type = intr_mode_trans[mode];
if (raw_intr_type == VR4181GIU_INTTYP_INVALID)
panic("vr4181giu_intr_establish: invalid interrupt mode.");
if (port < 0 || MAX_GIU4181INTR <= port)
panic("vr4181giu_intr_establish: invalid interrupt line.");
if (!TAILQ_EMPTY(&sc->sc_intr_head[port])
&& raw_intr_type != sc->sc_intr_mode[port])
panic("vr4181giu_intr_establish: "
"cannot use one line with two modes at a time.");
else
sc->sc_intr_mode[port] = raw_intr_type;
mask = (1 << port);
s = splhigh();
ih = kmem_alloc(sizeof *ih, KM_SLEEP);
ih->ih_port = port;
ih->ih_fun = ih_fun;
ih->ih_arg = ih_arg;
TAILQ_INSERT_TAIL(&sc->sc_intr_head[port], ih, ih_link);
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTEN_REG_W);
r &= ~mask;
bus_space_write_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTEN_REG_W, r);
regmod = port >> 3;
bitoff = (port & 0x7) << 1;
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_MODE0_REG_W + regmod);
r &= ~(0x3 << bitoff);
r |= (VR4181GIU_MODE_IN | VR4181GIU_MODE_GPIO) << bitoff;
bus_space_write_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_MODE0_REG_W + regmod, r);
reghl = port < 8 ? 2 : 0;
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_INTTYP_REG + reghl);
r &= ~(0x3 << bitoff);
r |= raw_intr_type << bitoff;
bus_space_write_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_INTTYP_REG + reghl, r);
bus_space_write_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_INTSTAT_REG_W, mask);
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTMASK_REG_W);
r &= ~mask;
bus_space_write_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTMASK_REG_W, r);
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTEN_REG_W);
r |= mask;
bus_space_write_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTEN_REG_W, r);
splx(s);
return ih;
}
static void
vr4181giu_intr_disestablish(hpcio_chip_t hc, void *arg)
{
}
static void
vr4181giu_intr_clear(hpcio_chip_t hc, void *arg)
{
struct vr4181giu_softc *sc = hc->hc_sc;
struct vr4181giu_intr_entry *ih = arg;
bus_space_write_2(sc->sc_iot, sc->sc_ioh,
VR4181GIU_INTSTAT_REG_W, 1 << ih->ih_port);
}
static void
vr4181giu_register_iochip(hpcio_chip_t hc, hpcio_chip_t iochip)
{
struct vr4181giu_softc *sc = hc->hc_sc;
vrip_register_gpio(sc->sc_vc, iochip);
}
static int
vr4181giu_intr(void *arg)
{
struct vr4181giu_softc *sc = arg;
int i;
u_int16_t r;
r = bus_space_read_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTSTAT_REG_W);
bus_space_write_2(sc->sc_iot, sc->sc_ioh, VR4181GIU_INTSTAT_REG_W, r);
for (i = 0; i < MAX_GIU4181INTR; i++) {
if (r & (1 << i)) {
struct vr4181giu_intr_entry *ih;
TAILQ_FOREACH(ih, &sc->sc_intr_head[i], ih_link) {
ih->ih_fun(ih->ih_arg);
}
}
}
return 0;
}