avr32: Move sleep code into mach-at32ap
Create a new file, pm-at32ap700x.S, in mach-at32ap and move the CPU idle sleep code there. Make it possible to disable the sleep code. Signed-off-by: Haavard Skinnemoen <hskinnemoen@atmel.com>
This commit is contained in:
parent
02f99d1ca7
commit
7e59128f31
|
@ -741,26 +741,6 @@ irq_level\level:
|
||||||
|
|
||||||
.section .irq.text,"ax",@progbits
|
.section .irq.text,"ax",@progbits
|
||||||
|
|
||||||
.global cpu_idle_sleep
|
|
||||||
cpu_idle_sleep:
|
|
||||||
mask_interrupts
|
|
||||||
get_thread_info r8
|
|
||||||
ld.w r9, r8[TI_flags]
|
|
||||||
bld r9, TIF_NEED_RESCHED
|
|
||||||
brcs cpu_idle_enable_int_and_exit
|
|
||||||
sbr r9, TIF_CPU_GOING_TO_SLEEP
|
|
||||||
st.w r8[TI_flags], r9
|
|
||||||
unmask_interrupts
|
|
||||||
sleep 0
|
|
||||||
cpu_idle_skip_sleep:
|
|
||||||
mask_interrupts
|
|
||||||
ld.w r9, r8[TI_flags]
|
|
||||||
cbr r9, TIF_CPU_GOING_TO_SLEEP
|
|
||||||
st.w r8[TI_flags], r9
|
|
||||||
cpu_idle_enable_int_and_exit:
|
|
||||||
unmask_interrupts
|
|
||||||
retal r12
|
|
||||||
|
|
||||||
.global irq_level0
|
.global irq_level0
|
||||||
.global irq_level1
|
.global irq_level1
|
||||||
.global irq_level2
|
.global irq_level2
|
||||||
|
|
|
@ -18,11 +18,11 @@
|
||||||
#include <asm/sysreg.h>
|
#include <asm/sysreg.h>
|
||||||
#include <asm/ocd.h>
|
#include <asm/ocd.h>
|
||||||
|
|
||||||
|
#include <asm/arch/pm.h>
|
||||||
|
|
||||||
void (*pm_power_off)(void) = NULL;
|
void (*pm_power_off)(void) = NULL;
|
||||||
EXPORT_SYMBOL(pm_power_off);
|
EXPORT_SYMBOL(pm_power_off);
|
||||||
|
|
||||||
extern void cpu_idle_sleep(void);
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* This file handles the architecture-dependent parts of process handling..
|
* This file handles the architecture-dependent parts of process handling..
|
||||||
*/
|
*/
|
||||||
|
|
|
@ -1,4 +1,4 @@
|
||||||
obj-y += at32ap.o clock.o intc.o extint.o pio.o hsmc.o
|
obj-y += at32ap.o clock.o intc.o extint.o pio.o hsmc.o
|
||||||
obj-$(CONFIG_CPU_AT32AP700X) += at32ap700x.o
|
obj-$(CONFIG_CPU_AT32AP700X) += at32ap700x.o pm-at32ap700x.o
|
||||||
obj-$(CONFIG_CPU_AT32AP700X) += time-tc.o
|
obj-$(CONFIG_CPU_AT32AP700X) += time-tc.o
|
||||||
obj-$(CONFIG_CPU_FREQ_AT32AP) += cpufreq.o
|
obj-$(CONFIG_CPU_FREQ_AT32AP) += cpufreq.o
|
||||||
|
|
66
arch/avr32/mach-at32ap/pm-at32ap700x.S
Normal file
66
arch/avr32/mach-at32ap/pm-at32ap700x.S
Normal file
|
@ -0,0 +1,66 @@
|
||||||
|
/*
|
||||||
|
* Low-level Power Management code.
|
||||||
|
*
|
||||||
|
* Copyright (C) 2008 Atmel Corporation
|
||||||
|
*
|
||||||
|
* This program is free software; you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License version 2 as
|
||||||
|
* published by the Free Software Foundation.
|
||||||
|
*/
|
||||||
|
#include <asm/asm.h>
|
||||||
|
#include <asm/asm-offsets.h>
|
||||||
|
#include <asm/thread_info.h>
|
||||||
|
#include <asm/arch/pm.h>
|
||||||
|
|
||||||
|
.section .bss, "wa", @nobits
|
||||||
|
.global disable_idle_sleep
|
||||||
|
.type disable_idle_sleep, @object
|
||||||
|
disable_idle_sleep:
|
||||||
|
.int 4
|
||||||
|
.size disable_idle_sleep, . - disable_idle_sleep
|
||||||
|
|
||||||
|
/* Keep this close to the irq handlers */
|
||||||
|
.section .irq.text, "ax", @progbits
|
||||||
|
|
||||||
|
/*
|
||||||
|
* void cpu_enter_idle(void)
|
||||||
|
*
|
||||||
|
* Put the CPU into "idle" mode, in which it will consume
|
||||||
|
* significantly less power.
|
||||||
|
*
|
||||||
|
* If an interrupt comes along in the window between
|
||||||
|
* unmask_interrupts and the sleep instruction below, the
|
||||||
|
* interrupt code will adjust the return address so that we
|
||||||
|
* never execute the sleep instruction. This is required
|
||||||
|
* because the AP7000 doesn't unmask interrupts when entering
|
||||||
|
* sleep modes; later CPUs may not need this workaround.
|
||||||
|
*/
|
||||||
|
.global cpu_enter_idle
|
||||||
|
.type cpu_enter_idle, @function
|
||||||
|
cpu_enter_idle:
|
||||||
|
mask_interrupts
|
||||||
|
get_thread_info r8
|
||||||
|
ld.w r9, r8[TI_flags]
|
||||||
|
bld r9, TIF_NEED_RESCHED
|
||||||
|
brcs .Lret_from_sleep
|
||||||
|
sbr r9, TIF_CPU_GOING_TO_SLEEP
|
||||||
|
st.w r8[TI_flags], r9
|
||||||
|
unmask_interrupts
|
||||||
|
sleep CPU_SLEEP_IDLE
|
||||||
|
.size cpu_idle_sleep, . - cpu_idle_sleep
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Common return path for PM functions that don't run from
|
||||||
|
* SRAM.
|
||||||
|
*/
|
||||||
|
.global cpu_idle_skip_sleep
|
||||||
|
.type cpu_idle_skip_sleep, @function
|
||||||
|
cpu_idle_skip_sleep:
|
||||||
|
mask_interrupts
|
||||||
|
ld.w r9, r8[TI_flags]
|
||||||
|
cbr r9, TIF_CPU_GOING_TO_SLEEP
|
||||||
|
st.w r8[TI_flags], r9
|
||||||
|
.Lret_from_sleep:
|
||||||
|
unmask_interrupts
|
||||||
|
retal r12
|
||||||
|
.size cpu_idle_skip_sleep, . - cpu_idle_skip_sleep
|
48
include/asm-avr32/arch-at32ap/pm.h
Normal file
48
include/asm-avr32/arch-at32ap/pm.h
Normal file
|
@ -0,0 +1,48 @@
|
||||||
|
/*
|
||||||
|
* AVR32 AP Power Management.
|
||||||
|
*
|
||||||
|
* Copyright (C) 2008 Atmel Corporation
|
||||||
|
*
|
||||||
|
* This program is free software; you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License version 2 as
|
||||||
|
* published by the Free Software Foundation.
|
||||||
|
*/
|
||||||
|
#ifndef __ASM_AVR32_ARCH_PM_H
|
||||||
|
#define __ASM_AVR32_ARCH_PM_H
|
||||||
|
|
||||||
|
/* Possible arguments to the "sleep" instruction */
|
||||||
|
#define CPU_SLEEP_IDLE 0
|
||||||
|
#define CPU_SLEEP_FROZEN 1
|
||||||
|
#define CPU_SLEEP_STANDBY 2
|
||||||
|
#define CPU_SLEEP_STOP 3
|
||||||
|
#define CPU_SLEEP_STATIC 5
|
||||||
|
|
||||||
|
#ifndef __ASSEMBLY__
|
||||||
|
extern void cpu_enter_idle(void);
|
||||||
|
|
||||||
|
extern bool disable_idle_sleep;
|
||||||
|
|
||||||
|
static inline void cpu_disable_idle_sleep(void)
|
||||||
|
{
|
||||||
|
disable_idle_sleep = true;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void cpu_enable_idle_sleep(void)
|
||||||
|
{
|
||||||
|
disable_idle_sleep = false;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void cpu_idle_sleep(void)
|
||||||
|
{
|
||||||
|
/*
|
||||||
|
* If we're using the COUNT and COMPARE registers for
|
||||||
|
* timekeeping, we can't use the IDLE state.
|
||||||
|
*/
|
||||||
|
if (disable_idle_sleep)
|
||||||
|
cpu_relax();
|
||||||
|
else
|
||||||
|
cpu_enter_idle();
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif /* __ASM_AVR32_ARCH_PM_H */
|
Loading…
Reference in a new issue