ARM: OMAP2xxx: PM: remove obsolete timer disable code in the suspend path
[firefly-linux-kernel-4.4.55.git] / arch / arm / mach-omap2 / pm24xx.c
1 /*
2  * OMAP2 Power Management Routines
3  *
4  * Copyright (C) 2005 Texas Instruments, Inc.
5  * Copyright (C) 2006-2008 Nokia Corporation
6  *
7  * Written by:
8  * Richard Woodruff <r-woodruff2@ti.com>
9  * Tony Lindgren
10  * Juha Yrjola
11  * Amit Kucheria <amit.kucheria@nokia.com>
12  * Igor Stoppa <igor.stoppa@nokia.com>
13  *
14  * Based on pm.c for omap1
15  *
16  * This program is free software; you can redistribute it and/or modify
17  * it under the terms of the GNU General Public License version 2 as
18  * published by the Free Software Foundation.
19  */
20
21 #include <linux/suspend.h>
22 #include <linux/sched.h>
23 #include <linux/proc_fs.h>
24 #include <linux/interrupt.h>
25 #include <linux/sysfs.h>
26 #include <linux/module.h>
27 #include <linux/delay.h>
28 #include <linux/clk.h>
29 #include <linux/io.h>
30 #include <linux/irq.h>
31 #include <linux/time.h>
32 #include <linux/gpio.h>
33
34 #include <asm/mach/time.h>
35 #include <asm/mach/irq.h>
36 #include <asm/mach-types.h>
37
38 #include <mach/irqs.h>
39 #include <plat/clock.h>
40 #include <plat/sram.h>
41 #include <plat/dma.h>
42 #include <plat/board.h>
43
44 #include "common.h"
45 #include "prm2xxx_3xxx.h"
46 #include "prm-regbits-24xx.h"
47 #include "cm2xxx_3xxx.h"
48 #include "cm-regbits-24xx.h"
49 #include "sdrc.h"
50 #include "pm.h"
51 #include "control.h"
52
53 #include "powerdomain.h"
54 #include "clockdomain.h"
55
56 #ifdef CONFIG_SUSPEND
57 static suspend_state_t suspend_state = PM_SUSPEND_ON;
58 static inline bool is_suspending(void)
59 {
60         return (suspend_state != PM_SUSPEND_ON);
61 }
62 #else
63 static inline bool is_suspending(void)
64 {
65         return false;
66 }
67 #endif
68
69 static void (*omap2_sram_idle)(void);
70 static void (*omap2_sram_suspend)(u32 dllctrl, void __iomem *sdrc_dlla_ctrl,
71                                   void __iomem *sdrc_power);
72
73 static struct powerdomain *mpu_pwrdm, *core_pwrdm;
74 static struct clockdomain *dsp_clkdm, *mpu_clkdm, *wkup_clkdm, *gfx_clkdm;
75
76 static struct clk *osc_ck, *emul_ck;
77
78 static int omap2_fclks_active(void)
79 {
80         u32 f1, f2;
81
82         f1 = omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1);
83         f2 = omap2_cm_read_mod_reg(CORE_MOD, OMAP24XX_CM_FCLKEN2);
84
85         /* Ignore UART clocks.  These are handled by UART core (serial.c) */
86         f1 &= ~(OMAP24XX_EN_UART1_MASK | OMAP24XX_EN_UART2_MASK);
87         f2 &= ~OMAP24XX_EN_UART3_MASK;
88
89         if (f1 | f2)
90                 return 1;
91         return 0;
92 }
93
94 static void omap2_enter_full_retention(void)
95 {
96         u32 l;
97
98         /* There is 1 reference hold for all children of the oscillator
99          * clock, the following will remove it. If no one else uses the
100          * oscillator itself it will be disabled if/when we enter retention
101          * mode.
102          */
103         clk_disable(osc_ck);
104
105         /* Clear old wake-up events */
106         /* REVISIT: These write to reserved bits? */
107         omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
108         omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
109         omap2_prm_write_mod_reg(0xffffffff, WKUP_MOD, PM_WKST);
110
111         /*
112          * Set MPU powerdomain's next power state to RETENTION;
113          * preserve logic state during retention
114          */
115         pwrdm_set_logic_retst(mpu_pwrdm, PWRDM_POWER_RET);
116         pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
117
118         /* Workaround to kill USB */
119         l = omap_ctrl_readl(OMAP2_CONTROL_DEVCONF0) | OMAP24XX_USBSTANDBYCTRL;
120         omap_ctrl_writel(l, OMAP2_CONTROL_DEVCONF0);
121
122         omap2_gpio_prepare_for_idle(0);
123
124         /* One last check for pending IRQs to avoid extra latency due
125          * to sleeping unnecessarily. */
126         if (omap_irq_pending())
127                 goto no_sleep;
128
129         /* Jump to SRAM suspend code */
130         omap2_sram_suspend(sdrc_read_reg(SDRC_DLLA_CTRL),
131                            OMAP_SDRC_REGADDR(SDRC_DLLA_CTRL),
132                            OMAP_SDRC_REGADDR(SDRC_POWER));
133
134 no_sleep:
135         omap2_gpio_resume_after_idle();
136
137         clk_enable(osc_ck);
138
139         /* clear CORE wake-up events */
140         omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
141         omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
142
143         /* wakeup domain events - bit 1: GPT1, bit5 GPIO */
144         omap2_prm_clear_mod_reg_bits(0x4 | 0x1, WKUP_MOD, PM_WKST);
145
146         /* MPU domain wake events */
147         l = omap2_prm_read_mod_reg(OCP_MOD, OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
148         if (l & 0x01)
149                 omap2_prm_write_mod_reg(0x01, OCP_MOD,
150                                   OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
151         if (l & 0x20)
152                 omap2_prm_write_mod_reg(0x20, OCP_MOD,
153                                   OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
154
155         /* Mask future PRCM-to-MPU interrupts */
156         omap2_prm_write_mod_reg(0x0, OCP_MOD, OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
157 }
158
159 static int omap2_i2c_active(void)
160 {
161         u32 l;
162
163         l = omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1);
164         return l & (OMAP2420_EN_I2C2_MASK | OMAP2420_EN_I2C1_MASK);
165 }
166
167 static int sti_console_enabled;
168
169 static int omap2_allow_mpu_retention(void)
170 {
171         u32 l;
172
173         /* Check for MMC, UART2, UART1, McSPI2, McSPI1 and DSS1. */
174         l = omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1);
175         if (l & (OMAP2420_EN_MMC_MASK | OMAP24XX_EN_UART2_MASK |
176                  OMAP24XX_EN_UART1_MASK | OMAP24XX_EN_MCSPI2_MASK |
177                  OMAP24XX_EN_MCSPI1_MASK | OMAP24XX_EN_DSS1_MASK))
178                 return 0;
179         /* Check for UART3. */
180         l = omap2_cm_read_mod_reg(CORE_MOD, OMAP24XX_CM_FCLKEN2);
181         if (l & OMAP24XX_EN_UART3_MASK)
182                 return 0;
183         if (sti_console_enabled)
184                 return 0;
185
186         return 1;
187 }
188
189 static void omap2_enter_mpu_retention(void)
190 {
191         int only_idle = 0;
192
193         /* Putting MPU into the WFI state while a transfer is active
194          * seems to cause the I2C block to timeout. Why? Good question. */
195         if (omap2_i2c_active())
196                 return;
197
198         /* The peripherals seem not to be able to wake up the MPU when
199          * it is in retention mode. */
200         if (omap2_allow_mpu_retention()) {
201                 /* REVISIT: These write to reserved bits? */
202                 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
203                 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
204                 omap2_prm_write_mod_reg(0xffffffff, WKUP_MOD, PM_WKST);
205
206                 /* Try to enter MPU retention */
207                 omap2_prm_write_mod_reg((0x01 << OMAP_POWERSTATE_SHIFT) |
208                                   OMAP_LOGICRETSTATE_MASK,
209                                   MPU_MOD, OMAP2_PM_PWSTCTRL);
210         } else {
211                 /* Block MPU retention */
212
213                 omap2_prm_write_mod_reg(OMAP_LOGICRETSTATE_MASK, MPU_MOD,
214                                                  OMAP2_PM_PWSTCTRL);
215                 only_idle = 1;
216         }
217
218         omap2_sram_idle();
219 }
220
221 static int omap2_can_sleep(void)
222 {
223         if (omap2_fclks_active())
224                 return 0;
225         if (osc_ck->usecount > 1)
226                 return 0;
227         if (omap_dma_running())
228                 return 0;
229
230         return 1;
231 }
232
233 static void omap2_pm_idle(void)
234 {
235         local_irq_disable();
236         local_fiq_disable();
237
238         if (!omap2_can_sleep()) {
239                 if (omap_irq_pending())
240                         goto out;
241                 omap2_enter_mpu_retention();
242                 goto out;
243         }
244
245         if (omap_irq_pending())
246                 goto out;
247
248         omap2_enter_full_retention();
249
250 out:
251         local_fiq_enable();
252         local_irq_enable();
253 }
254
255 #ifdef CONFIG_SUSPEND
256 static int omap2_pm_begin(suspend_state_t state)
257 {
258         disable_hlt();
259         suspend_state = state;
260         return 0;
261 }
262
263 static int omap2_pm_enter(suspend_state_t state)
264 {
265         int ret = 0;
266
267         switch (state) {
268         case PM_SUSPEND_STANDBY:
269         case PM_SUSPEND_MEM:
270                 omap2_enter_full_retention();
271                 break;
272         default:
273                 ret = -EINVAL;
274         }
275
276         return ret;
277 }
278
279 static void omap2_pm_end(void)
280 {
281         suspend_state = PM_SUSPEND_ON;
282         enable_hlt();
283 }
284
285 static const struct platform_suspend_ops omap_pm_ops = {
286         .begin          = omap2_pm_begin,
287         .enter          = omap2_pm_enter,
288         .end            = omap2_pm_end,
289         .valid          = suspend_valid_only_mem,
290 };
291 #else
292 static const struct platform_suspend_ops __initdata omap_pm_ops;
293 #endif /* CONFIG_SUSPEND */
294
295 /* XXX This function should be shareable between OMAP2xxx and OMAP3 */
296 static int __init clkdms_setup(struct clockdomain *clkdm, void *unused)
297 {
298         if (clkdm->flags & CLKDM_CAN_ENABLE_AUTO)
299                 clkdm_allow_idle(clkdm);
300         else if (clkdm->flags & CLKDM_CAN_FORCE_SLEEP &&
301                  atomic_read(&clkdm->usecount) == 0)
302                 clkdm_sleep(clkdm);
303         return 0;
304 }
305
306 static void __init prcm_setup_regs(void)
307 {
308         int i, num_mem_banks;
309         struct powerdomain *pwrdm;
310
311         /*
312          * Enable autoidle
313          * XXX This should be handled by hwmod code or PRCM init code
314          */
315         omap2_prm_write_mod_reg(OMAP24XX_AUTOIDLE_MASK, OCP_MOD,
316                           OMAP2_PRCM_SYSCONFIG_OFFSET);
317
318         /*
319          * Set CORE powerdomain memory banks to retain their contents
320          * during RETENTION
321          */
322         num_mem_banks = pwrdm_get_mem_bank_count(core_pwrdm);
323         for (i = 0; i < num_mem_banks; i++)
324                 pwrdm_set_mem_retst(core_pwrdm, i, PWRDM_POWER_RET);
325
326         /* Set CORE powerdomain's next power state to RETENTION */
327         pwrdm_set_next_pwrst(core_pwrdm, PWRDM_POWER_RET);
328
329         /*
330          * Set MPU powerdomain's next power state to RETENTION;
331          * preserve logic state during retention
332          */
333         pwrdm_set_logic_retst(mpu_pwrdm, PWRDM_POWER_RET);
334         pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
335
336         /* Force-power down DSP, GFX powerdomains */
337
338         pwrdm = clkdm_get_pwrdm(dsp_clkdm);
339         pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_OFF);
340         clkdm_sleep(dsp_clkdm);
341
342         pwrdm = clkdm_get_pwrdm(gfx_clkdm);
343         pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_OFF);
344         clkdm_sleep(gfx_clkdm);
345
346         /* Enable hardware-supervised idle for all clkdms */
347         clkdm_for_each(clkdms_setup, NULL);
348         clkdm_add_wkdep(mpu_clkdm, wkup_clkdm);
349
350         /* REVISIT: Configure number of 32 kHz clock cycles for sys_clk
351          * stabilisation */
352         omap2_prm_write_mod_reg(15 << OMAP_SETUP_TIME_SHIFT, OMAP24XX_GR_MOD,
353                                 OMAP2_PRCM_CLKSSETUP_OFFSET);
354
355         /* Configure automatic voltage transition */
356         omap2_prm_write_mod_reg(2 << OMAP_SETUP_TIME_SHIFT, OMAP24XX_GR_MOD,
357                                 OMAP2_PRCM_VOLTSETUP_OFFSET);
358         omap2_prm_write_mod_reg(OMAP24XX_AUTO_EXTVOLT_MASK |
359                                 (0x1 << OMAP24XX_SETOFF_LEVEL_SHIFT) |
360                                 OMAP24XX_MEMRETCTRL_MASK |
361                                 (0x1 << OMAP24XX_SETRET_LEVEL_SHIFT) |
362                                 (0x0 << OMAP24XX_VOLT_LEVEL_SHIFT),
363                                 OMAP24XX_GR_MOD, OMAP2_PRCM_VOLTCTRL_OFFSET);
364
365         /* Enable wake-up events */
366         omap2_prm_write_mod_reg(OMAP24XX_EN_GPIOS_MASK | OMAP24XX_EN_GPT1_MASK,
367                                 WKUP_MOD, PM_WKEN);
368 }
369
370 static int __init omap2_pm_init(void)
371 {
372         u32 l;
373
374         if (!cpu_is_omap24xx())
375                 return -ENODEV;
376
377         printk(KERN_INFO "Power Management for OMAP2 initializing\n");
378         l = omap2_prm_read_mod_reg(OCP_MOD, OMAP2_PRCM_REVISION_OFFSET);
379         printk(KERN_INFO "PRCM revision %d.%d\n", (l >> 4) & 0x0f, l & 0x0f);
380
381         /* Look up important powerdomains */
382
383         mpu_pwrdm = pwrdm_lookup("mpu_pwrdm");
384         if (!mpu_pwrdm)
385                 pr_err("PM: mpu_pwrdm not found\n");
386
387         core_pwrdm = pwrdm_lookup("core_pwrdm");
388         if (!core_pwrdm)
389                 pr_err("PM: core_pwrdm not found\n");
390
391         /* Look up important clockdomains */
392
393         mpu_clkdm = clkdm_lookup("mpu_clkdm");
394         if (!mpu_clkdm)
395                 pr_err("PM: mpu_clkdm not found\n");
396
397         wkup_clkdm = clkdm_lookup("wkup_clkdm");
398         if (!wkup_clkdm)
399                 pr_err("PM: wkup_clkdm not found\n");
400
401         dsp_clkdm = clkdm_lookup("dsp_clkdm");
402         if (!dsp_clkdm)
403                 pr_err("PM: dsp_clkdm not found\n");
404
405         gfx_clkdm = clkdm_lookup("gfx_clkdm");
406         if (!gfx_clkdm)
407                 pr_err("PM: gfx_clkdm not found\n");
408
409
410         osc_ck = clk_get(NULL, "osc_ck");
411         if (IS_ERR(osc_ck)) {
412                 printk(KERN_ERR "could not get osc_ck\n");
413                 return -ENODEV;
414         }
415
416         if (cpu_is_omap242x()) {
417                 emul_ck = clk_get(NULL, "emul_ck");
418                 if (IS_ERR(emul_ck)) {
419                         printk(KERN_ERR "could not get emul_ck\n");
420                         clk_put(osc_ck);
421                         return -ENODEV;
422                 }
423         }
424
425         prcm_setup_regs();
426
427         /* Hack to prevent MPU retention when STI console is enabled. */
428         {
429                 const struct omap_sti_console_config *sti;
430
431                 sti = omap_get_config(OMAP_TAG_STI_CONSOLE,
432                                       struct omap_sti_console_config);
433                 if (sti != NULL && sti->enable)
434                         sti_console_enabled = 1;
435         }
436
437         /*
438          * We copy the assembler sleep/wakeup routines to SRAM.
439          * These routines need to be in SRAM as that's the only
440          * memory the MPU can see when it wakes up.
441          */
442         if (cpu_is_omap24xx()) {
443                 omap2_sram_idle = omap_sram_push(omap24xx_idle_loop_suspend,
444                                                  omap24xx_idle_loop_suspend_sz);
445
446                 omap2_sram_suspend = omap_sram_push(omap24xx_cpu_suspend,
447                                                     omap24xx_cpu_suspend_sz);
448         }
449
450         suspend_set_ops(&omap_pm_ops);
451         pm_idle = omap2_pm_idle;
452
453         return 0;
454 }
455
456 late_initcall(omap2_pm_init);