Merge branch 'at91-3.4-base+pm_cleanup' of git://github.com/at91linux/linux-at91 into next/cleanup
* 'at91-3.4-base+pm_cleanup' of git://github.com/at91linux/linux-at91: ARM: at91: implement the standby function for pm/cpuidle ARM: at91: remove wait_for_interrupt definition ARM: at91: declare header name ARM: at91: coding style fixes
This commit is contained in:
commit
b01ee53dda
3 changed files with 50 additions and 44 deletions
|
@ -39,20 +39,15 @@ static int at91_enter_idle(struct cpuidle_device *dev,
|
||||||
{
|
{
|
||||||
struct timeval before, after;
|
struct timeval before, after;
|
||||||
int idle_time;
|
int idle_time;
|
||||||
u32 saved_lpr;
|
|
||||||
|
|
||||||
local_irq_disable();
|
local_irq_disable();
|
||||||
do_gettimeofday(&before);
|
do_gettimeofday(&before);
|
||||||
if (index == 0)
|
if (index == 0)
|
||||||
/* Wait for interrupt state */
|
/* Wait for interrupt state */
|
||||||
cpu_do_idle();
|
cpu_do_idle();
|
||||||
else if (index == 1) {
|
else if (index == 1)
|
||||||
asm("b 1f; .align 5; 1:");
|
at91_standby();
|
||||||
asm("mcr p15, 0, r0, c7, c10, 4"); /* drain write buffer */
|
|
||||||
saved_lpr = sdram_selfrefresh_enable();
|
|
||||||
cpu_do_idle();
|
|
||||||
sdram_selfrefresh_disable(saved_lpr);
|
|
||||||
}
|
|
||||||
do_gettimeofday(&after);
|
do_gettimeofday(&after);
|
||||||
local_irq_enable();
|
local_irq_enable();
|
||||||
idle_time = (after.tv_sec - before.tv_sec) * USEC_PER_SEC +
|
idle_time = (after.tv_sec - before.tv_sec) * USEC_PER_SEC +
|
||||||
|
|
|
@ -198,7 +198,6 @@ extern u32 at91_slow_clock_sz;
|
||||||
|
|
||||||
static int at91_pm_enter(suspend_state_t state)
|
static int at91_pm_enter(suspend_state_t state)
|
||||||
{
|
{
|
||||||
u32 saved_lpr;
|
|
||||||
at91_gpio_suspend();
|
at91_gpio_suspend();
|
||||||
at91_irq_suspend();
|
at91_irq_suspend();
|
||||||
|
|
||||||
|
@ -254,16 +253,7 @@ static int at91_pm_enter(suspend_state_t state)
|
||||||
* For ARM 926 based chips, this requirement is weaker
|
* For ARM 926 based chips, this requirement is weaker
|
||||||
* as at91sam9 can access a RAM in self-refresh mode.
|
* as at91sam9 can access a RAM in self-refresh mode.
|
||||||
*/
|
*/
|
||||||
asm volatile ( "mov r0, #0\n\t"
|
at91_standby();
|
||||||
"b 1f\n\t"
|
|
||||||
".align 5\n\t"
|
|
||||||
"1: mcr p15, 0, r0, c7, c10, 4\n\t"
|
|
||||||
: /* no output */
|
|
||||||
: /* no input */
|
|
||||||
: "r0");
|
|
||||||
saved_lpr = sdram_selfrefresh_enable();
|
|
||||||
wait_for_interrupt_enable();
|
|
||||||
sdram_selfrefresh_disable(saved_lpr);
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case PM_SUSPEND_ON:
|
case PM_SUSPEND_ON:
|
||||||
|
|
|
@ -1,3 +1,16 @@
|
||||||
|
/*
|
||||||
|
* AT91 Power Management
|
||||||
|
*
|
||||||
|
* Copyright (C) 2005 David Brownell
|
||||||
|
*
|
||||||
|
* This program is free software; you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation; either version 2 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*/
|
||||||
|
#ifndef __ARCH_ARM_MACH_AT91_PM
|
||||||
|
#define __ARCH_ARM_MACH_AT91_PM
|
||||||
|
|
||||||
#ifdef CONFIG_ARCH_AT91RM9200
|
#ifdef CONFIG_ARCH_AT91RM9200
|
||||||
#include <mach/at91rm9200_mc.h>
|
#include <mach/at91rm9200_mc.h>
|
||||||
|
|
||||||
|
@ -11,18 +24,25 @@
|
||||||
* still in self-refresh is "not recommended", but seems to work.
|
* still in self-refresh is "not recommended", but seems to work.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static inline u32 sdram_selfrefresh_enable(void)
|
static inline void at91rm9200_standby(void)
|
||||||
{
|
{
|
||||||
u32 saved_lpr = at91_sys_read(AT91_SDRAMC_LPR);
|
u32 lpr = at91_sys_read(AT91_SDRAMC_LPR);
|
||||||
|
|
||||||
at91_sys_write(AT91_SDRAMC_LPR, 0);
|
asm volatile(
|
||||||
at91_sys_write(AT91_SDRAMC_SRR, 1);
|
"b 1f\n\t"
|
||||||
return saved_lpr;
|
".align 5\n\t"
|
||||||
|
"1: mcr p15, 0, %0, c7, c10, 4\n\t"
|
||||||
|
" str %0, [%1, %2]\n\t"
|
||||||
|
" str %3, [%1, %4]\n\t"
|
||||||
|
" mcr p15, 0, %0, c7, c0, 4\n\t"
|
||||||
|
" str %5, [%1, %2]"
|
||||||
|
:
|
||||||
|
: "r" (0), "r" (AT91_BASE_SYS), "r" (AT91_SDRAMC_LPR),
|
||||||
|
"r" (1), "r" (AT91_SDRAMC_SRR),
|
||||||
|
"r" (lpr));
|
||||||
}
|
}
|
||||||
|
|
||||||
#define sdram_selfrefresh_disable(saved_lpr) at91_sys_write(AT91_SDRAMC_LPR, saved_lpr)
|
#define at91_standby at91rm9200_standby
|
||||||
#define wait_for_interrupt_enable() asm volatile ("mcr p15, 0, %0, c7, c0, 4" \
|
|
||||||
: : "r" (0))
|
|
||||||
|
|
||||||
#elif defined(CONFIG_ARCH_AT91SAM9G45)
|
#elif defined(CONFIG_ARCH_AT91SAM9G45)
|
||||||
#include <mach/at91sam9_ddrsdr.h>
|
#include <mach/at91sam9_ddrsdr.h>
|
||||||
|
@ -30,14 +50,12 @@ static inline u32 sdram_selfrefresh_enable(void)
|
||||||
/* We manage both DDRAM/SDRAM controllers, we need more than one value to
|
/* We manage both DDRAM/SDRAM controllers, we need more than one value to
|
||||||
* remember.
|
* remember.
|
||||||
*/
|
*/
|
||||||
static u32 saved_lpr1;
|
static inline void at91sam9g45_standby(void)
|
||||||
|
|
||||||
static inline u32 sdram_selfrefresh_enable(void)
|
|
||||||
{
|
{
|
||||||
/* Those tow values allow us to delay self-refresh activation
|
/* Those two values allow us to delay self-refresh activation
|
||||||
* to the maximum. */
|
* to the maximum. */
|
||||||
u32 lpr0, lpr1;
|
u32 lpr0, lpr1;
|
||||||
u32 saved_lpr0;
|
u32 saved_lpr0, saved_lpr1;
|
||||||
|
|
||||||
saved_lpr1 = at91_ramc_read(1, AT91_DDRSDRC_LPR);
|
saved_lpr1 = at91_ramc_read(1, AT91_DDRSDRC_LPR);
|
||||||
lpr1 = saved_lpr1 & ~AT91_DDRSDRC_LPCB;
|
lpr1 = saved_lpr1 & ~AT91_DDRSDRC_LPCB;
|
||||||
|
@ -51,15 +69,13 @@ static inline u32 sdram_selfrefresh_enable(void)
|
||||||
at91_ramc_write(0, AT91_DDRSDRC_LPR, lpr0);
|
at91_ramc_write(0, AT91_DDRSDRC_LPR, lpr0);
|
||||||
at91_ramc_write(1, AT91_DDRSDRC_LPR, lpr1);
|
at91_ramc_write(1, AT91_DDRSDRC_LPR, lpr1);
|
||||||
|
|
||||||
return saved_lpr0;
|
cpu_do_idle();
|
||||||
|
|
||||||
|
at91_ramc_write(0, AT91_DDRSDRC_LPR, saved_lpr0);
|
||||||
|
at91_ramc_write(1, AT91_DDRSDRC_LPR, saved_lpr1);
|
||||||
}
|
}
|
||||||
|
|
||||||
#define sdram_selfrefresh_disable(saved_lpr0) \
|
#define at91_standby at91sam9g45_standby
|
||||||
do { \
|
|
||||||
at91_ramc_write(0, AT91_DDRSDRC_LPR, saved_lpr0); \
|
|
||||||
at91_ramc_write(1, AT91_DDRSDRC_LPR, saved_lpr1); \
|
|
||||||
} while (0)
|
|
||||||
#define wait_for_interrupt_enable() cpu_do_idle()
|
|
||||||
|
|
||||||
#else
|
#else
|
||||||
#include <mach/at91sam9_sdramc.h>
|
#include <mach/at91sam9_sdramc.h>
|
||||||
|
@ -72,18 +88,23 @@ static inline u32 sdram_selfrefresh_enable(void)
|
||||||
#warning Assuming EB1 SDRAM controller is *NOT* used
|
#warning Assuming EB1 SDRAM controller is *NOT* used
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
static inline u32 sdram_selfrefresh_enable(void)
|
static inline void at91sam9_standby(void)
|
||||||
{
|
{
|
||||||
u32 saved_lpr, lpr;
|
u32 saved_lpr, lpr;
|
||||||
|
|
||||||
saved_lpr = at91_ramc_read(0, AT91_SDRAMC_LPR);
|
saved_lpr = at91_ramc_read(0, AT91_SDRAMC_LPR);
|
||||||
|
|
||||||
lpr = saved_lpr & ~AT91_SDRAMC_LPCB;
|
lpr = saved_lpr & ~AT91_SDRAMC_LPCB;
|
||||||
at91_ramc_write(0, AT91_SDRAMC_LPR, lpr | AT91_SDRAMC_LPCB_SELF_REFRESH);
|
at91_ramc_write(0, AT91_SDRAMC_LPR, lpr |
|
||||||
return saved_lpr;
|
AT91_SDRAMC_LPCB_SELF_REFRESH);
|
||||||
|
|
||||||
|
cpu_do_idle();
|
||||||
|
|
||||||
|
at91_ramc_write(0, AT91_SDRAMC_LPR, saved_lpr);
|
||||||
}
|
}
|
||||||
|
|
||||||
#define sdram_selfrefresh_disable(saved_lpr) at91_ramc_write(0, AT91_SDRAMC_LPR, saved_lpr)
|
#define at91_standby at91sam9_standby
|
||||||
#define wait_for_interrupt_enable() cpu_do_idle()
|
|
||||||
|
#endif
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
Loading…
Add table
Reference in a new issue