Commit 1a2d397a authored by Grant Likely's avatar Grant Likely

gpio/powerpc: Eliminate duplication of of_get_named_gpio_flags()

A large chunk of qe_pin_request() is unnecessarily cut-and-paste
directly from of_get_named_gpio_flags().  This patch cuts out the
duplicate code and replaces it with a call to of_get_gpio().

v2: fixed compile error due to missing gpio_to_chip()
Signed-off-by: default avatarGrant Likely <grant.likely@secretlab.ca>
Cc: Benjamin Herrenschmidt <benh@kernel.crashing.org>
Cc: Kumar Gala <galak@kernel.crashing.org>
parent fe9f6844
...@@ -139,14 +139,10 @@ struct qe_pin { ...@@ -139,14 +139,10 @@ struct qe_pin {
struct qe_pin *qe_pin_request(struct device_node *np, int index) struct qe_pin *qe_pin_request(struct device_node *np, int index)
{ {
struct qe_pin *qe_pin; struct qe_pin *qe_pin;
struct device_node *gpio_np;
struct gpio_chip *gc; struct gpio_chip *gc;
struct of_mm_gpio_chip *mm_gc; struct of_mm_gpio_chip *mm_gc;
struct qe_gpio_chip *qe_gc; struct qe_gpio_chip *qe_gc;
int err; int err;
int size;
const void *gpio_spec;
const u32 *gpio_cells;
unsigned long flags; unsigned long flags;
qe_pin = kzalloc(sizeof(*qe_pin), GFP_KERNEL); qe_pin = kzalloc(sizeof(*qe_pin), GFP_KERNEL);
...@@ -155,45 +151,25 @@ struct qe_pin *qe_pin_request(struct device_node *np, int index) ...@@ -155,45 +151,25 @@ struct qe_pin *qe_pin_request(struct device_node *np, int index)
return ERR_PTR(-ENOMEM); return ERR_PTR(-ENOMEM);
} }
err = of_parse_phandles_with_args(np, "gpios", "#gpio-cells", index, err = of_get_gpio(np, index);
&gpio_np, &gpio_spec); if (err < 0)
if (err) { goto err0;
pr_debug("%s: can't parse gpios property\n", __func__); gc = gpio_to_chip(err);
if (WARN_ON(!gc))
goto err0; goto err0;
}
if (!of_device_is_compatible(gpio_np, "fsl,mpc8323-qe-pario-bank")) { if (!of_device_is_compatible(gc->of_node, "fsl,mpc8323-qe-pario-bank")) {
pr_debug("%s: tried to get a non-qe pin\n", __func__); pr_debug("%s: tried to get a non-qe pin\n", __func__);
err = -EINVAL; err = -EINVAL;
goto err1; goto err0;
}
gc = of_node_to_gpiochip(gpio_np);
if (!gc) {
pr_debug("%s: gpio controller %s isn't registered\n",
np->full_name, gpio_np->full_name);
err = -ENODEV;
goto err1;
}
gpio_cells = of_get_property(gpio_np, "#gpio-cells", &size);
if (!gpio_cells || size != sizeof(*gpio_cells) ||
*gpio_cells != gc->of_gpio_n_cells) {
pr_debug("%s: wrong #gpio-cells for %s\n",
np->full_name, gpio_np->full_name);
err = -EINVAL;
goto err1;
} }
err = gc->of_xlate(gc, np, gpio_spec, NULL);
if (err < 0)
goto err1;
mm_gc = to_of_mm_gpio_chip(gc); mm_gc = to_of_mm_gpio_chip(gc);
qe_gc = to_qe_gpio_chip(mm_gc); qe_gc = to_qe_gpio_chip(mm_gc);
spin_lock_irqsave(&qe_gc->lock, flags); spin_lock_irqsave(&qe_gc->lock, flags);
err -= gc->base;
if (test_and_set_bit(QE_PIN_REQUESTED, &qe_gc->pin_flags[err]) == 0) { if (test_and_set_bit(QE_PIN_REQUESTED, &qe_gc->pin_flags[err]) == 0) {
qe_pin->controller = qe_gc; qe_pin->controller = qe_gc;
qe_pin->num = err; qe_pin->num = err;
...@@ -206,8 +182,6 @@ struct qe_pin *qe_pin_request(struct device_node *np, int index) ...@@ -206,8 +182,6 @@ struct qe_pin *qe_pin_request(struct device_node *np, int index)
if (!err) if (!err)
return qe_pin; return qe_pin;
err1:
of_node_put(gpio_np);
err0: err0:
kfree(qe_pin); kfree(qe_pin);
pr_debug("%s failed with status %d\n", __func__, err); pr_debug("%s failed with status %d\n", __func__, err);
......
...@@ -114,7 +114,7 @@ static int gpio_ensure_requested(struct gpio_desc *desc, unsigned offset) ...@@ -114,7 +114,7 @@ static int gpio_ensure_requested(struct gpio_desc *desc, unsigned offset)
} }
/* caller holds gpio_lock *OR* gpio is marked as requested */ /* caller holds gpio_lock *OR* gpio is marked as requested */
static inline struct gpio_chip *gpio_to_chip(unsigned gpio) struct gpio_chip *gpio_to_chip(unsigned gpio)
{ {
return gpio_desc[gpio].chip; return gpio_desc[gpio].chip;
} }
......
...@@ -135,6 +135,7 @@ struct gpio_chip { ...@@ -135,6 +135,7 @@ struct gpio_chip {
extern const char *gpiochip_is_requested(struct gpio_chip *chip, extern const char *gpiochip_is_requested(struct gpio_chip *chip,
unsigned offset); unsigned offset);
extern struct gpio_chip *gpio_to_chip(unsigned gpio);
extern int __must_check gpiochip_reserve(int start, int ngpio); extern int __must_check gpiochip_reserve(int start, int ngpio);
/* add/remove chips */ /* add/remove chips */
......
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