Skip to content

Commit

Permalink
gpio: brcmstb: Use dynamic GPIO base numbers
Browse files Browse the repository at this point in the history
Forcing a gpiochip to have a fixed base number now leads to a warning
message. Remove the need to do so by calculating hwirq numbers based
on bank numbers.

Signed-off-by: Phil Elwell <[email protected]>
Fixes: 3b0213d ("gpio: Add GPIO support for Broadcom STB SoCs")
  • Loading branch information
pelwell authored and popcornmix committed Oct 9, 2023
1 parent eed2e53 commit 7f5c05d
Showing 1 changed file with 10 additions and 11 deletions.
21 changes: 10 additions & 11 deletions drivers/gpio/gpio-brcmstb.c
Original file line number Diff line number Diff line change
Expand Up @@ -50,7 +50,6 @@ struct brcmstb_gpio_priv {
struct irq_domain *irq_domain;
struct irq_chip irq_chip;
int parent_irq;
int gpio_base;
int num_gpios;
int parent_wake_irq;
};
Expand Down Expand Up @@ -92,7 +91,7 @@ brcmstb_gpio_get_active_irqs(struct brcmstb_gpio_bank *bank)
static int brcmstb_gpio_hwirq_to_offset(irq_hw_number_t hwirq,
struct brcmstb_gpio_bank *bank)
{
return hwirq - (bank->gc.base - bank->parent_priv->gpio_base);
return hwirq - bank->id * 32;
}

static void brcmstb_gpio_set_imask(struct brcmstb_gpio_bank *bank,
Expand All @@ -117,8 +116,9 @@ static void brcmstb_gpio_set_imask(struct brcmstb_gpio_bank *bank,
static int brcmstb_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
{
struct brcmstb_gpio_priv *priv = brcmstb_gpio_gc_to_priv(gc);
struct brcmstb_gpio_bank *bank = gpiochip_get_data(gc);
/* gc_offset is relative to this gpio_chip; want real offset */
int hwirq = offset + (gc->base - priv->gpio_base);
int hwirq = offset + bank->id * 32;

if (hwirq >= priv->num_gpios)
return -ENXIO;
Expand Down Expand Up @@ -263,7 +263,7 @@ static void brcmstb_gpio_irq_bank_handler(struct brcmstb_gpio_bank *bank)
{
struct brcmstb_gpio_priv *priv = bank->parent_priv;
struct irq_domain *domain = priv->irq_domain;
int hwbase = bank->gc.base - priv->gpio_base;
int hwbase = bank->id * 32;
unsigned long status;

while ((status = brcmstb_gpio_get_active_irqs(bank))) {
Expand Down Expand Up @@ -414,7 +414,7 @@ static int brcmstb_gpio_of_xlate(struct gpio_chip *gc,
if (WARN_ON(gpiospec->args_count < gc->of_gpio_n_cells))
return -EINVAL;

offset = gpiospec->args[0] - (gc->base - priv->gpio_base);
offset = gpiospec->args[0] - bank->id * 32;
if (offset >= gc->ngpio || offset < 0)
return -EINVAL;

Expand Down Expand Up @@ -598,8 +598,8 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
const __be32 *p;
u32 bank_width;
int num_banks = 0;
int num_gpios = 0;
int err;
static int gpio_base;
unsigned long flags = 0;
bool need_wakeup_event = false;

Expand All @@ -613,7 +613,6 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
if (IS_ERR(reg_base))
return PTR_ERR(reg_base);

priv->gpio_base = gpio_base;
priv->reg_base = reg_base;
priv->pdev = pdev;

Expand Down Expand Up @@ -655,7 +654,7 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
dev_dbg(dev, "Width 0 found: Empty bank @ %d\n",
num_banks);
num_banks++;
gpio_base += MAX_GPIO_PER_BANK;
num_gpios += MAX_GPIO_PER_BANK;
continue;
}

Expand Down Expand Up @@ -697,7 +696,7 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
err = -ENOMEM;
goto fail;
}
gc->base = gpio_base;
gc->base = -1;
gc->of_gpio_n_cells = 2;
gc->of_xlate = brcmstb_gpio_of_xlate;
/* not all ngpio lines are valid, will use bank width later */
Expand All @@ -721,7 +720,7 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
bank->id);
goto fail;
}
gpio_base += gc->ngpio;
num_gpios += gc->ngpio;

dev_dbg(dev, "bank=%d, base=%d, ngpio=%d, width=%d\n", bank->id,
gc->base, gc->ngpio, bank->width);
Expand All @@ -732,7 +731,7 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
num_banks++;
}

priv->num_gpios = gpio_base - priv->gpio_base;
priv->num_gpios = num_gpios;
if (priv->parent_irq > 0) {
err = brcmstb_gpio_irq_setup(pdev, priv);
if (err)
Expand Down

0 comments on commit 7f5c05d

Please sign in to comment.