1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#undef DEBUG
27
28#include <linux/kernel.h>
29#include <linux/platform_device.h>
30#include <linux/slab.h>
31#include <linux/err.h>
32#include <linux/io.h>
33#include <linux/clk.h>
34#include <linux/clkdev.h>
35#include <linux/pm_domain.h>
36#include <linux/pm_runtime.h>
37#include <linux/of.h>
38#include <linux/notifier.h>
39
40#include "common.h"
41#include "soc.h"
42#include "omap_device.h"
43#include "omap_hwmod.h"
44
45
46
47static void _add_clkdev(struct omap_device *od, const char *clk_alias,
48 const char *clk_name)
49{
50 struct clk *r;
51 int rc;
52
53 if (!clk_alias || !clk_name)
54 return;
55
56 dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
57
58 r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
59 if (!IS_ERR(r)) {
60 dev_dbg(&od->pdev->dev,
61 "alias %s already exists\n", clk_alias);
62 clk_put(r);
63 return;
64 }
65
66 r = clk_get_sys(NULL, clk_name);
67
68 if (IS_ERR(r) && of_have_populated_dt()) {
69 struct of_phandle_args clkspec;
70
71 clkspec.np = of_find_node_by_name(NULL, clk_name);
72
73 r = of_clk_get_from_provider(&clkspec);
74
75 rc = clk_register_clkdev(r, clk_alias,
76 dev_name(&od->pdev->dev));
77 } else {
78 rc = clk_add_alias(clk_alias, dev_name(&od->pdev->dev),
79 clk_name, NULL);
80 }
81
82 if (rc) {
83 if (rc == -ENODEV || rc == -ENOMEM)
84 dev_err(&od->pdev->dev,
85 "clkdev_alloc for %s failed\n", clk_alias);
86 else
87 dev_err(&od->pdev->dev,
88 "clk_get for %s failed\n", clk_name);
89 }
90}
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111static void _add_hwmod_clocks_clkdev(struct omap_device *od,
112 struct omap_hwmod *oh)
113{
114 int i;
115
116 _add_clkdev(od, "fck", oh->main_clk);
117
118 for (i = 0; i < oh->opt_clks_cnt; i++)
119 _add_clkdev(od, oh->opt_clks[i].role, oh->opt_clks[i].clk);
120}
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135static int omap_device_build_from_dt(struct platform_device *pdev)
136{
137 struct omap_hwmod **hwmods;
138 struct omap_device *od;
139 struct omap_hwmod *oh;
140 struct device_node *node = pdev->dev.of_node;
141 const char *oh_name;
142 int oh_cnt, i, ret = 0;
143 bool device_active = false;
144
145 oh_cnt = of_property_count_strings(node, "ti,hwmods");
146 if (oh_cnt <= 0) {
147 dev_dbg(&pdev->dev, "No 'hwmods' to build omap_device\n");
148 return -ENODEV;
149 }
150
151 hwmods = kzalloc(sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
152 if (!hwmods) {
153 ret = -ENOMEM;
154 goto odbfd_exit;
155 }
156
157 for (i = 0; i < oh_cnt; i++) {
158 of_property_read_string_index(node, "ti,hwmods", i, &oh_name);
159 oh = omap_hwmod_lookup(oh_name);
160 if (!oh) {
161 dev_err(&pdev->dev, "Cannot lookup hwmod '%s'\n",
162 oh_name);
163 ret = -EINVAL;
164 goto odbfd_exit1;
165 }
166 hwmods[i] = oh;
167 if (oh->flags & HWMOD_INIT_NO_IDLE)
168 device_active = true;
169 }
170
171 od = omap_device_alloc(pdev, hwmods, oh_cnt);
172 if (IS_ERR(od)) {
173 dev_err(&pdev->dev, "Cannot allocate omap_device for :%s\n",
174 oh_name);
175 ret = PTR_ERR(od);
176 goto odbfd_exit1;
177 }
178
179
180 for (i = 0; i < pdev->num_resources; i++) {
181 struct resource *r = &pdev->resource[i];
182
183 if (r->name == NULL)
184 r->name = dev_name(&pdev->dev);
185 }
186
187 dev_pm_domain_set(&pdev->dev, &omap_device_pm_domain);
188
189 if (device_active) {
190 omap_device_enable(pdev);
191 pm_runtime_set_active(&pdev->dev);
192 }
193
194odbfd_exit1:
195 kfree(hwmods);
196odbfd_exit:
197
198 if (ret)
199 dev_pm_domain_set(&pdev->dev, &omap_device_fail_pm_domain);
200
201 return ret;
202}
203
204static int _omap_device_notifier_call(struct notifier_block *nb,
205 unsigned long event, void *dev)
206{
207 struct platform_device *pdev = to_platform_device(dev);
208 struct omap_device *od;
209 int err;
210
211 switch (event) {
212 case BUS_NOTIFY_REMOVED_DEVICE:
213 if (pdev->archdata.od)
214 omap_device_delete(pdev->archdata.od);
215 break;
216 case BUS_NOTIFY_UNBOUND_DRIVER:
217 od = to_omap_device(pdev);
218 if (od && (od->_state == OMAP_DEVICE_STATE_ENABLED)) {
219 dev_info(dev, "enabled after unload, idling\n");
220 err = omap_device_idle(pdev);
221 if (err)
222 dev_err(dev, "failed to idle\n");
223 }
224 break;
225 case BUS_NOTIFY_ADD_DEVICE:
226 if (pdev->dev.of_node)
227 omap_device_build_from_dt(pdev);
228 omap_auxdata_legacy_init(dev);
229
230 default:
231 od = to_omap_device(pdev);
232 if (od)
233 od->_driver_status = event;
234 }
235
236 return NOTIFY_DONE;
237}
238
239
240
241
242
243
244
245static int _omap_device_enable_hwmods(struct omap_device *od)
246{
247 int ret = 0;
248 int i;
249
250 for (i = 0; i < od->hwmods_cnt; i++)
251 ret |= omap_hwmod_enable(od->hwmods[i]);
252
253 return ret;
254}
255
256
257
258
259
260
261
262static int _omap_device_idle_hwmods(struct omap_device *od)
263{
264 int ret = 0;
265 int i;
266
267 for (i = 0; i < od->hwmods_cnt; i++)
268 ret |= omap_hwmod_idle(od->hwmods[i]);
269
270 return ret;
271}
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290int omap_device_get_context_loss_count(struct platform_device *pdev)
291{
292 struct omap_device *od;
293 u32 ret = 0;
294
295 od = to_omap_device(pdev);
296
297 if (od->hwmods_cnt)
298 ret = omap_hwmod_get_context_loss_count(od->hwmods[0]);
299
300 return ret;
301}
302
303
304
305
306
307
308
309
310
311
312
313static int omap_device_count_resources(struct omap_device *od,
314 unsigned long flags)
315{
316 int c = 0;
317 int i;
318
319 for (i = 0; i < od->hwmods_cnt; i++)
320 c += omap_hwmod_count_resources(od->hwmods[i], flags);
321
322 pr_debug("omap_device: %s: counted %d total resources across %d hwmods\n",
323 od->pdev->name, c, od->hwmods_cnt);
324
325 return c;
326}
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345static int omap_device_fill_resources(struct omap_device *od,
346 struct resource *res)
347{
348 int i, r;
349
350 for (i = 0; i < od->hwmods_cnt; i++) {
351 r = omap_hwmod_fill_resources(od->hwmods[i], res);
352 res += r;
353 }
354
355 return 0;
356}
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372static int _od_fill_dma_resources(struct omap_device *od,
373 struct resource *res)
374{
375 int i, r;
376
377 for (i = 0; i < od->hwmods_cnt; i++) {
378 r = omap_hwmod_fill_dma_resources(od->hwmods[i], res);
379 res += r;
380 }
381
382 return 0;
383}
384
385
386
387
388
389
390
391
392
393
394
395
396
397struct omap_device *omap_device_alloc(struct platform_device *pdev,
398 struct omap_hwmod **ohs, int oh_cnt)
399{
400 int ret = -ENOMEM;
401 struct omap_device *od;
402 struct resource *res = NULL;
403 int i, res_count;
404 struct omap_hwmod **hwmods;
405
406 od = kzalloc(sizeof(struct omap_device), GFP_KERNEL);
407 if (!od) {
408 ret = -ENOMEM;
409 goto oda_exit1;
410 }
411 od->hwmods_cnt = oh_cnt;
412
413 hwmods = kmemdup(ohs, sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
414 if (!hwmods)
415 goto oda_exit2;
416
417 od->hwmods = hwmods;
418 od->pdev = pdev;
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439 if (!pdev->num_resources) {
440
441 res_count = omap_device_count_resources(od, IORESOURCE_IRQ |
442 IORESOURCE_DMA |
443 IORESOURCE_MEM);
444 } else {
445
446 for (i = 0; i < pdev->num_resources; i++) {
447 struct resource *r = &pdev->resource[i];
448
449
450 if (r->flags == IORESOURCE_DMA)
451 goto have_everything;
452 }
453
454 res_count = omap_device_count_resources(od, IORESOURCE_DMA);
455
456 if (!res_count)
457 goto have_everything;
458
459 res_count += pdev->num_resources;
460 }
461
462
463 res = kzalloc(sizeof(struct resource) * res_count, GFP_KERNEL);
464 if (!res)
465 goto oda_exit3;
466
467 if (!pdev->num_resources) {
468 dev_dbg(&pdev->dev, "%s: using %d resources from hwmod\n",
469 __func__, res_count);
470 omap_device_fill_resources(od, res);
471 } else {
472 dev_dbg(&pdev->dev,
473 "%s: appending %d DMA resources from hwmod\n",
474 __func__, res_count - pdev->num_resources);
475 memcpy(res, pdev->resource,
476 sizeof(struct resource) * pdev->num_resources);
477 _od_fill_dma_resources(od, &res[pdev->num_resources]);
478 }
479
480 ret = platform_device_add_resources(pdev, res, res_count);
481 kfree(res);
482
483 if (ret)
484 goto oda_exit3;
485
486have_everything:
487 pdev->archdata.od = od;
488
489 for (i = 0; i < oh_cnt; i++) {
490 hwmods[i]->od = od;
491 _add_hwmod_clocks_clkdev(od, hwmods[i]);
492 }
493
494 return od;
495
496oda_exit3:
497 kfree(hwmods);
498oda_exit2:
499 kfree(od);
500oda_exit1:
501 dev_err(&pdev->dev, "omap_device: build failed (%d)\n", ret);
502
503 return ERR_PTR(ret);
504}
505
506void omap_device_delete(struct omap_device *od)
507{
508 if (!od)
509 return;
510
511 od->pdev->archdata.od = NULL;
512 kfree(od->hwmods);
513 kfree(od);
514}
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530struct platform_device __init *omap_device_build(const char *pdev_name,
531 int pdev_id,
532 struct omap_hwmod *oh,
533 void *pdata, int pdata_len)
534{
535 struct omap_hwmod *ohs[] = { oh };
536
537 if (!oh)
538 return ERR_PTR(-EINVAL);
539
540 return omap_device_build_ss(pdev_name, pdev_id, ohs, 1, pdata,
541 pdata_len);
542}
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558struct platform_device __init *omap_device_build_ss(const char *pdev_name,
559 int pdev_id,
560 struct omap_hwmod **ohs,
561 int oh_cnt, void *pdata,
562 int pdata_len)
563{
564 int ret = -ENOMEM;
565 struct platform_device *pdev;
566 struct omap_device *od;
567
568 if (!ohs || oh_cnt == 0 || !pdev_name)
569 return ERR_PTR(-EINVAL);
570
571 if (!pdata && pdata_len > 0)
572 return ERR_PTR(-EINVAL);
573
574 pdev = platform_device_alloc(pdev_name, pdev_id);
575 if (!pdev) {
576 ret = -ENOMEM;
577 goto odbs_exit;
578 }
579
580
581 if (pdev->id != -1)
582 dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
583 else
584 dev_set_name(&pdev->dev, "%s", pdev->name);
585
586 od = omap_device_alloc(pdev, ohs, oh_cnt);
587 if (IS_ERR(od))
588 goto odbs_exit1;
589
590 ret = platform_device_add_data(pdev, pdata, pdata_len);
591 if (ret)
592 goto odbs_exit2;
593
594 ret = omap_device_register(pdev);
595 if (ret)
596 goto odbs_exit2;
597
598 return pdev;
599
600odbs_exit2:
601 omap_device_delete(od);
602odbs_exit1:
603 platform_device_put(pdev);
604odbs_exit:
605
606 pr_err("omap_device: %s: build failed (%d)\n", pdev_name, ret);
607
608 return ERR_PTR(ret);
609}
610
611#ifdef CONFIG_PM
612static int _od_runtime_suspend(struct device *dev)
613{
614 struct platform_device *pdev = to_platform_device(dev);
615 int ret;
616
617 ret = pm_generic_runtime_suspend(dev);
618 if (ret)
619 return ret;
620
621 return omap_device_idle(pdev);
622}
623
624static int _od_runtime_resume(struct device *dev)
625{
626 struct platform_device *pdev = to_platform_device(dev);
627 int ret;
628
629 ret = omap_device_enable(pdev);
630 if (ret) {
631 dev_err(dev, "use pm_runtime_put_sync_suspend() in driver?\n");
632 return ret;
633 }
634
635 return pm_generic_runtime_resume(dev);
636}
637
638static int _od_fail_runtime_suspend(struct device *dev)
639{
640 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
641 return -ENODEV;
642}
643
644static int _od_fail_runtime_resume(struct device *dev)
645{
646 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
647 return -ENODEV;
648}
649
650#endif
651
652#ifdef CONFIG_SUSPEND
653static int _od_suspend_noirq(struct device *dev)
654{
655 struct platform_device *pdev = to_platform_device(dev);
656 struct omap_device *od = to_omap_device(pdev);
657 int ret;
658
659
660 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER)
661 return 0;
662
663 ret = pm_generic_suspend_noirq(dev);
664
665 if (!ret && !pm_runtime_status_suspended(dev)) {
666 if (pm_generic_runtime_suspend(dev) == 0) {
667 pm_runtime_set_suspended(dev);
668 omap_device_idle(pdev);
669 od->flags |= OMAP_DEVICE_SUSPENDED;
670 }
671 }
672
673 return ret;
674}
675
676static int _od_resume_noirq(struct device *dev)
677{
678 struct platform_device *pdev = to_platform_device(dev);
679 struct omap_device *od = to_omap_device(pdev);
680
681 if (od->flags & OMAP_DEVICE_SUSPENDED) {
682 od->flags &= ~OMAP_DEVICE_SUSPENDED;
683 omap_device_enable(pdev);
684
685
686
687
688
689
690
691 WARN(pm_runtime_set_active(dev),
692 "Could not set %s runtime state active\n", dev_name(dev));
693 pm_generic_runtime_resume(dev);
694 }
695
696 return pm_generic_resume_noirq(dev);
697}
698#else
699#define _od_suspend_noirq NULL
700#define _od_resume_noirq NULL
701#endif
702
703struct dev_pm_domain omap_device_fail_pm_domain = {
704 .ops = {
705 SET_RUNTIME_PM_OPS(_od_fail_runtime_suspend,
706 _od_fail_runtime_resume, NULL)
707 }
708};
709
710struct dev_pm_domain omap_device_pm_domain = {
711 .ops = {
712 SET_RUNTIME_PM_OPS(_od_runtime_suspend, _od_runtime_resume,
713 NULL)
714 USE_PLATFORM_PM_SLEEP_OPS
715 SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(_od_suspend_noirq,
716 _od_resume_noirq)
717 }
718};
719
720
721
722
723
724
725
726
727
728int omap_device_register(struct platform_device *pdev)
729{
730 pr_debug("omap_device: %s: registering\n", pdev->name);
731
732 dev_pm_domain_set(&pdev->dev, &omap_device_pm_domain);
733 return platform_device_add(pdev);
734}
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751int omap_device_enable(struct platform_device *pdev)
752{
753 int ret;
754 struct omap_device *od;
755
756 od = to_omap_device(pdev);
757
758 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
759 dev_warn(&pdev->dev,
760 "omap_device: %s() called from invalid state %d\n",
761 __func__, od->_state);
762 return -EINVAL;
763 }
764
765 ret = _omap_device_enable_hwmods(od);
766
767 if (ret == 0)
768 od->_state = OMAP_DEVICE_STATE_ENABLED;
769
770 return ret;
771}
772
773
774
775
776
777
778
779
780
781
782int omap_device_idle(struct platform_device *pdev)
783{
784 int ret;
785 struct omap_device *od;
786
787 od = to_omap_device(pdev);
788
789 if (od->_state != OMAP_DEVICE_STATE_ENABLED) {
790 dev_warn(&pdev->dev,
791 "omap_device: %s() called from invalid state %d\n",
792 __func__, od->_state);
793 return -EINVAL;
794 }
795
796 ret = _omap_device_idle_hwmods(od);
797
798 if (ret == 0)
799 od->_state = OMAP_DEVICE_STATE_IDLE;
800
801 return ret;
802}
803
804
805
806
807
808
809
810
811
812
813
814
815
816int omap_device_assert_hardreset(struct platform_device *pdev, const char *name)
817{
818 struct omap_device *od = to_omap_device(pdev);
819 int ret = 0;
820 int i;
821
822 for (i = 0; i < od->hwmods_cnt; i++) {
823 ret = omap_hwmod_assert_hardreset(od->hwmods[i], name);
824 if (ret)
825 break;
826 }
827
828 return ret;
829}
830
831
832
833
834
835
836
837
838
839
840
841
842
843int omap_device_deassert_hardreset(struct platform_device *pdev,
844 const char *name)
845{
846 struct omap_device *od = to_omap_device(pdev);
847 int ret = 0;
848 int i;
849
850 for (i = 0; i < od->hwmods_cnt; i++) {
851 ret = omap_hwmod_deassert_hardreset(od->hwmods[i], name);
852 if (ret)
853 break;
854 }
855
856 return ret;
857}
858
859
860
861
862
863
864
865
866
867struct device *omap_device_get_by_hwmod_name(const char *oh_name)
868{
869 struct omap_hwmod *oh;
870
871 if (!oh_name) {
872 WARN(1, "%s: no hwmod name!\n", __func__);
873 return ERR_PTR(-EINVAL);
874 }
875
876 oh = omap_hwmod_lookup(oh_name);
877 if (!oh) {
878 WARN(1, "%s: no hwmod for %s\n", __func__,
879 oh_name);
880 return ERR_PTR(-ENODEV);
881 }
882 if (!oh->od) {
883 WARN(1, "%s: no omap_device for %s\n", __func__,
884 oh_name);
885 return ERR_PTR(-ENODEV);
886 }
887
888 return &oh->od->pdev->dev;
889}
890
891static struct notifier_block platform_nb = {
892 .notifier_call = _omap_device_notifier_call,
893};
894
895static int __init omap_device_init(void)
896{
897 bus_register_notifier(&platform_bus_type, &platform_nb);
898 return 0;
899}
900omap_postcore_initcall(omap_device_init);
901
902
903
904
905
906
907
908
909
910static int __init omap_device_late_idle(struct device *dev, void *data)
911{
912 struct platform_device *pdev = to_platform_device(dev);
913 struct omap_device *od = to_omap_device(pdev);
914 int i;
915
916 if (!od)
917 return 0;
918
919
920
921
922
923
924
925
926
927
928 for (i = 0; i < od->hwmods_cnt; i++)
929 if (od->hwmods[i]->flags & HWMOD_INIT_NO_IDLE)
930 return 0;
931
932 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER &&
933 od->_driver_status != BUS_NOTIFY_BIND_DRIVER) {
934 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
935 dev_warn(dev, "%s: enabled but no driver. Idling\n",
936 __func__);
937 omap_device_idle(pdev);
938 }
939 }
940
941 return 0;
942}
943
944static int __init omap_device_late_init(void)
945{
946 bus_for_each_dev(&platform_bus_type, NULL, NULL, omap_device_late_idle);
947
948 WARN(!of_have_populated_dt(),
949 "legacy booting deprecated, please update to boot with .dts\n");
950
951 return 0;
952}
953omap_late_initcall_sync(omap_device_late_init);
954