Parcourir la source

[ARM] 4730/1: S3C2412: Ensure the PWRCFG has the right mode for RTC wake

Ensure that if the RTC IRQ is not selected for wake in the
base configuration, then the PWRCFG has the same value set
in it.

Signed-off-by: Ben Dooks <ben-linux@fluff.org>
Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
Ben Dooks il y a 17 ans
Parent
commit
0baada2742
3 fichiers modifiés avec 27 ajouts et 1 suppressions
  1. 24 0
      arch/arm/mach-s3c2412/irq.c
  2. 1 1
      arch/arm/plat-s3c24xx/irq.c
  3. 2 0
      include/asm-arm/plat-s3c24xx/irq.h

+ 24 - 0
arch/arm/mach-s3c2412/irq.c

@@ -33,6 +33,7 @@
 
 
 #include <asm/arch/regs-irq.h>
 #include <asm/arch/regs-irq.h>
 #include <asm/arch/regs-gpio.h>
 #include <asm/arch/regs-gpio.h>
+#include <asm/arch/regs-power.h>
 
 
 #include <asm/plat-s3c24xx/cpu.h>
 #include <asm/plat-s3c24xx/cpu.h>
 #include <asm/plat-s3c24xx/irq.h>
 #include <asm/plat-s3c24xx/irq.h>
@@ -153,6 +154,22 @@ static struct irq_chip s3c2412_irq_cfsdi = {
 	.unmask		= s3c2412_irq_cfsdi_unmask,
 	.unmask		= s3c2412_irq_cfsdi_unmask,
 };
 };
 
 
+static int s3c2412_irq_rtc_wake(unsigned int irqno, unsigned int state)
+{
+	unsigned long pwrcfg;
+
+	pwrcfg = __raw_readl(S3C2412_PWRCFG);
+	if (state)
+		pwrcfg &= ~S3C2412_PWRCFG_RTC_MASKIRQ;
+	else
+		pwrcfg |= S3C2412_PWRCFG_RTC_MASKIRQ;
+	__raw_writel(pwrcfg, S3C2412_PWRCFG);
+
+	return s3c_irq_chip.set_wake(irqno, state);
+}
+
+static struct irq_chip s3c2412_irq_rtc_chip;
+
 static int s3c2412_irq_add(struct sys_device *sysdev)
 static int s3c2412_irq_add(struct sys_device *sysdev)
 {
 {
 	unsigned int irqno;
 	unsigned int irqno;
@@ -173,6 +190,13 @@ static int s3c2412_irq_add(struct sys_device *sysdev)
 		set_irq_flags(irqno, IRQF_VALID);
 		set_irq_flags(irqno, IRQF_VALID);
 	}
 	}
 
 
+	/* change RTC IRQ's set wake method */
+
+	s3c2412_irq_rtc_chip = s3c_irq_chip;
+	s3c2412_irq_rtc_chip.set_wake = s3c2412_irq_rtc_wake;
+
+	set_irq_chip(IRQ_RTC, &s3c2412_irq_rtc_chip);
+
 	return 0;
 	return 0;
 }
 }
 
 

+ 1 - 1
arch/arm/plat-s3c24xx/irq.c

@@ -187,7 +187,7 @@ struct irq_chip s3c_irq_level_chip = {
 	.set_wake	= s3c_irq_wake
 	.set_wake	= s3c_irq_wake
 };
 };
 
 
-static struct irq_chip s3c_irq_chip = {
+struct irq_chip s3c_irq_chip = {
 	.name		= "s3c",
 	.name		= "s3c",
 	.ack		= s3c_irq_ack,
 	.ack		= s3c_irq_ack,
 	.mask		= s3c_irq_mask,
 	.mask		= s3c_irq_mask,

+ 2 - 0
include/asm-arm/plat-s3c24xx/irq.h

@@ -15,7 +15,9 @@
 
 
 #define EXTINT_OFF (IRQ_EINT4 - 4)
 #define EXTINT_OFF (IRQ_EINT4 - 4)
 
 
+/* these are exported for arch/arm/mach-* usage */
 extern struct irq_chip s3c_irq_level_chip;
 extern struct irq_chip s3c_irq_level_chip;
+extern struct irq_chip s3c_irq_chip;
 
 
 static inline void
 static inline void
 s3c_irqsub_mask(unsigned int irqno, unsigned int parentbit,
 s3c_irqsub_mask(unsigned int irqno, unsigned int parentbit,