arch/powerpc/sysdev/6xx-suspend.S

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2 /*
   3  * Enter and leave sleep state on chips with 6xx-style HID0
   4  * power management bits, which don't leave sleep state via reset.
   5  *
   6  * Author: Scott Wood <scottwood@freescale.com>
   7  *
   8  * Copyright (c) 2006-2007 Freescale Semiconductor, Inc.
   9  */
  10
  11 #include <asm/ppc_asm.h>
  12 #include <asm/reg.h>
  13 #include <asm/thread_info.h>
  14 #include <asm/asm-offsets.h>
  15
  16 _GLOBAL(mpc6xx_enter_standby)
  17         mflr    r4
  18
  19         mfspr   r5, SPRN_HID0
  20         rlwinm  r5, r5, 0, ~(HID0_DOZE | HID0_NAP)
  21         oris    r5, r5, HID0_SLEEP@h
  22         mtspr   SPRN_HID0, r5
  23         isync
  24
  25         lis     r5, ret_from_standby@h
  26         ori     r5, r5, ret_from_standby@l
  27         mtlr    r5
  28
  29         lwz     r6, TI_LOCAL_FLAGS(r2)
  30         ori     r6, r6, _TLF_SLEEPING
  31         stw     r6, TI_LOCAL_FLAGS(r2)
  32
  33         mfmsr   r5
  34         ori     r5, r5, MSR_EE
  35         oris    r5, r5, MSR_POW@h
  36         sync
  37         mtmsr   r5
  38         isync
  39
  40 1:      b       1b
  41
  42 ret_from_standby:
  43         mfspr   r5, SPRN_HID0
  44         rlwinm  r5, r5, 0, ~HID0_SLEEP
  45         mtspr   SPRN_HID0, r5
  46
  47         mtlr    r4
  48         blr