| blob | 8b66c042764cbc448c980285ccb9d669fed338e5 |
1 --- /mnt/bdisk/openembedded/oetmp/base/opensimpad-2.4.25-vrs2-pxa1-jpm1-r5/linux-2.4.25/arch/arm/mach-sa1100/pm-common.c 1970-01-01 01:00:00.000000000 +0100
2 +++ arch/arm/mach-sa1100/pm-common.c 2004-07-04 14:56:34.000000000 +0200
3 @@ -0,0 +1,268 @@
4 +/*
5 + * SA1100 Power Management Routines
6 + *
7 + * Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
8 + *
9 + * This program is free software; you can redistribute it and/or
10 + * modify it under the terms of the GNU General Public License.
11 + *
12 + * History:
13 + *
14 + * 2001-02-06: Cliff Brake Initial code
15 + *
16 + * 2001-02-25: Sukjae Cho <sjcho@east.isi.edu> &
17 + * Chester Kuo <chester@linux.org.tw>
18 + * Save more value for the resume function! Support
19 + * Bitsy/Assabet/Freebird board
20 + *
21 + * 2001-08-29: Nicolas Pitre <nico@cam.org>
22 + * Cleaned up, pushed platform dependent stuff
23 + * in the platform specific files.
24 + *
25 + * 2002-05-27: Nicolas Pitre Killed sleep.h and the kmalloced save array.
26 + * Storage is local on the stack now.
27 + */
28 +#include <linux/config.h>
29 +#include <linux/module.h>
30 +#include <linux/init.h>
31 +#include <linux/pm.h>
32 +#include <linux/slab.h>
33 +#include <linux/sched.h>
34 +#include <linux/interrupt.h>
35 +#include <linux/sysctl.h>
36 +#include <linux/errno.h>
37 +#include <linux/cpufreq.h>
38 +
39 +#include <asm/hardware.h>
40 +#include <asm/memory.h>
41 +#include <asm/system.h>
42 +#include <asm/leds.h>
43 +#include <asm/uaccess.h>
44 +
45 +
46 +#ifdef CONFIG_IPAQ_HANDHELD
47 +#include <asm/arch-sa1100/h3600_asic.h>
48 +#endif
49 +
50 +#define __KERNEL_SYSCALLS__
51 +#include <linux/unistd.h>
52 +
53 +/*
54 + * Debug macros
55 + */
56 +#undef DEBUG
57 +
58 +\f
59 +
60 +static char pm_helper_path[128] = "/sbin/pm_helper";
61 +extern int exec_usermodehelper(char *path, char **argv, char **envp);
62 +int debug_pm = 0;
63 +static int pm_helper_veto = 0;
64 +
65 +static int
66 +run_sbin_pm_helper( pm_request_t action )
67 +{
68 + int i;
69 + char *argv[3], *envp[8];
70 +
71 + if (!pm_helper_path[0])
72 + return 2;
73 +
74 + if ( action != PM_SUSPEND && action != PM_RESUME )
75 + return 1;
76 +
77 + /* Be root */
78 + current->uid = current->gid = 0;
79 +
80 + i = 0;
81 + argv[i++] = pm_helper_path;
82 + argv[i++] = (action == PM_RESUME ? "resume" : "suspend");
83 + argv[i] = 0;
84 +
85 + i = 0;
86 + /* minimal command environment */
87 + envp[i++] = "HOME=/";
88 + envp[i++] = "PATH=/sbin:/bin:/usr/sbin:/usr/bin";
89 + envp[i] = 0;
90 +
91 + /* other stuff we want to pass to /sbin/pm_helper */
92 + return exec_usermodehelper (argv [0], argv, envp);
93 +}
94 +
95 +/*
96 + * If pm_suggest_suspend_hook is non-NULL, it is called by pm_suggest_suspend.
97 + */
98 +int (*pm_suggest_suspend_hook)(int state);
99 +EXPORT_SYMBOL(pm_suggest_suspend_hook);
100 +
101 +/*
102 + * If pm_use_sbin_pm_helper is nonzero, then run_sbin_pm_helper is called before suspend and after resume
103 + */
104 +int pm_use_sbin_pm_helper = 1;
105 +EXPORT_SYMBOL(pm_use_sbin_pm_helper);
106 +
107 +/*
108 + * If sysctl_pm_do_suspend_hook is non-NULL, it is called by sysctl_pm_do_suspend.
109 + * If it returns a true value, then pm_suspend is not called.
110 + * Use this to hook in apmd, for now.
111 + */
112 +int (*pm_sysctl_suspend_hook)(int state);
113 +EXPORT_SYMBOL(pm_sysctl_suspend_hook);
114 +
115 +int pm_suspend(void);
116 +
117 +int pm_suggest_suspend(void)
118 +{
119 + int retval;
120 +
121 + if (pm_suggest_suspend_hook) {
122 + if (pm_suggest_suspend_hook(PM_SUSPEND))
123 + return 0;
124 + }
125 +
126 + if (pm_use_sbin_pm_helper) {
127 + pid_t pid;
128 + int res;
129 + int status = 0;
130 + unsigned int old_fs;
131 +
132 + pid = kernel_thread ((int (*) (void *)) run_sbin_pm_helper, (void *) PM_SUSPEND, 0 );
133 + if ( pid < 0 )
134 + return pid;
135 +
136 + if (debug_pm)
137 + printk(KERN_CRIT "%s:%d got pid=%d\n", __FUNCTION__, __LINE__, pid);
138 +
139 + old_fs = get_fs ();
140 + set_fs (get_ds ());
141 + res = waitpid(pid, &status, __WCLONE);
142 + set_fs (old_fs);
143 +
144 + if ( pid != res ) {
145 + if (debug_pm)
146 + printk(KERN_CRIT ": waitpid returned %d (exit_code=%d); not suspending\n", res, status );
147 +
148 + return -1;
149 + }
150 +
151 + /*if ( WIFEXITED(status) && ( WIFEXITSTATUS(status) != 0 )) {*/
152 + if (( status & 0xff7f ) != 0 ) {
153 + if (pm_helper_veto) {
154 + if (debug_pm)
155 + printk(KERN_CRIT "%s: SUSPEND WAS CANCELLED BY pm_helper (exit status %d)\n", __FUNCTION__, status >> 8);
156 + return -1;
157 + } else {
158 + if (debug_pm)
159 + printk(KERN_CRIT "%s: pm_helper returned %d, but going ahead anyway\n", __FUNCTION__, status >> 8);
160 + }
161 + }
162 + }
163 +
164 + if (debug_pm)
165 + printk(KERN_CRIT "%s: REALLY SUSPENDING NOW\n", __FUNCTION__ );
166 +
167 + if (pm_sysctl_suspend_hook) {
168 + if (pm_sysctl_suspend_hook(PM_SUSPEND))
169 + return 0;
170 + }
171 +
172 + retval = pm_suspend();
173 + if (retval) {
174 + if (debug_pm)
175 + printk(KERN_CRIT "pm_suspend returned %d\n", retval);
176 + return retval;
177 + }
178 +
179 + if (pm_use_sbin_pm_helper) {
180 + pid_t pid;
181 +
182 + if (debug_pm)
183 + printk(KERN_CRIT "%s: running pm_helper for wakeup\n", __FUNCTION__);
184 +
185 + pid = kernel_thread ((int (*) (void *)) run_sbin_pm_helper, (void *) PM_RESUME, 0 );
186 + if ( pid < 0 )
187 + return pid;
188 +
189 + if ( pid != waitpid ( pid, NULL, __WCLONE ))
190 + return -1;
191 + }
192 +
193 + return 0;
194 +}
195 +
196 +EXPORT_SYMBOL(pm_suggest_suspend);
197 +
198 +
199 +/*
200 + * Send us to sleep.
201 + */
202 +int pm_suspend(void)
203 +{
204 + int retval;
205 +
206 + retval = pm_send_all(PM_SUSPEND, (void *)3);
207 + if ( retval )
208 + return retval;
209 +
210 +#ifdef CONFIG_IPAQ_HANDHELD
211 + retval = h3600_power_management(PM_SUSPEND);
212 + if (retval) {
213 + pm_send_all(PM_RESUME, (void *)0);
214 + return retval;
215 + }
216 +#endif
217 +
218 + retval = pm_do_suspend();
219 +
220 +#ifdef CONFIG_IPAQ_HANDHELD
221 + /* Allow the power management routines to override resuming */
222 + while ( h3600_power_management(PM_RESUME) )
223 + retval = pm_do_suspend();
224 +#endif
225 +
226 + pm_send_all(PM_RESUME, (void *)0);
227 +
228 + return retval;
229 +}
230 +EXPORT_SYMBOL(pm_suspend);
231 +
232 +#ifdef CONFIG_SYSCTL
233 +/*
234 + * ARGH! ACPI people defined CTL_ACPI in linux/acpi.h rather than
235 + * linux/sysctl.h.
236 + *
237 + * This means our interface here won't survive long - it needs a new
238 + * interface. Quick hack to get this working - use sysctl id 9999.
239 + */
240 +#warning ACPI broke the kernel, this interface needs to be fixed up.
241 +#define CTL_ACPI 9999
242 +#define ACPI_S1_SLP_TYP 19
243 +
244 +static struct ctl_table pm_table[] =
245 +{
246 +/* {ACPI_S1_SLP_TYP, "suspend", NULL, 0, 0600, NULL, (proc_handler *)&sysctl_pm_suspend},*/
247 + {2, "helper", pm_helper_path, sizeof(pm_helper_path), 0644, NULL, (proc_handler *)&proc_dostring},
248 + {3, "debug", &debug_pm, sizeof(debug_pm), 0644, NULL, (proc_handler *)&proc_dointvec},
249 + {4, "helper_veto", &pm_helper_veto, sizeof(pm_helper_veto), 0644, NULL, (proc_handler *)&proc_dointvec},
250 + {0}
251 +};
252 +
253 +static struct ctl_table pm_dir_table[] =
254 +{
255 + {CTL_ACPI, "pm", NULL, 0, 0555, pm_table},
256 + {0}
257 +};
258 +
259 +/*
260 + * Initialize power interface
261 + */
262 +static int __init pm_init(void)
263 +{
264 + register_sysctl_table(pm_dir_table, 1);
265 + return 0;
266 +}
267 +
268 +__initcall(pm_init);
269 +
270 +#endif
271 +
272 --- /mnt/bdisk/openembedded/oetmp/base/opensimpad-2.4.25-vrs2-pxa1-jpm1-r5/linux-2.4.25/arch/arm/mach-sa1100/apm.c 2004-07-01 21:10:30.000000000 +0200
273 +++ arch/arm/mach-sa1100/apm.c 2004-07-04 14:53:38.000000000 +0200
274 @@ -32,9 +32,7 @@
276 #include <asm/system.h>
277 #include <asm/hardware.h>
278 -#if FIXME
279 #include <asm/arch-sa1100/pm.h>
280 -#endif
282 #ifdef CONFIG_IPAQ_HANDHELD
283 #include <asm/arch-sa1100/h3600_hal.h>
284 @@ -92,6 +91,8 @@
285 int magic;
286 struct apm_user * next;
287 int suser: 1;
288 + int writer: 1;
289 + int reader: 1;
290 int suspend_wait: 1;
291 int suspend_result;
292 int suspends_pending;
293 @@ -111,7 +112,7 @@
294 /*
295 * Local variables
296 */
297 -//static int suspends_pending;
298 +static int suspends_pending;
299 //static int standbys_pending;
300 //static int ignore_normal_resume;
302 @@ -129,8 +130,6 @@
303 #else
304 static int power_off = 1;
305 #endif
306 -static int exit_kapmd;
307 -static int kapmd_running;
309 static DECLARE_WAIT_QUEUE_HEAD(apm_waitqueue);
310 static DECLARE_WAIT_QUEUE_HEAD(apm_suspend_waitqueue);
311 @@ -190,6 +189,42 @@
312 return as->events[as->event_tail];
313 }
315 +static void queue_event(apm_event_t event, struct apm_user *sender)
316 +{
317 + struct apm_user * as;
318 +
319 + if (user_list == NULL)
320 + return;
321 + for (as = user_list; as != NULL; as = as->next) {
322 + if ((as == sender) || (!as->reader))
323 + continue;
324 + as->event_head = (as->event_head + 1) % APM_MAX_EVENTS;
325 + if (as->event_head == as->event_tail) {
326 + static int notified;
327 +
328 + if (notified++ == 0)
329 + printk(KERN_ERR "apm: an event queue overflowed\n");
330 + as->event_tail = (as->event_tail + 1) % APM_MAX_EVENTS;
331 + }
332 + as->events[as->event_head] = event;
333 + if ((!as->suser) || (!as->writer))
334 + continue;
335 + switch (event) {
336 + case APM_SYS_SUSPEND:
337 + case APM_USER_SUSPEND:
338 + as->suspends_pending++;
339 + suspends_pending++;
340 + break;
341 +
342 + case APM_SYS_STANDBY:
343 + case APM_USER_STANDBY:
344 + as->standbys_pending++;
345 + break;
346 + }
347 + }
348 + wake_up_interruptible(&apm_waitqueue);
349 +}
350 +
351 static int check_apm_user(struct apm_user *as, const char *func)
352 {
353 if ((as == NULL) || (as->magic != APM_BIOS_MAGIC)) {
354 @@ -228,7 +263,6 @@
355 i = count;
356 while ((i >= sizeof(event)) && !queue_empty(as)) {
357 event = get_queued_event(as);
358 - printk(" do_read: event=%d\n", event);
359 if (copy_to_user(buf, &event, sizeof(event))) {
360 if (i < count)
361 break;
362 @@ -280,9 +314,17 @@
363 return -EPERM;
364 switch (cmd) {
365 case APM_IOC_SUSPEND:
366 -#if FIXME
367 - pm_suggest_suspend();
368 -#endif
369 + if (as->suspends_read > 0) {
370 + as->suspends_read--;
371 + as->suspends_pending--;
372 + suspends_pending--;
373 + } else {
374 + queue_event(APM_USER_SUSPEND, as);
375 + }
376 +
377 + if (suspends_pending <= 0)
378 + wake_up(&apm_suspend_waitqueue);
379 +
380 break;
381 default:
382 return -EINVAL;
383 @@ -299,6 +341,20 @@
384 return 0;
385 filp->private_data = NULL;
386 lock_kernel();
387 + if (user_list == as)
388 + user_list = as->next;
389 + else {
390 + struct apm_user * as1;
391 +
392 + for (as1 = user_list;
393 + (as1 != NULL) && (as1->next != as);
394 + as1 = as1->next)
395 + ;
396 + if (as1 == NULL)
397 + printk(KERN_ERR "apm: filp not in user list\n");
398 + else
399 + as1->next = as->next;
400 + }
401 unlock_kernel();
402 kfree(as);
403 return 0;
404 @@ -326,6 +382,8 @@
405 * privileged operation -- cevans
406 */
407 as->suser = capable(CAP_SYS_ADMIN);
408 + as->writer = (filp->f_mode & FMODE_WRITE) == FMODE_WRITE;
409 + as->reader = (filp->f_mode & FMODE_READ) == FMODE_READ;
410 as->next = user_list;
411 user_list = as;
412 filp->private_data = as;
413 @@ -409,34 +467,6 @@
414 return p - buf;
415 }
417 -#ifndef MODULE
418 -static int __init apm_setup(char *str)
419 -{
420 - int invert;
421 -
422 - while ((str != NULL) && (*str != '\0')) {
423 - if (strncmp(str, "off", 3) == 0)
424 - apm_disabled = 1;
425 - if (strncmp(str, "on", 2) == 0)
426 - apm_disabled = 0;
427 - invert = (strncmp(str, "no-", 3) == 0);
428 - if (invert)
429 - str += 3;
430 - if (strncmp(str, "debug", 5) == 0)
431 - debug = !invert;
432 - if ((strncmp(str, "power-off", 9) == 0) ||
433 - (strncmp(str, "power_off", 9) == 0))
434 - power_off = !invert;
435 - str = strchr(str, ',');
436 - if (str != NULL)
437 - str += strspn(str, ", \t");
438 - }
439 - return 1;
440 -}
441 -
442 -__setup("apm=", apm_setup);
443 -#endif
444 -
445 static struct file_operations apm_bios_fops = {
446 owner: THIS_MODULE,
447 read: do_read,
448 @@ -454,6 +484,50 @@
450 #define APM_INIT_ERROR_RETURN return -1
452 +static pid_t apmd_pid;
453 +static DECLARE_COMPLETION(apmd_exited);
454 +
455 +static int apm(void *unused)
456 +{
457 + unsigned short bx;
458 + unsigned short cx;
459 + unsigned short dx;
460 + int error;
461 + char * power_stat;
462 + char * bat_stat;
463 + DECLARE_WAITQUEUE(wait, current);
464 + struct apm_user au, *as;
465 +
466 + lock_kernel();
467 +
468 + daemonize();
469 +
470 + strcpy(current->comm, "kapmd");
471 +
472 + as = &au;
473 + as->magic = APM_BIOS_MAGIC;
474 + as->event_tail = as->event_head = 0;
475 + as->suspends_pending = as->standbys_pending = 0;
476 + as->suspends_read = as->standbys_read = 0;
477 + as->suser = 1;
478 + as->writer = 1;
479 + as->reader = 0;
480 +
481 + for (;;) {
482 + interruptible_sleep_on(&apm_suspend_waitqueue);
483 + if (signal_pending (current))
484 + break;
485 +
486 + pm_suggest_suspend();
487 +
488 + queue_event(APM_NORMAL_RESUME, as);
489 + }
490 +
491 + unlock_kernel();
492 +
493 + complete_and_exit(&apmd_exited, 0);
494 +}
495 +
496 /*
497 * Just start the APM thread. We do NOT want to do APM BIOS
498 * calls from anything but the APM thread, if for no other reason
499 @@ -492,6 +564,8 @@
501 misc_register(&apm_device);
503 + apmd_pid = kernel_thread(apm, NULL, 0);
504 +
505 return 0;
506 }
508 @@ -499,11 +573,10 @@
509 {
510 misc_deregister(&apm_device);
511 remove_proc_entry("apm", NULL);
512 + kill_proc (apmd_pid, SIGTERM, 1);
513 + wait_for_completion(&apmd_exited);
514 if (power_off)
515 pm_power_off = NULL;
516 - exit_kapmd = 1;
517 - while (kapmd_running)
518 - schedule();
519 pm_active = 0;
520 }
522 @@ -512,6 +585,7 @@
524 MODULE_AUTHOR("Jamey Hicks, pulling bits from original by Stephen Rothwell");
525 MODULE_DESCRIPTION("A minimal emulation of APM");
526 +MODULE_LICENSE("GPL");
527 MODULE_PARM(debug, "i");
528 MODULE_PARM_DESC(debug, "Enable debug mode");
529 MODULE_PARM(power_off, "i");
530 diff -bBaruN /mnt/bdisk/openembedded/oetmp/base/opensimpad-2.4.25-vrs2-pxa1-jpm1-r5/linux-2.4.25/include/asm-arm/arch-sa1100/pm.h include/asm-arm/arch/pm.h
531 --- /mnt/bdisk/openembedded/oetmp/base/opensimpad-2.4.25-vrs2-pxa1-jpm1-r5/linux-2.4.25/include/asm-arm/arch-sa1100/pm.h 1970-01-01 01:00:00.000000000 +0100
532 +++ include/asm-arm/arch-sa1100/pm.h 2004-07-04 16:47:18.000000000 +0200
533 @@ -0,0 +1,20 @@
534 +/*
535 + *
536 + * Declarations for ARM Linux Power Management
537 + *
538 + * Copyright 2002 Compaq Computer Corporation.
539 + *
540 + * This program is free software; you can redistribute it and/or modify
541 + * it under the terms of the GNU General Public License version 2 as
542 + * published by the Free Software Foundation.
543 + *
544 + * Author: Jamey Hicks.
545 + *
546 + */
547 +
548 +
549 +extern int (*pm_suggest_suspend_hook)(int state);
550 +extern int (*pm_sysctl_suspend_hook)(int state);
551 +extern int pm_use_sbin_pm_helper;
552 +extern int pm_suspend(void);
553 +extern int pm_suggest_suspend(void); /* triggers /sbin/pm_helper or queueing event to apmd */
554 --- /mnt/bdisk/openembedded/oetmp/work/opensimpad-64+0-2.4.25-vrs2-pxa1-jpm1-r6/linux-2.4.25/arch/arm/mach-sa1100/Makefile 2004-07-04 19:39:48.000000000 +0200
555 +++ arch/arm/mach-sa1100/Makefile 2004-07-04 17:11:35.000000000 +0200
556 @@ -19,7 +19,7 @@
557 flexanet.o freebird.o frodo.o generic.o h3600.o \
558 huw_webpanel.o irq.o sa1111.o sa1111-pcibuf.o \
559 system3.o yopy.o usb_ctl.o usb_recv.o usb_send.o simputer.o ssp.o \
560 - simpad.o
561 + simpad.o pm-sa1100.o
563 # These aren't present yet, and prevents a plain -ac kernel building.
564 # hwtimer.o
565 @@ -105,7 +105,7 @@
566 obj-$(CONFIG_SA1100_USB_CHAR) += usb-char.o
568 # Miscelaneous functions
569 -obj-$(CONFIG_PM) += pm.o sleep.o
570 +obj-$(CONFIG_PM) += pm-sa1100.o sleep.o
571 obj-$(CONFIG_APM) += apm.o
573 # SIMpad specific
574 --- /mnt/bdisk/openembedded/oetmp/work/opensimpad-64+0-2.4.25-vrs2-pxa1-jpm1-r6/linux-2.4.25/arch/arm/mach-sa1100/pm-sa1100.c 1970-01-01 01:00:00.000000000 +0100
575 +++ arch/arm/mach-sa1100/pm-sa1100.c 2004-07-04 17:11:11.000000000 +0200
576 @@ -0,0 +1,225 @@
577 +/*
578 + * SA1100 Power Management Routines
579 + *
580 + * Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
581 + *
582 + * This program is free software; you can redistribute it and/or
583 + * modify it under the terms of the GNU General Public License.
584 + *
585 + * History:
586 + *
587 + * 2001-02-06: Cliff Brake Initial code
588 + *
589 + * 2001-02-25: Sukjae Cho <sjcho@east.isi.edu> &
590 + * Chester Kuo <chester@linux.org.tw>
591 + * Save more value for the resume function! Support
592 + * Bitsy/Assabet/Freebird board
593 + *
594 + * 2001-08-29: Nicolas Pitre <nico@cam.org>
595 + * Cleaned up, pushed platform dependent stuff
596 + * in the platform specific files.
597 + *
598 + * 2002-05-27: Nicolas Pitre Killed sleep.h and the kmalloced save array.
599 + * Storage is local on the stack now.
600 + */
601 +#include <linux/config.h>
602 +#include <linux/module.h>
603 +#include <linux/init.h>
604 +#include <linux/pm.h>
605 +#include <linux/slab.h>
606 +#include <linux/sched.h>
607 +#include <linux/interrupt.h>
608 +#include <linux/sysctl.h>
609 +#include <linux/errno.h>
610 +#include <linux/cpufreq.h>
611 +
612 +#include <asm/hardware.h>
613 +#include <asm/memory.h>
614 +#include <asm/system.h>
615 +#include <asm/leds.h>
616 +
617 +
618 +#ifdef CONFIG_IPAQ_HANDHELD
619 +#include <asm/arch/h3600_asic.h>
620 +#endif
621 +
622 +#define __KERNEL_SYSCALLS__
623 +#include <linux/unistd.h>
624 +
625 +extern void sa1100_cpu_suspend(void);
626 +extern void sa1100_cpu_resume(void);
627 +extern int debug_pm;
628 +
629 +#define SAVE(x) sleep_save[SLEEP_SAVE_##x] = x
630 +#define RESTORE(x) x = sleep_save[SLEEP_SAVE_##x]
631 +
632 +/*
633 + * List of global SA11x0 peripheral registers to preserve.
634 + * More ones like CP and general purpose register values are preserved
635 + * with the stack location in sleep.S.
636 + */
637 +enum { SLEEP_SAVE_START = 0,
638 +
639 + SLEEP_SAVE_OSCR, SLEEP_SAVE_OIER,
640 + SLEEP_SAVE_OSMR0, SLEEP_SAVE_OSMR1, SLEEP_SAVE_OSMR2, SLEEP_SAVE_OSMR3,
641 +
642 + SLEEP_SAVE_GPDR, SLEEP_SAVE_GRER, SLEEP_SAVE_GFER, SLEEP_SAVE_GAFR,
643 + SLEEP_SAVE_PPDR, SLEEP_SAVE_PPSR, SLEEP_SAVE_PPAR, SLEEP_SAVE_PSDR,
644 +
645 + SLEEP_SAVE_ICMR,
646 +#ifdef CONFIG_SA1100_SIMPAD
647 + SLEEP_SAVE_MECR, /* needed by SIMpad to get PCMCIA working after resume */
648 +#endif
649 + SLEEP_SAVE_Ser1SDCR0,
650 +
651 + SLEEP_SAVE_PWER,
652 + SLEEP_SAVE_MSC1, SLEEP_SAVE_MSC2,
653 +
654 + SLEEP_SAVE_SIZE
655 +};
656 +
657 +
658 +int pm_do_suspend(void)
659 +{
660 + unsigned long sleep_save[SLEEP_SAVE_SIZE];
661 +
662 + cli();
663 +
664 + leds_event(led_stop);
665 +
666 + /* preserve current time */
667 + RCNR = xtime.tv_sec;
668 +
669 + /* save vital registers */
670 + SAVE(OSCR);
671 + SAVE(OSMR0);
672 + SAVE(OSMR1);
673 + SAVE(OSMR2);
674 + SAVE(OSMR3);
675 + SAVE(OIER);
676 +
677 + SAVE(GPDR);
678 + SAVE(GRER);
679 + SAVE(GFER);
680 + SAVE(GAFR);
681 +
682 + SAVE(PPDR);
683 + SAVE(PPSR);
684 + SAVE(PPAR);
685 + SAVE(PSDR);
686 +
687 + SAVE(Ser1SDCR0);
688 +
689 + SAVE(ICMR);
690 +#ifdef CONFIG_SA1100_SIMPAD
691 + SAVE(MECR);
692 +#endif
693 + SAVE(PWER);
694 + SAVE(MSC1);
695 + SAVE(MSC2);
696 +
697 + /* ... maybe a global variable initialized by arch code to set this? */
698 + GRER &= PWER;
699 + GFER &= PWER;
700 + // Ugly, but I need the AC inserted event
701 + // In the future, we're going to care about DCD and USB interrupts as well
702 + if ( machine_is_h3800()) {
703 +#ifdef CONFIG_IPAQ_HANDHELD
704 + GFER = GPIO_H3800_AC_IN;
705 +#endif
706 + } else {
707 + GFER = 0;
708 + if (machine_is_jornada56x()) {
709 + /* jca */
710 + GFER = PWER;
711 + ICMR |= PWER;
712 + }
713 + }
714 + GEDR = GEDR;
715 +
716 + /* Clear previous reset status */
717 + RCSR = RCSR_HWR | RCSR_SWR | RCSR_WDR | RCSR_SMR;
718 +
719 + /* set resume return address */
720 + PSPR = virt_to_phys(sa1100_cpu_resume);
721 +
722 + /* go zzz */
723 + sa1100_cpu_suspend();
724 +
725 + /* ensure not to come back here if it wasn't intended */
726 + PSPR = 0;
727 +
728 + if (debug_pm)
729 + printk(KERN_CRIT "*** made it back from resume\n");
730 +
731 +#ifdef CONFIG_IPAQ_HANDHELD
732 + if ( machine_is_ipaq()) {
733 + ipaq_model_ops.gedr = GEDR;
734 + ipaq_model_ops.icpr = ICPR;
735 + }
736 +#endif
737 +
738 + /* restore registers */
739 + RESTORE(GPDR);
740 + RESTORE(GRER);
741 + RESTORE(GFER);
742 + RESTORE(GAFR);
743 +
744 + /* clear any edge detect bit */
745 + GEDR = GEDR;
746 +
747 + RESTORE(PPDR);
748 + RESTORE(PPSR);
749 + RESTORE(PPAR);
750 + RESTORE(PSDR);
751 +
752 + RESTORE(Ser1SDCR0);
753 +
754 + PSSR = PSSR_PH;
755 +
756 + RESTORE(OSMR0);
757 + RESTORE(OSMR1);
758 + RESTORE(OSMR2);
759 + RESTORE(OSMR3);
760 + RESTORE(OSCR);
761 + RESTORE(OIER);
762 +
763 +#ifdef CONFIG_IPAQ_HANDHELD
764 +/* OSMR0 may have fired before we went to sleep, but after interrupts
765 + were shut off. Set OSMR0 to something plausible */
766 + OSMR0 = OSCR + LATCH;
767 +#endif
768 + ICLR = 0;
769 + ICCR = 1;
770 + RESTORE(ICMR);
771 +#ifdef CONFIG_SA1100_SIMPAD
772 + RESTORE(MECR);
773 +#endif
774 + RESTORE(PWER);
775 + RESTORE(MSC1);
776 + RESTORE(MSC2);
777 + /* restore current time */
778 + xtime.tv_sec = RCNR;
779 +
780 + leds_event(led_start);
781 +
782 + sti();
783 +
784 + if (debug_pm)
785 + printk("interrupts are enabled\n");
786 +
787 + /*
788 + * Restore the CPU frequency settings.
789 + */
790 +#ifdef CONFIG_CPU_FREQ
791 + cpufreq_restore();
792 +#endif
793 + return 0;
794 +}
795 +
796 +unsigned long sleep_phys_sp(void *sp)
797 +{
798 + return virt_to_phys(sp);
799 +}
800 +
801 +#include "pm-common.c"