release/src-rt-6.x.4708/linux/linux-2.6.36/arch/mips/jz4740/pm.c

   1 /*
   2  *  Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de>
   3  *      JZ4740 SoC power management support
   4  *
   5  *  This program is free software; you can redistribute it and/or modify it
   6  *  under  the terms of the GNU General  Public License as published by the
   7  *  Free Software Foundation;  either version 2 of the License, or (at your
   8  *  option) any later version.
   9  *
  10  *  You should have received a copy of the GNU General Public License along
  11  *  with this program; if not, write to the Free Software Foundation, Inc.,
  12  *  675 Mass Ave, Cambridge, MA 02139, USA.
  13  *
  14  */
  15
  16 #include <linux/init.h>
  17 #include <linux/pm.h>
  18 #include <linux/delay.h>
  19 #include <linux/suspend.h>
  20
  21 #include <asm/mach-jz4740/clock.h>
  22
  23 #include "clock.h"
  24 #include "irq.h"
  25
  26 static int jz4740_pm_enter(suspend_state_t state)
  27 {
  28         jz4740_intc_suspend();
  29         jz4740_clock_suspend();
  30
  31         jz4740_clock_set_wait_mode(JZ4740_WAIT_MODE_SLEEP);
  32
  33         __asm__(".set\tmips3\n\t"
  34                 "wait\n\t"
  35                 ".set\tmips0");
  36
  37         jz4740_clock_set_wait_mode(JZ4740_WAIT_MODE_IDLE);
  38
  39         jz4740_clock_resume();
  40         jz4740_intc_resume();
  41
  42         return 0;
  43 }
  44
  45 static struct platform_suspend_ops jz4740_pm_ops = {
  46         .valid          = suspend_valid_only_mem,
  47         .enter          = jz4740_pm_enter,
  48 };
  49
  50 static int __init jz4740_pm_init(void)
  51 {
  52         suspend_set_ops(&jz4740_pm_ops);
  53         return 0;
  54
  55 }
  56 late_initcall(jz4740_pm_init);