hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

gpio-tz1090: convert to use generic irqchip 

Convert gpio-tz1090 driver to use generic irqchips. This allows the
irq_ack, irq_mask, and irq_unmask callbacks and associated helper
functions to be removed. Also switch to using irq_setup_alt_chip() in
the irq_set_type callback instead of using __irq_set_handler_locked().

Signed-off-by: James Hogan <james.hogan@imgtec.com>
Cc: Linus Walleij <linus.walleij@linaro.org>
Cc: Grant Likely <grant.likely@linaro.org>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
James Hogan 2013-06-25 15:27:45 +01:00 committed by Linus Walleij
parent 79bb646001
commit 04777396d8
2 changed files with 49 additions and 75 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
drivers/gpio/Kconfig
View File

@ -245,6 +245,7 @@ config GPIO_TS5500
config GPIO_TZ1090 config GPIO_TZ1090
bool "Toumaz Xenif TZ1090 GPIO support" bool "Toumaz Xenif TZ1090 GPIO support"
depends on SOC_TZ1090 depends on SOC_TZ1090
select GENERIC_IRQ_CHIP
default y default y
help help
Say yes here to support Toumaz Xenif TZ1090 GPIOs. Say yes here to support Toumaz Xenif TZ1090 GPIOs.

123
drivers/gpio/gpio-tz1090.c
View File

@ -270,30 +270,12 @@ static inline struct tz1090_gpio_bank *irqd_to_gpio_bank(struct irq_data *data)
return (struct tz1090_gpio_bank *)data->domain->host_data; return (struct tz1090_gpio_bank *)data->domain->host_data;
} }
static void tz1090_gpio_irq_clear(struct tz1090_gpio_bank *bank,
unsigned int offset)
{
tz1090_gpio_clear_bit(bank, REG_GPIO_IRQ_STS, offset);
}
static void tz1090_gpio_irq_enable(struct tz1090_gpio_bank *bank,
unsigned int offset, bool enable)
{
tz1090_gpio_mod_bit(bank, REG_GPIO_IRQ_EN, offset, enable);
}
static void tz1090_gpio_irq_polarity(struct tz1090_gpio_bank *bank, static void tz1090_gpio_irq_polarity(struct tz1090_gpio_bank *bank,
unsigned int offset, unsigned int polarity) unsigned int offset, unsigned int polarity)
{ {
tz1090_gpio_mod_bit(bank, REG_GPIO_IRQ_PLRT, offset, polarity); tz1090_gpio_mod_bit(bank, REG_GPIO_IRQ_PLRT, offset, polarity);
} }
static int tz1090_gpio_valid_handler(struct irq_desc *desc)
{
return desc->handle_irq == handle_level_irq ||
desc->handle_irq == handle_edge_irq;
}
static void tz1090_gpio_irq_type(struct tz1090_gpio_bank *bank, static void tz1090_gpio_irq_type(struct tz1090_gpio_bank *bank,
unsigned int offset, unsigned int type) unsigned int offset, unsigned int type)
{ {
@ -320,43 +302,18 @@ static void tz1090_gpio_irq_next_edge(struct tz1090_gpio_bank *bank,
__global_unlock2(lstat); __global_unlock2(lstat);
} }
static void gpio_ack_irq(struct irq_data *data)
{
struct tz1090_gpio_bank *bank = irqd_to_gpio_bank(data);
tz1090_gpio_irq_clear(bank, data->hwirq);
}
static void gpio_mask_irq(struct irq_data *data)
{
struct tz1090_gpio_bank *bank = irqd_to_gpio_bank(data);
tz1090_gpio_irq_enable(bank, data->hwirq, false);
}
static void gpio_unmask_irq(struct irq_data *data)
{
struct tz1090_gpio_bank *bank = irqd_to_gpio_bank(data);
tz1090_gpio_irq_enable(bank, data->hwirq, true);
}
static unsigned int gpio_startup_irq(struct irq_data *data) static unsigned int gpio_startup_irq(struct irq_data *data)
{ {
struct tz1090_gpio_bank *bank = irqd_to_gpio_bank(data);
irq_hw_number_t hw = data->hwirq;
struct irq_desc *desc = irq_to_desc(data->irq);
/* /*
* This warning indicates that the type of the irq hasn't been set * This warning indicates that the type of the irq hasn't been set
* before enabling the irq. This would normally be done by passing some * before enabling the irq. This would normally be done by passing some
* trigger flags to request_irq(). * trigger flags to request_irq().
*/ */
WARN(!tz1090_gpio_valid_handler(desc), WARN(irqd_get_trigger_type(data) == IRQ_TYPE_NONE,
"irq type not set before enabling gpio irq %d", data->irq); "irq type not set before enabling gpio irq %d", data->irq);
tz1090_gpio_irq_clear(bank, hw); irq_gc_ack_clr_bit(data);
tz1090_gpio_irq_enable(bank, hw, true); irq_gc_mask_set_bit(data);
return 0; return 0;
} }
@ -392,10 +349,7 @@ static int gpio_set_irq_type(struct irq_data *data, unsigned int flow_type)
} }
tz1090_gpio_irq_type(bank, data->hwirq, type); tz1090_gpio_irq_type(bank, data->hwirq, type);
if (type == REG_GPIO_IRQ_TYPE_LEVEL) irq_setup_alt_chip(data, flow_type);
__irq_set_handler_locked(data->irq, handle_level_irq);
else
__irq_set_handler_locked(data->irq, handle_edge_irq);
if (flow_type == IRQ_TYPE_EDGE_BOTH) if (flow_type == IRQ_TYPE_EDGE_BOTH)
tz1090_gpio_irq_next_edge(bank, data->hwirq); tz1090_gpio_irq_next_edge(bank, data->hwirq);
@ -421,17 +375,6 @@ static int gpio_set_irq_wake(struct irq_data *data, unsigned int on)
#define gpio_set_irq_wake NULL #define gpio_set_irq_wake NULL
#endif #endif
/* gpio virtual interrupt functions */
static struct irq_chip gpio_irq_chip = {
.irq_startup = gpio_startup_irq,
.irq_ack = gpio_ack_irq,
.irq_mask = gpio_mask_irq,
.irq_unmask = gpio_unmask_irq,
.irq_set_type = gpio_set_irq_type,
.irq_set_wake = gpio_set_irq_wake,
.flags = IRQCHIP_MASK_ON_SUSPEND,
};
static void tz1090_gpio_irq_handler(unsigned int irq, struct irq_desc *desc) static void tz1090_gpio_irq_handler(unsigned int irq, struct irq_desc *desc)
{ {
irq_hw_number_t hw; irq_hw_number_t hw;
@ -457,28 +400,17 @@ static void tz1090_gpio_irq_handler(unsigned int irq, struct irq_desc *desc)
== IRQ_TYPE_EDGE_BOTH) == IRQ_TYPE_EDGE_BOTH)
tz1090_gpio_irq_next_edge(bank, hw); tz1090_gpio_irq_next_edge(bank, hw);
BUG_ON(!tz1090_gpio_valid_handler(child_desc));
generic_handle_irq_desc(irq_no, child_desc); generic_handle_irq_desc(irq_no, child_desc);
} }
} }
static int tz1090_gpio_irq_map(struct irq_domain *d, unsigned int irq,
irq_hw_number_t hw)
{
irq_set_chip(irq, &gpio_irq_chip);
return 0;
}
static const struct irq_domain_ops tz1090_gpio_irq_domain_ops = {
.map = tz1090_gpio_irq_map,
.xlate = irq_domain_xlate_twocell,
};
static int tz1090_gpio_bank_probe(struct tz1090_gpio_bank_info *info) static int tz1090_gpio_bank_probe(struct tz1090_gpio_bank_info *info)
{ {
struct device_node *np = info->node; struct device_node *np = info->node;
struct device *dev = info->priv->dev; struct device *dev = info->priv->dev;
struct tz1090_gpio_bank *bank; struct tz1090_gpio_bank *bank;
struct irq_chip_generic *gc;
int err;
bank = devm_kzalloc(dev, sizeof(*bank), GFP_KERNEL); bank = devm_kzalloc(dev, sizeof(*bank), GFP_KERNEL);
if (!bank) { if (!bank) {
@ -533,9 +465,50 @@ static int tz1090_gpio_bank_probe(struct tz1090_gpio_bank_info *info)
/* Add a virtual IRQ for each GPIO */ /* Add a virtual IRQ for each GPIO */
bank->domain = irq_domain_add_linear(np, bank->domain = irq_domain_add_linear(np,
bank->chip.ngpio, bank->chip.ngpio,
&tz1090_gpio_irq_domain_ops, &irq_generic_chip_ops,
bank); bank);
/* Set up a generic irq chip with 2 chip types (level and edge) */
err = irq_alloc_domain_generic_chips(bank->domain, bank->chip.ngpio, 2,
bank->label, handle_bad_irq, 0, 0,
IRQ_GC_INIT_NESTED_LOCK);
if (err) {
dev_info(dev,
"irq_alloc_domain_generic_chips failed for bank %u, IRQs disabled\n",
info->index);
irq_domain_remove(bank->domain);
return 0;
}
gc = irq_get_domain_generic_chip(bank->domain, 0);
gc->reg_base = bank->reg;
/* level chip type */
gc->chip_types[0].type = IRQ_TYPE_LEVEL_MASK;
gc->chip_types[0].handler = handle_level_irq;
gc->chip_types[0].regs.ack = REG_GPIO_IRQ_STS;
gc->chip_types[0].regs.mask = REG_GPIO_IRQ_EN;
gc->chip_types[0].chip.irq_startup = gpio_startup_irq,
gc->chip_types[0].chip.irq_ack = irq_gc_ack_clr_bit,
gc->chip_types[0].chip.irq_mask = irq_gc_mask_clr_bit,
gc->chip_types[0].chip.irq_unmask = irq_gc_mask_set_bit,
gc->chip_types[0].chip.irq_set_type = gpio_set_irq_type,
gc->chip_types[0].chip.irq_set_wake = gpio_set_irq_wake,
gc->chip_types[0].chip.flags = IRQCHIP_MASK_ON_SUSPEND,
/* edge chip type */
gc->chip_types[1].type = IRQ_TYPE_EDGE_BOTH;
gc->chip_types[1].handler = handle_edge_irq;
gc->chip_types[1].regs.ack = REG_GPIO_IRQ_STS;
gc->chip_types[1].regs.mask = REG_GPIO_IRQ_EN;
gc->chip_types[1].chip.irq_startup = gpio_startup_irq,
gc->chip_types[1].chip.irq_ack = irq_gc_ack_clr_bit,
gc->chip_types[1].chip.irq_mask = irq_gc_mask_clr_bit,
gc->chip_types[1].chip.irq_unmask = irq_gc_mask_set_bit,
gc->chip_types[1].chip.irq_set_type = gpio_set_irq_type,
gc->chip_types[1].chip.irq_set_wake = gpio_set_irq_wake,
gc->chip_types[1].chip.flags = IRQCHIP_MASK_ON_SUSPEND,
/* Setup chained handler for this GPIO bank */ /* Setup chained handler for this GPIO bank */
irq_set_handler_data(bank->irq, bank); irq_set_handler_data(bank->irq, bank);
irq_set_chained_handler(bank->irq, tz1090_gpio_irq_handler); irq_set_chained_handler(bank->irq, tz1090_gpio_irq_handler);