Home | History | Annotate | Line # | Download | only in acpi
      1  1.3  riastrad /*	$NetBSD: amdgpio.c,v 1.3 2025/03/02 13:47:35 riastradh Exp $	*/
      2  1.1     ryoon 
      3  1.1     ryoon /*-
      4  1.1     ryoon  * Copyright (c) 2024 The NetBSD Foundation, Inc.
      5  1.1     ryoon  * All rights reserved.
      6  1.1     ryoon  *
      7  1.1     ryoon  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1     ryoon  * by Jared McNeill <jmcneill (at) invisible.ca>.
      9  1.1     ryoon  *
     10  1.1     ryoon  * Redistribution and use in source and binary forms, with or without
     11  1.1     ryoon  * modification, are permitted provided that the following conditions
     12  1.1     ryoon  * are met:
     13  1.1     ryoon  * 1. Redistributions of source code must retain the above copyright
     14  1.1     ryoon  *    notice, this list of conditions and the following disclaimer.
     15  1.1     ryoon  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1     ryoon  *    notice, this list of conditions and the following disclaimer in the
     17  1.1     ryoon  *    documentation and/or other materials provided with the distribution.
     18  1.1     ryoon  *
     19  1.1     ryoon  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.1     ryoon  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.1     ryoon  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.1     ryoon  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.1     ryoon  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.1     ryoon  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.1     ryoon  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.1     ryoon  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.1     ryoon  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.1     ryoon  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.1     ryoon  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1     ryoon  */
     31  1.1     ryoon 
     32  1.1     ryoon #include <sys/cdefs.h>
     33  1.3  riastrad __KERNEL_RCSID(0, "$NetBSD: amdgpio.c,v 1.3 2025/03/02 13:47:35 riastradh Exp $");
     34  1.1     ryoon 
     35  1.1     ryoon #include <sys/param.h>
     36  1.1     ryoon #include <sys/bus.h>
     37  1.1     ryoon #include <sys/cpu.h>
     38  1.1     ryoon #include <sys/device.h>
     39  1.1     ryoon #include <sys/gpio.h>
     40  1.1     ryoon #include <sys/kmem.h>
     41  1.1     ryoon #include <sys/mutex.h>
     42  1.1     ryoon #include <sys/queue.h>
     43  1.1     ryoon 
     44  1.1     ryoon #include <dev/acpi/acpireg.h>
     45  1.1     ryoon #include <dev/acpi/acpivar.h>
     46  1.1     ryoon #include <dev/acpi/acpi_event.h>
     47  1.1     ryoon #include <dev/acpi/acpi_gpio.h>
     48  1.1     ryoon #include <dev/acpi/acpi_intr.h>
     49  1.1     ryoon #include <dev/acpi/amdgpioreg.h>
     50  1.1     ryoon 
     51  1.1     ryoon #include <dev/gpio/gpiovar.h>
     52  1.1     ryoon 
     53  1.1     ryoon struct amdgpio_config {
     54  1.1     ryoon 	u_int	num_pins;
     55  1.1     ryoon 	int	(*translate)(ACPI_RESOURCE_GPIO *);
     56  1.1     ryoon };
     57  1.1     ryoon 
     58  1.1     ryoon struct amdgpio_intr_handler {
     59  1.1     ryoon 	int	(*ih_func)(void *);
     60  1.1     ryoon 	void	*ih_arg;
     61  1.1     ryoon 	int	ih_pin;
     62  1.1     ryoon 	LIST_ENTRY(amdgpio_intr_handler) ih_list;
     63  1.1     ryoon };
     64  1.1     ryoon 
     65  1.1     ryoon struct amdgpio_softc {
     66  1.1     ryoon 	device_t			sc_dev;
     67  1.1     ryoon 	device_t			sc_gpiodev;
     68  1.1     ryoon 	bus_space_handle_t		sc_bsh;
     69  1.1     ryoon 	bus_space_tag_t			sc_bst;
     70  1.1     ryoon 	const struct amdgpio_config	*sc_config;
     71  1.1     ryoon 	struct gpio_chipset_tag		sc_gc;
     72  1.1     ryoon 	gpio_pin_t			*sc_pins;
     73  1.1     ryoon 	LIST_HEAD(, amdgpio_intr_handler) sc_intrs;
     74  1.1     ryoon 	kmutex_t			sc_lock;
     75  1.1     ryoon };
     76  1.1     ryoon 
     77  1.1     ryoon #define RD4(sc, reg)		\
     78  1.1     ryoon 	bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
     79  1.1     ryoon #define WR4(sc, reg, val)	\
     80  1.1     ryoon 	bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
     81  1.1     ryoon 
     82  1.1     ryoon static int	amdgpio_match(device_t, cfdata_t, void *);
     83  1.1     ryoon static void	amdgpio_attach(device_t, device_t, void *);
     84  1.1     ryoon 
     85  1.1     ryoon static int	amdgpio_pin_read(void *, int);
     86  1.1     ryoon static void	amdgpio_pin_write(void *, int, int);
     87  1.1     ryoon static void	amdgpio_pin_ctl(void *, int, int);
     88  1.1     ryoon static void *	amdgpio_intr_establish(void *, int, int, int,
     89  1.3  riastrad 		    int (*)(void *), void *);
     90  1.1     ryoon static void	amdgpio_intr_disestablish(void *, void *);
     91  1.1     ryoon static bool	amdgpio_intr_str(void *, int, int, char *, size_t);
     92  1.1     ryoon static void	amdgpio_intr_mask(void *, void *);
     93  1.1     ryoon static void	amdgpio_intr_unmask(void *, void *);
     94  1.1     ryoon 
     95  1.1     ryoon static int	amdgpio_acpi_translate(void *, ACPI_RESOURCE_GPIO *, void **);
     96  1.1     ryoon static void	amdgpio_register_event(void *, struct acpi_event *,
     97  1.3  riastrad 		    ACPI_RESOURCE_GPIO *);
     98  1.1     ryoon static int	amdgpio_intr(void *);
     99  1.1     ryoon 
    100  1.1     ryoon CFATTACH_DECL_NEW(amdgpio, sizeof(struct amdgpio_softc),
    101  1.1     ryoon     amdgpio_match, amdgpio_attach, NULL, NULL);
    102  1.1     ryoon 
    103  1.1     ryoon #define AMDGPIO_NUM_PINS	184
    104  1.1     ryoon 
    105  1.1     ryoon static int
    106  1.1     ryoon amdgpio_translate(ACPI_RESOURCE_GPIO *gpio)
    107  1.1     ryoon {
    108  1.1     ryoon 	const ACPI_INTEGER pin = gpio->PinTable[0];
    109  1.1     ryoon 
    110  1.1     ryoon 	if (pin < AMDGPIO_NUM_PINS) {
    111  1.1     ryoon 		return gpio->PinTable[0];
    112  1.1     ryoon 	}
    113  1.1     ryoon 
    114  1.1     ryoon 	switch (pin) {
    115  1.1     ryoon 	case 0x0:
    116  1.1     ryoon 	case 0x8: /* TPDD */
    117  1.1     ryoon 	case 0x28: /* TPNL */
    118  1.1     ryoon 	case 0x3a:
    119  1.1     ryoon 	case 0x3b:
    120  1.1     ryoon 	case 0x3d:
    121  1.1     ryoon 	case 0x3e:
    122  1.1     ryoon 		return pin;
    123  1.1     ryoon 	default:
    124  1.1     ryoon 		return -1;
    125  1.1     ryoon 	}
    126  1.1     ryoon }
    127  1.1     ryoon 
    128  1.1     ryoon static struct amdgpio_config amdgpio_config = {
    129  1.1     ryoon 	.num_pins = AMDGPIO_NUM_PINS,
    130  1.1     ryoon 	.translate = amdgpio_translate, /* TODO: REMOVE */
    131  1.1     ryoon };
    132  1.1     ryoon 
    133  1.1     ryoon static const struct device_compatible_entry compat_data[] = {
    134  1.1     ryoon 	{ .compat = "AMDI0030",	.data = &amdgpio_config },
    135  1.1     ryoon 	DEVICE_COMPAT_EOL
    136  1.1     ryoon };
    137  1.1     ryoon 
    138  1.1     ryoon static int
    139  1.1     ryoon amdgpio_match(device_t parent, cfdata_t cf, void *aux)
    140  1.1     ryoon {
    141  1.1     ryoon 	struct acpi_attach_args *aa = aux;
    142  1.1     ryoon 
    143  1.1     ryoon 	return acpi_compatible_match(aa, compat_data);
    144  1.1     ryoon }
    145  1.1     ryoon 
    146  1.1     ryoon static void
    147  1.1     ryoon amdgpio_attach(device_t parent, device_t self, void *aux)
    148  1.1     ryoon {
    149  1.1     ryoon 	struct amdgpio_softc * const sc = device_private(self);
    150  1.1     ryoon 	struct acpi_attach_args *aa = aux;
    151  1.1     ryoon 	struct gpiobus_attach_args gba;
    152  1.1     ryoon 	ACPI_HANDLE hdl = aa->aa_node->ad_handle;
    153  1.1     ryoon 	struct acpi_resources res;
    154  1.1     ryoon 	struct acpi_mem *mem;
    155  1.1     ryoon 	struct acpi_irq *irq;
    156  1.1     ryoon 	ACPI_STATUS rv;
    157  1.1     ryoon 	int error, pin;
    158  1.1     ryoon 	void *ih;
    159  1.1     ryoon 
    160  1.1     ryoon 	sc->sc_dev = self;
    161  1.1     ryoon 	sc->sc_config = acpi_compatible_lookup(aa, compat_data)->data;
    162  1.1     ryoon 	sc->sc_bst = aa->aa_memt;
    163  1.1     ryoon 	KASSERT(sc->sc_config != NULL);
    164  1.1     ryoon 	LIST_INIT(&sc->sc_intrs);
    165  1.1     ryoon 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_VM);
    166  1.1     ryoon 
    167  1.1     ryoon 	rv = acpi_resource_parse(sc->sc_dev, hdl, "_CRS",
    168  1.1     ryoon 	    &res, &acpi_resource_parse_ops_default);
    169  1.1     ryoon 	if (ACPI_FAILURE(rv)) {
    170  1.1     ryoon 		return;
    171  1.1     ryoon 	}
    172  1.1     ryoon 
    173  1.1     ryoon 	mem = acpi_res_mem(&res, 0);
    174  1.1     ryoon 	if (mem == NULL) {
    175  1.1     ryoon 		aprint_error_dev(self, "couldn't find mem resource\n");
    176  1.1     ryoon 		goto done;
    177  1.1     ryoon 	}
    178  1.1     ryoon 
    179  1.1     ryoon 	irq = acpi_res_irq(&res, 0);
    180  1.1     ryoon 	if (irq == NULL) {
    181  1.1     ryoon 		aprint_error_dev(self, "couldn't find irq resource\n");
    182  1.1     ryoon 		goto done;
    183  1.1     ryoon 	}
    184  1.1     ryoon 
    185  1.1     ryoon 	error = bus_space_map(sc->sc_bst, mem->ar_base, mem->ar_length, 0,
    186  1.1     ryoon 	    &sc->sc_bsh);
    187  1.1     ryoon 	if (error) {
    188  1.1     ryoon 		aprint_error_dev(self, "couldn't map registers\n");
    189  1.1     ryoon 		goto done;
    190  1.1     ryoon 	}
    191  1.1     ryoon 
    192  1.1     ryoon 	sc->sc_pins = kmem_zalloc(sizeof(*sc->sc_pins) *
    193  1.1     ryoon 	    sc->sc_config->num_pins, KM_SLEEP);
    194  1.1     ryoon 	for (pin = 0; pin < sc->sc_config->num_pins; pin++) {
    195  1.1     ryoon 		sc->sc_pins[pin].pin_num = pin;
    196  1.1     ryoon 		sc->sc_pins[pin].pin_caps = GPIO_PIN_INPUT | GPIO_PIN_OUTPUT;
    197  1.1     ryoon 		sc->sc_pins[pin].pin_intrcaps =
    198  1.1     ryoon 		    GPIO_INTR_POS_EDGE | GPIO_INTR_NEG_EDGE |
    199  1.1     ryoon 		    GPIO_INTR_DOUBLE_EDGE | GPIO_INTR_HIGH_LEVEL |
    200  1.1     ryoon 		    GPIO_INTR_LOW_LEVEL | GPIO_INTR_MPSAFE;
    201  1.3  riastrad 		/*
    202  1.3  riastrad 		 * It's not safe to read all pins, so leave pin state
    203  1.3  riastrad 		 * unknown
    204  1.3  riastrad 		 */
    205  1.1     ryoon 		sc->sc_pins[pin].pin_state = 0;
    206  1.1     ryoon 	}
    207  1.1     ryoon 
    208  1.1     ryoon 	sc->sc_gc.gp_cookie = sc;
    209  1.1     ryoon 	sc->sc_gc.gp_pin_read = amdgpio_pin_read;
    210  1.1     ryoon 	sc->sc_gc.gp_pin_write = amdgpio_pin_write;
    211  1.1     ryoon 	sc->sc_gc.gp_pin_ctl = amdgpio_pin_ctl;
    212  1.1     ryoon 	sc->sc_gc.gp_intr_establish = amdgpio_intr_establish;
    213  1.1     ryoon 	sc->sc_gc.gp_intr_disestablish = amdgpio_intr_disestablish;
    214  1.1     ryoon 	sc->sc_gc.gp_intr_str = amdgpio_intr_str;
    215  1.1     ryoon 	sc->sc_gc.gp_intr_mask = amdgpio_intr_mask;
    216  1.1     ryoon 	sc->sc_gc.gp_intr_unmask = amdgpio_intr_unmask;
    217  1.1     ryoon 
    218  1.1     ryoon 	rv = acpi_event_create_gpio(self, hdl, amdgpio_register_event, sc);
    219  1.1     ryoon 	if (ACPI_FAILURE(rv)) {
    220  1.1     ryoon 		if (rv != AE_NOT_FOUND) {
    221  1.1     ryoon 			aprint_error_dev(self, "failed to create events: %s\n",
    222  1.1     ryoon 			    AcpiFormatException(rv));
    223  1.1     ryoon 		}
    224  1.1     ryoon 		goto done;
    225  1.1     ryoon 	}
    226  1.1     ryoon 
    227  1.1     ryoon 	ih = acpi_intr_establish(self, (uint64_t)(uintptr_t)hdl,
    228  1.1     ryoon 	    IPL_VM, false, amdgpio_intr, sc, device_xname(self));
    229  1.1     ryoon 	if (ih == NULL) {
    230  1.1     ryoon 		aprint_error_dev(self, "couldn't establish interrupt\n");
    231  1.1     ryoon 		goto done;
    232  1.1     ryoon 	}
    233  1.1     ryoon 
    234  1.1     ryoon 	memset(&gba, 0, sizeof(gba));
    235  1.1     ryoon 	gba.gba_gc = &sc->sc_gc;
    236  1.1     ryoon 	gba.gba_pins = sc->sc_pins;
    237  1.1     ryoon 	gba.gba_npins = sc->sc_config->num_pins;
    238  1.1     ryoon 	sc->sc_gpiodev = config_found(self, &gba, gpiobus_print,
    239  1.1     ryoon 	    CFARGS(.iattr = "gpiobus"));
    240  1.1     ryoon 	if (sc->sc_gpiodev != NULL) {
    241  1.1     ryoon 		acpi_gpio_register(aa->aa_node, self,
    242  1.3  riastrad 		    amdgpio_acpi_translate, sc);
    243  1.1     ryoon 	}
    244  1.1     ryoon 
    245  1.1     ryoon done:
    246  1.1     ryoon 	acpi_resource_cleanup(&res);
    247  1.1     ryoon }
    248  1.1     ryoon 
    249  1.1     ryoon static int
    250  1.1     ryoon amdgpio_acpi_translate(void *priv, ACPI_RESOURCE_GPIO *gpio, void **gpiop)
    251  1.1     ryoon {
    252  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    253  1.1     ryoon 	const ACPI_INTEGER pin = gpio->PinTable[0];
    254  1.1     ryoon 	int xpin;
    255  1.1     ryoon 
    256  1.1     ryoon 	xpin = sc->sc_config->translate(gpio);
    257  1.1     ryoon 
    258  1.1     ryoon 	aprint_debug_dev(sc->sc_dev, "translate %#lx -> %u\n", pin, xpin);
    259  1.1     ryoon 
    260  1.1     ryoon 	if (gpiop != NULL) {
    261  1.1     ryoon 		if (sc->sc_gpiodev != NULL) {
    262  1.1     ryoon 			*gpiop = device_private(sc->sc_gpiodev);
    263  1.1     ryoon 		} else {
    264  1.1     ryoon 			device_printf(sc->sc_dev,
    265  1.1     ryoon 			    "no gpiodev for pin %#lx -> %u\n", pin, xpin);
    266  1.1     ryoon 			xpin = -1;
    267  1.1     ryoon 		}
    268  1.1     ryoon 	}
    269  1.1     ryoon 
    270  1.1     ryoon 	return xpin;
    271  1.1     ryoon }
    272  1.1     ryoon 
    273  1.1     ryoon static int
    274  1.1     ryoon amdgpio_acpi_event(void *priv)
    275  1.1     ryoon {
    276  1.1     ryoon 	struct acpi_event * const ev = priv;
    277  1.1     ryoon 
    278  1.1     ryoon 	acpi_event_notify(ev);
    279  1.1     ryoon 
    280  1.1     ryoon 	return 1;
    281  1.1     ryoon }
    282  1.1     ryoon 
    283  1.1     ryoon static void
    284  1.1     ryoon amdgpio_register_event(void *priv, struct acpi_event *ev,
    285  1.1     ryoon     ACPI_RESOURCE_GPIO *gpio)
    286  1.1     ryoon {
    287  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    288  1.1     ryoon 	int irqmode;
    289  1.1     ryoon 	void *ih;
    290  1.1     ryoon 
    291  1.1     ryoon 	const int pin = amdgpio_acpi_translate(sc, gpio, NULL);
    292  1.1     ryoon 
    293  1.1     ryoon 	if (pin < 0 || pin == 0x8) {
    294  1.1     ryoon 		aprint_error_dev(sc->sc_dev,
    295  1.1     ryoon 		    "ignoring event for pin %#x (out of range)\n",
    296  1.1     ryoon 		    gpio->PinTable[0]);
    297  1.1     ryoon 		return;
    298  1.1     ryoon 	}
    299  1.1     ryoon 
    300  1.1     ryoon 	if (gpio->Triggering == ACPI_LEVEL_SENSITIVE) {
    301  1.1     ryoon 		irqmode = gpio->Polarity == ACPI_ACTIVE_HIGH ?
    302  1.1     ryoon 		    GPIO_INTR_HIGH_LEVEL : GPIO_INTR_LOW_LEVEL;
    303  1.1     ryoon 	} else {
    304  1.1     ryoon 		KASSERT(gpio->Triggering == ACPI_EDGE_SENSITIVE);
    305  1.1     ryoon 		if (gpio->Polarity == ACPI_ACTIVE_LOW) {
    306  1.1     ryoon 			irqmode = GPIO_INTR_NEG_EDGE;
    307  1.1     ryoon 		} else if (gpio->Polarity == ACPI_ACTIVE_HIGH) {
    308  1.1     ryoon 			irqmode = GPIO_INTR_POS_EDGE;
    309  1.1     ryoon 		} else {
    310  1.1     ryoon 			KASSERT(gpio->Polarity == ACPI_ACTIVE_BOTH);
    311  1.1     ryoon 			irqmode = GPIO_INTR_DOUBLE_EDGE;
    312  1.1     ryoon 		}
    313  1.1     ryoon 	}
    314  1.1     ryoon 
    315  1.1     ryoon 	ih = amdgpio_intr_establish(sc, pin, IPL_VM, irqmode,
    316  1.1     ryoon 	    amdgpio_acpi_event, ev);
    317  1.1     ryoon 	if (ih == NULL) {
    318  1.1     ryoon 		aprint_error_dev(sc->sc_dev,
    319  1.1     ryoon 		    "couldn't register event for pin %#x\n",
    320  1.1     ryoon 		    gpio->PinTable[0]);
    321  1.1     ryoon 		return;
    322  1.1     ryoon 	}
    323  1.1     ryoon 	if (gpio->Triggering == ACPI_LEVEL_SENSITIVE) {
    324  1.1     ryoon 		acpi_event_set_intrcookie(ev, ih);
    325  1.1     ryoon 	}
    326  1.1     ryoon }
    327  1.1     ryoon 
    328  1.1     ryoon static int
    329  1.1     ryoon amdgpio_pin_read(void *priv, int pin)
    330  1.1     ryoon {
    331  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    332  1.1     ryoon 	uint32_t val;
    333  1.1     ryoon 
    334  1.1     ryoon 	if (pin < 0 || pin >= sc->sc_config->num_pins) {
    335  1.1     ryoon 		return 0;
    336  1.1     ryoon 	}
    337  1.1     ryoon 	if ((sc->sc_pins[pin].pin_caps & GPIO_PIN_INPUT) == 0) {
    338  1.1     ryoon 		return 0;
    339  1.1     ryoon 	}
    340  1.1     ryoon 
    341  1.1     ryoon 	val = RD4(sc, AMDGPIO_PIN_REG(pin));
    342  1.1     ryoon 	return (val & AMDGPIO_CONF_GPIORXSTATE) ? 1 : 0;
    343  1.1     ryoon }
    344  1.1     ryoon 
    345  1.1     ryoon static void
    346  1.1     ryoon amdgpio_pin_write(void *priv, int pin, int pinval)
    347  1.1     ryoon {
    348  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    349  1.1     ryoon 	uint32_t val;
    350  1.1     ryoon 
    351  1.1     ryoon 	if (pin < 0 || pin >= sc->sc_config->num_pins) {
    352  1.1     ryoon 		return;
    353  1.1     ryoon 	}
    354  1.1     ryoon 	if ((sc->sc_pins[pin].pin_caps & GPIO_PIN_OUTPUT) == 0) {
    355  1.1     ryoon 		return;
    356  1.1     ryoon 	}
    357  1.1     ryoon 
    358  1.1     ryoon 	val = RD4(sc, AMDGPIO_PIN_REG(pin));
    359  1.1     ryoon 	if (pinval) {
    360  1.1     ryoon 		val |= AMDGPIO_CONF_GPIOTXSTATE;
    361  1.1     ryoon 	} else {
    362  1.1     ryoon 		val &= ~AMDGPIO_CONF_GPIOTXSTATE;
    363  1.1     ryoon 	}
    364  1.1     ryoon 	WR4(sc, AMDGPIO_PIN_REG(pin), val);
    365  1.1     ryoon }
    366  1.1     ryoon 
    367  1.1     ryoon static void
    368  1.1     ryoon amdgpio_pin_ctl(void *priv, int pin, int flags)
    369  1.1     ryoon {
    370  1.1     ryoon 	/* Nothing to do here, as firmware has already configured pins. */
    371  1.1     ryoon }
    372  1.1     ryoon 
    373  1.1     ryoon static void *
    374  1.1     ryoon amdgpio_intr_establish(void *priv, int pin, int ipl, int irqmode,
    375  1.3  riastrad     int (*func)(void *), void *arg)
    376  1.1     ryoon {
    377  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    378  1.1     ryoon 	struct amdgpio_intr_handler *aih, *aihp;
    379  1.1     ryoon 	uint32_t dect;
    380  1.1     ryoon 	uint32_t val;
    381  1.1     ryoon 
    382  1.1     ryoon 	if (pin < 0 || pin >= sc->sc_config->num_pins) {
    383  1.1     ryoon 		return NULL;
    384  1.1     ryoon 	}
    385  1.1     ryoon 	if (ipl != IPL_VM) {
    386  1.1     ryoon 		device_printf(sc->sc_dev, "%s: only IPL_VM supported\n",
    387  1.1     ryoon 		    __func__);
    388  1.1     ryoon 		return NULL;
    389  1.1     ryoon 	}
    390  1.1     ryoon 
    391  1.1     ryoon 	aih = kmem_alloc(sizeof(*aih), KM_SLEEP);
    392  1.1     ryoon 	aih->ih_func = func;
    393  1.1     ryoon 	aih->ih_arg = arg;
    394  1.1     ryoon 	aih->ih_pin = pin;
    395  1.1     ryoon 
    396  1.1     ryoon 	mutex_enter(&sc->sc_lock);
    397  1.1     ryoon 
    398  1.1     ryoon 	LIST_FOREACH(aihp, &sc->sc_intrs, ih_list) {
    399  1.1     ryoon 		if (aihp->ih_pin == aih->ih_pin) {
    400  1.1     ryoon 			mutex_exit(&sc->sc_lock);
    401  1.1     ryoon 			kmem_free(aih, sizeof(*aih));
    402  1.1     ryoon 			device_printf(sc->sc_dev,
    403  1.1     ryoon 			    "%s: pin %d already establish\n", __func__, pin);
    404  1.1     ryoon 			return NULL;
    405  1.1     ryoon 		}
    406  1.1     ryoon 	}
    407  1.1     ryoon 
    408  1.1     ryoon 	LIST_INSERT_HEAD(&sc->sc_intrs, aih, ih_list);
    409  1.1     ryoon 
    410  1.1     ryoon 	if ((irqmode & GPIO_INTR_LEVEL_MASK) != 0) {
    411  1.1     ryoon 		dect = AMDGPIO_CONF_LEVEL;
    412  1.1     ryoon 	} else {
    413  1.1     ryoon 		KASSERT((irqmode & GPIO_INTR_EDGE_MASK) != 0);
    414  1.1     ryoon 		if ((irqmode & GPIO_INTR_NEG_EDGE) != 0) {
    415  1.1     ryoon 			dect = AMDGPIO_CONF_ACTLO;
    416  1.1     ryoon 		} else if ((irqmode & GPIO_INTR_POS_EDGE) != 0) {
    417  1.2  jmcneill 			dect = 0;
    418  1.1     ryoon 		} else {
    419  1.1     ryoon 			KASSERT((irqmode & GPIO_INTR_DOUBLE_EDGE) != 0);
    420  1.1     ryoon 			dect = AMDGPIO_CONF_ACTBOTH;
    421  1.1     ryoon 		}
    422  1.1     ryoon 	}
    423  1.1     ryoon 
    424  1.1     ryoon 	val = RD4(sc, AMDGPIO_PIN_REG(pin));
    425  1.1     ryoon 	val |= dect;
    426  1.1     ryoon 	val |= AMDGPIO_CONF_INTR_MASK_EN | AMDGPIO_CONF_INTR_EN;
    427  1.1     ryoon 	WR4(sc, AMDGPIO_PIN_REG(pin), val);
    428  1.1     ryoon 
    429  1.1     ryoon 	mutex_exit(&sc->sc_lock);
    430  1.1     ryoon 
    431  1.1     ryoon 	return aih;
    432  1.1     ryoon }
    433  1.1     ryoon 
    434  1.1     ryoon static void
    435  1.1     ryoon amdgpio_intr_disestablish(void *priv, void *ih)
    436  1.1     ryoon {
    437  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    438  1.1     ryoon 	struct amdgpio_intr_handler *aih = ih;
    439  1.1     ryoon 	uint32_t val;
    440  1.1     ryoon 
    441  1.1     ryoon 	mutex_enter(&sc->sc_lock);
    442  1.1     ryoon 
    443  1.1     ryoon 	LIST_REMOVE(aih, ih_list);
    444  1.1     ryoon 
    445  1.1     ryoon 	val = RD4(sc, AMDGPIO_PIN_REG(aih->ih_pin));
    446  1.1     ryoon 	val &= ~(AMDGPIO_CONF_INTR_EN | AMDGPIO_CONF_INTR_MASK_EN);
    447  1.1     ryoon 	WR4(sc, AMDGPIO_PIN_REG(aih->ih_pin), val);
    448  1.1     ryoon 
    449  1.1     ryoon 	mutex_exit(&sc->sc_lock);
    450  1.1     ryoon 
    451  1.1     ryoon 	kmem_free(aih, sizeof(*aih));
    452  1.1     ryoon }
    453  1.1     ryoon 
    454  1.1     ryoon static bool
    455  1.1     ryoon amdgpio_intr_str(void *priv, int pin, int irqmode, char *buf, size_t buflen)
    456  1.1     ryoon {
    457  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    458  1.1     ryoon 	int rv;
    459  1.1     ryoon 
    460  1.1     ryoon 	rv = snprintf(buf, buflen, "%s pin %d", device_xname(sc->sc_dev), pin);
    461  1.1     ryoon 
    462  1.1     ryoon 	return rv < buflen;
    463  1.1     ryoon }
    464  1.1     ryoon 
    465  1.1     ryoon static void
    466  1.1     ryoon amdgpio_intr_mask(void *priv, void *ih)
    467  1.1     ryoon {
    468  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    469  1.1     ryoon 	struct amdgpio_intr_handler *aih = ih;
    470  1.1     ryoon 	uint32_t val;
    471  1.1     ryoon 
    472  1.1     ryoon 	val = RD4(sc, AMDGPIO_PIN_REG(aih->ih_pin));
    473  1.1     ryoon 	val &= ~AMDGPIO_CONF_INTR_MASK_EN;
    474  1.1     ryoon 	WR4(sc, AMDGPIO_PIN_REG(aih->ih_pin), val);
    475  1.1     ryoon }
    476  1.1     ryoon 
    477  1.1     ryoon static void
    478  1.1     ryoon amdgpio_intr_unmask(void *priv, void *ih)
    479  1.1     ryoon {
    480  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    481  1.1     ryoon 	struct amdgpio_intr_handler *aih = ih;
    482  1.1     ryoon 	uint32_t val;
    483  1.1     ryoon 
    484  1.1     ryoon 	val = RD4(sc, AMDGPIO_PIN_REG(aih->ih_pin));
    485  1.1     ryoon 	val |= AMDGPIO_CONF_INTR_MASK_EN;
    486  1.1     ryoon 	WR4(sc, AMDGPIO_PIN_REG(aih->ih_pin), val);
    487  1.1     ryoon }
    488  1.1     ryoon 
    489  1.1     ryoon static int
    490  1.1     ryoon amdgpio_intr(void *priv)
    491  1.1     ryoon {
    492  1.1     ryoon 	struct amdgpio_softc * const sc = priv;
    493  1.1     ryoon 	struct amdgpio_intr_handler *aih;
    494  1.1     ryoon 	int rv = 0;
    495  1.1     ryoon 	uint64_t status;
    496  1.1     ryoon 	uint32_t val;
    497  1.1     ryoon 
    498  1.1     ryoon 	mutex_enter(&sc->sc_lock);
    499  1.1     ryoon 
    500  1.1     ryoon 	status = RD4(sc, AMDGPIO_INTR_STATUS(1));
    501  1.1     ryoon 	status <<= 32;
    502  1.1     ryoon 	status |= RD4(sc, AMDGPIO_INTR_STATUS(0));
    503  1.1     ryoon 	status &= __BITS(0, AMDGPIO_INTR_STATUS_NBITS - 1);
    504  1.1     ryoon 
    505  1.1     ryoon 	if (status == 0) {
    506  1.1     ryoon 		rv = 1;
    507  1.1     ryoon 		goto out;
    508  1.1     ryoon 	}
    509  1.1     ryoon 
    510  1.1     ryoon 	LIST_FOREACH(aih, &sc->sc_intrs, ih_list) {
    511  1.1     ryoon 		const int pin = aih->ih_pin;
    512  1.1     ryoon 
    513  1.1     ryoon 		if ((status & __BIT(pin / 4)) == 0) {
    514  1.1     ryoon 			continue;
    515  1.1     ryoon 		}
    516  1.1     ryoon 
    517  1.1     ryoon 		val = RD4(sc, AMDGPIO_PIN_REG(pin));
    518  1.1     ryoon 		if ((val & AMDGPIO_CONF_INTR_STATUS) != 0) {
    519  1.1     ryoon 			rv |= aih->ih_func(aih->ih_arg);
    520  1.1     ryoon 
    521  1.3  riastrad 			val &= ~(AMDGPIO_CONF_INTR_MASK_EN |
    522  1.3  riastrad 			    AMDGPIO_CONF_INTR_EN);
    523  1.1     ryoon 			WR4(sc, AMDGPIO_PIN_REG(pin), val);
    524  1.1     ryoon 		}
    525  1.1     ryoon 	}
    526  1.1     ryoon 
    527  1.1     ryoon 	/* Signal end of interrupt */
    528  1.1     ryoon 	val = RD4(sc, AMDGPIO_INTR_MASTER);
    529  1.1     ryoon 	val |= AMDGPIO_INTR_MASTER_EIO;
    530  1.1     ryoon 	WR4(sc, AMDGPIO_INTR_MASTER, val);
    531  1.1     ryoon 
    532  1.1     ryoon out:
    533  1.1     ryoon 	mutex_exit(&sc->sc_lock);
    534  1.1     ryoon 
    535  1.1     ryoon 	return rv;
    536  1.1     ryoon }
    537