/* SPDX-License-Identifier: GPL-2.0-only */
/*
 * Enter and leave sleep state on chips with 6xx-style HID0
 * power management bits, which don't leave sleep state via reset.
 *
 * Author: Scott Wood <scottwood@freescale.com>
 *
 * Copyright (c) 2006-2007 Freescale Semiconductor, Inc.
 */

#include <asm/ppc_asm.h>
#include <asm/reg.h>
#include <asm/thread_info.h>
#include <asm/asm-offsets.h>

_GLOBAL(mpc6xx_enter_standby)
 mflr r4

 mfspr r5, SPRN_HID0
 rlwinm r5, r5, 0, ~(HID0_DOZE | HID0_NAP)
 oris r5, r5, HID0_SLEEP@h
 mtspr SPRN_HID0, r5
 isync

 lis r5, ret_from_standby@h
 ori r5, r5, ret_from_standby@l
 mtlr r5

 lwz r6, TI_LOCAL_FLAGS(r2)
 ori r6, r6, _TLF_SLEEPING
 stw r6, TI_LOCAL_FLAGS(r2)

 mfmsr r5
 ori r5, r5, MSR_EE
 oris r5, r5, MSR_POW@h
 sync
 mtmsr r5
 isync

1: b 1b

ret_from_standby:
 mfspr r5, SPRN_HID0
 rlwinm r5, r5, 0, ~HID0_SLEEP
 mtspr SPRN_HID0, r5

 mtlr r4
 blr