1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * PXA250/210 Power Management Routines
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * Original code for the SA11x0:
5*4882a593Smuzhiyun * Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Modified for the PXA250 by Nicolas Pitre:
8*4882a593Smuzhiyun * Copyright (c) 2002 Monta Vista Software, Inc.
9*4882a593Smuzhiyun *
10*4882a593Smuzhiyun * This program is free software; you can redistribute it and/or
11*4882a593Smuzhiyun * modify it under the terms of the GNU General Public License.
12*4882a593Smuzhiyun */
13*4882a593Smuzhiyun #include <linux/init.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/suspend.h>
16*4882a593Smuzhiyun #include <linux/errno.h>
17*4882a593Smuzhiyun #include <linux/slab.h>
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #include "pm.h"
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun struct pxa_cpu_pm_fns *pxa_cpu_pm_fns;
22*4882a593Smuzhiyun static unsigned long *sleep_save;
23*4882a593Smuzhiyun
pxa_pm_enter(suspend_state_t state)24*4882a593Smuzhiyun int pxa_pm_enter(suspend_state_t state)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun unsigned long sleep_save_checksum = 0, checksum = 0;
27*4882a593Smuzhiyun int i;
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun #ifdef CONFIG_IWMMXT
30*4882a593Smuzhiyun /* force any iWMMXt context to ram **/
31*4882a593Smuzhiyun if (elf_hwcap & HWCAP_IWMMXT)
32*4882a593Smuzhiyun iwmmxt_task_disable(NULL);
33*4882a593Smuzhiyun #endif
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun /* skip registers saving for standby */
36*4882a593Smuzhiyun if (state != PM_SUSPEND_STANDBY && pxa_cpu_pm_fns->save) {
37*4882a593Smuzhiyun pxa_cpu_pm_fns->save(sleep_save);
38*4882a593Smuzhiyun /* before sleeping, calculate and save a checksum */
39*4882a593Smuzhiyun for (i = 0; i < pxa_cpu_pm_fns->save_count - 1; i++)
40*4882a593Smuzhiyun sleep_save_checksum += sleep_save[i];
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun /* *** go zzz *** */
44*4882a593Smuzhiyun pxa_cpu_pm_fns->enter(state);
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun if (state != PM_SUSPEND_STANDBY && pxa_cpu_pm_fns->restore) {
47*4882a593Smuzhiyun /* after sleeping, validate the checksum */
48*4882a593Smuzhiyun for (i = 0; i < pxa_cpu_pm_fns->save_count - 1; i++)
49*4882a593Smuzhiyun checksum += sleep_save[i];
50*4882a593Smuzhiyun
51*4882a593Smuzhiyun /* if invalid, display message and wait for a hardware reset */
52*4882a593Smuzhiyun if (checksum != sleep_save_checksum) {
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun lubbock_set_hexled(0xbadbadc5);
55*4882a593Smuzhiyun
56*4882a593Smuzhiyun while (1)
57*4882a593Smuzhiyun pxa_cpu_pm_fns->enter(state);
58*4882a593Smuzhiyun }
59*4882a593Smuzhiyun pxa_cpu_pm_fns->restore(sleep_save);
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun pr_debug("*** made it back from resume\n");
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun return 0;
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(pxa_pm_enter);
68*4882a593Smuzhiyun
pxa_pm_valid(suspend_state_t state)69*4882a593Smuzhiyun static int pxa_pm_valid(suspend_state_t state)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun if (pxa_cpu_pm_fns)
72*4882a593Smuzhiyun return pxa_cpu_pm_fns->valid(state);
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun return -EINVAL;
75*4882a593Smuzhiyun }
76*4882a593Smuzhiyun
pxa_pm_prepare(void)77*4882a593Smuzhiyun int pxa_pm_prepare(void)
78*4882a593Smuzhiyun {
79*4882a593Smuzhiyun int ret = 0;
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun if (pxa_cpu_pm_fns && pxa_cpu_pm_fns->prepare)
82*4882a593Smuzhiyun ret = pxa_cpu_pm_fns->prepare();
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun return ret;
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun
pxa_pm_finish(void)87*4882a593Smuzhiyun void pxa_pm_finish(void)
88*4882a593Smuzhiyun {
89*4882a593Smuzhiyun if (pxa_cpu_pm_fns && pxa_cpu_pm_fns->finish)
90*4882a593Smuzhiyun pxa_cpu_pm_fns->finish();
91*4882a593Smuzhiyun }
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun static const struct platform_suspend_ops pxa_pm_ops = {
94*4882a593Smuzhiyun .valid = pxa_pm_valid,
95*4882a593Smuzhiyun .enter = pxa_pm_enter,
96*4882a593Smuzhiyun .prepare = pxa_pm_prepare,
97*4882a593Smuzhiyun .finish = pxa_pm_finish,
98*4882a593Smuzhiyun };
99*4882a593Smuzhiyun
pxa_pm_init(void)100*4882a593Smuzhiyun static int __init pxa_pm_init(void)
101*4882a593Smuzhiyun {
102*4882a593Smuzhiyun if (!pxa_cpu_pm_fns) {
103*4882a593Smuzhiyun printk(KERN_ERR "no valid pxa_cpu_pm_fns defined\n");
104*4882a593Smuzhiyun return -EINVAL;
105*4882a593Smuzhiyun }
106*4882a593Smuzhiyun
107*4882a593Smuzhiyun sleep_save = kmalloc_array(pxa_cpu_pm_fns->save_count,
108*4882a593Smuzhiyun sizeof(*sleep_save),
109*4882a593Smuzhiyun GFP_KERNEL);
110*4882a593Smuzhiyun if (!sleep_save)
111*4882a593Smuzhiyun return -ENOMEM;
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun suspend_set_ops(&pxa_pm_ops);
114*4882a593Smuzhiyun return 0;
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun
117*4882a593Smuzhiyun device_initcall(pxa_pm_init);
118