Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit e5598a85 authored by Barry Song's avatar Barry Song Committed by Barry Song
Browse files

ARM: CSR: PM: save/restore timer status in suspend cycle 



SiRFprimaII will lose power in deepsleep mode except rtc, pmu and sdram
self-refresh.
This patch saves timer-related registers while suspending and restore
them while resuming.

Signed-off-by: default avatarBarry Song <baohua.song@csr.com>
Acked-by: default avatarArnd Bergmann <arnd@arndb.de>
parent 684f7414

arch/arm/mach-prima2/timer.c

+34 −0
Original line number Diff line number Diff line
@@ -40,6 +40,17 @@ 


#define SIRFSOC_TIMER_LATCH_BIT	 BIT(0)



#define SIRFSOC_TIMER_REG_CNT 11



static const u32 sirfsoc_timer_reg_list[SIRFSOC_TIMER_REG_CNT] = {

	SIRFSOC_TIMER_MATCH_0, SIRFSOC_TIMER_MATCH_1, SIRFSOC_TIMER_MATCH_2,

	SIRFSOC_TIMER_MATCH_3, SIRFSOC_TIMER_MATCH_4, SIRFSOC_TIMER_MATCH_5,

	SIRFSOC_TIMER_INT_EN, SIRFSOC_TIMER_WATCHDOG_EN, SIRFSOC_TIMER_DIV,

	SIRFSOC_TIMER_LATCHED_LO, SIRFSOC_TIMER_LATCHED_HI,

};



static u32 sirfsoc_timer_reg_val[SIRFSOC_TIMER_REG_CNT];



static void __iomem *sirfsoc_timer_base;

static void __init sirfsoc_of_timer_map(void);
@@ -106,6 +117,27 @@ static void sirfsoc_timer_set_mode(enum clock_event_mode mode, 
	}

}



static void sirfsoc_clocksource_suspend(struct clocksource *cs)

{

	int i;



	writel_relaxed(SIRFSOC_TIMER_LATCH_BIT, sirfsoc_timer_base + SIRFSOC_TIMER_LATCH);



	for (i = 0; i < SIRFSOC_TIMER_REG_CNT; i++)

		sirfsoc_timer_reg_val[i] = readl_relaxed(sirfsoc_timer_base + sirfsoc_timer_reg_list[i]);

}



static void sirfsoc_clocksource_resume(struct clocksource *cs)

{

	int i;



	for (i = 0; i < SIRFSOC_TIMER_REG_CNT; i++)

		writel_relaxed(sirfsoc_timer_reg_val[i], sirfsoc_timer_base + sirfsoc_timer_reg_list[i]);



	writel_relaxed(sirfsoc_timer_reg_val[i - 2], sirfsoc_timer_base + SIRFSOC_TIMER_COUNTER_LO);

	writel_relaxed(sirfsoc_timer_reg_val[i - 1], sirfsoc_timer_base + SIRFSOC_TIMER_COUNTER_HI);

}



static struct clock_event_device sirfsoc_clockevent = {

	.name = "sirfsoc_clockevent",

	.rating = 200,
@@ -120,6 +152,8 @@ static struct clocksource sirfsoc_clocksource = { 
	.mask = CLOCKSOURCE_MASK(64),

	.flags = CLOCK_SOURCE_IS_CONTINUOUS,

	.read = sirfsoc_timer_read,

	.suspend = sirfsoc_clocksource_suspend,

	.resume = sirfsoc_clocksource_resume,

};



static struct irqaction sirfsoc_timer_irq = {