Am Montag, 2. April 2012, 21:28:09 schrieb Heiko Stübner: > Am Samstag 03 März 2012, 22:19:45 schrieb Heiko Stübner: > > The S3C2416 has a separate second interrupt register-set to support > > additional irqs. This patch adds the necessary constants and registers > > the irq handlers for it. > > > > Signed-off-by: Heiko Stuebner <heiko@xxxxxxxxx> > > and also "ping" :-) and another one :-) > > Thanks > Heiko > > > --- > > Patch should go on top of the current s3c24xx consolidation > > > > arch/arm/mach-s3c24xx/include/mach/irqs.h | 15 ++++- > > arch/arm/mach-s3c24xx/irq-s3c2416.c | 98 > > > > ++++++++++++++++++++++++++ arch/arm/mach-s3c24xx/s3c2416.c | > > > > 1 + > > > > arch/arm/plat-samsung/include/plat/s3c2416.h | 3 + > > 4 files changed, 116 insertions(+), 1 deletions(-) > > > > diff --git a/arch/arm/mach-s3c24xx/include/mach/irqs.h > > b/arch/arm/mach-s3c24xx/include/mach/irqs.h index e53b217..e120576 100644 > > --- a/arch/arm/mach-s3c24xx/include/mach/irqs.h > > +++ b/arch/arm/mach-s3c24xx/include/mach/irqs.h > > @@ -134,6 +134,17 @@ > > > > #define IRQ_S32416_WDT S3C2410_IRQSUB(27) > > #define IRQ_S32416_AC97 S3C2410_IRQSUB(28) > > > > +/* second interrupt-register of s3c2416/s3c2450 */ > > + > > +#define S3C2416_IRQ(x) S3C2410_IRQ((x)+54+29) > > +#define IRQ_S3C2416_2D S3C2416_IRQ(0) > > +#define IRQ_S3C2416_IIC1 S3C2416_IRQ(1) > > +#define IRQ_S3C2416_RESERVED2 S3C2416_IRQ(2) > > +#define IRQ_S3C2416_RESERVED3 S3C2416_IRQ(3) > > +#define IRQ_S3C2416_PCM0 S3C2416_IRQ(4) > > +#define IRQ_S3C2416_PCM1 S3C2416_IRQ(5) > > +#define IRQ_S3C2416_I2S0 S3C2416_IRQ(6) > > +#define IRQ_S3C2416_I2S1 S3C2416_IRQ(7) > > > > /* extra irqs for s3c2440 */ > > > > @@ -175,7 +186,9 @@ > > > > #define IRQ_S3C2443_WDT S3C2410_IRQSUB(27) > > #define IRQ_S3C2443_AC97 S3C2410_IRQSUB(28) > > > > -#if defined(CONFIG_CPU_S3C2443) || defined(CONFIG_CPU_S3C2416) > > +#if defined(CONFIG_CPU_S3C2416) > > +#define NR_IRQS (IRQ_S3C2416_I2S1+1) > > +#elif defined(CONFIG_CPU_S3C2443) > > > > #define NR_IRQS (IRQ_S3C2443_AC97+1) > > #else > > #define NR_IRQS (IRQ_S3C2440_AC97+1) > > > > diff --git a/arch/arm/mach-s3c24xx/irq-s3c2416.c > > b/arch/arm/mach-s3c24xx/irq-s3c2416.c index fd49f35..d92f879 100644 > > --- a/arch/arm/mach-s3c24xx/irq-s3c2416.c > > +++ b/arch/arm/mach-s3c24xx/irq-s3c2416.c > > @@ -27,6 +27,7 @@ > > > > #include <linux/ioport.h> > > #include <linux/device.h> > > #include <linux/io.h> > > > > +#include <linux/syscore_ops.h> > > > > #include <mach/hardware.h> > > #include <asm/irq.h> > > > > @@ -192,6 +193,43 @@ static struct irq_chip s3c2416_irq_uart3 = { > > > > .irq_ack = s3c2416_irq_uart3_ack, > > > > }; > > > > +/* second interrupt register */ > > + > > +static inline void s3c2416_irq_ack_second(struct irq_data *data) > > +{ > > + unsigned long bitval = 1UL << (data->irq - IRQ_S3C2416_2D); > > + > > + __raw_writel(bitval, S3C2416_SRCPND2); > > + __raw_writel(bitval, S3C2416_INTPND2); > > +} > > + > > +static void s3c2416_irq_mask_second(struct irq_data *data) > > +{ > > + unsigned long bitval = 1UL << (data->irq - IRQ_S3C2416_2D); > > + unsigned long mask; > > + > > + mask = __raw_readl(S3C2416_INTMSK2); > > + mask |= bitval; > > + __raw_writel(mask, S3C2416_INTMSK2); > > +} > > + > > +static void s3c2416_irq_unmask_second(struct irq_data *data) > > +{ > > + unsigned long bitval = 1UL << (data->irq - IRQ_S3C2416_2D); > > + unsigned long mask; > > + > > + mask = __raw_readl(S3C2416_INTMSK2); > > + mask &= ~bitval; > > + __raw_writel(mask, S3C2416_INTMSK2); > > +} > > + > > +struct irq_chip s3c2416_irq_second = { > > + .irq_ack = s3c2416_irq_ack_second, > > + .irq_mask = s3c2416_irq_mask_second, > > + .irq_unmask = s3c2416_irq_unmask_second, > > +}; > > + > > + > > > > /* IRQ initialisation code */ > > > > static int __init s3c2416_add_sub(unsigned int base, > > > > @@ -213,6 +251,42 @@ static int __init s3c2416_add_sub(unsigned int base, > > > > return 0; > > > > } > > > > +static void __init s3c2416_add_second(void) > > +{ > > + unsigned long pend; > > + unsigned long last; > > + int irqno; > > + int i; > > + > > + /* first, clear all interrupts pending... */ > > + last = 0; > > + for (i = 0; i < 4; i++) { > > + pend = __raw_readl(S3C2416_INTPND2); > > + > > + if (pend == 0 || pend == last) > > + break; > > + > > + __raw_writel(pend, S3C2416_SRCPND2); > > + __raw_writel(pend, S3C2416_INTPND2); > > + printk(KERN_INFO "irq: clearing pending status %08x\n", > > + (int)pend); > > + last = pend; > > + } > > + > > + for (irqno = IRQ_S3C2416_2D; irqno <= IRQ_S3C2416_I2S1; irqno++) { > > + switch (irqno) { > > + case IRQ_S3C2416_RESERVED2: > > + case IRQ_S3C2416_RESERVED3: > > + /* no IRQ here */ > > + break; > > + default: > > + irq_set_chip_and_handler(irqno, &s3c2416_irq_second, > > + handle_edge_irq); > > + set_irq_flags(irqno, IRQF_VALID); > > + } > > + } > > +} > > + > > > > static int __init s3c2416_irq_add(struct device *dev, > > > > struct subsys_interface *sif) > > > > { > > > > @@ -232,6 +306,8 @@ static int __init s3c2416_irq_add(struct device *dev, > > > > &s3c2416_irq_wdtac97, > > IRQ_S3C2443_WDT, IRQ_S3C2443_AC97); > > > > + s3c2416_add_second(); > > + > > > > return 0; > > > > } > > > > @@ -248,3 +324,25 @@ static int __init s3c2416_irq_init(void) > > > > arch_initcall(s3c2416_irq_init); > > > > +#ifdef CONFIG_PM > > +static struct sleep_save irq_save[] = { > > + SAVE_ITEM(S3C2416_INTMSK2), > > +}; > > + > > +int s3c2416_irq_suspend(void) > > +{ > > + s3c_pm_do_save(irq_save, ARRAY_SIZE(irq_save)); > > + > > + return 0; > > +} > > + > > +void s3c2416_irq_resume(void) > > +{ > > + s3c_pm_do_restore(irq_save, ARRAY_SIZE(irq_save)); > > +} > > + > > +struct syscore_ops s3c2416_irq_syscore_ops = { > > + .suspend = s3c2416_irq_suspend, > > + .resume = s3c2416_irq_resume, > > +}; > > +#endif > > diff --git a/arch/arm/mach-s3c24xx/s3c2416.c > > b/arch/arm/mach-s3c24xx/s3c2416.c index 0e9a71c..694977e 100644 > > --- a/arch/arm/mach-s3c24xx/s3c2416.c > > +++ b/arch/arm/mach-s3c24xx/s3c2416.c > > @@ -105,6 +105,7 @@ int __init s3c2416_init(void) > > > > register_syscore_ops(&s3c2416_pm_syscore_ops); > > > > #endif > > > > register_syscore_ops(&s3c24xx_irq_syscore_ops); > > > > + register_syscore_ops(&s3c2416_irq_syscore_ops); > > > > return device_register(&s3c2416_dev); > > > > } > > > > diff --git a/arch/arm/plat-samsung/include/plat/s3c2416.h > > b/arch/arm/plat-samsung/include/plat/s3c2416.h index de2b5bd..7178e33 > > 100644 > > --- a/arch/arm/plat-samsung/include/plat/s3c2416.h > > +++ b/arch/arm/plat-samsung/include/plat/s3c2416.h > > @@ -24,6 +24,9 @@ extern void s3c2416_init_clocks(int xtal); > > > > extern int s3c2416_baseclk_add(void); > > > > extern void s3c2416_restart(char mode, const char *cmd); > > > > + > > +extern struct syscore_ops s3c2416_irq_syscore_ops; > > + > > > > #else > > #define s3c2416_init_clocks NULL > > #define s3c2416_init_uarts NULL -- To unsubscribe from this list: send the line "unsubscribe linux-samsung-soc" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html