1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
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
47
48
49
50
51#define OMAP_PRCM_MAX_NR_PENDING_REG 2
52
53
54
55
56
57
58
59static struct irq_chip_generic **prcm_irq_chips;
60
61
62
63
64
65
66static struct omap_prcm_irq_setup *prcm_irq_setup;
67
68
69void __iomem *prm_base;
70
71u16 prm_features;
72
73
74
75
76
77static struct prm_ll_data null_prm_ll_data;
78static struct prm_ll_data *prm_ll_data = &null_prm_ll_data;
79
80
81
82
83
84
85static 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
99
100
101
102
103
104
105static 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
115
116
117
118
119
120
121
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
130
131
132 while (!prcm_irq_setup->suspended) {
133 prcm_irq_setup->read_pending_irqs(pending);
134
135
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
143
144
145
146
147 for_each_set_bit(virtirq, priority_pending, nr_irq)
148 generic_handle_irq(prcm_irq_setup->base_irq + virtirq);
149
150
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();
161}
162
163
164
165
166
167
168
169
170
171
172
173int 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
190
191
192
193
194void 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
233void omap_prcm_irq_prepare(void)
234{
235 prcm_irq_setup->suspended = true;
236}
237
238void omap_prcm_irq_complete(void)
239{
240 prcm_irq_setup->suspended = false;
241
242
243 if (!prcm_irq_setup->suspend_save_flag)
244 return;
245
246 prcm_irq_setup->suspend_save_flag = false;
247
248
249
250
251
252
253 prcm_irq_setup->restore_irqen(prcm_irq_setup->saved_mask);
254}
255
256
257
258
259
260
261
262
263
264
265
266int 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
356err:
357 omap_prcm_irq_cleanup();
358 return -ENOMEM;
359}
360
361
362
363
364
365
366
367void __init omap2_set_globals_prm(void __iomem *prm)
368{
369 prm_base = prm;
370}
371
372
373
374
375
376
377
378
379
380
381
382
383
384u32 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
398
399
400
401
402
403
404
405
406
407
408bool 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
423
424
425
426
427
428
429
430
431
432void 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
443
444
445
446
447
448
449
450int 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
463
464
465
466
467
468
469
470
471
472int 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
487
488
489
490
491
492
493
494int 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
507
508
509
510
511
512
513void 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
523
524
525
526void 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}
539
540
541
542
543
544
545
546
547
548
549
550int omap_prm_clear_mod_irqs(s16 module, u8 regs, u32 wkst_mask)
551{
552 if (!prm_ll_data->clear_mod_irqs) {
553 WARN_ONCE(1, "prm: %s: no mapping function defined\n",
554 __func__);
555 return -EINVAL;
556 }
557
558 return prm_ll_data->clear_mod_irqs(module, regs, wkst_mask);
559}
560
561
562
563
564
565
566
567u32 omap_prm_vp_check_txdone(u8 vp_id)
568{
569 if (!prm_ll_data->vp_check_txdone) {
570 WARN_ONCE(1, "prm: %s: no mapping function defined\n",
571 __func__);
572 return 0;
573 }
574
575 return prm_ll_data->vp_check_txdone(vp_id);
576}
577
578
579
580
581
582
583
584void omap_prm_vp_clear_txdone(u8 vp_id)
585{
586 if (!prm_ll_data->vp_clear_txdone) {
587 WARN_ONCE(1, "prm: %s: no mapping function defined\n",
588 __func__);
589 return;
590 }
591
592 prm_ll_data->vp_clear_txdone(vp_id);
593}
594
595
596
597
598
599
600
601
602
603
604
605
606int prm_register(struct prm_ll_data *pld)
607{
608 if (!pld)
609 return -EINVAL;
610
611 if (prm_ll_data != &null_prm_ll_data)
612 return -EEXIST;
613
614 prm_ll_data = pld;
615
616 return 0;
617}
618
619
620
621
622
623
624
625
626
627
628
629
630int prm_unregister(struct prm_ll_data *pld)
631{
632 if (!pld || prm_ll_data != pld)
633 return -EINVAL;
634
635 prm_ll_data = &null_prm_ll_data;
636
637 return 0;
638}
639
640#ifdef CONFIG_ARCH_OMAP2
641static struct omap_prcm_init_data omap2_prm_data __initdata = {
642 .index = TI_CLKM_PRM,
643 .init = omap2xxx_prm_init,
644};
645#endif
646
647#ifdef CONFIG_ARCH_OMAP3
648static struct omap_prcm_init_data omap3_prm_data __initdata = {
649 .index = TI_CLKM_PRM,
650 .init = omap3xxx_prm_init,
651
652
653
654
655
656 .offset = -OMAP3430_IVA2_MOD,
657};
658#endif
659
660#if defined(CONFIG_SOC_AM33XX) || defined(CONFIG_SOC_TI81XX)
661static struct omap_prcm_init_data am3_prm_data __initdata = {
662 .index = TI_CLKM_PRM,
663 .init = am33xx_prm_init,
664};
665#endif
666
667#ifdef CONFIG_SOC_TI81XX
668static struct omap_prcm_init_data dm814_pllss_data __initdata = {
669 .index = TI_CLKM_PLLSS,
670 .init = am33xx_prm_init,
671};
672#endif
673
674#ifdef CONFIG_ARCH_OMAP4
675static struct omap_prcm_init_data omap4_prm_data __initdata = {
676 .index = TI_CLKM_PRM,
677 .init = omap44xx_prm_init,
678 .device_inst_offset = OMAP4430_PRM_DEVICE_INST,
679 .flags = PRM_HAS_IO_WAKEUP | PRM_HAS_VOLTAGE | PRM_IRQ_DEFAULT,
680};
681#endif
682
683#ifdef CONFIG_SOC_OMAP5
684static struct omap_prcm_init_data omap5_prm_data __initdata = {
685 .index = TI_CLKM_PRM,
686 .init = omap44xx_prm_init,
687 .device_inst_offset = OMAP54XX_PRM_DEVICE_INST,
688 .flags = PRM_HAS_IO_WAKEUP | PRM_HAS_VOLTAGE,
689};
690#endif
691
692#ifdef CONFIG_SOC_DRA7XX
693static struct omap_prcm_init_data dra7_prm_data __initdata = {
694 .index = TI_CLKM_PRM,
695 .init = omap44xx_prm_init,
696 .device_inst_offset = DRA7XX_PRM_DEVICE_INST,
697 .flags = PRM_HAS_IO_WAKEUP,
698};
699#endif
700
701#ifdef CONFIG_SOC_AM43XX
702static struct omap_prcm_init_data am4_prm_data __initdata = {
703 .index = TI_CLKM_PRM,
704 .init = omap44xx_prm_init,
705 .device_inst_offset = AM43XX_PRM_DEVICE_INST,
706 .flags = PRM_HAS_IO_WAKEUP,
707};
708#endif
709
710#if defined(CONFIG_ARCH_OMAP4) || defined(CONFIG_SOC_OMAP5)
711static struct omap_prcm_init_data scrm_data __initdata = {
712 .index = TI_CLKM_SCRM,
713};
714#endif
715
716static const struct of_device_id const omap_prcm_dt_match_table[] __initconst = {
717#ifdef CONFIG_SOC_AM33XX
718 { .compatible = "ti,am3-prcm", .data = &am3_prm_data },
719#endif
720#ifdef CONFIG_SOC_AM43XX
721 { .compatible = "ti,am4-prcm", .data = &am4_prm_data },
722#endif
723#ifdef CONFIG_SOC_TI81XX
724 { .compatible = "ti,dm814-prcm", .data = &am3_prm_data },
725 { .compatible = "ti,dm814-pllss", .data = &dm814_pllss_data },
726 { .compatible = "ti,dm816-prcm", .data = &am3_prm_data },
727#endif
728#ifdef CONFIG_ARCH_OMAP2
729 { .compatible = "ti,omap2-prcm", .data = &omap2_prm_data },
730#endif
731#ifdef CONFIG_ARCH_OMAP3
732 { .compatible = "ti,omap3-prm", .data = &omap3_prm_data },
733#endif
734#ifdef CONFIG_ARCH_OMAP4
735 { .compatible = "ti,omap4-prm", .data = &omap4_prm_data },
736 { .compatible = "ti,omap4-scrm", .data = &scrm_data },
737#endif
738#ifdef CONFIG_SOC_OMAP5
739 { .compatible = "ti,omap5-prm", .data = &omap5_prm_data },
740 { .compatible = "ti,omap5-scrm", .data = &scrm_data },
741#endif
742#ifdef CONFIG_SOC_DRA7XX
743 { .compatible = "ti,dra7-prm", .data = &dra7_prm_data },
744#endif
745 { }
746};
747
748
749
750
751
752
753
754
755int __init omap2_prm_base_init(void)
756{
757 struct device_node *np;
758 const struct of_device_id *match;
759 struct omap_prcm_init_data *data;
760 void __iomem *mem;
761
762 for_each_matching_node_and_match(np, omap_prcm_dt_match_table, &match) {
763 data = (struct omap_prcm_init_data *)match->data;
764
765 mem = of_iomap(np, 0);
766 if (!mem)
767 return -ENOMEM;
768
769 if (data->index == TI_CLKM_PRM)
770 prm_base = mem + data->offset;
771
772 data->mem = mem;
773
774 data->np = np;
775
776 if (data->init)
777 data->init(data);
778 }
779
780 return 0;
781}
782
783int __init omap2_prcm_base_init(void)
784{
785 int ret;
786
787 ret = omap2_prm_base_init();
788 if (ret)
789 return ret;
790
791 return omap2_cm_base_init();
792}
793
794
795
796
797
798
799
800int __init omap_prcm_init(void)
801{
802 struct device_node *np;
803 const struct of_device_id *match;
804 const struct omap_prcm_init_data *data;
805 int ret;
806
807 for_each_matching_node_and_match(np, omap_prcm_dt_match_table, &match) {
808 data = match->data;
809
810 ret = omap2_clk_provider_init(np, data->index, NULL, data->mem);
811 if (ret)
812 return ret;
813 }
814
815 omap_cm_init();
816
817 return 0;
818}
819
820static int __init prm_late_init(void)
821{
822 if (prm_ll_data->late_init)
823 return prm_ll_data->late_init();
824 return 0;
825}
826subsys_initcall(prm_late_init);
827