87 lines
2 KiB
ArmAsm
87 lines
2 KiB
ArmAsm
|
/*
|
||
|
|
* Copyright 2010 IBM Corp, Benjamin Herrenschmidt <benh@kernel.crashing.org>
|
||
|
|
*
|
||
|
|
* Generic idle routine for Book3E processors
|
||
|
|
*
|
||
|
|
* 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.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/threads.h>
|
||
|
|
#include <asm/reg.h>
|
||
|
|
#include <asm/ppc_asm.h>
|
||
|
|
#include <asm/asm-offsets.h>
|
||
|
|
#include <asm/ppc-opcode.h>
|
||
|
|
#include <asm/processor.h>
|
||
|
|
#include <asm/thread_info.h>
|
||
|
|
|
||
|
|
/* 64-bit version only for now */
|
||
|
|
#ifdef CONFIG_PPC64
|
||
|
|
|
||
|
|
_GLOBAL(book3e_idle)
|
||
|
|
/* Save LR for later */
|
||
|
|
mflr r0
|
||
|
|
std r0,16(r1)
|
||
|
|
|
||
|
|
/* Hard disable interrupts */
|
||
|
|
wrteei 0
|
||
|
|
|
||
|
|
/* Now check if an interrupt came in while we were soft disabled
|
||
|
|
* since we may otherwise lose it (doorbells etc...). We know
|
||
|
|
* that since PACAHARDIRQEN will have been cleared in that case.
|
||
|
|
*/
|
||
|
|
lbz r3,PACAHARDIRQEN(r13)
|
||
|
|
cmpwi cr0,r3,0
|
||
|
|
beqlr
|
||
|
|
|
||
|
|
/* Now we are going to mark ourselves as soft and hard enables in
|
||
|
|
* order to be able to take interrupts while asleep. We inform lockdep
|
||
|
|
* of that. We don't actually turn interrupts on just yet tho.
|
||
|
|
*/
|
||
|
|
#ifdef CONFIG_TRACE_IRQFLAGS
|
||
|
|
stdu r1,-128(r1)
|
||
|
|
bl .trace_hardirqs_on
|
||
|
|
#endif
|
||
|
|
li r0,1
|
||
|
|
stb r0,PACASOFTIRQEN(r13)
|
||
|
|
stb r0,PACAHARDIRQEN(r13)
|
||
|
|
|
||
|
|
/* Interrupts will make use return to LR, so get something we want
|
||
|
|
* in there
|
||
|
|
*/
|
||
|
|
bl 1f
|
||
|
|
|
||
|
|
/* Hard disable interrupts again */
|
||
|
|
wrteei 0
|
||
|
|
|
||
|
|
/* Mark them off again in the PACA as well */
|
||
|
|
li r0,0
|
||
|
|
stb r0,PACASOFTIRQEN(r13)
|
||
|
|
stb r0,PACAHARDIRQEN(r13)
|
||
|
|
|
||
|
|
/* Tell lockdep about it */
|
||
|
|
#ifdef CONFIG_TRACE_IRQFLAGS
|
||
|
|
bl .trace_hardirqs_off
|
||
|
|
addi r1,r1,128
|
||
|
|
#endif
|
||
|
|
ld r0,16(r1)
|
||
|
|
mtlr r0
|
||
|
|
blr
|
||
|
|
|
||
|
|
1: /* Let's set the _TLF_NAPPING flag so interrupts make us return
|
||
|
|
* to the right spot
|
||
|
|
*/
|
||
|
|
clrrdi r11,r1,THREAD_SHIFT
|
||
|
|
ld r10,TI_LOCAL_FLAGS(r11)
|
||
|
|
ori r10,r10,_TLF_NAPPING
|
||
|
|
std r10,TI_LOCAL_FLAGS(r11)
|
||
|
|
|
||
|
|
/* We can now re-enable hard interrupts and go to sleep */
|
||
|
|
wrteei 1
|
||
|
|
1: PPC_WAIT(0)
|
||
|
|
b 1b
|
||
|
|
|
||
|
|
#endif /* CONFIG_PPC64 */
|