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

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