This source file includes following definitions.
- omap_cm_base_init
- _clkctrl_idlest
- _is_module_ready
- omap4_cminst_read_inst_reg
- omap4_cminst_write_inst_reg
- omap4_cminst_rmw_inst_reg_bits
- omap4_cminst_set_inst_reg_bits
- omap4_cminst_clear_inst_reg_bits
- omap4_cminst_read_inst_reg_bits
- _clktrctrl_write
- omap4_cminst_is_clkdm_in_hwsup
- omap4_cminst_clkdm_enable_hwsup
- omap4_cminst_clkdm_disable_hwsup
- omap4_cminst_clkdm_force_wakeup
- omap4_cminst_clkdm_force_sleep
- omap4_cminst_wait_module_ready
- omap4_cminst_wait_module_idle
- omap4_cminst_module_enable
- omap4_cminst_module_disable
- omap4_clkdm_add_wkup_sleep_dep
- omap4_clkdm_del_wkup_sleep_dep
- omap4_clkdm_read_wkup_sleep_dep
- omap4_clkdm_clear_all_wkup_sleep_deps
- omap4_clkdm_sleep
- omap4_clkdm_wakeup
- omap4_clkdm_allow_idle
- omap4_clkdm_deny_idle
- omap4_clkdm_clk_enable
- omap4_clkdm_clk_disable
- omap4_cminst_xlate_clkctrl
- omap4_clkdm_save_context
- omap4_clkdm_restore_context
- omap4_cm_init
- omap4_cm_exit
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15 #include <linux/kernel.h>
16 #include <linux/types.h>
17 #include <linux/errno.h>
18 #include <linux/err.h>
19 #include <linux/io.h>
20
21 #include "clockdomain.h"
22 #include "cm.h"
23 #include "cm1_44xx.h"
24 #include "cm2_44xx.h"
25 #include "cm44xx.h"
26 #include "cm-regbits-34xx.h"
27 #include "prcm44xx.h"
28 #include "prm44xx.h"
29 #include "prcm_mpu44xx.h"
30 #include "prcm-common.h"
31
32 #define OMAP4430_IDLEST_SHIFT 16
33 #define OMAP4430_IDLEST_MASK (0x3 << 16)
34 #define OMAP4430_CLKTRCTRL_SHIFT 0
35 #define OMAP4430_CLKTRCTRL_MASK (0x3 << 0)
36 #define OMAP4430_MODULEMODE_SHIFT 0
37 #define OMAP4430_MODULEMODE_MASK (0x3 << 0)
38
39
40
41
42
43
44
45
46
47
48
49
50 #define CLKCTRL_IDLEST_FUNCTIONAL 0x0
51 #define CLKCTRL_IDLEST_INTRANSITION 0x1
52 #define CLKCTRL_IDLEST_INTERFACE_IDLE 0x2
53 #define CLKCTRL_IDLEST_DISABLED 0x3
54
55 static struct omap_domain_base _cm_bases[OMAP4_MAX_PRCM_PARTITIONS];
56
57
58
59
60
61
62
63 static void omap_cm_base_init(void)
64 {
65 memcpy(&_cm_bases[OMAP4430_PRM_PARTITION], &prm_base, sizeof(prm_base));
66 memcpy(&_cm_bases[OMAP4430_CM1_PARTITION], &cm_base, sizeof(cm_base));
67 memcpy(&_cm_bases[OMAP4430_CM2_PARTITION], &cm2_base, sizeof(cm2_base));
68 memcpy(&_cm_bases[OMAP4430_PRCM_MPU_PARTITION], &prcm_mpu_base,
69 sizeof(prcm_mpu_base));
70 }
71
72
73
74 static u32 omap4_cminst_read_inst_reg(u8 part, u16 inst, u16 idx);
75
76
77
78
79
80
81
82
83
84
85 static u32 _clkctrl_idlest(u8 part, u16 inst, u16 clkctrl_offs)
86 {
87 u32 v = omap4_cminst_read_inst_reg(part, inst, clkctrl_offs);
88 v &= OMAP4430_IDLEST_MASK;
89 v >>= OMAP4430_IDLEST_SHIFT;
90 return v;
91 }
92
93
94
95
96
97
98
99
100
101
102 static bool _is_module_ready(u8 part, u16 inst, u16 clkctrl_offs)
103 {
104 u32 v;
105
106 v = _clkctrl_idlest(part, inst, clkctrl_offs);
107
108 return (v == CLKCTRL_IDLEST_FUNCTIONAL ||
109 v == CLKCTRL_IDLEST_INTERFACE_IDLE) ? true : false;
110 }
111
112
113 static u32 omap4_cminst_read_inst_reg(u8 part, u16 inst, u16 idx)
114 {
115 BUG_ON(part >= OMAP4_MAX_PRCM_PARTITIONS ||
116 part == OMAP4430_INVALID_PRCM_PARTITION ||
117 !_cm_bases[part].va);
118 return readl_relaxed(_cm_bases[part].va + inst + idx);
119 }
120
121
122 static void omap4_cminst_write_inst_reg(u32 val, u8 part, u16 inst, u16 idx)
123 {
124 BUG_ON(part >= OMAP4_MAX_PRCM_PARTITIONS ||
125 part == OMAP4430_INVALID_PRCM_PARTITION ||
126 !_cm_bases[part].va);
127 writel_relaxed(val, _cm_bases[part].va + inst + idx);
128 }
129
130
131 static u32 omap4_cminst_rmw_inst_reg_bits(u32 mask, u32 bits, u8 part, u16 inst,
132 s16 idx)
133 {
134 u32 v;
135
136 v = omap4_cminst_read_inst_reg(part, inst, idx);
137 v &= ~mask;
138 v |= bits;
139 omap4_cminst_write_inst_reg(v, part, inst, idx);
140
141 return v;
142 }
143
144 static u32 omap4_cminst_set_inst_reg_bits(u32 bits, u8 part, u16 inst, s16 idx)
145 {
146 return omap4_cminst_rmw_inst_reg_bits(bits, bits, part, inst, idx);
147 }
148
149 static u32 omap4_cminst_clear_inst_reg_bits(u32 bits, u8 part, u16 inst,
150 s16 idx)
151 {
152 return omap4_cminst_rmw_inst_reg_bits(bits, 0x0, part, inst, idx);
153 }
154
155 static u32 omap4_cminst_read_inst_reg_bits(u8 part, u16 inst, s16 idx, u32 mask)
156 {
157 u32 v;
158
159 v = omap4_cminst_read_inst_reg(part, inst, idx);
160 v &= mask;
161 v >>= __ffs(mask);
162
163 return v;
164 }
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180 static void _clktrctrl_write(u8 c, u8 part, u16 inst, u16 cdoffs)
181 {
182 u32 v;
183
184 v = omap4_cminst_read_inst_reg(part, inst, cdoffs + OMAP4_CM_CLKSTCTRL);
185 v &= ~OMAP4430_CLKTRCTRL_MASK;
186 v |= c << OMAP4430_CLKTRCTRL_SHIFT;
187 omap4_cminst_write_inst_reg(v, part, inst, cdoffs + OMAP4_CM_CLKSTCTRL);
188 }
189
190
191
192
193
194
195
196
197
198
199 static bool omap4_cminst_is_clkdm_in_hwsup(u8 part, u16 inst, u16 cdoffs)
200 {
201 u32 v;
202
203 v = omap4_cminst_read_inst_reg(part, inst, cdoffs + OMAP4_CM_CLKSTCTRL);
204 v &= OMAP4430_CLKTRCTRL_MASK;
205 v >>= OMAP4430_CLKTRCTRL_SHIFT;
206
207 return (v == OMAP34XX_CLKSTCTRL_ENABLE_AUTO) ? true : false;
208 }
209
210
211
212
213
214
215
216
217
218
219 static void omap4_cminst_clkdm_enable_hwsup(u8 part, u16 inst, u16 cdoffs)
220 {
221 _clktrctrl_write(OMAP34XX_CLKSTCTRL_ENABLE_AUTO, part, inst, cdoffs);
222 }
223
224
225
226
227
228
229
230
231
232
233
234 static void omap4_cminst_clkdm_disable_hwsup(u8 part, u16 inst, u16 cdoffs)
235 {
236 _clktrctrl_write(OMAP34XX_CLKSTCTRL_DISABLE_AUTO, part, inst, cdoffs);
237 }
238
239
240
241
242
243
244
245
246
247
248 static void omap4_cminst_clkdm_force_wakeup(u8 part, u16 inst, u16 cdoffs)
249 {
250 _clktrctrl_write(OMAP34XX_CLKSTCTRL_FORCE_WAKEUP, part, inst, cdoffs);
251 }
252
253
254
255
256
257 static void omap4_cminst_clkdm_force_sleep(u8 part, u16 inst, u16 cdoffs)
258 {
259 _clktrctrl_write(OMAP34XX_CLKSTCTRL_FORCE_SLEEP, part, inst, cdoffs);
260 }
261
262
263
264
265
266
267
268
269
270
271
272
273
274 static int omap4_cminst_wait_module_ready(u8 part, s16 inst, u16 clkctrl_offs,
275 u8 bit_shift)
276 {
277 int i = 0;
278
279 omap_test_timeout(_is_module_ready(part, inst, clkctrl_offs),
280 MAX_MODULE_READY_TIME, i);
281
282 return (i < MAX_MODULE_READY_TIME) ? 0 : -EBUSY;
283 }
284
285
286
287
288
289
290
291
292
293
294
295
296
297 static int omap4_cminst_wait_module_idle(u8 part, s16 inst, u16 clkctrl_offs,
298 u8 bit_shift)
299 {
300 int i = 0;
301
302 omap_test_timeout((_clkctrl_idlest(part, inst, clkctrl_offs) ==
303 CLKCTRL_IDLEST_DISABLED),
304 MAX_MODULE_DISABLE_TIME, i);
305
306 return (i < MAX_MODULE_DISABLE_TIME) ? 0 : -EBUSY;
307 }
308
309
310
311
312
313
314
315
316
317
318 static void omap4_cminst_module_enable(u8 mode, u8 part, u16 inst,
319 u16 clkctrl_offs)
320 {
321 u32 v;
322
323 v = omap4_cminst_read_inst_reg(part, inst, clkctrl_offs);
324 v &= ~OMAP4430_MODULEMODE_MASK;
325 v |= mode << OMAP4430_MODULEMODE_SHIFT;
326 omap4_cminst_write_inst_reg(v, part, inst, clkctrl_offs);
327 }
328
329
330
331
332
333
334
335
336
337 static void omap4_cminst_module_disable(u8 part, u16 inst, u16 clkctrl_offs)
338 {
339 u32 v;
340
341 v = omap4_cminst_read_inst_reg(part, inst, clkctrl_offs);
342 v &= ~OMAP4430_MODULEMODE_MASK;
343 omap4_cminst_write_inst_reg(v, part, inst, clkctrl_offs);
344 }
345
346
347
348
349
350 static int omap4_clkdm_add_wkup_sleep_dep(struct clockdomain *clkdm1,
351 struct clockdomain *clkdm2)
352 {
353 omap4_cminst_set_inst_reg_bits((1 << clkdm2->dep_bit),
354 clkdm1->prcm_partition,
355 clkdm1->cm_inst, clkdm1->clkdm_offs +
356 OMAP4_CM_STATICDEP);
357 return 0;
358 }
359
360 static int omap4_clkdm_del_wkup_sleep_dep(struct clockdomain *clkdm1,
361 struct clockdomain *clkdm2)
362 {
363 omap4_cminst_clear_inst_reg_bits((1 << clkdm2->dep_bit),
364 clkdm1->prcm_partition,
365 clkdm1->cm_inst, clkdm1->clkdm_offs +
366 OMAP4_CM_STATICDEP);
367 return 0;
368 }
369
370 static int omap4_clkdm_read_wkup_sleep_dep(struct clockdomain *clkdm1,
371 struct clockdomain *clkdm2)
372 {
373 return omap4_cminst_read_inst_reg_bits(clkdm1->prcm_partition,
374 clkdm1->cm_inst,
375 clkdm1->clkdm_offs +
376 OMAP4_CM_STATICDEP,
377 (1 << clkdm2->dep_bit));
378 }
379
380 static int omap4_clkdm_clear_all_wkup_sleep_deps(struct clockdomain *clkdm)
381 {
382 struct clkdm_dep *cd;
383 u32 mask = 0;
384
385 if (!clkdm->prcm_partition)
386 return 0;
387
388 for (cd = clkdm->wkdep_srcs; cd && cd->clkdm_name; cd++) {
389 if (!cd->clkdm)
390 continue;
391
392 mask |= 1 << cd->clkdm->dep_bit;
393 cd->wkdep_usecount = 0;
394 }
395
396 omap4_cminst_clear_inst_reg_bits(mask, clkdm->prcm_partition,
397 clkdm->cm_inst, clkdm->clkdm_offs +
398 OMAP4_CM_STATICDEP);
399 return 0;
400 }
401
402 static int omap4_clkdm_sleep(struct clockdomain *clkdm)
403 {
404 if (clkdm->flags & CLKDM_CAN_HWSUP)
405 omap4_cminst_clkdm_enable_hwsup(clkdm->prcm_partition,
406 clkdm->cm_inst,
407 clkdm->clkdm_offs);
408 else if (clkdm->flags & CLKDM_CAN_FORCE_SLEEP)
409 omap4_cminst_clkdm_force_sleep(clkdm->prcm_partition,
410 clkdm->cm_inst,
411 clkdm->clkdm_offs);
412 else
413 return -EINVAL;
414
415 return 0;
416 }
417
418 static int omap4_clkdm_wakeup(struct clockdomain *clkdm)
419 {
420 omap4_cminst_clkdm_force_wakeup(clkdm->prcm_partition,
421 clkdm->cm_inst, clkdm->clkdm_offs);
422 return 0;
423 }
424
425 static void omap4_clkdm_allow_idle(struct clockdomain *clkdm)
426 {
427 omap4_cminst_clkdm_enable_hwsup(clkdm->prcm_partition,
428 clkdm->cm_inst, clkdm->clkdm_offs);
429 }
430
431 static void omap4_clkdm_deny_idle(struct clockdomain *clkdm)
432 {
433 if (clkdm->flags & CLKDM_CAN_FORCE_WAKEUP)
434 omap4_clkdm_wakeup(clkdm);
435 else
436 omap4_cminst_clkdm_disable_hwsup(clkdm->prcm_partition,
437 clkdm->cm_inst,
438 clkdm->clkdm_offs);
439 }
440
441 static int omap4_clkdm_clk_enable(struct clockdomain *clkdm)
442 {
443 if (clkdm->flags & CLKDM_CAN_FORCE_WAKEUP)
444 return omap4_clkdm_wakeup(clkdm);
445
446 return 0;
447 }
448
449 static int omap4_clkdm_clk_disable(struct clockdomain *clkdm)
450 {
451 bool hwsup = false;
452
453 if (!clkdm->prcm_partition)
454 return 0;
455
456
457
458
459
460
461 if (clkdm->flags & CLKDM_MISSING_IDLE_REPORTING &&
462 !(clkdm->flags & CLKDM_CAN_FORCE_SLEEP)) {
463 omap4_clkdm_allow_idle(clkdm);
464 return 0;
465 }
466
467 hwsup = omap4_cminst_is_clkdm_in_hwsup(clkdm->prcm_partition,
468 clkdm->cm_inst, clkdm->clkdm_offs);
469
470 if (!hwsup && (clkdm->flags & CLKDM_CAN_FORCE_SLEEP))
471 omap4_clkdm_sleep(clkdm);
472
473 return 0;
474 }
475
476 static u32 omap4_cminst_xlate_clkctrl(u8 part, u16 inst, u16 offset)
477 {
478 return _cm_bases[part].pa + inst + offset;
479 }
480
481
482
483
484
485
486
487 static int omap4_clkdm_save_context(struct clockdomain *clkdm)
488 {
489 clkdm->context = omap4_cminst_read_inst_reg(clkdm->prcm_partition,
490 clkdm->cm_inst,
491 clkdm->clkdm_offs +
492 OMAP4_CM_CLKSTCTRL);
493 clkdm->context &= OMAP4430_MODULEMODE_MASK;
494 return 0;
495 }
496
497
498
499
500
501
502
503 static int omap4_clkdm_restore_context(struct clockdomain *clkdm)
504 {
505 switch (clkdm->context) {
506 case OMAP34XX_CLKSTCTRL_DISABLE_AUTO:
507 omap4_clkdm_deny_idle(clkdm);
508 break;
509 case OMAP34XX_CLKSTCTRL_FORCE_SLEEP:
510 omap4_clkdm_sleep(clkdm);
511 break;
512 case OMAP34XX_CLKSTCTRL_FORCE_WAKEUP:
513 omap4_clkdm_wakeup(clkdm);
514 break;
515 case OMAP34XX_CLKSTCTRL_ENABLE_AUTO:
516 omap4_clkdm_allow_idle(clkdm);
517 break;
518 }
519 return 0;
520 }
521
522 struct clkdm_ops omap4_clkdm_operations = {
523 .clkdm_add_wkdep = omap4_clkdm_add_wkup_sleep_dep,
524 .clkdm_del_wkdep = omap4_clkdm_del_wkup_sleep_dep,
525 .clkdm_read_wkdep = omap4_clkdm_read_wkup_sleep_dep,
526 .clkdm_clear_all_wkdeps = omap4_clkdm_clear_all_wkup_sleep_deps,
527 .clkdm_add_sleepdep = omap4_clkdm_add_wkup_sleep_dep,
528 .clkdm_del_sleepdep = omap4_clkdm_del_wkup_sleep_dep,
529 .clkdm_read_sleepdep = omap4_clkdm_read_wkup_sleep_dep,
530 .clkdm_clear_all_sleepdeps = omap4_clkdm_clear_all_wkup_sleep_deps,
531 .clkdm_sleep = omap4_clkdm_sleep,
532 .clkdm_wakeup = omap4_clkdm_wakeup,
533 .clkdm_allow_idle = omap4_clkdm_allow_idle,
534 .clkdm_deny_idle = omap4_clkdm_deny_idle,
535 .clkdm_clk_enable = omap4_clkdm_clk_enable,
536 .clkdm_clk_disable = omap4_clkdm_clk_disable,
537 .clkdm_save_context = omap4_clkdm_save_context,
538 .clkdm_restore_context = omap4_clkdm_restore_context,
539 };
540
541 struct clkdm_ops am43xx_clkdm_operations = {
542 .clkdm_sleep = omap4_clkdm_sleep,
543 .clkdm_wakeup = omap4_clkdm_wakeup,
544 .clkdm_allow_idle = omap4_clkdm_allow_idle,
545 .clkdm_deny_idle = omap4_clkdm_deny_idle,
546 .clkdm_clk_enable = omap4_clkdm_clk_enable,
547 .clkdm_clk_disable = omap4_clkdm_clk_disable,
548 };
549
550 static const struct cm_ll_data omap4xxx_cm_ll_data = {
551 .wait_module_ready = &omap4_cminst_wait_module_ready,
552 .wait_module_idle = &omap4_cminst_wait_module_idle,
553 .module_enable = &omap4_cminst_module_enable,
554 .module_disable = &omap4_cminst_module_disable,
555 .xlate_clkctrl = &omap4_cminst_xlate_clkctrl,
556 };
557
558 int __init omap4_cm_init(const struct omap_prcm_init_data *data)
559 {
560 omap_cm_base_init();
561
562 return cm_register(&omap4xxx_cm_ll_data);
563 }
564
565 static void __exit omap4_cm_exit(void)
566 {
567 cm_unregister(&omap4xxx_cm_ll_data);
568 }
569 __exitcall(omap4_cm_exit);