freebsd-dev/sys/dev/amdgpio/amdgpio.c
Andriy Gapon ed3f0b8a21 amdgpio: small formatting cleanup
MFC after:	2 weeks
2019-05-24 06:07:33 +00:00

479 lines
10 KiB
C

/*-
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
*
* 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);
*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;
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 ((sc->sc_gpio_pins[pin].gp_flags & GPIO_PIN_OUTPUT) != 0) {
if (val & BIT(OUTPUT_VALUE_OFF))
*value = GPIO_PIN_HIGH;
else
*value = GPIO_PIN_LOW;
} else {
if (val & BIT(PIN_STS_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 };
int rv;
if (acpi_disabled("gpio"))
return (ENXIO);
rv = ACPI_ID_PROBE(device_get_parent(dev), dev, gpio_ids, NULL);
if (rv <= 0)
device_set_desc(dev, "AMD GPIO Controller");
return (rv);
}
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);
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", 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",
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);