#include <sys/param.h>
#include <sys/malloc.h>
#include <sys/systm.h>
#include <dev/acpi/acpireg.h>
#include <dev/acpi/acpivar.h>
#include <dev/acpi/acpidev.h>
#include <dev/acpi/amltypes.h>
#include <dev/acpi/dsdt.h>
#define APLGPIO_CONF_TXSTATE 0x00000001
#define APLGPIO_CONF_RXSTATE 0x00000002
#define APLGPIO_CONF_RXINV 0x00800000
#define APLGPIO_CONF_RXEV_EDGE 0x02000000
#define APLGPIO_CONF_RXEV_ZERO 0x04000000
#define APLGPIO_CONF_RXEV_MASK 0x06000000
#define APLGPIO_IRQ_STS 0x100
#define APLGPIO_IRQ_EN 0x110
#define APLGPIO_PAD_CFG0 0x500
struct aplgpio_intrhand {
int (*ih_func)(void *);
void *ih_arg;
int ih_ipl;
};
struct aplgpio_softc {
struct device sc_dev;
struct acpi_softc *sc_acpi;
struct aml_node *sc_node;
bus_space_tag_t sc_memt;
bus_space_handle_t sc_memh;
void *sc_ih;
int sc_npins;
struct aplgpio_intrhand *sc_pin_ih;
struct acpi_gpio sc_gpio;
};
int aplgpio_match(struct device *, void *, void *);
void aplgpio_attach(struct device *, struct device *, void *);
const struct cfattach aplgpio_ca = {
sizeof(struct aplgpio_softc), aplgpio_match, aplgpio_attach
};
struct cfdriver aplgpio_cd = {
NULL, "aplgpio", DV_DULL
};
const char *aplgpio_hids[] = {
"INT3452",
NULL
};
int aplgpio_read_pin(void *, int);
void aplgpio_write_pin(void *, int, int);
void aplgpio_intr_establish(void *, int, int, int, int (*)(void *), void *);
void aplgpio_intr_enable(void *, int);
void aplgpio_intr_disable(void *, int);
int aplgpio_intr(void *);
int
aplgpio_match(struct device *parent, void *match, void *aux)
{
struct acpi_attach_args *aaa = aux;
struct cfdata *cf = match;
if (aaa->aaa_naddr < 1 || aaa->aaa_nirq < 1)
return 0;
return acpi_matchhids(aaa, aplgpio_hids, cf->cf_driver->cd_name);
}
void
aplgpio_attach(struct device *parent, struct device *self, void *aux)
{
struct aplgpio_softc *sc = (struct aplgpio_softc *)self;
struct acpi_attach_args *aaa = aux;
int64_t uid;
int i;
sc->sc_acpi = (struct acpi_softc *)parent;
sc->sc_node = aaa->aaa_node;
printf(" %s", sc->sc_node->name);
if (aml_evalinteger(sc->sc_acpi, sc->sc_node, "_UID", 0, NULL, &uid)) {
printf(": can't find uid\n");
return;
}
printf(" uid %lld", uid);
switch (uid) {
case 1:
sc->sc_npins = 78;
break;
case 2:
sc->sc_npins = 77;
break;
case 3:
sc->sc_npins = 47;
break;
case 4:
sc->sc_npins = 43;
break;
default:
printf("\n");
return;
}
printf(" addr 0x%llx/0x%llx", aaa->aaa_addr[0], aaa->aaa_size[0]);
printf(" irq %d", aaa->aaa_irq[0]);
sc->sc_memt = aaa->aaa_bst[0];
if (bus_space_map(sc->sc_memt, aaa->aaa_addr[0], aaa->aaa_size[0],
0, &sc->sc_memh)) {
printf(": can't map registers\n");
return;
}
sc->sc_pin_ih = mallocarray(sc->sc_npins, sizeof(*sc->sc_pin_ih),
M_DEVBUF, M_WAITOK | M_ZERO);
sc->sc_ih = acpi_intr_establish(aaa->aaa_irq[0], aaa->aaa_irq_flags[0],
IPL_BIO, aplgpio_intr, sc, sc->sc_dev.dv_xname);
if (sc->sc_ih == NULL) {
printf(": can't establish interrupt\n");
goto unmap;
}
sc->sc_gpio.cookie = sc;
sc->sc_gpio.read_pin = aplgpio_read_pin;
sc->sc_gpio.write_pin = aplgpio_write_pin;
sc->sc_gpio.intr_establish = aplgpio_intr_establish;
sc->sc_gpio.intr_enable = aplgpio_intr_enable;
sc->sc_gpio.intr_disable = aplgpio_intr_disable;
sc->sc_node->gpio = &sc->sc_gpio;
for (i = 0; i < sc->sc_npins; i++) {
if (i % 32 == 0) {
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (i / 32) * 4, 0x00000000);
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_STS + (i / 32) * 4, 0xffffffff);
}
}
printf(", %d pins\n", sc->sc_npins);
acpi_register_gpio(sc->sc_acpi, sc->sc_node);
return;
unmap:
free(sc->sc_pin_ih, M_DEVBUF, sc->sc_npins * sizeof(*sc->sc_pin_ih));
bus_space_unmap(sc->sc_memt, sc->sc_memh, aaa->aaa_size[0]);
}
int
aplgpio_read_pin(void *cookie, int pin)
{
struct aplgpio_softc *sc = cookie;
uint32_t reg;
reg = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_PAD_CFG0 + pin * 8);
return !!(reg & APLGPIO_CONF_RXSTATE);
}
void
aplgpio_write_pin(void *cookie, int pin, int value)
{
struct aplgpio_softc *sc = cookie;
uint32_t reg;
reg = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_PAD_CFG0 + pin * 8);
if (value)
reg |= APLGPIO_CONF_TXSTATE;
else
reg &= ~APLGPIO_CONF_TXSTATE;
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_PAD_CFG0 + pin * 8, reg);
}
void
aplgpio_intr_establish(void *cookie, int pin, int flags, int level,
int (*func)(void *), void *arg)
{
struct aplgpio_softc *sc = cookie;
uint32_t reg;
KASSERT(pin >= 0 && pin < sc->sc_npins);
sc->sc_pin_ih[pin].ih_func = func;
sc->sc_pin_ih[pin].ih_arg = arg;
sc->sc_pin_ih[pin].ih_ipl = level & ~IPL_WAKEUP;
reg = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_PAD_CFG0 + pin * 8);
reg &= ~(APLGPIO_CONF_RXEV_MASK | APLGPIO_CONF_RXINV);
if ((flags & LR_GPIO_MODE) == 1)
reg |= APLGPIO_CONF_RXEV_EDGE;
if ((flags & LR_GPIO_POLARITY) == LR_GPIO_ACTLO)
reg |= APLGPIO_CONF_RXINV;
if ((flags & LR_GPIO_POLARITY) == LR_GPIO_ACTBOTH)
reg |= APLGPIO_CONF_RXEV_EDGE | APLGPIO_CONF_RXEV_ZERO;
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_PAD_CFG0 + pin * 8, reg);
reg = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (pin / 32) * 4);
reg |= (1 << (pin % 32));
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (pin / 32) * 4, reg);
}
void
aplgpio_intr_enable(void *cookie, int pin)
{
struct aplgpio_softc *sc = cookie;
uint32_t reg;
KASSERT(pin >= 0 && pin < sc->sc_npins);
reg = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (pin / 32) * 4);
reg |= (1 << (pin % 32));
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (pin / 32) * 4, reg);
}
void
aplgpio_intr_disable(void *cookie, int pin)
{
struct aplgpio_softc *sc = cookie;
uint32_t reg;
KASSERT(pin >= 0 && pin < sc->sc_npins);
reg = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (pin / 32) * 4);
reg &= ~(1 << (pin % 32));
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (pin / 32) * 4, reg);
}
int
aplgpio_intr(void *arg)
{
struct aplgpio_softc *sc = arg;
struct aplgpio_intrhand *ih;
uint32_t status, enable;
int rc = 0;
int pin, s;
for (pin = 0; pin < sc->sc_npins; pin++) {
if (pin % 32 == 0) {
status = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_STS + (pin / 32) * 4);
bus_space_write_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_STS + (pin / 32) * 4, status);
enable = bus_space_read_4(sc->sc_memt, sc->sc_memh,
APLGPIO_IRQ_EN + (pin / 32) * 4);
status &= enable;
}
if (status & (1 << (pin % 32))) {
ih = &sc->sc_pin_ih[pin];
if (ih->ih_func) {
s = splraise(ih->ih_ipl);
ih->ih_func(ih->ih_arg);
splx(s);
}
rc = 1;
}
}
return rc;
}