xref: /linux/arch/arm/mach-omap2/prm3xxx.c (revision 9a87ffc99ec8eb8d35eed7c4f816d75f5cc9662e)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * OMAP3xxx PRM module functions
4  *
5  * Copyright (C) 2010-2012 Texas Instruments, Inc.
6  * Copyright (C) 2010 Nokia Corporation
7  * Benoît Cousson
8  * Paul Walmsley
9  * Rajendra Nayak <rnayak@ti.com>
10  */
11 
12 #include <linux/kernel.h>
13 #include <linux/errno.h>
14 #include <linux/err.h>
15 #include <linux/io.h>
16 #include <linux/irq.h>
17 #include <linux/of_irq.h>
18 
19 #include "soc.h"
20 #include "common.h"
21 #include "vp.h"
22 #include "powerdomain.h"
23 #include "prm3xxx.h"
24 #include "prm2xxx_3xxx.h"
25 #include "cm2xxx_3xxx.h"
26 #include "prm-regbits-34xx.h"
27 #include "cm3xxx.h"
28 #include "cm-regbits-34xx.h"
29 #include "clock.h"
30 
31 static void omap3xxx_prm_read_pending_irqs(unsigned long *events);
32 static void omap3xxx_prm_ocp_barrier(void);
33 static void omap3xxx_prm_save_and_clear_irqen(u32 *saved_mask);
34 static void omap3xxx_prm_restore_irqen(u32 *saved_mask);
35 static void omap3xxx_prm_iva_idle(void);
36 
37 static const struct omap_prcm_irq omap3_prcm_irqs[] = {
38 	OMAP_PRCM_IRQ("wkup",	0,	0),
39 	OMAP_PRCM_IRQ("io",	9,	1),
40 };
41 
42 static struct omap_prcm_irq_setup omap3_prcm_irq_setup = {
43 	.ack			= OMAP3_PRM_IRQSTATUS_MPU_OFFSET,
44 	.mask			= OMAP3_PRM_IRQENABLE_MPU_OFFSET,
45 	.nr_regs		= 1,
46 	.irqs			= omap3_prcm_irqs,
47 	.nr_irqs		= ARRAY_SIZE(omap3_prcm_irqs),
48 	.irq			= 11 + OMAP_INTC_START,
49 	.read_pending_irqs	= &omap3xxx_prm_read_pending_irqs,
50 	.ocp_barrier		= &omap3xxx_prm_ocp_barrier,
51 	.save_and_clear_irqen	= &omap3xxx_prm_save_and_clear_irqen,
52 	.restore_irqen		= &omap3xxx_prm_restore_irqen,
53 	.reconfigure_io_chain	= NULL,
54 };
55 
56 /*
57  * omap3_prm_reset_src_map - map from bits in the PRM_RSTST hardware
58  *   register (which are specific to OMAP3xxx SoCs) to reset source ID
59  *   bit shifts (which is an OMAP SoC-independent enumeration)
60  */
61 static struct prm_reset_src_map omap3xxx_prm_reset_src_map[] = {
62 	{ OMAP3430_GLOBAL_COLD_RST_SHIFT, OMAP_GLOBAL_COLD_RST_SRC_ID_SHIFT },
63 	{ OMAP3430_GLOBAL_SW_RST_SHIFT, OMAP_GLOBAL_WARM_RST_SRC_ID_SHIFT },
64 	{ OMAP3430_SECURITY_VIOL_RST_SHIFT, OMAP_SECU_VIOL_RST_SRC_ID_SHIFT },
65 	{ OMAP3430_MPU_WD_RST_SHIFT, OMAP_MPU_WD_RST_SRC_ID_SHIFT },
66 	{ OMAP3430_SECURE_WD_RST_SHIFT, OMAP_MPU_WD_RST_SRC_ID_SHIFT },
67 	{ OMAP3430_EXTERNAL_WARM_RST_SHIFT, OMAP_EXTWARM_RST_SRC_ID_SHIFT },
68 	{ OMAP3430_VDD1_VOLTAGE_MANAGER_RST_SHIFT,
69 	  OMAP_VDD_MPU_VM_RST_SRC_ID_SHIFT },
70 	{ OMAP3430_VDD2_VOLTAGE_MANAGER_RST_SHIFT,
71 	  OMAP_VDD_CORE_VM_RST_SRC_ID_SHIFT },
72 	{ OMAP3430_ICEPICK_RST_SHIFT, OMAP_ICEPICK_RST_SRC_ID_SHIFT },
73 	{ OMAP3430_ICECRUSHER_RST_SHIFT, OMAP_ICECRUSHER_RST_SRC_ID_SHIFT },
74 	{ -1, -1 },
75 };
76 
77 /* PRM VP */
78 
79 /*
80  * struct omap3_vp - OMAP3 VP register access description.
81  * @tranxdone_status: VP_TRANXDONE_ST bitmask in PRM_IRQSTATUS_MPU reg
82  */
83 struct omap3_vp {
84 	u32 tranxdone_status;
85 };
86 
87 static struct omap3_vp omap3_vp[] = {
88 	[OMAP3_VP_VDD_MPU_ID] = {
89 		.tranxdone_status = OMAP3430_VP1_TRANXDONE_ST_MASK,
90 	},
91 	[OMAP3_VP_VDD_CORE_ID] = {
92 		.tranxdone_status = OMAP3430_VP2_TRANXDONE_ST_MASK,
93 	},
94 };
95 
96 #define MAX_VP_ID ARRAY_SIZE(omap3_vp);
97 
omap3_prm_vp_check_txdone(u8 vp_id)98 static u32 omap3_prm_vp_check_txdone(u8 vp_id)
99 {
100 	struct omap3_vp *vp = &omap3_vp[vp_id];
101 	u32 irqstatus;
102 
103 	irqstatus = omap2_prm_read_mod_reg(OCP_MOD,
104 					   OMAP3_PRM_IRQSTATUS_MPU_OFFSET);
105 	return irqstatus & vp->tranxdone_status;
106 }
107 
omap3_prm_vp_clear_txdone(u8 vp_id)108 static void omap3_prm_vp_clear_txdone(u8 vp_id)
109 {
110 	struct omap3_vp *vp = &omap3_vp[vp_id];
111 
112 	omap2_prm_write_mod_reg(vp->tranxdone_status,
113 				OCP_MOD, OMAP3_PRM_IRQSTATUS_MPU_OFFSET);
114 }
115 
omap3_prm_vcvp_read(u8 offset)116 u32 omap3_prm_vcvp_read(u8 offset)
117 {
118 	return omap2_prm_read_mod_reg(OMAP3430_GR_MOD, offset);
119 }
120 
omap3_prm_vcvp_write(u32 val,u8 offset)121 void omap3_prm_vcvp_write(u32 val, u8 offset)
122 {
123 	omap2_prm_write_mod_reg(val, OMAP3430_GR_MOD, offset);
124 }
125 
omap3_prm_vcvp_rmw(u32 mask,u32 bits,u8 offset)126 u32 omap3_prm_vcvp_rmw(u32 mask, u32 bits, u8 offset)
127 {
128 	return omap2_prm_rmw_mod_reg_bits(mask, bits, OMAP3430_GR_MOD, offset);
129 }
130 
131 /**
132  * omap3xxx_prm_dpll3_reset - use DPLL3 reset to reboot the OMAP SoC
133  *
134  * Set the DPLL3 reset bit, which should reboot the SoC.  This is the
135  * recommended way to restart the SoC, considering Errata i520.  No
136  * return value.
137  */
omap3xxx_prm_dpll3_reset(void)138 static void omap3xxx_prm_dpll3_reset(void)
139 {
140 	omap2_prm_set_mod_reg_bits(OMAP_RST_DPLL3_MASK, OMAP3430_GR_MOD,
141 				   OMAP2_RM_RSTCTRL);
142 	/* OCP barrier */
143 	omap2_prm_read_mod_reg(OMAP3430_GR_MOD, OMAP2_RM_RSTCTRL);
144 }
145 
146 /**
147  * omap3xxx_prm_read_pending_irqs - read pending PRM MPU IRQs into @events
148  * @events: ptr to a u32, preallocated by caller
149  *
150  * Read PRM_IRQSTATUS_MPU bits, AND'ed with the currently-enabled PRM
151  * MPU IRQs, and store the result into the u32 pointed to by @events.
152  * No return value.
153  */
omap3xxx_prm_read_pending_irqs(unsigned long * events)154 static void omap3xxx_prm_read_pending_irqs(unsigned long *events)
155 {
156 	u32 mask, st;
157 
158 	/* XXX Can the mask read be avoided (e.g., can it come from RAM?) */
159 	mask = omap2_prm_read_mod_reg(OCP_MOD, OMAP3_PRM_IRQENABLE_MPU_OFFSET);
160 	st = omap2_prm_read_mod_reg(OCP_MOD, OMAP3_PRM_IRQSTATUS_MPU_OFFSET);
161 
162 	events[0] = mask & st;
163 }
164 
165 /**
166  * omap3xxx_prm_ocp_barrier - force buffered MPU writes to the PRM to complete
167  *
168  * Force any buffered writes to the PRM IP block to complete.  Needed
169  * by the PRM IRQ handler, which reads and writes directly to the IP
170  * block, to avoid race conditions after acknowledging or clearing IRQ
171  * bits.  No return value.
172  */
omap3xxx_prm_ocp_barrier(void)173 static void omap3xxx_prm_ocp_barrier(void)
174 {
175 	omap2_prm_read_mod_reg(OCP_MOD, OMAP3_PRM_REVISION_OFFSET);
176 }
177 
178 /**
179  * omap3xxx_prm_save_and_clear_irqen - save/clear PRM_IRQENABLE_MPU reg
180  * @saved_mask: ptr to a u32 array to save IRQENABLE bits
181  *
182  * Save the PRM_IRQENABLE_MPU register to @saved_mask.  @saved_mask
183  * must be allocated by the caller.  Intended to be used in the PRM
184  * interrupt handler suspend callback.  The OCP barrier is needed to
185  * ensure the write to disable PRM interrupts reaches the PRM before
186  * returning; otherwise, spurious interrupts might occur.  No return
187  * value.
188  */
omap3xxx_prm_save_and_clear_irqen(u32 * saved_mask)189 static void omap3xxx_prm_save_and_clear_irqen(u32 *saved_mask)
190 {
191 	saved_mask[0] = omap2_prm_read_mod_reg(OCP_MOD,
192 					       OMAP3_PRM_IRQENABLE_MPU_OFFSET);
193 	omap2_prm_write_mod_reg(0, OCP_MOD, OMAP3_PRM_IRQENABLE_MPU_OFFSET);
194 
195 	/* OCP barrier */
196 	omap2_prm_read_mod_reg(OCP_MOD, OMAP3_PRM_REVISION_OFFSET);
197 }
198 
199 /**
200  * omap3xxx_prm_restore_irqen - set PRM_IRQENABLE_MPU register from args
201  * @saved_mask: ptr to a u32 array of IRQENABLE bits saved previously
202  *
203  * Restore the PRM_IRQENABLE_MPU register from @saved_mask.  Intended
204  * to be used in the PRM interrupt handler resume callback to restore
205  * values saved by omap3xxx_prm_save_and_clear_irqen().  No OCP
206  * barrier should be needed here; any pending PRM interrupts will fire
207  * once the writes reach the PRM.  No return value.
208  */
omap3xxx_prm_restore_irqen(u32 * saved_mask)209 static void omap3xxx_prm_restore_irqen(u32 *saved_mask)
210 {
211 	omap2_prm_write_mod_reg(saved_mask[0], OCP_MOD,
212 				OMAP3_PRM_IRQENABLE_MPU_OFFSET);
213 }
214 
215 /**
216  * omap3xxx_prm_clear_mod_irqs - clear wake-up events from PRCM interrupt
217  * @module: PRM module to clear wakeups from
218  * @regs: register set to clear, 1 or 3
219  * @wkst_mask: wkst bits to clear
220  *
221  * The purpose of this function is to clear any wake-up events latched
222  * in the PRCM PM_WKST_x registers. It is possible that a wake-up event
223  * may occur whilst attempting to clear a PM_WKST_x register and thus
224  * set another bit in this register. A while loop is used to ensure
225  * that any peripheral wake-up events occurring while attempting to
226  * clear the PM_WKST_x are detected and cleared.
227  */
omap3xxx_prm_clear_mod_irqs(s16 module,u8 regs,u32 wkst_mask)228 static int omap3xxx_prm_clear_mod_irqs(s16 module, u8 regs, u32 wkst_mask)
229 {
230 	u32 wkst, fclk, iclk, clken;
231 	u16 wkst_off = (regs == 3) ? OMAP3430ES2_PM_WKST3 : PM_WKST1;
232 	u16 fclk_off = (regs == 3) ? OMAP3430ES2_CM_FCLKEN3 : CM_FCLKEN1;
233 	u16 iclk_off = (regs == 3) ? CM_ICLKEN3 : CM_ICLKEN1;
234 	u16 grpsel_off = (regs == 3) ?
235 		OMAP3430ES2_PM_MPUGRPSEL3 : OMAP3430_PM_MPUGRPSEL;
236 	int c = 0;
237 
238 	wkst = omap2_prm_read_mod_reg(module, wkst_off);
239 	wkst &= omap2_prm_read_mod_reg(module, grpsel_off);
240 	wkst &= wkst_mask;
241 	if (wkst) {
242 		iclk = omap2_cm_read_mod_reg(module, iclk_off);
243 		fclk = omap2_cm_read_mod_reg(module, fclk_off);
244 		while (wkst) {
245 			clken = wkst;
246 			omap2_cm_set_mod_reg_bits(clken, module, iclk_off);
247 			/*
248 			 * For USBHOST, we don't know whether HOST1 or
249 			 * HOST2 woke us up, so enable both f-clocks
250 			 */
251 			if (module == OMAP3430ES2_USBHOST_MOD)
252 				clken |= 1 << OMAP3430ES2_EN_USBHOST2_SHIFT;
253 			omap2_cm_set_mod_reg_bits(clken, module, fclk_off);
254 			omap2_prm_write_mod_reg(wkst, module, wkst_off);
255 			wkst = omap2_prm_read_mod_reg(module, wkst_off);
256 			wkst &= wkst_mask;
257 			c++;
258 		}
259 		omap2_cm_write_mod_reg(iclk, module, iclk_off);
260 		omap2_cm_write_mod_reg(fclk, module, fclk_off);
261 	}
262 
263 	return c;
264 }
265 
266 /**
267  * omap3_prm_reset_modem - toggle reset signal for modem
268  *
269  * Toggles the reset signal to modem IP block. Required to allow
270  * OMAP3430 without stacked modem to idle properly.
271  */
omap3_prm_reset_modem(void)272 static void __init omap3_prm_reset_modem(void)
273 {
274 	omap2_prm_write_mod_reg(
275 		OMAP3430_RM_RSTCTRL_CORE_MODEM_SW_RSTPWRON_MASK |
276 		OMAP3430_RM_RSTCTRL_CORE_MODEM_SW_RST_MASK,
277 				CORE_MOD, OMAP2_RM_RSTCTRL);
278 	omap2_prm_write_mod_reg(0, CORE_MOD, OMAP2_RM_RSTCTRL);
279 }
280 
281 /**
282  * omap3_prm_init_pm - initialize PM related registers for PRM
283  * @has_uart4: SoC has UART4
284  * @has_iva: SoC has IVA
285  *
286  * Initializes PRM registers for PM use. Called from PM init.
287  */
omap3_prm_init_pm(bool has_uart4,bool has_iva)288 void __init omap3_prm_init_pm(bool has_uart4, bool has_iva)
289 {
290 	u32 en_uart4_mask;
291 	u32 grpsel_uart4_mask;
292 
293 	/*
294 	 * Enable control of expternal oscillator through
295 	 * sys_clkreq. In the long run clock framework should
296 	 * take care of this.
297 	 */
298 	omap2_prm_rmw_mod_reg_bits(OMAP_AUTOEXTCLKMODE_MASK,
299 				   1 << OMAP_AUTOEXTCLKMODE_SHIFT,
300 				   OMAP3430_GR_MOD,
301 				   OMAP3_PRM_CLKSRC_CTRL_OFFSET);
302 
303 	/* setup wakup source */
304 	omap2_prm_write_mod_reg(OMAP3430_EN_IO_MASK | OMAP3430_EN_GPIO1_MASK |
305 				OMAP3430_EN_GPT1_MASK | OMAP3430_EN_GPT12_MASK,
306 				WKUP_MOD, PM_WKEN);
307 	/* No need to write EN_IO, that is always enabled */
308 	omap2_prm_write_mod_reg(OMAP3430_GRPSEL_GPIO1_MASK |
309 				OMAP3430_GRPSEL_GPT1_MASK |
310 				OMAP3430_GRPSEL_GPT12_MASK,
311 				WKUP_MOD, OMAP3430_PM_MPUGRPSEL);
312 
313 	/* Enable PM_WKEN to support DSS LPR */
314 	omap2_prm_write_mod_reg(OMAP3430_PM_WKEN_DSS_EN_DSS_MASK,
315 				OMAP3430_DSS_MOD, PM_WKEN);
316 
317 	if (has_uart4) {
318 		en_uart4_mask = OMAP3630_EN_UART4_MASK;
319 		grpsel_uart4_mask = OMAP3630_GRPSEL_UART4_MASK;
320 	} else {
321 		en_uart4_mask = 0;
322 		grpsel_uart4_mask = 0;
323 	}
324 
325 	/* Enable wakeups in PER */
326 	omap2_prm_write_mod_reg(en_uart4_mask |
327 				OMAP3430_EN_GPIO2_MASK |
328 				OMAP3430_EN_GPIO3_MASK |
329 				OMAP3430_EN_GPIO4_MASK |
330 				OMAP3430_EN_GPIO5_MASK |
331 				OMAP3430_EN_GPIO6_MASK |
332 				OMAP3430_EN_UART3_MASK |
333 				OMAP3430_EN_MCBSP2_MASK |
334 				OMAP3430_EN_MCBSP3_MASK |
335 				OMAP3430_EN_MCBSP4_MASK,
336 				OMAP3430_PER_MOD, PM_WKEN);
337 
338 	/* and allow them to wake up MPU */
339 	omap2_prm_write_mod_reg(grpsel_uart4_mask |
340 				OMAP3430_GRPSEL_GPIO2_MASK |
341 				OMAP3430_GRPSEL_GPIO3_MASK |
342 				OMAP3430_GRPSEL_GPIO4_MASK |
343 				OMAP3430_GRPSEL_GPIO5_MASK |
344 				OMAP3430_GRPSEL_GPIO6_MASK |
345 				OMAP3430_GRPSEL_UART3_MASK |
346 				OMAP3430_GRPSEL_MCBSP2_MASK |
347 				OMAP3430_GRPSEL_MCBSP3_MASK |
348 				OMAP3430_GRPSEL_MCBSP4_MASK,
349 				OMAP3430_PER_MOD, OMAP3430_PM_MPUGRPSEL);
350 
351 	/* Don't attach IVA interrupts */
352 	if (has_iva) {
353 		omap2_prm_write_mod_reg(0, WKUP_MOD, OMAP3430_PM_IVAGRPSEL);
354 		omap2_prm_write_mod_reg(0, CORE_MOD, OMAP3430_PM_IVAGRPSEL1);
355 		omap2_prm_write_mod_reg(0, CORE_MOD, OMAP3430ES2_PM_IVAGRPSEL3);
356 		omap2_prm_write_mod_reg(0, OMAP3430_PER_MOD,
357 					OMAP3430_PM_IVAGRPSEL);
358 	}
359 
360 	/* Clear any pending 'reset' flags */
361 	omap2_prm_write_mod_reg(0xffffffff, MPU_MOD, OMAP2_RM_RSTST);
362 	omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP2_RM_RSTST);
363 	omap2_prm_write_mod_reg(0xffffffff, OMAP3430_PER_MOD, OMAP2_RM_RSTST);
364 	omap2_prm_write_mod_reg(0xffffffff, OMAP3430_EMU_MOD, OMAP2_RM_RSTST);
365 	omap2_prm_write_mod_reg(0xffffffff, OMAP3430_NEON_MOD, OMAP2_RM_RSTST);
366 	omap2_prm_write_mod_reg(0xffffffff, OMAP3430_DSS_MOD, OMAP2_RM_RSTST);
367 	omap2_prm_write_mod_reg(0xffffffff, OMAP3430ES2_USBHOST_MOD,
368 				OMAP2_RM_RSTST);
369 
370 	/* Clear any pending PRCM interrupts */
371 	omap2_prm_write_mod_reg(0, OCP_MOD, OMAP3_PRM_IRQSTATUS_MPU_OFFSET);
372 
373 	/* We need to idle iva2_pwrdm even on am3703 with no iva2. */
374 	omap3xxx_prm_iva_idle();
375 
376 	omap3_prm_reset_modem();
377 }
378 
379 /**
380  * omap3430_pre_es3_1_reconfigure_io_chain - restart wake-up daisy chain
381  *
382  * The ST_IO_CHAIN bit does not exist in 3430 before es3.1. The only
383  * thing we can do is toggle EN_IO bit for earlier omaps.
384  */
omap3430_pre_es3_1_reconfigure_io_chain(void)385 static void omap3430_pre_es3_1_reconfigure_io_chain(void)
386 {
387 	omap2_prm_clear_mod_reg_bits(OMAP3430_EN_IO_MASK, WKUP_MOD,
388 				     PM_WKEN);
389 	omap2_prm_set_mod_reg_bits(OMAP3430_EN_IO_MASK, WKUP_MOD,
390 				   PM_WKEN);
391 	omap2_prm_read_mod_reg(WKUP_MOD, PM_WKEN);
392 }
393 
394 /**
395  * omap3_prm_reconfigure_io_chain - clear latches and reconfigure I/O chain
396  *
397  * Clear any previously-latched I/O wakeup events and ensure that the
398  * I/O wakeup gates are aligned with the current mux settings.  Works
399  * by asserting WUCLKIN, waiting for WUCLKOUT to be asserted, and then
400  * deasserting WUCLKIN and clearing the ST_IO_CHAIN WKST bit.  No
401  * return value. These registers are only available in 3430 es3.1 and later.
402  */
omap3_prm_reconfigure_io_chain(void)403 static void omap3_prm_reconfigure_io_chain(void)
404 {
405 	int i = 0;
406 
407 	omap2_prm_set_mod_reg_bits(OMAP3430_EN_IO_CHAIN_MASK, WKUP_MOD,
408 				   PM_WKEN);
409 
410 	omap_test_timeout(omap2_prm_read_mod_reg(WKUP_MOD, PM_WKST) &
411 			  OMAP3430_ST_IO_CHAIN_MASK,
412 			  MAX_IOPAD_LATCH_TIME, i);
413 	if (i == MAX_IOPAD_LATCH_TIME)
414 		pr_warn("PRM: I/O chain clock line assertion timed out\n");
415 
416 	omap2_prm_clear_mod_reg_bits(OMAP3430_EN_IO_CHAIN_MASK, WKUP_MOD,
417 				     PM_WKEN);
418 
419 	omap2_prm_set_mod_reg_bits(OMAP3430_ST_IO_CHAIN_MASK, WKUP_MOD,
420 				   PM_WKST);
421 
422 	omap2_prm_read_mod_reg(WKUP_MOD, PM_WKST);
423 }
424 
425 /**
426  * omap3xxx_prm_enable_io_wakeup - enable wakeup events from I/O wakeup latches
427  *
428  * Activates the I/O wakeup event latches and allows events logged by
429  * those latches to signal a wakeup event to the PRCM.  For I/O
430  * wakeups to occur, WAKEUPENABLE bits must be set in the pad mux
431  * registers, and omap3xxx_prm_reconfigure_io_chain() must be called.
432  * No return value.
433  */
omap3xxx_prm_enable_io_wakeup(void)434 static void omap3xxx_prm_enable_io_wakeup(void)
435 {
436 	if (prm_features & PRM_HAS_IO_WAKEUP)
437 		omap2_prm_set_mod_reg_bits(OMAP3430_EN_IO_MASK, WKUP_MOD,
438 					   PM_WKEN);
439 }
440 
441 /**
442  * omap3xxx_prm_read_reset_sources - return the last SoC reset source
443  *
444  * Return a u32 representing the last reset sources of the SoC.  The
445  * returned reset source bits are standardized across OMAP SoCs.
446  */
omap3xxx_prm_read_reset_sources(void)447 static u32 omap3xxx_prm_read_reset_sources(void)
448 {
449 	struct prm_reset_src_map *p;
450 	u32 r = 0;
451 	u32 v;
452 
453 	v = omap2_prm_read_mod_reg(WKUP_MOD, OMAP2_RM_RSTST);
454 
455 	p = omap3xxx_prm_reset_src_map;
456 	while (p->reg_shift >= 0 && p->std_shift >= 0) {
457 		if (v & (1 << p->reg_shift))
458 			r |= 1 << p->std_shift;
459 		p++;
460 	}
461 
462 	return r;
463 }
464 
465 /**
466  * omap3xxx_prm_iva_idle - ensure IVA is in idle so it can be put into retention
467  *
468  * In cases where IVA2 is activated by bootcode, it may prevent
469  * full-chip retention or off-mode because it is not idle.  This
470  * function forces the IVA2 into idle state so it can go
471  * into retention/off and thus allow full-chip retention/off.
472  */
omap3xxx_prm_iva_idle(void)473 static void omap3xxx_prm_iva_idle(void)
474 {
475 	/* ensure IVA2 clock is disabled */
476 	omap2_cm_write_mod_reg(0, OMAP3430_IVA2_MOD, CM_FCLKEN);
477 
478 	/* if no clock activity, nothing else to do */
479 	if (!(omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP3430_CM_CLKSTST) &
480 	      OMAP3430_CLKACTIVITY_IVA2_MASK))
481 		return;
482 
483 	/* Reset IVA2 */
484 	omap2_prm_write_mod_reg(OMAP3430_RST1_IVA2_MASK |
485 				OMAP3430_RST2_IVA2_MASK |
486 				OMAP3430_RST3_IVA2_MASK,
487 				OMAP3430_IVA2_MOD, OMAP2_RM_RSTCTRL);
488 
489 	/* Enable IVA2 clock */
490 	omap2_cm_write_mod_reg(OMAP3430_CM_FCLKEN_IVA2_EN_IVA2_MASK,
491 			       OMAP3430_IVA2_MOD, CM_FCLKEN);
492 
493 	/* Un-reset IVA2 */
494 	omap2_prm_write_mod_reg(0, OMAP3430_IVA2_MOD, OMAP2_RM_RSTCTRL);
495 
496 	/* Disable IVA2 clock */
497 	omap2_cm_write_mod_reg(0, OMAP3430_IVA2_MOD, CM_FCLKEN);
498 
499 	/* Reset IVA2 */
500 	omap2_prm_write_mod_reg(OMAP3430_RST1_IVA2_MASK |
501 				OMAP3430_RST2_IVA2_MASK |
502 				OMAP3430_RST3_IVA2_MASK,
503 				OMAP3430_IVA2_MOD, OMAP2_RM_RSTCTRL);
504 }
505 
506 /**
507  * omap3xxx_prm_clear_global_cold_reset - checks the global cold reset status
508  *					  and clears it if asserted
509  *
510  * Checks if cold-reset has occurred and clears the status bit if yes. Returns
511  * 1 if cold-reset has occurred, 0 otherwise.
512  */
omap3xxx_prm_clear_global_cold_reset(void)513 int omap3xxx_prm_clear_global_cold_reset(void)
514 {
515 	if (omap2_prm_read_mod_reg(OMAP3430_GR_MOD, OMAP3_PRM_RSTST_OFFSET) &
516 	    OMAP3430_GLOBAL_COLD_RST_MASK) {
517 		omap2_prm_set_mod_reg_bits(OMAP3430_GLOBAL_COLD_RST_MASK,
518 					   OMAP3430_GR_MOD,
519 					   OMAP3_PRM_RSTST_OFFSET);
520 		return 1;
521 	}
522 
523 	return 0;
524 }
525 
omap3_prm_save_scratchpad_contents(u32 * ptr)526 void omap3_prm_save_scratchpad_contents(u32 *ptr)
527 {
528 	*ptr++ = omap2_prm_read_mod_reg(OMAP3430_GR_MOD,
529 					OMAP3_PRM_CLKSRC_CTRL_OFFSET);
530 
531 	*ptr++ = omap2_prm_read_mod_reg(OMAP3430_GR_MOD,
532 					OMAP3_PRM_CLKSEL_OFFSET);
533 }
534 
535 /* Powerdomain low-level functions */
536 
omap3_pwrdm_set_next_pwrst(struct powerdomain * pwrdm,u8 pwrst)537 static int omap3_pwrdm_set_next_pwrst(struct powerdomain *pwrdm, u8 pwrst)
538 {
539 	omap2_prm_rmw_mod_reg_bits(OMAP_POWERSTATE_MASK,
540 				   (pwrst << OMAP_POWERSTATE_SHIFT),
541 				   pwrdm->prcm_offs, OMAP2_PM_PWSTCTRL);
542 	return 0;
543 }
544 
omap3_pwrdm_read_next_pwrst(struct powerdomain * pwrdm)545 static int omap3_pwrdm_read_next_pwrst(struct powerdomain *pwrdm)
546 {
547 	return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
548 					     OMAP2_PM_PWSTCTRL,
549 					     OMAP_POWERSTATE_MASK);
550 }
551 
omap3_pwrdm_read_pwrst(struct powerdomain * pwrdm)552 static int omap3_pwrdm_read_pwrst(struct powerdomain *pwrdm)
553 {
554 	return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
555 					     OMAP2_PM_PWSTST,
556 					     OMAP_POWERSTATEST_MASK);
557 }
558 
559 /* Applicable only for OMAP3. Not supported on OMAP2 */
omap3_pwrdm_read_prev_pwrst(struct powerdomain * pwrdm)560 static int omap3_pwrdm_read_prev_pwrst(struct powerdomain *pwrdm)
561 {
562 	return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
563 					     OMAP3430_PM_PREPWSTST,
564 					     OMAP3430_LASTPOWERSTATEENTERED_MASK);
565 }
566 
omap3_pwrdm_read_logic_pwrst(struct powerdomain * pwrdm)567 static int omap3_pwrdm_read_logic_pwrst(struct powerdomain *pwrdm)
568 {
569 	return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
570 					     OMAP2_PM_PWSTST,
571 					     OMAP3430_LOGICSTATEST_MASK);
572 }
573 
omap3_pwrdm_read_logic_retst(struct powerdomain * pwrdm)574 static int omap3_pwrdm_read_logic_retst(struct powerdomain *pwrdm)
575 {
576 	return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
577 					     OMAP2_PM_PWSTCTRL,
578 					     OMAP3430_LOGICSTATEST_MASK);
579 }
580 
omap3_pwrdm_read_prev_logic_pwrst(struct powerdomain * pwrdm)581 static int omap3_pwrdm_read_prev_logic_pwrst(struct powerdomain *pwrdm)
582 {
583 	return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
584 					     OMAP3430_PM_PREPWSTST,
585 					     OMAP3430_LASTLOGICSTATEENTERED_MASK);
586 }
587 
omap3_get_mem_bank_lastmemst_mask(u8 bank)588 static int omap3_get_mem_bank_lastmemst_mask(u8 bank)
589 {
590 	switch (bank) {
591 	case 0:
592 		return OMAP3430_LASTMEM1STATEENTERED_MASK;
593 	case 1:
594 		return OMAP3430_LASTMEM2STATEENTERED_MASK;
595 	case 2:
596 		return OMAP3430_LASTSHAREDL2CACHEFLATSTATEENTERED_MASK;
597 	case 3:
598 		return OMAP3430_LASTL2FLATMEMSTATEENTERED_MASK;
599 	default:
600 		WARN_ON(1); /* should never happen */
601 		return -EEXIST;
602 	}
603 	return 0;
604 }
605 
omap3_pwrdm_read_prev_mem_pwrst(struct powerdomain * pwrdm,u8 bank)606 static int omap3_pwrdm_read_prev_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
607 {
608 	u32 m;
609 
610 	m = omap3_get_mem_bank_lastmemst_mask(bank);
611 
612 	return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
613 				OMAP3430_PM_PREPWSTST, m);
614 }
615 
omap3_pwrdm_clear_all_prev_pwrst(struct powerdomain * pwrdm)616 static int omap3_pwrdm_clear_all_prev_pwrst(struct powerdomain *pwrdm)
617 {
618 	omap2_prm_write_mod_reg(0, pwrdm->prcm_offs, OMAP3430_PM_PREPWSTST);
619 	return 0;
620 }
621 
omap3_pwrdm_enable_hdwr_sar(struct powerdomain * pwrdm)622 static int omap3_pwrdm_enable_hdwr_sar(struct powerdomain *pwrdm)
623 {
624 	return omap2_prm_rmw_mod_reg_bits(0,
625 					  1 << OMAP3430ES2_SAVEANDRESTORE_SHIFT,
626 					  pwrdm->prcm_offs, OMAP2_PM_PWSTCTRL);
627 }
628 
omap3_pwrdm_disable_hdwr_sar(struct powerdomain * pwrdm)629 static int omap3_pwrdm_disable_hdwr_sar(struct powerdomain *pwrdm)
630 {
631 	return omap2_prm_rmw_mod_reg_bits(1 << OMAP3430ES2_SAVEANDRESTORE_SHIFT,
632 					  0, pwrdm->prcm_offs,
633 					  OMAP2_PM_PWSTCTRL);
634 }
635 
636 struct pwrdm_ops omap3_pwrdm_operations = {
637 	.pwrdm_set_next_pwrst	= omap3_pwrdm_set_next_pwrst,
638 	.pwrdm_read_next_pwrst	= omap3_pwrdm_read_next_pwrst,
639 	.pwrdm_read_pwrst	= omap3_pwrdm_read_pwrst,
640 	.pwrdm_read_prev_pwrst	= omap3_pwrdm_read_prev_pwrst,
641 	.pwrdm_set_logic_retst	= omap2_pwrdm_set_logic_retst,
642 	.pwrdm_read_logic_pwrst	= omap3_pwrdm_read_logic_pwrst,
643 	.pwrdm_read_logic_retst	= omap3_pwrdm_read_logic_retst,
644 	.pwrdm_read_prev_logic_pwrst	= omap3_pwrdm_read_prev_logic_pwrst,
645 	.pwrdm_set_mem_onst	= omap2_pwrdm_set_mem_onst,
646 	.pwrdm_set_mem_retst	= omap2_pwrdm_set_mem_retst,
647 	.pwrdm_read_mem_pwrst	= omap2_pwrdm_read_mem_pwrst,
648 	.pwrdm_read_mem_retst	= omap2_pwrdm_read_mem_retst,
649 	.pwrdm_read_prev_mem_pwrst	= omap3_pwrdm_read_prev_mem_pwrst,
650 	.pwrdm_clear_all_prev_pwrst	= omap3_pwrdm_clear_all_prev_pwrst,
651 	.pwrdm_enable_hdwr_sar	= omap3_pwrdm_enable_hdwr_sar,
652 	.pwrdm_disable_hdwr_sar	= omap3_pwrdm_disable_hdwr_sar,
653 	.pwrdm_wait_transition	= omap2_pwrdm_wait_transition,
654 };
655 
656 /*
657  *
658  */
659 
660 static int omap3xxx_prm_late_init(void);
661 
662 static struct prm_ll_data omap3xxx_prm_ll_data = {
663 	.read_reset_sources = &omap3xxx_prm_read_reset_sources,
664 	.late_init = &omap3xxx_prm_late_init,
665 	.assert_hardreset = &omap2_prm_assert_hardreset,
666 	.deassert_hardreset = &omap2_prm_deassert_hardreset,
667 	.is_hardreset_asserted = &omap2_prm_is_hardreset_asserted,
668 	.reset_system = &omap3xxx_prm_dpll3_reset,
669 	.clear_mod_irqs = &omap3xxx_prm_clear_mod_irqs,
670 	.vp_check_txdone = &omap3_prm_vp_check_txdone,
671 	.vp_clear_txdone = &omap3_prm_vp_clear_txdone,
672 };
673 
omap3xxx_prm_init(const struct omap_prcm_init_data * data)674 int __init omap3xxx_prm_init(const struct omap_prcm_init_data *data)
675 {
676 	omap2_clk_legacy_provider_init(TI_CLKM_PRM,
677 				       prm_base.va + OMAP3430_IVA2_MOD);
678 	if (omap3_has_io_wakeup())
679 		prm_features |= PRM_HAS_IO_WAKEUP;
680 
681 	return prm_register(&omap3xxx_prm_ll_data);
682 }
683 
684 static const struct of_device_id omap3_prm_dt_match_table[] = {
685 	{ .compatible = "ti,omap3-prm" },
686 	{ }
687 };
688 
omap3xxx_prm_late_init(void)689 static int omap3xxx_prm_late_init(void)
690 {
691 	struct device_node *np;
692 	int irq_num;
693 
694 	if (!(prm_features & PRM_HAS_IO_WAKEUP))
695 		return 0;
696 
697 	if (omap3_has_io_chain_ctrl())
698 		omap3_prcm_irq_setup.reconfigure_io_chain =
699 			omap3_prm_reconfigure_io_chain;
700 	else
701 		omap3_prcm_irq_setup.reconfigure_io_chain =
702 			omap3430_pre_es3_1_reconfigure_io_chain;
703 
704 	np = of_find_matching_node(NULL, omap3_prm_dt_match_table);
705 	if (!np) {
706 		pr_err("PRM: no device tree node for interrupt?\n");
707 
708 		return -ENODEV;
709 	}
710 
711 	irq_num = of_irq_get(np, 0);
712 	of_node_put(np);
713 	if (irq_num == -EPROBE_DEFER)
714 		return irq_num;
715 
716 	omap3_prcm_irq_setup.irq = irq_num;
717 
718 	omap3xxx_prm_enable_io_wakeup();
719 
720 	return omap_prcm_register_chain_handler(&omap3_prcm_irq_setup);
721 }
722 
omap3xxx_prm_exit(void)723 static void __exit omap3xxx_prm_exit(void)
724 {
725 	prm_unregister(&omap3xxx_prm_ll_data);
726 }
727 __exitcall(omap3xxx_prm_exit);
728