#include "../../drivers/irqchip/irqchip.h"
-static void __iomem *jz_intc_base;
+struct ingenic_intc_data {
+ void __iomem *base;
+};
#define JZ_REG_INTC_STATUS 0x00
#define JZ_REG_INTC_MASK 0x04
static irqreturn_t jz4740_cascade(int irq, void *data)
{
+ struct ingenic_intc_data *intc = irq_get_handler_data(irq);
uint32_t irq_reg;
- irq_reg = readl(jz_intc_base + JZ_REG_INTC_PENDING);
+ irq_reg = readl(intc->base + JZ_REG_INTC_PENDING);
if (irq_reg)
generic_handle_irq(__fls(irq_reg) + JZ4740_IRQ_BASE);
static int __init jz4740_intc_of_init(struct device_node *node,
struct device_node *parent)
{
+ struct ingenic_intc_data *intc;
struct irq_chip_generic *gc;
struct irq_chip_type *ct;
struct irq_domain *domain;
- int parent_irq;
+ int parent_irq, err = 0;
+
+ intc = kzalloc(sizeof(*intc), GFP_KERNEL);
+ if (!intc) {
+ err = -ENOMEM;
+ goto out_err;
+ }
parent_irq = irq_of_parse_and_map(node, 0);
- if (!parent_irq)
- return -EINVAL;
+ if (!parent_irq) {
+ err = -EINVAL;
+ goto out_free;
+ }
- jz_intc_base = ioremap(JZ4740_INTC_BASE_ADDR, 0x14);
+ err = irq_set_handler_data(parent_irq, intc);
+ if (err)
+ goto out_unmap_irq;
+
+ intc->base = ioremap(JZ4740_INTC_BASE_ADDR, 0x14);
/* Mask all irqs */
- writel(0xffffffff, jz_intc_base + JZ_REG_INTC_SET_MASK);
+ writel(0xffffffff, intc->base + JZ_REG_INTC_SET_MASK);
- gc = irq_alloc_generic_chip("INTC", 1, JZ4740_IRQ_BASE, jz_intc_base,
+ gc = irq_alloc_generic_chip("INTC", 1, JZ4740_IRQ_BASE, intc->base,
handle_level_irq);
gc->wake_enabled = IRQ_MSK(32);
setup_irq(parent_irq, &jz4740_cascade_action);
return 0;
+
+out_unmap_irq:
+ irq_dispose_mapping(parent_irq);
+out_free:
+ kfree(intc);
+out_err:
+ return err;
}
IRQCHIP_DECLARE(jz4740_intc, "ingenic,jz4740-intc", jz4740_intc_of_init);