Re: [PATCH] ARM: S3C24XX: add support for second irq set of S3C2416

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



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" :-)

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


[Index of Archives]     [Linux SoC Development]     [Linux Rockchip Development]     [Linux USB Development]     [Video for Linux]     [Linux Audio Users]     [Linux SCSI]     [Yosemite News]

  Powered by Linux