blob: fb3c40b4fbe28dc2c95b3fc7d0c1aae0d0928391 [file] [log] [blame]
Mike Turquetteb24764902012-03-15 23:11:19 -07001/*
2 * Copyright (C) 2010-2011 Canonical Ltd <jeremy.kerr@canonical.com>
3 * Copyright (C) 2011-2012 Linaro Ltd <mturquette@linaro.org>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 *
9 * Standard functionality for the common clock API. See Documentation/clk.txt
10 */
11
12#include <linux/clk-private.h>
13#include <linux/module.h>
14#include <linux/mutex.h>
15#include <linux/spinlock.h>
16#include <linux/err.h>
17#include <linux/list.h>
18#include <linux/slab.h>
Grant Likely766e6a42012-04-09 14:50:06 -050019#include <linux/of.h>
Stephen Boyd46c87732012-09-24 13:38:04 -070020#include <linux/device.h>
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +053021#include <linux/init.h>
Mike Turquette533ddeb2013-03-28 13:59:02 -070022#include <linux/sched.h>
Mike Turquetteb24764902012-03-15 23:11:19 -070023
Sylwester Nawrockid6782c22013-08-23 17:03:43 +020024#include "clk.h"
25
Mike Turquetteb24764902012-03-15 23:11:19 -070026static DEFINE_SPINLOCK(enable_lock);
27static DEFINE_MUTEX(prepare_lock);
28
Mike Turquette533ddeb2013-03-28 13:59:02 -070029static struct task_struct *prepare_owner;
30static struct task_struct *enable_owner;
31
32static int prepare_refcnt;
33static int enable_refcnt;
34
Mike Turquetteb24764902012-03-15 23:11:19 -070035static HLIST_HEAD(clk_root_list);
36static HLIST_HEAD(clk_orphan_list);
37static LIST_HEAD(clk_notifier_list);
38
Mike Turquetteeab89f62013-03-28 13:59:01 -070039/*** locking ***/
40static void clk_prepare_lock(void)
41{
Mike Turquette533ddeb2013-03-28 13:59:02 -070042 if (!mutex_trylock(&prepare_lock)) {
43 if (prepare_owner == current) {
44 prepare_refcnt++;
45 return;
46 }
47 mutex_lock(&prepare_lock);
48 }
49 WARN_ON_ONCE(prepare_owner != NULL);
50 WARN_ON_ONCE(prepare_refcnt != 0);
51 prepare_owner = current;
52 prepare_refcnt = 1;
Mike Turquetteeab89f62013-03-28 13:59:01 -070053}
54
55static void clk_prepare_unlock(void)
56{
Mike Turquette533ddeb2013-03-28 13:59:02 -070057 WARN_ON_ONCE(prepare_owner != current);
58 WARN_ON_ONCE(prepare_refcnt == 0);
59
60 if (--prepare_refcnt)
61 return;
62 prepare_owner = NULL;
Mike Turquetteeab89f62013-03-28 13:59:01 -070063 mutex_unlock(&prepare_lock);
64}
65
66static unsigned long clk_enable_lock(void)
67{
68 unsigned long flags;
Mike Turquette533ddeb2013-03-28 13:59:02 -070069
70 if (!spin_trylock_irqsave(&enable_lock, flags)) {
71 if (enable_owner == current) {
72 enable_refcnt++;
73 return flags;
74 }
75 spin_lock_irqsave(&enable_lock, flags);
76 }
77 WARN_ON_ONCE(enable_owner != NULL);
78 WARN_ON_ONCE(enable_refcnt != 0);
79 enable_owner = current;
80 enable_refcnt = 1;
Mike Turquetteeab89f62013-03-28 13:59:01 -070081 return flags;
82}
83
84static void clk_enable_unlock(unsigned long flags)
85{
Mike Turquette533ddeb2013-03-28 13:59:02 -070086 WARN_ON_ONCE(enable_owner != current);
87 WARN_ON_ONCE(enable_refcnt == 0);
88
89 if (--enable_refcnt)
90 return;
91 enable_owner = NULL;
Mike Turquetteeab89f62013-03-28 13:59:01 -070092 spin_unlock_irqrestore(&enable_lock, flags);
93}
94
Mike Turquetteb24764902012-03-15 23:11:19 -070095/*** debugfs support ***/
96
Mike Turquetteea72dc22013-12-18 21:38:52 -080097#ifdef CONFIG_DEBUG_FS
Mike Turquetteb24764902012-03-15 23:11:19 -070098#include <linux/debugfs.h>
99
100static struct dentry *rootdir;
101static struct dentry *orphandir;
102static int inited = 0;
103
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530104static void clk_summary_show_one(struct seq_file *s, struct clk *c, int level)
105{
106 if (!c)
107 return;
108
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100109 seq_printf(s, "%*s%-*s %-11d %-12d %-10lu %-11lu",
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530110 level * 3 + 1, "",
111 30 - level * 3, c->name,
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100112 c->enable_count, c->prepare_count, clk_get_rate(c),
113 clk_get_accuracy(c));
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530114 seq_printf(s, "\n");
115}
116
117static void clk_summary_show_subtree(struct seq_file *s, struct clk *c,
118 int level)
119{
120 struct clk *child;
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530121
122 if (!c)
123 return;
124
125 clk_summary_show_one(s, c, level);
126
Sasha Levinb67bfe02013-02-27 17:06:00 -0800127 hlist_for_each_entry(child, &c->children, child_node)
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530128 clk_summary_show_subtree(s, child, level + 1);
129}
130
131static int clk_summary_show(struct seq_file *s, void *data)
132{
133 struct clk *c;
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530134
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100135 seq_printf(s, " clock enable_cnt prepare_cnt rate accuracy\n");
136 seq_printf(s, "---------------------------------------------------------------------------------\n");
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530137
Mike Turquetteeab89f62013-03-28 13:59:01 -0700138 clk_prepare_lock();
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530139
Sasha Levinb67bfe02013-02-27 17:06:00 -0800140 hlist_for_each_entry(c, &clk_root_list, child_node)
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530141 clk_summary_show_subtree(s, c, 0);
142
Sasha Levinb67bfe02013-02-27 17:06:00 -0800143 hlist_for_each_entry(c, &clk_orphan_list, child_node)
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530144 clk_summary_show_subtree(s, c, 0);
145
Mike Turquetteeab89f62013-03-28 13:59:01 -0700146 clk_prepare_unlock();
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530147
148 return 0;
149}
150
151
152static int clk_summary_open(struct inode *inode, struct file *file)
153{
154 return single_open(file, clk_summary_show, inode->i_private);
155}
156
157static const struct file_operations clk_summary_fops = {
158 .open = clk_summary_open,
159 .read = seq_read,
160 .llseek = seq_lseek,
161 .release = single_release,
162};
163
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530164static void clk_dump_one(struct seq_file *s, struct clk *c, int level)
165{
166 if (!c)
167 return;
168
169 seq_printf(s, "\"%s\": { ", c->name);
170 seq_printf(s, "\"enable_count\": %d,", c->enable_count);
171 seq_printf(s, "\"prepare_count\": %d,", c->prepare_count);
Peter De Schrijver670decd2013-06-05 18:06:35 +0300172 seq_printf(s, "\"rate\": %lu", clk_get_rate(c));
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100173 seq_printf(s, "\"accuracy\": %lu", clk_get_accuracy(c));
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530174}
175
176static void clk_dump_subtree(struct seq_file *s, struct clk *c, int level)
177{
178 struct clk *child;
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530179
180 if (!c)
181 return;
182
183 clk_dump_one(s, c, level);
184
Sasha Levinb67bfe02013-02-27 17:06:00 -0800185 hlist_for_each_entry(child, &c->children, child_node) {
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530186 seq_printf(s, ",");
187 clk_dump_subtree(s, child, level + 1);
188 }
189
190 seq_printf(s, "}");
191}
192
193static int clk_dump(struct seq_file *s, void *data)
194{
195 struct clk *c;
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530196 bool first_node = true;
197
198 seq_printf(s, "{");
199
Mike Turquetteeab89f62013-03-28 13:59:01 -0700200 clk_prepare_lock();
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530201
Sasha Levinb67bfe02013-02-27 17:06:00 -0800202 hlist_for_each_entry(c, &clk_root_list, child_node) {
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530203 if (!first_node)
204 seq_printf(s, ",");
205 first_node = false;
206 clk_dump_subtree(s, c, 0);
207 }
208
Sasha Levinb67bfe02013-02-27 17:06:00 -0800209 hlist_for_each_entry(c, &clk_orphan_list, child_node) {
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530210 seq_printf(s, ",");
211 clk_dump_subtree(s, c, 0);
212 }
213
Mike Turquetteeab89f62013-03-28 13:59:01 -0700214 clk_prepare_unlock();
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530215
216 seq_printf(s, "}");
217 return 0;
218}
219
220
221static int clk_dump_open(struct inode *inode, struct file *file)
222{
223 return single_open(file, clk_dump, inode->i_private);
224}
225
226static const struct file_operations clk_dump_fops = {
227 .open = clk_dump_open,
228 .read = seq_read,
229 .llseek = seq_lseek,
230 .release = single_release,
231};
232
Mike Turquetteb24764902012-03-15 23:11:19 -0700233/* caller must hold prepare_lock */
234static int clk_debug_create_one(struct clk *clk, struct dentry *pdentry)
235{
236 struct dentry *d;
237 int ret = -ENOMEM;
238
239 if (!clk || !pdentry) {
240 ret = -EINVAL;
241 goto out;
242 }
243
244 d = debugfs_create_dir(clk->name, pdentry);
245 if (!d)
246 goto out;
247
248 clk->dentry = d;
249
250 d = debugfs_create_u32("clk_rate", S_IRUGO, clk->dentry,
251 (u32 *)&clk->rate);
252 if (!d)
253 goto err_out;
254
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100255 d = debugfs_create_u32("clk_accuracy", S_IRUGO, clk->dentry,
256 (u32 *)&clk->accuracy);
257 if (!d)
258 goto err_out;
259
Mike Turquetteb24764902012-03-15 23:11:19 -0700260 d = debugfs_create_x32("clk_flags", S_IRUGO, clk->dentry,
261 (u32 *)&clk->flags);
262 if (!d)
263 goto err_out;
264
265 d = debugfs_create_u32("clk_prepare_count", S_IRUGO, clk->dentry,
266 (u32 *)&clk->prepare_count);
267 if (!d)
268 goto err_out;
269
270 d = debugfs_create_u32("clk_enable_count", S_IRUGO, clk->dentry,
271 (u32 *)&clk->enable_count);
272 if (!d)
273 goto err_out;
274
275 d = debugfs_create_u32("clk_notifier_count", S_IRUGO, clk->dentry,
276 (u32 *)&clk->notifier_count);
277 if (!d)
278 goto err_out;
279
280 ret = 0;
281 goto out;
282
283err_out:
Alex Elderb5f98e62013-11-27 09:39:49 -0600284 debugfs_remove_recursive(clk->dentry);
285 clk->dentry = NULL;
Mike Turquetteb24764902012-03-15 23:11:19 -0700286out:
287 return ret;
288}
289
290/* caller must hold prepare_lock */
291static int clk_debug_create_subtree(struct clk *clk, struct dentry *pdentry)
292{
293 struct clk *child;
Mike Turquetteb24764902012-03-15 23:11:19 -0700294 int ret = -EINVAL;;
295
296 if (!clk || !pdentry)
297 goto out;
298
299 ret = clk_debug_create_one(clk, pdentry);
300
301 if (ret)
302 goto out;
303
Sasha Levinb67bfe02013-02-27 17:06:00 -0800304 hlist_for_each_entry(child, &clk->children, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -0700305 clk_debug_create_subtree(child, clk->dentry);
306
307 ret = 0;
308out:
309 return ret;
310}
311
312/**
313 * clk_debug_register - add a clk node to the debugfs clk tree
314 * @clk: the clk being added to the debugfs clk tree
315 *
316 * Dynamically adds a clk to the debugfs clk tree if debugfs has been
317 * initialized. Otherwise it bails out early since the debugfs clk tree
318 * will be created lazily by clk_debug_init as part of a late_initcall.
319 *
320 * Caller must hold prepare_lock. Only clk_init calls this function (so
321 * far) so this is taken care.
322 */
323static int clk_debug_register(struct clk *clk)
324{
325 struct clk *parent;
326 struct dentry *pdentry;
327 int ret = 0;
328
329 if (!inited)
330 goto out;
331
332 parent = clk->parent;
333
334 /*
335 * Check to see if a clk is a root clk. Also check that it is
336 * safe to add this clk to debugfs
337 */
338 if (!parent)
339 if (clk->flags & CLK_IS_ROOT)
340 pdentry = rootdir;
341 else
342 pdentry = orphandir;
343 else
344 if (parent->dentry)
345 pdentry = parent->dentry;
346 else
347 goto out;
348
349 ret = clk_debug_create_subtree(clk, pdentry);
350
351out:
352 return ret;
353}
354
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +0200355 /**
356 * clk_debug_unregister - remove a clk node from the debugfs clk tree
357 * @clk: the clk being removed from the debugfs clk tree
358 *
359 * Dynamically removes a clk and all it's children clk nodes from the
360 * debugfs clk tree if clk->dentry points to debugfs created by
361 * clk_debug_register in __clk_init.
362 *
363 * Caller must hold prepare_lock.
364 */
365static void clk_debug_unregister(struct clk *clk)
366{
367 debugfs_remove_recursive(clk->dentry);
368}
369
Mike Turquetteb24764902012-03-15 23:11:19 -0700370/**
Ulf Hanssonb33d2122013-04-02 23:09:37 +0200371 * clk_debug_reparent - reparent clk node in the debugfs clk tree
372 * @clk: the clk being reparented
373 * @new_parent: the new clk parent, may be NULL
374 *
375 * Rename clk entry in the debugfs clk tree if debugfs has been
376 * initialized. Otherwise it bails out early since the debugfs clk tree
377 * will be created lazily by clk_debug_init as part of a late_initcall.
378 *
379 * Caller must hold prepare_lock.
380 */
381static void clk_debug_reparent(struct clk *clk, struct clk *new_parent)
382{
383 struct dentry *d;
384 struct dentry *new_parent_d;
385
386 if (!inited)
387 return;
388
389 if (new_parent)
390 new_parent_d = new_parent->dentry;
391 else
392 new_parent_d = orphandir;
393
394 d = debugfs_rename(clk->dentry->d_parent, clk->dentry,
395 new_parent_d, clk->name);
396 if (d)
397 clk->dentry = d;
398 else
399 pr_debug("%s: failed to rename debugfs entry for %s\n",
400 __func__, clk->name);
401}
402
403/**
Mike Turquetteb24764902012-03-15 23:11:19 -0700404 * clk_debug_init - lazily create the debugfs clk tree visualization
405 *
406 * clks are often initialized very early during boot before memory can
407 * be dynamically allocated and well before debugfs is setup.
408 * clk_debug_init walks the clk tree hierarchy while holding
409 * prepare_lock and creates the topology as part of a late_initcall,
410 * thus insuring that clks initialized very early will still be
411 * represented in the debugfs clk tree. This function should only be
412 * called once at boot-time, and all other clks added dynamically will
413 * be done so with clk_debug_register.
414 */
415static int __init clk_debug_init(void)
416{
417 struct clk *clk;
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530418 struct dentry *d;
Mike Turquetteb24764902012-03-15 23:11:19 -0700419
420 rootdir = debugfs_create_dir("clk", NULL);
421
422 if (!rootdir)
423 return -ENOMEM;
424
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530425 d = debugfs_create_file("clk_summary", S_IRUGO, rootdir, NULL,
426 &clk_summary_fops);
427 if (!d)
428 return -ENOMEM;
429
Prashant Gaikwadbddca892012-12-26 19:16:23 +0530430 d = debugfs_create_file("clk_dump", S_IRUGO, rootdir, NULL,
431 &clk_dump_fops);
432 if (!d)
433 return -ENOMEM;
434
Mike Turquetteb24764902012-03-15 23:11:19 -0700435 orphandir = debugfs_create_dir("orphans", rootdir);
436
437 if (!orphandir)
438 return -ENOMEM;
439
Mike Turquetteeab89f62013-03-28 13:59:01 -0700440 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700441
Sasha Levinb67bfe02013-02-27 17:06:00 -0800442 hlist_for_each_entry(clk, &clk_root_list, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -0700443 clk_debug_create_subtree(clk, rootdir);
444
Sasha Levinb67bfe02013-02-27 17:06:00 -0800445 hlist_for_each_entry(clk, &clk_orphan_list, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -0700446 clk_debug_create_subtree(clk, orphandir);
447
448 inited = 1;
449
Mike Turquetteeab89f62013-03-28 13:59:01 -0700450 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700451
452 return 0;
453}
454late_initcall(clk_debug_init);
455#else
456static inline int clk_debug_register(struct clk *clk) { return 0; }
Ulf Hanssonb33d2122013-04-02 23:09:37 +0200457static inline void clk_debug_reparent(struct clk *clk, struct clk *new_parent)
458{
459}
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +0200460static inline void clk_debug_unregister(struct clk *clk)
461{
462}
Mike Turquette70d347e2012-03-26 11:53:47 -0700463#endif
Mike Turquetteb24764902012-03-15 23:11:19 -0700464
Mike Turquetteb24764902012-03-15 23:11:19 -0700465/* caller must hold prepare_lock */
Ulf Hansson1c155b32013-03-12 20:26:03 +0100466static void clk_unprepare_unused_subtree(struct clk *clk)
467{
468 struct clk *child;
469
470 if (!clk)
471 return;
472
473 hlist_for_each_entry(child, &clk->children, child_node)
474 clk_unprepare_unused_subtree(child);
475
476 if (clk->prepare_count)
477 return;
478
479 if (clk->flags & CLK_IGNORE_UNUSED)
480 return;
481
Ulf Hansson3cc82472013-03-12 20:26:04 +0100482 if (__clk_is_prepared(clk)) {
483 if (clk->ops->unprepare_unused)
484 clk->ops->unprepare_unused(clk->hw);
485 else if (clk->ops->unprepare)
Ulf Hansson1c155b32013-03-12 20:26:03 +0100486 clk->ops->unprepare(clk->hw);
Ulf Hansson3cc82472013-03-12 20:26:04 +0100487 }
Ulf Hansson1c155b32013-03-12 20:26:03 +0100488}
489
490/* caller must hold prepare_lock */
Mike Turquetteb24764902012-03-15 23:11:19 -0700491static void clk_disable_unused_subtree(struct clk *clk)
492{
493 struct clk *child;
Mike Turquetteb24764902012-03-15 23:11:19 -0700494 unsigned long flags;
495
496 if (!clk)
497 goto out;
498
Sasha Levinb67bfe02013-02-27 17:06:00 -0800499 hlist_for_each_entry(child, &clk->children, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -0700500 clk_disable_unused_subtree(child);
501
Mike Turquetteeab89f62013-03-28 13:59:01 -0700502 flags = clk_enable_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700503
504 if (clk->enable_count)
505 goto unlock_out;
506
507 if (clk->flags & CLK_IGNORE_UNUSED)
508 goto unlock_out;
509
Mike Turquette7c045a52012-12-04 11:00:35 -0800510 /*
511 * some gate clocks have special needs during the disable-unused
512 * sequence. call .disable_unused if available, otherwise fall
513 * back to .disable
514 */
515 if (__clk_is_enabled(clk)) {
516 if (clk->ops->disable_unused)
517 clk->ops->disable_unused(clk->hw);
518 else if (clk->ops->disable)
519 clk->ops->disable(clk->hw);
520 }
Mike Turquetteb24764902012-03-15 23:11:19 -0700521
522unlock_out:
Mike Turquetteeab89f62013-03-28 13:59:01 -0700523 clk_enable_unlock(flags);
Mike Turquetteb24764902012-03-15 23:11:19 -0700524
525out:
526 return;
527}
528
Olof Johansson1e435252013-04-27 14:10:18 -0700529static bool clk_ignore_unused;
530static int __init clk_ignore_unused_setup(char *__unused)
531{
532 clk_ignore_unused = true;
533 return 1;
534}
535__setup("clk_ignore_unused", clk_ignore_unused_setup);
536
Mike Turquetteb24764902012-03-15 23:11:19 -0700537static int clk_disable_unused(void)
538{
539 struct clk *clk;
Mike Turquetteb24764902012-03-15 23:11:19 -0700540
Olof Johansson1e435252013-04-27 14:10:18 -0700541 if (clk_ignore_unused) {
542 pr_warn("clk: Not disabling unused clocks\n");
543 return 0;
544 }
545
Mike Turquetteeab89f62013-03-28 13:59:01 -0700546 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700547
Sasha Levinb67bfe02013-02-27 17:06:00 -0800548 hlist_for_each_entry(clk, &clk_root_list, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -0700549 clk_disable_unused_subtree(clk);
550
Sasha Levinb67bfe02013-02-27 17:06:00 -0800551 hlist_for_each_entry(clk, &clk_orphan_list, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -0700552 clk_disable_unused_subtree(clk);
553
Ulf Hansson1c155b32013-03-12 20:26:03 +0100554 hlist_for_each_entry(clk, &clk_root_list, child_node)
555 clk_unprepare_unused_subtree(clk);
556
557 hlist_for_each_entry(clk, &clk_orphan_list, child_node)
558 clk_unprepare_unused_subtree(clk);
559
Mike Turquetteeab89f62013-03-28 13:59:01 -0700560 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700561
562 return 0;
563}
Saravana Kannand41d5802013-05-09 11:35:01 -0700564late_initcall_sync(clk_disable_unused);
Mike Turquetteb24764902012-03-15 23:11:19 -0700565
566/*** helper functions ***/
567
Russ Dill65800b22012-11-26 11:20:09 -0800568const char *__clk_get_name(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700569{
570 return !clk ? NULL : clk->name;
571}
Niels de Vos48950842012-12-13 13:12:25 +0100572EXPORT_SYMBOL_GPL(__clk_get_name);
Mike Turquetteb24764902012-03-15 23:11:19 -0700573
Russ Dill65800b22012-11-26 11:20:09 -0800574struct clk_hw *__clk_get_hw(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700575{
576 return !clk ? NULL : clk->hw;
577}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800578EXPORT_SYMBOL_GPL(__clk_get_hw);
Mike Turquetteb24764902012-03-15 23:11:19 -0700579
Russ Dill65800b22012-11-26 11:20:09 -0800580u8 __clk_get_num_parents(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700581{
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700582 return !clk ? 0 : clk->num_parents;
Mike Turquetteb24764902012-03-15 23:11:19 -0700583}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800584EXPORT_SYMBOL_GPL(__clk_get_num_parents);
Mike Turquetteb24764902012-03-15 23:11:19 -0700585
Russ Dill65800b22012-11-26 11:20:09 -0800586struct clk *__clk_get_parent(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700587{
588 return !clk ? NULL : clk->parent;
589}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800590EXPORT_SYMBOL_GPL(__clk_get_parent);
Mike Turquetteb24764902012-03-15 23:11:19 -0700591
James Hogan7ef3dcc2013-07-29 12:24:58 +0100592struct clk *clk_get_parent_by_index(struct clk *clk, u8 index)
593{
594 if (!clk || index >= clk->num_parents)
595 return NULL;
596 else if (!clk->parents)
597 return __clk_lookup(clk->parent_names[index]);
598 else if (!clk->parents[index])
599 return clk->parents[index] =
600 __clk_lookup(clk->parent_names[index]);
601 else
602 return clk->parents[index];
603}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800604EXPORT_SYMBOL_GPL(clk_get_parent_by_index);
James Hogan7ef3dcc2013-07-29 12:24:58 +0100605
Russ Dill65800b22012-11-26 11:20:09 -0800606unsigned int __clk_get_enable_count(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700607{
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700608 return !clk ? 0 : clk->enable_count;
Mike Turquetteb24764902012-03-15 23:11:19 -0700609}
610
Russ Dill65800b22012-11-26 11:20:09 -0800611unsigned int __clk_get_prepare_count(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700612{
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700613 return !clk ? 0 : clk->prepare_count;
Mike Turquetteb24764902012-03-15 23:11:19 -0700614}
615
616unsigned long __clk_get_rate(struct clk *clk)
617{
618 unsigned long ret;
619
620 if (!clk) {
Rajendra Nayak34e44fe2012-03-26 19:01:48 +0530621 ret = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -0700622 goto out;
623 }
624
625 ret = clk->rate;
626
627 if (clk->flags & CLK_IS_ROOT)
628 goto out;
629
630 if (!clk->parent)
Rajendra Nayak34e44fe2012-03-26 19:01:48 +0530631 ret = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -0700632
633out:
634 return ret;
635}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800636EXPORT_SYMBOL_GPL(__clk_get_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -0700637
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100638unsigned long __clk_get_accuracy(struct clk *clk)
639{
640 if (!clk)
641 return 0;
642
643 return clk->accuracy;
644}
645
Russ Dill65800b22012-11-26 11:20:09 -0800646unsigned long __clk_get_flags(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700647{
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700648 return !clk ? 0 : clk->flags;
Mike Turquetteb24764902012-03-15 23:11:19 -0700649}
Thierry Redingb05c6832013-09-03 09:43:51 +0200650EXPORT_SYMBOL_GPL(__clk_get_flags);
Mike Turquetteb24764902012-03-15 23:11:19 -0700651
Ulf Hansson3d6ee282013-03-12 20:26:02 +0100652bool __clk_is_prepared(struct clk *clk)
653{
654 int ret;
655
656 if (!clk)
657 return false;
658
659 /*
660 * .is_prepared is optional for clocks that can prepare
661 * fall back to software usage counter if it is missing
662 */
663 if (!clk->ops->is_prepared) {
664 ret = clk->prepare_count ? 1 : 0;
665 goto out;
666 }
667
668 ret = clk->ops->is_prepared(clk->hw);
669out:
670 return !!ret;
671}
672
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700673bool __clk_is_enabled(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700674{
675 int ret;
676
677 if (!clk)
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700678 return false;
Mike Turquetteb24764902012-03-15 23:11:19 -0700679
680 /*
681 * .is_enabled is only mandatory for clocks that gate
682 * fall back to software usage counter if .is_enabled is missing
683 */
684 if (!clk->ops->is_enabled) {
685 ret = clk->enable_count ? 1 : 0;
686 goto out;
687 }
688
689 ret = clk->ops->is_enabled(clk->hw);
690out:
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700691 return !!ret;
Mike Turquetteb24764902012-03-15 23:11:19 -0700692}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800693EXPORT_SYMBOL_GPL(__clk_is_enabled);
Mike Turquetteb24764902012-03-15 23:11:19 -0700694
695static struct clk *__clk_lookup_subtree(const char *name, struct clk *clk)
696{
697 struct clk *child;
698 struct clk *ret;
Mike Turquetteb24764902012-03-15 23:11:19 -0700699
700 if (!strcmp(clk->name, name))
701 return clk;
702
Sasha Levinb67bfe02013-02-27 17:06:00 -0800703 hlist_for_each_entry(child, &clk->children, child_node) {
Mike Turquetteb24764902012-03-15 23:11:19 -0700704 ret = __clk_lookup_subtree(name, child);
705 if (ret)
706 return ret;
707 }
708
709 return NULL;
710}
711
712struct clk *__clk_lookup(const char *name)
713{
714 struct clk *root_clk;
715 struct clk *ret;
Mike Turquetteb24764902012-03-15 23:11:19 -0700716
717 if (!name)
718 return NULL;
719
720 /* search the 'proper' clk tree first */
Sasha Levinb67bfe02013-02-27 17:06:00 -0800721 hlist_for_each_entry(root_clk, &clk_root_list, child_node) {
Mike Turquetteb24764902012-03-15 23:11:19 -0700722 ret = __clk_lookup_subtree(name, root_clk);
723 if (ret)
724 return ret;
725 }
726
727 /* if not found, then search the orphan tree */
Sasha Levinb67bfe02013-02-27 17:06:00 -0800728 hlist_for_each_entry(root_clk, &clk_orphan_list, child_node) {
Mike Turquetteb24764902012-03-15 23:11:19 -0700729 ret = __clk_lookup_subtree(name, root_clk);
730 if (ret)
731 return ret;
732 }
733
734 return NULL;
735}
736
James Hogane366fdd2013-07-29 12:25:02 +0100737/*
738 * Helper for finding best parent to provide a given frequency. This can be used
739 * directly as a determine_rate callback (e.g. for a mux), or from a more
740 * complex clock that may combine a mux with other operations.
741 */
742long __clk_mux_determine_rate(struct clk_hw *hw, unsigned long rate,
743 unsigned long *best_parent_rate,
744 struct clk **best_parent_p)
745{
746 struct clk *clk = hw->clk, *parent, *best_parent = NULL;
747 int i, num_parents;
748 unsigned long parent_rate, best = 0;
749
750 /* if NO_REPARENT flag set, pass through to current parent */
751 if (clk->flags & CLK_SET_RATE_NO_REPARENT) {
752 parent = clk->parent;
753 if (clk->flags & CLK_SET_RATE_PARENT)
754 best = __clk_round_rate(parent, rate);
755 else if (parent)
756 best = __clk_get_rate(parent);
757 else
758 best = __clk_get_rate(clk);
759 goto out;
760 }
761
762 /* find the parent that can provide the fastest rate <= rate */
763 num_parents = clk->num_parents;
764 for (i = 0; i < num_parents; i++) {
765 parent = clk_get_parent_by_index(clk, i);
766 if (!parent)
767 continue;
768 if (clk->flags & CLK_SET_RATE_PARENT)
769 parent_rate = __clk_round_rate(parent, rate);
770 else
771 parent_rate = __clk_get_rate(parent);
772 if (parent_rate <= rate && parent_rate > best) {
773 best_parent = parent;
774 best = parent_rate;
775 }
776 }
777
778out:
779 if (best_parent)
780 *best_parent_p = best_parent;
781 *best_parent_rate = best;
782
783 return best;
784}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800785EXPORT_SYMBOL_GPL(__clk_mux_determine_rate);
James Hogane366fdd2013-07-29 12:25:02 +0100786
Mike Turquetteb24764902012-03-15 23:11:19 -0700787/*** clk api ***/
788
789void __clk_unprepare(struct clk *clk)
790{
791 if (!clk)
792 return;
793
794 if (WARN_ON(clk->prepare_count == 0))
795 return;
796
797 if (--clk->prepare_count > 0)
798 return;
799
800 WARN_ON(clk->enable_count > 0);
801
802 if (clk->ops->unprepare)
803 clk->ops->unprepare(clk->hw);
804
805 __clk_unprepare(clk->parent);
806}
807
808/**
809 * clk_unprepare - undo preparation of a clock source
Peter Meerwald24ee1a02013-06-29 15:14:19 +0200810 * @clk: the clk being unprepared
Mike Turquetteb24764902012-03-15 23:11:19 -0700811 *
812 * clk_unprepare may sleep, which differentiates it from clk_disable. In a
813 * simple case, clk_unprepare can be used instead of clk_disable to gate a clk
814 * if the operation may sleep. One example is a clk which is accessed over
815 * I2c. In the complex case a clk gate operation may require a fast and a slow
816 * part. It is this reason that clk_unprepare and clk_disable are not mutually
817 * exclusive. In fact clk_disable must be called before clk_unprepare.
818 */
819void clk_unprepare(struct clk *clk)
820{
Mike Turquetteeab89f62013-03-28 13:59:01 -0700821 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700822 __clk_unprepare(clk);
Mike Turquetteeab89f62013-03-28 13:59:01 -0700823 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700824}
825EXPORT_SYMBOL_GPL(clk_unprepare);
826
827int __clk_prepare(struct clk *clk)
828{
829 int ret = 0;
830
831 if (!clk)
832 return 0;
833
834 if (clk->prepare_count == 0) {
835 ret = __clk_prepare(clk->parent);
836 if (ret)
837 return ret;
838
839 if (clk->ops->prepare) {
840 ret = clk->ops->prepare(clk->hw);
841 if (ret) {
842 __clk_unprepare(clk->parent);
843 return ret;
844 }
845 }
846 }
847
848 clk->prepare_count++;
849
850 return 0;
851}
852
853/**
854 * clk_prepare - prepare a clock source
855 * @clk: the clk being prepared
856 *
857 * clk_prepare may sleep, which differentiates it from clk_enable. In a simple
858 * case, clk_prepare can be used instead of clk_enable to ungate a clk if the
859 * operation may sleep. One example is a clk which is accessed over I2c. In
860 * the complex case a clk ungate operation may require a fast and a slow part.
861 * It is this reason that clk_prepare and clk_enable are not mutually
862 * exclusive. In fact clk_prepare must be called before clk_enable.
863 * Returns 0 on success, -EERROR otherwise.
864 */
865int clk_prepare(struct clk *clk)
866{
867 int ret;
868
Mike Turquetteeab89f62013-03-28 13:59:01 -0700869 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700870 ret = __clk_prepare(clk);
Mike Turquetteeab89f62013-03-28 13:59:01 -0700871 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700872
873 return ret;
874}
875EXPORT_SYMBOL_GPL(clk_prepare);
876
877static void __clk_disable(struct clk *clk)
878{
879 if (!clk)
880 return;
881
Fengguang Wue47c6a32012-07-30 14:39:54 -0700882 if (WARN_ON(IS_ERR(clk)))
883 return;
884
Mike Turquetteb24764902012-03-15 23:11:19 -0700885 if (WARN_ON(clk->enable_count == 0))
886 return;
887
888 if (--clk->enable_count > 0)
889 return;
890
891 if (clk->ops->disable)
892 clk->ops->disable(clk->hw);
893
894 __clk_disable(clk->parent);
895}
896
897/**
898 * clk_disable - gate a clock
899 * @clk: the clk being gated
900 *
901 * clk_disable must not sleep, which differentiates it from clk_unprepare. In
902 * a simple case, clk_disable can be used instead of clk_unprepare to gate a
903 * clk if the operation is fast and will never sleep. One example is a
904 * SoC-internal clk which is controlled via simple register writes. In the
905 * complex case a clk gate operation may require a fast and a slow part. It is
906 * this reason that clk_unprepare and clk_disable are not mutually exclusive.
907 * In fact clk_disable must be called before clk_unprepare.
908 */
909void clk_disable(struct clk *clk)
910{
911 unsigned long flags;
912
Mike Turquetteeab89f62013-03-28 13:59:01 -0700913 flags = clk_enable_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700914 __clk_disable(clk);
Mike Turquetteeab89f62013-03-28 13:59:01 -0700915 clk_enable_unlock(flags);
Mike Turquetteb24764902012-03-15 23:11:19 -0700916}
917EXPORT_SYMBOL_GPL(clk_disable);
918
919static int __clk_enable(struct clk *clk)
920{
921 int ret = 0;
922
923 if (!clk)
924 return 0;
925
926 if (WARN_ON(clk->prepare_count == 0))
927 return -ESHUTDOWN;
928
929 if (clk->enable_count == 0) {
930 ret = __clk_enable(clk->parent);
931
932 if (ret)
933 return ret;
934
935 if (clk->ops->enable) {
936 ret = clk->ops->enable(clk->hw);
937 if (ret) {
938 __clk_disable(clk->parent);
939 return ret;
940 }
941 }
942 }
943
944 clk->enable_count++;
945 return 0;
946}
947
948/**
949 * clk_enable - ungate a clock
950 * @clk: the clk being ungated
951 *
952 * clk_enable must not sleep, which differentiates it from clk_prepare. In a
953 * simple case, clk_enable can be used instead of clk_prepare to ungate a clk
954 * if the operation will never sleep. One example is a SoC-internal clk which
955 * is controlled via simple register writes. In the complex case a clk ungate
956 * operation may require a fast and a slow part. It is this reason that
957 * clk_enable and clk_prepare are not mutually exclusive. In fact clk_prepare
958 * must be called before clk_enable. Returns 0 on success, -EERROR
959 * otherwise.
960 */
961int clk_enable(struct clk *clk)
962{
963 unsigned long flags;
964 int ret;
965
Mike Turquetteeab89f62013-03-28 13:59:01 -0700966 flags = clk_enable_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -0700967 ret = __clk_enable(clk);
Mike Turquetteeab89f62013-03-28 13:59:01 -0700968 clk_enable_unlock(flags);
Mike Turquetteb24764902012-03-15 23:11:19 -0700969
970 return ret;
971}
972EXPORT_SYMBOL_GPL(clk_enable);
973
974/**
Mike Turquetteb24764902012-03-15 23:11:19 -0700975 * __clk_round_rate - round the given rate for a clk
976 * @clk: round the rate of this clock
Peter Meerwald24ee1a02013-06-29 15:14:19 +0200977 * @rate: the rate which is to be rounded
Mike Turquetteb24764902012-03-15 23:11:19 -0700978 *
979 * Caller must hold prepare_lock. Useful for clk_ops such as .set_rate
980 */
981unsigned long __clk_round_rate(struct clk *clk, unsigned long rate)
982{
Shawn Guo81536e02012-04-12 20:50:17 +0800983 unsigned long parent_rate = 0;
James Hogan71472c02013-07-29 12:25:00 +0100984 struct clk *parent;
Mike Turquetteb24764902012-03-15 23:11:19 -0700985
986 if (!clk)
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700987 return 0;
Mike Turquetteb24764902012-03-15 23:11:19 -0700988
James Hogan71472c02013-07-29 12:25:00 +0100989 parent = clk->parent;
990 if (parent)
991 parent_rate = parent->rate;
Mike Turquetteb24764902012-03-15 23:11:19 -0700992
James Hogan71472c02013-07-29 12:25:00 +0100993 if (clk->ops->determine_rate)
994 return clk->ops->determine_rate(clk->hw, rate, &parent_rate,
995 &parent);
996 else if (clk->ops->round_rate)
997 return clk->ops->round_rate(clk->hw, rate, &parent_rate);
998 else if (clk->flags & CLK_SET_RATE_PARENT)
999 return __clk_round_rate(clk->parent, rate);
1000 else
1001 return clk->rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07001002}
1003
1004/**
1005 * clk_round_rate - round the given rate for a clk
1006 * @clk: the clk for which we are rounding a rate
1007 * @rate: the rate which is to be rounded
1008 *
1009 * Takes in a rate as input and rounds it to a rate that the clk can actually
1010 * use which is then returned. If clk doesn't support round_rate operation
1011 * then the parent rate is returned.
1012 */
1013long clk_round_rate(struct clk *clk, unsigned long rate)
1014{
1015 unsigned long ret;
1016
Mike Turquetteeab89f62013-03-28 13:59:01 -07001017 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001018 ret = __clk_round_rate(clk, rate);
Mike Turquetteeab89f62013-03-28 13:59:01 -07001019 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001020
1021 return ret;
1022}
1023EXPORT_SYMBOL_GPL(clk_round_rate);
1024
1025/**
1026 * __clk_notify - call clk notifier chain
1027 * @clk: struct clk * that is changing rate
1028 * @msg: clk notifier type (see include/linux/clk.h)
1029 * @old_rate: old clk rate
1030 * @new_rate: new clk rate
1031 *
1032 * Triggers a notifier call chain on the clk rate-change notification
1033 * for 'clk'. Passes a pointer to the struct clk and the previous
1034 * and current rates to the notifier callback. Intended to be called by
1035 * internal clock code only. Returns NOTIFY_DONE from the last driver
1036 * called if all went well, or NOTIFY_STOP or NOTIFY_BAD immediately if
1037 * a driver returns that.
1038 */
1039static int __clk_notify(struct clk *clk, unsigned long msg,
1040 unsigned long old_rate, unsigned long new_rate)
1041{
1042 struct clk_notifier *cn;
1043 struct clk_notifier_data cnd;
1044 int ret = NOTIFY_DONE;
1045
1046 cnd.clk = clk;
1047 cnd.old_rate = old_rate;
1048 cnd.new_rate = new_rate;
1049
1050 list_for_each_entry(cn, &clk_notifier_list, node) {
1051 if (cn->clk == clk) {
1052 ret = srcu_notifier_call_chain(&cn->notifier_head, msg,
1053 &cnd);
1054 break;
1055 }
1056 }
1057
1058 return ret;
1059}
1060
1061/**
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001062 * __clk_recalc_accuracies
1063 * @clk: first clk in the subtree
1064 *
1065 * Walks the subtree of clks starting with clk and recalculates accuracies as
1066 * it goes. Note that if a clk does not implement the .recalc_accuracy
1067 * callback then it is assumed that the clock will take on the accuracy of it's
1068 * parent.
1069 *
1070 * Caller must hold prepare_lock.
1071 */
1072static void __clk_recalc_accuracies(struct clk *clk)
1073{
1074 unsigned long parent_accuracy = 0;
1075 struct clk *child;
1076
1077 if (clk->parent)
1078 parent_accuracy = clk->parent->accuracy;
1079
1080 if (clk->ops->recalc_accuracy)
1081 clk->accuracy = clk->ops->recalc_accuracy(clk->hw,
1082 parent_accuracy);
1083 else
1084 clk->accuracy = parent_accuracy;
1085
1086 hlist_for_each_entry(child, &clk->children, child_node)
1087 __clk_recalc_accuracies(child);
1088}
1089
1090/**
1091 * clk_get_accuracy - return the accuracy of clk
1092 * @clk: the clk whose accuracy is being returned
1093 *
1094 * Simply returns the cached accuracy of the clk, unless
1095 * CLK_GET_ACCURACY_NOCACHE flag is set, which means a recalc_rate will be
1096 * issued.
1097 * If clk is NULL then returns 0.
1098 */
1099long clk_get_accuracy(struct clk *clk)
1100{
1101 unsigned long accuracy;
1102
1103 clk_prepare_lock();
1104 if (clk && (clk->flags & CLK_GET_ACCURACY_NOCACHE))
1105 __clk_recalc_accuracies(clk);
1106
1107 accuracy = __clk_get_accuracy(clk);
1108 clk_prepare_unlock();
1109
1110 return accuracy;
1111}
1112EXPORT_SYMBOL_GPL(clk_get_accuracy);
1113
1114/**
Mike Turquetteb24764902012-03-15 23:11:19 -07001115 * __clk_recalc_rates
1116 * @clk: first clk in the subtree
1117 * @msg: notification type (see include/linux/clk.h)
1118 *
1119 * Walks the subtree of clks starting with clk and recalculates rates as it
1120 * goes. Note that if a clk does not implement the .recalc_rate callback then
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001121 * it is assumed that the clock will take on the rate of its parent.
Mike Turquetteb24764902012-03-15 23:11:19 -07001122 *
1123 * clk_recalc_rates also propagates the POST_RATE_CHANGE notification,
1124 * if necessary.
1125 *
1126 * Caller must hold prepare_lock.
1127 */
1128static void __clk_recalc_rates(struct clk *clk, unsigned long msg)
1129{
1130 unsigned long old_rate;
1131 unsigned long parent_rate = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001132 struct clk *child;
1133
1134 old_rate = clk->rate;
1135
1136 if (clk->parent)
1137 parent_rate = clk->parent->rate;
1138
1139 if (clk->ops->recalc_rate)
1140 clk->rate = clk->ops->recalc_rate(clk->hw, parent_rate);
1141 else
1142 clk->rate = parent_rate;
1143
1144 /*
1145 * ignore NOTIFY_STOP and NOTIFY_BAD return values for POST_RATE_CHANGE
1146 * & ABORT_RATE_CHANGE notifiers
1147 */
1148 if (clk->notifier_count && msg)
1149 __clk_notify(clk, msg, old_rate, clk->rate);
1150
Sasha Levinb67bfe02013-02-27 17:06:00 -08001151 hlist_for_each_entry(child, &clk->children, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -07001152 __clk_recalc_rates(child, msg);
1153}
1154
1155/**
Ulf Hanssona093bde2012-08-31 14:21:28 +02001156 * clk_get_rate - return the rate of clk
1157 * @clk: the clk whose rate is being returned
1158 *
1159 * Simply returns the cached rate of the clk, unless CLK_GET_RATE_NOCACHE flag
1160 * is set, which means a recalc_rate will be issued.
1161 * If clk is NULL then returns 0.
1162 */
1163unsigned long clk_get_rate(struct clk *clk)
1164{
1165 unsigned long rate;
1166
Mike Turquetteeab89f62013-03-28 13:59:01 -07001167 clk_prepare_lock();
Ulf Hanssona093bde2012-08-31 14:21:28 +02001168
1169 if (clk && (clk->flags & CLK_GET_RATE_NOCACHE))
1170 __clk_recalc_rates(clk, 0);
1171
1172 rate = __clk_get_rate(clk);
Mike Turquetteeab89f62013-03-28 13:59:01 -07001173 clk_prepare_unlock();
Ulf Hanssona093bde2012-08-31 14:21:28 +02001174
1175 return rate;
1176}
1177EXPORT_SYMBOL_GPL(clk_get_rate);
1178
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001179static int clk_fetch_parent_index(struct clk *clk, struct clk *parent)
James Hogan4935b222013-07-29 12:24:59 +01001180{
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001181 int i;
James Hogan4935b222013-07-29 12:24:59 +01001182
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001183 if (!clk->parents) {
Tomasz Figa96a7ed92013-09-29 02:37:15 +02001184 clk->parents = kcalloc(clk->num_parents,
1185 sizeof(struct clk *), GFP_KERNEL);
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001186 if (!clk->parents)
1187 return -ENOMEM;
1188 }
James Hogan4935b222013-07-29 12:24:59 +01001189
1190 /*
1191 * find index of new parent clock using cached parent ptrs,
1192 * or if not yet cached, use string name comparison and cache
1193 * them now to avoid future calls to __clk_lookup.
1194 */
1195 for (i = 0; i < clk->num_parents; i++) {
Tomasz Figada0f0b22013-09-29 02:37:16 +02001196 if (clk->parents[i] == parent)
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001197 return i;
Tomasz Figada0f0b22013-09-29 02:37:16 +02001198
1199 if (clk->parents[i])
1200 continue;
1201
1202 if (!strcmp(clk->parent_names[i], parent->name)) {
1203 clk->parents[i] = __clk_lookup(parent->name);
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001204 return i;
James Hogan4935b222013-07-29 12:24:59 +01001205 }
1206 }
1207
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001208 return -EINVAL;
James Hogan4935b222013-07-29 12:24:59 +01001209}
1210
1211static void clk_reparent(struct clk *clk, struct clk *new_parent)
1212{
1213 hlist_del(&clk->child_node);
1214
James Hogan903efc52013-08-29 12:10:51 +01001215 if (new_parent) {
1216 /* avoid duplicate POST_RATE_CHANGE notifications */
1217 if (new_parent->new_child == clk)
1218 new_parent->new_child = NULL;
1219
James Hogan4935b222013-07-29 12:24:59 +01001220 hlist_add_head(&clk->child_node, &new_parent->children);
James Hogan903efc52013-08-29 12:10:51 +01001221 } else {
James Hogan4935b222013-07-29 12:24:59 +01001222 hlist_add_head(&clk->child_node, &clk_orphan_list);
James Hogan903efc52013-08-29 12:10:51 +01001223 }
James Hogan4935b222013-07-29 12:24:59 +01001224
1225 clk->parent = new_parent;
1226}
1227
Stephen Boyd3fa22522014-01-15 10:47:22 -08001228static struct clk *__clk_set_parent_before(struct clk *clk, struct clk *parent)
James Hogan4935b222013-07-29 12:24:59 +01001229{
1230 unsigned long flags;
James Hogan4935b222013-07-29 12:24:59 +01001231 struct clk *old_parent = clk->parent;
1232
1233 /*
1234 * Migrate prepare state between parents and prevent race with
1235 * clk_enable().
1236 *
1237 * If the clock is not prepared, then a race with
1238 * clk_enable/disable() is impossible since we already have the
1239 * prepare lock (future calls to clk_enable() need to be preceded by
1240 * a clk_prepare()).
1241 *
1242 * If the clock is prepared, migrate the prepared state to the new
1243 * parent and also protect against a race with clk_enable() by
1244 * forcing the clock and the new parent on. This ensures that all
1245 * future calls to clk_enable() are practically NOPs with respect to
1246 * hardware and software states.
1247 *
1248 * See also: Comment for clk_set_parent() below.
1249 */
1250 if (clk->prepare_count) {
1251 __clk_prepare(parent);
1252 clk_enable(parent);
1253 clk_enable(clk);
1254 }
1255
1256 /* update the clk tree topology */
1257 flags = clk_enable_lock();
1258 clk_reparent(clk, parent);
1259 clk_enable_unlock(flags);
1260
Stephen Boyd3fa22522014-01-15 10:47:22 -08001261 return old_parent;
1262}
1263
1264static void __clk_set_parent_after(struct clk *clk, struct clk *parent,
1265 struct clk *old_parent)
1266{
1267 /*
1268 * Finish the migration of prepare state and undo the changes done
1269 * for preventing a race with clk_enable().
1270 */
1271 if (clk->prepare_count) {
1272 clk_disable(clk);
1273 clk_disable(old_parent);
1274 __clk_unprepare(old_parent);
1275 }
1276
1277 /* update debugfs with new clk tree topology */
1278 clk_debug_reparent(clk, parent);
1279}
1280
1281static int __clk_set_parent(struct clk *clk, struct clk *parent, u8 p_index)
1282{
1283 unsigned long flags;
1284 int ret = 0;
1285 struct clk *old_parent;
1286
1287 old_parent = __clk_set_parent_before(clk, parent);
1288
James Hogan4935b222013-07-29 12:24:59 +01001289 /* change clock input source */
1290 if (parent && clk->ops->set_parent)
1291 ret = clk->ops->set_parent(clk->hw, p_index);
1292
1293 if (ret) {
1294 flags = clk_enable_lock();
1295 clk_reparent(clk, old_parent);
1296 clk_enable_unlock(flags);
1297
1298 if (clk->prepare_count) {
1299 clk_disable(clk);
1300 clk_disable(parent);
1301 __clk_unprepare(parent);
1302 }
1303 return ret;
1304 }
1305
Stephen Boyd3fa22522014-01-15 10:47:22 -08001306 __clk_set_parent_after(clk, parent, old_parent);
James Hogan4935b222013-07-29 12:24:59 +01001307
James Hogan4935b222013-07-29 12:24:59 +01001308 return 0;
1309}
1310
Ulf Hanssona093bde2012-08-31 14:21:28 +02001311/**
Mike Turquetteb24764902012-03-15 23:11:19 -07001312 * __clk_speculate_rates
1313 * @clk: first clk in the subtree
1314 * @parent_rate: the "future" rate of clk's parent
1315 *
1316 * Walks the subtree of clks starting with clk, speculating rates as it
1317 * goes and firing off PRE_RATE_CHANGE notifications as necessary.
1318 *
1319 * Unlike clk_recalc_rates, clk_speculate_rates exists only for sending
1320 * pre-rate change notifications and returns early if no clks in the
1321 * subtree have subscribed to the notifications. Note that if a clk does not
1322 * implement the .recalc_rate callback then it is assumed that the clock will
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001323 * take on the rate of its parent.
Mike Turquetteb24764902012-03-15 23:11:19 -07001324 *
1325 * Caller must hold prepare_lock.
1326 */
1327static int __clk_speculate_rates(struct clk *clk, unsigned long parent_rate)
1328{
Mike Turquetteb24764902012-03-15 23:11:19 -07001329 struct clk *child;
1330 unsigned long new_rate;
1331 int ret = NOTIFY_DONE;
1332
1333 if (clk->ops->recalc_rate)
1334 new_rate = clk->ops->recalc_rate(clk->hw, parent_rate);
1335 else
1336 new_rate = parent_rate;
1337
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001338 /* abort rate change if a driver returns NOTIFY_BAD or NOTIFY_STOP */
Mike Turquetteb24764902012-03-15 23:11:19 -07001339 if (clk->notifier_count)
1340 ret = __clk_notify(clk, PRE_RATE_CHANGE, clk->rate, new_rate);
1341
Mike Turquette86bcfa22014-02-24 16:08:41 -08001342 if (ret & NOTIFY_STOP_MASK) {
1343 pr_debug("%s: clk notifier callback for clock %s aborted with error %d\n",
1344 __func__, clk->name, ret);
Mike Turquetteb24764902012-03-15 23:11:19 -07001345 goto out;
Mike Turquette86bcfa22014-02-24 16:08:41 -08001346 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001347
Sasha Levinb67bfe02013-02-27 17:06:00 -08001348 hlist_for_each_entry(child, &clk->children, child_node) {
Mike Turquetteb24764902012-03-15 23:11:19 -07001349 ret = __clk_speculate_rates(child, new_rate);
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001350 if (ret & NOTIFY_STOP_MASK)
Mike Turquetteb24764902012-03-15 23:11:19 -07001351 break;
1352 }
1353
1354out:
1355 return ret;
1356}
1357
James Hogan71472c02013-07-29 12:25:00 +01001358static void clk_calc_subtree(struct clk *clk, unsigned long new_rate,
1359 struct clk *new_parent, u8 p_index)
Mike Turquetteb24764902012-03-15 23:11:19 -07001360{
1361 struct clk *child;
Mike Turquetteb24764902012-03-15 23:11:19 -07001362
1363 clk->new_rate = new_rate;
James Hogan71472c02013-07-29 12:25:00 +01001364 clk->new_parent = new_parent;
1365 clk->new_parent_index = p_index;
1366 /* include clk in new parent's PRE_RATE_CHANGE notifications */
1367 clk->new_child = NULL;
1368 if (new_parent && new_parent != clk->parent)
1369 new_parent->new_child = clk;
Mike Turquetteb24764902012-03-15 23:11:19 -07001370
Sasha Levinb67bfe02013-02-27 17:06:00 -08001371 hlist_for_each_entry(child, &clk->children, child_node) {
Mike Turquetteb24764902012-03-15 23:11:19 -07001372 if (child->ops->recalc_rate)
1373 child->new_rate = child->ops->recalc_rate(child->hw, new_rate);
1374 else
1375 child->new_rate = new_rate;
James Hogan71472c02013-07-29 12:25:00 +01001376 clk_calc_subtree(child, child->new_rate, NULL, 0);
Mike Turquetteb24764902012-03-15 23:11:19 -07001377 }
1378}
1379
1380/*
1381 * calculate the new rates returning the topmost clock that has to be
1382 * changed.
1383 */
1384static struct clk *clk_calc_new_rates(struct clk *clk, unsigned long rate)
1385{
1386 struct clk *top = clk;
James Hogan71472c02013-07-29 12:25:00 +01001387 struct clk *old_parent, *parent;
Shawn Guo81536e02012-04-12 20:50:17 +08001388 unsigned long best_parent_rate = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001389 unsigned long new_rate;
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001390 int p_index = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001391
Mike Turquette7452b212012-03-26 14:45:36 -07001392 /* sanity */
1393 if (IS_ERR_OR_NULL(clk))
1394 return NULL;
1395
Mike Turquette63f5c3b2012-05-02 16:23:43 -07001396 /* save parent rate, if it exists */
James Hogan71472c02013-07-29 12:25:00 +01001397 parent = old_parent = clk->parent;
1398 if (parent)
1399 best_parent_rate = parent->rate;
Mike Turquette63f5c3b2012-05-02 16:23:43 -07001400
James Hogan71472c02013-07-29 12:25:00 +01001401 /* find the closest rate and parent clk/rate */
1402 if (clk->ops->determine_rate) {
1403 new_rate = clk->ops->determine_rate(clk->hw, rate,
1404 &best_parent_rate,
1405 &parent);
1406 } else if (clk->ops->round_rate) {
1407 new_rate = clk->ops->round_rate(clk->hw, rate,
1408 &best_parent_rate);
1409 } else if (!parent || !(clk->flags & CLK_SET_RATE_PARENT)) {
1410 /* pass-through clock without adjustable parent */
1411 clk->new_rate = clk->rate;
1412 return NULL;
1413 } else {
1414 /* pass-through clock with adjustable parent */
1415 top = clk_calc_new_rates(parent, rate);
1416 new_rate = parent->new_rate;
Mike Turquette63f5c3b2012-05-02 16:23:43 -07001417 goto out;
Mike Turquette7452b212012-03-26 14:45:36 -07001418 }
1419
James Hogan71472c02013-07-29 12:25:00 +01001420 /* some clocks must be gated to change parent */
1421 if (parent != old_parent &&
1422 (clk->flags & CLK_SET_PARENT_GATE) && clk->prepare_count) {
1423 pr_debug("%s: %s not gated but wants to reparent\n",
1424 __func__, clk->name);
Mike Turquetteb24764902012-03-15 23:11:19 -07001425 return NULL;
1426 }
1427
James Hogan71472c02013-07-29 12:25:00 +01001428 /* try finding the new parent index */
1429 if (parent) {
1430 p_index = clk_fetch_parent_index(clk, parent);
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001431 if (p_index < 0) {
James Hogan71472c02013-07-29 12:25:00 +01001432 pr_debug("%s: clk %s can not be parent of clk %s\n",
1433 __func__, parent->name, clk->name);
1434 return NULL;
1435 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001436 }
1437
James Hogan71472c02013-07-29 12:25:00 +01001438 if ((clk->flags & CLK_SET_RATE_PARENT) && parent &&
1439 best_parent_rate != parent->rate)
1440 top = clk_calc_new_rates(parent, best_parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001441
1442out:
James Hogan71472c02013-07-29 12:25:00 +01001443 clk_calc_subtree(clk, new_rate, parent, p_index);
Mike Turquetteb24764902012-03-15 23:11:19 -07001444
1445 return top;
1446}
1447
1448/*
1449 * Notify about rate changes in a subtree. Always walk down the whole tree
1450 * so that in case of an error we can walk down the whole tree again and
1451 * abort the change.
1452 */
1453static struct clk *clk_propagate_rate_change(struct clk *clk, unsigned long event)
1454{
James Hogan71472c02013-07-29 12:25:00 +01001455 struct clk *child, *tmp_clk, *fail_clk = NULL;
Mike Turquetteb24764902012-03-15 23:11:19 -07001456 int ret = NOTIFY_DONE;
1457
1458 if (clk->rate == clk->new_rate)
Sachin Kamat5fda6852013-03-13 15:17:49 +05301459 return NULL;
Mike Turquetteb24764902012-03-15 23:11:19 -07001460
1461 if (clk->notifier_count) {
1462 ret = __clk_notify(clk, event, clk->rate, clk->new_rate);
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001463 if (ret & NOTIFY_STOP_MASK)
Mike Turquetteb24764902012-03-15 23:11:19 -07001464 fail_clk = clk;
1465 }
1466
Sasha Levinb67bfe02013-02-27 17:06:00 -08001467 hlist_for_each_entry(child, &clk->children, child_node) {
James Hogan71472c02013-07-29 12:25:00 +01001468 /* Skip children who will be reparented to another clock */
1469 if (child->new_parent && child->new_parent != clk)
1470 continue;
1471 tmp_clk = clk_propagate_rate_change(child, event);
1472 if (tmp_clk)
1473 fail_clk = tmp_clk;
1474 }
1475
1476 /* handle the new child who might not be in clk->children yet */
1477 if (clk->new_child) {
1478 tmp_clk = clk_propagate_rate_change(clk->new_child, event);
1479 if (tmp_clk)
1480 fail_clk = tmp_clk;
Mike Turquetteb24764902012-03-15 23:11:19 -07001481 }
1482
1483 return fail_clk;
1484}
1485
1486/*
1487 * walk down a subtree and set the new rates notifying the rate
1488 * change on the way
1489 */
1490static void clk_change_rate(struct clk *clk)
1491{
1492 struct clk *child;
1493 unsigned long old_rate;
Pawel Mollbf47b4f2012-06-08 14:04:06 +01001494 unsigned long best_parent_rate = 0;
Stephen Boyd3fa22522014-01-15 10:47:22 -08001495 bool skip_set_rate = false;
1496 struct clk *old_parent;
Mike Turquetteb24764902012-03-15 23:11:19 -07001497
1498 old_rate = clk->rate;
1499
Stephen Boyd3fa22522014-01-15 10:47:22 -08001500 if (clk->new_parent)
1501 best_parent_rate = clk->new_parent->rate;
1502 else if (clk->parent)
Pawel Mollbf47b4f2012-06-08 14:04:06 +01001503 best_parent_rate = clk->parent->rate;
1504
Stephen Boyd3fa22522014-01-15 10:47:22 -08001505 if (clk->new_parent && clk->new_parent != clk->parent) {
1506 old_parent = __clk_set_parent_before(clk, clk->new_parent);
1507
1508 if (clk->ops->set_rate_and_parent) {
1509 skip_set_rate = true;
1510 clk->ops->set_rate_and_parent(clk->hw, clk->new_rate,
1511 best_parent_rate,
1512 clk->new_parent_index);
1513 } else if (clk->ops->set_parent) {
1514 clk->ops->set_parent(clk->hw, clk->new_parent_index);
1515 }
1516
1517 __clk_set_parent_after(clk, clk->new_parent, old_parent);
1518 }
1519
1520 if (!skip_set_rate && clk->ops->set_rate)
Pawel Mollbf47b4f2012-06-08 14:04:06 +01001521 clk->ops->set_rate(clk->hw, clk->new_rate, best_parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001522
1523 if (clk->ops->recalc_rate)
Pawel Mollbf47b4f2012-06-08 14:04:06 +01001524 clk->rate = clk->ops->recalc_rate(clk->hw, best_parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001525 else
Pawel Mollbf47b4f2012-06-08 14:04:06 +01001526 clk->rate = best_parent_rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07001527
1528 if (clk->notifier_count && old_rate != clk->rate)
1529 __clk_notify(clk, POST_RATE_CHANGE, old_rate, clk->rate);
1530
James Hogan71472c02013-07-29 12:25:00 +01001531 hlist_for_each_entry(child, &clk->children, child_node) {
1532 /* Skip children who will be reparented to another clock */
1533 if (child->new_parent && child->new_parent != clk)
1534 continue;
Mike Turquetteb24764902012-03-15 23:11:19 -07001535 clk_change_rate(child);
James Hogan71472c02013-07-29 12:25:00 +01001536 }
1537
1538 /* handle the new child who might not be in clk->children yet */
1539 if (clk->new_child)
1540 clk_change_rate(clk->new_child);
Mike Turquetteb24764902012-03-15 23:11:19 -07001541}
1542
1543/**
1544 * clk_set_rate - specify a new rate for clk
1545 * @clk: the clk whose rate is being changed
1546 * @rate: the new rate for clk
1547 *
Mike Turquette5654dc92012-03-26 11:51:34 -07001548 * In the simplest case clk_set_rate will only adjust the rate of clk.
Mike Turquetteb24764902012-03-15 23:11:19 -07001549 *
Mike Turquette5654dc92012-03-26 11:51:34 -07001550 * Setting the CLK_SET_RATE_PARENT flag allows the rate change operation to
1551 * propagate up to clk's parent; whether or not this happens depends on the
1552 * outcome of clk's .round_rate implementation. If *parent_rate is unchanged
1553 * after calling .round_rate then upstream parent propagation is ignored. If
1554 * *parent_rate comes back with a new rate for clk's parent then we propagate
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001555 * up to clk's parent and set its rate. Upward propagation will continue
Mike Turquette5654dc92012-03-26 11:51:34 -07001556 * until either a clk does not support the CLK_SET_RATE_PARENT flag or
1557 * .round_rate stops requesting changes to clk's parent_rate.
Mike Turquetteb24764902012-03-15 23:11:19 -07001558 *
Mike Turquette5654dc92012-03-26 11:51:34 -07001559 * Rate changes are accomplished via tree traversal that also recalculates the
1560 * rates for the clocks and fires off POST_RATE_CHANGE notifiers.
Mike Turquetteb24764902012-03-15 23:11:19 -07001561 *
1562 * Returns 0 on success, -EERROR otherwise.
1563 */
1564int clk_set_rate(struct clk *clk, unsigned long rate)
1565{
1566 struct clk *top, *fail_clk;
1567 int ret = 0;
1568
Mike Turquette89ac8d72013-08-21 23:58:09 -07001569 if (!clk)
1570 return 0;
1571
Mike Turquetteb24764902012-03-15 23:11:19 -07001572 /* prevent racing with updates to the clock topology */
Mike Turquetteeab89f62013-03-28 13:59:01 -07001573 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001574
1575 /* bail early if nothing to do */
Peter De Schrijver34e452a2013-06-05 18:06:36 +03001576 if (rate == clk_get_rate(clk))
Mike Turquetteb24764902012-03-15 23:11:19 -07001577 goto out;
1578
Saravana Kannan7e0fa1b2012-05-15 13:43:42 -07001579 if ((clk->flags & CLK_SET_RATE_GATE) && clk->prepare_count) {
Viresh Kumar0e1c0302012-04-11 16:03:42 +05301580 ret = -EBUSY;
1581 goto out;
1582 }
1583
Mike Turquetteb24764902012-03-15 23:11:19 -07001584 /* calculate new rates and get the topmost changed clock */
1585 top = clk_calc_new_rates(clk, rate);
1586 if (!top) {
1587 ret = -EINVAL;
1588 goto out;
1589 }
1590
1591 /* notify that we are about to change rates */
1592 fail_clk = clk_propagate_rate_change(top, PRE_RATE_CHANGE);
1593 if (fail_clk) {
Sascha Hauerf7363862014-01-16 16:12:55 +01001594 pr_debug("%s: failed to set %s rate\n", __func__,
Mike Turquetteb24764902012-03-15 23:11:19 -07001595 fail_clk->name);
1596 clk_propagate_rate_change(top, ABORT_RATE_CHANGE);
1597 ret = -EBUSY;
1598 goto out;
1599 }
1600
1601 /* change the rates */
1602 clk_change_rate(top);
1603
Mike Turquetteb24764902012-03-15 23:11:19 -07001604out:
Mike Turquetteeab89f62013-03-28 13:59:01 -07001605 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001606
1607 return ret;
1608}
1609EXPORT_SYMBOL_GPL(clk_set_rate);
1610
1611/**
1612 * clk_get_parent - return the parent of a clk
1613 * @clk: the clk whose parent gets returned
1614 *
1615 * Simply returns clk->parent. Returns NULL if clk is NULL.
1616 */
1617struct clk *clk_get_parent(struct clk *clk)
1618{
1619 struct clk *parent;
1620
Mike Turquetteeab89f62013-03-28 13:59:01 -07001621 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001622 parent = __clk_get_parent(clk);
Mike Turquetteeab89f62013-03-28 13:59:01 -07001623 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001624
1625 return parent;
1626}
1627EXPORT_SYMBOL_GPL(clk_get_parent);
1628
1629/*
1630 * .get_parent is mandatory for clocks with multiple possible parents. It is
1631 * optional for single-parent clocks. Always call .get_parent if it is
1632 * available and WARN if it is missing for multi-parent clocks.
1633 *
1634 * For single-parent clocks without .get_parent, first check to see if the
1635 * .parents array exists, and if so use it to avoid an expensive tree
1636 * traversal. If .parents does not exist then walk the tree with __clk_lookup.
1637 */
1638static struct clk *__clk_init_parent(struct clk *clk)
1639{
1640 struct clk *ret = NULL;
1641 u8 index;
1642
1643 /* handle the trivial cases */
1644
1645 if (!clk->num_parents)
1646 goto out;
1647
1648 if (clk->num_parents == 1) {
1649 if (IS_ERR_OR_NULL(clk->parent))
1650 ret = clk->parent = __clk_lookup(clk->parent_names[0]);
1651 ret = clk->parent;
1652 goto out;
1653 }
1654
1655 if (!clk->ops->get_parent) {
1656 WARN(!clk->ops->get_parent,
1657 "%s: multi-parent clocks must implement .get_parent\n",
1658 __func__);
1659 goto out;
1660 };
1661
1662 /*
1663 * Do our best to cache parent clocks in clk->parents. This prevents
1664 * unnecessary and expensive calls to __clk_lookup. We don't set
1665 * clk->parent here; that is done by the calling function
1666 */
1667
1668 index = clk->ops->get_parent(clk->hw);
1669
1670 if (!clk->parents)
1671 clk->parents =
Tomasz Figa96a7ed92013-09-29 02:37:15 +02001672 kcalloc(clk->num_parents, sizeof(struct clk *),
Mike Turquetteb24764902012-03-15 23:11:19 -07001673 GFP_KERNEL);
1674
James Hogan7ef3dcc2013-07-29 12:24:58 +01001675 ret = clk_get_parent_by_index(clk, index);
Mike Turquetteb24764902012-03-15 23:11:19 -07001676
1677out:
1678 return ret;
1679}
1680
Ulf Hanssonb33d2122013-04-02 23:09:37 +02001681void __clk_reparent(struct clk *clk, struct clk *new_parent)
1682{
1683 clk_reparent(clk, new_parent);
1684 clk_debug_reparent(clk, new_parent);
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001685 __clk_recalc_accuracies(clk);
Mike Turquetteb24764902012-03-15 23:11:19 -07001686 __clk_recalc_rates(clk, POST_RATE_CHANGE);
1687}
1688
Mike Turquetteb24764902012-03-15 23:11:19 -07001689/**
1690 * clk_set_parent - switch the parent of a mux clk
1691 * @clk: the mux clk whose input we are switching
1692 * @parent: the new input to clk
1693 *
Saravana Kannanf8aa0bd2013-05-15 21:07:24 -07001694 * Re-parent clk to use parent as its new input source. If clk is in
1695 * prepared state, the clk will get enabled for the duration of this call. If
1696 * that's not acceptable for a specific clk (Eg: the consumer can't handle
1697 * that, the reparenting is glitchy in hardware, etc), use the
1698 * CLK_SET_PARENT_GATE flag to allow reparenting only when clk is unprepared.
1699 *
1700 * After successfully changing clk's parent clk_set_parent will update the
1701 * clk topology, sysfs topology and propagate rate recalculation via
1702 * __clk_recalc_rates.
1703 *
1704 * Returns 0 on success, -EERROR otherwise.
Mike Turquetteb24764902012-03-15 23:11:19 -07001705 */
1706int clk_set_parent(struct clk *clk, struct clk *parent)
1707{
1708 int ret = 0;
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001709 int p_index = 0;
Ulf Hansson031dcc92013-04-02 23:09:38 +02001710 unsigned long p_rate = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001711
Mike Turquette89ac8d72013-08-21 23:58:09 -07001712 if (!clk)
1713 return 0;
1714
1715 if (!clk->ops)
Mike Turquetteb24764902012-03-15 23:11:19 -07001716 return -EINVAL;
1717
Ulf Hansson031dcc92013-04-02 23:09:38 +02001718 /* verify ops for for multi-parent clks */
1719 if ((clk->num_parents > 1) && (!clk->ops->set_parent))
Mike Turquetteb24764902012-03-15 23:11:19 -07001720 return -ENOSYS;
1721
1722 /* prevent racing with updates to the clock topology */
Mike Turquetteeab89f62013-03-28 13:59:01 -07001723 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001724
1725 if (clk->parent == parent)
1726 goto out;
1727
Ulf Hansson031dcc92013-04-02 23:09:38 +02001728 /* check that we are allowed to re-parent if the clock is in use */
1729 if ((clk->flags & CLK_SET_PARENT_GATE) && clk->prepare_count) {
1730 ret = -EBUSY;
1731 goto out;
1732 }
1733
1734 /* try finding the new parent index */
1735 if (parent) {
1736 p_index = clk_fetch_parent_index(clk, parent);
1737 p_rate = parent->rate;
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001738 if (p_index < 0) {
Ulf Hansson031dcc92013-04-02 23:09:38 +02001739 pr_debug("%s: clk %s can not be parent of clk %s\n",
1740 __func__, parent->name, clk->name);
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001741 ret = p_index;
Ulf Hansson031dcc92013-04-02 23:09:38 +02001742 goto out;
1743 }
1744 }
1745
Mike Turquetteb24764902012-03-15 23:11:19 -07001746 /* propagate PRE_RATE_CHANGE notifications */
Soren Brinkmannf3aab5d2013-04-16 10:06:50 -07001747 ret = __clk_speculate_rates(clk, p_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001748
1749 /* abort if a driver objects */
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001750 if (ret & NOTIFY_STOP_MASK)
Mike Turquetteb24764902012-03-15 23:11:19 -07001751 goto out;
1752
Ulf Hansson031dcc92013-04-02 23:09:38 +02001753 /* do the re-parent */
1754 ret = __clk_set_parent(clk, parent, p_index);
Mike Turquetteb24764902012-03-15 23:11:19 -07001755
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001756 /* propagate rate an accuracy recalculation accordingly */
1757 if (ret) {
Mike Turquetteb24764902012-03-15 23:11:19 -07001758 __clk_recalc_rates(clk, ABORT_RATE_CHANGE);
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001759 } else {
Ulf Hanssona68de8e2013-04-02 23:09:39 +02001760 __clk_recalc_rates(clk, POST_RATE_CHANGE);
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001761 __clk_recalc_accuracies(clk);
1762 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001763
1764out:
Mike Turquetteeab89f62013-03-28 13:59:01 -07001765 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001766
1767 return ret;
1768}
1769EXPORT_SYMBOL_GPL(clk_set_parent);
1770
1771/**
1772 * __clk_init - initialize the data structures in a struct clk
1773 * @dev: device initializing this clk, placeholder for now
1774 * @clk: clk being initialized
1775 *
1776 * Initializes the lists in struct clk, queries the hardware for the
1777 * parent and rate and sets them both.
Mike Turquetteb24764902012-03-15 23:11:19 -07001778 */
Mike Turquetted1302a32012-03-29 14:30:40 -07001779int __clk_init(struct device *dev, struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -07001780{
Mike Turquetted1302a32012-03-29 14:30:40 -07001781 int i, ret = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001782 struct clk *orphan;
Sasha Levinb67bfe02013-02-27 17:06:00 -08001783 struct hlist_node *tmp2;
Mike Turquetteb24764902012-03-15 23:11:19 -07001784
1785 if (!clk)
Mike Turquetted1302a32012-03-29 14:30:40 -07001786 return -EINVAL;
Mike Turquetteb24764902012-03-15 23:11:19 -07001787
Mike Turquetteeab89f62013-03-28 13:59:01 -07001788 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001789
1790 /* check to see if a clock with this name is already registered */
Mike Turquetted1302a32012-03-29 14:30:40 -07001791 if (__clk_lookup(clk->name)) {
1792 pr_debug("%s: clk %s already initialized\n",
1793 __func__, clk->name);
1794 ret = -EEXIST;
Mike Turquetteb24764902012-03-15 23:11:19 -07001795 goto out;
Mike Turquetted1302a32012-03-29 14:30:40 -07001796 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001797
Mike Turquetted4d7e3d2012-03-26 16:15:52 -07001798 /* check that clk_ops are sane. See Documentation/clk.txt */
1799 if (clk->ops->set_rate &&
James Hogan71472c02013-07-29 12:25:00 +01001800 !((clk->ops->round_rate || clk->ops->determine_rate) &&
1801 clk->ops->recalc_rate)) {
1802 pr_warning("%s: %s must implement .round_rate or .determine_rate in addition to .recalc_rate\n",
Mike Turquetted4d7e3d2012-03-26 16:15:52 -07001803 __func__, clk->name);
Mike Turquetted1302a32012-03-29 14:30:40 -07001804 ret = -EINVAL;
Mike Turquetted4d7e3d2012-03-26 16:15:52 -07001805 goto out;
1806 }
1807
1808 if (clk->ops->set_parent && !clk->ops->get_parent) {
1809 pr_warning("%s: %s must implement .get_parent & .set_parent\n",
1810 __func__, clk->name);
Mike Turquetted1302a32012-03-29 14:30:40 -07001811 ret = -EINVAL;
Mike Turquetted4d7e3d2012-03-26 16:15:52 -07001812 goto out;
1813 }
1814
Stephen Boyd3fa22522014-01-15 10:47:22 -08001815 if (clk->ops->set_rate_and_parent &&
1816 !(clk->ops->set_parent && clk->ops->set_rate)) {
1817 pr_warn("%s: %s must implement .set_parent & .set_rate\n",
1818 __func__, clk->name);
1819 ret = -EINVAL;
1820 goto out;
1821 }
1822
Mike Turquetteb24764902012-03-15 23:11:19 -07001823 /* throw a WARN if any entries in parent_names are NULL */
1824 for (i = 0; i < clk->num_parents; i++)
1825 WARN(!clk->parent_names[i],
1826 "%s: invalid NULL in %s's .parent_names\n",
1827 __func__, clk->name);
1828
1829 /*
1830 * Allocate an array of struct clk *'s to avoid unnecessary string
1831 * look-ups of clk's possible parents. This can fail for clocks passed
1832 * in to clk_init during early boot; thus any access to clk->parents[]
1833 * must always check for a NULL pointer and try to populate it if
1834 * necessary.
1835 *
1836 * If clk->parents is not NULL we skip this entire block. This allows
1837 * for clock drivers to statically initialize clk->parents.
1838 */
Rajendra Nayak9ca1c5a2012-06-06 14:41:30 +05301839 if (clk->num_parents > 1 && !clk->parents) {
Tomasz Figa96a7ed92013-09-29 02:37:15 +02001840 clk->parents = kcalloc(clk->num_parents, sizeof(struct clk *),
1841 GFP_KERNEL);
Mike Turquetteb24764902012-03-15 23:11:19 -07001842 /*
1843 * __clk_lookup returns NULL for parents that have not been
1844 * clk_init'd; thus any access to clk->parents[] must check
1845 * for a NULL pointer. We can always perform lazy lookups for
1846 * missing parents later on.
1847 */
1848 if (clk->parents)
1849 for (i = 0; i < clk->num_parents; i++)
1850 clk->parents[i] =
1851 __clk_lookup(clk->parent_names[i]);
1852 }
1853
1854 clk->parent = __clk_init_parent(clk);
1855
1856 /*
1857 * Populate clk->parent if parent has already been __clk_init'd. If
1858 * parent has not yet been __clk_init'd then place clk in the orphan
1859 * list. If clk has set the CLK_IS_ROOT flag then place it in the root
1860 * clk list.
1861 *
1862 * Every time a new clk is clk_init'd then we walk the list of orphan
1863 * clocks and re-parent any that are children of the clock currently
1864 * being clk_init'd.
1865 */
1866 if (clk->parent)
1867 hlist_add_head(&clk->child_node,
1868 &clk->parent->children);
1869 else if (clk->flags & CLK_IS_ROOT)
1870 hlist_add_head(&clk->child_node, &clk_root_list);
1871 else
1872 hlist_add_head(&clk->child_node, &clk_orphan_list);
1873
1874 /*
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001875 * Set clk's accuracy. The preferred method is to use
1876 * .recalc_accuracy. For simple clocks and lazy developers the default
1877 * fallback is to use the parent's accuracy. If a clock doesn't have a
1878 * parent (or is orphaned) then accuracy is set to zero (perfect
1879 * clock).
1880 */
1881 if (clk->ops->recalc_accuracy)
1882 clk->accuracy = clk->ops->recalc_accuracy(clk->hw,
1883 __clk_get_accuracy(clk->parent));
1884 else if (clk->parent)
1885 clk->accuracy = clk->parent->accuracy;
1886 else
1887 clk->accuracy = 0;
1888
1889 /*
Mike Turquetteb24764902012-03-15 23:11:19 -07001890 * Set clk's rate. The preferred method is to use .recalc_rate. For
1891 * simple clocks and lazy developers the default fallback is to use the
1892 * parent's rate. If a clock doesn't have a parent (or is orphaned)
1893 * then rate is set to zero.
1894 */
1895 if (clk->ops->recalc_rate)
1896 clk->rate = clk->ops->recalc_rate(clk->hw,
1897 __clk_get_rate(clk->parent));
1898 else if (clk->parent)
1899 clk->rate = clk->parent->rate;
1900 else
1901 clk->rate = 0;
1902
Stephen Boyd3a5aec22013-10-16 00:40:03 -07001903 clk_debug_register(clk);
Mike Turquetteb24764902012-03-15 23:11:19 -07001904 /*
1905 * walk the list of orphan clocks and reparent any that are children of
1906 * this clock
1907 */
Sasha Levinb67bfe02013-02-27 17:06:00 -08001908 hlist_for_each_entry_safe(orphan, tmp2, &clk_orphan_list, child_node) {
Alex Elder12d298862013-09-05 08:33:24 -05001909 if (orphan->num_parents && orphan->ops->get_parent) {
Martin Fuzzey1f61e5f2012-11-22 20:15:05 +01001910 i = orphan->ops->get_parent(orphan->hw);
1911 if (!strcmp(clk->name, orphan->parent_names[i]))
1912 __clk_reparent(orphan, clk);
1913 continue;
1914 }
1915
Mike Turquetteb24764902012-03-15 23:11:19 -07001916 for (i = 0; i < orphan->num_parents; i++)
1917 if (!strcmp(clk->name, orphan->parent_names[i])) {
1918 __clk_reparent(orphan, clk);
1919 break;
1920 }
Martin Fuzzey1f61e5f2012-11-22 20:15:05 +01001921 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001922
1923 /*
1924 * optional platform-specific magic
1925 *
1926 * The .init callback is not used by any of the basic clock types, but
1927 * exists for weird hardware that must perform initialization magic.
1928 * Please consider other ways of solving initialization problems before
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001929 * using this callback, as its use is discouraged.
Mike Turquetteb24764902012-03-15 23:11:19 -07001930 */
1931 if (clk->ops->init)
1932 clk->ops->init(clk->hw);
1933
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02001934 kref_init(&clk->ref);
Mike Turquetteb24764902012-03-15 23:11:19 -07001935out:
Mike Turquetteeab89f62013-03-28 13:59:01 -07001936 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001937
Mike Turquetted1302a32012-03-29 14:30:40 -07001938 return ret;
Mike Turquetteb24764902012-03-15 23:11:19 -07001939}
1940
1941/**
Saravana Kannan0197b3e2012-04-25 22:58:56 -07001942 * __clk_register - register a clock and return a cookie.
1943 *
1944 * Same as clk_register, except that the .clk field inside hw shall point to a
1945 * preallocated (generally statically allocated) struct clk. None of the fields
1946 * of the struct clk need to be initialized.
1947 *
1948 * The data pointed to by .init and .clk field shall NOT be marked as init
1949 * data.
1950 *
1951 * __clk_register is only exposed via clk-private.h and is intended for use with
1952 * very large numbers of clocks that need to be statically initialized. It is
1953 * a layering violation to include clk-private.h from any code which implements
1954 * a clock's .ops; as such any statically initialized clock data MUST be in a
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001955 * separate C file from the logic that implements its operations. Returns 0
Saravana Kannan0197b3e2012-04-25 22:58:56 -07001956 * on success, otherwise an error code.
1957 */
1958struct clk *__clk_register(struct device *dev, struct clk_hw *hw)
1959{
1960 int ret;
1961 struct clk *clk;
1962
1963 clk = hw->clk;
1964 clk->name = hw->init->name;
1965 clk->ops = hw->init->ops;
1966 clk->hw = hw;
1967 clk->flags = hw->init->flags;
1968 clk->parent_names = hw->init->parent_names;
1969 clk->num_parents = hw->init->num_parents;
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02001970 if (dev && dev->driver)
1971 clk->owner = dev->driver->owner;
1972 else
1973 clk->owner = NULL;
Saravana Kannan0197b3e2012-04-25 22:58:56 -07001974
1975 ret = __clk_init(dev, clk);
1976 if (ret)
1977 return ERR_PTR(ret);
1978
1979 return clk;
1980}
1981EXPORT_SYMBOL_GPL(__clk_register);
1982
Stephen Boyd46c87732012-09-24 13:38:04 -07001983static int _clk_register(struct device *dev, struct clk_hw *hw, struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -07001984{
Mike Turquetted1302a32012-03-29 14:30:40 -07001985 int i, ret;
Mike Turquetteb24764902012-03-15 23:11:19 -07001986
Saravana Kannan0197b3e2012-04-25 22:58:56 -07001987 clk->name = kstrdup(hw->init->name, GFP_KERNEL);
1988 if (!clk->name) {
1989 pr_err("%s: could not allocate clk->name\n", __func__);
1990 ret = -ENOMEM;
1991 goto fail_name;
1992 }
1993 clk->ops = hw->init->ops;
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02001994 if (dev && dev->driver)
1995 clk->owner = dev->driver->owner;
Mike Turquetteb24764902012-03-15 23:11:19 -07001996 clk->hw = hw;
Saravana Kannan0197b3e2012-04-25 22:58:56 -07001997 clk->flags = hw->init->flags;
1998 clk->num_parents = hw->init->num_parents;
Mike Turquetteb24764902012-03-15 23:11:19 -07001999 hw->clk = clk;
2000
Mike Turquetted1302a32012-03-29 14:30:40 -07002001 /* allocate local copy in case parent_names is __initdata */
Tomasz Figa96a7ed92013-09-29 02:37:15 +02002002 clk->parent_names = kcalloc(clk->num_parents, sizeof(char *),
2003 GFP_KERNEL);
Mike Turquetteb24764902012-03-15 23:11:19 -07002004
Mike Turquetted1302a32012-03-29 14:30:40 -07002005 if (!clk->parent_names) {
2006 pr_err("%s: could not allocate clk->parent_names\n", __func__);
2007 ret = -ENOMEM;
2008 goto fail_parent_names;
2009 }
2010
2011
2012 /* copy each string name in case parent_names is __initdata */
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002013 for (i = 0; i < clk->num_parents; i++) {
2014 clk->parent_names[i] = kstrdup(hw->init->parent_names[i],
2015 GFP_KERNEL);
Mike Turquetted1302a32012-03-29 14:30:40 -07002016 if (!clk->parent_names[i]) {
2017 pr_err("%s: could not copy parent_names\n", __func__);
2018 ret = -ENOMEM;
2019 goto fail_parent_names_copy;
2020 }
2021 }
2022
2023 ret = __clk_init(dev, clk);
2024 if (!ret)
Stephen Boyd46c87732012-09-24 13:38:04 -07002025 return 0;
Mike Turquetted1302a32012-03-29 14:30:40 -07002026
2027fail_parent_names_copy:
2028 while (--i >= 0)
2029 kfree(clk->parent_names[i]);
2030 kfree(clk->parent_names);
2031fail_parent_names:
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002032 kfree(clk->name);
2033fail_name:
Stephen Boyd46c87732012-09-24 13:38:04 -07002034 return ret;
2035}
2036
2037/**
2038 * clk_register - allocate a new clock, register it and return an opaque cookie
2039 * @dev: device that is registering this clock
2040 * @hw: link to hardware-specific clock data
2041 *
2042 * clk_register is the primary interface for populating the clock tree with new
2043 * clock nodes. It returns a pointer to the newly allocated struct clk which
2044 * cannot be dereferenced by driver code but may be used in conjuction with the
2045 * rest of the clock API. In the event of an error clk_register will return an
2046 * error code; drivers must test for an error code after calling clk_register.
2047 */
2048struct clk *clk_register(struct device *dev, struct clk_hw *hw)
2049{
2050 int ret;
2051 struct clk *clk;
2052
2053 clk = kzalloc(sizeof(*clk), GFP_KERNEL);
2054 if (!clk) {
2055 pr_err("%s: could not allocate clk\n", __func__);
2056 ret = -ENOMEM;
2057 goto fail_out;
2058 }
2059
2060 ret = _clk_register(dev, hw, clk);
2061 if (!ret)
2062 return clk;
2063
Mike Turquetted1302a32012-03-29 14:30:40 -07002064 kfree(clk);
2065fail_out:
2066 return ERR_PTR(ret);
Mike Turquetteb24764902012-03-15 23:11:19 -07002067}
2068EXPORT_SYMBOL_GPL(clk_register);
2069
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002070/*
2071 * Free memory allocated for a clock.
2072 * Caller must hold prepare_lock.
2073 */
2074static void __clk_release(struct kref *ref)
2075{
2076 struct clk *clk = container_of(ref, struct clk, ref);
2077 int i = clk->num_parents;
2078
2079 kfree(clk->parents);
2080 while (--i >= 0)
2081 kfree(clk->parent_names[i]);
2082
2083 kfree(clk->parent_names);
2084 kfree(clk->name);
2085 kfree(clk);
2086}
2087
2088/*
2089 * Empty clk_ops for unregistered clocks. These are used temporarily
2090 * after clk_unregister() was called on a clock and until last clock
2091 * consumer calls clk_put() and the struct clk object is freed.
2092 */
2093static int clk_nodrv_prepare_enable(struct clk_hw *hw)
2094{
2095 return -ENXIO;
2096}
2097
2098static void clk_nodrv_disable_unprepare(struct clk_hw *hw)
2099{
2100 WARN_ON_ONCE(1);
2101}
2102
2103static int clk_nodrv_set_rate(struct clk_hw *hw, unsigned long rate,
2104 unsigned long parent_rate)
2105{
2106 return -ENXIO;
2107}
2108
2109static int clk_nodrv_set_parent(struct clk_hw *hw, u8 index)
2110{
2111 return -ENXIO;
2112}
2113
2114static const struct clk_ops clk_nodrv_ops = {
2115 .enable = clk_nodrv_prepare_enable,
2116 .disable = clk_nodrv_disable_unprepare,
2117 .prepare = clk_nodrv_prepare_enable,
2118 .unprepare = clk_nodrv_disable_unprepare,
2119 .set_rate = clk_nodrv_set_rate,
2120 .set_parent = clk_nodrv_set_parent,
2121};
2122
Mark Brown1df5c932012-04-18 09:07:12 +01002123/**
2124 * clk_unregister - unregister a currently registered clock
2125 * @clk: clock to unregister
Mark Brown1df5c932012-04-18 09:07:12 +01002126 */
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002127void clk_unregister(struct clk *clk)
2128{
2129 unsigned long flags;
2130
2131 if (!clk || WARN_ON_ONCE(IS_ERR(clk)))
2132 return;
2133
2134 clk_prepare_lock();
2135
2136 if (clk->ops == &clk_nodrv_ops) {
2137 pr_err("%s: unregistered clock: %s\n", __func__, clk->name);
2138 goto out;
2139 }
2140 /*
2141 * Assign empty clock ops for consumers that might still hold
2142 * a reference to this clock.
2143 */
2144 flags = clk_enable_lock();
2145 clk->ops = &clk_nodrv_ops;
2146 clk_enable_unlock(flags);
2147
2148 if (!hlist_empty(&clk->children)) {
2149 struct clk *child;
2150
2151 /* Reparent all children to the orphan list. */
2152 hlist_for_each_entry(child, &clk->children, child_node)
2153 clk_set_parent(child, NULL);
2154 }
2155
2156 clk_debug_unregister(clk);
2157
2158 hlist_del_init(&clk->child_node);
2159
2160 if (clk->prepare_count)
2161 pr_warn("%s: unregistering prepared clock: %s\n",
2162 __func__, clk->name);
2163
2164 kref_put(&clk->ref, __clk_release);
2165out:
2166 clk_prepare_unlock();
2167}
Mark Brown1df5c932012-04-18 09:07:12 +01002168EXPORT_SYMBOL_GPL(clk_unregister);
2169
Stephen Boyd46c87732012-09-24 13:38:04 -07002170static void devm_clk_release(struct device *dev, void *res)
2171{
2172 clk_unregister(res);
2173}
2174
2175/**
2176 * devm_clk_register - resource managed clk_register()
2177 * @dev: device that is registering this clock
2178 * @hw: link to hardware-specific clock data
2179 *
2180 * Managed clk_register(). Clocks returned from this function are
2181 * automatically clk_unregister()ed on driver detach. See clk_register() for
2182 * more information.
2183 */
2184struct clk *devm_clk_register(struct device *dev, struct clk_hw *hw)
2185{
2186 struct clk *clk;
2187 int ret;
2188
2189 clk = devres_alloc(devm_clk_release, sizeof(*clk), GFP_KERNEL);
2190 if (!clk)
2191 return ERR_PTR(-ENOMEM);
2192
2193 ret = _clk_register(dev, hw, clk);
2194 if (!ret) {
2195 devres_add(dev, clk);
2196 } else {
2197 devres_free(clk);
2198 clk = ERR_PTR(ret);
2199 }
2200
2201 return clk;
2202}
2203EXPORT_SYMBOL_GPL(devm_clk_register);
2204
2205static int devm_clk_match(struct device *dev, void *res, void *data)
2206{
2207 struct clk *c = res;
2208 if (WARN_ON(!c))
2209 return 0;
2210 return c == data;
2211}
2212
2213/**
2214 * devm_clk_unregister - resource managed clk_unregister()
2215 * @clk: clock to unregister
2216 *
2217 * Deallocate a clock allocated with devm_clk_register(). Normally
2218 * this function will not need to be called and the resource management
2219 * code will ensure that the resource is freed.
2220 */
2221void devm_clk_unregister(struct device *dev, struct clk *clk)
2222{
2223 WARN_ON(devres_release(dev, devm_clk_release, devm_clk_match, clk));
2224}
2225EXPORT_SYMBOL_GPL(devm_clk_unregister);
2226
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02002227/*
2228 * clkdev helpers
2229 */
2230int __clk_get(struct clk *clk)
2231{
Sylwester Nawrocki00efcb12014-01-07 13:03:43 +01002232 if (clk) {
2233 if (!try_module_get(clk->owner))
2234 return 0;
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02002235
Sylwester Nawrocki00efcb12014-01-07 13:03:43 +01002236 kref_get(&clk->ref);
2237 }
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02002238 return 1;
2239}
2240
2241void __clk_put(struct clk *clk)
2242{
Sylwester Nawrocki00efcb12014-01-07 13:03:43 +01002243 if (!clk || WARN_ON_ONCE(IS_ERR(clk)))
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02002244 return;
2245
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002246 clk_prepare_lock();
2247 kref_put(&clk->ref, __clk_release);
2248 clk_prepare_unlock();
2249
Sylwester Nawrocki00efcb12014-01-07 13:03:43 +01002250 module_put(clk->owner);
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02002251}
2252
Mike Turquetteb24764902012-03-15 23:11:19 -07002253/*** clk rate change notifiers ***/
2254
2255/**
2256 * clk_notifier_register - add a clk rate change notifier
2257 * @clk: struct clk * to watch
2258 * @nb: struct notifier_block * with callback info
2259 *
2260 * Request notification when clk's rate changes. This uses an SRCU
2261 * notifier because we want it to block and notifier unregistrations are
2262 * uncommon. The callbacks associated with the notifier must not
2263 * re-enter into the clk framework by calling any top-level clk APIs;
2264 * this will cause a nested prepare_lock mutex.
2265 *
Soren Brinkmann5324fda2014-01-22 11:48:37 -08002266 * In all notification cases cases (pre, post and abort rate change) the
2267 * original clock rate is passed to the callback via struct
2268 * clk_notifier_data.old_rate and the new frequency is passed via struct
Mike Turquetteb24764902012-03-15 23:11:19 -07002269 * clk_notifier_data.new_rate.
2270 *
Mike Turquetteb24764902012-03-15 23:11:19 -07002271 * clk_notifier_register() must be called from non-atomic context.
2272 * Returns -EINVAL if called with null arguments, -ENOMEM upon
2273 * allocation failure; otherwise, passes along the return value of
2274 * srcu_notifier_chain_register().
2275 */
2276int clk_notifier_register(struct clk *clk, struct notifier_block *nb)
2277{
2278 struct clk_notifier *cn;
2279 int ret = -ENOMEM;
2280
2281 if (!clk || !nb)
2282 return -EINVAL;
2283
Mike Turquetteeab89f62013-03-28 13:59:01 -07002284 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07002285
2286 /* search the list of notifiers for this clk */
2287 list_for_each_entry(cn, &clk_notifier_list, node)
2288 if (cn->clk == clk)
2289 break;
2290
2291 /* if clk wasn't in the notifier list, allocate new clk_notifier */
2292 if (cn->clk != clk) {
2293 cn = kzalloc(sizeof(struct clk_notifier), GFP_KERNEL);
2294 if (!cn)
2295 goto out;
2296
2297 cn->clk = clk;
2298 srcu_init_notifier_head(&cn->notifier_head);
2299
2300 list_add(&cn->node, &clk_notifier_list);
2301 }
2302
2303 ret = srcu_notifier_chain_register(&cn->notifier_head, nb);
2304
2305 clk->notifier_count++;
2306
2307out:
Mike Turquetteeab89f62013-03-28 13:59:01 -07002308 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07002309
2310 return ret;
2311}
2312EXPORT_SYMBOL_GPL(clk_notifier_register);
2313
2314/**
2315 * clk_notifier_unregister - remove a clk rate change notifier
2316 * @clk: struct clk *
2317 * @nb: struct notifier_block * with callback info
2318 *
2319 * Request no further notification for changes to 'clk' and frees memory
2320 * allocated in clk_notifier_register.
2321 *
2322 * Returns -EINVAL if called with null arguments; otherwise, passes
2323 * along the return value of srcu_notifier_chain_unregister().
2324 */
2325int clk_notifier_unregister(struct clk *clk, struct notifier_block *nb)
2326{
2327 struct clk_notifier *cn = NULL;
2328 int ret = -EINVAL;
2329
2330 if (!clk || !nb)
2331 return -EINVAL;
2332
Mike Turquetteeab89f62013-03-28 13:59:01 -07002333 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07002334
2335 list_for_each_entry(cn, &clk_notifier_list, node)
2336 if (cn->clk == clk)
2337 break;
2338
2339 if (cn->clk == clk) {
2340 ret = srcu_notifier_chain_unregister(&cn->notifier_head, nb);
2341
2342 clk->notifier_count--;
2343
2344 /* XXX the notifier code should handle this better */
2345 if (!cn->notifier_head.head) {
2346 srcu_cleanup_notifier_head(&cn->notifier_head);
Lai Jiangshan72b53222013-06-03 17:17:15 +08002347 list_del(&cn->node);
Mike Turquetteb24764902012-03-15 23:11:19 -07002348 kfree(cn);
2349 }
2350
2351 } else {
2352 ret = -ENOENT;
2353 }
2354
Mike Turquetteeab89f62013-03-28 13:59:01 -07002355 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07002356
2357 return ret;
2358}
2359EXPORT_SYMBOL_GPL(clk_notifier_unregister);
Grant Likely766e6a42012-04-09 14:50:06 -05002360
2361#ifdef CONFIG_OF
2362/**
2363 * struct of_clk_provider - Clock provider registration structure
2364 * @link: Entry in global list of clock providers
2365 * @node: Pointer to device tree node of clock provider
2366 * @get: Get clock callback. Returns NULL or a struct clk for the
2367 * given clock specifier
2368 * @data: context pointer to be passed into @get callback
2369 */
2370struct of_clk_provider {
2371 struct list_head link;
2372
2373 struct device_node *node;
2374 struct clk *(*get)(struct of_phandle_args *clkspec, void *data);
2375 void *data;
2376};
2377
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +05302378static const struct of_device_id __clk_of_table_sentinel
2379 __used __section(__clk_of_table_end);
2380
Grant Likely766e6a42012-04-09 14:50:06 -05002381static LIST_HEAD(of_clk_providers);
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02002382static DEFINE_MUTEX(of_clk_mutex);
2383
2384/* of_clk_provider list locking helpers */
2385void of_clk_lock(void)
2386{
2387 mutex_lock(&of_clk_mutex);
2388}
2389
2390void of_clk_unlock(void)
2391{
2392 mutex_unlock(&of_clk_mutex);
2393}
Grant Likely766e6a42012-04-09 14:50:06 -05002394
2395struct clk *of_clk_src_simple_get(struct of_phandle_args *clkspec,
2396 void *data)
2397{
2398 return data;
2399}
2400EXPORT_SYMBOL_GPL(of_clk_src_simple_get);
2401
Shawn Guo494bfec2012-08-22 21:36:27 +08002402struct clk *of_clk_src_onecell_get(struct of_phandle_args *clkspec, void *data)
2403{
2404 struct clk_onecell_data *clk_data = data;
2405 unsigned int idx = clkspec->args[0];
2406
2407 if (idx >= clk_data->clk_num) {
2408 pr_err("%s: invalid clock index %d\n", __func__, idx);
2409 return ERR_PTR(-EINVAL);
2410 }
2411
2412 return clk_data->clks[idx];
2413}
2414EXPORT_SYMBOL_GPL(of_clk_src_onecell_get);
2415
Grant Likely766e6a42012-04-09 14:50:06 -05002416/**
2417 * of_clk_add_provider() - Register a clock provider for a node
2418 * @np: Device node pointer associated with clock provider
2419 * @clk_src_get: callback for decoding clock
2420 * @data: context pointer for @clk_src_get callback.
2421 */
2422int of_clk_add_provider(struct device_node *np,
2423 struct clk *(*clk_src_get)(struct of_phandle_args *clkspec,
2424 void *data),
2425 void *data)
2426{
2427 struct of_clk_provider *cp;
2428
2429 cp = kzalloc(sizeof(struct of_clk_provider), GFP_KERNEL);
2430 if (!cp)
2431 return -ENOMEM;
2432
2433 cp->node = of_node_get(np);
2434 cp->data = data;
2435 cp->get = clk_src_get;
2436
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02002437 mutex_lock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05002438 list_add(&cp->link, &of_clk_providers);
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02002439 mutex_unlock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05002440 pr_debug("Added clock from %s\n", np->full_name);
2441
2442 return 0;
2443}
2444EXPORT_SYMBOL_GPL(of_clk_add_provider);
2445
2446/**
2447 * of_clk_del_provider() - Remove a previously registered clock provider
2448 * @np: Device node pointer associated with clock provider
2449 */
2450void of_clk_del_provider(struct device_node *np)
2451{
2452 struct of_clk_provider *cp;
2453
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02002454 mutex_lock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05002455 list_for_each_entry(cp, &of_clk_providers, link) {
2456 if (cp->node == np) {
2457 list_del(&cp->link);
2458 of_node_put(cp->node);
2459 kfree(cp);
2460 break;
2461 }
2462 }
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02002463 mutex_unlock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05002464}
2465EXPORT_SYMBOL_GPL(of_clk_del_provider);
2466
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02002467struct clk *__of_clk_get_from_provider(struct of_phandle_args *clkspec)
Grant Likely766e6a42012-04-09 14:50:06 -05002468{
2469 struct of_clk_provider *provider;
Jean-Francois Moinea34cd462013-11-25 19:47:04 +01002470 struct clk *clk = ERR_PTR(-EPROBE_DEFER);
Grant Likely766e6a42012-04-09 14:50:06 -05002471
2472 /* Check if we have such a provider in our array */
Grant Likely766e6a42012-04-09 14:50:06 -05002473 list_for_each_entry(provider, &of_clk_providers, link) {
2474 if (provider->node == clkspec->np)
2475 clk = provider->get(clkspec, provider->data);
2476 if (!IS_ERR(clk))
2477 break;
2478 }
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02002479
2480 return clk;
2481}
2482
2483struct clk *of_clk_get_from_provider(struct of_phandle_args *clkspec)
2484{
2485 struct clk *clk;
2486
2487 mutex_lock(&of_clk_mutex);
2488 clk = __of_clk_get_from_provider(clkspec);
2489 mutex_unlock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05002490
2491 return clk;
2492}
2493
Mike Turquettef6102742013-10-07 23:12:13 -07002494int of_clk_get_parent_count(struct device_node *np)
2495{
2496 return of_count_phandle_with_args(np, "clocks", "#clock-cells");
2497}
2498EXPORT_SYMBOL_GPL(of_clk_get_parent_count);
2499
Grant Likely766e6a42012-04-09 14:50:06 -05002500const char *of_clk_get_parent_name(struct device_node *np, int index)
2501{
2502 struct of_phandle_args clkspec;
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00002503 struct property *prop;
Grant Likely766e6a42012-04-09 14:50:06 -05002504 const char *clk_name;
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00002505 const __be32 *vp;
2506 u32 pv;
Grant Likely766e6a42012-04-09 14:50:06 -05002507 int rc;
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00002508 int count;
Grant Likely766e6a42012-04-09 14:50:06 -05002509
2510 if (index < 0)
2511 return NULL;
2512
2513 rc = of_parse_phandle_with_args(np, "clocks", "#clock-cells", index,
2514 &clkspec);
2515 if (rc)
2516 return NULL;
2517
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00002518 index = clkspec.args_count ? clkspec.args[0] : 0;
2519 count = 0;
2520
2521 /* if there is an indices property, use it to transfer the index
2522 * specified into an array offset for the clock-output-names property.
2523 */
2524 of_property_for_each_u32(clkspec.np, "clock-indices", prop, vp, pv) {
2525 if (index == pv) {
2526 index = count;
2527 break;
2528 }
2529 count++;
2530 }
2531
Grant Likely766e6a42012-04-09 14:50:06 -05002532 if (of_property_read_string_index(clkspec.np, "clock-output-names",
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00002533 index,
Grant Likely766e6a42012-04-09 14:50:06 -05002534 &clk_name) < 0)
2535 clk_name = clkspec.np->name;
2536
2537 of_node_put(clkspec.np);
2538 return clk_name;
2539}
2540EXPORT_SYMBOL_GPL(of_clk_get_parent_name);
2541
Gregory CLEMENT1771b102014-02-24 19:10:13 +01002542struct clock_provider {
2543 of_clk_init_cb_t clk_init_cb;
2544 struct device_node *np;
2545 struct list_head node;
2546};
2547
2548static LIST_HEAD(clk_provider_list);
2549
2550/*
2551 * This function looks for a parent clock. If there is one, then it
2552 * checks that the provider for this parent clock was initialized, in
2553 * this case the parent clock will be ready.
2554 */
2555static int parent_ready(struct device_node *np)
2556{
2557 int i = 0;
2558
2559 while (true) {
2560 struct clk *clk = of_clk_get(np, i);
2561
2562 /* this parent is ready we can check the next one */
2563 if (!IS_ERR(clk)) {
2564 clk_put(clk);
2565 i++;
2566 continue;
2567 }
2568
2569 /* at least one parent is not ready, we exit now */
2570 if (PTR_ERR(clk) == -EPROBE_DEFER)
2571 return 0;
2572
2573 /*
2574 * Here we make assumption that the device tree is
2575 * written correctly. So an error means that there is
2576 * no more parent. As we didn't exit yet, then the
2577 * previous parent are ready. If there is no clock
2578 * parent, no need to wait for them, then we can
2579 * consider their absence as being ready
2580 */
2581 return 1;
2582 }
2583}
2584
Grant Likely766e6a42012-04-09 14:50:06 -05002585/**
2586 * of_clk_init() - Scan and init clock providers from the DT
2587 * @matches: array of compatible values and init functions for providers.
2588 *
Gregory CLEMENT1771b102014-02-24 19:10:13 +01002589 * This function scans the device tree for matching clock providers
2590 * and calls their initialization functions. It also do it by trying
2591 * to follow the dependencies.
Grant Likely766e6a42012-04-09 14:50:06 -05002592 */
2593void __init of_clk_init(const struct of_device_id *matches)
2594{
Alex Elder7f7ed582013-08-22 11:31:31 -05002595 const struct of_device_id *match;
Grant Likely766e6a42012-04-09 14:50:06 -05002596 struct device_node *np;
Gregory CLEMENT1771b102014-02-24 19:10:13 +01002597 struct clock_provider *clk_provider, *next;
2598 bool is_init_done;
2599 bool force = false;
Grant Likely766e6a42012-04-09 14:50:06 -05002600
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +05302601 if (!matches)
Tero Kristo819b4862013-10-22 11:39:36 +03002602 matches = &__clk_of_table;
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +05302603
Gregory CLEMENT1771b102014-02-24 19:10:13 +01002604 /* First prepare the list of the clocks providers */
Alex Elder7f7ed582013-08-22 11:31:31 -05002605 for_each_matching_node_and_match(np, matches, &match) {
Gregory CLEMENT1771b102014-02-24 19:10:13 +01002606 struct clock_provider *parent =
2607 kzalloc(sizeof(struct clock_provider), GFP_KERNEL);
2608
2609 parent->clk_init_cb = match->data;
2610 parent->np = np;
2611 list_add(&parent->node, &clk_provider_list);
2612 }
2613
2614 while (!list_empty(&clk_provider_list)) {
2615 is_init_done = false;
2616 list_for_each_entry_safe(clk_provider, next,
2617 &clk_provider_list, node) {
2618 if (force || parent_ready(clk_provider->np)) {
2619 clk_provider->clk_init_cb(clk_provider->np);
2620 list_del(&clk_provider->node);
2621 kfree(clk_provider);
2622 is_init_done = true;
2623 }
2624 }
2625
2626 /*
2627 * We didn't managed to initialize any of the
2628 * remaining providers during the last loop, so now we
2629 * initialize all the remaining ones unconditionally
2630 * in case the clock parent was not mandatory
2631 */
2632 if (!is_init_done)
2633 force = true;
2634
Grant Likely766e6a42012-04-09 14:50:06 -05002635 }
2636}
2637#endif