From: Alexander Shiyan <shc_work@mail.ru>
To: barebox@lists.infradead.org
Subject: [PATCH v2] GPIO: Add gpio_to_desc helper
Date: Thu, 16 May 2013 02:13:28 +0400 [thread overview]
Message-ID: <1368656008-13621-1-git-send-email-shc_work@mail.ru> (raw)
Patch adds gpio_to_desc helper for validate GPIO.
A bit optimization is performed (about -160 bytes on ARM).
Signed-off-by: Alexander Shiyan <shc_work@mail.ru>
---
drivers/gpio/gpiolib.c | 95 +++++++++++++++++++++++++++-----------------------
1 file changed, 51 insertions(+), 44 deletions(-)
diff --git a/drivers/gpio/gpiolib.c b/drivers/gpio/gpiolib.c
index 6398268..ca6e8ad 100644
--- a/drivers/gpio/gpiolib.c
+++ b/drivers/gpio/gpiolib.c
@@ -1,3 +1,5 @@
+#define pr_fmt(fmt) "gpiolib: " fmt
+
#include <init.h>
#include <common.h>
#include <command.h>
@@ -32,20 +34,30 @@ static int gpio_ensure_requested(struct gpio_info *gi, int gpio)
return gpio_request(gpio, "gpio");
}
+static struct gpio_info *gpio_to_desc(unsigned gpio)
+{
+ if (gpio_is_valid(gpio))
+ if (gpio_desc[gpio].chip)
+ return &gpio_desc[gpio];
+
+ pr_warning("invalid GPIO %d\n", gpio);
+
+ return NULL;
+}
+
int gpio_request(unsigned gpio, const char *label)
{
- struct gpio_info *gi = &gpio_desc[gpio];
- struct gpio_chip *chip = gi->chip;
+ struct gpio_info *gi = gpio_to_desc(gpio);
int ret;
- if (!gpio_is_valid(gpio))
- return -EINVAL;
- if (!chip)
- return -EINVAL;
+ if (!gi)
+ return -ENODEV;
+
if (gi->requested)
return -EBUSY;
- if (chip->ops->request) {
- ret = chip->ops->request(chip, gpio - chip->base);
+
+ if (gi->chip->ops->request) {
+ ret = gi->chip->ops->request(gi->chip, gpio - gi->chip->base);
if (ret)
return ret;
}
@@ -58,17 +70,16 @@ int gpio_request(unsigned gpio, const char *label)
void gpio_free(unsigned gpio)
{
- struct gpio_info *gi = &gpio_desc[gpio];
- struct gpio_chip *chip = gi->chip;
+ struct gpio_info *gi = gpio_to_desc(gpio);
- if (!gpio_is_valid(gpio))
- return;
- if (!chip)
+ if (!gi)
return;
+
if (!gi->requested)
return;
- if (chip->ops->free)
- chip->ops->free(chip, gpio - chip->base);
+
+ if (gi->chip->ops->free)
+ gi->chip->ops->free(gi->chip, gpio - gi->chip->base);
gi->requested = false;
free(gi->label);
@@ -76,75 +87,71 @@ void gpio_free(unsigned gpio)
void gpio_set_value(unsigned gpio, int value)
{
- struct gpio_info *gi = &gpio_desc[gpio];
- struct gpio_chip *chip = gi->chip;
+ struct gpio_info *gi = gpio_to_desc(gpio);
- if (!gpio_is_valid(gpio))
- return;
- if (!chip)
+ if (!gi)
return;
+
if (gpio_ensure_requested(gi, gpio))
return;
- if (!chip->ops->set)
- return;
- chip->ops->set(chip, gpio - chip->base, value);
+
+ if (gi->chip->ops->set)
+ gi->chip->ops->set(gi->chip, gpio - gi->chip->base, value);
}
EXPORT_SYMBOL(gpio_set_value);
int gpio_get_value(unsigned gpio)
{
- struct gpio_info *gi = &gpio_desc[gpio];
- struct gpio_chip *chip = gi->chip;
+ struct gpio_info *gi = gpio_to_desc(gpio);
int ret;
- if (!gpio_is_valid(gpio))
- return -EINVAL;
- if (!chip)
+ if (!gi)
return -ENODEV;
+
ret = gpio_ensure_requested(gi, gpio);
if (ret)
return ret;
- if (!chip->ops->get)
+
+ if (!gi->chip->ops->get)
return -ENOSYS;
- return chip->ops->get(chip, gpio - chip->base);
+ return gi->chip->ops->get(gi->chip, gpio - gi->chip->base);
}
EXPORT_SYMBOL(gpio_get_value);
int gpio_direction_output(unsigned gpio, int value)
{
- struct gpio_info *gi = &gpio_desc[gpio];
- struct gpio_chip *chip = gi->chip;
+ struct gpio_info *gi = gpio_to_desc(gpio);
int ret;
- if (!gpio_is_valid(gpio))
- return -EINVAL;
- if (!chip)
+ if (!gi)
return -ENODEV;
+
ret = gpio_ensure_requested(gi, gpio);
if (ret)
return ret;
- if (!chip->ops->direction_output)
+
+ if (!gi->chip->ops->direction_output)
return -ENOSYS;
- return chip->ops->direction_output(chip, gpio - chip->base, value);
+ return gi->chip->ops->direction_output(gi->chip, gpio - gi->chip->base,
+ value);
}
EXPORT_SYMBOL(gpio_direction_output);
int gpio_direction_input(unsigned gpio)
{
- struct gpio_info *gi = &gpio_desc[gpio];
- struct gpio_chip *chip = gi->chip;
+ struct gpio_info *gi = gpio_to_desc(gpio);
int ret;
- if (!gpio_is_valid(gpio))
- return -EINVAL;
- if (!chip)
+ if (!gi)
return -ENODEV;
+
ret = gpio_ensure_requested(gi, gpio);
if (ret)
return ret;
- if (!chip->ops->direction_input)
+
+ if (!gi->chip->ops->direction_input)
return -ENOSYS;
- return chip->ops->direction_input(chip, gpio - chip->base);
+ return gi->chip->ops->direction_input(gi->chip, gpio - gi->chip->base);
}
EXPORT_SYMBOL(gpio_direction_input);
--
1.8.1.5
_______________________________________________
barebox mailing list
barebox@lists.infradead.org
http://lists.infradead.org/mailman/listinfo/barebox
next reply other threads:[~2013-05-15 22:17 UTC|newest]
Thread overview: 2+ messages / expand[flat|nested] mbox.gz Atom feed top
2013-05-15 22:13 Alexander Shiyan [this message]
2013-05-17 5:46 ` Sascha Hauer
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=1368656008-13621-1-git-send-email-shc_work@mail.ru \
--to=shc_work@mail.ru \
--cc=barebox@lists.infradead.org \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox