forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
48 lines
902 B
48 lines
902 B
/* 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
|
|
|