321 lines
8.4 KiB
C
321 lines
8.4 KiB
C
/*
|
|
* Copyright (c) 2018-2019, NXP
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT nxp_imx_gpio
|
|
|
|
#include <errno.h>
|
|
#include <zephyr/device.h>
|
|
#include <zephyr/drivers/gpio.h>
|
|
#include <zephyr/irq.h>
|
|
#include <soc.h>
|
|
#include <zephyr/sys/util.h>
|
|
#include <gpio_imx.h>
|
|
#include <string.h>
|
|
#include <zephyr/drivers/pinctrl.h>
|
|
|
|
#include <zephyr/drivers/gpio/gpio_utils.h>
|
|
|
|
struct imx_gpio_config {
|
|
/* gpio_driver_config needs to be first */
|
|
struct gpio_driver_config common;
|
|
GPIO_Type *base;
|
|
const struct pinctrl_soc_pinmux *pin_muxes;
|
|
uint8_t mux_count;
|
|
};
|
|
|
|
struct imx_gpio_data {
|
|
/* gpio_driver_data needs to be first */
|
|
struct gpio_driver_data common;
|
|
/* port ISR callback routine address */
|
|
sys_slist_t callbacks;
|
|
};
|
|
|
|
static int imx_gpio_configure(const struct device *port, gpio_pin_t pin,
|
|
gpio_flags_t flags)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
GPIO_Type *base = config->base;
|
|
|
|
if (((flags & GPIO_INPUT) != 0U) && ((flags & GPIO_OUTPUT) != 0U)) {
|
|
return -ENOTSUP;
|
|
}
|
|
__ASSERT_NO_MSG(pin < config->mux_count);
|
|
|
|
struct pinctrl_soc_pin pin_cfg;
|
|
/* Set appropriate bits in pin configuration register */
|
|
volatile uint32_t *gpio_cfg_reg =
|
|
(volatile uint32_t *)config->pin_muxes[pin].config_register;
|
|
uint32_t reg = *gpio_cfg_reg;
|
|
|
|
#ifdef MCUX_IMX_DRIVE_OPEN_DRAIN_SHIFT
|
|
if ((flags & GPIO_SINGLE_ENDED) != 0) {
|
|
/* Set ODE bit */
|
|
reg |= BIT(MCUX_IMX_DRIVE_OPEN_DRAIN_SHIFT);
|
|
} else {
|
|
reg &= ~BIT(MCUX_IMX_DRIVE_OPEN_DRAIN_SHIFT);
|
|
}
|
|
#else
|
|
if ((flags & GPIO_SINGLE_ENDED) != 0) {
|
|
return -ENOTSUP;
|
|
}
|
|
#endif
|
|
if (((flags & GPIO_PULL_UP) != 0) || ((flags & GPIO_PULL_DOWN) != 0)) {
|
|
reg |= BIT(MCUX_IMX_PULL_ENABLE_SHIFT);
|
|
#ifdef CONFIG_SOC_MCIMX6X_M4
|
|
reg |= BIT(MCUX_IMX_BIAS_BUS_HOLD_SHIFT);
|
|
#endif
|
|
if (((flags & GPIO_PULL_UP) != 0)) {
|
|
reg |= BIT(MCUX_IMX_BIAS_PULL_UP_SHIFT);
|
|
} else {
|
|
reg &= ~BIT(MCUX_IMX_BIAS_PULL_UP_SHIFT);
|
|
}
|
|
} else {
|
|
/* Set pin to highz */
|
|
reg &= ~BIT(MCUX_IMX_PULL_ENABLE_SHIFT);
|
|
#ifdef CONFIG_SOC_MCIMX6X_M4
|
|
reg &= ~BIT(MCUX_IMX_BIAS_BUS_HOLD_SHIFT);
|
|
#endif
|
|
}
|
|
|
|
/* Init pin configuration struct, and use pinctrl api to apply settings */
|
|
__ASSERT_NO_MSG(pin < config->mux_count);
|
|
|
|
memcpy(&pin_cfg.pinmux, &config->pin_muxes[pin], sizeof(pin_cfg.pinmux));
|
|
|
|
unsigned int key = irq_lock();
|
|
|
|
/* cfg register will be set by pinctrl_configure_pins */
|
|
pin_cfg.pin_ctrl_flags = reg;
|
|
pinctrl_configure_pins(&pin_cfg, 1, PINCTRL_REG_NONE);
|
|
|
|
/* Disable interrupts for pin */
|
|
GPIO_SetPinIntMode(base, pin, false);
|
|
GPIO_SetIntEdgeSelect(base, pin, false);
|
|
|
|
if ((flags & GPIO_OUTPUT) != 0U) {
|
|
/* Set output pin initial value */
|
|
if ((flags & GPIO_OUTPUT_INIT_LOW) != 0U) {
|
|
GPIO_WritePinOutput(base, pin, gpioPinClear);
|
|
} else if ((flags & GPIO_OUTPUT_INIT_HIGH) != 0U) {
|
|
GPIO_WritePinOutput(base, pin, gpioPinSet);
|
|
}
|
|
|
|
/* Set pin as output */
|
|
WRITE_BIT(base->GDIR, pin, 1U);
|
|
} else {
|
|
/* Set pin as input */
|
|
WRITE_BIT(base->GDIR, pin, 0U);
|
|
}
|
|
|
|
irq_unlock(key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_port_get_raw(const struct device *port, uint32_t *value)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
GPIO_Type *base = config->base;
|
|
|
|
*value = GPIO_ReadPortInput(base);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_port_set_masked_raw(const struct device *port,
|
|
gpio_port_pins_t mask,
|
|
gpio_port_value_t value)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
GPIO_Type *base = config->base;
|
|
|
|
unsigned int key = irq_lock();
|
|
GPIO_WritePortOutput(base,
|
|
(GPIO_ReadPortInput(base) & ~mask) | (value & mask));
|
|
irq_unlock(key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_port_set_bits_raw(const struct device *port,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
GPIO_Type *base = config->base;
|
|
|
|
unsigned int key = irq_lock();
|
|
GPIO_WritePortOutput(base, GPIO_ReadPortInput(base) | pins);
|
|
irq_unlock(key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_port_clear_bits_raw(const struct device *port,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
GPIO_Type *base = config->base;
|
|
|
|
unsigned int key = irq_lock();
|
|
GPIO_WritePortOutput(base, GPIO_ReadPortInput(base) & ~pins);
|
|
irq_unlock(key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_port_toggle_bits(const struct device *port,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
GPIO_Type *base = config->base;
|
|
|
|
unsigned int key = irq_lock();
|
|
GPIO_WritePortOutput(base, GPIO_ReadPortInput(base) ^ pins);
|
|
irq_unlock(key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_pin_interrupt_configure(const struct device *port,
|
|
gpio_pin_t pin,
|
|
enum gpio_int_mode mode,
|
|
enum gpio_int_trig trig)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
GPIO_Type *base = config->base;
|
|
volatile uint32_t *icr_reg;
|
|
unsigned int key;
|
|
uint32_t icr_val;
|
|
uint8_t shift;
|
|
|
|
if (((base->GDIR & BIT(pin)) != 0U)
|
|
&& (mode != GPIO_INT_MODE_DISABLED)) {
|
|
/* Interrupt on output pin not supported */
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
if ((mode == GPIO_INT_MODE_EDGE) && (trig == GPIO_INT_TRIG_LOW)) {
|
|
icr_val = 3U;
|
|
} else if ((mode == GPIO_INT_MODE_EDGE) &&
|
|
(trig == GPIO_INT_TRIG_HIGH)) {
|
|
icr_val = 2U;
|
|
} else if ((mode == GPIO_INT_MODE_LEVEL) &&
|
|
(trig == GPIO_INT_TRIG_HIGH)) {
|
|
icr_val = 1U;
|
|
} else {
|
|
icr_val = 0U;
|
|
}
|
|
|
|
if (pin < 16U) {
|
|
shift = 2U * pin;
|
|
icr_reg = &(base->ICR1);
|
|
} else if (pin < 32U) {
|
|
shift = 2U * (pin - 16U);
|
|
icr_reg = &(base->ICR2);
|
|
} else {
|
|
return -EINVAL;
|
|
}
|
|
|
|
key = irq_lock();
|
|
|
|
*icr_reg = (*icr_reg & ~(3U << shift)) | (icr_val << shift);
|
|
|
|
WRITE_BIT(base->EDGE_SEL, pin, trig == GPIO_INT_TRIG_BOTH);
|
|
WRITE_BIT(base->ISR, pin, mode != GPIO_INT_MODE_DISABLED);
|
|
WRITE_BIT(base->IMR, pin, mode != GPIO_INT_MODE_DISABLED);
|
|
|
|
irq_unlock(key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_gpio_manage_callback(const struct device *port,
|
|
struct gpio_callback *cb, bool set)
|
|
{
|
|
struct imx_gpio_data *data = port->data;
|
|
|
|
return gpio_manage_callback(&data->callbacks, cb, set);
|
|
}
|
|
|
|
static void imx_gpio_port_isr(const struct device *port)
|
|
{
|
|
const struct imx_gpio_config *config = port->config;
|
|
struct imx_gpio_data *data = port->data;
|
|
uint32_t int_status;
|
|
|
|
int_status = config->base->ISR & config->base->IMR;
|
|
|
|
config->base->ISR = int_status;
|
|
|
|
gpio_fire_callbacks(&data->callbacks, port, int_status);
|
|
}
|
|
|
|
static const struct gpio_driver_api imx_gpio_driver_api = {
|
|
.pin_configure = imx_gpio_configure,
|
|
.port_get_raw = imx_gpio_port_get_raw,
|
|
.port_set_masked_raw = imx_gpio_port_set_masked_raw,
|
|
.port_set_bits_raw = imx_gpio_port_set_bits_raw,
|
|
.port_clear_bits_raw = imx_gpio_port_clear_bits_raw,
|
|
.port_toggle_bits = imx_gpio_port_toggle_bits,
|
|
.pin_interrupt_configure = imx_gpio_pin_interrupt_configure,
|
|
.manage_callback = imx_gpio_manage_callback,
|
|
};
|
|
|
|
/* These macros will declare an array of pinctrl_soc_pinmux types */
|
|
#define PINMUX_INIT(node, prop, idx) MCUX_IMX_PINMUX(DT_PROP_BY_IDX(node, prop, idx)),
|
|
#define IMX_IGPIO_PIN_DECLARE(n) \
|
|
const struct pinctrl_soc_pinmux mcux_igpio_pinmux_##n[] = { \
|
|
DT_INST_FOREACH_PROP_ELEM(n, pinmux, PINMUX_INIT) \
|
|
};
|
|
#define IMX_IGPIO_PIN_INIT(n) \
|
|
.pin_muxes = mcux_igpio_pinmux_##n, \
|
|
.mux_count = DT_INST_PROP_LEN(n, pinmux),
|
|
|
|
#define GPIO_IMX_INIT(n) \
|
|
IMX_IGPIO_PIN_DECLARE(n) \
|
|
static int imx_gpio_##n##_init(const struct device *port); \
|
|
\
|
|
static const struct imx_gpio_config imx_gpio_##n##_config = { \
|
|
.common = { \
|
|
.port_pin_mask = \
|
|
GPIO_PORT_PIN_MASK_FROM_DT_INST(n), \
|
|
}, \
|
|
.base = (GPIO_Type *)DT_INST_REG_ADDR(n), \
|
|
IMX_IGPIO_PIN_INIT(n) \
|
|
}; \
|
|
\
|
|
static struct imx_gpio_data imx_gpio_##n##_data; \
|
|
\
|
|
DEVICE_DT_INST_DEFINE(n, \
|
|
imx_gpio_##n##_init, \
|
|
NULL, \
|
|
&imx_gpio_##n##_data, \
|
|
&imx_gpio_##n##_config, \
|
|
PRE_KERNEL_1, \
|
|
CONFIG_GPIO_INIT_PRIORITY, \
|
|
&imx_gpio_driver_api); \
|
|
\
|
|
static int imx_gpio_##n##_init(const struct device *port) \
|
|
{ \
|
|
IRQ_CONNECT(DT_INST_IRQ_BY_IDX(n, 0, irq), \
|
|
DT_INST_IRQ_BY_IDX(n, 0, priority), \
|
|
imx_gpio_port_isr, \
|
|
DEVICE_DT_INST_GET(n), 0); \
|
|
\
|
|
irq_enable(DT_INST_IRQ_BY_IDX(n, 0, irq)); \
|
|
\
|
|
IRQ_CONNECT(DT_INST_IRQ_BY_IDX(n, 1, irq), \
|
|
DT_INST_IRQ_BY_IDX(n, 1, priority), \
|
|
imx_gpio_port_isr, \
|
|
DEVICE_DT_INST_GET(n), 0); \
|
|
\
|
|
irq_enable(DT_INST_IRQ_BY_IDX(n, 1, irq)); \
|
|
\
|
|
return 0; \
|
|
}
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(GPIO_IMX_INIT)
|