#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/rman.h>
#include <sys/lock.h>
#include <sys/malloc.h>
#include <sys/mutex.h>
#include <sys/gpio.h>
#include <machine/bus.h>
#include <machine/resource.h>
#include <dev/gpio/gpiobusvar.h>
#include <dev/fdt/fdt_common.h>
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include <dev/fdt/fdt_pinctrl.h>
#include "qcom_tlmm_var.h"
#include "qcom_tlmm_ipq4018_reg.h"
#include "qcom_tlmm_ipq4018_hw.h"
#include "gpio_if.h"
int
qcom_tlmm_ipq4018_hw_pin_set_function(struct qcom_tlmm_softc *sc,
int pin, int function)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg &= ~(QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_MUX_MASK
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_MUX_SHIFT);
reg |= (function & QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_MUX_MASK)
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_MUX_SHIFT;
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_function(struct qcom_tlmm_softc *sc,
int pin, int *function)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg = reg >> QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_MUX_SHIFT;
reg &= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_MUX_MASK;
*function = reg;
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_set_oe_output(struct qcom_tlmm_softc *sc,
int pin)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg |= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_OE_ENABLE;
GPIO_WRITE(sc,
QCOM_TLMM_IPQ4018_REG_PIN(pin, QCOM_TLMM_IPQ4018_REG_PIN_CONTROL),
reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_set_oe_input(struct qcom_tlmm_softc *sc,
int pin)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg &= ~QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_OE_ENABLE;
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_oe_state(struct qcom_tlmm_softc *sc,
int pin, bool *is_output)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
*is_output = !! (reg & QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_OE_ENABLE);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_set_output_value(struct qcom_tlmm_softc *sc,
uint32_t pin, unsigned int value)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_IO));
if (value)
reg |= QCOM_TLMM_IPQ4018_REG_PIN_IO_OUTPUT_EN;
else
reg &= ~QCOM_TLMM_IPQ4018_REG_PIN_IO_OUTPUT_EN;
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_IO), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_output_value(struct qcom_tlmm_softc *sc,
uint32_t pin, unsigned int *val)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_IO));
*val = !! (reg & QCOM_TLMM_IPQ4018_REG_PIN_IO_INPUT_STATUS);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_input_value(struct qcom_tlmm_softc *sc,
uint32_t pin, unsigned int *val)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_IO));
*val = !! (reg & QCOM_TLMM_IPQ4018_REG_PIN_IO_INPUT_STATUS);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_toggle_output_value(
struct qcom_tlmm_softc *sc, uint32_t pin)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_IO));
if ((reg & QCOM_TLMM_IPQ4018_REG_PIN_IO_OUTPUT_EN) == 0)
reg |= QCOM_TLMM_IPQ4018_REG_PIN_IO_OUTPUT_EN;
else
reg &= ~QCOM_TLMM_IPQ4018_REG_PIN_IO_OUTPUT_EN;
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_IO), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_set_pupd_config(
struct qcom_tlmm_softc *sc, uint32_t pin,
qcom_tlmm_pin_pupd_config_t pupd)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg &= ~(QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_MASK
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_SHIFT);
switch (pupd) {
case QCOM_TLMM_PIN_PUPD_CONFIG_DISABLE:
reg |= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_DISABLE
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_SHIFT;
break;
case QCOM_TLMM_PIN_PUPD_CONFIG_PULL_DOWN:
reg |= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_PULLDOWN
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_SHIFT;
break;
case QCOM_TLMM_PIN_PUPD_CONFIG_PULL_UP:
reg |= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_PULLUP
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_SHIFT;
break;
case QCOM_TLMM_PIN_PUPD_CONFIG_BUS_HOLD:
reg |= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_BUSHOLD
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_SHIFT;
break;
}
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_pupd_config(
struct qcom_tlmm_softc *sc, uint32_t pin,
qcom_tlmm_pin_pupd_config_t *pupd)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg >>= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_SHIFT;
reg &= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_MASK;
switch (reg) {
case QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_DISABLE:
*pupd = QCOM_TLMM_PIN_PUPD_CONFIG_DISABLE;
break;
case QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_PULLDOWN:
*pupd = QCOM_TLMM_PIN_PUPD_CONFIG_PULL_DOWN;
break;
case QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_PUPD_PULLUP:
*pupd = QCOM_TLMM_PIN_PUPD_CONFIG_PULL_UP;
break;
default:
*pupd = QCOM_TLMM_PIN_PUPD_CONFIG_DISABLE;
break;
}
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_set_drive_strength(
struct qcom_tlmm_softc *sc, uint32_t pin, uint8_t drv)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
if (drv > 16 || drv < 2)
return (EINVAL);
drv = (drv / 2) - 1;
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg &= ~(QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_DRIVE_STRENGTH_SHIFT
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_DRIVE_STRENGTH_MASK);
reg |= (drv & QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_DRIVE_STRENGTH_MASK)
<< QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_DRIVE_STRENGTH_SHIFT;
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_drive_strength(
struct qcom_tlmm_softc *sc, uint32_t pin, uint8_t *drv)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
*drv = (reg >> QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_DRIVE_STRENGTH_SHIFT)
& QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_DRIVE_STRENGTH_MASK;
*drv = (*drv + 1) * 2;
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_set_vm(
struct qcom_tlmm_softc *sc, uint32_t pin, bool enable)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg &= ~QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_VM_ENABLE;
if (enable)
reg |= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_VM_ENABLE;
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_vm(
struct qcom_tlmm_softc *sc, uint32_t pin, bool *enable)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
*enable = !! (reg & QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_VM_ENABLE);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_set_open_drain(
struct qcom_tlmm_softc *sc, uint32_t pin, bool enable)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
reg &= ~QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_OD_ENABLE;
if (enable)
reg |= QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_OD_ENABLE;
GPIO_WRITE(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL), reg);
return (0);
}
int
qcom_tlmm_ipq4018_hw_pin_get_open_drain(
struct qcom_tlmm_softc *sc, uint32_t pin, bool *enable)
{
uint32_t reg;
GPIO_LOCK_ASSERT(sc);
if (pin >= sc->gpio_npins)
return (EINVAL);
reg = GPIO_READ(sc, QCOM_TLMM_IPQ4018_REG_PIN(pin,
QCOM_TLMM_IPQ4018_REG_PIN_CONTROL));
*enable = !! (reg & QCOM_TLMM_IPQ4018_REG_PIN_CONTROL_OD_ENABLE);
return (0);
}