1
2
3
4
5
6
7
8
9
10
11
12
13
14#undef DEBUG
15
16#include <linux/kernel.h>
17#include <linux/device.h>
18#include <linux/list.h>
19#include <linux/errno.h>
20#include <linux/string.h>
21#include <linux/delay.h>
22#include <linux/clk.h>
23#include <linux/limits.h>
24#include <linux/err.h>
25#include <linux/clk-provider.h>
26
27#include <linux/io.h>
28
29#include <linux/bitops.h>
30
31#include "soc.h"
32#include "clock.h"
33#include "clockdomain.h"
34
35
36static LIST_HEAD(clkdm_list);
37
38
39static struct clkdm_autodep *autodeps;
40
41static struct clkdm_ops *arch_clkdm;
42
43
44
45static struct clockdomain *_clkdm_lookup(const char *name)
46{
47 struct clockdomain *clkdm, *temp_clkdm;
48
49 if (!name)
50 return NULL;
51
52 clkdm = NULL;
53
54 list_for_each_entry(temp_clkdm, &clkdm_list, node) {
55 if (!strcmp(name, temp_clkdm->name)) {
56 clkdm = temp_clkdm;
57 break;
58 }
59 }
60
61 return clkdm;
62}
63
64
65
66
67
68
69
70
71
72static int _clkdm_register(struct clockdomain *clkdm)
73{
74 struct powerdomain *pwrdm;
75
76 if (!clkdm || !clkdm->name)
77 return -EINVAL;
78
79 pwrdm = pwrdm_lookup(clkdm->pwrdm.name);
80 if (!pwrdm) {
81 pr_err("clockdomain: %s: powerdomain %s does not exist\n",
82 clkdm->name, clkdm->pwrdm.name);
83 return -EINVAL;
84 }
85 clkdm->pwrdm.ptr = pwrdm;
86
87
88 if (_clkdm_lookup(clkdm->name))
89 return -EEXIST;
90
91 list_add(&clkdm->node, &clkdm_list);
92
93 pwrdm_add_clkdm(pwrdm, clkdm);
94
95 pr_debug("clockdomain: registered %s\n", clkdm->name);
96
97 return 0;
98}
99
100
101static struct clkdm_dep *_clkdm_deps_lookup(struct clockdomain *clkdm,
102 struct clkdm_dep *deps)
103{
104 struct clkdm_dep *cd;
105
106 if (!clkdm || !deps)
107 return ERR_PTR(-EINVAL);
108
109 for (cd = deps; cd->clkdm_name; cd++) {
110 if (!cd->clkdm && cd->clkdm_name)
111 cd->clkdm = _clkdm_lookup(cd->clkdm_name);
112
113 if (cd->clkdm == clkdm)
114 break;
115 }
116
117 if (!cd->clkdm_name)
118 return ERR_PTR(-ENOENT);
119
120 return cd;
121}
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139static void _autodep_lookup(struct clkdm_autodep *autodep)
140{
141 struct clockdomain *clkdm;
142
143 if (!autodep)
144 return;
145
146 clkdm = clkdm_lookup(autodep->clkdm.name);
147 if (!clkdm) {
148 pr_err("clockdomain: autodeps: clockdomain %s does not exist\n",
149 autodep->clkdm.name);
150 clkdm = ERR_PTR(-ENOENT);
151 }
152 autodep->clkdm.ptr = clkdm;
153}
154
155
156
157
158
159
160
161
162
163
164static void _resolve_clkdm_deps(struct clockdomain *clkdm,
165 struct clkdm_dep *clkdm_deps)
166{
167 struct clkdm_dep *cd;
168
169 for (cd = clkdm_deps; cd && cd->clkdm_name; cd++) {
170 if (cd->clkdm)
171 continue;
172 cd->clkdm = _clkdm_lookup(cd->clkdm_name);
173
174 WARN(!cd->clkdm, "clockdomain: %s: could not find clkdm %s while resolving dependencies - should never happen",
175 clkdm->name, cd->clkdm_name);
176 }
177}
178
179
180
181
182
183
184
185
186
187
188
189
190
191static int _clkdm_add_wkdep(struct clockdomain *clkdm1,
192 struct clockdomain *clkdm2)
193{
194 struct clkdm_dep *cd;
195 int ret = 0;
196
197 if (!clkdm1 || !clkdm2)
198 return -EINVAL;
199
200 cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
201 if (IS_ERR(cd))
202 ret = PTR_ERR(cd);
203
204 if (!arch_clkdm || !arch_clkdm->clkdm_add_wkdep)
205 ret = -EINVAL;
206
207 if (ret) {
208 pr_debug("clockdomain: hardware cannot set/clear wake up of %s when %s wakes up\n",
209 clkdm1->name, clkdm2->name);
210 return ret;
211 }
212
213 cd->wkdep_usecount++;
214 if (cd->wkdep_usecount == 1) {
215 pr_debug("clockdomain: hardware will wake up %s when %s wakes up\n",
216 clkdm1->name, clkdm2->name);
217
218 ret = arch_clkdm->clkdm_add_wkdep(clkdm1, clkdm2);
219 }
220
221 return ret;
222}
223
224
225
226
227
228
229
230
231
232
233
234static int _clkdm_del_wkdep(struct clockdomain *clkdm1,
235 struct clockdomain *clkdm2)
236{
237 struct clkdm_dep *cd;
238 int ret = 0;
239
240 if (!clkdm1 || !clkdm2)
241 return -EINVAL;
242
243 cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
244 if (IS_ERR(cd))
245 ret = PTR_ERR(cd);
246
247 if (!arch_clkdm || !arch_clkdm->clkdm_del_wkdep)
248 ret = -EINVAL;
249
250 if (ret) {
251 pr_debug("clockdomain: hardware cannot set/clear wake up of %s when %s wakes up\n",
252 clkdm1->name, clkdm2->name);
253 return ret;
254 }
255
256 cd->wkdep_usecount--;
257 if (cd->wkdep_usecount == 0) {
258 pr_debug("clockdomain: hardware will no longer wake up %s after %s wakes up\n",
259 clkdm1->name, clkdm2->name);
260
261 ret = arch_clkdm->clkdm_del_wkdep(clkdm1, clkdm2);
262 }
263
264 return ret;
265}
266
267
268
269
270
271
272
273
274
275
276
277
278
279static int _clkdm_add_sleepdep(struct clockdomain *clkdm1,
280 struct clockdomain *clkdm2)
281{
282 struct clkdm_dep *cd;
283 int ret = 0;
284
285 if (!clkdm1 || !clkdm2)
286 return -EINVAL;
287
288 cd = _clkdm_deps_lookup(clkdm2, clkdm1->sleepdep_srcs);
289 if (IS_ERR(cd))
290 ret = PTR_ERR(cd);
291
292 if (!arch_clkdm || !arch_clkdm->clkdm_add_sleepdep)
293 ret = -EINVAL;
294
295 if (ret) {
296 pr_debug("clockdomain: hardware cannot set/clear sleep dependency affecting %s from %s\n",
297 clkdm1->name, clkdm2->name);
298 return ret;
299 }
300
301 cd->sleepdep_usecount++;
302 if (cd->sleepdep_usecount == 1) {
303 pr_debug("clockdomain: will prevent %s from sleeping if %s is active\n",
304 clkdm1->name, clkdm2->name);
305
306 ret = arch_clkdm->clkdm_add_sleepdep(clkdm1, clkdm2);
307 }
308
309 return ret;
310}
311
312
313
314
315
316
317
318
319
320
321
322
323
324static int _clkdm_del_sleepdep(struct clockdomain *clkdm1,
325 struct clockdomain *clkdm2)
326{
327 struct clkdm_dep *cd;
328 int ret = 0;
329
330 if (!clkdm1 || !clkdm2)
331 return -EINVAL;
332
333 cd = _clkdm_deps_lookup(clkdm2, clkdm1->sleepdep_srcs);
334 if (IS_ERR(cd))
335 ret = PTR_ERR(cd);
336
337 if (!arch_clkdm || !arch_clkdm->clkdm_del_sleepdep)
338 ret = -EINVAL;
339
340 if (ret) {
341 pr_debug("clockdomain: hardware cannot set/clear sleep dependency affecting %s from %s\n",
342 clkdm1->name, clkdm2->name);
343 return ret;
344 }
345
346 cd->sleepdep_usecount--;
347 if (cd->sleepdep_usecount == 0) {
348 pr_debug("clockdomain: will no longer prevent %s from sleeping if %s is active\n",
349 clkdm1->name, clkdm2->name);
350
351 ret = arch_clkdm->clkdm_del_sleepdep(clkdm1, clkdm2);
352 }
353
354 return ret;
355}
356
357
358
359
360
361
362
363
364
365
366
367
368
369int clkdm_register_platform_funcs(struct clkdm_ops *co)
370{
371 if (!co)
372 return -EINVAL;
373
374 if (arch_clkdm)
375 return -EEXIST;
376
377 arch_clkdm = co;
378
379 return 0;
380};
381
382
383
384
385
386
387
388
389
390
391
392int clkdm_register_clkdms(struct clockdomain **cs)
393{
394 struct clockdomain **c = NULL;
395
396 if (!arch_clkdm)
397 return -EACCES;
398
399 if (!cs)
400 return -EINVAL;
401
402 for (c = cs; *c; c++)
403 _clkdm_register(*c);
404
405 return 0;
406}
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432int clkdm_register_autodeps(struct clkdm_autodep *ia)
433{
434 struct clkdm_autodep *a = NULL;
435
436 if (list_empty(&clkdm_list))
437 return -EACCES;
438
439 if (!ia)
440 return -EINVAL;
441
442 if (autodeps)
443 return -EEXIST;
444
445 autodeps = ia;
446 for (a = autodeps; a->clkdm.ptr; a++)
447 _autodep_lookup(a);
448
449 return 0;
450}
451
452
453
454
455
456
457
458
459
460int clkdm_complete_init(void)
461{
462 struct clockdomain *clkdm;
463
464 if (list_empty(&clkdm_list))
465 return -EACCES;
466
467 list_for_each_entry(clkdm, &clkdm_list, node) {
468 clkdm_deny_idle(clkdm);
469
470 _resolve_clkdm_deps(clkdm, clkdm->wkdep_srcs);
471 clkdm_clear_all_wkdeps(clkdm);
472
473 _resolve_clkdm_deps(clkdm, clkdm->sleepdep_srcs);
474 clkdm_clear_all_sleepdeps(clkdm);
475 }
476
477 return 0;
478}
479
480
481
482
483
484
485
486
487struct clockdomain *clkdm_lookup(const char *name)
488{
489 struct clockdomain *clkdm, *temp_clkdm;
490
491 if (!name)
492 return NULL;
493
494 clkdm = NULL;
495
496 list_for_each_entry(temp_clkdm, &clkdm_list, node) {
497 if (!strcmp(name, temp_clkdm->name)) {
498 clkdm = temp_clkdm;
499 break;
500 }
501 }
502
503 return clkdm;
504}
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520int clkdm_for_each(int (*fn)(struct clockdomain *clkdm, void *user),
521 void *user)
522{
523 struct clockdomain *clkdm;
524 int ret = 0;
525
526 if (!fn)
527 return -EINVAL;
528
529 list_for_each_entry(clkdm, &clkdm_list, node) {
530 ret = (*fn)(clkdm, user);
531 if (ret)
532 break;
533 }
534
535 return ret;
536}
537
538
539
540
541
542
543
544
545
546struct powerdomain *clkdm_get_pwrdm(struct clockdomain *clkdm)
547{
548 if (!clkdm)
549 return NULL;
550
551 return clkdm->pwrdm.ptr;
552}
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569int clkdm_add_wkdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
570{
571 struct clkdm_dep *cd;
572 int ret;
573
574 if (!clkdm1 || !clkdm2)
575 return -EINVAL;
576
577 cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
578 if (IS_ERR(cd))
579 return PTR_ERR(cd);
580
581 pwrdm_lock(cd->clkdm->pwrdm.ptr);
582 ret = _clkdm_add_wkdep(clkdm1, clkdm2);
583 pwrdm_unlock(cd->clkdm->pwrdm.ptr);
584
585 return ret;
586}
587
588
589
590
591
592
593
594
595
596
597
598int clkdm_del_wkdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
599{
600 struct clkdm_dep *cd;
601 int ret;
602
603 if (!clkdm1 || !clkdm2)
604 return -EINVAL;
605
606 cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
607 if (IS_ERR(cd))
608 return PTR_ERR(cd);
609
610 pwrdm_lock(cd->clkdm->pwrdm.ptr);
611 ret = _clkdm_del_wkdep(clkdm1, clkdm2);
612 pwrdm_unlock(cd->clkdm->pwrdm.ptr);
613
614 return ret;
615}
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631int clkdm_read_wkdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
632{
633 struct clkdm_dep *cd;
634 int ret = 0;
635
636 if (!clkdm1 || !clkdm2)
637 return -EINVAL;
638
639 cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
640 if (IS_ERR(cd))
641 ret = PTR_ERR(cd);
642
643 if (!arch_clkdm || !arch_clkdm->clkdm_read_wkdep)
644 ret = -EINVAL;
645
646 if (ret) {
647 pr_debug("clockdomain: hardware cannot set/clear wake up of %s when %s wakes up\n",
648 clkdm1->name, clkdm2->name);
649 return ret;
650 }
651
652
653 return arch_clkdm->clkdm_read_wkdep(clkdm1, clkdm2);
654}
655
656
657
658
659
660
661
662
663
664
665
666int clkdm_clear_all_wkdeps(struct clockdomain *clkdm)
667{
668 if (!clkdm)
669 return -EINVAL;
670
671 if (!arch_clkdm || !arch_clkdm->clkdm_clear_all_wkdeps)
672 return -EINVAL;
673
674 return arch_clkdm->clkdm_clear_all_wkdeps(clkdm);
675}
676
677
678
679
680
681
682
683
684
685
686
687
688
689int clkdm_add_sleepdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
690{
691 struct clkdm_dep *cd;
692 int ret;
693
694 if (!clkdm1 || !clkdm2)
695 return -EINVAL;
696
697 cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
698 if (IS_ERR(cd))
699 return PTR_ERR(cd);
700
701 pwrdm_lock(cd->clkdm->pwrdm.ptr);
702 ret = _clkdm_add_sleepdep(clkdm1, clkdm2);
703 pwrdm_unlock(cd->clkdm->pwrdm.ptr);
704
705 return ret;
706}
707
708
709
710
711
712
713
714
715
716
717
718
719
720int clkdm_del_sleepdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
721{
722 struct clkdm_dep *cd;
723 int ret;
724
725 if (!clkdm1 || !clkdm2)
726 return -EINVAL;
727
728 cd = _clkdm_deps_lookup(clkdm2, clkdm1->wkdep_srcs);
729 if (IS_ERR(cd))
730 return PTR_ERR(cd);
731
732 pwrdm_lock(cd->clkdm->pwrdm.ptr);
733 ret = _clkdm_del_sleepdep(clkdm1, clkdm2);
734 pwrdm_unlock(cd->clkdm->pwrdm.ptr);
735
736 return ret;
737}
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755int clkdm_read_sleepdep(struct clockdomain *clkdm1, struct clockdomain *clkdm2)
756{
757 struct clkdm_dep *cd;
758 int ret = 0;
759
760 if (!clkdm1 || !clkdm2)
761 return -EINVAL;
762
763 cd = _clkdm_deps_lookup(clkdm2, clkdm1->sleepdep_srcs);
764 if (IS_ERR(cd))
765 ret = PTR_ERR(cd);
766
767 if (!arch_clkdm || !arch_clkdm->clkdm_read_sleepdep)
768 ret = -EINVAL;
769
770 if (ret) {
771 pr_debug("clockdomain: hardware cannot set/clear sleep dependency affecting %s from %s\n",
772 clkdm1->name, clkdm2->name);
773 return ret;
774 }
775
776
777 return arch_clkdm->clkdm_read_sleepdep(clkdm1, clkdm2);
778}
779
780
781
782
783
784
785
786
787
788
789
790int clkdm_clear_all_sleepdeps(struct clockdomain *clkdm)
791{
792 if (!clkdm)
793 return -EINVAL;
794
795 if (!arch_clkdm || !arch_clkdm->clkdm_clear_all_sleepdeps)
796 return -EINVAL;
797
798 return arch_clkdm->clkdm_clear_all_sleepdeps(clkdm);
799}
800
801
802
803
804
805
806
807
808
809
810int clkdm_sleep_nolock(struct clockdomain *clkdm)
811{
812 int ret;
813
814 if (!clkdm)
815 return -EINVAL;
816
817 if (!(clkdm->flags & CLKDM_CAN_FORCE_SLEEP)) {
818 pr_debug("clockdomain: %s does not support forcing sleep via software\n",
819 clkdm->name);
820 return -EINVAL;
821 }
822
823 if (!arch_clkdm || !arch_clkdm->clkdm_sleep)
824 return -EINVAL;
825
826 pr_debug("clockdomain: forcing sleep on %s\n", clkdm->name);
827
828 clkdm->_flags &= ~_CLKDM_FLAG_HWSUP_ENABLED;
829 ret = arch_clkdm->clkdm_sleep(clkdm);
830 ret |= pwrdm_state_switch_nolock(clkdm->pwrdm.ptr);
831
832 return ret;
833}
834
835
836
837
838
839
840
841
842
843
844int clkdm_sleep(struct clockdomain *clkdm)
845{
846 int ret;
847
848 pwrdm_lock(clkdm->pwrdm.ptr);
849 ret = clkdm_sleep_nolock(clkdm);
850 pwrdm_unlock(clkdm->pwrdm.ptr);
851
852 return ret;
853}
854
855
856
857
858
859
860
861
862
863
864int clkdm_wakeup_nolock(struct clockdomain *clkdm)
865{
866 int ret;
867
868 if (!clkdm)
869 return -EINVAL;
870
871 if (!(clkdm->flags & CLKDM_CAN_FORCE_WAKEUP)) {
872 pr_debug("clockdomain: %s does not support forcing wakeup via software\n",
873 clkdm->name);
874 return -EINVAL;
875 }
876
877 if (!arch_clkdm || !arch_clkdm->clkdm_wakeup)
878 return -EINVAL;
879
880 pr_debug("clockdomain: forcing wakeup on %s\n", clkdm->name);
881
882 clkdm->_flags &= ~_CLKDM_FLAG_HWSUP_ENABLED;
883 ret = arch_clkdm->clkdm_wakeup(clkdm);
884 ret |= pwrdm_state_switch_nolock(clkdm->pwrdm.ptr);
885
886 return ret;
887}
888
889
890
891
892
893
894
895
896
897
898int clkdm_wakeup(struct clockdomain *clkdm)
899{
900 int ret;
901
902 pwrdm_lock(clkdm->pwrdm.ptr);
903 ret = clkdm_wakeup_nolock(clkdm);
904 pwrdm_unlock(clkdm->pwrdm.ptr);
905
906 return ret;
907}
908
909
910
911
912
913
914
915
916
917
918
919
920void clkdm_allow_idle_nolock(struct clockdomain *clkdm)
921{
922 if (!clkdm)
923 return;
924
925 if (!WARN_ON(!clkdm->forcewake_count))
926 clkdm->forcewake_count--;
927
928 if (clkdm->forcewake_count)
929 return;
930
931 if (!clkdm->usecount && (clkdm->flags & CLKDM_CAN_FORCE_SLEEP))
932 clkdm_sleep_nolock(clkdm);
933
934 if (!(clkdm->flags & CLKDM_CAN_ENABLE_AUTO))
935 return;
936
937 if (clkdm->flags & CLKDM_MISSING_IDLE_REPORTING)
938 return;
939
940 if (!arch_clkdm || !arch_clkdm->clkdm_allow_idle)
941 return;
942
943 pr_debug("clockdomain: enabling automatic idle transitions for %s\n",
944 clkdm->name);
945
946 clkdm->_flags |= _CLKDM_FLAG_HWSUP_ENABLED;
947 arch_clkdm->clkdm_allow_idle(clkdm);
948 pwrdm_state_switch_nolock(clkdm->pwrdm.ptr);
949}
950
951
952
953
954
955
956
957
958
959
960
961void clkdm_allow_idle(struct clockdomain *clkdm)
962{
963 pwrdm_lock(clkdm->pwrdm.ptr);
964 clkdm_allow_idle_nolock(clkdm);
965 pwrdm_unlock(clkdm->pwrdm.ptr);
966}
967
968
969
970
971
972
973
974
975
976
977
978void clkdm_deny_idle_nolock(struct clockdomain *clkdm)
979{
980 if (!clkdm)
981 return;
982
983 if (clkdm->forcewake_count++)
984 return;
985
986 if (clkdm->flags & CLKDM_CAN_FORCE_WAKEUP)
987 clkdm_wakeup_nolock(clkdm);
988
989 if (!(clkdm->flags & CLKDM_CAN_DISABLE_AUTO))
990 return;
991
992 if (clkdm->flags & CLKDM_MISSING_IDLE_REPORTING)
993 return;
994
995 if (!arch_clkdm || !arch_clkdm->clkdm_deny_idle)
996 return;
997
998 pr_debug("clockdomain: disabling automatic idle transitions for %s\n",
999 clkdm->name);
1000
1001 clkdm->_flags &= ~_CLKDM_FLAG_HWSUP_ENABLED;
1002 arch_clkdm->clkdm_deny_idle(clkdm);
1003 pwrdm_state_switch_nolock(clkdm->pwrdm.ptr);
1004}
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015void clkdm_deny_idle(struct clockdomain *clkdm)
1016{
1017 pwrdm_lock(clkdm->pwrdm.ptr);
1018 clkdm_deny_idle_nolock(clkdm);
1019 pwrdm_unlock(clkdm->pwrdm.ptr);
1020}
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033bool clkdm_in_hwsup(struct clockdomain *clkdm)
1034{
1035 bool ret;
1036
1037 if (!clkdm)
1038 return false;
1039
1040 ret = (clkdm->_flags & _CLKDM_FLAG_HWSUP_ENABLED) ? true : false;
1041
1042 return ret;
1043}
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054bool clkdm_missing_idle_reporting(struct clockdomain *clkdm)
1055{
1056 if (!clkdm)
1057 return false;
1058
1059 return (clkdm->flags & CLKDM_MISSING_IDLE_REPORTING) ? true : false;
1060}
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075void clkdm_add_autodeps(struct clockdomain *clkdm)
1076{
1077 struct clkdm_autodep *autodep;
1078
1079 if (!autodeps || clkdm->flags & CLKDM_NO_AUTODEPS)
1080 return;
1081
1082 for (autodep = autodeps; autodep->clkdm.ptr; autodep++) {
1083 if (IS_ERR(autodep->clkdm.ptr))
1084 continue;
1085
1086 pr_debug("clockdomain: %s: adding %s sleepdep/wkdep\n",
1087 clkdm->name, autodep->clkdm.ptr->name);
1088
1089 _clkdm_add_sleepdep(clkdm, autodep->clkdm.ptr);
1090 _clkdm_add_wkdep(clkdm, autodep->clkdm.ptr);
1091 }
1092}
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105void clkdm_del_autodeps(struct clockdomain *clkdm)
1106{
1107 struct clkdm_autodep *autodep;
1108
1109 if (!autodeps || clkdm->flags & CLKDM_NO_AUTODEPS)
1110 return;
1111
1112 for (autodep = autodeps; autodep->clkdm.ptr; autodep++) {
1113 if (IS_ERR(autodep->clkdm.ptr))
1114 continue;
1115
1116 pr_debug("clockdomain: %s: removing %s sleepdep/wkdep\n",
1117 clkdm->name, autodep->clkdm.ptr->name);
1118
1119 _clkdm_del_sleepdep(clkdm, autodep->clkdm.ptr);
1120 _clkdm_del_wkdep(clkdm, autodep->clkdm.ptr);
1121 }
1122}
1123
1124
1125
1126static int _clkdm_clk_hwmod_enable(struct clockdomain *clkdm)
1127{
1128 if (!clkdm || !arch_clkdm || !arch_clkdm->clkdm_clk_enable)
1129 return -EINVAL;
1130
1131 pwrdm_lock(clkdm->pwrdm.ptr);
1132
1133
1134
1135
1136
1137
1138 clkdm->usecount++;
1139 if (clkdm->usecount > 1 && autodeps) {
1140 pwrdm_unlock(clkdm->pwrdm.ptr);
1141 return 0;
1142 }
1143
1144 arch_clkdm->clkdm_clk_enable(clkdm);
1145 pwrdm_state_switch_nolock(clkdm->pwrdm.ptr);
1146 pwrdm_unlock(clkdm->pwrdm.ptr);
1147
1148 pr_debug("clockdomain: %s: enabled\n", clkdm->name);
1149
1150 return 0;
1151}
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167int clkdm_clk_enable(struct clockdomain *clkdm, struct clk *clk)
1168{
1169
1170
1171
1172
1173
1174 if (!clk)
1175 return -EINVAL;
1176
1177 return _clkdm_clk_hwmod_enable(clkdm);
1178}
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193int clkdm_clk_disable(struct clockdomain *clkdm, struct clk *clk)
1194{
1195 if (!clkdm || !clk || !arch_clkdm || !arch_clkdm->clkdm_clk_disable)
1196 return -EINVAL;
1197
1198 pwrdm_lock(clkdm->pwrdm.ptr);
1199
1200
1201 if ((__clk_get_enable_count(clk) == 0) && clkdm->usecount == 0)
1202 goto ccd_exit;
1203
1204 if (clkdm->usecount == 0) {
1205 pwrdm_unlock(clkdm->pwrdm.ptr);
1206 WARN_ON(1);
1207 return -ERANGE;
1208 }
1209
1210 clkdm->usecount--;
1211 if (clkdm->usecount > 0) {
1212 pwrdm_unlock(clkdm->pwrdm.ptr);
1213 return 0;
1214 }
1215
1216 arch_clkdm->clkdm_clk_disable(clkdm);
1217 pwrdm_state_switch_nolock(clkdm->pwrdm.ptr);
1218
1219 pr_debug("clockdomain: %s: disabled\n", clkdm->name);
1220
1221ccd_exit:
1222 pwrdm_unlock(clkdm->pwrdm.ptr);
1223
1224 return 0;
1225}
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242int clkdm_hwmod_enable(struct clockdomain *clkdm, struct omap_hwmod *oh)
1243{
1244
1245 if (cpu_is_omap24xx() || cpu_is_omap34xx())
1246 return 0;
1247
1248
1249
1250
1251
1252
1253 if (!oh)
1254 return -EINVAL;
1255
1256 return _clkdm_clk_hwmod_enable(clkdm);
1257}
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273int clkdm_hwmod_disable(struct clockdomain *clkdm, struct omap_hwmod *oh)
1274{
1275
1276 if (cpu_is_omap24xx() || cpu_is_omap34xx())
1277 return 0;
1278
1279
1280
1281
1282
1283
1284 if (!clkdm || !oh || !arch_clkdm || !arch_clkdm->clkdm_clk_disable)
1285 return -EINVAL;
1286
1287 pwrdm_lock(clkdm->pwrdm.ptr);
1288
1289 if (clkdm->usecount == 0) {
1290 pwrdm_unlock(clkdm->pwrdm.ptr);
1291 WARN_ON(1);
1292 return -ERANGE;
1293 }
1294
1295 clkdm->usecount--;
1296 if (clkdm->usecount > 0) {
1297 pwrdm_unlock(clkdm->pwrdm.ptr);
1298 return 0;
1299 }
1300
1301 arch_clkdm->clkdm_clk_disable(clkdm);
1302 pwrdm_state_switch_nolock(clkdm->pwrdm.ptr);
1303 pwrdm_unlock(clkdm->pwrdm.ptr);
1304
1305 pr_debug("clockdomain: %s: disabled\n", clkdm->name);
1306
1307 return 0;
1308}
1309
1310