Message ID | 20130506142539.523110430@linutronix.de (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
On 05/06/2013 09:30 AM, Thomas Gleixner wrote: > Proof of concept patch to demonstrate the new irqdomain support for > the generic irq chip. Untested !! > > Signed-off-by: Thomas Gleixner <tglx@linutronix.de> > Cc: Maxime Ripard <maxime.ripard@free-electrons.com> > --- > drivers/irqchip/irq-sun4i.c | 100 ++++++++++++-------------------------------- > 1 file changed, 29 insertions(+), 71 deletions(-) > > Index: linux-2.6/drivers/irqchip/irq-sun4i.c > =================================================================== > --- linux-2.6.orig/drivers/irqchip/irq-sun4i.c > +++ linux-2.6/drivers/irqchip/irq-sun4i.c > @@ -32,70 +32,43 @@ > #define SUN4I_IRQ_FIQ_PENDING_REG(x) (0x20 + 0x4 * x) > #define SUN4I_IRQ_ENABLE_REG(x) (0x40 + 0x4 * x) > #define SUN4I_IRQ_MASK_REG(x) (0x50 + 0x4 * x) > +#define SUN4I_NUM_CHIPS 3 > +#define SUN4I_IRQS_PER_CHIP 32 > > static void __iomem *sun4i_irq_base; > static struct irq_domain *sun4i_irq_domain; > > static asmlinkage void __exception_irq_entry sun4i_handle_irq(struct pt_regs *regs); > > -void sun4i_irq_ack(struct irq_data *irqd) > +static int __init sun4i_init_domain_chips(void) > { > - unsigned int irq = irqd_to_hwirq(irqd); > - unsigned int irq_off = irq % 32; > - int reg = irq / 32; > - u32 val; > - > - val = readl(sun4i_irq_base + SUN4I_IRQ_PENDING_REG(reg)); > - writel(val | (1 << irq_off), > - sun4i_irq_base + SUN4I_IRQ_PENDING_REG(reg)); > -} > - > -static void sun4i_irq_mask(struct irq_data *irqd) > -{ > - unsigned int irq = irqd_to_hwirq(irqd); > - unsigned int irq_off = irq % 32; > - int reg = irq / 32; > - u32 val; > - > - val = readl(sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); > - writel(val & ~(1 << irq_off), > - sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); > -} > - > -static void sun4i_irq_unmask(struct irq_data *irqd) > -{ > - unsigned int irq = irqd_to_hwirq(irqd); > - unsigned int irq_off = irq % 32; > - int reg = irq / 32; > - u32 val; > - > - val = readl(sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); > - writel(val | (1 << irq_off), > - sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); > -} > - > -static struct irq_chip sun4i_irq_chip = { > - .name = "sun4i_irq", > - .irq_ack = sun4i_irq_ack, > - .irq_mask = sun4i_irq_mask, > - .irq_unmask = sun4i_irq_unmask, > -}; > - > -static int sun4i_irq_map(struct irq_domain *d, unsigned int virq, > - irq_hw_number_t hw) > -{ > - irq_set_chip_and_handler(virq, &sun4i_irq_chip, > - handle_level_irq); > - set_irq_flags(virq, IRQF_VALID | IRQF_PROBE); > - > + unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN; > + struct irq_chip_generic *gc; > + int i, ret, base = 0; > + > + ret = irq_alloc_domain_generic_chips(d, SUN4I_IRQS_PER_CHIP, 1, 1 should be SUN4I_NUM_CHIPS. > + "sun4i_irq", handle_level_irq, > + clr, 0, IRQ_GC_INIT_MASK_CACHE); > + if (ret) > + return ret; > + > + for (i = 0; i < SUN4I_NUM_CHIPS; i++, base += SUN4I_IRQS_PER_CHIP) { > + gc = irq_get_domain_generic_chip(sun4i_irq_domain, base); Perhaps this could be an iterator macro. > + gc->reg_base = sun4i_irq_base; > + gc->chip_types[0].regs.mask = SUN4I_IRQ_ENABLE_REG(i); > + gc->chip_types[0].regs.ack = SUN4I_IRQ_PENDING_REG(i); > + gc->chip_types[0].chip.mask = irq_gc_mask_clr_bit; > + gc->chip_types[0].chip.ack = irq_gc_ack_set_bit; > + gc->chip_types[0].chip.unmask = irq_gc_mask_set_bit; > + > + /* Disable, mask and clear all pending interrupts */ > + writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(i)); > + writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(i)); > + writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(i)); > + } > return 0; > } > > -static struct irq_domain_ops sun4i_irq_ops = { > - .map = sun4i_irq_map, > - .xlate = irq_domain_xlate_onecell, > -}; > - > static int __init sun4i_of_init(struct device_node *node, > struct device_node *parent) > { > @@ -104,21 +77,6 @@ static int __init sun4i_of_init(struct d > panic("%s: unable to map IC registers\n", > node->full_name); > > - /* Disable all interrupts */ > - writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(0)); > - writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(1)); > - writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(2)); > - > - /* Mask all the interrupts */ > - writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(0)); > - writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(1)); > - writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(2)); > - > - /* Clear all the pending interrupts */ > - writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(0)); > - writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(1)); > - writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(2)); > - > /* Enable protection mode */ > writel(0x01, sun4i_irq_base + SUN4I_IRQ_PROTECTION_REG); > > @@ -126,8 +84,8 @@ static int __init sun4i_of_init(struct d > writel(0x00, sun4i_irq_base + SUN4I_IRQ_NMI_CTRL_REG); > > sun4i_irq_domain = irq_domain_add_linear(node, 3 * 32, s/3 * 32/SUN4I_NUM_CHIPS * SUN4I_IRQS_PER_CHIP/ > - &sun4i_irq_ops, NULL); > - if (!sun4i_irq_domain) > + &irq_generic_chip_ops, NULL); > + if (!sun4i_irq_domain || sun4i_init_domain_chips()) > panic("%s: unable to create IRQ domain\n", node->full_name); > > set_handle_irq(sun4i_handle_irq); > > > _______________________________________________ > devicetree-discuss mailing list > devicetree-discuss@lists.ozlabs.org > https://lists.ozlabs.org/listinfo/devicetree-discuss
Hi Thomas, Le 06/05/2013 16:30, Thomas Gleixner a écrit : > Proof of concept patch to demonstrate the new irqdomain support for > the generic irq chip. Untested !! > > Signed-off-by: Thomas Gleixner <tglx@linutronix.de> > Cc: Maxime Ripard <maxime.ripard@free-electrons.com> I just tested it, and with the minor patch I sent, it's working fine. You can add my Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com> Thanks, Maxime
Le 12/05/2013 16:08, Maxime Ripard a écrit : > Hi Thomas, > > Le 06/05/2013 16:30, Thomas Gleixner a écrit : >> Proof of concept patch to demonstrate the new irqdomain support for >> the generic irq chip. Untested !! >> >> Signed-off-by: Thomas Gleixner <tglx@linutronix.de> >> Cc: Maxime Ripard <maxime.ripard@free-electrons.com> > > I just tested it, and with the minor patch I sent, it's working fine. > > You can add my > Acked-by: Maxime Ripard <maxime.ripard@free-electrons.com> After addressing the comments RobH already made that is. Maxime
Index: linux-2.6/drivers/irqchip/irq-sun4i.c =================================================================== --- linux-2.6.orig/drivers/irqchip/irq-sun4i.c +++ linux-2.6/drivers/irqchip/irq-sun4i.c @@ -32,70 +32,43 @@ #define SUN4I_IRQ_FIQ_PENDING_REG(x) (0x20 + 0x4 * x) #define SUN4I_IRQ_ENABLE_REG(x) (0x40 + 0x4 * x) #define SUN4I_IRQ_MASK_REG(x) (0x50 + 0x4 * x) +#define SUN4I_NUM_CHIPS 3 +#define SUN4I_IRQS_PER_CHIP 32 static void __iomem *sun4i_irq_base; static struct irq_domain *sun4i_irq_domain; static asmlinkage void __exception_irq_entry sun4i_handle_irq(struct pt_regs *regs); -void sun4i_irq_ack(struct irq_data *irqd) +static int __init sun4i_init_domain_chips(void) { - unsigned int irq = irqd_to_hwirq(irqd); - unsigned int irq_off = irq % 32; - int reg = irq / 32; - u32 val; - - val = readl(sun4i_irq_base + SUN4I_IRQ_PENDING_REG(reg)); - writel(val | (1 << irq_off), - sun4i_irq_base + SUN4I_IRQ_PENDING_REG(reg)); -} - -static void sun4i_irq_mask(struct irq_data *irqd) -{ - unsigned int irq = irqd_to_hwirq(irqd); - unsigned int irq_off = irq % 32; - int reg = irq / 32; - u32 val; - - val = readl(sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); - writel(val & ~(1 << irq_off), - sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); -} - -static void sun4i_irq_unmask(struct irq_data *irqd) -{ - unsigned int irq = irqd_to_hwirq(irqd); - unsigned int irq_off = irq % 32; - int reg = irq / 32; - u32 val; - - val = readl(sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); - writel(val | (1 << irq_off), - sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(reg)); -} - -static struct irq_chip sun4i_irq_chip = { - .name = "sun4i_irq", - .irq_ack = sun4i_irq_ack, - .irq_mask = sun4i_irq_mask, - .irq_unmask = sun4i_irq_unmask, -}; - -static int sun4i_irq_map(struct irq_domain *d, unsigned int virq, - irq_hw_number_t hw) -{ - irq_set_chip_and_handler(virq, &sun4i_irq_chip, - handle_level_irq); - set_irq_flags(virq, IRQF_VALID | IRQF_PROBE); - + unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN; + struct irq_chip_generic *gc; + int i, ret, base = 0; + + ret = irq_alloc_domain_generic_chips(d, SUN4I_IRQS_PER_CHIP, 1, + "sun4i_irq", handle_level_irq, + clr, 0, IRQ_GC_INIT_MASK_CACHE); + if (ret) + return ret; + + for (i = 0; i < SUN4I_NUM_CHIPS; i++, base += SUN4I_IRQS_PER_CHIP) { + gc = irq_get_domain_generic_chip(sun4i_irq_domain, base); + gc->reg_base = sun4i_irq_base; + gc->chip_types[0].regs.mask = SUN4I_IRQ_ENABLE_REG(i); + gc->chip_types[0].regs.ack = SUN4I_IRQ_PENDING_REG(i); + gc->chip_types[0].chip.mask = irq_gc_mask_clr_bit; + gc->chip_types[0].chip.ack = irq_gc_ack_set_bit; + gc->chip_types[0].chip.unmask = irq_gc_mask_set_bit; + + /* Disable, mask and clear all pending interrupts */ + writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(i)); + writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(i)); + writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(i)); + } return 0; } -static struct irq_domain_ops sun4i_irq_ops = { - .map = sun4i_irq_map, - .xlate = irq_domain_xlate_onecell, -}; - static int __init sun4i_of_init(struct device_node *node, struct device_node *parent) { @@ -104,21 +77,6 @@ static int __init sun4i_of_init(struct d panic("%s: unable to map IC registers\n", node->full_name); - /* Disable all interrupts */ - writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(0)); - writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(1)); - writel(0, sun4i_irq_base + SUN4I_IRQ_ENABLE_REG(2)); - - /* Mask all the interrupts */ - writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(0)); - writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(1)); - writel(0, sun4i_irq_base + SUN4I_IRQ_MASK_REG(2)); - - /* Clear all the pending interrupts */ - writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(0)); - writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(1)); - writel(0xffffffff, sun4i_irq_base + SUN4I_IRQ_PENDING_REG(2)); - /* Enable protection mode */ writel(0x01, sun4i_irq_base + SUN4I_IRQ_PROTECTION_REG); @@ -126,8 +84,8 @@ static int __init sun4i_of_init(struct d writel(0x00, sun4i_irq_base + SUN4I_IRQ_NMI_CTRL_REG); sun4i_irq_domain = irq_domain_add_linear(node, 3 * 32, - &sun4i_irq_ops, NULL); - if (!sun4i_irq_domain) + &irq_generic_chip_ops, NULL); + if (!sun4i_irq_domain || sun4i_init_domain_chips()) panic("%s: unable to create IRQ domain\n", node->full_name); set_handle_irq(sun4i_handle_irq);
Proof of concept patch to demonstrate the new irqdomain support for the generic irq chip. Untested !! Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Cc: Maxime Ripard <maxime.ripard@free-electrons.com> --- drivers/irqchip/irq-sun4i.c | 100 ++++++++++++-------------------------------- 1 file changed, 29 insertions(+), 71 deletions(-)