zephyr/drivers/gpio/gpio_si32.c

264 lines
7.6 KiB
C
Raw Normal View History

/*
* Copyright (c) 2024 GARDENA GmbH
*
* SPDX-License-Identifier: Apache-2.0
*/
#define DT_DRV_COMPAT silabs_si32_gpio
#include <zephyr/device.h>
#include <zephyr/drivers/gpio.h>
#include <zephyr/drivers/gpio/gpio_utils.h>
#include <zephyr/kernel.h>
#include <SI32_PBCFG_A_Type.h>
#include <SI32_PBSTD_A_Type.h>
#include <si32_device.h>
#include <errno.h>
struct gpio_si32_config {
struct gpio_driver_config common;
SI32_PBSTD_A_Type *base;
bool disable_pullups;
};
struct gpio_si32_data {
/* gpio_driver_data needs to be first */
struct gpio_driver_data common;
sys_slist_t cb;
gpio_port_pins_t trig_low;
gpio_port_pins_t trig_high;
uint32_t pin_values;
};
static int gpio_si32_configure(const struct device *dev, gpio_pin_t pin, gpio_flags_t flags)
{
const struct gpio_si32_config *config = dev->config;
uint32_t key = irq_lock();
/* Simultaneous input & output mode not supported */
if (((flags & GPIO_INPUT) != 0) && ((flags & GPIO_OUTPUT) != 0)) {
return -ENOTSUP;
}
if (flags & GPIO_OUTPUT) {
if (flags & GPIO_OUTPUT_INIT_HIGH) {
SI32_PBSTD_A_write_pins_high(config->base, BIT(pin));
} else if (flags & GPIO_OUTPUT_INIT_LOW) {
SI32_PBSTD_A_write_pins_low(config->base, BIT(pin));
}
SI32_PBSTD_A_set_pins_push_pull_output(config->base, BIT(pin));
} else if (flags & GPIO_INPUT) {
SI32_PBSTD_A_set_pins_digital_input(config->base, BIT(pin));
} else {
SI32_PBSTD_A_set_pins_analog(config->base, BIT(pin));
}
/* Initially, configure interrupt to trigger on the active value.
* Otherwise we'd get an interrupt immediately after enabling them.
*/
if (flags & GPIO_ACTIVE_HIGH) {
config->base->PM_SET = BIT(pin);
} else {
config->base->PM_CLR = BIT(pin);
}
irq_unlock(key);
return 0;
}
static int gpio_si32_port_get_raw(const struct device *dev, uint32_t *value)
{
const struct gpio_si32_config *config = dev->config;
*value = SI32_PBSTD_A_read_pins(config->base);
return 0;
}
static int gpio_si32_port_set_masked_raw(const struct device *dev, gpio_port_pins_t mask,
gpio_port_value_t value)
{
const struct gpio_si32_config *config = dev->config;
SI32_PBSTD_A_write_pins_masked(config->base, value, mask);
return 0;
}
static int gpio_si32_port_set_bits_raw(const struct device *dev, gpio_port_pins_t pins)
{
const struct gpio_si32_config *config = dev->config;
SI32_PBSTD_A_write_pins_high(config->base, pins);
return 0;
}
static int gpio_si32_port_clear_bits_raw(const struct device *dev, gpio_port_pins_t pins)
{
const struct gpio_si32_config *config = dev->config;
SI32_PBSTD_A_write_pins_low(config->base, pins);
return 0;
}
static int gpio_si32_port_toggle_bits(const struct device *dev, gpio_port_pins_t pins)
{
const struct gpio_si32_config *config = dev->config;
SI32_PBSTD_A_toggle_pins(config->base, pins);
return 0;
}
static int gpio_si32_pin_interrupt_configure(const struct device *dev, gpio_pin_t pin,
enum gpio_int_mode mode, enum gpio_int_trig trig)
{
const struct gpio_si32_config *config = dev->config;
struct gpio_si32_data *data = dev->data;
int ret;
const uint32_t key = irq_lock();
if (mode == GPIO_INT_MODE_DISABLED) {
config->base->PMEN_CLR = BIT(pin);
WRITE_BIT(data->trig_low, pin, 0);
WRITE_BIT(data->trig_high, pin, 0);
ret = 0;
goto unlock;
} else if (mode == GPIO_INT_MODE_EDGE) {
} else {
/* Not yet implemented */
ret = -ENOTSUP;
goto unlock;
}
WRITE_BIT(data->trig_low, pin, trig & GPIO_INT_TRIG_LOW);
WRITE_BIT(data->trig_high, pin, trig & GPIO_INT_TRIG_HIGH);
config->base->PMEN_SET = BIT(pin);
ret = 0;
unlock:
irq_unlock(key);
return ret;
}
static int gpio_si32_manage_callback(const struct device *dev, struct gpio_callback *callback,
bool set)
{
struct gpio_si32_data *data = dev->data;
return gpio_manage_callback(&data->cb, callback, set);
}
static const struct gpio_driver_api gpio_si32_driver = {
.pin_configure = gpio_si32_configure,
.port_get_raw = gpio_si32_port_get_raw,
.port_set_masked_raw = gpio_si32_port_set_masked_raw,
.port_set_bits_raw = gpio_si32_port_set_bits_raw,
.port_clear_bits_raw = gpio_si32_port_clear_bits_raw,
.port_toggle_bits = gpio_si32_port_toggle_bits,
.pin_interrupt_configure = gpio_si32_pin_interrupt_configure,
.manage_callback = gpio_si32_manage_callback,
};
static int gpio_si32_init(const struct device *dev)
{
const struct gpio_si32_config *config = dev->config;
if (config->disable_pullups) {
SI32_PBSTD_A_disable_pullup_resistors(config->base);
}
return 0;
}
#define GPIO_DEVICE_INIT(inst) \
static const struct gpio_si32_config gpio_si32_cfg_##inst = { \
.common = \
{ \
.port_pin_mask = GPIO_PORT_PIN_MASK_FROM_NGPIOS(16U), \
}, \
.base = (SI32_PBSTD_A_Type *)DT_INST_REG_ADDR(inst), \
.disable_pullups = DT_INST_PROP(inst, disable_pullups), \
}; \
static struct gpio_si32_data gpio_si32_data_##inst; \
DEVICE_DT_INST_DEFINE(inst, gpio_si32_init, NULL, &gpio_si32_data_##inst, \
&gpio_si32_cfg_##inst, PRE_KERNEL_1, CONFIG_GPIO_INIT_PRIORITY, \
&gpio_si32_driver);
DT_INST_FOREACH_STATUS_OKAY(GPIO_DEVICE_INIT)
#define GPIO_DEVICE_LIST_ENTRY(inst) DEVICE_DT_GET(DT_DRV_INST(inst)),
static const struct device *gpio_devices[] = {DT_INST_FOREACH_STATUS_OKAY(GPIO_DEVICE_LIST_ENTRY)};
/* The hardware only supports level interrupts, so we have to emulate edge
* interrupts in this handler.
*/
static void gpio_si32_irq_handler(const struct device *arg)
{
ARG_UNUSED(arg);
irq_disable(PMATCH_IRQn);
NVIC_ClearPendingIRQ(PMATCH_IRQn);
for (size_t i = 0; i < ARRAY_SIZE(gpio_devices); i++) {
const struct device *dev = gpio_devices[i];
const struct gpio_si32_config *config = dev->config;
struct gpio_si32_data *data = dev->data;
const uint32_t pmen = SI32_PBSTD_A_read_pmen(config->base);
const uint32_t pm = SI32_PBSTD_A_read_pm(config->base);
const uint32_t values = SI32_PBSTD_A_read_pins(config->base);
/* Invert triggers for all pins which are at their trigger
* values. This disables interrupts until they change again
* since the hardware only supports level interrupts.
*/
const uint32_t pins_not_at_trigger_value = (pm ^ values) & pmen;
const uint32_t pins_at_trigger_value = (~pins_not_at_trigger_value) & pmen;
SI32_PBSTD_A_write_pm(config->base, pm ^ pins_at_trigger_value);
/* To check which pins actually changed we have to store and
* compare the previous value.
*/
const uint32_t changed_pins = (values ^ data->pin_values) & pmen;
data->pin_values = values;
if (changed_pins) {
/* The user might be interested in both levels or just one,
* so filter those events here.
*/
const uint32_t changed_pins_high =
(values & changed_pins) & data->trig_high;
const uint32_t changed_pins_low =
((~values) & changed_pins) & data->trig_low;
gpio_fire_callbacks(&data->cb, dev, changed_pins_high | changed_pins_low);
}
}
irq_enable(PMATCH_IRQn);
}
static int gpio_si32_common_init(void)
{
/* This is the only mode we support right now */
SI32_PBCFG_A_select_port_match_mode_pin_match(SI32_PBCFG_0);
IRQ_CONNECT(PMATCH_IRQn, 0, gpio_si32_irq_handler, NULL, 0);
irq_enable(PMATCH_IRQn);
return 0;
}
SYS_INIT(gpio_si32_common_init, PRE_KERNEL_1, CONFIG_GPIO_INIT_PRIORITY);