pinctrl: npcm7xx: Switch to use for_each_gpiochip_node() helper

Switch the code to use for_each_gpiochip_node() helper.

While at it, in order to avoid additional churn in the future,
do the following:
- use a temporary variable for struct device pointer to shorten a few lines
- get rid of a temporary variable for vIRQ number, assign it directly
- switch to fwnode APIs where it makes sense

Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
This commit is contained in:
Andy Shevchenko 2022-04-01 13:35:59 +03:00
Родитель 5e455dd933
Коммит 0173ce55e5
1 изменённых файлов: 60 добавлений и 78 удалений

Просмотреть файл

@ -17,6 +17,7 @@
#include <linux/pinctrl/pinctrl.h> #include <linux/pinctrl/pinctrl.h>
#include <linux/pinctrl/pinmux.h> #include <linux/pinctrl/pinmux.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/property.h>
#include <linux/regmap.h> #include <linux/regmap.h>
/* GCR registers */ /* GCR registers */
@ -1862,85 +1863,66 @@ static int npcm7xx_gpio_of(struct npcm7xx_pinctrl *pctrl)
{ {
int ret = -ENXIO; int ret = -ENXIO;
struct resource res; struct resource res;
int id = 0, irq; struct device *dev = pctrl->dev;
struct device_node *np; struct fwnode_reference_args args;
struct of_phandle_args pinspec; struct fwnode_handle *child;
int id = 0;
for_each_gpiochip_node(dev, child) {
struct device_node *np = to_of_node(child);
for_each_available_child_of_node(pctrl->dev->of_node, np)
if (of_find_property(np, "gpio-controller", NULL)) {
ret = of_address_to_resource(np, 0, &res); ret = of_address_to_resource(np, 0, &res);
if (ret < 0) { if (ret < 0) {
dev_err(pctrl->dev, dev_err(dev, "Resource fail for GPIO bank %u\n", id);
"Resource fail for GPIO bank %u\n", id);
return ret; return ret;
} }
pctrl->gpio_bank[id].base = pctrl->gpio_bank[id].base = ioremap(res.start, resource_size(&res));
ioremap(res.start, resource_size(&res));
irq = irq_of_parse_and_map(np, 0); ret = bgpio_init(&pctrl->gpio_bank[id].gc, dev, 4,
if (irq < 0) { pctrl->gpio_bank[id].base + NPCM7XX_GP_N_DIN,
dev_err(pctrl->dev, pctrl->gpio_bank[id].base + NPCM7XX_GP_N_DOUT,
"No IRQ for GPIO bank %u\n", id);
ret = irq;
return ret;
}
ret = bgpio_init(&pctrl->gpio_bank[id].gc,
pctrl->dev, 4,
pctrl->gpio_bank[id].base +
NPCM7XX_GP_N_DIN,
pctrl->gpio_bank[id].base +
NPCM7XX_GP_N_DOUT,
NULL, NULL,
NULL, NULL,
pctrl->gpio_bank[id].base + pctrl->gpio_bank[id].base + NPCM7XX_GP_N_IEM,
NPCM7XX_GP_N_IEM,
BGPIOF_READ_OUTPUT_REG_SET); BGPIOF_READ_OUTPUT_REG_SET);
if (ret) { if (ret) {
dev_err(pctrl->dev, "bgpio_init() failed\n"); dev_err(dev, "bgpio_init() failed\n");
return ret; return ret;
} }
ret = of_parse_phandle_with_fixed_args(np, ret = fwnode_property_get_reference_args(child, "gpio-ranges", NULL, 3, 0, &args);
"gpio-ranges", 3,
0, &pinspec);
if (ret < 0) { if (ret < 0) {
dev_err(pctrl->dev, dev_err(dev, "gpio-ranges fail for GPIO bank %u\n", id);
"gpio-ranges fail for GPIO bank %u\n",
id);
return ret; return ret;
} }
pctrl->gpio_bank[id].irq = irq; ret = irq_of_parse_and_map(np, 0);
if (ret < 0) {
dev_err(dev, "No IRQ for GPIO bank %u\n", id);
return ret;
}
pctrl->gpio_bank[id].irq = ret;
pctrl->gpio_bank[id].irq_chip = npcmgpio_irqchip; pctrl->gpio_bank[id].irq_chip = npcmgpio_irqchip;
pctrl->gpio_bank[id].gc.parent = pctrl->dev; pctrl->gpio_bank[id].irqbase = id * NPCM7XX_GPIO_PER_BANK;
pctrl->gpio_bank[id].irqbase = pctrl->gpio_bank[id].pinctrl_id = args.args[0];
id * NPCM7XX_GPIO_PER_BANK; pctrl->gpio_bank[id].gc.base = args.args[1];
pctrl->gpio_bank[id].pinctrl_id = pinspec.args[0]; pctrl->gpio_bank[id].gc.ngpio = args.args[2];
pctrl->gpio_bank[id].gc.base = pinspec.args[1];
pctrl->gpio_bank[id].gc.ngpio = pinspec.args[2];
pctrl->gpio_bank[id].gc.owner = THIS_MODULE; pctrl->gpio_bank[id].gc.owner = THIS_MODULE;
pctrl->gpio_bank[id].gc.label = pctrl->gpio_bank[id].gc.parent = dev;
devm_kasprintf(pctrl->dev, GFP_KERNEL, "%pOF", pctrl->gpio_bank[id].gc.fwnode = child;
np); pctrl->gpio_bank[id].gc.label = devm_kasprintf(dev, GFP_KERNEL, "%pfw", child);
if (pctrl->gpio_bank[id].gc.label == NULL) if (pctrl->gpio_bank[id].gc.label == NULL)
return -ENOMEM; return -ENOMEM;
pctrl->gpio_bank[id].gc.dbg_show = npcmgpio_dbg_show; pctrl->gpio_bank[id].gc.dbg_show = npcmgpio_dbg_show;
pctrl->gpio_bank[id].direction_input = pctrl->gpio_bank[id].direction_input = pctrl->gpio_bank[id].gc.direction_input;
pctrl->gpio_bank[id].gc.direction_input; pctrl->gpio_bank[id].gc.direction_input = npcmgpio_direction_input;
pctrl->gpio_bank[id].gc.direction_input = pctrl->gpio_bank[id].direction_output = pctrl->gpio_bank[id].gc.direction_output;
npcmgpio_direction_input; pctrl->gpio_bank[id].gc.direction_output = npcmgpio_direction_output;
pctrl->gpio_bank[id].direction_output = pctrl->gpio_bank[id].request = pctrl->gpio_bank[id].gc.request;
pctrl->gpio_bank[id].gc.direction_output;
pctrl->gpio_bank[id].gc.direction_output =
npcmgpio_direction_output;
pctrl->gpio_bank[id].request =
pctrl->gpio_bank[id].gc.request;
pctrl->gpio_bank[id].gc.request = npcmgpio_gpio_request; pctrl->gpio_bank[id].gc.request = npcmgpio_gpio_request;
pctrl->gpio_bank[id].gc.free = npcmgpio_gpio_free; pctrl->gpio_bank[id].gc.free = npcmgpio_gpio_free;
pctrl->gpio_bank[id].gc.of_node = np;
id++; id++;
} }