1/*
2 * SA1100 Power Management Routines
3 *
4 * Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License.
8 *
9 * History:
10 *
11 * 2001-02-06:	Cliff Brake         Initial code
12 *
13 * 2001-02-25:	Sukjae Cho <sjcho@east.isi.edu> &
14 * 		Chester Kuo <chester@linux.org.tw>
15 * 			Save more value for the resume function! Support
16 * 			Bitsy/Assabet/Freebird board
17 *
18 * 2001-08-29:	Nicolas Pitre <nico@cam.org>
19 * 			Cleaned up, pushed platform dependent stuff
20 * 			in the platform specific files.
21 *
22 * 2002-05-27:	Nicolas Pitre	Killed sleep.h and the kmalloced save array.
23 * 				Storage is local on the stack now.
24 */
25#include <linux/init.h>
26#include <linux/suspend.h>
27#include <linux/errno.h>
28#include <linux/time.h>
29
30#include <asm/hardware.h>
31#include <asm/memory.h>
32#include <asm/system.h>
33#include <asm/mach/time.h>
34
35extern void sa1100_cpu_suspend(void);
36extern void sa1100_cpu_resume(void);
37
38#define SAVE(x)		sleep_save[SLEEP_SAVE_##x] = x
39#define RESTORE(x)	x = sleep_save[SLEEP_SAVE_##x]
40
41/*
42 * List of global SA11x0 peripheral registers to preserve.
43 * More ones like CP and general purpose register values are preserved
44 * on the stack and then the stack pointer is stored last in sleep.S.
45 */
46enum {	SLEEP_SAVE_SP = 0,
47
48	SLEEP_SAVE_GPDR, SLEEP_SAVE_GAFR,
49	SLEEP_SAVE_PPDR, SLEEP_SAVE_PPSR, SLEEP_SAVE_PPAR, SLEEP_SAVE_PSDR,
50
51	SLEEP_SAVE_Ser1SDCR0,
52
53	SLEEP_SAVE_SIZE
54};
55
56
57static int sa11x0_pm_enter(suspend_state_t state)
58{
59	unsigned long gpio, sleep_save[SLEEP_SAVE_SIZE];
60	struct timespec delta, rtc;
61
62	/* preserve current time */
63	rtc.tv_sec = RCNR;
64	rtc.tv_nsec = 0;
65	save_time_delta(&delta, &rtc);
66	gpio = GPLR;
67
68	/* save vital registers */
69	SAVE(GPDR);
70	SAVE(GAFR);
71
72	SAVE(PPDR);
73	SAVE(PPSR);
74	SAVE(PPAR);
75	SAVE(PSDR);
76
77	SAVE(Ser1SDCR0);
78
79	/* Clear previous reset status */
80	RCSR = RCSR_HWR | RCSR_SWR | RCSR_WDR | RCSR_SMR;
81
82	/* set resume return address */
83	PSPR = virt_to_phys(sa1100_cpu_resume);
84
85	/* go zzz */
86	sa1100_cpu_suspend();
87
88	cpu_init();
89
90	/*
91	 * Ensure not to come back here if it wasn't intended
92	 */
93	PSPR = 0;
94
95	/*
96	 * Ensure interrupt sources are disabled; we will re-init
97	 * the interrupt subsystem via the device manager.
98	 */
99	ICLR = 0;
100	ICCR = 1;
101	ICMR = 0;
102
103	/* restore registers */
104	RESTORE(GPDR);
105	RESTORE(GAFR);
106
107	RESTORE(PPDR);
108	RESTORE(PPSR);
109	RESTORE(PPAR);
110	RESTORE(PSDR);
111
112	RESTORE(Ser1SDCR0);
113
114	GPSR = gpio;
115	GPCR = ~gpio;
116
117	/*
118	 * Clear the peripheral sleep-hold bit.
119	 */
120	PSSR = PSSR_PH;
121
122	/* restore current time */
123	rtc.tv_sec = RCNR;
124	restore_time_delta(&delta, &rtc);
125
126	return 0;
127}
128
129unsigned long sleep_phys_sp(void *sp)
130{
131	return virt_to_phys(sp);
132}
133
134static struct pm_ops sa11x0_pm_ops = {
135	.enter		= sa11x0_pm_enter,
136	.valid		= pm_valid_only_mem,
137};
138
139static int __init sa11x0_pm_init(void)
140{
141	pm_set_ops(&sa11x0_pm_ops);
142	return 0;
143}
144
145late_initcall(sa11x0_pm_init);
146