320 lines
8.5 KiB
C
320 lines
8.5 KiB
C
/*
|
|
* Copyright (c) 2020 IoT.bzh
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT renesas_rcar_gpio
|
|
|
|
#include <errno.h>
|
|
|
|
#include <kernel.h>
|
|
#include <device.h>
|
|
#include <init.h>
|
|
#include <drivers/gpio.h>
|
|
#include <drivers/clock_control.h>
|
|
#include <drivers/clock_control/rcar_clock_control.h>
|
|
|
|
#include "gpio_utils.h"
|
|
|
|
typedef void (*init_func_t)(const struct device *dev);
|
|
|
|
struct gpio_rcar_cfg {
|
|
struct gpio_driver_config common;
|
|
uint32_t reg_addr;
|
|
int reg_size;
|
|
init_func_t init_func;
|
|
const struct device *clock_dev;
|
|
struct rcar_cpg_clk mod_clk;
|
|
};
|
|
|
|
struct gpio_rcar_data {
|
|
struct gpio_driver_data common;
|
|
sys_slist_t cb;
|
|
};
|
|
|
|
#define IOINTSEL 0x00 /* General IO/Interrupt Switching Register */
|
|
#define INOUTSEL 0x04 /* General Input/Output Switching Register */
|
|
#define OUTDT 0x08 /* General Output Register */
|
|
#define INDT 0x0c /* General Input Register */
|
|
#define INTDT 0x10 /* Interrupt Display Register */
|
|
#define INTCLR 0x14 /* Interrupt Clear Register */
|
|
#define INTMSK 0x18 /* Interrupt Mask Register */
|
|
#define MSKCLR 0x1c /* Interrupt Mask Clear Register */
|
|
#define POSNEG 0x20 /* Positive/Negative Logic Select Register */
|
|
#define EDGLEVEL 0x24 /* Edge/level Select Register */
|
|
#define FILONOFF 0x28 /* Chattering Prevention On/Off Register */
|
|
#define OUTDTSEL 0x40 /* Output Data Select Register */
|
|
#define BOTHEDGE 0x4c /* One Edge/Both Edge Select Register */
|
|
|
|
static inline uint32_t gpio_rcar_read(const struct gpio_rcar_cfg *config,
|
|
uint32_t offs)
|
|
{
|
|
return sys_read32(config->reg_addr + offs);
|
|
}
|
|
|
|
static inline void gpio_rcar_write(const struct gpio_rcar_cfg *config,
|
|
uint32_t offs, uint32_t value)
|
|
{
|
|
sys_write32(value, config->reg_addr + offs);
|
|
}
|
|
|
|
static void gpio_rcar_modify_bit(const struct gpio_rcar_cfg *config,
|
|
uint32_t offs, int bit, bool value)
|
|
{
|
|
uint32_t tmp = gpio_rcar_read(config, offs);
|
|
|
|
if (value) {
|
|
tmp |= BIT(bit);
|
|
} else {
|
|
tmp &= ~BIT(bit);
|
|
}
|
|
|
|
gpio_rcar_write(config, offs, tmp);
|
|
}
|
|
|
|
static void gpio_rcar_port_isr(const struct device *dev)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
struct gpio_rcar_data *data = dev->data;
|
|
uint32_t pending, fsb, mask;
|
|
|
|
pending = gpio_rcar_read(config, INTDT);
|
|
mask = gpio_rcar_read(config, INTMSK);
|
|
|
|
while ((pending = gpio_rcar_read(config, INTDT) &
|
|
gpio_rcar_read(config, INTMSK))) {
|
|
fsb = find_lsb_set(pending) - 1;
|
|
gpio_fire_callbacks(&data->cb, dev, BIT(fsb));
|
|
gpio_rcar_write(config, INTCLR, BIT(fsb));
|
|
}
|
|
}
|
|
|
|
static void gpio_rcar_config_general_input_output_mode(
|
|
const struct gpio_rcar_cfg *config,
|
|
uint32_t gpio,
|
|
bool output)
|
|
{
|
|
/* follow steps in the GPIO documentation for
|
|
* "Setting General Output Mode" and
|
|
* "Setting General Input Mode"
|
|
*/
|
|
|
|
/* Configure positive logic in POSNEG */
|
|
gpio_rcar_modify_bit(config, POSNEG, gpio, false);
|
|
|
|
/* Select "General Input/Output Mode" in IOINTSEL */
|
|
gpio_rcar_modify_bit(config, IOINTSEL, gpio, false);
|
|
|
|
/* Select Input Mode or Output Mode in INOUTSEL */
|
|
gpio_rcar_modify_bit(config, INOUTSEL, gpio, output);
|
|
|
|
/* Select General Output Register to output data in OUTDTSEL */
|
|
if (output) {
|
|
gpio_rcar_modify_bit(config, OUTDTSEL, gpio, false);
|
|
}
|
|
}
|
|
|
|
static int gpio_rcar_configure(const struct device *dev,
|
|
gpio_pin_t pin, gpio_flags_t flags)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
|
|
if ((flags & GPIO_OUTPUT) && (flags & GPIO_INPUT)) {
|
|
/* Pin cannot be configured as input and output */
|
|
return -ENOTSUP;
|
|
} else if (!(flags & (GPIO_INPUT | GPIO_OUTPUT))) {
|
|
/* Pin has to be configured as input or output */
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
if (flags & GPIO_OUTPUT) {
|
|
if (flags & GPIO_OUTPUT_INIT_HIGH) {
|
|
gpio_rcar_modify_bit(config, OUTDT, pin, true);
|
|
} else if (flags & GPIO_OUTPUT_INIT_LOW) {
|
|
gpio_rcar_modify_bit(config, OUTDT, pin, false);
|
|
}
|
|
gpio_rcar_config_general_input_output_mode(config, pin, true);
|
|
} else {
|
|
gpio_rcar_config_general_input_output_mode(config, pin, false);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_port_get_raw(const struct device *dev,
|
|
gpio_port_value_t *value)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
|
|
*value = gpio_rcar_read(config, INDT);
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_port_set_masked_raw(const struct device *dev,
|
|
gpio_port_pins_t mask,
|
|
gpio_port_value_t value)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
uint32_t port_val;
|
|
|
|
port_val = gpio_rcar_read(config, OUTDT);
|
|
port_val = (port_val & ~mask) | (value & mask);
|
|
gpio_rcar_write(config, OUTDT, port_val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_port_set_bits_raw(const struct device *dev,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
uint32_t port_val;
|
|
|
|
port_val = gpio_rcar_read(config, OUTDT);
|
|
port_val |= pins;
|
|
gpio_rcar_write(config, OUTDT, port_val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_port_clear_bits_raw(const struct device *dev,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
uint32_t port_val;
|
|
|
|
port_val = gpio_rcar_read(config, OUTDT);
|
|
port_val &= ~pins;
|
|
gpio_rcar_write(config, OUTDT, port_val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_port_toggle_bits(const struct device *dev,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
uint32_t port_val;
|
|
|
|
port_val = gpio_rcar_read(config, OUTDT);
|
|
port_val ^= pins;
|
|
gpio_rcar_write(config, OUTDT, port_val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_pin_interrupt_configure(const struct device *dev,
|
|
gpio_pin_t pin,
|
|
enum gpio_int_mode mode,
|
|
enum gpio_int_trig trig)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
|
|
if (mode == GPIO_INT_MODE_DISABLED) {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
/* Configure positive or negative logic in POSNEG */
|
|
gpio_rcar_modify_bit(config, POSNEG, pin,
|
|
(trig == GPIO_INT_TRIG_LOW));
|
|
|
|
/* Configure edge or level trigger in EDGLEVEL */
|
|
if (mode == GPIO_INT_MODE_EDGE) {
|
|
gpio_rcar_modify_bit(config, EDGLEVEL, pin, true);
|
|
} else {
|
|
gpio_rcar_modify_bit(config, EDGLEVEL, pin, false);
|
|
}
|
|
|
|
if (trig == GPIO_INT_TRIG_BOTH) {
|
|
gpio_rcar_modify_bit(config, BOTHEDGE, pin, true);
|
|
}
|
|
|
|
gpio_rcar_modify_bit(config, IOINTSEL, pin, true);
|
|
|
|
if (mode == GPIO_INT_MODE_EDGE) {
|
|
/* Write INTCLR in case of edge trigger */
|
|
gpio_rcar_write(config, INTCLR, BIT(pin));
|
|
}
|
|
|
|
gpio_rcar_write(config, MSKCLR, BIT(pin));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_init(const struct device *dev)
|
|
{
|
|
const struct gpio_rcar_cfg *config = dev->config;
|
|
int ret;
|
|
|
|
ret = clock_control_on(config->clock_dev,
|
|
(clock_control_subsys_t *) &config->mod_clk);
|
|
|
|
if (ret < 0) {
|
|
return ret;
|
|
}
|
|
|
|
config->init_func(dev);
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_rcar_manage_callback(const struct device *dev,
|
|
struct gpio_callback *callback,
|
|
bool set)
|
|
{
|
|
struct gpio_rcar_data *data = dev->data;
|
|
|
|
return gpio_manage_callback(&data->cb, callback, set);
|
|
}
|
|
|
|
static const struct gpio_driver_api gpio_rcar_driver_api = {
|
|
.pin_configure = gpio_rcar_configure,
|
|
.port_get_raw = gpio_rcar_port_get_raw,
|
|
.port_set_masked_raw = gpio_rcar_port_set_masked_raw,
|
|
.port_set_bits_raw = gpio_rcar_port_set_bits_raw,
|
|
.port_clear_bits_raw = gpio_rcar_port_clear_bits_raw,
|
|
.port_toggle_bits = gpio_rcar_port_toggle_bits,
|
|
.pin_interrupt_configure = gpio_rcar_pin_interrupt_configure,
|
|
.manage_callback = gpio_rcar_manage_callback,
|
|
};
|
|
|
|
/* Device Instantiation */
|
|
#define GPIO_RCAR_INIT(n) \
|
|
static void gpio_rcar_##n##_init(const struct device *dev); \
|
|
static const struct gpio_rcar_cfg gpio_rcar_cfg_##n = { \
|
|
.common = { \
|
|
.port_pin_mask = \
|
|
GPIO_PORT_PIN_MASK_FROM_DT_INST(n), \
|
|
}, \
|
|
.reg_addr = DT_INST_REG_ADDR(n), \
|
|
.reg_size = DT_INST_REG_SIZE(n), \
|
|
.init_func = gpio_rcar_##n##_init, \
|
|
.clock_dev = DEVICE_DT_GET(DT_INST_CLOCKS_CTLR(n)), \
|
|
.mod_clk.module = \
|
|
DT_INST_CLOCKS_CELL_BY_IDX(n, 0, module), \
|
|
.mod_clk.domain = \
|
|
DT_INST_CLOCKS_CELL_BY_IDX(n, 0, domain), \
|
|
}; \
|
|
static struct gpio_rcar_data gpio_rcar_data_##n; \
|
|
\
|
|
DEVICE_DT_INST_DEFINE(n, \
|
|
gpio_rcar_init, \
|
|
NULL, \
|
|
&gpio_rcar_data_##n, \
|
|
&gpio_rcar_cfg_##n, \
|
|
PRE_KERNEL_1, \
|
|
CONFIG_GPIO_INIT_PRIORITY, \
|
|
&gpio_rcar_driver_api \
|
|
); \
|
|
static void gpio_rcar_##n##_init(const struct device *dev) \
|
|
{ \
|
|
IRQ_CONNECT(DT_INST_IRQN(n), \
|
|
0, \
|
|
gpio_rcar_port_isr, \
|
|
DEVICE_DT_INST_GET(n), 0); \
|
|
\
|
|
irq_enable(DT_INST_IRQN(n)); \
|
|
}
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(GPIO_RCAR_INIT)
|