Quelle  powersave.S   Sprache: Sparc

/* SPDX-License-Identifier: GPL-2.0-only */
/*
 * Copyright (C) 2006-2007 PA Semi, Inc
 *
 * Maintained by: Olof Johansson <olof@lixom.net>
 */

#include <asm/processor.h>
#include <asm/page.h>
#include <asm/ppc_asm.h>
#include <asm/cputable.h>
#include <asm/cache.h>
#include <asm/thread_info.h>
#include <asm/asm-offsets.h>

/* Power savings opcodes since not all binutils have them at this time */
#define DOZE .long 0x4c000324
#define NAP .long 0x4c000364
#define SLEEP .long 0x4c0003a4
#define RVW .long 0x4c0003e4

/* Common sequence to do before going to any of the
 * powersavings modes.
 */

#define PRE_SLEEP_SEQUENCE \
 std r3,8(r1); \
 ptesync ;  \
 ld r3,8(r1); \
1: cmpd  r3,r3;  \
 bne 1b

_doze:
 PRE_SLEEP_SEQUENCE
 DOZE
 b .


_GLOBAL(idle_spin)
 blr

_GLOBAL(idle_doze)
 LOAD_REG_ADDR(r3, _doze)
 b sleep_common

/* Add more modes here later */

sleep_common:
 mflr r0
 std r0, 16(r1)
 stdu r1,-64(r1)
#ifdef CONFIG_PPC_PASEMI_CPUFREQ
 std r3, 48(r1)

 /* Only do power savings when in astate 0 */
 bl check_astate
 cmpwi r3,0
 bne 1f

 ld r3, 48(r1)
#endif
 LOAD_REG_IMMEDIATE(r6,MSR_DR|MSR_IR|MSR_ME|MSR_EE)
 mfmsr r4
 andc r5,r4,r6
 mtmsrd r5,0

 mtctr r3
 bctrl

 mtmsrd r4,0

1: addi r1,r1,64
 ld r0,16(r1)
 mtlr r0
 blr