提交 fc4e2514 编写于 作者: R Ryan Mallon 提交者: Linus Walleij

gpiolib: Refactor gpio_export

The gpio_export function uses nested if statements and the status
variable to handle the failure cases. This makes the function logic
difficult to follow. Refactor the code to abort immediately on failure
using goto. This makes the code slightly longer, but significantly
reduces the nesting and number of split lines and makes the code easier
to read.
Signed-off-by: NRyan Mallon <rmallon@gmail.com>
Signed-off-by: NLinus Walleij <linus.walleij@linaro.org>
上级 67a0d499
...@@ -702,8 +702,9 @@ int gpio_export(unsigned gpio, bool direction_may_change) ...@@ -702,8 +702,9 @@ int gpio_export(unsigned gpio, bool direction_may_change)
{ {
unsigned long flags; unsigned long flags;
struct gpio_desc *desc; struct gpio_desc *desc;
int status = -EINVAL; int status;
const char *ioname = NULL; const char *ioname = NULL;
struct device *dev;
/* can't export until sysfs is available ... */ /* can't export until sysfs is available ... */
if (!gpio_class.p) { if (!gpio_class.p) {
...@@ -711,59 +712,65 @@ int gpio_export(unsigned gpio, bool direction_may_change) ...@@ -711,59 +712,65 @@ int gpio_export(unsigned gpio, bool direction_may_change)
return -ENOENT; return -ENOENT;
} }
if (!gpio_is_valid(gpio)) if (!gpio_is_valid(gpio)) {
goto done; pr_debug("%s: gpio %d is not valid\n", __func__, gpio);
return -EINVAL;
}
mutex_lock(&sysfs_lock); mutex_lock(&sysfs_lock);
spin_lock_irqsave(&gpio_lock, flags); spin_lock_irqsave(&gpio_lock, flags);
desc = &gpio_desc[gpio]; desc = &gpio_desc[gpio];
if (test_bit(FLAG_REQUESTED, &desc->flags) if (!test_bit(FLAG_REQUESTED, &desc->flags) ||
&& !test_bit(FLAG_EXPORT, &desc->flags)) { test_bit(FLAG_EXPORT, &desc->flags)) {
status = 0; spin_unlock_irqrestore(&gpio_lock, flags);
if (!desc->chip->direction_input pr_debug("%s: gpio %d unavailable (requested=%d, exported=%d)\n",
|| !desc->chip->direction_output) __func__, gpio,
direction_may_change = false; test_bit(FLAG_REQUESTED, &desc->flags),
test_bit(FLAG_EXPORT, &desc->flags));
return -EPERM;
} }
if (!desc->chip->direction_input || !desc->chip->direction_output)
direction_may_change = false;
spin_unlock_irqrestore(&gpio_lock, flags); spin_unlock_irqrestore(&gpio_lock, flags);
if (desc->chip->names && desc->chip->names[gpio - desc->chip->base]) if (desc->chip->names && desc->chip->names[gpio - desc->chip->base])
ioname = desc->chip->names[gpio - desc->chip->base]; ioname = desc->chip->names[gpio - desc->chip->base];
if (status == 0) {
struct device *dev;
dev = device_create(&gpio_class, desc->chip->dev, MKDEV(0, 0), dev = device_create(&gpio_class, desc->chip->dev, MKDEV(0, 0),
desc, ioname ? ioname : "gpio%u", gpio); desc, ioname ? ioname : "gpio%u", gpio);
if (!IS_ERR(dev)) { if (IS_ERR(dev)) {
status = sysfs_create_group(&dev->kobj, status = PTR_ERR(dev);
&gpio_attr_group); goto fail_unlock;
}
if (!status && direction_may_change) status = sysfs_create_group(&dev->kobj, &gpio_attr_group);
status = device_create_file(dev, if (status)
&dev_attr_direction); goto fail_unregister_device;
if (!status && gpio_to_irq(gpio) >= 0 if (direction_may_change) {
&& (direction_may_change status = device_create_file(dev, &dev_attr_direction);
|| !test_bit(FLAG_IS_OUT, if (status)
&desc->flags))) goto fail_unregister_device;
status = device_create_file(dev, }
&dev_attr_edge);
if (status != 0) if (gpio_to_irq(gpio) >= 0 && (direction_may_change ||
device_unregister(dev); !test_bit(FLAG_IS_OUT, &desc->flags))) {
} else status = device_create_file(dev, &dev_attr_edge);
status = PTR_ERR(dev); if (status)
if (status == 0) goto fail_unregister_device;
set_bit(FLAG_EXPORT, &desc->flags);
} }
set_bit(FLAG_EXPORT, &desc->flags);
mutex_unlock(&sysfs_lock); mutex_unlock(&sysfs_lock);
return 0;
done: fail_unregister_device:
if (status) device_unregister(dev);
fail_unlock:
mutex_unlock(&sysfs_lock);
pr_debug("%s: gpio%d status %d\n", __func__, gpio, status); pr_debug("%s: gpio%d status %d\n", __func__, gpio, status);
return status; return status;
} }
EXPORT_SYMBOL_GPL(gpio_export); EXPORT_SYMBOL_GPL(gpio_export);
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册