891 lines
25 KiB
C
891 lines
25 KiB
C
/*
|
|
* Copyright (c) 2020 Friedt Professional Engineering Services, Inc
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT zephyr_gpio_emul
|
|
|
|
#include <zephyr/device.h>
|
|
#include <zephyr/drivers/gpio.h>
|
|
#include <zephyr/drivers/gpio/gpio_emul.h>
|
|
#include <errno.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/pm/device.h>
|
|
|
|
#include <zephyr/drivers/gpio/gpio_utils.h>
|
|
|
|
#define LOG_LEVEL CONFIG_GPIO_LOG_LEVEL
|
|
#include <zephyr/logging/log.h>
|
|
LOG_MODULE_REGISTER(gpio_emul);
|
|
|
|
#define GPIO_EMUL_INT_BITMASK \
|
|
(GPIO_INT_DISABLE | GPIO_INT_ENABLE | GPIO_INT_LEVELS_LOGICAL | \
|
|
GPIO_INT_EDGE | GPIO_INT_LOW_0 | GPIO_INT_HIGH_1)
|
|
|
|
/**
|
|
* @brief GPIO Emulator interrupt capabilities
|
|
*
|
|
* These enumerations are used as a bitmask and allow the GPIO Emulator to
|
|
* model GPIO interrupt controllers with varying interrupt trigger support.
|
|
*
|
|
* For example, some controllers to not support level interrupts,
|
|
* some controllers do not support rising and falling edge simultaneously,
|
|
* etc.
|
|
*
|
|
* This primarily affects the behaviour of @ref gpio_pin_interrupt_configure.
|
|
*/
|
|
enum gpio_emul_interrupt_cap {
|
|
GPIO_EMUL_INT_CAP_EDGE_RISING = 1,
|
|
GPIO_EMUL_INT_CAP_EDGE_FALLING = 2,
|
|
GPIO_EMUL_INT_CAP_LEVEL_HIGH = 16,
|
|
GPIO_EMUL_INT_CAP_LEVEL_LOW = 32,
|
|
};
|
|
|
|
/**
|
|
* @brief Emulated GPIO controller configuration data
|
|
*
|
|
* This structure contains all of the state for a given emulated GPIO
|
|
* controller as well as all of the pins associated with it.
|
|
*
|
|
* The @a flags member is a pointer to an array which is @a num_pins in size.
|
|
*
|
|
* @a num_pins must be in the range [1, @ref GPIO_MAX_PINS_PER_PORT].
|
|
*
|
|
* Pin direction as well as other pin properties are set using
|
|
* specific bits in @a flags. For more details, see @ref gpio_interface.
|
|
*
|
|
* Changes are synchronized using @ref gpio_emul_data.mu.
|
|
*/
|
|
struct gpio_emul_config {
|
|
/** Common @ref gpio_driver_config */
|
|
const struct gpio_driver_config common;
|
|
/** Number of pins available in the given GPIO controller instance */
|
|
const gpio_pin_t num_pins;
|
|
/** Supported interrupts */
|
|
const enum gpio_emul_interrupt_cap interrupt_caps;
|
|
};
|
|
|
|
/**
|
|
* @brief Emulated GPIO controller data
|
|
*
|
|
* This structure contains data structures used by a emulated GPIO
|
|
* controller.
|
|
*
|
|
* If the application wishes to specify a "wiring" for the emulated
|
|
* GPIO, then a @ref gpio_callback_handler_t should be registered using
|
|
* @ref gpio_add_callback.
|
|
*
|
|
* Changes are to @ref gpio_emul_data and @ref gpio_emul_config are
|
|
* synchronized using @a k_spinlock.
|
|
*/
|
|
struct gpio_emul_data {
|
|
/** Common @ref gpio_driver_data */
|
|
struct gpio_driver_data common;
|
|
/** Pointer to an array of flags is @a num_pins in size */
|
|
gpio_flags_t *flags;
|
|
/** Input values for each pin */
|
|
gpio_port_value_t input_vals;
|
|
/** Output values for each pin */
|
|
gpio_port_value_t output_vals;
|
|
/** Interrupt status for each pin */
|
|
gpio_port_pins_t interrupts;
|
|
/** Spinlock to synchronize accesses to driver data and config */
|
|
struct k_spinlock lock;
|
|
/** Is interrupt enabled for each pin */
|
|
gpio_port_pins_t enabled_interrupts;
|
|
/** Singly-linked list of callbacks associated with the controller */
|
|
sys_slist_t callbacks;
|
|
};
|
|
|
|
/**
|
|
* @brief Obtain a mask of pins that match all of the provided @p flags
|
|
*
|
|
* Use this function to see which pins match the current GPIO configuration.
|
|
*
|
|
* The caller must ensure that @ref gpio_emul_data.lock is locked.
|
|
*
|
|
* @param port The emulated GPIO device pointer
|
|
* @param mask A mask of flags to match
|
|
* @param flags The flags to match
|
|
*
|
|
* @return a mask of the pins with matching @p flags
|
|
*/
|
|
static gpio_port_pins_t
|
|
get_pins_with_flags(const struct device *port, gpio_port_pins_t mask,
|
|
gpio_flags_t flags)
|
|
{
|
|
size_t i;
|
|
gpio_port_pins_t matched = 0;
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
|
|
for (i = 0; i < config->num_pins; ++i) {
|
|
if ((drv_data->flags[i] & mask) == flags) {
|
|
matched |= BIT(i);
|
|
}
|
|
}
|
|
|
|
return matched;
|
|
}
|
|
|
|
/**
|
|
* @brief Obtain a mask of pins that are configured as @ref GPIO_INPUT
|
|
*
|
|
* The caller must ensure that @ref gpio_emul_data.lock is locked.
|
|
*
|
|
* @param port The emulated GPIO device pointer
|
|
*
|
|
* @return a mask of pins that are configured as @ref GPIO_INPUT
|
|
*/
|
|
static inline gpio_port_pins_t get_input_pins(const struct device *port)
|
|
{
|
|
return get_pins_with_flags(port, GPIO_INPUT, GPIO_INPUT);
|
|
}
|
|
|
|
/**
|
|
* @brief Obtain a mask of pins that are configured as @ref GPIO_OUTPUT
|
|
*
|
|
* The caller must ensure that @ref gpio_emul_data.lock is locked.
|
|
*
|
|
* @param port The emulated GPIO device pointer
|
|
*
|
|
* @return a mask of pins that are configured as @ref GPIO_OUTPUT
|
|
*/
|
|
static inline gpio_port_pins_t get_output_pins(const struct device *port)
|
|
{
|
|
return get_pins_with_flags(port, GPIO_OUTPUT, GPIO_OUTPUT);
|
|
}
|
|
|
|
/**
|
|
* Check if @p port has capabilities specified in @p caps
|
|
*
|
|
* @param port The emulated GPIO device pointer
|
|
* @param caps A bitmask of @ref gpio_emul_interrupt_cap
|
|
*
|
|
* @return true if all @p caps are present, otherwise false
|
|
*/
|
|
static inline bool gpio_emul_config_has_caps(const struct device *port,
|
|
int caps) {
|
|
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
|
|
return (caps & config->interrupt_caps) == caps;
|
|
}
|
|
|
|
/*
|
|
* GPIO backend API (for setting input pin values)
|
|
*/
|
|
static void gpio_emul_gen_interrupt_bits(const struct device *port,
|
|
gpio_port_pins_t mask,
|
|
gpio_port_value_t prev_values,
|
|
gpio_port_value_t values,
|
|
gpio_port_pins_t *interrupts,
|
|
bool detect_edge)
|
|
{
|
|
size_t i;
|
|
bool bit;
|
|
bool prev_bit;
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
|
|
for (i = 0, *interrupts = 0; mask && i < config->num_pins;
|
|
++i, mask >>= 1, prev_values >>= 1, values >>= 1) {
|
|
if ((mask & 1) == 0) {
|
|
continue;
|
|
}
|
|
|
|
prev_bit = ((prev_values & 1) != 0);
|
|
bit = ((values & 1) != 0);
|
|
|
|
switch (drv_data->flags[i] & GPIO_EMUL_INT_BITMASK) {
|
|
case GPIO_INT_EDGE_RISING:
|
|
if (gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_EDGE_RISING)) {
|
|
if (detect_edge && !prev_bit && bit) {
|
|
drv_data->interrupts |= BIT(i);
|
|
*interrupts |= (BIT(i) & drv_data->enabled_interrupts);
|
|
}
|
|
}
|
|
break;
|
|
case GPIO_INT_EDGE_FALLING:
|
|
if (gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_EDGE_FALLING)) {
|
|
if (detect_edge && prev_bit && !bit) {
|
|
drv_data->interrupts |= BIT(i);
|
|
*interrupts |= (BIT(i) & drv_data->enabled_interrupts);
|
|
}
|
|
}
|
|
break;
|
|
case GPIO_INT_EDGE_BOTH:
|
|
if (gpio_emul_config_has_caps(port,
|
|
GPIO_EMUL_INT_CAP_EDGE_RISING | GPIO_EMUL_INT_CAP_EDGE_FALLING)) {
|
|
if (detect_edge && prev_bit != bit) {
|
|
drv_data->interrupts |= BIT(i);
|
|
*interrupts |= (BIT(i) & drv_data->enabled_interrupts);
|
|
}
|
|
}
|
|
break;
|
|
case GPIO_INT_LEVEL_LOW:
|
|
if (gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_LEVEL_LOW)) {
|
|
if (!bit) {
|
|
drv_data->interrupts |= BIT(i);
|
|
*interrupts |= (BIT(i) & drv_data->enabled_interrupts);
|
|
}
|
|
}
|
|
break;
|
|
case GPIO_INT_LEVEL_HIGH:
|
|
if (gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_LEVEL_HIGH)) {
|
|
if (bit) {
|
|
drv_data->interrupts |= BIT(i);
|
|
*interrupts |= (BIT(i) & drv_data->enabled_interrupts);
|
|
}
|
|
}
|
|
break;
|
|
case 0:
|
|
case GPIO_INT_DISABLE:
|
|
break;
|
|
default:
|
|
LOG_DBG("unhandled case %u",
|
|
drv_data->flags[i] & GPIO_EMUL_INT_BITMASK);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Trigger possible interrupt events after an input pin has changed
|
|
*
|
|
* For more information, see @ref gpio_interface.
|
|
*
|
|
* The caller must ensure that @ref gpio_emul_data.lock is locked.
|
|
*
|
|
* @param port The emulated GPIO port
|
|
* @param mask The mask of pins that have changed
|
|
* @param prev_values Previous pin values
|
|
* @param values Current pin values
|
|
*/
|
|
static void gpio_emul_pend_interrupt(const struct device *port, gpio_port_pins_t mask,
|
|
gpio_port_value_t prev_values,
|
|
gpio_port_value_t values)
|
|
{
|
|
gpio_port_pins_t interrupts;
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
k_spinlock_key_t key;
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
gpio_emul_gen_interrupt_bits(port, mask, prev_values, values,
|
|
&interrupts, true);
|
|
while (interrupts != 0) {
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
gpio_fire_callbacks(&drv_data->callbacks, port, interrupts);
|
|
key = k_spin_lock(&drv_data->lock);
|
|
/* Clear handled interrupts */
|
|
drv_data->interrupts &= ~interrupts;
|
|
gpio_emul_gen_interrupt_bits(port, mask, prev_values, values,
|
|
&interrupts, false);
|
|
}
|
|
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
}
|
|
|
|
int gpio_emul_input_set_masked_int(const struct device *port,
|
|
gpio_port_pins_t mask,
|
|
gpio_port_value_t values)
|
|
{
|
|
gpio_port_pins_t input_mask;
|
|
gpio_port_pins_t prev_values;
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
|
|
if (mask == 0) {
|
|
return 0;
|
|
}
|
|
|
|
if (~config->common.port_pin_mask & mask) {
|
|
LOG_ERR("Pin not supported port_pin_mask=%x mask=%x",
|
|
config->common.port_pin_mask, mask);
|
|
return -EINVAL;
|
|
}
|
|
|
|
input_mask = get_input_pins(port);
|
|
if (~input_mask & mask) {
|
|
LOG_ERR("Not input pin input_mask=%x mask=%x", input_mask,
|
|
mask);
|
|
return -EINVAL;
|
|
}
|
|
|
|
prev_values = drv_data->input_vals;
|
|
drv_data->input_vals &= ~mask;
|
|
drv_data->input_vals |= values & mask;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* documented in drivers/gpio/gpio_emul.h */
|
|
int gpio_emul_input_set_masked(const struct device *port, gpio_port_pins_t mask,
|
|
gpio_port_value_t values)
|
|
{
|
|
struct gpio_emul_data *drv_data = (struct gpio_emul_data *)port->data;
|
|
gpio_port_pins_t prev_input_values;
|
|
gpio_port_pins_t input_values;
|
|
k_spinlock_key_t key;
|
|
int rv;
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
prev_input_values = drv_data->input_vals;
|
|
rv = gpio_emul_input_set_masked_int(port, mask, values);
|
|
input_values = drv_data->input_vals;
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
if (rv) {
|
|
return rv;
|
|
}
|
|
|
|
gpio_emul_pend_interrupt(port, mask, prev_input_values, input_values);
|
|
return 0;
|
|
}
|
|
|
|
/* documented in drivers/gpio/gpio_emul.h */
|
|
int gpio_emul_output_get_masked(const struct device *port, gpio_port_pins_t mask,
|
|
gpio_port_value_t *values)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
k_spinlock_key_t key;
|
|
|
|
if (mask == 0) {
|
|
return 0;
|
|
}
|
|
|
|
if (~config->common.port_pin_mask & mask) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
*values = drv_data->output_vals & get_output_pins(port);
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* documented in drivers/gpio/gpio_emul.h */
|
|
int gpio_emul_flags_get(const struct device *port, gpio_pin_t pin, gpio_flags_t *flags)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
k_spinlock_key_t key;
|
|
|
|
if (flags == NULL) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
if ((config->common.port_pin_mask & BIT(pin)) == 0) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
*flags = drv_data->flags[pin];
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* GPIO Driver API
|
|
*
|
|
* API is documented at drivers/gpio.h
|
|
*/
|
|
|
|
static int gpio_emul_pin_configure(const struct device *port, gpio_pin_t pin,
|
|
gpio_flags_t flags)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
k_spinlock_key_t key;
|
|
int rv;
|
|
|
|
if (flags & GPIO_OPEN_DRAIN) {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
if (flags & GPIO_OPEN_SOURCE) {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
if ((config->common.port_pin_mask & BIT(pin)) == 0) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
drv_data->flags[pin] = flags;
|
|
if (flags & GPIO_OUTPUT) {
|
|
if (flags & GPIO_OUTPUT_INIT_LOW) {
|
|
drv_data->output_vals &= ~BIT(pin);
|
|
if (flags & GPIO_INPUT) {
|
|
/* for push-pull mode to generate interrupts */
|
|
rv = gpio_emul_input_set_masked_int(
|
|
port, BIT(pin), drv_data->output_vals);
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
}
|
|
} else if (flags & GPIO_OUTPUT_INIT_HIGH) {
|
|
drv_data->output_vals |= BIT(pin);
|
|
if (flags & GPIO_INPUT) {
|
|
/* for push-pull mode to generate interrupts */
|
|
rv = gpio_emul_input_set_masked_int(
|
|
port, BIT(pin), drv_data->output_vals);
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
}
|
|
}
|
|
} else if (flags & GPIO_INPUT) {
|
|
if (flags & GPIO_PULL_UP) {
|
|
rv = gpio_emul_input_set_masked_int(port, BIT(pin), BIT(pin));
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
} else if (flags & GPIO_PULL_DOWN) {
|
|
rv = gpio_emul_input_set_masked_int(
|
|
port, BIT(pin), 0);
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
}
|
|
}
|
|
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
gpio_fire_callbacks(&drv_data->callbacks, port, BIT(pin));
|
|
/* GPIO pin configuration changed so clear the pending interrupt. */
|
|
drv_data->interrupts &= ~((gpio_port_pins_t)BIT(pin));
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_GPIO_GET_CONFIG
|
|
static int gpio_emul_pin_get_config(const struct device *port, gpio_pin_t pin,
|
|
gpio_flags_t *out_flags)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
k_spinlock_key_t key;
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
|
|
*out_flags = drv_data->flags[pin] &
|
|
~(GPIO_OUTPUT_INIT_LOW | GPIO_OUTPUT_INIT_HIGH
|
|
| GPIO_OUTPUT_INIT_LOGICAL);
|
|
if (drv_data->flags[pin] & GPIO_OUTPUT) {
|
|
if (drv_data->output_vals & BIT(pin)) {
|
|
*out_flags |= GPIO_OUTPUT_HIGH;
|
|
} else {
|
|
*out_flags |= GPIO_OUTPUT_LOW;
|
|
}
|
|
}
|
|
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static int gpio_emul_port_get_raw(const struct device *port, gpio_port_value_t *values)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
k_spinlock_key_t key;
|
|
|
|
if (values == NULL) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
*values = drv_data->input_vals & get_input_pins(port);
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_emul_port_set_masked_raw(const struct device *port,
|
|
gpio_port_pins_t mask,
|
|
gpio_port_value_t values)
|
|
{
|
|
gpio_port_pins_t output_mask;
|
|
gpio_port_pins_t prev_values;
|
|
gpio_port_pins_t prev_input_values;
|
|
gpio_port_pins_t input_values;
|
|
gpio_port_pins_t input_mask;
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
k_spinlock_key_t key;
|
|
int rv;
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
output_mask = get_output_pins(port);
|
|
mask &= output_mask;
|
|
prev_values = drv_data->output_vals;
|
|
prev_values &= output_mask;
|
|
values &= mask;
|
|
drv_data->output_vals &= ~mask;
|
|
drv_data->output_vals |= values;
|
|
/* in push-pull, set input values & fire interrupts */
|
|
prev_input_values = drv_data->input_vals;
|
|
input_mask = mask & get_input_pins(port);
|
|
rv = gpio_emul_input_set_masked_int(port, input_mask,
|
|
drv_data->output_vals);
|
|
input_values = drv_data->input_vals;
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
gpio_emul_pend_interrupt(port, input_mask, prev_input_values, input_values);
|
|
|
|
/* for output-wiring, so the user can take action based on output */
|
|
if (prev_values ^ values) {
|
|
gpio_fire_callbacks(&drv_data->callbacks, port, mask & ~get_input_pins(port));
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_emul_port_set_bits_raw(const struct device *port,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
k_spinlock_key_t key;
|
|
gpio_port_pins_t prev_input_values;
|
|
gpio_port_pins_t input_values;
|
|
gpio_port_pins_t input_mask;
|
|
int rv;
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
pins &= get_output_pins(port);
|
|
drv_data->output_vals |= pins;
|
|
prev_input_values = drv_data->input_vals;
|
|
input_mask = pins & get_input_pins(port);
|
|
rv = gpio_emul_input_set_masked_int(port, input_mask,
|
|
drv_data->output_vals);
|
|
input_values = drv_data->input_vals;
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
gpio_emul_pend_interrupt(port, input_mask, prev_input_values, input_values);
|
|
/* for output-wiring, so the user can take action based on output */
|
|
gpio_fire_callbacks(&drv_data->callbacks, port, pins & ~get_input_pins(port));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_emul_port_clear_bits_raw(const struct device *port,
|
|
gpio_port_pins_t pins)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
k_spinlock_key_t key;
|
|
gpio_port_pins_t prev_input_values;
|
|
gpio_port_pins_t input_values;
|
|
gpio_port_pins_t input_mask;
|
|
int rv;
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
pins &= get_output_pins(port);
|
|
drv_data->output_vals &= ~pins;
|
|
prev_input_values = drv_data->input_vals;
|
|
input_mask = pins & get_input_pins(port);
|
|
rv = gpio_emul_input_set_masked_int(port, input_mask, drv_data->output_vals);
|
|
input_values = drv_data->input_vals;
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
gpio_emul_pend_interrupt(port, input_mask, prev_input_values, input_values);
|
|
/* for output-wiring, so the user can take action based on output */
|
|
gpio_fire_callbacks(&drv_data->callbacks, port, pins & ~get_input_pins(port));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_emul_port_toggle_bits(const struct device *port, gpio_port_pins_t pins)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
k_spinlock_key_t key;
|
|
int rv;
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
drv_data->output_vals ^= (pins & get_output_pins(port));
|
|
/* in push-pull, set input values but do not fire interrupts (yet) */
|
|
rv = gpio_emul_input_set_masked_int(port, pins & get_input_pins(port),
|
|
drv_data->output_vals);
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
__ASSERT_NO_MSG(rv == 0);
|
|
/* for output-wiring, so the user can take action based on output */
|
|
gpio_fire_callbacks(&drv_data->callbacks, port, pins);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static bool gpio_emul_level_trigger_supported(const struct device *port,
|
|
enum gpio_int_trig trig)
|
|
{
|
|
switch (trig) {
|
|
case GPIO_INT_TRIG_LOW:
|
|
return gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_LEVEL_LOW);
|
|
case GPIO_INT_TRIG_HIGH:
|
|
return gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_LEVEL_HIGH);
|
|
case GPIO_INT_TRIG_BOTH:
|
|
return gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_LEVEL_LOW
|
|
| GPIO_EMUL_INT_CAP_LEVEL_HIGH);
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static bool gpio_emul_edge_trigger_supported(const struct device *port,
|
|
enum gpio_int_trig trig)
|
|
{
|
|
switch (trig) {
|
|
case GPIO_INT_TRIG_LOW:
|
|
return gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_EDGE_FALLING);
|
|
case GPIO_INT_TRIG_HIGH:
|
|
return gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_EDGE_RISING);
|
|
case GPIO_INT_TRIG_BOTH:
|
|
return gpio_emul_config_has_caps(port, GPIO_EMUL_INT_CAP_EDGE_FALLING
|
|
| GPIO_EMUL_INT_CAP_EDGE_RISING);
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static int gpio_emul_pin_interrupt_configure(const struct device *port, gpio_pin_t pin,
|
|
enum gpio_int_mode mode,
|
|
enum gpio_int_trig trig)
|
|
{
|
|
int ret;
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config =
|
|
(const struct gpio_emul_config *)port->config;
|
|
k_spinlock_key_t key;
|
|
|
|
if ((BIT(pin) & config->common.port_pin_mask) == 0) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
#ifdef CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT
|
|
if (mode != GPIO_INT_MODE_DISABLED && !(mode & GPIO_INT_ENABLE_DISABLE_ONLY)) {
|
|
#else
|
|
if (mode != GPIO_INT_MODE_DISABLED) {
|
|
#endif /* CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT */
|
|
switch (trig) {
|
|
case GPIO_INT_TRIG_LOW:
|
|
case GPIO_INT_TRIG_HIGH:
|
|
case GPIO_INT_TRIG_BOTH:
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
if (mode == GPIO_INT_MODE_LEVEL) {
|
|
if (!gpio_emul_level_trigger_supported(port, trig)) {
|
|
return -ENOTSUP;
|
|
}
|
|
}
|
|
|
|
if (mode == GPIO_INT_MODE_EDGE) {
|
|
if (!gpio_emul_edge_trigger_supported(port, trig)) {
|
|
return -ENOTSUP;
|
|
}
|
|
}
|
|
|
|
key = k_spin_lock(&drv_data->lock);
|
|
|
|
#ifdef CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT
|
|
/* According to the GPIO interrupt configuration flag documentation,
|
|
* changes to the interrupt trigger properties should clear pending
|
|
* interrupts.
|
|
*/
|
|
if (!(mode & GPIO_INT_ENABLE_DISABLE_ONLY)) {
|
|
drv_data->interrupts &= ~((gpio_port_pins_t)BIT(pin));
|
|
}
|
|
#else
|
|
drv_data->interrupts &= ~((gpio_port_pins_t)BIT(pin));
|
|
#endif /* CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT */
|
|
|
|
switch (mode) {
|
|
case GPIO_INT_MODE_DISABLED:
|
|
drv_data->flags[pin] &= ~GPIO_EMUL_INT_BITMASK;
|
|
drv_data->flags[pin] |= GPIO_INT_DISABLE;
|
|
#ifdef CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT
|
|
__fallthrough;
|
|
case GPIO_INT_MODE_DISABLE_ONLY:
|
|
#endif /* CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT */
|
|
drv_data->enabled_interrupts &= ~((gpio_port_pins_t)BIT(pin));
|
|
break;
|
|
case GPIO_INT_MODE_LEVEL:
|
|
case GPIO_INT_MODE_EDGE:
|
|
drv_data->flags[pin] &= ~GPIO_EMUL_INT_BITMASK;
|
|
drv_data->flags[pin] |= (mode | trig);
|
|
#ifdef CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT
|
|
__fallthrough;
|
|
case GPIO_INT_MODE_ENABLE_ONLY:
|
|
#endif /* CONFIG_GPIO_ENABLE_DISABLE_INTERRUPT */
|
|
drv_data->enabled_interrupts |= BIT(pin);
|
|
break;
|
|
default:
|
|
ret = -EINVAL;
|
|
goto unlock;
|
|
}
|
|
|
|
ret = 0;
|
|
|
|
unlock:
|
|
k_spin_unlock(&drv_data->lock, key);
|
|
|
|
/* Trigger callback if this pin has pending interrupt */
|
|
if (BIT(pin) & (drv_data->interrupts & drv_data->enabled_interrupts)) {
|
|
gpio_fire_callbacks(&drv_data->callbacks, port, BIT(pin));
|
|
drv_data->interrupts &= ~((gpio_port_pins_t)BIT(pin));
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int gpio_emul_manage_callback(const struct device *port,
|
|
struct gpio_callback *cb, bool set)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)port->data;
|
|
|
|
return gpio_manage_callback(&drv_data->callbacks, cb, set);
|
|
}
|
|
|
|
static uint32_t gpio_emul_get_pending_int(const struct device *dev)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)dev->data;
|
|
|
|
return drv_data->interrupts;
|
|
}
|
|
|
|
#ifdef CONFIG_GPIO_GET_DIRECTION
|
|
static int gpio_emul_port_get_direction(const struct device *port, gpio_port_pins_t map,
|
|
gpio_port_pins_t *inputs, gpio_port_pins_t *outputs)
|
|
{
|
|
int i;
|
|
gpio_port_pins_t ip = 0;
|
|
gpio_port_pins_t op = 0;
|
|
struct gpio_emul_data *const drv_data = (struct gpio_emul_data *)port->data;
|
|
const struct gpio_emul_config *config = (const struct gpio_emul_config *)port->config;
|
|
|
|
map &= config->common.port_pin_mask;
|
|
|
|
if (inputs != NULL) {
|
|
for (i = find_lsb_set(map) - 1; map;
|
|
map &= ~BIT(i), i = find_lsb_set(map) - 1) {
|
|
ip |= !!(drv_data->flags[i] & GPIO_INPUT) * BIT(i);
|
|
}
|
|
|
|
*inputs = ip;
|
|
}
|
|
|
|
if (outputs != NULL) {
|
|
for (i = find_lsb_set(map) - 1; map;
|
|
map &= ~BIT(i), i = find_lsb_set(map) - 1) {
|
|
op |= !!(drv_data->flags[i] & GPIO_OUTPUT) * BIT(i);
|
|
}
|
|
|
|
*outputs = op;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_GPIO_GET_DIRECTION */
|
|
|
|
static const struct gpio_driver_api gpio_emul_driver = {
|
|
.pin_configure = gpio_emul_pin_configure,
|
|
#ifdef CONFIG_GPIO_GET_CONFIG
|
|
.pin_get_config = gpio_emul_pin_get_config,
|
|
#endif
|
|
.port_get_raw = gpio_emul_port_get_raw,
|
|
.port_set_masked_raw = gpio_emul_port_set_masked_raw,
|
|
.port_set_bits_raw = gpio_emul_port_set_bits_raw,
|
|
.port_clear_bits_raw = gpio_emul_port_clear_bits_raw,
|
|
.port_toggle_bits = gpio_emul_port_toggle_bits,
|
|
.pin_interrupt_configure = gpio_emul_pin_interrupt_configure,
|
|
.manage_callback = gpio_emul_manage_callback,
|
|
.get_pending_int = gpio_emul_get_pending_int,
|
|
#ifdef CONFIG_GPIO_GET_DIRECTION
|
|
.port_get_direction = gpio_emul_port_get_direction,
|
|
#endif /* CONFIG_GPIO_GET_DIRECTION */
|
|
};
|
|
|
|
static int gpio_emul_init(const struct device *dev)
|
|
{
|
|
struct gpio_emul_data *drv_data =
|
|
(struct gpio_emul_data *)dev->data;
|
|
|
|
sys_slist_init(&drv_data->callbacks);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM_DEVICE
|
|
static int gpio_emul_pm_device_pm_action(const struct device *dev,
|
|
enum pm_device_action action)
|
|
{
|
|
ARG_UNUSED(dev);
|
|
ARG_UNUSED(action);
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Device Initialization
|
|
*/
|
|
|
|
#define GPIO_EMUL_INT_CAPS(_num) (0 \
|
|
+ DT_INST_PROP(_num, rising_edge) \
|
|
* GPIO_EMUL_INT_CAP_EDGE_RISING \
|
|
+ DT_INST_PROP(_num, falling_edge) \
|
|
* GPIO_EMUL_INT_CAP_EDGE_FALLING \
|
|
+ DT_INST_PROP(_num, high_level) \
|
|
* GPIO_EMUL_INT_CAP_LEVEL_HIGH \
|
|
+ DT_INST_PROP(_num, low_level) \
|
|
* GPIO_EMUL_INT_CAP_LEVEL_LOW \
|
|
)
|
|
|
|
#define DEFINE_GPIO_EMUL(_num) \
|
|
\
|
|
static gpio_flags_t \
|
|
gpio_emul_flags_##_num[DT_INST_PROP(_num, ngpios)]; \
|
|
\
|
|
static const struct gpio_emul_config gpio_emul_config_##_num = {\
|
|
.common = { \
|
|
.port_pin_mask = \
|
|
GPIO_PORT_PIN_MASK_FROM_DT_INST(_num), \
|
|
}, \
|
|
.num_pins = DT_INST_PROP(_num, ngpios), \
|
|
.interrupt_caps = GPIO_EMUL_INT_CAPS(_num) \
|
|
}; \
|
|
BUILD_ASSERT( \
|
|
DT_INST_PROP(_num, ngpios) <= GPIO_MAX_PINS_PER_PORT, \
|
|
"Too many ngpios"); \
|
|
\
|
|
static struct gpio_emul_data gpio_emul_data_##_num = { \
|
|
.flags = gpio_emul_flags_##_num, \
|
|
}; \
|
|
\
|
|
PM_DEVICE_DT_INST_DEFINE(_num, gpio_emul_pm_device_pm_action); \
|
|
\
|
|
DEVICE_DT_INST_DEFINE(_num, gpio_emul_init, \
|
|
PM_DEVICE_DT_INST_GET(_num), \
|
|
&gpio_emul_data_##_num, \
|
|
&gpio_emul_config_##_num, POST_KERNEL, \
|
|
CONFIG_GPIO_INIT_PRIORITY, \
|
|
&gpio_emul_driver);
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(DEFINE_GPIO_EMUL)
|