/* $OpenBSD: dwgpio.c,v 1.7 2022/04/06 18:59:27 naddy Exp $ */ /* * Copyright (c) 2020 Mark Kettenis * * Permission to use, copy, modify, and distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. */ #include #include #include #include #include #include #include #include /* Registers. */ #define GPIO_SWPORTA_DR 0x0000 #define GPIO_SWPORTA_DDR 0x0004 #define GPIO_INTEN 0x0030 #define GPIO_INTTYPE_LEVEL 0x0034 #define GPIO_INT_POLARITY 0x0038 #define GPIO_INT_STATUS 0x003c #define GPIO_PORTS_EOI 0x0040 #define GPIO_INTMASK 0x0044 #define GPIO_DEBOUNCE 0x0048 #define GPIO_EXT_PORTA 0x0050 #define GPIO_NUM_PORTS 4 #define GPIO_NUM_PINS 32 #define HREAD4(sc, reg) \ (bus_space_read_4((sc)->sc_memt, (sc)->sc_memh, (reg))) #define HWRITE4(sc, reg, val) \ bus_space_write_4((sc)->sc_memt, (sc)->sc_memh, (reg), (val)) #define HSET4(sc, reg, bits) \ HWRITE4((sc), (reg), HREAD4((sc), (reg)) | (bits)) #define HCLR4(sc, reg, bits) \ HWRITE4((sc), (reg), HREAD4((sc), (reg)) & ~(bits)) struct dwgpio_intrhand { int (*ih_func)(void *); void *ih_arg; }; struct dwgpio_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; int sc_nirq; void **sc_ih; uint32_t sc_npins; struct dwgpio_intrhand *sc_pin_ih; struct acpi_gpio sc_gpio; }; int dwgpio_match(struct device *, void *, void *); void dwgpio_attach(struct device *, struct device *, void *); const struct cfattach dwgpio_ca = { sizeof(struct dwgpio_softc), dwgpio_match, dwgpio_attach }; struct cfdriver dwgpio_cd = { NULL, "dwgpio", DV_DULL }; const char *dwgpio_hids[] = { "APMC0D81", NULL }; int dwgpio_found_hid(struct aml_node *, void *); int dwgpio_read_pin(void *, int); void dwgpio_write_pin(void *, int, int); void dwgpio_intr_establish(void *, int, int, int (*)(void *), void *); int dwgpio_pin_intr(struct dwgpio_softc *, int); int dwgpio_intr(void *); int dwgpio_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, dwgpio_hids, cf->cf_driver->cd_name); } void dwgpio_attach(struct device *parent, struct device *self, void *aux) { struct acpi_attach_args *aaa = aux; struct dwgpio_softc *sc = (struct dwgpio_softc *)self; int i; sc->sc_acpi = (struct acpi_softc *)parent; sc->sc_node = aaa->aaa_node; printf(" %s", sc->sc_node->name); printf(" addr 0x%llx/0x%llx", aaa->aaa_addr[0], aaa->aaa_size[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; } aml_find_node(sc->sc_node, "_HID", dwgpio_found_hid, sc); if (sc->sc_npins == 0) { printf(": no pins\n"); return; } if (sc->sc_npins >= GPIO_NUM_PINS) { printf(": too many pins\n"); return; } sc->sc_pin_ih = mallocarray(sc->sc_npins, sizeof(*sc->sc_pin_ih), M_DEVBUF, M_WAITOK | M_ZERO); printf(" irq"); sc->sc_nirq = aaa->aaa_nirq; sc->sc_ih = mallocarray(sc->sc_nirq, sizeof(*sc->sc_ih), M_DEVBUF, M_WAITOK | M_ZERO); for (i = 0; i < sc->sc_nirq; i++) { printf(" %d", aaa->aaa_irq[i]); sc->sc_ih[i] = acpi_intr_establish(aaa->aaa_irq[i], aaa->aaa_irq_flags[i], IPL_BIO, dwgpio_intr, sc, sc->sc_dev.dv_xname); if (sc->sc_ih[i] == NULL) { printf(": can't establish interrupt\n"); goto unmap; } } sc->sc_gpio.cookie = sc; sc->sc_gpio.read_pin = dwgpio_read_pin; sc->sc_gpio.write_pin = dwgpio_write_pin; sc->sc_gpio.intr_establish = dwgpio_intr_establish; sc->sc_node->gpio = &sc->sc_gpio; printf(", %d pins\n", sc->sc_npins); acpi_register_gpio(sc->sc_acpi, sc->sc_node); return; unmap: for (i = 0; i < sc->sc_nirq; i++) { if (sc->sc_ih[i]) acpi_intr_disestablish(sc->sc_ih[i]); } free(sc->sc_ih, M_DEVBUF, sc->sc_nirq * sizeof(*sc->sc_ih)); 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 dwgpio_found_hid(struct aml_node *child, void *arg) { struct dwgpio_softc *sc = (struct dwgpio_softc *)arg; struct aml_node *node = child->parent; int reg; /* Skip our own _HID. */ if (node == sc->sc_node) return 0; /* Only handle a single port for now. */ reg = acpi_getpropint(node, "reg", -1); if (reg != 0) return 0; sc->sc_npins = acpi_getpropint(node, "snps,nr-gpios", GPIO_NUM_PINS); node->attached = 1; return 0; } int dwgpio_read_pin(void *cookie, int pin) { struct dwgpio_softc *sc = cookie; uint32_t reg; int val; if (pin < 0 || pin >= sc->sc_npins) return 0; reg = HREAD4(sc, GPIO_EXT_PORTA); val = (reg >> pin) & 1; return val; } void dwgpio_write_pin(void *cookie, int pin, int val) { struct dwgpio_softc *sc = cookie; if (pin < 0 || pin >= sc->sc_npins) return; if (val) HSET4(sc, GPIO_SWPORTA_DR, (1 << pin)); else HCLR4(sc, GPIO_SWPORTA_DR, (1 << pin)); } void dwgpio_intr_establish(void *cookie, int pin, int flags, int (*func)(void *), void *arg) { struct dwgpio_softc *sc = cookie; if (pin < 0 || pin >= sc->sc_npins) return; sc->sc_pin_ih[pin].ih_func = func; sc->sc_pin_ih[pin].ih_arg = arg; if ((flags & LR_GPIO_MODE) == LR_GPIO_EDGE) HSET4(sc, GPIO_INTTYPE_LEVEL, 1 << pin); else HCLR4(sc, GPIO_INTTYPE_LEVEL, 1 << pin); if ((flags & LR_GPIO_POLARITY) == LR_GPIO_ACTHI) HSET4(sc, GPIO_INT_POLARITY, 1 << pin); else HCLR4(sc, GPIO_INT_POLARITY, 1 << pin); HCLR4(sc, GPIO_SWPORTA_DDR, 1 << pin); HSET4(sc, GPIO_INTEN, 1 << pin); HCLR4(sc, GPIO_INTMASK, 1 << pin); } int dwgpio_intr(void *arg) { struct dwgpio_softc *sc = arg; uint32_t status; int pin, handled = 0; status = HREAD4(sc, GPIO_INT_STATUS); HWRITE4(sc, GPIO_PORTS_EOI, status); for (pin = 0; pin < sc->sc_npins; pin++) { if ((status & (1 << pin)) && sc->sc_pin_ih[pin].ih_func) { sc->sc_pin_ih[pin].ih_func(sc->sc_pin_ih[pin].ih_arg); handled = 1; } } return handled; }