[PATCH 03/03] ARM: mach-shmobile: sh7372 power domain LED hack

[PATCH 03/03] ARM: mach-shmobile: sh7372 power domain LED hack

[Magnus Damm]

From: Magnus Damm <damm@opensource.se>

Hack to hook up LED1->LED4 on the Mackerel board
to show the state of the power domains:

LED1: ARM core
LED2: A4LC
LED3: A3RV
LED4: A3SP

Not-yet-signed-off-by: Magnus Damm <damm@opensource.se>
---

 arch/arm/mach-shmobile/pm-sh7372.c |   49 ++++++++++++++++++++++++++++++++++++
 1 file changed, 49 insertions(+)

--- 0005/arch/arm/mach-shmobile/pm-sh7372.c
+++ work/arch/arm/mach-shmobile/pm-sh7372.c	2011-06-30 17:06:38.000000000 +0900
@@ -18,6 +18,7 @@
 #include <linux/pm_runtime.h>
 #include <linux/platform_device.h>
 #include <linux/delay.h>
+#include <linux/gpio.h>
 #include <asm/system.h>
 #include <asm/io.h>
 #include <asm/tlbflush.h>
@@ -43,6 +44,19 @@ static int pd_power_down(struct generic_
 	struct sh7372_pm_domain *sh7372_pd = to_sh7372_pd(genpd);
 	unsigned int mask = 1 << sh7372_pd->bit_shift;
 
+#ifndef CONFIG_LEDS_GPIO
+	/* LED2: A4LC status - LED off when power off */
+	if (genpd = &sh7372_a4lc.genpd)
+		gpio_set_value(GPIO_PORT1, 0);
+
+	/* LED3: A3RV status - LED off when power off */
+	if (genpd = &sh7372_a3rv.genpd)
+		gpio_set_value(GPIO_PORT2, 0);
+
+	/* LED4: A3SP status - LED off when power off */
+	if (genpd = &sh7372_a3sp.genpd)
+		gpio_set_value(GPIO_PORT159, 0);
+#endif
 	if (__raw_readl(PSTR) & mask) {
 		unsigned int retry_count;
 
@@ -70,6 +84,19 @@ static int pd_power_up(struct generic_pm
 	unsigned int retry_count;
 	int ret = 0;
 
+#ifndef CONFIG_LEDS_GPIO
+	/* LED2: A4LC status - LED lit when power on */
+	if (genpd = &sh7372_a4lc.genpd)
+		gpio_set_value(GPIO_PORT1, 1);
+
+	/* LED3: A3RV status - LED lit when power on */
+	if (genpd = &sh7372_a3rv.genpd)
+		gpio_set_value(GPIO_PORT2, 1);
+
+	/* LED4: A3SP status - LED lit when power on */
+	if (genpd = &sh7372_a3sp.genpd)
+		gpio_set_value(GPIO_PORT159, 1);
+#endif
 	if (__raw_readl(PSTR) & mask)
 		goto out;
 
@@ -145,6 +172,11 @@ static void sh7372_enter_core_standby(vo
 {
 	void __iomem *smfram = (void __iomem *)SMFRAM;
 
+#ifndef CONFIG_LEDS_GPIO
+	/* LED1: ARM core status - LED off when power off */
+	gpio_set_value(GPIO_PORT0, 0);
+#endif
+
 	__raw_writel(0, APARMBAREA); /* translate 4k */
 	__raw_writel(__pa(sh7372_cpu_resume), SBAR); /* set reset vector */
 	__raw_writel(0x10, SYSTBCR); /* enable core standby */
@@ -165,6 +197,11 @@ static void sh7372_enter_core_standby(vo
 
 	__raw_writel(0, SYSTBCR); /* disable core standby */
 	__raw_writel(0, SBAR); /* disable reset vector translation */
+
+#ifndef CONFIG_LEDS_GPIO
+	/* LED1: ARM core status - LED lit when power on */
+	gpio_set_value(GPIO_PORT0, 1);
+#endif
 }
 
 #ifdef CONFIG_CPU_IDLE
@@ -222,6 +259,18 @@ void __init sh7372_pm_init(void)
 	/* do not convert A3SM, A3SP, A3SG, A4R power down into A4S */
 	__raw_writel(0, PDNSEL);
 
+#ifndef CONFIG_LEDS_GPIO
+	/* output power domain state of LED1 -> LED4 */
+	gpio_request(GPIO_PORT0, NULL); /* LED1 */
+	gpio_direction_output(GPIO_PORT0, 1);
+	gpio_request(GPIO_PORT1, NULL); /* LED2 */
+	gpio_direction_output(GPIO_PORT1, 1);
+	gpio_request(GPIO_PORT2, NULL); /* LED3 */
+	gpio_direction_output(GPIO_PORT2, 1);
+	gpio_request(GPIO_PORT159, NULL); /* LED4 */
+	gpio_direction_output(GPIO_PORT159, 1);
+#endif
+
 	sh7372_suspend_init();
 	sh7372_cpuidle_init();
 }