patrick/zephyr
1
0
Fork 0
Code Issues Pull requests Actions 7 Packages Projects Releases Wiki Activity

drivers: gpio_emul: support gpio_port_get_direction

Browse source 
Support querying the direction of emulated GPIO.

Signed-off-by: Christopher Friedt <cfriedt@fb.com>
This commit is contained in:
Christopher Friedt 2022-06-17 11:07:11 -04:00 committed by Carles Cufí
parent 165c5db078
commit 9526437e64
1 changed files with 37 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

37
drivers/gpio/gpio_emul.c
View file

@ -666,6 +666,40 @@ static gpio_port_pins_t gpio_emul_get_pending_int(const struct device *dev)
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,
.port_get_raw = gpio_emul_port_get_raw,
@ -676,6 +710,9 @@ static const struct gpio_driver_api gpio_emul_driver = {
.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)