Changeset View
Changeset View
Standalone View
Standalone View
sys/dev/amdgpio/amdgpio.c
| /*- | |||||
| * Copyright (c) 2018 Advanced Micro Devices | |||||
| * All rights reserved. | |||||
| * | |||||
| * Redistribution and use in source and binary forms, with or without | |||||
| * modification, are permitted provided that the following conditions | |||||
| * are met: | |||||
| * 1. Redistributions of source code must retain the above copyright | |||||
| * notice, this list of conditions and the following disclaimer. | |||||
| * 2. Redistributions in binary form must reproduce the above copyright | |||||
| * notice, this list of conditions and the following disclaimer in the | |||||
| * documentation and/or other materials provided with the distribution. | |||||
| * | |||||
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND | |||||
| * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |||||
| * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |||||
| * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE | |||||
| * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL | |||||
| * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS | |||||
| * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) | |||||
| * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT | |||||
| * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY | |||||
| * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF | |||||
| * SUCH DAMAGE. | |||||
| */ | |||||
| #include <sys/cdefs.h> | |||||
| __FBSDID("$FreeBSD$"); | |||||
| #include "opt_acpi.h" | |||||
| #include <sys/param.h> | |||||
| #include <sys/systm.h> | |||||
| #include <sys/bus.h> | |||||
| #include <sys/gpio.h> | |||||
| #include <sys/interrupt.h> | |||||
| #include <sys/kernel.h> | |||||
| #include <sys/lock.h> | |||||
| #include <sys/module.h> | |||||
| #include <sys/mutex.h> | |||||
| #include <sys/proc.h> | |||||
| #include <sys/rman.h> | |||||
| #include <sys/sysctl.h> | |||||
| #include <machine/bus.h> | |||||
| #include <machine/resource.h> | |||||
| #include <contrib/dev/acpica/include/acpi.h> | |||||
| #include <contrib/dev/acpica/include/accommon.h> | |||||
| #include <dev/acpica/acpivar.h> | |||||
| #include <dev/gpio/gpiobusvar.h> | |||||
| #include "gpio_if.h" | |||||
| #include "amdgpio.h" | |||||
| static struct resource_spec amdgpio_spec[] = { | |||||
| { SYS_RES_MEMORY, 0, RF_ACTIVE }, | |||||
| { -1, 0, 0 } | |||||
| }; | |||||
| static inline uint32_t | |||||
| amdgpio_read_4(struct amdgpio_softc *sc, bus_size_t off) | |||||
| { | |||||
| return (bus_read_4(sc->sc_res[0], off)); | |||||
| } | |||||
| static inline void | |||||
| amdgpio_write_4(struct amdgpio_softc *sc, bus_size_t off, | |||||
| uint32_t val) | |||||
| { | |||||
| bus_write_4(sc->sc_res[0], off, val); | |||||
| } | |||||
| static bool | |||||
| amdgpio_is_pin_output(struct amdgpio_softc *sc, uint32_t pin) | |||||
| { | |||||
| uint32_t reg, val; | |||||
| bool ret; | |||||
| /* Get the current pin state */ | |||||
| AMDGPIO_LOCK(sc); | |||||
| reg = AMDGPIO_PIN_REGISTER(pin); | |||||
| val = amdgpio_read_4(sc, reg); | |||||
| if (val & BIT(OUTPUT_ENABLE_OFF)) | |||||
| ret = true; | |||||
| else | |||||
| ret = false; | |||||
| AMDGPIO_UNLOCK(sc); | |||||
| return (ret); | |||||
| } | |||||
| static device_t | |||||
| amdgpio_get_bus(device_t dev) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| sc = device_get_softc(dev); | |||||
| dprintf("busdev %p\n", sc->sc_busdev); | |||||
| return (sc->sc_busdev); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_max(device_t dev, int *maxpin) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| sc = device_get_softc(dev); | |||||
| *maxpin = sc->sc_npins - 1; | |||||
| dprintf("npins %d maxpin %d\n", sc->sc_npins, *maxpin); | |||||
| return (0); | |||||
| } | |||||
| static bool | |||||
| amdgpio_valid_pin(struct amdgpio_softc *sc, int pin) | |||||
| { | |||||
| dprintf("pin %d\n", pin); | |||||
| if (sc->sc_res[0] == NULL) | |||||
| return (false); | |||||
| if ((sc->sc_gpio_pins[pin].gp_pin == pin) && | |||||
| (sc->sc_gpio_pins[pin].gp_caps != 0)) | |||||
| return (true); | |||||
| return (false); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_getname(device_t dev, uint32_t pin, char *name) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| dprintf("pin %d\n", pin); | |||||
| sc = device_get_softc(dev); | |||||
| if (!amdgpio_valid_pin(sc, pin)) | |||||
| return (EINVAL); | |||||
| /* Set a very simple name */ | |||||
| snprintf(name, GPIOMAXNAME, "%s", sc->sc_gpio_pins[pin].gp_name); | |||||
| name[GPIOMAXNAME - 1] = '\0'; | |||||
| dprintf("pin %d name %s\n", pin, name); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_getcaps(device_t dev, uint32_t pin, uint32_t *caps) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| sc = device_get_softc(dev); | |||||
| dprintf("pin %d\n", pin); | |||||
| if (!amdgpio_valid_pin(sc, pin)) | |||||
| return (EINVAL); | |||||
gonzo: This line is redundant. The value is overwritten by the next line. | |||||
| *caps = sc->sc_gpio_pins[pin].gp_caps; | |||||
| dprintf("pin %d caps 0x%x\n", pin, *caps); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_getflags(device_t dev, uint32_t pin, uint32_t *flags) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| sc = device_get_softc(dev); | |||||
| dprintf("pin %d\n", pin); | |||||
| if (!amdgpio_valid_pin(sc, pin)) | |||||
| return (EINVAL); | |||||
| AMDGPIO_LOCK(sc); | |||||
| *flags = sc->sc_gpio_pins[pin].gp_flags; | |||||
Done Inline ActionsThis one is also redundant. gonzo: This one is also redundant. | |||||
| dprintf("pin %d flags 0x%x\n", pin, *flags); | |||||
| AMDGPIO_UNLOCK(sc); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_setflags(device_t dev, uint32_t pin, uint32_t flags) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| uint32_t reg, val, allowed; | |||||
| sc = device_get_softc(dev); | |||||
| dprintf("pin %d flags 0x%x\n", pin, flags); | |||||
| if (!amdgpio_valid_pin(sc, pin)) | |||||
| return (EINVAL); | |||||
| allowed = GPIO_PIN_INPUT | GPIO_PIN_OUTPUT; | |||||
| /* | |||||
| * Only directtion flag allowed | |||||
| */ | |||||
| if (flags & ~allowed) | |||||
| return (EINVAL); | |||||
| /* | |||||
| * Not both directions simultaneously | |||||
| */ | |||||
| if ((flags & allowed) == allowed) | |||||
| return (EINVAL); | |||||
| /* Set the GPIO mode and state */ | |||||
| AMDGPIO_LOCK(sc); | |||||
| reg = AMDGPIO_PIN_REGISTER(pin); | |||||
| val = amdgpio_read_4(sc, reg); | |||||
| if (flags & GPIO_PIN_INPUT) { | |||||
| val &= ~BIT(OUTPUT_ENABLE_OFF); | |||||
| sc->sc_gpio_pins[pin].gp_flags = GPIO_PIN_INPUT; | |||||
| } else { | |||||
| val |= BIT(OUTPUT_ENABLE_OFF); | |||||
| sc->sc_gpio_pins[pin].gp_flags = GPIO_PIN_OUTPUT; | |||||
| } | |||||
| amdgpio_write_4(sc, reg, val); | |||||
| dprintf("pin %d flags 0x%x val 0x%x gp_flags 0x%x\n", | |||||
| pin, flags, val, sc->sc_gpio_pins[pin].gp_flags); | |||||
| AMDGPIO_UNLOCK(sc); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_get(device_t dev, uint32_t pin, unsigned int *value) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| uint32_t reg, val; | |||||
| sc = device_get_softc(dev); | |||||
| dprintf("pin %d\n", pin); | |||||
| if (!amdgpio_valid_pin(sc, pin)) | |||||
| return (EINVAL); | |||||
| *value = 0; | |||||
| AMDGPIO_LOCK(sc); | |||||
| reg = AMDGPIO_PIN_REGISTER(pin); | |||||
| val = amdgpio_read_4(sc, reg); | |||||
| if (val & BIT(OUTPUT_VALUE_OFF)) | |||||
| *value = GPIO_PIN_HIGH; | |||||
| else | |||||
| *value = GPIO_PIN_LOW; | |||||
| dprintf("pin %d value 0x%x\n", pin, *value); | |||||
| AMDGPIO_UNLOCK(sc); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_set(device_t dev, uint32_t pin, unsigned int value) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| uint32_t reg, val; | |||||
| sc = device_get_softc(dev); | |||||
| dprintf("pin %d value 0x%x\n", pin, value); | |||||
| if (!amdgpio_valid_pin(sc, pin)) | |||||
| return (EINVAL); | |||||
| if (!amdgpio_is_pin_output(sc, pin)) | |||||
| return (EINVAL); | |||||
| AMDGPIO_LOCK(sc); | |||||
| reg = AMDGPIO_PIN_REGISTER(pin); | |||||
| val = amdgpio_read_4(sc, reg); | |||||
| if (value == GPIO_PIN_LOW) | |||||
| val &= ~BIT(OUTPUT_VALUE_OFF); | |||||
| else | |||||
| val |= BIT(OUTPUT_VALUE_OFF); | |||||
| amdgpio_write_4(sc, reg, val); | |||||
| dprintf("pin %d value 0x%x val 0x%x\n", pin, value, val); | |||||
| AMDGPIO_UNLOCK(sc); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_pin_toggle(device_t dev, uint32_t pin) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| uint32_t reg, val; | |||||
| sc = device_get_softc(dev); | |||||
| dprintf("pin %d\n", pin); | |||||
| if (!amdgpio_valid_pin(sc, pin)) | |||||
| return (EINVAL); | |||||
| if (!amdgpio_is_pin_output(sc, pin)) | |||||
| return (EINVAL); | |||||
| /* Toggle the pin */ | |||||
| AMDGPIO_LOCK(sc); | |||||
| reg = AMDGPIO_PIN_REGISTER(pin); | |||||
| val = amdgpio_read_4(sc, reg); | |||||
| dprintf("pin %d value before 0x%x\n", pin, val); | |||||
| val = val ^ BIT(OUTPUT_VALUE_OFF); | |||||
| dprintf("pin %d value after 0x%x\n", pin, val); | |||||
| amdgpio_write_4(sc, reg, val); | |||||
| AMDGPIO_UNLOCK(sc); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_probe(device_t dev) | |||||
| { | |||||
| static char *gpio_ids[] = { "AMD0030", "AMDI0030", NULL }; | |||||
| if (acpi_disabled("gpio") || | |||||
| ACPI_ID_PROBE(device_get_parent(dev), dev, gpio_ids) == NULL) | |||||
| return (ENXIO); | |||||
| device_set_desc(dev, "AMD GPIO Controller"); | |||||
| return (0); | |||||
| } | |||||
| static int | |||||
| amdgpio_attach(device_t dev) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| int i, pin, bank; | |||||
| sc = device_get_softc(dev); | |||||
| sc->sc_dev = dev; | |||||
| sc->sc_handle = acpi_get_handle(dev); | |||||
Not Done Inline Actionssc_bank_prefix is assigned but never used. I think since there is just one bank it's better to remove this field altogether. gonzo: sc_bank_prefix is assigned but never used. I think since there is just one bank it's better to… | |||||
Done Inline ActionsThis driver has 4 banks (please see sc_nbanks above). There is some plan to implement a "show" routine later for this driver, which shows the pin details bank wise. That's why I have the definitions for sc_banks and sc_bank_prefix. But, if you insist this being removed for now (since it's not used now), I will remove it. We need to implement functions to configure gpio pins as interrupt line. For that, we need the INTRNG framework support for amd64 platforms. Since, it's not available now, we haven't done it now. Once this is implemented, we will have the "show" routine as well. rajeshasp: This driver has 4 banks (please see sc_nbanks above). There is some plan to implement a "show"… | |||||
| AMDGPIO_LOCK_INIT(sc); | |||||
| sc->sc_nbanks = AMD_GPIO_NUM_PIN_BANK; | |||||
| sc->sc_npins = AMD_GPIO_PINS_MAX; | |||||
| sc->sc_bank_prefix = AMD_GPIO_PREFIX; | |||||
| sc->sc_pin_info = kernzp_pins; | |||||
| sc->sc_ngroups = nitems(kernzp_groups); | |||||
| sc->sc_groups = kernzp_groups; | |||||
| if (bus_alloc_resources(dev, amdgpio_spec, sc->sc_res)) { | |||||
| device_printf(dev, "could not allocate resources\n"); | |||||
| goto err_rsrc; | |||||
| } | |||||
| sc->sc_bst = rman_get_bustag(sc->sc_res[0]); | |||||
| sc->sc_bsh = rman_get_bushandle(sc->sc_res[0]); | |||||
| /* Initialize all possible pins to be Invalid */ | |||||
| for (i = 0; i < AMD_GPIO_PINS_MAX ; i++) { | |||||
| snprintf(sc->sc_gpio_pins[i].gp_name, GPIOMAXNAME, | |||||
| "Unexposed PIN %d\n", i); | |||||
| sc->sc_gpio_pins[i].gp_pin = -1; | |||||
| sc->sc_gpio_pins[i].gp_caps = 0; | |||||
| sc->sc_gpio_pins[i].gp_flags = 0; | |||||
| } | |||||
| /* Initialize only driver exposed pins with appropriate capabilities */ | |||||
| for (i = 0; i < AMD_GPIO_PINS_EXPOSED ; i++) { | |||||
| pin = kernzp_pins[i].pin_num; | |||||
| bank = pin/AMD_GPIO_PINS_PER_BANK; | |||||
| snprintf(sc->sc_gpio_pins[pin].gp_name, GPIOMAXNAME, "%s%d_%s\n", | |||||
| AMD_GPIO_PREFIX, bank, kernzp_pins[i].pin_name); | |||||
| sc->sc_gpio_pins[pin].gp_pin = pin; | |||||
| sc->sc_gpio_pins[pin].gp_caps = AMDGPIO_DEFAULT_CAPS; | |||||
| sc->sc_gpio_pins[pin].gp_flags = (amdgpio_is_pin_output(sc, pin)? | |||||
| GPIO_PIN_OUTPUT : GPIO_PIN_INPUT); | |||||
| } | |||||
| sc->sc_busdev = gpiobus_attach_bus(dev); | |||||
| if (sc->sc_busdev == NULL) { | |||||
| device_printf(dev, "could not attach gpiobus\n"); | |||||
| goto err_bus; | |||||
| } | |||||
| return (0); | |||||
| err_bus: | |||||
| bus_release_resources(dev, amdgpio_spec, sc->sc_res); | |||||
| err_rsrc: | |||||
| AMDGPIO_LOCK_DESTROY(sc); | |||||
| return (ENXIO); | |||||
| } | |||||
| static int | |||||
| amdgpio_detach(device_t dev) | |||||
| { | |||||
| struct amdgpio_softc *sc; | |||||
| sc = device_get_softc(dev); | |||||
| if (sc->sc_busdev) | |||||
| gpiobus_detach_bus(dev); | |||||
| bus_release_resources(dev, amdgpio_spec, sc->sc_res); | |||||
| AMDGPIO_LOCK_DESTROY(sc); | |||||
| return (0); | |||||
| } | |||||
| static device_method_t amdgpio_methods[] = { | |||||
| /* Device interface */ | |||||
| DEVMETHOD(device_probe, amdgpio_probe), | |||||
| DEVMETHOD(device_attach, amdgpio_attach), | |||||
| DEVMETHOD(device_detach, amdgpio_detach), | |||||
| /* GPIO protocol */ | |||||
| DEVMETHOD(gpio_get_bus, amdgpio_get_bus), | |||||
| DEVMETHOD(gpio_pin_max, amdgpio_pin_max), | |||||
| DEVMETHOD(gpio_pin_getname, amdgpio_pin_getname), | |||||
| DEVMETHOD(gpio_pin_getcaps, amdgpio_pin_getcaps), | |||||
| DEVMETHOD(gpio_pin_getflags, amdgpio_pin_getflags), | |||||
| DEVMETHOD(gpio_pin_setflags, amdgpio_pin_setflags), | |||||
| DEVMETHOD(gpio_pin_get, amdgpio_pin_get), | |||||
| DEVMETHOD(gpio_pin_set, amdgpio_pin_set), | |||||
| DEVMETHOD(gpio_pin_toggle, amdgpio_pin_toggle), | |||||
| DEVMETHOD_END | |||||
| }; | |||||
| static driver_t amdgpio_driver = { | |||||
| "gpio", | |||||
| amdgpio_methods, | |||||
| sizeof(struct amdgpio_softc), | |||||
| }; | |||||
| static devclass_t amdgpio_devclass; | |||||
| DRIVER_MODULE(amdgpio, acpi, amdgpio_driver, amdgpio_devclass, 0, 0); | |||||
| MODULE_DEPEND(amdgpio, acpi, 1, 1, 1); | |||||
| MODULE_DEPEND(amdgpio, gpiobus, 1, 1, 1); | |||||
| MODULE_VERSION(amdgpio, 1); | |||||
This line is redundant. The value is overwritten by the next line.