Commit f0da2679 authored by Dmitry Torokhov's avatar Dmitry Torokhov

Input: adp5588-keys - use guard notation when acquiring mutexes

This makes the code more compact and error handling more robust.
Acked-by: default avatarMichael Hennerich <michael.hennerich@analog.com>
Link: https://lore.kernel.org/r/20240826-adp5588_gpio_support-v11-1-3e5ac2bd31b7@analog.comSigned-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent e2e75e42
...@@ -221,15 +221,13 @@ static int adp5588_gpio_get_value(struct gpio_chip *chip, unsigned int off) ...@@ -221,15 +221,13 @@ static int adp5588_gpio_get_value(struct gpio_chip *chip, unsigned int off)
unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]);
int val; int val;
mutex_lock(&kpad->gpio_lock); guard(mutex)(&kpad->gpio_lock);
if (kpad->dir[bank] & bit) if (kpad->dir[bank] & bit)
val = kpad->dat_out[bank]; val = kpad->dat_out[bank];
else else
val = adp5588_read(kpad->client, GPIO_DAT_STAT1 + bank); val = adp5588_read(kpad->client, GPIO_DAT_STAT1 + bank);
mutex_unlock(&kpad->gpio_lock);
return !!(val & bit); return !!(val & bit);
} }
...@@ -240,7 +238,7 @@ static void adp5588_gpio_set_value(struct gpio_chip *chip, ...@@ -240,7 +238,7 @@ static void adp5588_gpio_set_value(struct gpio_chip *chip,
unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]);
unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]);
mutex_lock(&kpad->gpio_lock); guard(mutex)(&kpad->gpio_lock);
if (val) if (val)
kpad->dat_out[bank] |= bit; kpad->dat_out[bank] |= bit;
...@@ -248,8 +246,6 @@ static void adp5588_gpio_set_value(struct gpio_chip *chip, ...@@ -248,8 +246,6 @@ static void adp5588_gpio_set_value(struct gpio_chip *chip,
kpad->dat_out[bank] &= ~bit; kpad->dat_out[bank] &= ~bit;
adp5588_write(kpad->client, GPIO_DAT_OUT1 + bank, kpad->dat_out[bank]); adp5588_write(kpad->client, GPIO_DAT_OUT1 + bank, kpad->dat_out[bank]);
mutex_unlock(&kpad->gpio_lock);
} }
static int adp5588_gpio_set_config(struct gpio_chip *chip, unsigned int off, static int adp5588_gpio_set_config(struct gpio_chip *chip, unsigned int off,
...@@ -259,7 +255,6 @@ static int adp5588_gpio_set_config(struct gpio_chip *chip, unsigned int off, ...@@ -259,7 +255,6 @@ static int adp5588_gpio_set_config(struct gpio_chip *chip, unsigned int off,
unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]);
unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]);
bool pull_disable; bool pull_disable;
int ret;
switch (pinconf_to_config_param(config)) { switch (pinconf_to_config_param(config)) {
case PIN_CONFIG_BIAS_PULL_UP: case PIN_CONFIG_BIAS_PULL_UP:
...@@ -272,19 +267,15 @@ static int adp5588_gpio_set_config(struct gpio_chip *chip, unsigned int off, ...@@ -272,19 +267,15 @@ static int adp5588_gpio_set_config(struct gpio_chip *chip, unsigned int off,
return -ENOTSUPP; return -ENOTSUPP;
} }
mutex_lock(&kpad->gpio_lock); guard(mutex)(&kpad->gpio_lock);
if (pull_disable) if (pull_disable)
kpad->pull_dis[bank] |= bit; kpad->pull_dis[bank] |= bit;
else else
kpad->pull_dis[bank] &= bit; kpad->pull_dis[bank] &= bit;
ret = adp5588_write(kpad->client, GPIO_PULL1 + bank, return adp5588_write(kpad->client, GPIO_PULL1 + bank,
kpad->pull_dis[bank]); kpad->pull_dis[bank]);
mutex_unlock(&kpad->gpio_lock);
return ret;
} }
static int adp5588_gpio_direction_input(struct gpio_chip *chip, unsigned int off) static int adp5588_gpio_direction_input(struct gpio_chip *chip, unsigned int off)
...@@ -292,16 +283,11 @@ static int adp5588_gpio_direction_input(struct gpio_chip *chip, unsigned int off ...@@ -292,16 +283,11 @@ static int adp5588_gpio_direction_input(struct gpio_chip *chip, unsigned int off
struct adp5588_kpad *kpad = gpiochip_get_data(chip); struct adp5588_kpad *kpad = gpiochip_get_data(chip);
unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]);
unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]);
int ret;
mutex_lock(&kpad->gpio_lock); guard(mutex)(&kpad->gpio_lock);
kpad->dir[bank] &= ~bit; kpad->dir[bank] &= ~bit;
ret = adp5588_write(kpad->client, GPIO_DIR1 + bank, kpad->dir[bank]); return adp5588_write(kpad->client, GPIO_DIR1 + bank, kpad->dir[bank]);
mutex_unlock(&kpad->gpio_lock);
return ret;
} }
static int adp5588_gpio_direction_output(struct gpio_chip *chip, static int adp5588_gpio_direction_output(struct gpio_chip *chip,
...@@ -310,9 +296,9 @@ static int adp5588_gpio_direction_output(struct gpio_chip *chip, ...@@ -310,9 +296,9 @@ static int adp5588_gpio_direction_output(struct gpio_chip *chip,
struct adp5588_kpad *kpad = gpiochip_get_data(chip); struct adp5588_kpad *kpad = gpiochip_get_data(chip);
unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]);
unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]);
int ret; int error;
mutex_lock(&kpad->gpio_lock); guard(mutex)(&kpad->gpio_lock);
kpad->dir[bank] |= bit; kpad->dir[bank] |= bit;
...@@ -321,17 +307,16 @@ static int adp5588_gpio_direction_output(struct gpio_chip *chip, ...@@ -321,17 +307,16 @@ static int adp5588_gpio_direction_output(struct gpio_chip *chip,
else else
kpad->dat_out[bank] &= ~bit; kpad->dat_out[bank] &= ~bit;
ret = adp5588_write(kpad->client, GPIO_DAT_OUT1 + bank, error = adp5588_write(kpad->client, GPIO_DAT_OUT1 + bank,
kpad->dat_out[bank]); kpad->dat_out[bank]);
if (ret) if (error)
goto out_unlock; return error;
ret = adp5588_write(kpad->client, GPIO_DIR1 + bank, kpad->dir[bank]);
out_unlock: error = adp5588_write(kpad->client, GPIO_DIR1 + bank, kpad->dir[bank]);
mutex_unlock(&kpad->gpio_lock); if (error)
return error;
return ret; return 0;
} }
static int adp5588_build_gpiomap(struct adp5588_kpad *kpad) static int adp5588_build_gpiomap(struct adp5588_kpad *kpad)
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment