• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * OMAP2+ common Power & Reset Management (PRM) IP block functions
3  *
4  * Copyright (C) 2011 Texas Instruments, Inc.
5  * Tero Kristo <t-kristo@ti.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  *
11  *
12  * For historical purposes, the API used to configure the PRM
13  * interrupt handler refers to it as the "PRCM interrupt."  The
14  * underlying registers are located in the PRM on OMAP3/4.
15  *
16  * XXX This code should eventually be moved to a PRM driver.
17  */
18 
19 #include <linux/kernel.h>
20 #include <linux/module.h>
21 #include <linux/init.h>
22 #include <linux/io.h>
23 #include <linux/irq.h>
24 #include <linux/interrupt.h>
25 #include <linux/slab.h>
26 #include <linux/of.h>
27 #include <linux/of_address.h>
28 #include <linux/clk-provider.h>
29 #include <linux/clk/ti.h>
30 
31 #include "soc.h"
32 #include "prm2xxx_3xxx.h"
33 #include "prm2xxx.h"
34 #include "prm3xxx.h"
35 #include "prm33xx.h"
36 #include "prm44xx.h"
37 #include "prm54xx.h"
38 #include "prm7xx.h"
39 #include "prcm43xx.h"
40 #include "common.h"
41 #include "clock.h"
42 #include "cm.h"
43 #include "control.h"
44 
45 /*
46  * OMAP_PRCM_MAX_NR_PENDING_REG: maximum number of PRM_IRQ*_MPU regs
47  * XXX this is technically not needed, since
48  * omap_prcm_register_chain_handler() could allocate this based on the
49  * actual amount of memory needed for the SoC
50  */
51 #define OMAP_PRCM_MAX_NR_PENDING_REG		2
52 
53 /*
54  * prcm_irq_chips: an array of all of the "generic IRQ chips" in use
55  * by the PRCM interrupt handler code.  There will be one 'chip' per
56  * PRM_{IRQSTATUS,IRQENABLE}_MPU register pair.  (So OMAP3 will have
57  * one "chip" and OMAP4 will have two.)
58  */
59 static struct irq_chip_generic **prcm_irq_chips;
60 
61 /*
62  * prcm_irq_setup: the PRCM IRQ parameters for the hardware the code
63  * is currently running on.  Defined and passed by initialization code
64  * that calls omap_prcm_register_chain_handler().
65  */
66 static struct omap_prcm_irq_setup *prcm_irq_setup;
67 
68 /* prm_base: base virtual address of the PRM IP block */
69 void __iomem *prm_base;
70 
71 u16 prm_features;
72 
73 /*
74  * prm_ll_data: function pointers to SoC-specific implementations of
75  * common PRM functions
76  */
77 static struct prm_ll_data null_prm_ll_data;
78 static struct prm_ll_data *prm_ll_data = &null_prm_ll_data;
79 
80 /* Private functions */
81 
82 /*
83  * Move priority events from events to priority_events array
84  */
omap_prcm_events_filter_priority(unsigned long * events,unsigned long * priority_events)85 static void omap_prcm_events_filter_priority(unsigned long *events,
86 	unsigned long *priority_events)
87 {
88 	int i;
89 
90 	for (i = 0; i < prcm_irq_setup->nr_regs; i++) {
91 		priority_events[i] =
92 			events[i] & prcm_irq_setup->priority_mask[i];
93 		events[i] ^= priority_events[i];
94 	}
95 }
96 
97 /*
98  * PRCM Interrupt Handler
99  *
100  * This is a common handler for the OMAP PRCM interrupts. Pending
101  * interrupts are detected by a call to prcm_pending_events and
102  * dispatched accordingly. Clearing of the wakeup events should be
103  * done by the SoC specific individual handlers.
104  */
omap_prcm_irq_handler(struct irq_desc * desc)105 static void omap_prcm_irq_handler(struct irq_desc *desc)
106 {
107 	unsigned long pending[OMAP_PRCM_MAX_NR_PENDING_REG];
108 	unsigned long priority_pending[OMAP_PRCM_MAX_NR_PENDING_REG];
109 	struct irq_chip *chip = irq_desc_get_chip(desc);
110 	unsigned int virtirq;
111 	int nr_irq = prcm_irq_setup->nr_regs * 32;
112 
113 	/*
114 	 * If we are suspended, mask all interrupts from PRCM level,
115 	 * this does not ack them, and they will be pending until we
116 	 * re-enable the interrupts, at which point the
117 	 * omap_prcm_irq_handler will be executed again.  The
118 	 * _save_and_clear_irqen() function must ensure that the PRM
119 	 * write to disable all IRQs has reached the PRM before
120 	 * returning, or spurious PRCM interrupts may occur during
121 	 * suspend.
122 	 */
123 	if (prcm_irq_setup->suspended) {
124 		prcm_irq_setup->save_and_clear_irqen(prcm_irq_setup->saved_mask);
125 		prcm_irq_setup->suspend_save_flag = true;
126 	}
127 
128 	/*
129 	 * Loop until all pending irqs are handled, since
130 	 * generic_handle_irq() can cause new irqs to come
131 	 */
132 	while (!prcm_irq_setup->suspended) {
133 		prcm_irq_setup->read_pending_irqs(pending);
134 
135 		/* No bit set, then all IRQs are handled */
136 		if (find_first_bit(pending, nr_irq) >= nr_irq)
137 			break;
138 
139 		omap_prcm_events_filter_priority(pending, priority_pending);
140 
141 		/*
142 		 * Loop on all currently pending irqs so that new irqs
143 		 * cannot starve previously pending irqs
144 		 */
145 
146 		/* Serve priority events first */
147 		for_each_set_bit(virtirq, priority_pending, nr_irq)
148 			generic_handle_irq(prcm_irq_setup->base_irq + virtirq);
149 
150 		/* Serve normal events next */
151 		for_each_set_bit(virtirq, pending, nr_irq)
152 			generic_handle_irq(prcm_irq_setup->base_irq + virtirq);
153 	}
154 	if (chip->irq_ack)
155 		chip->irq_ack(&desc->irq_data);
156 	if (chip->irq_eoi)
157 		chip->irq_eoi(&desc->irq_data);
158 	chip->irq_unmask(&desc->irq_data);
159 
160 	prcm_irq_setup->ocp_barrier(); /* avoid spurious IRQs */
161 }
162 
163 /* Public functions */
164 
165 /**
166  * omap_prcm_event_to_irq - given a PRCM event name, returns the
167  * corresponding IRQ on which the handler should be registered
168  * @name: name of the PRCM interrupt bit to look up - see struct omap_prcm_irq
169  *
170  * Returns the Linux internal IRQ ID corresponding to @name upon success,
171  * or -ENOENT upon failure.
172  */
omap_prcm_event_to_irq(const char * name)173 int omap_prcm_event_to_irq(const char *name)
174 {
175 	int i;
176 
177 	if (!prcm_irq_setup || !name)
178 		return -ENOENT;
179 
180 	for (i = 0; i < prcm_irq_setup->nr_irqs; i++)
181 		if (!strcmp(prcm_irq_setup->irqs[i].name, name))
182 			return prcm_irq_setup->base_irq +
183 				prcm_irq_setup->irqs[i].offset;
184 
185 	return -ENOENT;
186 }
187 
188 /**
189  * omap_prcm_irq_cleanup - reverses memory allocated and other steps
190  * done by omap_prcm_register_chain_handler()
191  *
192  * No return value.
193  */
omap_prcm_irq_cleanup(void)194 void omap_prcm_irq_cleanup(void)
195 {
196 	unsigned int irq;
197 	int i;
198 
199 	if (!prcm_irq_setup) {
200 		pr_err("PRCM: IRQ handler not initialized; cannot cleanup\n");
201 		return;
202 	}
203 
204 	if (prcm_irq_chips) {
205 		for (i = 0; i < prcm_irq_setup->nr_regs; i++) {
206 			if (prcm_irq_chips[i])
207 				irq_remove_generic_chip(prcm_irq_chips[i],
208 					0xffffffff, 0, 0);
209 			prcm_irq_chips[i] = NULL;
210 		}
211 		kfree(prcm_irq_chips);
212 		prcm_irq_chips = NULL;
213 	}
214 
215 	kfree(prcm_irq_setup->saved_mask);
216 	prcm_irq_setup->saved_mask = NULL;
217 
218 	kfree(prcm_irq_setup->priority_mask);
219 	prcm_irq_setup->priority_mask = NULL;
220 
221 	if (prcm_irq_setup->xlate_irq)
222 		irq = prcm_irq_setup->xlate_irq(prcm_irq_setup->irq);
223 	else
224 		irq = prcm_irq_setup->irq;
225 	irq_set_chained_handler(irq, NULL);
226 
227 	if (prcm_irq_setup->base_irq > 0)
228 		irq_free_descs(prcm_irq_setup->base_irq,
229 			prcm_irq_setup->nr_regs * 32);
230 	prcm_irq_setup->base_irq = 0;
231 }
232 
omap_prcm_irq_prepare(void)233 void omap_prcm_irq_prepare(void)
234 {
235 	prcm_irq_setup->suspended = true;
236 }
237 
omap_prcm_irq_complete(void)238 void omap_prcm_irq_complete(void)
239 {
240 	prcm_irq_setup->suspended = false;
241 
242 	/* If we have not saved the masks, do not attempt to restore */
243 	if (!prcm_irq_setup->suspend_save_flag)
244 		return;
245 
246 	prcm_irq_setup->suspend_save_flag = false;
247 
248 	/*
249 	 * Re-enable all masked PRCM irq sources, this causes the PRCM
250 	 * interrupt to fire immediately if the events were masked
251 	 * previously in the chain handler
252 	 */
253 	prcm_irq_setup->restore_irqen(prcm_irq_setup->saved_mask);
254 }
255 
256 /**
257  * omap_prcm_register_chain_handler - initializes the prcm chained interrupt
258  * handler based on provided parameters
259  * @irq_setup: hardware data about the underlying PRM/PRCM
260  *
261  * Set up the PRCM chained interrupt handler on the PRCM IRQ.  Sets up
262  * one generic IRQ chip per PRM interrupt status/enable register pair.
263  * Returns 0 upon success, -EINVAL if called twice or if invalid
264  * arguments are passed, or -ENOMEM on any other error.
265  */
omap_prcm_register_chain_handler(struct omap_prcm_irq_setup * irq_setup)266 int omap_prcm_register_chain_handler(struct omap_prcm_irq_setup *irq_setup)
267 {
268 	int nr_regs;
269 	u32 mask[OMAP_PRCM_MAX_NR_PENDING_REG];
270 	int offset, i;
271 	struct irq_chip_generic *gc;
272 	struct irq_chip_type *ct;
273 	unsigned int irq;
274 
275 	if (!irq_setup)
276 		return -EINVAL;
277 
278 	nr_regs = irq_setup->nr_regs;
279 
280 	if (prcm_irq_setup) {
281 		pr_err("PRCM: already initialized; won't reinitialize\n");
282 		return -EINVAL;
283 	}
284 
285 	if (nr_regs > OMAP_PRCM_MAX_NR_PENDING_REG) {
286 		pr_err("PRCM: nr_regs too large\n");
287 		return -EINVAL;
288 	}
289 
290 	prcm_irq_setup = irq_setup;
291 
292 	prcm_irq_chips = kzalloc(sizeof(void *) * nr_regs, GFP_KERNEL);
293 	prcm_irq_setup->saved_mask = kzalloc(sizeof(u32) * nr_regs, GFP_KERNEL);
294 	prcm_irq_setup->priority_mask = kzalloc(sizeof(u32) * nr_regs,
295 		GFP_KERNEL);
296 
297 	if (!prcm_irq_chips || !prcm_irq_setup->saved_mask ||
298 	    !prcm_irq_setup->priority_mask) {
299 		pr_err("PRCM: kzalloc failed\n");
300 		goto err;
301 	}
302 
303 	memset(mask, 0, sizeof(mask));
304 
305 	for (i = 0; i < irq_setup->nr_irqs; i++) {
306 		offset = irq_setup->irqs[i].offset;
307 		mask[offset >> 5] |= 1 << (offset & 0x1f);
308 		if (irq_setup->irqs[i].priority)
309 			irq_setup->priority_mask[offset >> 5] |=
310 				1 << (offset & 0x1f);
311 	}
312 
313 	if (irq_setup->xlate_irq)
314 		irq = irq_setup->xlate_irq(irq_setup->irq);
315 	else
316 		irq = irq_setup->irq;
317 	irq_set_chained_handler(irq, omap_prcm_irq_handler);
318 
319 	irq_setup->base_irq = irq_alloc_descs(-1, 0, irq_setup->nr_regs * 32,
320 		0);
321 
322 	if (irq_setup->base_irq < 0) {
323 		pr_err("PRCM: failed to allocate irq descs: %d\n",
324 			irq_setup->base_irq);
325 		goto err;
326 	}
327 
328 	for (i = 0; i < irq_setup->nr_regs; i++) {
329 		gc = irq_alloc_generic_chip("PRCM", 1,
330 			irq_setup->base_irq + i * 32, prm_base,
331 			handle_level_irq);
332 
333 		if (!gc) {
334 			pr_err("PRCM: failed to allocate generic chip\n");
335 			goto err;
336 		}
337 		ct = gc->chip_types;
338 		ct->chip.irq_ack = irq_gc_ack_set_bit;
339 		ct->chip.irq_mask = irq_gc_mask_clr_bit;
340 		ct->chip.irq_unmask = irq_gc_mask_set_bit;
341 
342 		ct->regs.ack = irq_setup->ack + i * 4;
343 		ct->regs.mask = irq_setup->mask + i * 4;
344 
345 		irq_setup_generic_chip(gc, mask[i], 0, IRQ_NOREQUEST, 0);
346 		prcm_irq_chips[i] = gc;
347 	}
348 
349 	if (of_have_populated_dt()) {
350 		int irq = omap_prcm_event_to_irq("io");
351 		omap_pcs_legacy_init(irq, irq_setup->reconfigure_io_chain);
352 	}
353 
354 	return 0;
355 
356 err:
357 	omap_prcm_irq_cleanup();
358 	return -ENOMEM;
359 }
360 
361 /**
362  * omap2_set_globals_prm - set the PRM base address (for early use)
363  * @prm: PRM base virtual address
364  *
365  * XXX Will be replaced when the PRM/CM drivers are completed.
366  */
omap2_set_globals_prm(void __iomem * prm)367 void __init omap2_set_globals_prm(void __iomem *prm)
368 {
369 	prm_base = prm;
370 }
371 
372 /**
373  * prm_read_reset_sources - return the sources of the SoC's last reset
374  *
375  * Return a u32 bitmask representing the reset sources that caused the
376  * SoC to reset.  The low-level per-SoC functions called by this
377  * function remap the SoC-specific reset source bits into an
378  * OMAP-common set of reset source bits, defined in
379  * arch/arm/mach-omap2/prm.h.  Returns the standardized reset source
380  * u32 bitmask from the hardware upon success, or returns (1 <<
381  * OMAP_UNKNOWN_RST_SRC_ID_SHIFT) if no low-level read_reset_sources()
382  * function was registered.
383  */
prm_read_reset_sources(void)384 u32 prm_read_reset_sources(void)
385 {
386 	u32 ret = 1 << OMAP_UNKNOWN_RST_SRC_ID_SHIFT;
387 
388 	if (prm_ll_data->read_reset_sources)
389 		ret = prm_ll_data->read_reset_sources();
390 	else
391 		WARN_ONCE(1, "prm: %s: no mapping function defined for reset sources\n", __func__);
392 
393 	return ret;
394 }
395 
396 /**
397  * prm_was_any_context_lost_old - was device context lost? (old API)
398  * @part: PRM partition ID (e.g., OMAP4430_PRM_PARTITION)
399  * @inst: PRM instance offset (e.g., OMAP4430_PRM_MPU_INST)
400  * @idx: CONTEXT register offset
401  *
402  * Return 1 if any bits were set in the *_CONTEXT_* register
403  * identified by (@part, @inst, @idx), which means that some context
404  * was lost for that module; otherwise, return 0.  XXX Deprecated;
405  * callers need to use a less-SoC-dependent way to identify hardware
406  * IP blocks.
407  */
prm_was_any_context_lost_old(u8 part,s16 inst,u16 idx)408 bool prm_was_any_context_lost_old(u8 part, s16 inst, u16 idx)
409 {
410 	bool ret = true;
411 
412 	if (prm_ll_data->was_any_context_lost_old)
413 		ret = prm_ll_data->was_any_context_lost_old(part, inst, idx);
414 	else
415 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
416 			  __func__);
417 
418 	return ret;
419 }
420 
421 /**
422  * prm_clear_context_lost_flags_old - clear context loss flags (old API)
423  * @part: PRM partition ID (e.g., OMAP4430_PRM_PARTITION)
424  * @inst: PRM instance offset (e.g., OMAP4430_PRM_MPU_INST)
425  * @idx: CONTEXT register offset
426  *
427  * Clear hardware context loss bits for the module identified by
428  * (@part, @inst, @idx).  No return value.  XXX Deprecated; callers
429  * need to use a less-SoC-dependent way to identify hardware IP
430  * blocks.
431  */
prm_clear_context_loss_flags_old(u8 part,s16 inst,u16 idx)432 void prm_clear_context_loss_flags_old(u8 part, s16 inst, u16 idx)
433 {
434 	if (prm_ll_data->clear_context_loss_flags_old)
435 		prm_ll_data->clear_context_loss_flags_old(part, inst, idx);
436 	else
437 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
438 			  __func__);
439 }
440 
441 /**
442  * omap_prm_assert_hardreset - assert hardreset for an IP block
443  * @shift: register bit shift corresponding to the reset line
444  * @part: PRM partition
445  * @prm_mod: PRM submodule base or instance offset
446  * @offset: register offset
447  *
448  * Asserts a hardware reset line for an IP block.
449  */
omap_prm_assert_hardreset(u8 shift,u8 part,s16 prm_mod,u16 offset)450 int omap_prm_assert_hardreset(u8 shift, u8 part, s16 prm_mod, u16 offset)
451 {
452 	if (!prm_ll_data->assert_hardreset) {
453 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
454 			  __func__);
455 		return -EINVAL;
456 	}
457 
458 	return prm_ll_data->assert_hardreset(shift, part, prm_mod, offset);
459 }
460 
461 /**
462  * omap_prm_deassert_hardreset - deassert hardreset for an IP block
463  * @shift: register bit shift corresponding to the reset line
464  * @st_shift: reset status bit shift corresponding to the reset line
465  * @part: PRM partition
466  * @prm_mod: PRM submodule base or instance offset
467  * @offset: register offset
468  * @st_offset: status register offset
469  *
470  * Deasserts a hardware reset line for an IP block.
471  */
omap_prm_deassert_hardreset(u8 shift,u8 st_shift,u8 part,s16 prm_mod,u16 offset,u16 st_offset)472 int omap_prm_deassert_hardreset(u8 shift, u8 st_shift, u8 part, s16 prm_mod,
473 				u16 offset, u16 st_offset)
474 {
475 	if (!prm_ll_data->deassert_hardreset) {
476 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
477 			  __func__);
478 		return -EINVAL;
479 	}
480 
481 	return prm_ll_data->deassert_hardreset(shift, st_shift, part, prm_mod,
482 					       offset, st_offset);
483 }
484 
485 /**
486  * omap_prm_is_hardreset_asserted - check the hardreset status for an IP block
487  * @shift: register bit shift corresponding to the reset line
488  * @part: PRM partition
489  * @prm_mod: PRM submodule base or instance offset
490  * @offset: register offset
491  *
492  * Checks if a hardware reset line for an IP block is enabled or not.
493  */
omap_prm_is_hardreset_asserted(u8 shift,u8 part,s16 prm_mod,u16 offset)494 int omap_prm_is_hardreset_asserted(u8 shift, u8 part, s16 prm_mod, u16 offset)
495 {
496 	if (!prm_ll_data->is_hardreset_asserted) {
497 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
498 			  __func__);
499 		return -EINVAL;
500 	}
501 
502 	return prm_ll_data->is_hardreset_asserted(shift, part, prm_mod, offset);
503 }
504 
505 /**
506  * omap_prm_reconfigure_io_chain - clear latches and reconfigure I/O chain
507  *
508  * Clear any previously-latched I/O wakeup events and ensure that the
509  * I/O wakeup gates are aligned with the current mux settings.
510  * Calls SoC specific I/O chain reconfigure function if available,
511  * otherwise does nothing.
512  */
omap_prm_reconfigure_io_chain(void)513 void omap_prm_reconfigure_io_chain(void)
514 {
515 	if (!prcm_irq_setup || !prcm_irq_setup->reconfigure_io_chain)
516 		return;
517 
518 	prcm_irq_setup->reconfigure_io_chain();
519 }
520 
521 /**
522  * omap_prm_reset_system - trigger global SW reset
523  *
524  * Triggers SoC specific global warm reset to reboot the device.
525  */
omap_prm_reset_system(void)526 void omap_prm_reset_system(void)
527 {
528 	if (!prm_ll_data->reset_system) {
529 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
530 			  __func__);
531 		return;
532 	}
533 
534 	prm_ll_data->reset_system();
535 
536 	while (1) {
537 		cpu_relax();
538 		wfe();
539 	}
540 }
541 
542 /**
543  * omap_prm_clear_mod_irqs - clear wake-up events from PRCM interrupt
544  * @module: PRM module to clear wakeups from
545  * @regs: register to clear
546  * @wkst_mask: wkst bits to clear
547  *
548  * Clears any wakeup events for the module and register set defined.
549  * Uses SoC specific implementation to do the actual wakeup status
550  * clearing.
551  */
omap_prm_clear_mod_irqs(s16 module,u8 regs,u32 wkst_mask)552 int omap_prm_clear_mod_irqs(s16 module, u8 regs, u32 wkst_mask)
553 {
554 	if (!prm_ll_data->clear_mod_irqs) {
555 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
556 			  __func__);
557 		return -EINVAL;
558 	}
559 
560 	return prm_ll_data->clear_mod_irqs(module, regs, wkst_mask);
561 }
562 
563 /**
564  * omap_prm_vp_check_txdone - check voltage processor TX done status
565  *
566  * Checks if voltage processor transmission has been completed.
567  * Returns non-zero if a transmission has completed, 0 otherwise.
568  */
omap_prm_vp_check_txdone(u8 vp_id)569 u32 omap_prm_vp_check_txdone(u8 vp_id)
570 {
571 	if (!prm_ll_data->vp_check_txdone) {
572 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
573 			  __func__);
574 		return 0;
575 	}
576 
577 	return prm_ll_data->vp_check_txdone(vp_id);
578 }
579 
580 /**
581  * omap_prm_vp_clear_txdone - clears voltage processor TX done status
582  *
583  * Clears the status bit for completed voltage processor transmission
584  * returned by prm_vp_check_txdone.
585  */
omap_prm_vp_clear_txdone(u8 vp_id)586 void omap_prm_vp_clear_txdone(u8 vp_id)
587 {
588 	if (!prm_ll_data->vp_clear_txdone) {
589 		WARN_ONCE(1, "prm: %s: no mapping function defined\n",
590 			  __func__);
591 		return;
592 	}
593 
594 	prm_ll_data->vp_clear_txdone(vp_id);
595 }
596 
597 /**
598  * prm_register - register per-SoC low-level data with the PRM
599  * @pld: low-level per-SoC OMAP PRM data & function pointers to register
600  *
601  * Register per-SoC low-level OMAP PRM data and function pointers with
602  * the OMAP PRM common interface.  The caller must keep the data
603  * pointed to by @pld valid until it calls prm_unregister() and
604  * it returns successfully.  Returns 0 upon success, -EINVAL if @pld
605  * is NULL, or -EEXIST if prm_register() has already been called
606  * without an intervening prm_unregister().
607  */
prm_register(struct prm_ll_data * pld)608 int prm_register(struct prm_ll_data *pld)
609 {
610 	if (!pld)
611 		return -EINVAL;
612 
613 	if (prm_ll_data != &null_prm_ll_data)
614 		return -EEXIST;
615 
616 	prm_ll_data = pld;
617 
618 	return 0;
619 }
620 
621 /**
622  * prm_unregister - unregister per-SoC low-level data & function pointers
623  * @pld: low-level per-SoC OMAP PRM data & function pointers to unregister
624  *
625  * Unregister per-SoC low-level OMAP PRM data and function pointers
626  * that were previously registered with prm_register().  The
627  * caller may not destroy any of the data pointed to by @pld until
628  * this function returns successfully.  Returns 0 upon success, or
629  * -EINVAL if @pld is NULL or if @pld does not match the struct
630  * prm_ll_data * previously registered by prm_register().
631  */
prm_unregister(struct prm_ll_data * pld)632 int prm_unregister(struct prm_ll_data *pld)
633 {
634 	if (!pld || prm_ll_data != pld)
635 		return -EINVAL;
636 
637 	prm_ll_data = &null_prm_ll_data;
638 
639 	return 0;
640 }
641 
642 #ifdef CONFIG_ARCH_OMAP2
643 static struct omap_prcm_init_data omap2_prm_data __initdata = {
644 	.index = TI_CLKM_PRM,
645 	.init = omap2xxx_prm_init,
646 };
647 #endif
648 
649 #ifdef CONFIG_ARCH_OMAP3
650 static struct omap_prcm_init_data omap3_prm_data __initdata = {
651 	.index = TI_CLKM_PRM,
652 	.init = omap3xxx_prm_init,
653 
654 	/*
655 	 * IVA2 offset is a negative value, must offset the prm_base
656 	 * address by this to get it to positive
657 	 */
658 	.offset = -OMAP3430_IVA2_MOD,
659 };
660 #endif
661 
662 #if defined(CONFIG_SOC_AM33XX) || defined(CONFIG_SOC_TI81XX)
663 static struct omap_prcm_init_data am3_prm_data __initdata = {
664 	.index = TI_CLKM_PRM,
665 	.init = am33xx_prm_init,
666 };
667 #endif
668 
669 #ifdef CONFIG_ARCH_OMAP4
670 static struct omap_prcm_init_data omap4_prm_data __initdata = {
671 	.index = TI_CLKM_PRM,
672 	.init = omap44xx_prm_init,
673 	.device_inst_offset = OMAP4430_PRM_DEVICE_INST,
674 	.flags = PRM_HAS_IO_WAKEUP | PRM_HAS_VOLTAGE | PRM_IRQ_DEFAULT,
675 };
676 #endif
677 
678 #ifdef CONFIG_SOC_OMAP5
679 static struct omap_prcm_init_data omap5_prm_data __initdata = {
680 	.index = TI_CLKM_PRM,
681 	.init = omap44xx_prm_init,
682 	.device_inst_offset = OMAP54XX_PRM_DEVICE_INST,
683 	.flags = PRM_HAS_IO_WAKEUP | PRM_HAS_VOLTAGE,
684 };
685 #endif
686 
687 #ifdef CONFIG_SOC_DRA7XX
688 static struct omap_prcm_init_data dra7_prm_data __initdata = {
689 	.index = TI_CLKM_PRM,
690 	.init = omap44xx_prm_init,
691 	.device_inst_offset = DRA7XX_PRM_DEVICE_INST,
692 	.flags = PRM_HAS_IO_WAKEUP,
693 };
694 #endif
695 
696 #ifdef CONFIG_SOC_AM43XX
697 static struct omap_prcm_init_data am4_prm_data __initdata = {
698 	.index = TI_CLKM_PRM,
699 	.init = omap44xx_prm_init,
700 	.device_inst_offset = AM43XX_PRM_DEVICE_INST,
701 	.flags = PRM_HAS_IO_WAKEUP,
702 };
703 #endif
704 
705 #if defined(CONFIG_ARCH_OMAP4) || defined(CONFIG_SOC_OMAP5)
706 static struct omap_prcm_init_data scrm_data __initdata = {
707 	.index = TI_CLKM_SCRM,
708 };
709 #endif
710 
711 static const struct of_device_id omap_prcm_dt_match_table[] __initconst = {
712 #ifdef CONFIG_SOC_AM33XX
713 	{ .compatible = "ti,am3-prcm", .data = &am3_prm_data },
714 #endif
715 #ifdef CONFIG_SOC_AM43XX
716 	{ .compatible = "ti,am4-prcm", .data = &am4_prm_data },
717 #endif
718 #ifdef CONFIG_SOC_TI81XX
719 	{ .compatible = "ti,dm814-prcm", .data = &am3_prm_data },
720 	{ .compatible = "ti,dm816-prcm", .data = &am3_prm_data },
721 #endif
722 #ifdef CONFIG_ARCH_OMAP2
723 	{ .compatible = "ti,omap2-prcm", .data = &omap2_prm_data },
724 #endif
725 #ifdef CONFIG_ARCH_OMAP3
726 	{ .compatible = "ti,omap3-prm", .data = &omap3_prm_data },
727 #endif
728 #ifdef CONFIG_ARCH_OMAP4
729 	{ .compatible = "ti,omap4-prm", .data = &omap4_prm_data },
730 	{ .compatible = "ti,omap4-scrm", .data = &scrm_data },
731 #endif
732 #ifdef CONFIG_SOC_OMAP5
733 	{ .compatible = "ti,omap5-prm", .data = &omap5_prm_data },
734 	{ .compatible = "ti,omap5-scrm", .data = &scrm_data },
735 #endif
736 #ifdef CONFIG_SOC_DRA7XX
737 	{ .compatible = "ti,dra7-prm", .data = &dra7_prm_data },
738 #endif
739 	{ }
740 };
741 
742 /**
743  * omap2_prm_base_init - initialize iomappings for the PRM driver
744  *
745  * Detects and initializes the iomappings for the PRM driver, based
746  * on the DT data. Returns 0 in success, negative error value
747  * otherwise.
748  */
omap2_prm_base_init(void)749 int __init omap2_prm_base_init(void)
750 {
751 	struct device_node *np;
752 	const struct of_device_id *match;
753 	struct omap_prcm_init_data *data;
754 	void __iomem *mem;
755 
756 	for_each_matching_node_and_match(np, omap_prcm_dt_match_table, &match) {
757 		data = (struct omap_prcm_init_data *)match->data;
758 
759 		mem = of_iomap(np, 0);
760 		if (!mem)
761 			return -ENOMEM;
762 
763 		if (data->index == TI_CLKM_PRM)
764 			prm_base = mem + data->offset;
765 
766 		data->mem = mem;
767 
768 		data->np = np;
769 
770 		if (data->init)
771 			data->init(data);
772 	}
773 
774 	return 0;
775 }
776 
omap2_prcm_base_init(void)777 int __init omap2_prcm_base_init(void)
778 {
779 	int ret;
780 
781 	ret = omap2_prm_base_init();
782 	if (ret)
783 		return ret;
784 
785 	return omap2_cm_base_init();
786 }
787 
788 /**
789  * omap_prcm_init - low level init for the PRCM drivers
790  *
791  * Initializes the low level clock infrastructure for PRCM drivers.
792  * Returns 0 in success, negative error value in failure.
793  */
omap_prcm_init(void)794 int __init omap_prcm_init(void)
795 {
796 	struct device_node *np;
797 	const struct of_device_id *match;
798 	const struct omap_prcm_init_data *data;
799 	int ret;
800 
801 	for_each_matching_node_and_match(np, omap_prcm_dt_match_table, &match) {
802 		data = match->data;
803 
804 		ret = omap2_clk_provider_init(np, data->index, NULL, data->mem);
805 		if (ret)
806 			return ret;
807 	}
808 
809 	omap_cm_init();
810 
811 	return 0;
812 }
813 
prm_late_init(void)814 static int __init prm_late_init(void)
815 {
816 	if (prm_ll_data->late_init)
817 		return prm_ll_data->late_init();
818 	return 0;
819 }
820 subsys_initcall(prm_late_init);
821