1
2
3
4
5
6
7
8
9
10
11#include <linux/pm.h>
12#include <linux/suspend.h>
13#include <linux/cpuidle.h>
14#include <linux/module.h>
15#include <linux/list.h>
16#include <linux/err.h>
17#include <linux/slab.h>
18#include <linux/pm_clock.h>
19#include <linux/platform_device.h>
20#include <linux/delay.h>
21#include <linux/irq.h>
22#include <linux/bitrev.h>
23#include <linux/console.h>
24#include <asm/cpuidle.h>
25#include <asm/io.h>
26#include <asm/tlbflush.h>
27#include <asm/suspend.h>
28#include <mach/common.h>
29#include <mach/sh7372.h>
30#include <mach/pm-rmobile.h>
31
32
33#define DBGREG1 IOMEM(0xe6100020)
34#define DBGREG9 IOMEM(0xe6100040)
35
36
37#define SYSTBCR IOMEM(0xe6150024)
38#define MSTPSR0 IOMEM(0xe6150030)
39#define MSTPSR1 IOMEM(0xe6150038)
40#define MSTPSR2 IOMEM(0xe6150040)
41#define MSTPSR3 IOMEM(0xe6150048)
42#define MSTPSR4 IOMEM(0xe615004c)
43#define PLLC01STPCR IOMEM(0xe61500c8)
44
45
46#define SBAR IOMEM(0xe6180020)
47#define WUPRMSK IOMEM(0xe6180028)
48#define WUPSMSK IOMEM(0xe618002c)
49#define WUPSMSK2 IOMEM(0xe6180048)
50#define WUPSFAC IOMEM(0xe6180098)
51#define IRQCR IOMEM(0xe618022c)
52#define IRQCR2 IOMEM(0xe6180238)
53#define IRQCR3 IOMEM(0xe6180244)
54#define IRQCR4 IOMEM(0xe6180248)
55#define PDNSEL IOMEM(0xe6180254)
56
57
58#define ICR1A IOMEM(0xe6900000)
59#define ICR2A IOMEM(0xe6900004)
60#define ICR3A IOMEM(0xe6900008)
61#define ICR4A IOMEM(0xe690000c)
62#define INTMSK00A IOMEM(0xe6900040)
63#define INTMSK10A IOMEM(0xe6900044)
64#define INTMSK20A IOMEM(0xe6900048)
65#define INTMSK30A IOMEM(0xe690004c)
66
67
68
69#define SMFRAM 0xe6a70000
70
71
72#define APARMBAREA IOMEM(0xe6f10020)
73
74#ifdef CONFIG_PM
75
76#define PM_DOMAIN_ON_OFF_LATENCY_NS 250000
77
78static int sh7372_a4r_pd_suspend(void)
79{
80 sh7372_intcs_suspend();
81 __raw_writel(0x300fffff, WUPRMSK);
82 return 0;
83}
84
85static bool a4s_suspend_ready;
86
87static int sh7372_a4s_pd_suspend(void)
88{
89
90
91
92
93
94
95
96 a4s_suspend_ready = true;
97 return -EBUSY;
98}
99
100static void sh7372_a4s_pd_resume(void)
101{
102 a4s_suspend_ready = false;
103}
104
105static int sh7372_a3sp_pd_suspend(void)
106{
107
108
109
110
111 return console_suspend_enabled ? 0 : -EBUSY;
112}
113
114static struct rmobile_pm_domain sh7372_pm_domains[] = {
115 {
116 .genpd.name = "A4LC",
117 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
118 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
119 .bit_shift = 1,
120 },
121 {
122 .genpd.name = "A4MP",
123 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
124 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
125 .bit_shift = 2,
126 },
127 {
128 .genpd.name = "D4",
129 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
130 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
131 .bit_shift = 3,
132 },
133 {
134 .genpd.name = "A4R",
135 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
136 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
137 .bit_shift = 5,
138 .suspend = sh7372_a4r_pd_suspend,
139 .resume = sh7372_intcs_resume,
140 },
141 {
142 .genpd.name = "A3RV",
143 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
144 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
145 .bit_shift = 6,
146 },
147 {
148 .genpd.name = "A3RI",
149 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
150 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
151 .bit_shift = 8,
152 },
153 {
154 .genpd.name = "A4S",
155 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
156 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
157 .bit_shift = 10,
158 .gov = &pm_domain_always_on_gov,
159 .no_debug = true,
160 .suspend = sh7372_a4s_pd_suspend,
161 .resume = sh7372_a4s_pd_resume,
162 },
163 {
164 .genpd.name = "A3SP",
165 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
166 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
167 .bit_shift = 11,
168 .gov = &pm_domain_always_on_gov,
169 .no_debug = true,
170 .suspend = sh7372_a3sp_pd_suspend,
171 },
172 {
173 .genpd.name = "A3SG",
174 .genpd.power_on_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
175 .genpd.power_off_latency_ns = PM_DOMAIN_ON_OFF_LATENCY_NS,
176 .bit_shift = 13,
177 },
178};
179
180void __init sh7372_init_pm_domains(void)
181{
182 rmobile_init_domains(sh7372_pm_domains, ARRAY_SIZE(sh7372_pm_domains));
183 pm_genpd_add_subdomain_names("A4LC", "A3RV");
184 pm_genpd_add_subdomain_names("A4R", "A4LC");
185 pm_genpd_add_subdomain_names("A4S", "A3SG");
186 pm_genpd_add_subdomain_names("A4S", "A3SP");
187}
188
189#endif
190
191#if defined(CONFIG_SUSPEND) || defined(CONFIG_CPU_IDLE)
192static void sh7372_set_reset_vector(unsigned long address)
193{
194
195 __raw_writel(address, SBAR);
196 __raw_writel(0, APARMBAREA);
197}
198
199static void sh7372_enter_sysc(int pllc0_on, unsigned long sleep_mode)
200{
201 if (pllc0_on)
202 __raw_writel(0, PLLC01STPCR);
203 else
204 __raw_writel(1 << 28, PLLC01STPCR);
205
206 __raw_readl(WUPSFAC);
207 cpu_suspend(sleep_mode, sh7372_do_idle_sysc);
208 __raw_readl(WUPSFAC);
209
210
211 __raw_writel(0, SBAR);
212}
213
214static int sh7372_sysc_valid(unsigned long *mskp, unsigned long *msk2p)
215{
216 unsigned long mstpsr0, mstpsr1, mstpsr2, mstpsr3, mstpsr4;
217 unsigned long msk, msk2;
218
219
220
221 mstpsr0 = __raw_readl(MSTPSR0);
222 if ((mstpsr0 & 0x00000003) != 0x00000003) {
223 pr_debug("sh7372 mstpsr0 0x%08lx\n", mstpsr0);
224 return 0;
225 }
226
227 mstpsr1 = __raw_readl(MSTPSR1);
228 if ((mstpsr1 & 0xff079b7f) != 0xff079b7f) {
229 pr_debug("sh7372 mstpsr1 0x%08lx\n", mstpsr1);
230 return 0;
231 }
232
233 mstpsr2 = __raw_readl(MSTPSR2);
234 if ((mstpsr2 & 0x000741ff) != 0x000741ff) {
235 pr_debug("sh7372 mstpsr2 0x%08lx\n", mstpsr2);
236 return 0;
237 }
238
239 mstpsr3 = __raw_readl(MSTPSR3);
240 if ((mstpsr3 & 0x1a60f010) != 0x1a60f010) {
241 pr_debug("sh7372 mstpsr3 0x%08lx\n", mstpsr3);
242 return 0;
243 }
244
245 mstpsr4 = __raw_readl(MSTPSR4);
246 if ((mstpsr4 & 0x00008cf0) != 0x00008cf0) {
247 pr_debug("sh7372 mstpsr4 0x%08lx\n", mstpsr4);
248 return 0;
249 }
250
251 msk = 0;
252 msk2 = 0;
253
254
255
256 if ((mstpsr2 & (1 << 23)) == 0)
257 msk |= 1 << 31;
258
259 if ((mstpsr2 & (1 << 12)) == 0)
260 msk |= 1 << 21;
261
262 if ((mstpsr4 & (1 << 3)) == 0)
263 msk |= 1 << 2;
264
265 if ((mstpsr1 & (1 << 24)) == 0)
266 msk |= 1 << 1;
267
268 if ((mstpsr3 & (1 << 29)) == 0)
269 msk |= 1 << 1;
270
271 if ((mstpsr4 & (1 << 0)) == 0)
272 msk |= 1 << 1;
273
274 if ((mstpsr2 & (1 << 13)) == 0)
275 msk2 |= 1 << 17;
276
277 *mskp = msk;
278 *msk2p = msk2;
279
280 return 1;
281}
282
283static void sh7372_icr_to_irqcr(unsigned long icr, u16 *irqcr1p, u16 *irqcr2p)
284{
285 u16 tmp, irqcr1, irqcr2;
286 int k;
287
288 irqcr1 = 0;
289 irqcr2 = 0;
290
291
292 for (k = 0; k <= 7; k++) {
293 tmp = (icr >> ((7 - k) * 4)) & 0xf;
294 irqcr1 |= (tmp & 0x03) << (k * 2);
295 irqcr2 |= (tmp >> 2) << (k * 2);
296 }
297
298 *irqcr1p = irqcr1;
299 *irqcr2p = irqcr2;
300}
301
302static void sh7372_setup_sysc(unsigned long msk, unsigned long msk2)
303{
304 u16 irqcrx_low, irqcrx_high, irqcry_low, irqcry_high;
305 unsigned long tmp;
306
307
308 tmp = bitrev8(__raw_readb(INTMSK00A));
309 tmp |= bitrev8(__raw_readb(INTMSK10A)) << 8;
310
311
312 msk = (~msk & 0xc030000f) | (tmp << 4);
313 __raw_writel(msk, WUPSMSK);
314
315
316 sh7372_icr_to_irqcr(__raw_readl(ICR1A), &irqcrx_low, &irqcry_low);
317 sh7372_icr_to_irqcr(__raw_readl(ICR2A), &irqcrx_high, &irqcry_high);
318 __raw_writel((irqcrx_high << 16) | irqcrx_low, IRQCR);
319 __raw_writel((irqcry_high << 16) | irqcry_low, IRQCR2);
320
321
322 tmp = bitrev8(__raw_readb(INTMSK20A));
323 tmp |= bitrev8(__raw_readb(INTMSK30A)) << 8;
324
325
326 msk2 = (~msk2 & 0x00030000) | tmp;
327 __raw_writel(msk2, WUPSMSK2);
328
329
330 sh7372_icr_to_irqcr(__raw_readl(ICR3A), &irqcrx_low, &irqcry_low);
331 sh7372_icr_to_irqcr(__raw_readl(ICR4A), &irqcrx_high, &irqcry_high);
332 __raw_writel((irqcrx_high << 16) | irqcrx_low, IRQCR3);
333 __raw_writel((irqcry_high << 16) | irqcry_low, IRQCR4);
334}
335
336static void sh7372_enter_a3sm_common(int pllc0_on)
337{
338
339 sh7372_setup_sysc(1 << 0, 0);
340 sh7372_set_reset_vector(__pa(sh7372_resume_core_standby_sysc));
341 sh7372_enter_sysc(pllc0_on, 1 << 12);
342}
343
344static void sh7372_enter_a4s_common(int pllc0_on)
345{
346 sh7372_intca_suspend();
347 sh7372_set_reset_vector(SMFRAM);
348 sh7372_enter_sysc(pllc0_on, 1 << 10);
349 sh7372_intca_resume();
350}
351
352static void sh7372_pm_setup_smfram(void)
353{
354
355 sh7372_cpu_resume = virt_to_phys(cpu_resume);
356
357 memcpy((void *)SMFRAM, sh7372_resume_core_standby_sysc, 0x100);
358}
359#else
360static inline void sh7372_pm_setup_smfram(void) {}
361#endif
362
363#ifdef CONFIG_CPU_IDLE
364static int sh7372_do_idle_core_standby(unsigned long unused)
365{
366 cpu_do_idle();
367 return 0;
368}
369
370static int sh7372_enter_core_standby(struct cpuidle_device *dev,
371 struct cpuidle_driver *drv, int index)
372{
373 sh7372_set_reset_vector(__pa(sh7372_resume_core_standby_sysc));
374
375
376 __raw_writel(0x10, SYSTBCR);
377 cpu_suspend(0, sh7372_do_idle_core_standby);
378 __raw_writel(0, SYSTBCR);
379
380
381 __raw_writel(0, SBAR);
382
383 return 1;
384}
385
386static int sh7372_enter_a3sm_pll_on(struct cpuidle_device *dev,
387 struct cpuidle_driver *drv, int index)
388{
389 sh7372_enter_a3sm_common(1);
390 return 2;
391}
392
393static int sh7372_enter_a3sm_pll_off(struct cpuidle_device *dev,
394 struct cpuidle_driver *drv, int index)
395{
396 sh7372_enter_a3sm_common(0);
397 return 3;
398}
399
400static int sh7372_enter_a4s(struct cpuidle_device *dev,
401 struct cpuidle_driver *drv, int index)
402{
403 unsigned long msk, msk2;
404
405 if (!sh7372_sysc_valid(&msk, &msk2))
406 return sh7372_enter_a3sm_pll_off(dev, drv, index);
407
408 sh7372_setup_sysc(msk, msk2);
409 sh7372_enter_a4s_common(0);
410 return 4;
411}
412
413static struct cpuidle_driver sh7372_cpuidle_driver = {
414 .name = "sh7372_cpuidle",
415 .owner = THIS_MODULE,
416 .state_count = 5,
417 .safe_state_index = 0,
418 .states[0] = ARM_CPUIDLE_WFI_STATE,
419 .states[1] = {
420 .name = "C2",
421 .desc = "Core Standby Mode",
422 .exit_latency = 10,
423 .target_residency = 20 + 10,
424 .flags = CPUIDLE_FLAG_TIME_VALID,
425 .enter = sh7372_enter_core_standby,
426 },
427 .states[2] = {
428 .name = "C3",
429 .desc = "A3SM PLL ON",
430 .exit_latency = 20,
431 .target_residency = 30 + 20,
432 .flags = CPUIDLE_FLAG_TIME_VALID,
433 .enter = sh7372_enter_a3sm_pll_on,
434 },
435 .states[3] = {
436 .name = "C4",
437 .desc = "A3SM PLL OFF",
438 .exit_latency = 120,
439 .target_residency = 30 + 120,
440 .flags = CPUIDLE_FLAG_TIME_VALID,
441 .enter = sh7372_enter_a3sm_pll_off,
442 },
443 .states[4] = {
444 .name = "C5",
445 .desc = "A4S PLL OFF",
446 .exit_latency = 240,
447 .target_residency = 30 + 240,
448 .flags = CPUIDLE_FLAG_TIME_VALID,
449 .enter = sh7372_enter_a4s,
450 .disabled = true,
451 },
452};
453
454static void __init sh7372_cpuidle_init(void)
455{
456 shmobile_cpuidle_set_driver(&sh7372_cpuidle_driver);
457}
458#else
459static void __init sh7372_cpuidle_init(void) {}
460#endif
461
462#ifdef CONFIG_SUSPEND
463static int sh7372_enter_suspend(suspend_state_t suspend_state)
464{
465 unsigned long msk, msk2;
466
467
468 if (sh7372_sysc_valid(&msk, &msk2) && a4s_suspend_ready) {
469
470 sh7372_setup_sysc(msk, msk2);
471
472
473 pr_debug("entering A4S\n");
474 sh7372_enter_a4s_common(0);
475 return 0;
476 }
477
478
479 pr_debug("entering A3SM\n");
480 sh7372_enter_a3sm_common(0);
481 return 0;
482}
483
484
485
486
487
488
489
490static int sh7372_pm_notifier_fn(struct notifier_block *notifier,
491 unsigned long pm_event, void *unused)
492{
493 switch (pm_event) {
494 case PM_SUSPEND_PREPARE:
495
496
497
498
499
500
501 pm_genpd_name_poweron("A4R");
502 break;
503 case PM_POST_SUSPEND:
504 pm_genpd_poweroff_unused();
505 break;
506 }
507
508 return NOTIFY_DONE;
509}
510
511static void sh7372_suspend_init(void)
512{
513 shmobile_suspend_ops.enter = sh7372_enter_suspend;
514 pm_notifier(sh7372_pm_notifier_fn, 0);
515}
516#else
517static void sh7372_suspend_init(void) {}
518#endif
519
520void __init sh7372_pm_init(void)
521{
522
523 __raw_writel(0x0000a500, DBGREG9);
524 __raw_writel(0x0000a501, DBGREG9);
525 __raw_writel(0x00000000, DBGREG1);
526
527
528 __raw_writel(0, PDNSEL);
529
530 sh7372_pm_setup_smfram();
531
532 sh7372_suspend_init();
533 sh7372_cpuidle_init();
534}
535
536void __init sh7372_pm_init_late(void)
537{
538 shmobile_init_late();
539 pm_genpd_name_attach_cpuidle("A4S", 4);
540}
541