blob: b56c11f51bafad32bafc7b5b9c7467e7cd16632b [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
Stephen Boyd3c373112015-06-19 15:00:46 -070012#include <linux/clk.h>
Michael Turquetteb09d6d92015-01-29 14:22:50 -080013#include <linux/clk-provider.h>
Sylwester Nawrocki86be4082014-06-18 17:29:32 +020014#include <linux/clk/clk-conf.h>
Mike Turquetteb24764902012-03-15 23:11:19 -070015#include <linux/module.h>
16#include <linux/mutex.h>
17#include <linux/spinlock.h>
18#include <linux/err.h>
19#include <linux/list.h>
20#include <linux/slab.h>
Grant Likely766e6a42012-04-09 14:50:06 -050021#include <linux/of.h>
Stephen Boyd46c87732012-09-24 13:38:04 -070022#include <linux/device.h>
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +053023#include <linux/init.h>
Marek Szyprowski9a34b452017-08-21 10:04:59 +020024#include <linux/pm_runtime.h>
Mike Turquette533ddeb2013-03-28 13:59:02 -070025#include <linux/sched.h>
Stephen Boyd562ef0b2015-05-01 12:16:14 -070026#include <linux/clkdev.h>
Mike Turquetteb24764902012-03-15 23:11:19 -070027
Sylwester Nawrockid6782c22013-08-23 17:03:43 +020028#include "clk.h"
29
Mike Turquetteb24764902012-03-15 23:11:19 -070030static DEFINE_SPINLOCK(enable_lock);
31static DEFINE_MUTEX(prepare_lock);
32
Mike Turquette533ddeb2013-03-28 13:59:02 -070033static struct task_struct *prepare_owner;
34static struct task_struct *enable_owner;
35
36static int prepare_refcnt;
37static int enable_refcnt;
38
Mike Turquetteb24764902012-03-15 23:11:19 -070039static HLIST_HEAD(clk_root_list);
40static HLIST_HEAD(clk_orphan_list);
41static LIST_HEAD(clk_notifier_list);
42
Michael Turquetteb09d6d92015-01-29 14:22:50 -080043/*** private data structures ***/
44
45struct clk_core {
46 const char *name;
47 const struct clk_ops *ops;
48 struct clk_hw *hw;
49 struct module *owner;
Marek Szyprowski9a34b452017-08-21 10:04:59 +020050 struct device *dev;
Michael Turquetteb09d6d92015-01-29 14:22:50 -080051 struct clk_core *parent;
52 const char **parent_names;
53 struct clk_core **parents;
54 u8 num_parents;
55 u8 new_parent_index;
56 unsigned long rate;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +010057 unsigned long req_rate;
Michael Turquetteb09d6d92015-01-29 14:22:50 -080058 unsigned long new_rate;
59 struct clk_core *new_parent;
60 struct clk_core *new_child;
61 unsigned long flags;
Heiko Stuebnere6500342015-04-22 22:53:05 +020062 bool orphan;
Michael Turquetteb09d6d92015-01-29 14:22:50 -080063 unsigned int enable_count;
64 unsigned int prepare_count;
Stephen Boyd9783c0d2015-07-16 12:50:27 -070065 unsigned long min_rate;
66 unsigned long max_rate;
Michael Turquetteb09d6d92015-01-29 14:22:50 -080067 unsigned long accuracy;
68 int phase;
69 struct hlist_head children;
70 struct hlist_node child_node;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +010071 struct hlist_head clks;
Michael Turquetteb09d6d92015-01-29 14:22:50 -080072 unsigned int notifier_count;
73#ifdef CONFIG_DEBUG_FS
74 struct dentry *dentry;
Maxime Coquelin8c9a8a82015-06-10 13:28:27 +020075 struct hlist_node debug_node;
Michael Turquetteb09d6d92015-01-29 14:22:50 -080076#endif
77 struct kref ref;
78};
79
Stephen Boyddfc202e2015-02-02 14:37:41 -080080#define CREATE_TRACE_POINTS
81#include <trace/events/clk.h>
82
Michael Turquetteb09d6d92015-01-29 14:22:50 -080083struct clk {
84 struct clk_core *core;
85 const char *dev_id;
86 const char *con_id;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +010087 unsigned long min_rate;
88 unsigned long max_rate;
Stephen Boyd50595f82015-02-06 11:42:44 -080089 struct hlist_node clks_node;
Michael Turquetteb09d6d92015-01-29 14:22:50 -080090};
91
Marek Szyprowski9a34b452017-08-21 10:04:59 +020092/*** runtime pm ***/
93static int clk_pm_runtime_get(struct clk_core *core)
94{
95 int ret = 0;
96
97 if (!core->dev)
98 return 0;
99
100 ret = pm_runtime_get_sync(core->dev);
101 return ret < 0 ? ret : 0;
102}
103
104static void clk_pm_runtime_put(struct clk_core *core)
105{
106 if (!core->dev)
107 return;
108
109 pm_runtime_put_sync(core->dev);
110}
111
Mike Turquetteeab89f62013-03-28 13:59:01 -0700112/*** locking ***/
113static void clk_prepare_lock(void)
114{
Mike Turquette533ddeb2013-03-28 13:59:02 -0700115 if (!mutex_trylock(&prepare_lock)) {
116 if (prepare_owner == current) {
117 prepare_refcnt++;
118 return;
119 }
120 mutex_lock(&prepare_lock);
121 }
122 WARN_ON_ONCE(prepare_owner != NULL);
123 WARN_ON_ONCE(prepare_refcnt != 0);
124 prepare_owner = current;
125 prepare_refcnt = 1;
Mike Turquetteeab89f62013-03-28 13:59:01 -0700126}
127
128static void clk_prepare_unlock(void)
129{
Mike Turquette533ddeb2013-03-28 13:59:02 -0700130 WARN_ON_ONCE(prepare_owner != current);
131 WARN_ON_ONCE(prepare_refcnt == 0);
132
133 if (--prepare_refcnt)
134 return;
135 prepare_owner = NULL;
Mike Turquetteeab89f62013-03-28 13:59:01 -0700136 mutex_unlock(&prepare_lock);
137}
138
139static unsigned long clk_enable_lock(void)
Stephen Boyda57aa182015-07-24 12:24:48 -0700140 __acquires(enable_lock)
Mike Turquetteeab89f62013-03-28 13:59:01 -0700141{
142 unsigned long flags;
Mike Turquette533ddeb2013-03-28 13:59:02 -0700143
144 if (!spin_trylock_irqsave(&enable_lock, flags)) {
145 if (enable_owner == current) {
146 enable_refcnt++;
Stephen Boyda57aa182015-07-24 12:24:48 -0700147 __acquire(enable_lock);
Mike Turquette533ddeb2013-03-28 13:59:02 -0700148 return flags;
149 }
150 spin_lock_irqsave(&enable_lock, flags);
151 }
152 WARN_ON_ONCE(enable_owner != NULL);
153 WARN_ON_ONCE(enable_refcnt != 0);
154 enable_owner = current;
155 enable_refcnt = 1;
Mike Turquetteeab89f62013-03-28 13:59:01 -0700156 return flags;
157}
158
159static void clk_enable_unlock(unsigned long flags)
Stephen Boyda57aa182015-07-24 12:24:48 -0700160 __releases(enable_lock)
Mike Turquetteeab89f62013-03-28 13:59:01 -0700161{
Mike Turquette533ddeb2013-03-28 13:59:02 -0700162 WARN_ON_ONCE(enable_owner != current);
163 WARN_ON_ONCE(enable_refcnt == 0);
164
Stephen Boyda57aa182015-07-24 12:24:48 -0700165 if (--enable_refcnt) {
166 __release(enable_lock);
Mike Turquette533ddeb2013-03-28 13:59:02 -0700167 return;
Stephen Boyda57aa182015-07-24 12:24:48 -0700168 }
Mike Turquette533ddeb2013-03-28 13:59:02 -0700169 enable_owner = NULL;
Mike Turquetteeab89f62013-03-28 13:59:01 -0700170 spin_unlock_irqrestore(&enable_lock, flags);
171}
172
Stephen Boyd4dff95d2015-04-30 14:43:22 -0700173static bool clk_core_is_prepared(struct clk_core *core)
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530174{
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200175 bool ret = false;
176
Stephen Boyd4dff95d2015-04-30 14:43:22 -0700177 /*
178 * .is_prepared is optional for clocks that can prepare
179 * fall back to software usage counter if it is missing
180 */
181 if (!core->ops->is_prepared)
182 return core->prepare_count;
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530183
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200184 if (!clk_pm_runtime_get(core)) {
185 ret = core->ops->is_prepared(core->hw);
186 clk_pm_runtime_put(core);
187 }
188
189 return ret;
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530190}
191
Stephen Boyd4dff95d2015-04-30 14:43:22 -0700192static bool clk_core_is_enabled(struct clk_core *core)
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530193{
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200194 bool ret = false;
195
Stephen Boyd4dff95d2015-04-30 14:43:22 -0700196 /*
197 * .is_enabled is only mandatory for clocks that gate
198 * fall back to software usage counter if .is_enabled is missing
199 */
200 if (!core->ops->is_enabled)
201 return core->enable_count;
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530202
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200203 /*
204 * Check if clock controller's device is runtime active before
205 * calling .is_enabled callback. If not, assume that clock is
206 * disabled, because we might be called from atomic context, from
207 * which pm_runtime_get() is not allowed.
208 * This function is called mainly from clk_disable_unused_subtree,
209 * which ensures proper runtime pm activation of controller before
210 * taking enable spinlock, but the below check is needed if one tries
211 * to call it from other places.
212 */
213 if (core->dev) {
214 pm_runtime_get_noresume(core->dev);
215 if (!pm_runtime_active(core->dev)) {
216 ret = false;
217 goto done;
218 }
219 }
220
221 ret = core->ops->is_enabled(core->hw);
222done:
Dong Aisheng756efe12017-12-22 17:46:04 +0800223 if (core->dev)
224 pm_runtime_put(core->dev);
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200225
226 return ret;
Prashant Gaikwad1af599d2012-12-26 19:16:22 +0530227}
228
Mike Turquetteb24764902012-03-15 23:11:19 -0700229/*** helper functions ***/
230
Geert Uytterhoevenb76281c2015-10-16 14:35:21 +0200231const char *__clk_get_name(const struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700232{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100233 return !clk ? NULL : clk->core->name;
Mike Turquetteb24764902012-03-15 23:11:19 -0700234}
Niels de Vos48950842012-12-13 13:12:25 +0100235EXPORT_SYMBOL_GPL(__clk_get_name);
Mike Turquetteb24764902012-03-15 23:11:19 -0700236
Stephen Boyde7df6f62015-08-12 13:04:56 -0700237const char *clk_hw_get_name(const struct clk_hw *hw)
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700238{
239 return hw->core->name;
240}
241EXPORT_SYMBOL_GPL(clk_hw_get_name);
242
Russ Dill65800b22012-11-26 11:20:09 -0800243struct clk_hw *__clk_get_hw(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700244{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100245 return !clk ? NULL : clk->core->hw;
Mike Turquetteb24764902012-03-15 23:11:19 -0700246}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800247EXPORT_SYMBOL_GPL(__clk_get_hw);
Mike Turquetteb24764902012-03-15 23:11:19 -0700248
Stephen Boyde7df6f62015-08-12 13:04:56 -0700249unsigned int clk_hw_get_num_parents(const struct clk_hw *hw)
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700250{
251 return hw->core->num_parents;
252}
253EXPORT_SYMBOL_GPL(clk_hw_get_num_parents);
254
Stephen Boyde7df6f62015-08-12 13:04:56 -0700255struct clk_hw *clk_hw_get_parent(const struct clk_hw *hw)
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700256{
257 return hw->core->parent ? hw->core->parent->hw : NULL;
258}
259EXPORT_SYMBOL_GPL(clk_hw_get_parent);
260
Stephen Boyd4dff95d2015-04-30 14:43:22 -0700261static struct clk_core *__clk_lookup_subtree(const char *name,
262 struct clk_core *core)
263{
264 struct clk_core *child;
265 struct clk_core *ret;
266
267 if (!strcmp(core->name, name))
268 return core;
269
270 hlist_for_each_entry(child, &core->children, child_node) {
271 ret = __clk_lookup_subtree(name, child);
272 if (ret)
273 return ret;
274 }
275
276 return NULL;
277}
278
279static struct clk_core *clk_core_lookup(const char *name)
280{
281 struct clk_core *root_clk;
282 struct clk_core *ret;
283
284 if (!name)
285 return NULL;
286
287 /* search the 'proper' clk tree first */
288 hlist_for_each_entry(root_clk, &clk_root_list, child_node) {
289 ret = __clk_lookup_subtree(name, root_clk);
290 if (ret)
291 return ret;
292 }
293
294 /* if not found, then search the orphan tree */
295 hlist_for_each_entry(root_clk, &clk_orphan_list, child_node) {
296 ret = __clk_lookup_subtree(name, root_clk);
297 if (ret)
298 return ret;
299 }
300
301 return NULL;
302}
303
Stephen Boydd6968fc2015-04-30 13:54:13 -0700304static struct clk_core *clk_core_get_parent_by_index(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100305 u8 index)
James Hogan7ef3dcc2013-07-29 12:24:58 +0100306{
Stephen Boydd6968fc2015-04-30 13:54:13 -0700307 if (!core || index >= core->num_parents)
James Hogan7ef3dcc2013-07-29 12:24:58 +0100308 return NULL;
Masahiro Yamada88cfbef2015-12-28 19:23:01 +0900309
310 if (!core->parents[index])
311 core->parents[index] =
312 clk_core_lookup(core->parent_names[index]);
313
314 return core->parents[index];
James Hogan7ef3dcc2013-07-29 12:24:58 +0100315}
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100316
Stephen Boyde7df6f62015-08-12 13:04:56 -0700317struct clk_hw *
318clk_hw_get_parent_by_index(const struct clk_hw *hw, unsigned int index)
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700319{
320 struct clk_core *parent;
321
322 parent = clk_core_get_parent_by_index(hw->core, index);
323
324 return !parent ? NULL : parent->hw;
325}
326EXPORT_SYMBOL_GPL(clk_hw_get_parent_by_index);
327
Russ Dill65800b22012-11-26 11:20:09 -0800328unsigned int __clk_get_enable_count(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700329{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100330 return !clk ? 0 : clk->core->enable_count;
Mike Turquetteb24764902012-03-15 23:11:19 -0700331}
332
Stephen Boydd6968fc2015-04-30 13:54:13 -0700333static unsigned long clk_core_get_rate_nolock(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700334{
335 unsigned long ret;
336
Stephen Boydd6968fc2015-04-30 13:54:13 -0700337 if (!core) {
Rajendra Nayak34e44fe2012-03-26 19:01:48 +0530338 ret = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -0700339 goto out;
340 }
341
Stephen Boydd6968fc2015-04-30 13:54:13 -0700342 ret = core->rate;
Mike Turquetteb24764902012-03-15 23:11:19 -0700343
Stephen Boyd47b0eeb2016-02-02 17:24:56 -0800344 if (!core->num_parents)
Mike Turquetteb24764902012-03-15 23:11:19 -0700345 goto out;
346
Stephen Boydd6968fc2015-04-30 13:54:13 -0700347 if (!core->parent)
Rajendra Nayak34e44fe2012-03-26 19:01:48 +0530348 ret = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -0700349
350out:
351 return ret;
352}
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100353
Stephen Boyde7df6f62015-08-12 13:04:56 -0700354unsigned long clk_hw_get_rate(const struct clk_hw *hw)
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700355{
356 return clk_core_get_rate_nolock(hw->core);
357}
358EXPORT_SYMBOL_GPL(clk_hw_get_rate);
359
Stephen Boydd6968fc2015-04-30 13:54:13 -0700360static unsigned long __clk_get_accuracy(struct clk_core *core)
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100361{
Stephen Boydd6968fc2015-04-30 13:54:13 -0700362 if (!core)
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100363 return 0;
364
Stephen Boydd6968fc2015-04-30 13:54:13 -0700365 return core->accuracy;
Boris BREZILLON5279fc42013-12-21 10:34:47 +0100366}
367
Russ Dill65800b22012-11-26 11:20:09 -0800368unsigned long __clk_get_flags(struct clk *clk)
Mike Turquetteb24764902012-03-15 23:11:19 -0700369{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100370 return !clk ? 0 : clk->core->flags;
Mike Turquetteb24764902012-03-15 23:11:19 -0700371}
Thierry Redingb05c6832013-09-03 09:43:51 +0200372EXPORT_SYMBOL_GPL(__clk_get_flags);
Mike Turquetteb24764902012-03-15 23:11:19 -0700373
Stephen Boyde7df6f62015-08-12 13:04:56 -0700374unsigned long clk_hw_get_flags(const struct clk_hw *hw)
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700375{
376 return hw->core->flags;
377}
378EXPORT_SYMBOL_GPL(clk_hw_get_flags);
379
Stephen Boyde7df6f62015-08-12 13:04:56 -0700380bool clk_hw_is_prepared(const struct clk_hw *hw)
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700381{
382 return clk_core_is_prepared(hw->core);
383}
384
Joachim Eastwoodbe68bf82015-10-24 18:55:22 +0200385bool clk_hw_is_enabled(const struct clk_hw *hw)
386{
387 return clk_core_is_enabled(hw->core);
388}
389
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100390bool __clk_is_enabled(struct clk *clk)
391{
392 if (!clk)
393 return false;
394
395 return clk_core_is_enabled(clk->core);
396}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800397EXPORT_SYMBOL_GPL(__clk_is_enabled);
Mike Turquetteb24764902012-03-15 23:11:19 -0700398
Stephen Boyd15a02c12015-01-19 18:05:28 -0800399static bool mux_is_better_rate(unsigned long rate, unsigned long now,
400 unsigned long best, unsigned long flags)
James Hogane366fdd2013-07-29 12:25:02 +0100401{
Stephen Boyd15a02c12015-01-19 18:05:28 -0800402 if (flags & CLK_MUX_ROUND_CLOSEST)
403 return abs(now - rate) < abs(best - rate);
404
405 return now <= rate && now > best;
406}
407
Boris Brezillon0817b622015-07-07 20:48:08 +0200408static int
409clk_mux_determine_rate_flags(struct clk_hw *hw, struct clk_rate_request *req,
Stephen Boyd15a02c12015-01-19 18:05:28 -0800410 unsigned long flags)
James Hogane366fdd2013-07-29 12:25:02 +0100411{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100412 struct clk_core *core = hw->core, *parent, *best_parent = NULL;
Boris Brezillon0817b622015-07-07 20:48:08 +0200413 int i, num_parents, ret;
414 unsigned long best = 0;
415 struct clk_rate_request parent_req = *req;
James Hogane366fdd2013-07-29 12:25:02 +0100416
417 /* if NO_REPARENT flag set, pass through to current parent */
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100418 if (core->flags & CLK_SET_RATE_NO_REPARENT) {
419 parent = core->parent;
Boris Brezillon0817b622015-07-07 20:48:08 +0200420 if (core->flags & CLK_SET_RATE_PARENT) {
421 ret = __clk_determine_rate(parent ? parent->hw : NULL,
422 &parent_req);
423 if (ret)
424 return ret;
425
426 best = parent_req.rate;
427 } else if (parent) {
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100428 best = clk_core_get_rate_nolock(parent);
Boris Brezillon0817b622015-07-07 20:48:08 +0200429 } else {
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100430 best = clk_core_get_rate_nolock(core);
Boris Brezillon0817b622015-07-07 20:48:08 +0200431 }
432
James Hogane366fdd2013-07-29 12:25:02 +0100433 goto out;
434 }
435
436 /* find the parent that can provide the fastest rate <= rate */
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100437 num_parents = core->num_parents;
James Hogane366fdd2013-07-29 12:25:02 +0100438 for (i = 0; i < num_parents; i++) {
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100439 parent = clk_core_get_parent_by_index(core, i);
James Hogane366fdd2013-07-29 12:25:02 +0100440 if (!parent)
441 continue;
Boris Brezillon0817b622015-07-07 20:48:08 +0200442
443 if (core->flags & CLK_SET_RATE_PARENT) {
444 parent_req = *req;
445 ret = __clk_determine_rate(parent->hw, &parent_req);
446 if (ret)
447 continue;
448 } else {
449 parent_req.rate = clk_core_get_rate_nolock(parent);
450 }
451
452 if (mux_is_better_rate(req->rate, parent_req.rate,
453 best, flags)) {
James Hogane366fdd2013-07-29 12:25:02 +0100454 best_parent = parent;
Boris Brezillon0817b622015-07-07 20:48:08 +0200455 best = parent_req.rate;
James Hogane366fdd2013-07-29 12:25:02 +0100456 }
457 }
458
Boris Brezillon57d866e2015-07-09 22:39:38 +0200459 if (!best_parent)
460 return -EINVAL;
461
James Hogane366fdd2013-07-29 12:25:02 +0100462out:
463 if (best_parent)
Boris Brezillon0817b622015-07-07 20:48:08 +0200464 req->best_parent_hw = best_parent->hw;
465 req->best_parent_rate = best;
466 req->rate = best;
James Hogane366fdd2013-07-29 12:25:02 +0100467
Boris Brezillon0817b622015-07-07 20:48:08 +0200468 return 0;
James Hogane366fdd2013-07-29 12:25:02 +0100469}
Stephen Boyd15a02c12015-01-19 18:05:28 -0800470
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100471struct clk *__clk_lookup(const char *name)
472{
473 struct clk_core *core = clk_core_lookup(name);
474
475 return !core ? NULL : core->hw->clk;
476}
477
Stephen Boydd6968fc2015-04-30 13:54:13 -0700478static void clk_core_get_boundaries(struct clk_core *core,
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100479 unsigned long *min_rate,
480 unsigned long *max_rate)
481{
482 struct clk *clk_user;
483
Stephen Boyd9783c0d2015-07-16 12:50:27 -0700484 *min_rate = core->min_rate;
485 *max_rate = core->max_rate;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100486
Stephen Boydd6968fc2015-04-30 13:54:13 -0700487 hlist_for_each_entry(clk_user, &core->clks, clks_node)
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100488 *min_rate = max(*min_rate, clk_user->min_rate);
489
Stephen Boydd6968fc2015-04-30 13:54:13 -0700490 hlist_for_each_entry(clk_user, &core->clks, clks_node)
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100491 *max_rate = min(*max_rate, clk_user->max_rate);
492}
493
Stephen Boyd9783c0d2015-07-16 12:50:27 -0700494void clk_hw_set_rate_range(struct clk_hw *hw, unsigned long min_rate,
495 unsigned long max_rate)
496{
497 hw->core->min_rate = min_rate;
498 hw->core->max_rate = max_rate;
499}
500EXPORT_SYMBOL_GPL(clk_hw_set_rate_range);
501
Stephen Boyd15a02c12015-01-19 18:05:28 -0800502/*
503 * Helper for finding best parent to provide a given frequency. This can be used
504 * directly as a determine_rate callback (e.g. for a mux), or from a more
505 * complex clock that may combine a mux with other operations.
506 */
Boris Brezillon0817b622015-07-07 20:48:08 +0200507int __clk_mux_determine_rate(struct clk_hw *hw,
508 struct clk_rate_request *req)
Stephen Boyd15a02c12015-01-19 18:05:28 -0800509{
Boris Brezillon0817b622015-07-07 20:48:08 +0200510 return clk_mux_determine_rate_flags(hw, req, 0);
Stephen Boyd15a02c12015-01-19 18:05:28 -0800511}
Stephen Boyd0b7f04b2014-01-17 19:47:17 -0800512EXPORT_SYMBOL_GPL(__clk_mux_determine_rate);
James Hogane366fdd2013-07-29 12:25:02 +0100513
Boris Brezillon0817b622015-07-07 20:48:08 +0200514int __clk_mux_determine_rate_closest(struct clk_hw *hw,
515 struct clk_rate_request *req)
Stephen Boyd15a02c12015-01-19 18:05:28 -0800516{
Boris Brezillon0817b622015-07-07 20:48:08 +0200517 return clk_mux_determine_rate_flags(hw, req, CLK_MUX_ROUND_CLOSEST);
Stephen Boyd15a02c12015-01-19 18:05:28 -0800518}
519EXPORT_SYMBOL_GPL(__clk_mux_determine_rate_closest);
520
Mike Turquetteb24764902012-03-15 23:11:19 -0700521/*** clk api ***/
522
Stephen Boydd6968fc2015-04-30 13:54:13 -0700523static void clk_core_unprepare(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700524{
Stephen Boyda6334722015-05-06 17:00:54 -0700525 lockdep_assert_held(&prepare_lock);
526
Stephen Boydd6968fc2015-04-30 13:54:13 -0700527 if (!core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700528 return;
529
Stephen Boydd6968fc2015-04-30 13:54:13 -0700530 if (WARN_ON(core->prepare_count == 0))
Mike Turquetteb24764902012-03-15 23:11:19 -0700531 return;
532
Lee Jones2e20fbf2016-02-11 13:19:10 -0800533 if (WARN_ON(core->prepare_count == 1 && core->flags & CLK_IS_CRITICAL))
534 return;
535
Stephen Boydd6968fc2015-04-30 13:54:13 -0700536 if (--core->prepare_count > 0)
Mike Turquetteb24764902012-03-15 23:11:19 -0700537 return;
538
Stephen Boydd6968fc2015-04-30 13:54:13 -0700539 WARN_ON(core->enable_count > 0);
Mike Turquetteb24764902012-03-15 23:11:19 -0700540
Stephen Boydd6968fc2015-04-30 13:54:13 -0700541 trace_clk_unprepare(core);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800542
Stephen Boydd6968fc2015-04-30 13:54:13 -0700543 if (core->ops->unprepare)
544 core->ops->unprepare(core->hw);
Mike Turquetteb24764902012-03-15 23:11:19 -0700545
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200546 clk_pm_runtime_put(core);
547
Stephen Boydd6968fc2015-04-30 13:54:13 -0700548 trace_clk_unprepare_complete(core);
549 clk_core_unprepare(core->parent);
Mike Turquetteb24764902012-03-15 23:11:19 -0700550}
551
Dong Aishenga6adc302016-06-30 17:31:11 +0800552static void clk_core_unprepare_lock(struct clk_core *core)
553{
554 clk_prepare_lock();
555 clk_core_unprepare(core);
556 clk_prepare_unlock();
557}
558
Mike Turquetteb24764902012-03-15 23:11:19 -0700559/**
560 * clk_unprepare - undo preparation of a clock source
Peter Meerwald24ee1a02013-06-29 15:14:19 +0200561 * @clk: the clk being unprepared
Mike Turquetteb24764902012-03-15 23:11:19 -0700562 *
563 * clk_unprepare may sleep, which differentiates it from clk_disable. In a
564 * simple case, clk_unprepare can be used instead of clk_disable to gate a clk
565 * if the operation may sleep. One example is a clk which is accessed over
566 * I2c. In the complex case a clk gate operation may require a fast and a slow
567 * part. It is this reason that clk_unprepare and clk_disable are not mutually
568 * exclusive. In fact clk_disable must be called before clk_unprepare.
569 */
570void clk_unprepare(struct clk *clk)
571{
Stephen Boyd63589e92014-03-26 16:06:37 -0700572 if (IS_ERR_OR_NULL(clk))
573 return;
574
Dong Aishenga6adc302016-06-30 17:31:11 +0800575 clk_core_unprepare_lock(clk->core);
Mike Turquetteb24764902012-03-15 23:11:19 -0700576}
577EXPORT_SYMBOL_GPL(clk_unprepare);
578
Stephen Boydd6968fc2015-04-30 13:54:13 -0700579static int clk_core_prepare(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700580{
581 int ret = 0;
582
Stephen Boyda6334722015-05-06 17:00:54 -0700583 lockdep_assert_held(&prepare_lock);
584
Stephen Boydd6968fc2015-04-30 13:54:13 -0700585 if (!core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700586 return 0;
587
Stephen Boydd6968fc2015-04-30 13:54:13 -0700588 if (core->prepare_count == 0) {
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200589 ret = clk_pm_runtime_get(core);
Mike Turquetteb24764902012-03-15 23:11:19 -0700590 if (ret)
591 return ret;
592
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200593 ret = clk_core_prepare(core->parent);
594 if (ret)
595 goto runtime_put;
596
Stephen Boydd6968fc2015-04-30 13:54:13 -0700597 trace_clk_prepare(core);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800598
Stephen Boydd6968fc2015-04-30 13:54:13 -0700599 if (core->ops->prepare)
600 ret = core->ops->prepare(core->hw);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800601
Stephen Boydd6968fc2015-04-30 13:54:13 -0700602 trace_clk_prepare_complete(core);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800603
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200604 if (ret)
605 goto unprepare;
Mike Turquetteb24764902012-03-15 23:11:19 -0700606 }
607
Stephen Boydd6968fc2015-04-30 13:54:13 -0700608 core->prepare_count++;
Mike Turquetteb24764902012-03-15 23:11:19 -0700609
610 return 0;
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200611unprepare:
612 clk_core_unprepare(core->parent);
613runtime_put:
614 clk_pm_runtime_put(core);
615 return ret;
Mike Turquetteb24764902012-03-15 23:11:19 -0700616}
617
Dong Aishenga6adc302016-06-30 17:31:11 +0800618static int clk_core_prepare_lock(struct clk_core *core)
619{
620 int ret;
621
622 clk_prepare_lock();
623 ret = clk_core_prepare(core);
624 clk_prepare_unlock();
625
626 return ret;
627}
628
Mike Turquetteb24764902012-03-15 23:11:19 -0700629/**
630 * clk_prepare - prepare a clock source
631 * @clk: the clk being prepared
632 *
633 * clk_prepare may sleep, which differentiates it from clk_enable. In a simple
634 * case, clk_prepare can be used instead of clk_enable to ungate a clk if the
635 * operation may sleep. One example is a clk which is accessed over I2c. In
636 * the complex case a clk ungate operation may require a fast and a slow part.
637 * It is this reason that clk_prepare and clk_enable are not mutually
638 * exclusive. In fact clk_prepare must be called before clk_enable.
639 * Returns 0 on success, -EERROR otherwise.
640 */
641int clk_prepare(struct clk *clk)
642{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100643 if (!clk)
644 return 0;
645
Dong Aishenga6adc302016-06-30 17:31:11 +0800646 return clk_core_prepare_lock(clk->core);
Mike Turquetteb24764902012-03-15 23:11:19 -0700647}
648EXPORT_SYMBOL_GPL(clk_prepare);
649
Stephen Boydd6968fc2015-04-30 13:54:13 -0700650static void clk_core_disable(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700651{
Stephen Boyda6334722015-05-06 17:00:54 -0700652 lockdep_assert_held(&enable_lock);
653
Stephen Boydd6968fc2015-04-30 13:54:13 -0700654 if (!core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700655 return;
656
Stephen Boydd6968fc2015-04-30 13:54:13 -0700657 if (WARN_ON(core->enable_count == 0))
Mike Turquetteb24764902012-03-15 23:11:19 -0700658 return;
659
Lee Jones2e20fbf2016-02-11 13:19:10 -0800660 if (WARN_ON(core->enable_count == 1 && core->flags & CLK_IS_CRITICAL))
661 return;
662
Stephen Boydd6968fc2015-04-30 13:54:13 -0700663 if (--core->enable_count > 0)
Mike Turquetteb24764902012-03-15 23:11:19 -0700664 return;
665
Paul E. McKenney2f87a6e2016-04-26 12:43:57 -0700666 trace_clk_disable_rcuidle(core);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800667
Stephen Boydd6968fc2015-04-30 13:54:13 -0700668 if (core->ops->disable)
669 core->ops->disable(core->hw);
Mike Turquetteb24764902012-03-15 23:11:19 -0700670
Paul E. McKenney2f87a6e2016-04-26 12:43:57 -0700671 trace_clk_disable_complete_rcuidle(core);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800672
Stephen Boydd6968fc2015-04-30 13:54:13 -0700673 clk_core_disable(core->parent);
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100674}
675
Dong Aishenga6adc302016-06-30 17:31:11 +0800676static void clk_core_disable_lock(struct clk_core *core)
677{
678 unsigned long flags;
679
680 flags = clk_enable_lock();
681 clk_core_disable(core);
682 clk_enable_unlock(flags);
683}
684
Mike Turquetteb24764902012-03-15 23:11:19 -0700685/**
686 * clk_disable - gate a clock
687 * @clk: the clk being gated
688 *
689 * clk_disable must not sleep, which differentiates it from clk_unprepare. In
690 * a simple case, clk_disable can be used instead of clk_unprepare to gate a
691 * clk if the operation is fast and will never sleep. One example is a
692 * SoC-internal clk which is controlled via simple register writes. In the
693 * complex case a clk gate operation may require a fast and a slow part. It is
694 * this reason that clk_unprepare and clk_disable are not mutually exclusive.
695 * In fact clk_disable must be called before clk_unprepare.
696 */
697void clk_disable(struct clk *clk)
698{
Stephen Boyd63589e92014-03-26 16:06:37 -0700699 if (IS_ERR_OR_NULL(clk))
700 return;
701
Dong Aishenga6adc302016-06-30 17:31:11 +0800702 clk_core_disable_lock(clk->core);
Mike Turquetteb24764902012-03-15 23:11:19 -0700703}
704EXPORT_SYMBOL_GPL(clk_disable);
705
Stephen Boydd6968fc2015-04-30 13:54:13 -0700706static int clk_core_enable(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700707{
708 int ret = 0;
709
Stephen Boyda6334722015-05-06 17:00:54 -0700710 lockdep_assert_held(&enable_lock);
711
Stephen Boydd6968fc2015-04-30 13:54:13 -0700712 if (!core)
Mike Turquetteb24764902012-03-15 23:11:19 -0700713 return 0;
714
Stephen Boydd6968fc2015-04-30 13:54:13 -0700715 if (WARN_ON(core->prepare_count == 0))
Mike Turquetteb24764902012-03-15 23:11:19 -0700716 return -ESHUTDOWN;
717
Stephen Boydd6968fc2015-04-30 13:54:13 -0700718 if (core->enable_count == 0) {
719 ret = clk_core_enable(core->parent);
Mike Turquetteb24764902012-03-15 23:11:19 -0700720
721 if (ret)
722 return ret;
723
Paul E. McKenneyf17a0dd2016-04-26 14:02:23 -0700724 trace_clk_enable_rcuidle(core);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800725
Stephen Boydd6968fc2015-04-30 13:54:13 -0700726 if (core->ops->enable)
727 ret = core->ops->enable(core->hw);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800728
Paul E. McKenneyf17a0dd2016-04-26 14:02:23 -0700729 trace_clk_enable_complete_rcuidle(core);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800730
731 if (ret) {
Stephen Boydd6968fc2015-04-30 13:54:13 -0700732 clk_core_disable(core->parent);
Stephen Boyddfc202e2015-02-02 14:37:41 -0800733 return ret;
Mike Turquetteb24764902012-03-15 23:11:19 -0700734 }
735 }
736
Stephen Boydd6968fc2015-04-30 13:54:13 -0700737 core->enable_count++;
Mike Turquetteb24764902012-03-15 23:11:19 -0700738 return 0;
739}
740
Dong Aishenga6adc302016-06-30 17:31:11 +0800741static int clk_core_enable_lock(struct clk_core *core)
742{
743 unsigned long flags;
744 int ret;
745
746 flags = clk_enable_lock();
747 ret = clk_core_enable(core);
748 clk_enable_unlock(flags);
749
750 return ret;
751}
752
Mike Turquetteb24764902012-03-15 23:11:19 -0700753/**
754 * clk_enable - ungate a clock
755 * @clk: the clk being ungated
756 *
757 * clk_enable must not sleep, which differentiates it from clk_prepare. In a
758 * simple case, clk_enable can be used instead of clk_prepare to ungate a clk
759 * if the operation will never sleep. One example is a SoC-internal clk which
760 * is controlled via simple register writes. In the complex case a clk ungate
761 * operation may require a fast and a slow part. It is this reason that
762 * clk_enable and clk_prepare are not mutually exclusive. In fact clk_prepare
763 * must be called before clk_enable. Returns 0 on success, -EERROR
764 * otherwise.
765 */
766int clk_enable(struct clk *clk)
767{
Dong Aisheng864e1602015-04-30 14:02:19 -0700768 if (!clk)
769 return 0;
770
Dong Aishenga6adc302016-06-30 17:31:11 +0800771 return clk_core_enable_lock(clk->core);
772}
773EXPORT_SYMBOL_GPL(clk_enable);
774
775static int clk_core_prepare_enable(struct clk_core *core)
776{
777 int ret;
778
779 ret = clk_core_prepare_lock(core);
780 if (ret)
781 return ret;
782
783 ret = clk_core_enable_lock(core);
784 if (ret)
785 clk_core_unprepare_lock(core);
Mike Turquetteb24764902012-03-15 23:11:19 -0700786
787 return ret;
788}
Dong Aishenga6adc302016-06-30 17:31:11 +0800789
790static void clk_core_disable_unprepare(struct clk_core *core)
791{
792 clk_core_disable_lock(core);
793 clk_core_unprepare_lock(core);
794}
Mike Turquetteb24764902012-03-15 23:11:19 -0700795
Dong Aisheng7ec986e2016-06-30 17:31:12 +0800796static void clk_unprepare_unused_subtree(struct clk_core *core)
797{
798 struct clk_core *child;
799
800 lockdep_assert_held(&prepare_lock);
801
802 hlist_for_each_entry(child, &core->children, child_node)
803 clk_unprepare_unused_subtree(child);
804
805 if (core->prepare_count)
806 return;
807
808 if (core->flags & CLK_IGNORE_UNUSED)
809 return;
810
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200811 if (clk_pm_runtime_get(core))
812 return;
813
Dong Aisheng7ec986e2016-06-30 17:31:12 +0800814 if (clk_core_is_prepared(core)) {
815 trace_clk_unprepare(core);
816 if (core->ops->unprepare_unused)
817 core->ops->unprepare_unused(core->hw);
818 else if (core->ops->unprepare)
819 core->ops->unprepare(core->hw);
820 trace_clk_unprepare_complete(core);
821 }
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200822
823 clk_pm_runtime_put(core);
Dong Aisheng7ec986e2016-06-30 17:31:12 +0800824}
825
826static void clk_disable_unused_subtree(struct clk_core *core)
827{
828 struct clk_core *child;
829 unsigned long flags;
830
831 lockdep_assert_held(&prepare_lock);
832
833 hlist_for_each_entry(child, &core->children, child_node)
834 clk_disable_unused_subtree(child);
835
Dong Aishenga4b35182016-06-30 17:31:13 +0800836 if (core->flags & CLK_OPS_PARENT_ENABLE)
837 clk_core_prepare_enable(core->parent);
838
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200839 if (clk_pm_runtime_get(core))
840 goto unprepare_out;
841
Dong Aisheng7ec986e2016-06-30 17:31:12 +0800842 flags = clk_enable_lock();
843
844 if (core->enable_count)
845 goto unlock_out;
846
847 if (core->flags & CLK_IGNORE_UNUSED)
848 goto unlock_out;
849
850 /*
851 * some gate clocks have special needs during the disable-unused
852 * sequence. call .disable_unused if available, otherwise fall
853 * back to .disable
854 */
855 if (clk_core_is_enabled(core)) {
856 trace_clk_disable(core);
857 if (core->ops->disable_unused)
858 core->ops->disable_unused(core->hw);
859 else if (core->ops->disable)
860 core->ops->disable(core->hw);
861 trace_clk_disable_complete(core);
862 }
863
864unlock_out:
865 clk_enable_unlock(flags);
Marek Szyprowski9a34b452017-08-21 10:04:59 +0200866 clk_pm_runtime_put(core);
867unprepare_out:
Dong Aishenga4b35182016-06-30 17:31:13 +0800868 if (core->flags & CLK_OPS_PARENT_ENABLE)
869 clk_core_disable_unprepare(core->parent);
Dong Aisheng7ec986e2016-06-30 17:31:12 +0800870}
871
872static bool clk_ignore_unused;
873static int __init clk_ignore_unused_setup(char *__unused)
874{
875 clk_ignore_unused = true;
876 return 1;
877}
878__setup("clk_ignore_unused", clk_ignore_unused_setup);
879
880static int clk_disable_unused(void)
881{
882 struct clk_core *core;
883
884 if (clk_ignore_unused) {
885 pr_warn("clk: Not disabling unused clocks\n");
886 return 0;
887 }
888
889 clk_prepare_lock();
890
891 hlist_for_each_entry(core, &clk_root_list, child_node)
892 clk_disable_unused_subtree(core);
893
894 hlist_for_each_entry(core, &clk_orphan_list, child_node)
895 clk_disable_unused_subtree(core);
896
897 hlist_for_each_entry(core, &clk_root_list, child_node)
898 clk_unprepare_unused_subtree(core);
899
900 hlist_for_each_entry(core, &clk_orphan_list, child_node)
901 clk_unprepare_unused_subtree(core);
902
903 clk_prepare_unlock();
904
905 return 0;
906}
907late_initcall_sync(clk_disable_unused);
908
Boris Brezillon0817b622015-07-07 20:48:08 +0200909static int clk_core_round_rate_nolock(struct clk_core *core,
910 struct clk_rate_request *req)
Mike Turquetteb24764902012-03-15 23:11:19 -0700911{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100912 struct clk_core *parent;
Boris Brezillon0817b622015-07-07 20:48:08 +0200913 long rate;
Mike Turquetteb24764902012-03-15 23:11:19 -0700914
Krzysztof Kozlowski496eadf2015-01-09 09:28:10 +0100915 lockdep_assert_held(&prepare_lock);
916
Stephen Boydd6968fc2015-04-30 13:54:13 -0700917 if (!core)
Stephen Boyd2ac6b1f2012-10-03 23:38:55 -0700918 return 0;
Mike Turquetteb24764902012-03-15 23:11:19 -0700919
Stephen Boydd6968fc2015-04-30 13:54:13 -0700920 parent = core->parent;
Boris Brezillon0817b622015-07-07 20:48:08 +0200921 if (parent) {
922 req->best_parent_hw = parent->hw;
923 req->best_parent_rate = parent->rate;
924 } else {
925 req->best_parent_hw = NULL;
926 req->best_parent_rate = 0;
927 }
Mike Turquetteb24764902012-03-15 23:11:19 -0700928
Stephen Boydd6968fc2015-04-30 13:54:13 -0700929 if (core->ops->determine_rate) {
Boris Brezillon0817b622015-07-07 20:48:08 +0200930 return core->ops->determine_rate(core->hw, req);
931 } else if (core->ops->round_rate) {
932 rate = core->ops->round_rate(core->hw, req->rate,
933 &req->best_parent_rate);
934 if (rate < 0)
935 return rate;
936
937 req->rate = rate;
938 } else if (core->flags & CLK_SET_RATE_PARENT) {
939 return clk_core_round_rate_nolock(parent, req);
940 } else {
941 req->rate = core->rate;
942 }
943
944 return 0;
Mike Turquetteb24764902012-03-15 23:11:19 -0700945}
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100946
947/**
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100948 * __clk_determine_rate - get the closest rate actually supported by a clock
949 * @hw: determine the rate of this clock
Peng Fan2d5b5202016-06-13 19:34:21 +0800950 * @req: target rate request
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100951 *
Stephen Boyd6e5ab412015-04-30 15:11:31 -0700952 * Useful for clk_ops such as .set_rate and .determine_rate.
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100953 */
Boris Brezillon0817b622015-07-07 20:48:08 +0200954int __clk_determine_rate(struct clk_hw *hw, struct clk_rate_request *req)
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100955{
Boris Brezillon0817b622015-07-07 20:48:08 +0200956 if (!hw) {
957 req->rate = 0;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100958 return 0;
Boris Brezillon0817b622015-07-07 20:48:08 +0200959 }
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100960
Boris Brezillon0817b622015-07-07 20:48:08 +0200961 return clk_core_round_rate_nolock(hw->core, req);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +0100962}
963EXPORT_SYMBOL_GPL(__clk_determine_rate);
964
Stephen Boyd1a9c0692015-06-25 15:55:14 -0700965unsigned long clk_hw_round_rate(struct clk_hw *hw, unsigned long rate)
966{
967 int ret;
968 struct clk_rate_request req;
969
970 clk_core_get_boundaries(hw->core, &req.min_rate, &req.max_rate);
971 req.rate = rate;
972
973 ret = clk_core_round_rate_nolock(hw->core, &req);
974 if (ret)
975 return 0;
976
977 return req.rate;
978}
979EXPORT_SYMBOL_GPL(clk_hw_round_rate);
980
Mike Turquetteb24764902012-03-15 23:11:19 -0700981/**
982 * clk_round_rate - round the given rate for a clk
983 * @clk: the clk for which we are rounding a rate
984 * @rate: the rate which is to be rounded
985 *
986 * Takes in a rate as input and rounds it to a rate that the clk can actually
987 * use which is then returned. If clk doesn't support round_rate operation
988 * then the parent rate is returned.
989 */
990long clk_round_rate(struct clk *clk, unsigned long rate)
991{
Stephen Boydfc4a05d2015-06-25 17:24:15 -0700992 struct clk_rate_request req;
993 int ret;
Mike Turquetteb24764902012-03-15 23:11:19 -0700994
Tomeu Vizoso035a61c2015-01-23 12:03:30 +0100995 if (!clk)
996 return 0;
997
Mike Turquetteeab89f62013-03-28 13:59:01 -0700998 clk_prepare_lock();
Stephen Boydfc4a05d2015-06-25 17:24:15 -0700999
1000 clk_core_get_boundaries(clk->core, &req.min_rate, &req.max_rate);
1001 req.rate = rate;
1002
1003 ret = clk_core_round_rate_nolock(clk->core, &req);
Mike Turquetteeab89f62013-03-28 13:59:01 -07001004 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001005
Stephen Boydfc4a05d2015-06-25 17:24:15 -07001006 if (ret)
1007 return ret;
1008
1009 return req.rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07001010}
1011EXPORT_SYMBOL_GPL(clk_round_rate);
1012
1013/**
1014 * __clk_notify - call clk notifier chain
Stephen Boydd6968fc2015-04-30 13:54:13 -07001015 * @core: clk that is changing rate
Mike Turquetteb24764902012-03-15 23:11:19 -07001016 * @msg: clk notifier type (see include/linux/clk.h)
1017 * @old_rate: old clk rate
1018 * @new_rate: new clk rate
1019 *
1020 * Triggers a notifier call chain on the clk rate-change notification
1021 * for 'clk'. Passes a pointer to the struct clk and the previous
1022 * and current rates to the notifier callback. Intended to be called by
1023 * internal clock code only. Returns NOTIFY_DONE from the last driver
1024 * called if all went well, or NOTIFY_STOP or NOTIFY_BAD immediately if
1025 * a driver returns that.
1026 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001027static int __clk_notify(struct clk_core *core, unsigned long msg,
Mike Turquetteb24764902012-03-15 23:11:19 -07001028 unsigned long old_rate, unsigned long new_rate)
1029{
1030 struct clk_notifier *cn;
1031 struct clk_notifier_data cnd;
1032 int ret = NOTIFY_DONE;
1033
Mike Turquetteb24764902012-03-15 23:11:19 -07001034 cnd.old_rate = old_rate;
1035 cnd.new_rate = new_rate;
1036
1037 list_for_each_entry(cn, &clk_notifier_list, node) {
Stephen Boydd6968fc2015-04-30 13:54:13 -07001038 if (cn->clk->core == core) {
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001039 cnd.clk = cn->clk;
Mike Turquetteb24764902012-03-15 23:11:19 -07001040 ret = srcu_notifier_call_chain(&cn->notifier_head, msg,
1041 &cnd);
Peter De Schrijver17c34c52017-03-21 12:16:26 +02001042 if (ret & NOTIFY_STOP_MASK)
1043 return ret;
Mike Turquetteb24764902012-03-15 23:11:19 -07001044 }
1045 }
1046
1047 return ret;
1048}
1049
1050/**
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001051 * __clk_recalc_accuracies
Stephen Boydd6968fc2015-04-30 13:54:13 -07001052 * @core: first clk in the subtree
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001053 *
1054 * Walks the subtree of clks starting with clk and recalculates accuracies as
1055 * it goes. Note that if a clk does not implement the .recalc_accuracy
Stephen Boyd6e5ab412015-04-30 15:11:31 -07001056 * callback then it is assumed that the clock will take on the accuracy of its
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001057 * parent.
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001058 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001059static void __clk_recalc_accuracies(struct clk_core *core)
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001060{
1061 unsigned long parent_accuracy = 0;
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001062 struct clk_core *child;
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001063
Krzysztof Kozlowski496eadf2015-01-09 09:28:10 +01001064 lockdep_assert_held(&prepare_lock);
1065
Stephen Boydd6968fc2015-04-30 13:54:13 -07001066 if (core->parent)
1067 parent_accuracy = core->parent->accuracy;
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001068
Stephen Boydd6968fc2015-04-30 13:54:13 -07001069 if (core->ops->recalc_accuracy)
1070 core->accuracy = core->ops->recalc_accuracy(core->hw,
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001071 parent_accuracy);
1072 else
Stephen Boydd6968fc2015-04-30 13:54:13 -07001073 core->accuracy = parent_accuracy;
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001074
Stephen Boydd6968fc2015-04-30 13:54:13 -07001075 hlist_for_each_entry(child, &core->children, child_node)
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001076 __clk_recalc_accuracies(child);
1077}
1078
Stephen Boydd6968fc2015-04-30 13:54:13 -07001079static long clk_core_get_accuracy(struct clk_core *core)
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001080{
1081 unsigned long accuracy;
1082
1083 clk_prepare_lock();
Stephen Boydd6968fc2015-04-30 13:54:13 -07001084 if (core && (core->flags & CLK_GET_ACCURACY_NOCACHE))
1085 __clk_recalc_accuracies(core);
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001086
Stephen Boydd6968fc2015-04-30 13:54:13 -07001087 accuracy = __clk_get_accuracy(core);
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001088 clk_prepare_unlock();
1089
1090 return accuracy;
1091}
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001092
1093/**
1094 * clk_get_accuracy - return the accuracy of clk
1095 * @clk: the clk whose accuracy is being returned
1096 *
1097 * Simply returns the cached accuracy of the clk, unless
1098 * CLK_GET_ACCURACY_NOCACHE flag is set, which means a recalc_rate will be
1099 * issued.
1100 * If clk is NULL then returns 0.
1101 */
1102long clk_get_accuracy(struct clk *clk)
1103{
1104 if (!clk)
1105 return 0;
1106
1107 return clk_core_get_accuracy(clk->core);
1108}
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001109EXPORT_SYMBOL_GPL(clk_get_accuracy);
1110
Stephen Boydd6968fc2015-04-30 13:54:13 -07001111static unsigned long clk_recalc(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001112 unsigned long parent_rate)
Stephen Boyd8f2c2db2014-03-26 16:06:36 -07001113{
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001114 unsigned long rate = parent_rate;
1115
1116 if (core->ops->recalc_rate && !clk_pm_runtime_get(core)) {
1117 rate = core->ops->recalc_rate(core->hw, parent_rate);
1118 clk_pm_runtime_put(core);
1119 }
1120 return rate;
Stephen Boyd8f2c2db2014-03-26 16:06:36 -07001121}
1122
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001123/**
Mike Turquetteb24764902012-03-15 23:11:19 -07001124 * __clk_recalc_rates
Stephen Boydd6968fc2015-04-30 13:54:13 -07001125 * @core: first clk in the subtree
Mike Turquetteb24764902012-03-15 23:11:19 -07001126 * @msg: notification type (see include/linux/clk.h)
1127 *
1128 * Walks the subtree of clks starting with clk and recalculates rates as it
1129 * goes. Note that if a clk does not implement the .recalc_rate callback then
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001130 * it is assumed that the clock will take on the rate of its parent.
Mike Turquetteb24764902012-03-15 23:11:19 -07001131 *
1132 * clk_recalc_rates also propagates the POST_RATE_CHANGE notification,
1133 * if necessary.
Mike Turquetteb24764902012-03-15 23:11:19 -07001134 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001135static void __clk_recalc_rates(struct clk_core *core, unsigned long msg)
Mike Turquetteb24764902012-03-15 23:11:19 -07001136{
1137 unsigned long old_rate;
1138 unsigned long parent_rate = 0;
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001139 struct clk_core *child;
Mike Turquetteb24764902012-03-15 23:11:19 -07001140
Krzysztof Kozlowski496eadf2015-01-09 09:28:10 +01001141 lockdep_assert_held(&prepare_lock);
1142
Stephen Boydd6968fc2015-04-30 13:54:13 -07001143 old_rate = core->rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07001144
Stephen Boydd6968fc2015-04-30 13:54:13 -07001145 if (core->parent)
1146 parent_rate = core->parent->rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07001147
Stephen Boydd6968fc2015-04-30 13:54:13 -07001148 core->rate = clk_recalc(core, parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001149
1150 /*
1151 * ignore NOTIFY_STOP and NOTIFY_BAD return values for POST_RATE_CHANGE
1152 * & ABORT_RATE_CHANGE notifiers
1153 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001154 if (core->notifier_count && msg)
1155 __clk_notify(core, msg, old_rate, core->rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001156
Stephen Boydd6968fc2015-04-30 13:54:13 -07001157 hlist_for_each_entry(child, &core->children, child_node)
Mike Turquetteb24764902012-03-15 23:11:19 -07001158 __clk_recalc_rates(child, msg);
1159}
1160
Stephen Boydd6968fc2015-04-30 13:54:13 -07001161static unsigned long clk_core_get_rate(struct clk_core *core)
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001162{
1163 unsigned long rate;
1164
1165 clk_prepare_lock();
1166
Stephen Boydd6968fc2015-04-30 13:54:13 -07001167 if (core && (core->flags & CLK_GET_RATE_NOCACHE))
1168 __clk_recalc_rates(core, 0);
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001169
Stephen Boydd6968fc2015-04-30 13:54:13 -07001170 rate = clk_core_get_rate_nolock(core);
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001171 clk_prepare_unlock();
1172
1173 return rate;
1174}
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001175
Mike Turquetteb24764902012-03-15 23:11:19 -07001176/**
Ulf Hanssona093bde2012-08-31 14:21:28 +02001177 * clk_get_rate - return the rate of clk
1178 * @clk: the clk whose rate is being returned
1179 *
1180 * Simply returns the cached rate of the clk, unless CLK_GET_RATE_NOCACHE flag
1181 * is set, which means a recalc_rate will be issued.
1182 * If clk is NULL then returns 0.
1183 */
1184unsigned long clk_get_rate(struct clk *clk)
1185{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001186 if (!clk)
1187 return 0;
Ulf Hanssona093bde2012-08-31 14:21:28 +02001188
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001189 return clk_core_get_rate(clk->core);
Ulf Hanssona093bde2012-08-31 14:21:28 +02001190}
1191EXPORT_SYMBOL_GPL(clk_get_rate);
1192
Stephen Boydd6968fc2015-04-30 13:54:13 -07001193static int clk_fetch_parent_index(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001194 struct clk_core *parent)
James Hogan4935b222013-07-29 12:24:59 +01001195{
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001196 int i;
James Hogan4935b222013-07-29 12:24:59 +01001197
Masahiro Yamada508f8842015-12-28 19:23:08 +09001198 if (!parent)
1199 return -EINVAL;
1200
Masahiro Yamada470b5e22015-12-28 19:23:09 +09001201 for (i = 0; i < core->num_parents; i++)
1202 if (clk_core_get_parent_by_index(core, i) == parent)
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001203 return i;
Tomasz Figada0f0b22013-09-29 02:37:16 +02001204
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001205 return -EINVAL;
James Hogan4935b222013-07-29 12:24:59 +01001206}
1207
Heiko Stuebnere6500342015-04-22 22:53:05 +02001208/*
1209 * Update the orphan status of @core and all its children.
1210 */
1211static void clk_core_update_orphan_status(struct clk_core *core, bool is_orphan)
1212{
1213 struct clk_core *child;
1214
1215 core->orphan = is_orphan;
1216
1217 hlist_for_each_entry(child, &core->children, child_node)
1218 clk_core_update_orphan_status(child, is_orphan);
1219}
1220
Stephen Boydd6968fc2015-04-30 13:54:13 -07001221static void clk_reparent(struct clk_core *core, struct clk_core *new_parent)
James Hogan4935b222013-07-29 12:24:59 +01001222{
Heiko Stuebnere6500342015-04-22 22:53:05 +02001223 bool was_orphan = core->orphan;
1224
Stephen Boydd6968fc2015-04-30 13:54:13 -07001225 hlist_del(&core->child_node);
James Hogan4935b222013-07-29 12:24:59 +01001226
James Hogan903efc52013-08-29 12:10:51 +01001227 if (new_parent) {
Heiko Stuebnere6500342015-04-22 22:53:05 +02001228 bool becomes_orphan = new_parent->orphan;
1229
James Hogan903efc52013-08-29 12:10:51 +01001230 /* avoid duplicate POST_RATE_CHANGE notifications */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001231 if (new_parent->new_child == core)
James Hogan903efc52013-08-29 12:10:51 +01001232 new_parent->new_child = NULL;
1233
Stephen Boydd6968fc2015-04-30 13:54:13 -07001234 hlist_add_head(&core->child_node, &new_parent->children);
Heiko Stuebnere6500342015-04-22 22:53:05 +02001235
1236 if (was_orphan != becomes_orphan)
1237 clk_core_update_orphan_status(core, becomes_orphan);
James Hogan903efc52013-08-29 12:10:51 +01001238 } else {
Stephen Boydd6968fc2015-04-30 13:54:13 -07001239 hlist_add_head(&core->child_node, &clk_orphan_list);
Heiko Stuebnere6500342015-04-22 22:53:05 +02001240 if (!was_orphan)
1241 clk_core_update_orphan_status(core, true);
James Hogan903efc52013-08-29 12:10:51 +01001242 }
James Hogan4935b222013-07-29 12:24:59 +01001243
Stephen Boydd6968fc2015-04-30 13:54:13 -07001244 core->parent = new_parent;
James Hogan4935b222013-07-29 12:24:59 +01001245}
1246
Stephen Boydd6968fc2015-04-30 13:54:13 -07001247static struct clk_core *__clk_set_parent_before(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001248 struct clk_core *parent)
James Hogan4935b222013-07-29 12:24:59 +01001249{
1250 unsigned long flags;
Stephen Boydd6968fc2015-04-30 13:54:13 -07001251 struct clk_core *old_parent = core->parent;
James Hogan4935b222013-07-29 12:24:59 +01001252
1253 /*
Dong Aishengfc8726a2016-06-30 17:31:14 +08001254 * 1. enable parents for CLK_OPS_PARENT_ENABLE clock
1255 *
1256 * 2. Migrate prepare state between parents and prevent race with
James Hogan4935b222013-07-29 12:24:59 +01001257 * clk_enable().
1258 *
1259 * If the clock is not prepared, then a race with
1260 * clk_enable/disable() is impossible since we already have the
1261 * prepare lock (future calls to clk_enable() need to be preceded by
1262 * a clk_prepare()).
1263 *
1264 * If the clock is prepared, migrate the prepared state to the new
1265 * parent and also protect against a race with clk_enable() by
1266 * forcing the clock and the new parent on. This ensures that all
1267 * future calls to clk_enable() are practically NOPs with respect to
1268 * hardware and software states.
1269 *
1270 * See also: Comment for clk_set_parent() below.
1271 */
Dong Aishengfc8726a2016-06-30 17:31:14 +08001272
1273 /* enable old_parent & parent if CLK_OPS_PARENT_ENABLE is set */
1274 if (core->flags & CLK_OPS_PARENT_ENABLE) {
1275 clk_core_prepare_enable(old_parent);
1276 clk_core_prepare_enable(parent);
1277 }
1278
1279 /* migrate prepare count if > 0 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001280 if (core->prepare_count) {
Dong Aishengfc8726a2016-06-30 17:31:14 +08001281 clk_core_prepare_enable(parent);
1282 clk_core_enable_lock(core);
James Hogan4935b222013-07-29 12:24:59 +01001283 }
1284
1285 /* update the clk tree topology */
1286 flags = clk_enable_lock();
Stephen Boydd6968fc2015-04-30 13:54:13 -07001287 clk_reparent(core, parent);
James Hogan4935b222013-07-29 12:24:59 +01001288 clk_enable_unlock(flags);
1289
Stephen Boyd3fa22522014-01-15 10:47:22 -08001290 return old_parent;
1291}
1292
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001293static void __clk_set_parent_after(struct clk_core *core,
1294 struct clk_core *parent,
1295 struct clk_core *old_parent)
Stephen Boyd3fa22522014-01-15 10:47:22 -08001296{
1297 /*
1298 * Finish the migration of prepare state and undo the changes done
1299 * for preventing a race with clk_enable().
1300 */
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001301 if (core->prepare_count) {
Dong Aishengfc8726a2016-06-30 17:31:14 +08001302 clk_core_disable_lock(core);
1303 clk_core_disable_unprepare(old_parent);
1304 }
1305
1306 /* re-balance ref counting if CLK_OPS_PARENT_ENABLE is set */
1307 if (core->flags & CLK_OPS_PARENT_ENABLE) {
1308 clk_core_disable_unprepare(parent);
1309 clk_core_disable_unprepare(old_parent);
Stephen Boyd3fa22522014-01-15 10:47:22 -08001310 }
Stephen Boyd3fa22522014-01-15 10:47:22 -08001311}
1312
Stephen Boydd6968fc2015-04-30 13:54:13 -07001313static int __clk_set_parent(struct clk_core *core, struct clk_core *parent,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001314 u8 p_index)
Stephen Boyd3fa22522014-01-15 10:47:22 -08001315{
1316 unsigned long flags;
1317 int ret = 0;
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001318 struct clk_core *old_parent;
Stephen Boyd3fa22522014-01-15 10:47:22 -08001319
Stephen Boydd6968fc2015-04-30 13:54:13 -07001320 old_parent = __clk_set_parent_before(core, parent);
Stephen Boyd3fa22522014-01-15 10:47:22 -08001321
Stephen Boydd6968fc2015-04-30 13:54:13 -07001322 trace_clk_set_parent(core, parent);
Stephen Boyddfc202e2015-02-02 14:37:41 -08001323
James Hogan4935b222013-07-29 12:24:59 +01001324 /* change clock input source */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001325 if (parent && core->ops->set_parent)
1326 ret = core->ops->set_parent(core->hw, p_index);
James Hogan4935b222013-07-29 12:24:59 +01001327
Stephen Boydd6968fc2015-04-30 13:54:13 -07001328 trace_clk_set_parent_complete(core, parent);
Stephen Boyddfc202e2015-02-02 14:37:41 -08001329
James Hogan4935b222013-07-29 12:24:59 +01001330 if (ret) {
1331 flags = clk_enable_lock();
Stephen Boydd6968fc2015-04-30 13:54:13 -07001332 clk_reparent(core, old_parent);
James Hogan4935b222013-07-29 12:24:59 +01001333 clk_enable_unlock(flags);
Dong Aishengc660b2eb2015-07-28 21:19:41 +08001334 __clk_set_parent_after(core, old_parent, parent);
James Hogan4935b222013-07-29 12:24:59 +01001335
James Hogan4935b222013-07-29 12:24:59 +01001336 return ret;
1337 }
1338
Stephen Boydd6968fc2015-04-30 13:54:13 -07001339 __clk_set_parent_after(core, parent, old_parent);
James Hogan4935b222013-07-29 12:24:59 +01001340
James Hogan4935b222013-07-29 12:24:59 +01001341 return 0;
1342}
1343
Ulf Hanssona093bde2012-08-31 14:21:28 +02001344/**
Mike Turquetteb24764902012-03-15 23:11:19 -07001345 * __clk_speculate_rates
Stephen Boydd6968fc2015-04-30 13:54:13 -07001346 * @core: first clk in the subtree
Mike Turquetteb24764902012-03-15 23:11:19 -07001347 * @parent_rate: the "future" rate of clk's parent
1348 *
1349 * Walks the subtree of clks starting with clk, speculating rates as it
1350 * goes and firing off PRE_RATE_CHANGE notifications as necessary.
1351 *
1352 * Unlike clk_recalc_rates, clk_speculate_rates exists only for sending
1353 * pre-rate change notifications and returns early if no clks in the
1354 * subtree have subscribed to the notifications. Note that if a clk does not
1355 * implement the .recalc_rate callback then it is assumed that the clock will
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001356 * take on the rate of its parent.
Mike Turquetteb24764902012-03-15 23:11:19 -07001357 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001358static int __clk_speculate_rates(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001359 unsigned long parent_rate)
Mike Turquetteb24764902012-03-15 23:11:19 -07001360{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001361 struct clk_core *child;
Mike Turquetteb24764902012-03-15 23:11:19 -07001362 unsigned long new_rate;
1363 int ret = NOTIFY_DONE;
1364
Krzysztof Kozlowski496eadf2015-01-09 09:28:10 +01001365 lockdep_assert_held(&prepare_lock);
1366
Stephen Boydd6968fc2015-04-30 13:54:13 -07001367 new_rate = clk_recalc(core, parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001368
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001369 /* abort rate change if a driver returns NOTIFY_BAD or NOTIFY_STOP */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001370 if (core->notifier_count)
1371 ret = __clk_notify(core, PRE_RATE_CHANGE, core->rate, new_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001372
Mike Turquette86bcfa22014-02-24 16:08:41 -08001373 if (ret & NOTIFY_STOP_MASK) {
1374 pr_debug("%s: clk notifier callback for clock %s aborted with error %d\n",
Stephen Boydd6968fc2015-04-30 13:54:13 -07001375 __func__, core->name, ret);
Mike Turquetteb24764902012-03-15 23:11:19 -07001376 goto out;
Mike Turquette86bcfa22014-02-24 16:08:41 -08001377 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001378
Stephen Boydd6968fc2015-04-30 13:54:13 -07001379 hlist_for_each_entry(child, &core->children, child_node) {
Mike Turquetteb24764902012-03-15 23:11:19 -07001380 ret = __clk_speculate_rates(child, new_rate);
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001381 if (ret & NOTIFY_STOP_MASK)
Mike Turquetteb24764902012-03-15 23:11:19 -07001382 break;
1383 }
1384
1385out:
1386 return ret;
1387}
1388
Stephen Boydd6968fc2015-04-30 13:54:13 -07001389static void clk_calc_subtree(struct clk_core *core, unsigned long new_rate,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001390 struct clk_core *new_parent, u8 p_index)
Mike Turquetteb24764902012-03-15 23:11:19 -07001391{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001392 struct clk_core *child;
Mike Turquetteb24764902012-03-15 23:11:19 -07001393
Stephen Boydd6968fc2015-04-30 13:54:13 -07001394 core->new_rate = new_rate;
1395 core->new_parent = new_parent;
1396 core->new_parent_index = p_index;
James Hogan71472c02013-07-29 12:25:00 +01001397 /* include clk in new parent's PRE_RATE_CHANGE notifications */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001398 core->new_child = NULL;
1399 if (new_parent && new_parent != core->parent)
1400 new_parent->new_child = core;
Mike Turquetteb24764902012-03-15 23:11:19 -07001401
Stephen Boydd6968fc2015-04-30 13:54:13 -07001402 hlist_for_each_entry(child, &core->children, child_node) {
Stephen Boyd8f2c2db2014-03-26 16:06:36 -07001403 child->new_rate = clk_recalc(child, new_rate);
James Hogan71472c02013-07-29 12:25:00 +01001404 clk_calc_subtree(child, child->new_rate, NULL, 0);
Mike Turquetteb24764902012-03-15 23:11:19 -07001405 }
1406}
1407
1408/*
1409 * calculate the new rates returning the topmost clock that has to be
1410 * changed.
1411 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001412static struct clk_core *clk_calc_new_rates(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001413 unsigned long rate)
Mike Turquetteb24764902012-03-15 23:11:19 -07001414{
Stephen Boydd6968fc2015-04-30 13:54:13 -07001415 struct clk_core *top = core;
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001416 struct clk_core *old_parent, *parent;
Shawn Guo81536e02012-04-12 20:50:17 +08001417 unsigned long best_parent_rate = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001418 unsigned long new_rate;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001419 unsigned long min_rate;
1420 unsigned long max_rate;
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001421 int p_index = 0;
Boris Brezillon03bc10a2015-03-29 03:48:48 +02001422 long ret;
Mike Turquetteb24764902012-03-15 23:11:19 -07001423
Mike Turquette7452b212012-03-26 14:45:36 -07001424 /* sanity */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001425 if (IS_ERR_OR_NULL(core))
Mike Turquette7452b212012-03-26 14:45:36 -07001426 return NULL;
1427
Mike Turquette63f5c3b2012-05-02 16:23:43 -07001428 /* save parent rate, if it exists */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001429 parent = old_parent = core->parent;
James Hogan71472c02013-07-29 12:25:00 +01001430 if (parent)
1431 best_parent_rate = parent->rate;
Mike Turquette63f5c3b2012-05-02 16:23:43 -07001432
Stephen Boydd6968fc2015-04-30 13:54:13 -07001433 clk_core_get_boundaries(core, &min_rate, &max_rate);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001434
James Hogan71472c02013-07-29 12:25:00 +01001435 /* find the closest rate and parent clk/rate */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001436 if (core->ops->determine_rate) {
Boris Brezillon0817b622015-07-07 20:48:08 +02001437 struct clk_rate_request req;
1438
1439 req.rate = rate;
1440 req.min_rate = min_rate;
1441 req.max_rate = max_rate;
1442 if (parent) {
1443 req.best_parent_hw = parent->hw;
1444 req.best_parent_rate = parent->rate;
1445 } else {
1446 req.best_parent_hw = NULL;
1447 req.best_parent_rate = 0;
1448 }
1449
1450 ret = core->ops->determine_rate(core->hw, &req);
Boris Brezillon03bc10a2015-03-29 03:48:48 +02001451 if (ret < 0)
1452 return NULL;
1453
Boris Brezillon0817b622015-07-07 20:48:08 +02001454 best_parent_rate = req.best_parent_rate;
1455 new_rate = req.rate;
1456 parent = req.best_parent_hw ? req.best_parent_hw->core : NULL;
Stephen Boydd6968fc2015-04-30 13:54:13 -07001457 } else if (core->ops->round_rate) {
1458 ret = core->ops->round_rate(core->hw, rate,
Boris Brezillon0817b622015-07-07 20:48:08 +02001459 &best_parent_rate);
Boris Brezillon03bc10a2015-03-29 03:48:48 +02001460 if (ret < 0)
1461 return NULL;
1462
1463 new_rate = ret;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001464 if (new_rate < min_rate || new_rate > max_rate)
1465 return NULL;
Stephen Boydd6968fc2015-04-30 13:54:13 -07001466 } else if (!parent || !(core->flags & CLK_SET_RATE_PARENT)) {
James Hogan71472c02013-07-29 12:25:00 +01001467 /* pass-through clock without adjustable parent */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001468 core->new_rate = core->rate;
James Hogan71472c02013-07-29 12:25:00 +01001469 return NULL;
1470 } else {
1471 /* pass-through clock with adjustable parent */
1472 top = clk_calc_new_rates(parent, rate);
1473 new_rate = parent->new_rate;
Mike Turquette63f5c3b2012-05-02 16:23:43 -07001474 goto out;
Mike Turquette7452b212012-03-26 14:45:36 -07001475 }
1476
James Hogan71472c02013-07-29 12:25:00 +01001477 /* some clocks must be gated to change parent */
1478 if (parent != old_parent &&
Stephen Boydd6968fc2015-04-30 13:54:13 -07001479 (core->flags & CLK_SET_PARENT_GATE) && core->prepare_count) {
James Hogan71472c02013-07-29 12:25:00 +01001480 pr_debug("%s: %s not gated but wants to reparent\n",
Stephen Boydd6968fc2015-04-30 13:54:13 -07001481 __func__, core->name);
Mike Turquetteb24764902012-03-15 23:11:19 -07001482 return NULL;
1483 }
1484
James Hogan71472c02013-07-29 12:25:00 +01001485 /* try finding the new parent index */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001486 if (parent && core->num_parents > 1) {
1487 p_index = clk_fetch_parent_index(core, parent);
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001488 if (p_index < 0) {
James Hogan71472c02013-07-29 12:25:00 +01001489 pr_debug("%s: clk %s can not be parent of clk %s\n",
Stephen Boydd6968fc2015-04-30 13:54:13 -07001490 __func__, parent->name, core->name);
James Hogan71472c02013-07-29 12:25:00 +01001491 return NULL;
1492 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001493 }
1494
Stephen Boydd6968fc2015-04-30 13:54:13 -07001495 if ((core->flags & CLK_SET_RATE_PARENT) && parent &&
James Hogan71472c02013-07-29 12:25:00 +01001496 best_parent_rate != parent->rate)
1497 top = clk_calc_new_rates(parent, best_parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001498
1499out:
Stephen Boydd6968fc2015-04-30 13:54:13 -07001500 clk_calc_subtree(core, new_rate, parent, p_index);
Mike Turquetteb24764902012-03-15 23:11:19 -07001501
1502 return top;
1503}
1504
1505/*
1506 * Notify about rate changes in a subtree. Always walk down the whole tree
1507 * so that in case of an error we can walk down the whole tree again and
1508 * abort the change.
1509 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001510static struct clk_core *clk_propagate_rate_change(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001511 unsigned long event)
Mike Turquetteb24764902012-03-15 23:11:19 -07001512{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001513 struct clk_core *child, *tmp_clk, *fail_clk = NULL;
Mike Turquetteb24764902012-03-15 23:11:19 -07001514 int ret = NOTIFY_DONE;
1515
Stephen Boydd6968fc2015-04-30 13:54:13 -07001516 if (core->rate == core->new_rate)
Sachin Kamat5fda6852013-03-13 15:17:49 +05301517 return NULL;
Mike Turquetteb24764902012-03-15 23:11:19 -07001518
Stephen Boydd6968fc2015-04-30 13:54:13 -07001519 if (core->notifier_count) {
1520 ret = __clk_notify(core, event, core->rate, core->new_rate);
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001521 if (ret & NOTIFY_STOP_MASK)
Stephen Boydd6968fc2015-04-30 13:54:13 -07001522 fail_clk = core;
Mike Turquetteb24764902012-03-15 23:11:19 -07001523 }
1524
Stephen Boydd6968fc2015-04-30 13:54:13 -07001525 hlist_for_each_entry(child, &core->children, child_node) {
James Hogan71472c02013-07-29 12:25:00 +01001526 /* Skip children who will be reparented to another clock */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001527 if (child->new_parent && child->new_parent != core)
James Hogan71472c02013-07-29 12:25:00 +01001528 continue;
1529 tmp_clk = clk_propagate_rate_change(child, event);
1530 if (tmp_clk)
1531 fail_clk = tmp_clk;
1532 }
1533
Stephen Boydd6968fc2015-04-30 13:54:13 -07001534 /* handle the new child who might not be in core->children yet */
1535 if (core->new_child) {
1536 tmp_clk = clk_propagate_rate_change(core->new_child, event);
James Hogan71472c02013-07-29 12:25:00 +01001537 if (tmp_clk)
1538 fail_clk = tmp_clk;
Mike Turquetteb24764902012-03-15 23:11:19 -07001539 }
1540
1541 return fail_clk;
1542}
1543
1544/*
1545 * walk down a subtree and set the new rates notifying the rate
1546 * change on the way
1547 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001548static void clk_change_rate(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -07001549{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001550 struct clk_core *child;
Tero Kristo067bb172014-08-21 16:47:45 +03001551 struct hlist_node *tmp;
Mike Turquetteb24764902012-03-15 23:11:19 -07001552 unsigned long old_rate;
Pawel Mollbf47b4f2012-06-08 14:04:06 +01001553 unsigned long best_parent_rate = 0;
Stephen Boyd3fa22522014-01-15 10:47:22 -08001554 bool skip_set_rate = false;
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001555 struct clk_core *old_parent;
Dong Aishengfc8726a2016-06-30 17:31:14 +08001556 struct clk_core *parent = NULL;
Mike Turquetteb24764902012-03-15 23:11:19 -07001557
Stephen Boydd6968fc2015-04-30 13:54:13 -07001558 old_rate = core->rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07001559
Dong Aishengfc8726a2016-06-30 17:31:14 +08001560 if (core->new_parent) {
1561 parent = core->new_parent;
Stephen Boydd6968fc2015-04-30 13:54:13 -07001562 best_parent_rate = core->new_parent->rate;
Dong Aishengfc8726a2016-06-30 17:31:14 +08001563 } else if (core->parent) {
1564 parent = core->parent;
Stephen Boydd6968fc2015-04-30 13:54:13 -07001565 best_parent_rate = core->parent->rate;
Dong Aishengfc8726a2016-06-30 17:31:14 +08001566 }
Pawel Mollbf47b4f2012-06-08 14:04:06 +01001567
Marek Szyprowski588fb542017-11-30 13:14:51 +01001568 if (clk_pm_runtime_get(core))
1569 return;
1570
Heiko Stuebner2eb8c712015-12-22 22:27:58 +01001571 if (core->flags & CLK_SET_RATE_UNGATE) {
1572 unsigned long flags;
1573
1574 clk_core_prepare(core);
1575 flags = clk_enable_lock();
1576 clk_core_enable(core);
1577 clk_enable_unlock(flags);
1578 }
1579
Stephen Boydd6968fc2015-04-30 13:54:13 -07001580 if (core->new_parent && core->new_parent != core->parent) {
1581 old_parent = __clk_set_parent_before(core, core->new_parent);
1582 trace_clk_set_parent(core, core->new_parent);
Stephen Boyd3fa22522014-01-15 10:47:22 -08001583
Stephen Boydd6968fc2015-04-30 13:54:13 -07001584 if (core->ops->set_rate_and_parent) {
Stephen Boyd3fa22522014-01-15 10:47:22 -08001585 skip_set_rate = true;
Stephen Boydd6968fc2015-04-30 13:54:13 -07001586 core->ops->set_rate_and_parent(core->hw, core->new_rate,
Stephen Boyd3fa22522014-01-15 10:47:22 -08001587 best_parent_rate,
Stephen Boydd6968fc2015-04-30 13:54:13 -07001588 core->new_parent_index);
1589 } else if (core->ops->set_parent) {
1590 core->ops->set_parent(core->hw, core->new_parent_index);
Stephen Boyd3fa22522014-01-15 10:47:22 -08001591 }
1592
Stephen Boydd6968fc2015-04-30 13:54:13 -07001593 trace_clk_set_parent_complete(core, core->new_parent);
1594 __clk_set_parent_after(core, core->new_parent, old_parent);
Stephen Boyd3fa22522014-01-15 10:47:22 -08001595 }
1596
Dong Aishengfc8726a2016-06-30 17:31:14 +08001597 if (core->flags & CLK_OPS_PARENT_ENABLE)
1598 clk_core_prepare_enable(parent);
1599
Stephen Boydd6968fc2015-04-30 13:54:13 -07001600 trace_clk_set_rate(core, core->new_rate);
Stephen Boyddfc202e2015-02-02 14:37:41 -08001601
Stephen Boydd6968fc2015-04-30 13:54:13 -07001602 if (!skip_set_rate && core->ops->set_rate)
1603 core->ops->set_rate(core->hw, core->new_rate, best_parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001604
Stephen Boydd6968fc2015-04-30 13:54:13 -07001605 trace_clk_set_rate_complete(core, core->new_rate);
Stephen Boyddfc202e2015-02-02 14:37:41 -08001606
Stephen Boydd6968fc2015-04-30 13:54:13 -07001607 core->rate = clk_recalc(core, best_parent_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001608
Heiko Stuebner2eb8c712015-12-22 22:27:58 +01001609 if (core->flags & CLK_SET_RATE_UNGATE) {
1610 unsigned long flags;
1611
1612 flags = clk_enable_lock();
1613 clk_core_disable(core);
1614 clk_enable_unlock(flags);
1615 clk_core_unprepare(core);
1616 }
1617
Dong Aishengfc8726a2016-06-30 17:31:14 +08001618 if (core->flags & CLK_OPS_PARENT_ENABLE)
1619 clk_core_disable_unprepare(parent);
1620
Stephen Boydd6968fc2015-04-30 13:54:13 -07001621 if (core->notifier_count && old_rate != core->rate)
1622 __clk_notify(core, POST_RATE_CHANGE, old_rate, core->rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001623
Michael Turquette85e88fa2015-06-20 12:18:03 -07001624 if (core->flags & CLK_RECALC_NEW_RATES)
1625 (void)clk_calc_new_rates(core, core->new_rate);
Bartlomiej Zolnierkiewiczd8d91982015-04-03 18:43:44 +02001626
Tero Kristo067bb172014-08-21 16:47:45 +03001627 /*
1628 * Use safe iteration, as change_rate can actually swap parents
1629 * for certain clock types.
1630 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001631 hlist_for_each_entry_safe(child, tmp, &core->children, child_node) {
James Hogan71472c02013-07-29 12:25:00 +01001632 /* Skip children who will be reparented to another clock */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001633 if (child->new_parent && child->new_parent != core)
James Hogan71472c02013-07-29 12:25:00 +01001634 continue;
Mike Turquetteb24764902012-03-15 23:11:19 -07001635 clk_change_rate(child);
James Hogan71472c02013-07-29 12:25:00 +01001636 }
1637
Stephen Boydd6968fc2015-04-30 13:54:13 -07001638 /* handle the new child who might not be in core->children yet */
1639 if (core->new_child)
1640 clk_change_rate(core->new_child);
Marek Szyprowski588fb542017-11-30 13:14:51 +01001641
1642 clk_pm_runtime_put(core);
Mike Turquetteb24764902012-03-15 23:11:19 -07001643}
1644
Stephen Boydd6968fc2015-04-30 13:54:13 -07001645static int clk_core_set_rate_nolock(struct clk_core *core,
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001646 unsigned long req_rate)
1647{
1648 struct clk_core *top, *fail_clk;
1649 unsigned long rate = req_rate;
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001650 int ret = 0;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001651
Stephen Boydd6968fc2015-04-30 13:54:13 -07001652 if (!core)
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001653 return 0;
1654
1655 /* bail early if nothing to do */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001656 if (rate == clk_core_get_rate_nolock(core))
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001657 return 0;
1658
Stephen Boydd6968fc2015-04-30 13:54:13 -07001659 if ((core->flags & CLK_SET_RATE_GATE) && core->prepare_count)
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001660 return -EBUSY;
1661
1662 /* calculate new rates and get the topmost changed clock */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001663 top = clk_calc_new_rates(core, rate);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001664 if (!top)
1665 return -EINVAL;
1666
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001667 ret = clk_pm_runtime_get(core);
1668 if (ret)
1669 return ret;
1670
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001671 /* notify that we are about to change rates */
1672 fail_clk = clk_propagate_rate_change(top, PRE_RATE_CHANGE);
1673 if (fail_clk) {
1674 pr_debug("%s: failed to set %s rate\n", __func__,
1675 fail_clk->name);
1676 clk_propagate_rate_change(top, ABORT_RATE_CHANGE);
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001677 ret = -EBUSY;
1678 goto err;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001679 }
1680
1681 /* change the rates */
1682 clk_change_rate(top);
1683
Stephen Boydd6968fc2015-04-30 13:54:13 -07001684 core->req_rate = req_rate;
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001685err:
1686 clk_pm_runtime_put(core);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001687
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001688 return ret;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001689}
1690
Mike Turquetteb24764902012-03-15 23:11:19 -07001691/**
1692 * clk_set_rate - specify a new rate for clk
1693 * @clk: the clk whose rate is being changed
1694 * @rate: the new rate for clk
1695 *
Mike Turquette5654dc92012-03-26 11:51:34 -07001696 * In the simplest case clk_set_rate will only adjust the rate of clk.
Mike Turquetteb24764902012-03-15 23:11:19 -07001697 *
Mike Turquette5654dc92012-03-26 11:51:34 -07001698 * Setting the CLK_SET_RATE_PARENT flag allows the rate change operation to
1699 * propagate up to clk's parent; whether or not this happens depends on the
1700 * outcome of clk's .round_rate implementation. If *parent_rate is unchanged
1701 * after calling .round_rate then upstream parent propagation is ignored. If
1702 * *parent_rate comes back with a new rate for clk's parent then we propagate
Peter Meerwald24ee1a02013-06-29 15:14:19 +02001703 * up to clk's parent and set its rate. Upward propagation will continue
Mike Turquette5654dc92012-03-26 11:51:34 -07001704 * until either a clk does not support the CLK_SET_RATE_PARENT flag or
1705 * .round_rate stops requesting changes to clk's parent_rate.
Mike Turquetteb24764902012-03-15 23:11:19 -07001706 *
Mike Turquette5654dc92012-03-26 11:51:34 -07001707 * Rate changes are accomplished via tree traversal that also recalculates the
1708 * rates for the clocks and fires off POST_RATE_CHANGE notifiers.
Mike Turquetteb24764902012-03-15 23:11:19 -07001709 *
1710 * Returns 0 on success, -EERROR otherwise.
1711 */
1712int clk_set_rate(struct clk *clk, unsigned long rate)
1713{
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001714 int ret;
Mike Turquetteb24764902012-03-15 23:11:19 -07001715
Mike Turquette89ac8d72013-08-21 23:58:09 -07001716 if (!clk)
1717 return 0;
1718
Mike Turquetteb24764902012-03-15 23:11:19 -07001719 /* prevent racing with updates to the clock topology */
Mike Turquetteeab89f62013-03-28 13:59:01 -07001720 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001721
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001722 ret = clk_core_set_rate_nolock(clk->core, rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001723
Mike Turquetteeab89f62013-03-28 13:59:01 -07001724 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001725
1726 return ret;
1727}
1728EXPORT_SYMBOL_GPL(clk_set_rate);
1729
1730/**
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01001731 * clk_set_rate_range - set a rate range for a clock source
1732 * @clk: clock source
1733 * @min: desired minimum clock rate in Hz, inclusive
1734 * @max: desired maximum clock rate in Hz, inclusive
1735 *
1736 * Returns success (0) or negative errno.
1737 */
1738int clk_set_rate_range(struct clk *clk, unsigned long min, unsigned long max)
1739{
1740 int ret = 0;
1741
1742 if (!clk)
1743 return 0;
1744
1745 if (min > max) {
1746 pr_err("%s: clk %s dev %s con %s: invalid range [%lu, %lu]\n",
1747 __func__, clk->core->name, clk->dev_id, clk->con_id,
1748 min, max);
1749 return -EINVAL;
1750 }
1751
1752 clk_prepare_lock();
1753
1754 if (min != clk->min_rate || max != clk->max_rate) {
1755 clk->min_rate = min;
1756 clk->max_rate = max;
1757 ret = clk_core_set_rate_nolock(clk->core, clk->core->req_rate);
1758 }
1759
1760 clk_prepare_unlock();
1761
1762 return ret;
1763}
1764EXPORT_SYMBOL_GPL(clk_set_rate_range);
1765
1766/**
1767 * clk_set_min_rate - set a minimum clock rate for a clock source
1768 * @clk: clock source
1769 * @rate: desired minimum clock rate in Hz, inclusive
1770 *
1771 * Returns success (0) or negative errno.
1772 */
1773int clk_set_min_rate(struct clk *clk, unsigned long rate)
1774{
1775 if (!clk)
1776 return 0;
1777
1778 return clk_set_rate_range(clk, rate, clk->max_rate);
1779}
1780EXPORT_SYMBOL_GPL(clk_set_min_rate);
1781
1782/**
1783 * clk_set_max_rate - set a maximum clock rate for a clock source
1784 * @clk: clock source
1785 * @rate: desired maximum clock rate in Hz, inclusive
1786 *
1787 * Returns success (0) or negative errno.
1788 */
1789int clk_set_max_rate(struct clk *clk, unsigned long rate)
1790{
1791 if (!clk)
1792 return 0;
1793
1794 return clk_set_rate_range(clk, clk->min_rate, rate);
1795}
1796EXPORT_SYMBOL_GPL(clk_set_max_rate);
1797
1798/**
Mike Turquetteb24764902012-03-15 23:11:19 -07001799 * clk_get_parent - return the parent of a clk
1800 * @clk: the clk whose parent gets returned
1801 *
1802 * Simply returns clk->parent. Returns NULL if clk is NULL.
1803 */
1804struct clk *clk_get_parent(struct clk *clk)
1805{
1806 struct clk *parent;
1807
Stephen Boydfc4a05d2015-06-25 17:24:15 -07001808 if (!clk)
1809 return NULL;
1810
Mike Turquetteeab89f62013-03-28 13:59:01 -07001811 clk_prepare_lock();
Stephen Boydfc4a05d2015-06-25 17:24:15 -07001812 /* TODO: Create a per-user clk and change callers to call clk_put */
1813 parent = !clk->core->parent ? NULL : clk->core->parent->hw->clk;
Mike Turquetteeab89f62013-03-28 13:59:01 -07001814 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001815
1816 return parent;
1817}
1818EXPORT_SYMBOL_GPL(clk_get_parent);
1819
Stephen Boydd6968fc2015-04-30 13:54:13 -07001820static struct clk_core *__clk_init_parent(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -07001821{
Masahiro Yamada5146e0b2015-12-28 19:23:04 +09001822 u8 index = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001823
Masahiro Yamada2430a942016-02-09 20:19:14 +09001824 if (core->num_parents > 1 && core->ops->get_parent)
Masahiro Yamada5146e0b2015-12-28 19:23:04 +09001825 index = core->ops->get_parent(core->hw);
Mike Turquetteb24764902012-03-15 23:11:19 -07001826
Masahiro Yamada5146e0b2015-12-28 19:23:04 +09001827 return clk_core_get_parent_by_index(core, index);
Mike Turquetteb24764902012-03-15 23:11:19 -07001828}
1829
Stephen Boydd6968fc2015-04-30 13:54:13 -07001830static void clk_core_reparent(struct clk_core *core,
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001831 struct clk_core *new_parent)
Ulf Hanssonb33d2122013-04-02 23:09:37 +02001832{
Stephen Boydd6968fc2015-04-30 13:54:13 -07001833 clk_reparent(core, new_parent);
1834 __clk_recalc_accuracies(core);
1835 __clk_recalc_rates(core, POST_RATE_CHANGE);
Mike Turquetteb24764902012-03-15 23:11:19 -07001836}
1837
Tomeu Vizoso42c86542015-03-11 11:34:25 +01001838void clk_hw_reparent(struct clk_hw *hw, struct clk_hw *new_parent)
1839{
1840 if (!hw)
1841 return;
1842
1843 clk_core_reparent(hw->core, !new_parent ? NULL : new_parent->core);
1844}
1845
Mike Turquetteb24764902012-03-15 23:11:19 -07001846/**
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001847 * clk_has_parent - check if a clock is a possible parent for another
1848 * @clk: clock source
1849 * @parent: parent clock source
Mike Turquetteb24764902012-03-15 23:11:19 -07001850 *
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001851 * This function can be used in drivers that need to check that a clock can be
1852 * the parent of another without actually changing the parent.
Saravana Kannanf8aa0bd2013-05-15 21:07:24 -07001853 *
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001854 * Returns true if @parent is a possible parent for @clk, false otherwise.
Mike Turquetteb24764902012-03-15 23:11:19 -07001855 */
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001856bool clk_has_parent(struct clk *clk, struct clk *parent)
1857{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001858 struct clk_core *core, *parent_core;
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001859 unsigned int i;
1860
1861 /* NULL clocks should be nops, so return success if either is NULL. */
1862 if (!clk || !parent)
1863 return true;
1864
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001865 core = clk->core;
1866 parent_core = parent->core;
1867
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001868 /* Optimize for the case where the parent is already the parent. */
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001869 if (core->parent == parent_core)
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001870 return true;
1871
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001872 for (i = 0; i < core->num_parents; i++)
1873 if (strcmp(core->parent_names[i], parent_core->name) == 0)
Thierry Reding4e88f3d2015-01-21 17:13:00 +01001874 return true;
1875
1876 return false;
1877}
1878EXPORT_SYMBOL_GPL(clk_has_parent);
1879
Stephen Boydd6968fc2015-04-30 13:54:13 -07001880static int clk_core_set_parent(struct clk_core *core, struct clk_core *parent)
Mike Turquetteb24764902012-03-15 23:11:19 -07001881{
1882 int ret = 0;
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001883 int p_index = 0;
Ulf Hansson031dcc92013-04-02 23:09:38 +02001884 unsigned long p_rate = 0;
Mike Turquetteb24764902012-03-15 23:11:19 -07001885
Stephen Boydd6968fc2015-04-30 13:54:13 -07001886 if (!core)
Mike Turquette89ac8d72013-08-21 23:58:09 -07001887 return 0;
1888
Mike Turquetteb24764902012-03-15 23:11:19 -07001889 /* prevent racing with updates to the clock topology */
Mike Turquetteeab89f62013-03-28 13:59:01 -07001890 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001891
Stephen Boydd6968fc2015-04-30 13:54:13 -07001892 if (core->parent == parent)
Mike Turquetteb24764902012-03-15 23:11:19 -07001893 goto out;
1894
Stephen Boydb61c43c2015-02-02 14:11:25 -08001895 /* verify ops for for multi-parent clks */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001896 if ((core->num_parents > 1) && (!core->ops->set_parent)) {
Stephen Boydb61c43c2015-02-02 14:11:25 -08001897 ret = -ENOSYS;
1898 goto out;
1899 }
1900
Ulf Hansson031dcc92013-04-02 23:09:38 +02001901 /* check that we are allowed to re-parent if the clock is in use */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001902 if ((core->flags & CLK_SET_PARENT_GATE) && core->prepare_count) {
Ulf Hansson031dcc92013-04-02 23:09:38 +02001903 ret = -EBUSY;
1904 goto out;
1905 }
1906
1907 /* try finding the new parent index */
1908 if (parent) {
Stephen Boydd6968fc2015-04-30 13:54:13 -07001909 p_index = clk_fetch_parent_index(core, parent);
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001910 if (p_index < 0) {
Ulf Hansson031dcc92013-04-02 23:09:38 +02001911 pr_debug("%s: clk %s can not be parent of clk %s\n",
Stephen Boydd6968fc2015-04-30 13:54:13 -07001912 __func__, parent->name, core->name);
Tomasz Figaf1c8b2e2013-09-29 02:37:14 +02001913 ret = p_index;
Ulf Hansson031dcc92013-04-02 23:09:38 +02001914 goto out;
1915 }
Masahiro Yamadae8f0e682015-12-28 19:23:10 +09001916 p_rate = parent->rate;
Ulf Hansson031dcc92013-04-02 23:09:38 +02001917 }
1918
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001919 ret = clk_pm_runtime_get(core);
1920 if (ret)
1921 goto out;
1922
Mike Turquetteb24764902012-03-15 23:11:19 -07001923 /* propagate PRE_RATE_CHANGE notifications */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001924 ret = __clk_speculate_rates(core, p_rate);
Mike Turquetteb24764902012-03-15 23:11:19 -07001925
1926 /* abort if a driver objects */
Soren Brinkmannfb72a052013-04-03 12:17:12 -07001927 if (ret & NOTIFY_STOP_MASK)
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001928 goto runtime_put;
Mike Turquetteb24764902012-03-15 23:11:19 -07001929
Ulf Hansson031dcc92013-04-02 23:09:38 +02001930 /* do the re-parent */
Stephen Boydd6968fc2015-04-30 13:54:13 -07001931 ret = __clk_set_parent(core, parent, p_index);
Mike Turquetteb24764902012-03-15 23:11:19 -07001932
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001933 /* propagate rate an accuracy recalculation accordingly */
1934 if (ret) {
Stephen Boydd6968fc2015-04-30 13:54:13 -07001935 __clk_recalc_rates(core, ABORT_RATE_CHANGE);
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001936 } else {
Stephen Boydd6968fc2015-04-30 13:54:13 -07001937 __clk_recalc_rates(core, POST_RATE_CHANGE);
1938 __clk_recalc_accuracies(core);
Boris BREZILLON5279fc42013-12-21 10:34:47 +01001939 }
Mike Turquetteb24764902012-03-15 23:11:19 -07001940
Marek Szyprowski9a34b452017-08-21 10:04:59 +02001941runtime_put:
1942 clk_pm_runtime_put(core);
Mike Turquetteb24764902012-03-15 23:11:19 -07001943out:
Mike Turquetteeab89f62013-03-28 13:59:01 -07001944 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07001945
1946 return ret;
1947}
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01001948
1949/**
1950 * clk_set_parent - switch the parent of a mux clk
1951 * @clk: the mux clk whose input we are switching
1952 * @parent: the new input to clk
1953 *
1954 * Re-parent clk to use parent as its new input source. If clk is in
1955 * prepared state, the clk will get enabled for the duration of this call. If
1956 * that's not acceptable for a specific clk (Eg: the consumer can't handle
1957 * that, the reparenting is glitchy in hardware, etc), use the
1958 * CLK_SET_PARENT_GATE flag to allow reparenting only when clk is unprepared.
1959 *
1960 * After successfully changing clk's parent clk_set_parent will update the
1961 * clk topology, sysfs topology and propagate rate recalculation via
1962 * __clk_recalc_rates.
1963 *
1964 * Returns 0 on success, -EERROR otherwise.
1965 */
1966int clk_set_parent(struct clk *clk, struct clk *parent)
1967{
1968 if (!clk)
1969 return 0;
1970
1971 return clk_core_set_parent(clk->core, parent ? parent->core : NULL);
1972}
Mike Turquetteb24764902012-03-15 23:11:19 -07001973EXPORT_SYMBOL_GPL(clk_set_parent);
1974
1975/**
Mike Turquettee59c5372014-02-18 21:21:25 -08001976 * clk_set_phase - adjust the phase shift of a clock signal
1977 * @clk: clock signal source
1978 * @degrees: number of degrees the signal is shifted
1979 *
1980 * Shifts the phase of a clock signal by the specified
1981 * degrees. Returns 0 on success, -EERROR otherwise.
1982 *
1983 * This function makes no distinction about the input or reference
1984 * signal that we adjust the clock signal phase against. For example
1985 * phase locked-loop clock signal generators we may shift phase with
1986 * respect to feedback clock signal input, but for other cases the
1987 * clock phase may be shifted with respect to some other, unspecified
1988 * signal.
1989 *
1990 * Additionally the concept of phase shift does not propagate through
1991 * the clock tree hierarchy, which sets it apart from clock rates and
1992 * clock accuracy. A parent clock phase attribute does not have an
1993 * impact on the phase attribute of a child clock.
1994 */
1995int clk_set_phase(struct clk *clk, int degrees)
1996{
Stephen Boyd08b95752015-02-02 14:09:43 -08001997 int ret = -EINVAL;
Mike Turquettee59c5372014-02-18 21:21:25 -08001998
1999 if (!clk)
Stephen Boyd08b95752015-02-02 14:09:43 -08002000 return 0;
Mike Turquettee59c5372014-02-18 21:21:25 -08002001
2002 /* sanity check degrees */
2003 degrees %= 360;
2004 if (degrees < 0)
2005 degrees += 360;
2006
2007 clk_prepare_lock();
2008
Stephen Boyddfc202e2015-02-02 14:37:41 -08002009 trace_clk_set_phase(clk->core, degrees);
2010
Stephen Boyd08b95752015-02-02 14:09:43 -08002011 if (clk->core->ops->set_phase)
2012 ret = clk->core->ops->set_phase(clk->core->hw, degrees);
Mike Turquettee59c5372014-02-18 21:21:25 -08002013
Stephen Boyddfc202e2015-02-02 14:37:41 -08002014 trace_clk_set_phase_complete(clk->core, degrees);
2015
Mike Turquettee59c5372014-02-18 21:21:25 -08002016 if (!ret)
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002017 clk->core->phase = degrees;
Mike Turquettee59c5372014-02-18 21:21:25 -08002018
Mike Turquettee59c5372014-02-18 21:21:25 -08002019 clk_prepare_unlock();
2020
Mike Turquettee59c5372014-02-18 21:21:25 -08002021 return ret;
2022}
Maxime Ripard9767b042015-01-20 22:23:43 +01002023EXPORT_SYMBOL_GPL(clk_set_phase);
Mike Turquettee59c5372014-02-18 21:21:25 -08002024
Stephen Boydd6968fc2015-04-30 13:54:13 -07002025static int clk_core_get_phase(struct clk_core *core)
Mike Turquettee59c5372014-02-18 21:21:25 -08002026{
Stephen Boyd1f3e1982015-04-30 14:21:56 -07002027 int ret;
Mike Turquettee59c5372014-02-18 21:21:25 -08002028
2029 clk_prepare_lock();
Stephen Boydd6968fc2015-04-30 13:54:13 -07002030 ret = core->phase;
Mike Turquettee59c5372014-02-18 21:21:25 -08002031 clk_prepare_unlock();
2032
Mike Turquettee59c5372014-02-18 21:21:25 -08002033 return ret;
2034}
2035
2036/**
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002037 * clk_get_phase - return the phase shift of a clock signal
2038 * @clk: clock signal source
2039 *
2040 * Returns the phase shift of a clock node in degrees, otherwise returns
2041 * -EERROR.
2042 */
2043int clk_get_phase(struct clk *clk)
2044{
2045 if (!clk)
2046 return 0;
2047
2048 return clk_core_get_phase(clk->core);
2049}
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002050EXPORT_SYMBOL_GPL(clk_get_phase);
Mike Turquetteb24764902012-03-15 23:11:19 -07002051
2052/**
Michael Turquette3d3801e2015-02-25 09:11:01 -08002053 * clk_is_match - check if two clk's point to the same hardware clock
2054 * @p: clk compared against q
2055 * @q: clk compared against p
2056 *
2057 * Returns true if the two struct clk pointers both point to the same hardware
2058 * clock node. Put differently, returns true if struct clk *p and struct clk *q
2059 * share the same struct clk_core object.
2060 *
2061 * Returns false otherwise. Note that two NULL clks are treated as matching.
2062 */
2063bool clk_is_match(const struct clk *p, const struct clk *q)
2064{
2065 /* trivial case: identical struct clk's or both NULL */
2066 if (p == q)
2067 return true;
2068
Geert Uytterhoeven3fe003f2015-10-29 20:55:00 +01002069 /* true if clk->core pointers match. Avoid dereferencing garbage */
Michael Turquette3d3801e2015-02-25 09:11:01 -08002070 if (!IS_ERR_OR_NULL(p) && !IS_ERR_OR_NULL(q))
2071 if (p->core == q->core)
2072 return true;
2073
2074 return false;
2075}
2076EXPORT_SYMBOL_GPL(clk_is_match);
2077
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002078/*** debugfs support ***/
2079
2080#ifdef CONFIG_DEBUG_FS
2081#include <linux/debugfs.h>
2082
2083static struct dentry *rootdir;
2084static int inited = 0;
2085static DEFINE_MUTEX(clk_debug_lock);
2086static HLIST_HEAD(clk_debug_list);
2087
2088static struct hlist_head *all_lists[] = {
2089 &clk_root_list,
2090 &clk_orphan_list,
2091 NULL,
2092};
2093
2094static struct hlist_head *orphan_list[] = {
2095 &clk_orphan_list,
2096 NULL,
2097};
2098
2099static void clk_summary_show_one(struct seq_file *s, struct clk_core *c,
2100 int level)
2101{
2102 if (!c)
2103 return;
2104
2105 seq_printf(s, "%*s%-*s %11d %12d %11lu %10lu %-3d\n",
2106 level * 3 + 1, "",
2107 30 - level * 3, c->name,
2108 c->enable_count, c->prepare_count, clk_core_get_rate(c),
2109 clk_core_get_accuracy(c), clk_core_get_phase(c));
2110}
2111
2112static void clk_summary_show_subtree(struct seq_file *s, struct clk_core *c,
2113 int level)
2114{
2115 struct clk_core *child;
2116
2117 if (!c)
2118 return;
2119
2120 clk_summary_show_one(s, c, level);
2121
2122 hlist_for_each_entry(child, &c->children, child_node)
2123 clk_summary_show_subtree(s, child, level + 1);
2124}
2125
2126static int clk_summary_show(struct seq_file *s, void *data)
2127{
2128 struct clk_core *c;
2129 struct hlist_head **lists = (struct hlist_head **)s->private;
2130
2131 seq_puts(s, " clock enable_cnt prepare_cnt rate accuracy phase\n");
2132 seq_puts(s, "----------------------------------------------------------------------------------------\n");
2133
2134 clk_prepare_lock();
2135
2136 for (; *lists; lists++)
2137 hlist_for_each_entry(c, *lists, child_node)
2138 clk_summary_show_subtree(s, c, 0);
2139
2140 clk_prepare_unlock();
2141
2142 return 0;
2143}
2144
2145
2146static int clk_summary_open(struct inode *inode, struct file *file)
2147{
2148 return single_open(file, clk_summary_show, inode->i_private);
2149}
2150
2151static const struct file_operations clk_summary_fops = {
2152 .open = clk_summary_open,
2153 .read = seq_read,
2154 .llseek = seq_lseek,
2155 .release = single_release,
2156};
2157
2158static void clk_dump_one(struct seq_file *s, struct clk_core *c, int level)
2159{
2160 if (!c)
2161 return;
2162
Stefan Wahren7cb81132015-04-29 16:36:43 +00002163 /* This should be JSON format, i.e. elements separated with a comma */
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002164 seq_printf(s, "\"%s\": { ", c->name);
2165 seq_printf(s, "\"enable_count\": %d,", c->enable_count);
2166 seq_printf(s, "\"prepare_count\": %d,", c->prepare_count);
Stefan Wahren7cb81132015-04-29 16:36:43 +00002167 seq_printf(s, "\"rate\": %lu,", clk_core_get_rate(c));
2168 seq_printf(s, "\"accuracy\": %lu,", clk_core_get_accuracy(c));
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002169 seq_printf(s, "\"phase\": %d", clk_core_get_phase(c));
2170}
2171
2172static void clk_dump_subtree(struct seq_file *s, struct clk_core *c, int level)
2173{
2174 struct clk_core *child;
2175
2176 if (!c)
2177 return;
2178
2179 clk_dump_one(s, c, level);
2180
2181 hlist_for_each_entry(child, &c->children, child_node) {
Markus Elfring4d327582017-04-20 08:45:43 +02002182 seq_putc(s, ',');
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002183 clk_dump_subtree(s, child, level + 1);
2184 }
2185
Markus Elfring4d327582017-04-20 08:45:43 +02002186 seq_putc(s, '}');
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002187}
2188
2189static int clk_dump(struct seq_file *s, void *data)
2190{
2191 struct clk_core *c;
2192 bool first_node = true;
2193 struct hlist_head **lists = (struct hlist_head **)s->private;
2194
Markus Elfring4d327582017-04-20 08:45:43 +02002195 seq_putc(s, '{');
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002196 clk_prepare_lock();
2197
2198 for (; *lists; lists++) {
2199 hlist_for_each_entry(c, *lists, child_node) {
2200 if (!first_node)
Markus Elfring4d327582017-04-20 08:45:43 +02002201 seq_putc(s, ',');
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002202 first_node = false;
2203 clk_dump_subtree(s, c, 0);
2204 }
2205 }
2206
2207 clk_prepare_unlock();
2208
Felipe Balbi70e9f4d2015-05-01 09:48:37 -05002209 seq_puts(s, "}\n");
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002210 return 0;
2211}
2212
2213
2214static int clk_dump_open(struct inode *inode, struct file *file)
2215{
2216 return single_open(file, clk_dump, inode->i_private);
2217}
2218
2219static const struct file_operations clk_dump_fops = {
2220 .open = clk_dump_open,
2221 .read = seq_read,
2222 .llseek = seq_lseek,
2223 .release = single_release,
2224};
2225
Peter De Schrijver92031572017-03-21 15:20:31 +02002226static int possible_parents_dump(struct seq_file *s, void *data)
2227{
2228 struct clk_core *core = s->private;
2229 int i;
2230
2231 for (i = 0; i < core->num_parents - 1; i++)
2232 seq_printf(s, "%s ", core->parent_names[i]);
2233
2234 seq_printf(s, "%s\n", core->parent_names[i]);
2235
2236 return 0;
2237}
2238
2239static int possible_parents_open(struct inode *inode, struct file *file)
2240{
2241 return single_open(file, possible_parents_dump, inode->i_private);
2242}
2243
2244static const struct file_operations possible_parents_fops = {
2245 .open = possible_parents_open,
2246 .read = seq_read,
2247 .llseek = seq_lseek,
2248 .release = single_release,
2249};
2250
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002251static int clk_debug_create_one(struct clk_core *core, struct dentry *pdentry)
2252{
2253 struct dentry *d;
2254 int ret = -ENOMEM;
2255
2256 if (!core || !pdentry) {
2257 ret = -EINVAL;
2258 goto out;
2259 }
2260
2261 d = debugfs_create_dir(core->name, pdentry);
2262 if (!d)
2263 goto out;
2264
2265 core->dentry = d;
2266
2267 d = debugfs_create_u32("clk_rate", S_IRUGO, core->dentry,
2268 (u32 *)&core->rate);
2269 if (!d)
2270 goto err_out;
2271
2272 d = debugfs_create_u32("clk_accuracy", S_IRUGO, core->dentry,
2273 (u32 *)&core->accuracy);
2274 if (!d)
2275 goto err_out;
2276
2277 d = debugfs_create_u32("clk_phase", S_IRUGO, core->dentry,
2278 (u32 *)&core->phase);
2279 if (!d)
2280 goto err_out;
2281
2282 d = debugfs_create_x32("clk_flags", S_IRUGO, core->dentry,
2283 (u32 *)&core->flags);
2284 if (!d)
2285 goto err_out;
2286
2287 d = debugfs_create_u32("clk_prepare_count", S_IRUGO, core->dentry,
2288 (u32 *)&core->prepare_count);
2289 if (!d)
2290 goto err_out;
2291
2292 d = debugfs_create_u32("clk_enable_count", S_IRUGO, core->dentry,
2293 (u32 *)&core->enable_count);
2294 if (!d)
2295 goto err_out;
2296
2297 d = debugfs_create_u32("clk_notifier_count", S_IRUGO, core->dentry,
2298 (u32 *)&core->notifier_count);
2299 if (!d)
2300 goto err_out;
2301
Peter De Schrijver92031572017-03-21 15:20:31 +02002302 if (core->num_parents > 1) {
2303 d = debugfs_create_file("clk_possible_parents", S_IRUGO,
2304 core->dentry, core, &possible_parents_fops);
2305 if (!d)
2306 goto err_out;
2307 }
2308
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002309 if (core->ops->debug_init) {
2310 ret = core->ops->debug_init(core->hw, core->dentry);
2311 if (ret)
2312 goto err_out;
2313 }
2314
2315 ret = 0;
2316 goto out;
2317
2318err_out:
2319 debugfs_remove_recursive(core->dentry);
2320 core->dentry = NULL;
2321out:
2322 return ret;
2323}
2324
2325/**
Stephen Boyd6e5ab412015-04-30 15:11:31 -07002326 * clk_debug_register - add a clk node to the debugfs clk directory
2327 * @core: the clk being added to the debugfs clk directory
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002328 *
Stephen Boyd6e5ab412015-04-30 15:11:31 -07002329 * Dynamically adds a clk to the debugfs clk directory if debugfs has been
2330 * initialized. Otherwise it bails out early since the debugfs clk directory
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002331 * will be created lazily by clk_debug_init as part of a late_initcall.
2332 */
2333static int clk_debug_register(struct clk_core *core)
2334{
2335 int ret = 0;
2336
2337 mutex_lock(&clk_debug_lock);
2338 hlist_add_head(&core->debug_node, &clk_debug_list);
2339
2340 if (!inited)
2341 goto unlock;
2342
2343 ret = clk_debug_create_one(core, rootdir);
2344unlock:
2345 mutex_unlock(&clk_debug_lock);
2346
2347 return ret;
2348}
2349
2350 /**
Stephen Boyd6e5ab412015-04-30 15:11:31 -07002351 * clk_debug_unregister - remove a clk node from the debugfs clk directory
2352 * @core: the clk being removed from the debugfs clk directory
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002353 *
Stephen Boyd6e5ab412015-04-30 15:11:31 -07002354 * Dynamically removes a clk and all its child nodes from the
2355 * debugfs clk directory if clk->dentry points to debugfs created by
Stephen Boyd706d5c72016-02-22 15:43:41 -08002356 * clk_debug_register in __clk_core_init.
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002357 */
2358static void clk_debug_unregister(struct clk_core *core)
2359{
2360 mutex_lock(&clk_debug_lock);
2361 hlist_del_init(&core->debug_node);
2362 debugfs_remove_recursive(core->dentry);
2363 core->dentry = NULL;
2364 mutex_unlock(&clk_debug_lock);
2365}
2366
2367struct dentry *clk_debugfs_add_file(struct clk_hw *hw, char *name, umode_t mode,
2368 void *data, const struct file_operations *fops)
2369{
2370 struct dentry *d = NULL;
2371
2372 if (hw->core->dentry)
2373 d = debugfs_create_file(name, mode, hw->core->dentry, data,
2374 fops);
2375
2376 return d;
2377}
2378EXPORT_SYMBOL_GPL(clk_debugfs_add_file);
2379
2380/**
Stephen Boyd6e5ab412015-04-30 15:11:31 -07002381 * clk_debug_init - lazily populate the debugfs clk directory
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002382 *
Stephen Boyd6e5ab412015-04-30 15:11:31 -07002383 * clks are often initialized very early during boot before memory can be
2384 * dynamically allocated and well before debugfs is setup. This function
2385 * populates the debugfs clk directory once at boot-time when we know that
2386 * debugfs is setup. It should only be called once at boot-time, all other clks
2387 * added dynamically will be done so with clk_debug_register.
Stephen Boyd4dff95d2015-04-30 14:43:22 -07002388 */
2389static int __init clk_debug_init(void)
2390{
2391 struct clk_core *core;
2392 struct dentry *d;
2393
2394 rootdir = debugfs_create_dir("clk", NULL);
2395
2396 if (!rootdir)
2397 return -ENOMEM;
2398
2399 d = debugfs_create_file("clk_summary", S_IRUGO, rootdir, &all_lists,
2400 &clk_summary_fops);
2401 if (!d)
2402 return -ENOMEM;
2403
2404 d = debugfs_create_file("clk_dump", S_IRUGO, rootdir, &all_lists,
2405 &clk_dump_fops);
2406 if (!d)
2407 return -ENOMEM;
2408
2409 d = debugfs_create_file("clk_orphan_summary", S_IRUGO, rootdir,
2410 &orphan_list, &clk_summary_fops);
2411 if (!d)
2412 return -ENOMEM;
2413
2414 d = debugfs_create_file("clk_orphan_dump", S_IRUGO, rootdir,
2415 &orphan_list, &clk_dump_fops);
2416 if (!d)
2417 return -ENOMEM;
2418
2419 mutex_lock(&clk_debug_lock);
2420 hlist_for_each_entry(core, &clk_debug_list, debug_node)
2421 clk_debug_create_one(core, rootdir);
2422
2423 inited = 1;
2424 mutex_unlock(&clk_debug_lock);
2425
2426 return 0;
2427}
2428late_initcall(clk_debug_init);
2429#else
2430static inline int clk_debug_register(struct clk_core *core) { return 0; }
2431static inline void clk_debug_reparent(struct clk_core *core,
2432 struct clk_core *new_parent)
2433{
2434}
2435static inline void clk_debug_unregister(struct clk_core *core)
2436{
2437}
2438#endif
2439
Michael Turquette3d3801e2015-02-25 09:11:01 -08002440/**
Masahiro Yamadabe45ebf2015-12-28 19:22:57 +09002441 * __clk_core_init - initialize the data structures in a struct clk_core
Masahiro Yamadad35c80c2015-12-28 19:22:56 +09002442 * @core: clk_core being initialized
Mike Turquetteb24764902012-03-15 23:11:19 -07002443 *
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002444 * Initializes the lists in struct clk_core, queries the hardware for the
Mike Turquetteb24764902012-03-15 23:11:19 -07002445 * parent and rate and sets them both.
Mike Turquetteb24764902012-03-15 23:11:19 -07002446 */
Masahiro Yamadabe45ebf2015-12-28 19:22:57 +09002447static int __clk_core_init(struct clk_core *core)
Mike Turquetteb24764902012-03-15 23:11:19 -07002448{
Marek Szyprowski9a34b452017-08-21 10:04:59 +02002449 int i, ret;
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002450 struct clk_core *orphan;
Sasha Levinb67bfe02013-02-27 17:06:00 -08002451 struct hlist_node *tmp2;
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002452 unsigned long rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07002453
Masahiro Yamadad35c80c2015-12-28 19:22:56 +09002454 if (!core)
Mike Turquetted1302a32012-03-29 14:30:40 -07002455 return -EINVAL;
Mike Turquetteb24764902012-03-15 23:11:19 -07002456
Mike Turquetteeab89f62013-03-28 13:59:01 -07002457 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07002458
Marek Szyprowski9a34b452017-08-21 10:04:59 +02002459 ret = clk_pm_runtime_get(core);
2460 if (ret)
2461 goto unlock;
2462
Mike Turquetteb24764902012-03-15 23:11:19 -07002463 /* check to see if a clock with this name is already registered */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002464 if (clk_core_lookup(core->name)) {
Mike Turquetted1302a32012-03-29 14:30:40 -07002465 pr_debug("%s: clk %s already initialized\n",
Stephen Boydd6968fc2015-04-30 13:54:13 -07002466 __func__, core->name);
Mike Turquetted1302a32012-03-29 14:30:40 -07002467 ret = -EEXIST;
Mike Turquetteb24764902012-03-15 23:11:19 -07002468 goto out;
Mike Turquetted1302a32012-03-29 14:30:40 -07002469 }
Mike Turquetteb24764902012-03-15 23:11:19 -07002470
Mike Turquetted4d7e3d2012-03-26 16:15:52 -07002471 /* check that clk_ops are sane. See Documentation/clk.txt */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002472 if (core->ops->set_rate &&
2473 !((core->ops->round_rate || core->ops->determine_rate) &&
2474 core->ops->recalc_rate)) {
Masahiro Yamadac44fccb2015-12-28 19:23:03 +09002475 pr_err("%s: %s must implement .round_rate or .determine_rate in addition to .recalc_rate\n",
2476 __func__, core->name);
Mike Turquetted1302a32012-03-29 14:30:40 -07002477 ret = -EINVAL;
Mike Turquetted4d7e3d2012-03-26 16:15:52 -07002478 goto out;
2479 }
2480
Stephen Boydd6968fc2015-04-30 13:54:13 -07002481 if (core->ops->set_parent && !core->ops->get_parent) {
Masahiro Yamadac44fccb2015-12-28 19:23:03 +09002482 pr_err("%s: %s must implement .get_parent & .set_parent\n",
2483 __func__, core->name);
Mike Turquetted1302a32012-03-29 14:30:40 -07002484 ret = -EINVAL;
Mike Turquetted4d7e3d2012-03-26 16:15:52 -07002485 goto out;
2486 }
2487
Masahiro Yamada3c8e77d2015-12-28 19:23:04 +09002488 if (core->num_parents > 1 && !core->ops->get_parent) {
2489 pr_err("%s: %s must implement .get_parent as it has multi parents\n",
2490 __func__, core->name);
2491 ret = -EINVAL;
2492 goto out;
2493 }
2494
Stephen Boydd6968fc2015-04-30 13:54:13 -07002495 if (core->ops->set_rate_and_parent &&
2496 !(core->ops->set_parent && core->ops->set_rate)) {
Masahiro Yamadac44fccb2015-12-28 19:23:03 +09002497 pr_err("%s: %s must implement .set_parent & .set_rate\n",
Stephen Boydd6968fc2015-04-30 13:54:13 -07002498 __func__, core->name);
Stephen Boyd3fa22522014-01-15 10:47:22 -08002499 ret = -EINVAL;
2500 goto out;
2501 }
2502
Mike Turquetteb24764902012-03-15 23:11:19 -07002503 /* throw a WARN if any entries in parent_names are NULL */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002504 for (i = 0; i < core->num_parents; i++)
2505 WARN(!core->parent_names[i],
Mike Turquetteb24764902012-03-15 23:11:19 -07002506 "%s: invalid NULL in %s's .parent_names\n",
Stephen Boydd6968fc2015-04-30 13:54:13 -07002507 __func__, core->name);
Mike Turquetteb24764902012-03-15 23:11:19 -07002508
Stephen Boydd6968fc2015-04-30 13:54:13 -07002509 core->parent = __clk_init_parent(core);
Mike Turquetteb24764902012-03-15 23:11:19 -07002510
2511 /*
Stephen Boyd706d5c72016-02-22 15:43:41 -08002512 * Populate core->parent if parent has already been clk_core_init'd. If
2513 * parent has not yet been clk_core_init'd then place clk in the orphan
Stephen Boyd47b0eeb2016-02-02 17:24:56 -08002514 * list. If clk doesn't have any parents then place it in the root
Mike Turquetteb24764902012-03-15 23:11:19 -07002515 * clk list.
2516 *
2517 * Every time a new clk is clk_init'd then we walk the list of orphan
2518 * clocks and re-parent any that are children of the clock currently
2519 * being clk_init'd.
2520 */
Heiko Stuebnere6500342015-04-22 22:53:05 +02002521 if (core->parent) {
Stephen Boydd6968fc2015-04-30 13:54:13 -07002522 hlist_add_head(&core->child_node,
2523 &core->parent->children);
Heiko Stuebnere6500342015-04-22 22:53:05 +02002524 core->orphan = core->parent->orphan;
Stephen Boyd47b0eeb2016-02-02 17:24:56 -08002525 } else if (!core->num_parents) {
Stephen Boydd6968fc2015-04-30 13:54:13 -07002526 hlist_add_head(&core->child_node, &clk_root_list);
Heiko Stuebnere6500342015-04-22 22:53:05 +02002527 core->orphan = false;
2528 } else {
Stephen Boydd6968fc2015-04-30 13:54:13 -07002529 hlist_add_head(&core->child_node, &clk_orphan_list);
Heiko Stuebnere6500342015-04-22 22:53:05 +02002530 core->orphan = true;
2531 }
Mike Turquetteb24764902012-03-15 23:11:19 -07002532
2533 /*
Boris BREZILLON5279fc42013-12-21 10:34:47 +01002534 * Set clk's accuracy. The preferred method is to use
2535 * .recalc_accuracy. For simple clocks and lazy developers the default
2536 * fallback is to use the parent's accuracy. If a clock doesn't have a
2537 * parent (or is orphaned) then accuracy is set to zero (perfect
2538 * clock).
2539 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002540 if (core->ops->recalc_accuracy)
2541 core->accuracy = core->ops->recalc_accuracy(core->hw,
2542 __clk_get_accuracy(core->parent));
2543 else if (core->parent)
2544 core->accuracy = core->parent->accuracy;
Boris BREZILLON5279fc42013-12-21 10:34:47 +01002545 else
Stephen Boydd6968fc2015-04-30 13:54:13 -07002546 core->accuracy = 0;
Boris BREZILLON5279fc42013-12-21 10:34:47 +01002547
2548 /*
Maxime Ripard9824cf72014-07-14 13:53:27 +02002549 * Set clk's phase.
2550 * Since a phase is by definition relative to its parent, just
2551 * query the current clock phase, or just assume it's in phase.
2552 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002553 if (core->ops->get_phase)
2554 core->phase = core->ops->get_phase(core->hw);
Maxime Ripard9824cf72014-07-14 13:53:27 +02002555 else
Stephen Boydd6968fc2015-04-30 13:54:13 -07002556 core->phase = 0;
Maxime Ripard9824cf72014-07-14 13:53:27 +02002557
2558 /*
Mike Turquetteb24764902012-03-15 23:11:19 -07002559 * Set clk's rate. The preferred method is to use .recalc_rate. For
2560 * simple clocks and lazy developers the default fallback is to use the
2561 * parent's rate. If a clock doesn't have a parent (or is orphaned)
2562 * then rate is set to zero.
2563 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002564 if (core->ops->recalc_rate)
2565 rate = core->ops->recalc_rate(core->hw,
2566 clk_core_get_rate_nolock(core->parent));
2567 else if (core->parent)
2568 rate = core->parent->rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07002569 else
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002570 rate = 0;
Stephen Boydd6968fc2015-04-30 13:54:13 -07002571 core->rate = core->req_rate = rate;
Mike Turquetteb24764902012-03-15 23:11:19 -07002572
2573 /*
Masahiro Yamada0e8f6e42015-12-28 19:23:07 +09002574 * walk the list of orphan clocks and reparent any that newly finds a
2575 * parent.
Mike Turquetteb24764902012-03-15 23:11:19 -07002576 */
Sasha Levinb67bfe02013-02-27 17:06:00 -08002577 hlist_for_each_entry_safe(orphan, tmp2, &clk_orphan_list, child_node) {
Masahiro Yamada0e8f6e42015-12-28 19:23:07 +09002578 struct clk_core *parent = __clk_init_parent(orphan);
Martin Fuzzey1f61e5f2012-11-22 20:15:05 +01002579
Michael Turquette904e6ea2016-07-08 16:32:10 -07002580 /*
2581 * we could call __clk_set_parent, but that would result in a
2582 * redundant call to the .set_rate op, if it exists
2583 */
2584 if (parent) {
2585 __clk_set_parent_before(orphan, parent);
2586 __clk_set_parent_after(orphan, parent, NULL);
2587 __clk_recalc_accuracies(orphan);
2588 __clk_recalc_rates(orphan, 0);
2589 }
Masahiro Yamada0e8f6e42015-12-28 19:23:07 +09002590 }
Mike Turquetteb24764902012-03-15 23:11:19 -07002591
2592 /*
2593 * optional platform-specific magic
2594 *
2595 * The .init callback is not used by any of the basic clock types, but
2596 * exists for weird hardware that must perform initialization magic.
2597 * Please consider other ways of solving initialization problems before
Peter Meerwald24ee1a02013-06-29 15:14:19 +02002598 * using this callback, as its use is discouraged.
Mike Turquetteb24764902012-03-15 23:11:19 -07002599 */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002600 if (core->ops->init)
2601 core->ops->init(core->hw);
Mike Turquetteb24764902012-03-15 23:11:19 -07002602
Lee Jones32b9b102016-02-11 13:19:09 -08002603 if (core->flags & CLK_IS_CRITICAL) {
Maxime Ripardef56b792016-05-13 10:00:31 +02002604 unsigned long flags;
2605
Lee Jones32b9b102016-02-11 13:19:09 -08002606 clk_core_prepare(core);
Maxime Ripardef56b792016-05-13 10:00:31 +02002607
2608 flags = clk_enable_lock();
Lee Jones32b9b102016-02-11 13:19:09 -08002609 clk_core_enable(core);
Maxime Ripardef56b792016-05-13 10:00:31 +02002610 clk_enable_unlock(flags);
Lee Jones32b9b102016-02-11 13:19:09 -08002611 }
2612
Stephen Boydd6968fc2015-04-30 13:54:13 -07002613 kref_init(&core->ref);
Mike Turquetteb24764902012-03-15 23:11:19 -07002614out:
Marek Szyprowski9a34b452017-08-21 10:04:59 +02002615 clk_pm_runtime_put(core);
2616unlock:
Mike Turquetteeab89f62013-03-28 13:59:01 -07002617 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07002618
Stephen Boyd89f7e9d2014-12-12 15:04:16 -08002619 if (!ret)
Stephen Boydd6968fc2015-04-30 13:54:13 -07002620 clk_debug_register(core);
Stephen Boyd89f7e9d2014-12-12 15:04:16 -08002621
Mike Turquetted1302a32012-03-29 14:30:40 -07002622 return ret;
Mike Turquetteb24764902012-03-15 23:11:19 -07002623}
2624
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002625struct clk *__clk_create_clk(struct clk_hw *hw, const char *dev_id,
2626 const char *con_id)
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002627{
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002628 struct clk *clk;
2629
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002630 /* This is to allow this function to be chained to others */
Masahiro Yamadac1de1352015-11-20 14:38:49 +09002631 if (IS_ERR_OR_NULL(hw))
Masahiro Yamada8a231332016-07-19 16:28:47 +09002632 return ERR_CAST(hw);
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002633
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002634 clk = kzalloc(sizeof(*clk), GFP_KERNEL);
2635 if (!clk)
2636 return ERR_PTR(-ENOMEM);
2637
2638 clk->core = hw->core;
2639 clk->dev_id = dev_id;
Leonard Crestez253160a2017-02-20 15:20:56 +02002640 clk->con_id = kstrdup_const(con_id, GFP_KERNEL);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002641 clk->max_rate = ULONG_MAX;
2642
2643 clk_prepare_lock();
Stephen Boyd50595f82015-02-06 11:42:44 -08002644 hlist_add_head(&clk->clks_node, &hw->core->clks);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002645 clk_prepare_unlock();
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002646
2647 return clk;
2648}
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002649
Stephen Boyd73e0e492015-02-06 11:42:43 -08002650void __clk_free_clk(struct clk *clk)
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002651{
2652 clk_prepare_lock();
Stephen Boyd50595f82015-02-06 11:42:44 -08002653 hlist_del(&clk->clks_node);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002654 clk_prepare_unlock();
2655
Leonard Crestez253160a2017-02-20 15:20:56 +02002656 kfree_const(clk->con_id);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002657 kfree(clk);
2658}
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002659
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002660/**
2661 * clk_register - allocate a new clock, register it and return an opaque cookie
2662 * @dev: device that is registering this clock
2663 * @hw: link to hardware-specific clock data
2664 *
2665 * clk_register is the primary interface for populating the clock tree with new
2666 * clock nodes. It returns a pointer to the newly allocated struct clk which
Shailendra Vermaa59a5162015-05-21 00:06:48 +05302667 * cannot be dereferenced by driver code but may be used in conjunction with the
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002668 * rest of the clock API. In the event of an error clk_register will return an
2669 * error code; drivers must test for an error code after calling clk_register.
2670 */
2671struct clk *clk_register(struct device *dev, struct clk_hw *hw)
Mike Turquetteb24764902012-03-15 23:11:19 -07002672{
Mike Turquetted1302a32012-03-29 14:30:40 -07002673 int i, ret;
Stephen Boydd6968fc2015-04-30 13:54:13 -07002674 struct clk_core *core;
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002675
Stephen Boydd6968fc2015-04-30 13:54:13 -07002676 core = kzalloc(sizeof(*core), GFP_KERNEL);
2677 if (!core) {
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002678 ret = -ENOMEM;
2679 goto fail_out;
2680 }
Mike Turquetteb24764902012-03-15 23:11:19 -07002681
Stephen Boydd6968fc2015-04-30 13:54:13 -07002682 core->name = kstrdup_const(hw->init->name, GFP_KERNEL);
2683 if (!core->name) {
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002684 ret = -ENOMEM;
2685 goto fail_name;
2686 }
Stephen Boydd6968fc2015-04-30 13:54:13 -07002687 core->ops = hw->init->ops;
Marek Szyprowski9a34b452017-08-21 10:04:59 +02002688 if (dev && pm_runtime_enabled(dev))
2689 core->dev = dev;
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02002690 if (dev && dev->driver)
Stephen Boydd6968fc2015-04-30 13:54:13 -07002691 core->owner = dev->driver->owner;
2692 core->hw = hw;
2693 core->flags = hw->init->flags;
2694 core->num_parents = hw->init->num_parents;
Stephen Boyd9783c0d2015-07-16 12:50:27 -07002695 core->min_rate = 0;
2696 core->max_rate = ULONG_MAX;
Stephen Boydd6968fc2015-04-30 13:54:13 -07002697 hw->core = core;
Mike Turquetteb24764902012-03-15 23:11:19 -07002698
Mike Turquetted1302a32012-03-29 14:30:40 -07002699 /* allocate local copy in case parent_names is __initdata */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002700 core->parent_names = kcalloc(core->num_parents, sizeof(char *),
Tomasz Figa96a7ed92013-09-29 02:37:15 +02002701 GFP_KERNEL);
Mike Turquetteb24764902012-03-15 23:11:19 -07002702
Stephen Boydd6968fc2015-04-30 13:54:13 -07002703 if (!core->parent_names) {
Mike Turquetted1302a32012-03-29 14:30:40 -07002704 ret = -ENOMEM;
2705 goto fail_parent_names;
2706 }
2707
2708
2709 /* copy each string name in case parent_names is __initdata */
Stephen Boydd6968fc2015-04-30 13:54:13 -07002710 for (i = 0; i < core->num_parents; i++) {
2711 core->parent_names[i] = kstrdup_const(hw->init->parent_names[i],
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002712 GFP_KERNEL);
Stephen Boydd6968fc2015-04-30 13:54:13 -07002713 if (!core->parent_names[i]) {
Mike Turquetted1302a32012-03-29 14:30:40 -07002714 ret = -ENOMEM;
2715 goto fail_parent_names_copy;
2716 }
2717 }
2718
Masahiro Yamada176d1162015-12-28 19:23:00 +09002719 /* avoid unnecessary string look-ups of clk_core's possible parents. */
2720 core->parents = kcalloc(core->num_parents, sizeof(*core->parents),
2721 GFP_KERNEL);
2722 if (!core->parents) {
2723 ret = -ENOMEM;
2724 goto fail_parents;
2725 };
2726
Stephen Boydd6968fc2015-04-30 13:54:13 -07002727 INIT_HLIST_HEAD(&core->clks);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002728
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002729 hw->clk = __clk_create_clk(hw, NULL, NULL);
2730 if (IS_ERR(hw->clk)) {
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002731 ret = PTR_ERR(hw->clk);
Masahiro Yamada176d1162015-12-28 19:23:00 +09002732 goto fail_parents;
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002733 }
Mike Turquetted1302a32012-03-29 14:30:40 -07002734
Masahiro Yamadabe45ebf2015-12-28 19:22:57 +09002735 ret = __clk_core_init(core);
Mike Turquetted1302a32012-03-29 14:30:40 -07002736 if (!ret)
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002737 return hw->clk;
2738
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01002739 __clk_free_clk(hw->clk);
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002740 hw->clk = NULL;
Mike Turquetted1302a32012-03-29 14:30:40 -07002741
Masahiro Yamada176d1162015-12-28 19:23:00 +09002742fail_parents:
2743 kfree(core->parents);
Mike Turquetted1302a32012-03-29 14:30:40 -07002744fail_parent_names_copy:
2745 while (--i >= 0)
Stephen Boydd6968fc2015-04-30 13:54:13 -07002746 kfree_const(core->parent_names[i]);
2747 kfree(core->parent_names);
Mike Turquetted1302a32012-03-29 14:30:40 -07002748fail_parent_names:
Stephen Boydd6968fc2015-04-30 13:54:13 -07002749 kfree_const(core->name);
Saravana Kannan0197b3e2012-04-25 22:58:56 -07002750fail_name:
Stephen Boydd6968fc2015-04-30 13:54:13 -07002751 kfree(core);
Mike Turquetted1302a32012-03-29 14:30:40 -07002752fail_out:
2753 return ERR_PTR(ret);
Mike Turquetteb24764902012-03-15 23:11:19 -07002754}
2755EXPORT_SYMBOL_GPL(clk_register);
2756
Stephen Boyd41438042016-02-05 17:02:52 -08002757/**
2758 * clk_hw_register - register a clk_hw and return an error code
2759 * @dev: device that is registering this clock
2760 * @hw: link to hardware-specific clock data
2761 *
2762 * clk_hw_register is the primary interface for populating the clock tree with
2763 * new clock nodes. It returns an integer equal to zero indicating success or
2764 * less than zero indicating failure. Drivers must test for an error code after
2765 * calling clk_hw_register().
2766 */
2767int clk_hw_register(struct device *dev, struct clk_hw *hw)
2768{
2769 return PTR_ERR_OR_ZERO(clk_register(dev, hw));
2770}
2771EXPORT_SYMBOL_GPL(clk_hw_register);
2772
Stephen Boyd6e5ab412015-04-30 15:11:31 -07002773/* Free memory allocated for a clock. */
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002774static void __clk_release(struct kref *ref)
2775{
Stephen Boydd6968fc2015-04-30 13:54:13 -07002776 struct clk_core *core = container_of(ref, struct clk_core, ref);
2777 int i = core->num_parents;
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002778
Krzysztof Kozlowski496eadf2015-01-09 09:28:10 +01002779 lockdep_assert_held(&prepare_lock);
2780
Stephen Boydd6968fc2015-04-30 13:54:13 -07002781 kfree(core->parents);
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002782 while (--i >= 0)
Stephen Boydd6968fc2015-04-30 13:54:13 -07002783 kfree_const(core->parent_names[i]);
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002784
Stephen Boydd6968fc2015-04-30 13:54:13 -07002785 kfree(core->parent_names);
2786 kfree_const(core->name);
2787 kfree(core);
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002788}
2789
2790/*
2791 * Empty clk_ops for unregistered clocks. These are used temporarily
2792 * after clk_unregister() was called on a clock and until last clock
2793 * consumer calls clk_put() and the struct clk object is freed.
2794 */
2795static int clk_nodrv_prepare_enable(struct clk_hw *hw)
2796{
2797 return -ENXIO;
2798}
2799
2800static void clk_nodrv_disable_unprepare(struct clk_hw *hw)
2801{
2802 WARN_ON_ONCE(1);
2803}
2804
2805static int clk_nodrv_set_rate(struct clk_hw *hw, unsigned long rate,
2806 unsigned long parent_rate)
2807{
2808 return -ENXIO;
2809}
2810
2811static int clk_nodrv_set_parent(struct clk_hw *hw, u8 index)
2812{
2813 return -ENXIO;
2814}
2815
2816static const struct clk_ops clk_nodrv_ops = {
2817 .enable = clk_nodrv_prepare_enable,
2818 .disable = clk_nodrv_disable_unprepare,
2819 .prepare = clk_nodrv_prepare_enable,
2820 .unprepare = clk_nodrv_disable_unprepare,
2821 .set_rate = clk_nodrv_set_rate,
2822 .set_parent = clk_nodrv_set_parent,
2823};
2824
Mark Brown1df5c932012-04-18 09:07:12 +01002825/**
2826 * clk_unregister - unregister a currently registered clock
2827 * @clk: clock to unregister
Mark Brown1df5c932012-04-18 09:07:12 +01002828 */
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002829void clk_unregister(struct clk *clk)
2830{
2831 unsigned long flags;
2832
Stephen Boyd6314b672014-09-04 23:37:49 -07002833 if (!clk || WARN_ON_ONCE(IS_ERR(clk)))
2834 return;
2835
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002836 clk_debug_unregister(clk->core);
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002837
2838 clk_prepare_lock();
2839
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002840 if (clk->core->ops == &clk_nodrv_ops) {
2841 pr_err("%s: unregistered clock: %s\n", __func__,
2842 clk->core->name);
Insu Yun4106a3d2016-01-30 10:12:04 -05002843 goto unlock;
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002844 }
2845 /*
2846 * Assign empty clock ops for consumers that might still hold
2847 * a reference to this clock.
2848 */
2849 flags = clk_enable_lock();
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002850 clk->core->ops = &clk_nodrv_ops;
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002851 clk_enable_unlock(flags);
2852
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002853 if (!hlist_empty(&clk->core->children)) {
2854 struct clk_core *child;
Stephen Boyd874f2242014-04-18 16:29:43 -07002855 struct hlist_node *t;
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002856
2857 /* Reparent all children to the orphan list. */
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002858 hlist_for_each_entry_safe(child, t, &clk->core->children,
2859 child_node)
2860 clk_core_set_parent(child, NULL);
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002861 }
2862
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002863 hlist_del_init(&clk->core->child_node);
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002864
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002865 if (clk->core->prepare_count)
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002866 pr_warn("%s: unregistering prepared clock: %s\n",
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01002867 __func__, clk->core->name);
2868 kref_put(&clk->core->ref, __clk_release);
Insu Yun4106a3d2016-01-30 10:12:04 -05002869unlock:
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02002870 clk_prepare_unlock();
2871}
Mark Brown1df5c932012-04-18 09:07:12 +01002872EXPORT_SYMBOL_GPL(clk_unregister);
2873
Stephen Boyd41438042016-02-05 17:02:52 -08002874/**
2875 * clk_hw_unregister - unregister a currently registered clk_hw
2876 * @hw: hardware-specific clock data to unregister
2877 */
2878void clk_hw_unregister(struct clk_hw *hw)
2879{
2880 clk_unregister(hw->clk);
2881}
2882EXPORT_SYMBOL_GPL(clk_hw_unregister);
2883
Stephen Boyd46c87732012-09-24 13:38:04 -07002884static void devm_clk_release(struct device *dev, void *res)
2885{
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002886 clk_unregister(*(struct clk **)res);
Stephen Boyd46c87732012-09-24 13:38:04 -07002887}
2888
Stephen Boyd41438042016-02-05 17:02:52 -08002889static void devm_clk_hw_release(struct device *dev, void *res)
2890{
2891 clk_hw_unregister(*(struct clk_hw **)res);
2892}
2893
Stephen Boyd46c87732012-09-24 13:38:04 -07002894/**
2895 * devm_clk_register - resource managed clk_register()
2896 * @dev: device that is registering this clock
2897 * @hw: link to hardware-specific clock data
2898 *
2899 * Managed clk_register(). Clocks returned from this function are
2900 * automatically clk_unregister()ed on driver detach. See clk_register() for
2901 * more information.
2902 */
2903struct clk *devm_clk_register(struct device *dev, struct clk_hw *hw)
2904{
2905 struct clk *clk;
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002906 struct clk **clkp;
Stephen Boyd46c87732012-09-24 13:38:04 -07002907
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002908 clkp = devres_alloc(devm_clk_release, sizeof(*clkp), GFP_KERNEL);
2909 if (!clkp)
Stephen Boyd46c87732012-09-24 13:38:04 -07002910 return ERR_PTR(-ENOMEM);
2911
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002912 clk = clk_register(dev, hw);
2913 if (!IS_ERR(clk)) {
2914 *clkp = clk;
2915 devres_add(dev, clkp);
Stephen Boyd46c87732012-09-24 13:38:04 -07002916 } else {
Stephen Boyd293ba3b2014-04-18 16:29:42 -07002917 devres_free(clkp);
Stephen Boyd46c87732012-09-24 13:38:04 -07002918 }
2919
2920 return clk;
2921}
2922EXPORT_SYMBOL_GPL(devm_clk_register);
2923
Stephen Boyd41438042016-02-05 17:02:52 -08002924/**
2925 * devm_clk_hw_register - resource managed clk_hw_register()
2926 * @dev: device that is registering this clock
2927 * @hw: link to hardware-specific clock data
2928 *
Masahiro Yamadac47265a2016-05-01 19:56:08 +09002929 * Managed clk_hw_register(). Clocks registered by this function are
Stephen Boyd41438042016-02-05 17:02:52 -08002930 * automatically clk_hw_unregister()ed on driver detach. See clk_hw_register()
2931 * for more information.
2932 */
2933int devm_clk_hw_register(struct device *dev, struct clk_hw *hw)
2934{
2935 struct clk_hw **hwp;
2936 int ret;
2937
2938 hwp = devres_alloc(devm_clk_hw_release, sizeof(*hwp), GFP_KERNEL);
2939 if (!hwp)
2940 return -ENOMEM;
2941
2942 ret = clk_hw_register(dev, hw);
2943 if (!ret) {
2944 *hwp = hw;
2945 devres_add(dev, hwp);
2946 } else {
2947 devres_free(hwp);
2948 }
2949
2950 return ret;
2951}
2952EXPORT_SYMBOL_GPL(devm_clk_hw_register);
2953
Stephen Boyd46c87732012-09-24 13:38:04 -07002954static int devm_clk_match(struct device *dev, void *res, void *data)
2955{
2956 struct clk *c = res;
2957 if (WARN_ON(!c))
2958 return 0;
2959 return c == data;
2960}
2961
Stephen Boyd41438042016-02-05 17:02:52 -08002962static int devm_clk_hw_match(struct device *dev, void *res, void *data)
2963{
2964 struct clk_hw *hw = res;
2965
2966 if (WARN_ON(!hw))
2967 return 0;
2968 return hw == data;
2969}
2970
Stephen Boyd46c87732012-09-24 13:38:04 -07002971/**
2972 * devm_clk_unregister - resource managed clk_unregister()
2973 * @clk: clock to unregister
2974 *
2975 * Deallocate a clock allocated with devm_clk_register(). Normally
2976 * this function will not need to be called and the resource management
2977 * code will ensure that the resource is freed.
2978 */
2979void devm_clk_unregister(struct device *dev, struct clk *clk)
2980{
2981 WARN_ON(devres_release(dev, devm_clk_release, devm_clk_match, clk));
2982}
2983EXPORT_SYMBOL_GPL(devm_clk_unregister);
2984
Stephen Boyd41438042016-02-05 17:02:52 -08002985/**
2986 * devm_clk_hw_unregister - resource managed clk_hw_unregister()
2987 * @dev: device that is unregistering the hardware-specific clock data
2988 * @hw: link to hardware-specific clock data
2989 *
2990 * Unregister a clk_hw registered with devm_clk_hw_register(). Normally
2991 * this function will not need to be called and the resource management
2992 * code will ensure that the resource is freed.
2993 */
2994void devm_clk_hw_unregister(struct device *dev, struct clk_hw *hw)
2995{
2996 WARN_ON(devres_release(dev, devm_clk_hw_release, devm_clk_hw_match,
2997 hw));
2998}
2999EXPORT_SYMBOL_GPL(devm_clk_hw_unregister);
3000
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02003001/*
3002 * clkdev helpers
3003 */
3004int __clk_get(struct clk *clk)
3005{
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01003006 struct clk_core *core = !clk ? NULL : clk->core;
3007
3008 if (core) {
3009 if (!try_module_get(core->owner))
Sylwester Nawrocki00efcb12014-01-07 13:03:43 +01003010 return 0;
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02003011
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01003012 kref_get(&core->ref);
Sylwester Nawrocki00efcb12014-01-07 13:03:43 +01003013 }
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02003014 return 1;
3015}
3016
3017void __clk_put(struct clk *clk)
3018{
Tomeu Vizoso10cdfe52014-12-02 08:54:19 +01003019 struct module *owner;
3020
Sylwester Nawrocki00efcb12014-01-07 13:03:43 +01003021 if (!clk || WARN_ON_ONCE(IS_ERR(clk)))
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02003022 return;
3023
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02003024 clk_prepare_lock();
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01003025
Stephen Boyd50595f82015-02-06 11:42:44 -08003026 hlist_del(&clk->clks_node);
Tomeu Vizosoec02ace2015-02-06 15:13:01 +01003027 if (clk->min_rate > clk->core->req_rate ||
3028 clk->max_rate < clk->core->req_rate)
3029 clk_core_set_rate_nolock(clk->core, clk->core->req_rate);
3030
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01003031 owner = clk->core->owner;
3032 kref_put(&clk->core->ref, __clk_release);
3033
Sylwester Nawrockifcb0ee62013-08-24 15:00:10 +02003034 clk_prepare_unlock();
3035
Tomeu Vizoso10cdfe52014-12-02 08:54:19 +01003036 module_put(owner);
Tomeu Vizoso1c8e6002015-01-23 12:03:31 +01003037
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01003038 kfree(clk);
Sylwester Nawrockiac2df522013-08-24 20:10:41 +02003039}
3040
Mike Turquetteb24764902012-03-15 23:11:19 -07003041/*** clk rate change notifiers ***/
3042
3043/**
3044 * clk_notifier_register - add a clk rate change notifier
3045 * @clk: struct clk * to watch
3046 * @nb: struct notifier_block * with callback info
3047 *
3048 * Request notification when clk's rate changes. This uses an SRCU
3049 * notifier because we want it to block and notifier unregistrations are
3050 * uncommon. The callbacks associated with the notifier must not
3051 * re-enter into the clk framework by calling any top-level clk APIs;
3052 * this will cause a nested prepare_lock mutex.
3053 *
Masahiro Yamada198bb592015-11-30 16:40:51 +09003054 * In all notification cases (pre, post and abort rate change) the original
3055 * clock rate is passed to the callback via struct clk_notifier_data.old_rate
3056 * and the new frequency is passed via struct clk_notifier_data.new_rate.
Mike Turquetteb24764902012-03-15 23:11:19 -07003057 *
Mike Turquetteb24764902012-03-15 23:11:19 -07003058 * clk_notifier_register() must be called from non-atomic context.
3059 * Returns -EINVAL if called with null arguments, -ENOMEM upon
3060 * allocation failure; otherwise, passes along the return value of
3061 * srcu_notifier_chain_register().
3062 */
3063int clk_notifier_register(struct clk *clk, struct notifier_block *nb)
3064{
3065 struct clk_notifier *cn;
3066 int ret = -ENOMEM;
3067
3068 if (!clk || !nb)
3069 return -EINVAL;
3070
Mike Turquetteeab89f62013-03-28 13:59:01 -07003071 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07003072
3073 /* search the list of notifiers for this clk */
3074 list_for_each_entry(cn, &clk_notifier_list, node)
3075 if (cn->clk == clk)
3076 break;
3077
3078 /* if clk wasn't in the notifier list, allocate new clk_notifier */
3079 if (cn->clk != clk) {
Markus Elfring1808a322017-04-20 09:30:52 +02003080 cn = kzalloc(sizeof(*cn), GFP_KERNEL);
Mike Turquetteb24764902012-03-15 23:11:19 -07003081 if (!cn)
3082 goto out;
3083
3084 cn->clk = clk;
3085 srcu_init_notifier_head(&cn->notifier_head);
3086
3087 list_add(&cn->node, &clk_notifier_list);
3088 }
3089
3090 ret = srcu_notifier_chain_register(&cn->notifier_head, nb);
3091
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01003092 clk->core->notifier_count++;
Mike Turquetteb24764902012-03-15 23:11:19 -07003093
3094out:
Mike Turquetteeab89f62013-03-28 13:59:01 -07003095 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07003096
3097 return ret;
3098}
3099EXPORT_SYMBOL_GPL(clk_notifier_register);
3100
3101/**
3102 * clk_notifier_unregister - remove a clk rate change notifier
3103 * @clk: struct clk *
3104 * @nb: struct notifier_block * with callback info
3105 *
3106 * Request no further notification for changes to 'clk' and frees memory
3107 * allocated in clk_notifier_register.
3108 *
3109 * Returns -EINVAL if called with null arguments; otherwise, passes
3110 * along the return value of srcu_notifier_chain_unregister().
3111 */
3112int clk_notifier_unregister(struct clk *clk, struct notifier_block *nb)
3113{
3114 struct clk_notifier *cn = NULL;
3115 int ret = -EINVAL;
3116
3117 if (!clk || !nb)
3118 return -EINVAL;
3119
Mike Turquetteeab89f62013-03-28 13:59:01 -07003120 clk_prepare_lock();
Mike Turquetteb24764902012-03-15 23:11:19 -07003121
3122 list_for_each_entry(cn, &clk_notifier_list, node)
3123 if (cn->clk == clk)
3124 break;
3125
3126 if (cn->clk == clk) {
3127 ret = srcu_notifier_chain_unregister(&cn->notifier_head, nb);
3128
Tomeu Vizoso035a61c2015-01-23 12:03:30 +01003129 clk->core->notifier_count--;
Mike Turquetteb24764902012-03-15 23:11:19 -07003130
3131 /* XXX the notifier code should handle this better */
3132 if (!cn->notifier_head.head) {
3133 srcu_cleanup_notifier_head(&cn->notifier_head);
Lai Jiangshan72b53222013-06-03 17:17:15 +08003134 list_del(&cn->node);
Mike Turquetteb24764902012-03-15 23:11:19 -07003135 kfree(cn);
3136 }
3137
3138 } else {
3139 ret = -ENOENT;
3140 }
3141
Mike Turquetteeab89f62013-03-28 13:59:01 -07003142 clk_prepare_unlock();
Mike Turquetteb24764902012-03-15 23:11:19 -07003143
3144 return ret;
3145}
3146EXPORT_SYMBOL_GPL(clk_notifier_unregister);
Grant Likely766e6a42012-04-09 14:50:06 -05003147
3148#ifdef CONFIG_OF
3149/**
3150 * struct of_clk_provider - Clock provider registration structure
3151 * @link: Entry in global list of clock providers
3152 * @node: Pointer to device tree node of clock provider
3153 * @get: Get clock callback. Returns NULL or a struct clk for the
3154 * given clock specifier
3155 * @data: context pointer to be passed into @get callback
3156 */
3157struct of_clk_provider {
3158 struct list_head link;
3159
3160 struct device_node *node;
3161 struct clk *(*get)(struct of_phandle_args *clkspec, void *data);
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003162 struct clk_hw *(*get_hw)(struct of_phandle_args *clkspec, void *data);
Grant Likely766e6a42012-04-09 14:50:06 -05003163 void *data;
3164};
3165
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +05303166static const struct of_device_id __clk_of_table_sentinel
3167 __used __section(__clk_of_table_end);
3168
Grant Likely766e6a42012-04-09 14:50:06 -05003169static LIST_HEAD(of_clk_providers);
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02003170static DEFINE_MUTEX(of_clk_mutex);
3171
Grant Likely766e6a42012-04-09 14:50:06 -05003172struct clk *of_clk_src_simple_get(struct of_phandle_args *clkspec,
3173 void *data)
3174{
3175 return data;
3176}
3177EXPORT_SYMBOL_GPL(of_clk_src_simple_get);
3178
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003179struct clk_hw *of_clk_hw_simple_get(struct of_phandle_args *clkspec, void *data)
3180{
3181 return data;
3182}
3183EXPORT_SYMBOL_GPL(of_clk_hw_simple_get);
3184
Shawn Guo494bfec2012-08-22 21:36:27 +08003185struct clk *of_clk_src_onecell_get(struct of_phandle_args *clkspec, void *data)
3186{
3187 struct clk_onecell_data *clk_data = data;
3188 unsigned int idx = clkspec->args[0];
3189
3190 if (idx >= clk_data->clk_num) {
Geert Uytterhoeven7e963532015-10-16 17:12:32 +02003191 pr_err("%s: invalid clock index %u\n", __func__, idx);
Shawn Guo494bfec2012-08-22 21:36:27 +08003192 return ERR_PTR(-EINVAL);
3193 }
3194
3195 return clk_data->clks[idx];
3196}
3197EXPORT_SYMBOL_GPL(of_clk_src_onecell_get);
3198
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003199struct clk_hw *
3200of_clk_hw_onecell_get(struct of_phandle_args *clkspec, void *data)
3201{
3202 struct clk_hw_onecell_data *hw_data = data;
3203 unsigned int idx = clkspec->args[0];
3204
3205 if (idx >= hw_data->num) {
3206 pr_err("%s: invalid index %u\n", __func__, idx);
3207 return ERR_PTR(-EINVAL);
3208 }
3209
3210 return hw_data->hws[idx];
3211}
3212EXPORT_SYMBOL_GPL(of_clk_hw_onecell_get);
3213
Grant Likely766e6a42012-04-09 14:50:06 -05003214/**
3215 * of_clk_add_provider() - Register a clock provider for a node
3216 * @np: Device node pointer associated with clock provider
3217 * @clk_src_get: callback for decoding clock
3218 * @data: context pointer for @clk_src_get callback.
3219 */
3220int of_clk_add_provider(struct device_node *np,
3221 struct clk *(*clk_src_get)(struct of_phandle_args *clkspec,
3222 void *data),
3223 void *data)
3224{
3225 struct of_clk_provider *cp;
Sylwester Nawrocki86be4082014-06-18 17:29:32 +02003226 int ret;
Grant Likely766e6a42012-04-09 14:50:06 -05003227
Markus Elfring1808a322017-04-20 09:30:52 +02003228 cp = kzalloc(sizeof(*cp), GFP_KERNEL);
Grant Likely766e6a42012-04-09 14:50:06 -05003229 if (!cp)
3230 return -ENOMEM;
3231
3232 cp->node = of_node_get(np);
3233 cp->data = data;
3234 cp->get = clk_src_get;
3235
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02003236 mutex_lock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05003237 list_add(&cp->link, &of_clk_providers);
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02003238 mutex_unlock(&of_clk_mutex);
Rob Herring16673932017-07-18 16:42:52 -05003239 pr_debug("Added clock from %pOF\n", np);
Grant Likely766e6a42012-04-09 14:50:06 -05003240
Sylwester Nawrocki86be4082014-06-18 17:29:32 +02003241 ret = of_clk_set_defaults(np, true);
3242 if (ret < 0)
3243 of_clk_del_provider(np);
3244
3245 return ret;
Grant Likely766e6a42012-04-09 14:50:06 -05003246}
3247EXPORT_SYMBOL_GPL(of_clk_add_provider);
3248
3249/**
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003250 * of_clk_add_hw_provider() - Register a clock provider for a node
3251 * @np: Device node pointer associated with clock provider
3252 * @get: callback for decoding clk_hw
3253 * @data: context pointer for @get callback.
3254 */
3255int of_clk_add_hw_provider(struct device_node *np,
3256 struct clk_hw *(*get)(struct of_phandle_args *clkspec,
3257 void *data),
3258 void *data)
3259{
3260 struct of_clk_provider *cp;
3261 int ret;
3262
3263 cp = kzalloc(sizeof(*cp), GFP_KERNEL);
3264 if (!cp)
3265 return -ENOMEM;
3266
3267 cp->node = of_node_get(np);
3268 cp->data = data;
3269 cp->get_hw = get;
3270
3271 mutex_lock(&of_clk_mutex);
3272 list_add(&cp->link, &of_clk_providers);
3273 mutex_unlock(&of_clk_mutex);
Rob Herring16673932017-07-18 16:42:52 -05003274 pr_debug("Added clk_hw provider from %pOF\n", np);
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003275
3276 ret = of_clk_set_defaults(np, true);
3277 if (ret < 0)
3278 of_clk_del_provider(np);
3279
3280 return ret;
3281}
3282EXPORT_SYMBOL_GPL(of_clk_add_hw_provider);
3283
Stephen Boydaa795c42017-09-01 16:16:40 -07003284static void devm_of_clk_release_provider(struct device *dev, void *res)
3285{
3286 of_clk_del_provider(*(struct device_node **)res);
3287}
3288
3289int devm_of_clk_add_hw_provider(struct device *dev,
3290 struct clk_hw *(*get)(struct of_phandle_args *clkspec,
3291 void *data),
3292 void *data)
3293{
3294 struct device_node **ptr, *np;
3295 int ret;
3296
3297 ptr = devres_alloc(devm_of_clk_release_provider, sizeof(*ptr),
3298 GFP_KERNEL);
3299 if (!ptr)
3300 return -ENOMEM;
3301
3302 np = dev->of_node;
3303 ret = of_clk_add_hw_provider(np, get, data);
3304 if (!ret) {
3305 *ptr = np;
3306 devres_add(dev, ptr);
3307 } else {
3308 devres_free(ptr);
3309 }
3310
3311 return ret;
3312}
3313EXPORT_SYMBOL_GPL(devm_of_clk_add_hw_provider);
3314
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003315/**
Grant Likely766e6a42012-04-09 14:50:06 -05003316 * of_clk_del_provider() - Remove a previously registered clock provider
3317 * @np: Device node pointer associated with clock provider
3318 */
3319void of_clk_del_provider(struct device_node *np)
3320{
3321 struct of_clk_provider *cp;
3322
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02003323 mutex_lock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05003324 list_for_each_entry(cp, &of_clk_providers, link) {
3325 if (cp->node == np) {
3326 list_del(&cp->link);
3327 of_node_put(cp->node);
3328 kfree(cp);
3329 break;
3330 }
3331 }
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02003332 mutex_unlock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05003333}
3334EXPORT_SYMBOL_GPL(of_clk_del_provider);
3335
Stephen Boydaa795c42017-09-01 16:16:40 -07003336static int devm_clk_provider_match(struct device *dev, void *res, void *data)
3337{
3338 struct device_node **np = res;
3339
3340 if (WARN_ON(!np || !*np))
3341 return 0;
3342
3343 return *np == data;
3344}
3345
3346void devm_of_clk_del_provider(struct device *dev)
3347{
3348 int ret;
3349
3350 ret = devres_release(dev, devm_of_clk_release_provider,
3351 devm_clk_provider_match, dev->of_node);
3352
3353 WARN_ON(ret);
3354}
3355EXPORT_SYMBOL(devm_of_clk_del_provider);
3356
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003357static struct clk_hw *
3358__of_clk_get_hw_from_provider(struct of_clk_provider *provider,
3359 struct of_phandle_args *clkspec)
3360{
3361 struct clk *clk;
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003362
Stephen Boyd74002fc2016-08-25 13:35:36 -07003363 if (provider->get_hw)
3364 return provider->get_hw(clkspec, provider->data);
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003365
Stephen Boyd74002fc2016-08-25 13:35:36 -07003366 clk = provider->get(clkspec, provider->data);
3367 if (IS_ERR(clk))
3368 return ERR_CAST(clk);
3369 return __clk_get_hw(clk);
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003370}
3371
Stephen Boyd73e0e492015-02-06 11:42:43 -08003372struct clk *__of_clk_get_from_provider(struct of_phandle_args *clkspec,
3373 const char *dev_id, const char *con_id)
Grant Likely766e6a42012-04-09 14:50:06 -05003374{
3375 struct of_clk_provider *provider;
Jean-Francois Moinea34cd462013-11-25 19:47:04 +01003376 struct clk *clk = ERR_PTR(-EPROBE_DEFER);
Stephen Boydf155d152016-08-15 14:32:23 -07003377 struct clk_hw *hw;
Grant Likely766e6a42012-04-09 14:50:06 -05003378
Stephen Boyd306c3422015-02-05 15:39:11 -08003379 if (!clkspec)
3380 return ERR_PTR(-EINVAL);
3381
Grant Likely766e6a42012-04-09 14:50:06 -05003382 /* Check if we have such a provider in our array */
Stephen Boyd306c3422015-02-05 15:39:11 -08003383 mutex_lock(&of_clk_mutex);
Grant Likely766e6a42012-04-09 14:50:06 -05003384 list_for_each_entry(provider, &of_clk_providers, link) {
Stephen Boydf155d152016-08-15 14:32:23 -07003385 if (provider->node == clkspec->np) {
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003386 hw = __of_clk_get_hw_from_provider(provider, clkspec);
Stephen Boyd0861e5b2016-02-05 17:38:26 -08003387 clk = __clk_create_clk(hw, dev_id, con_id);
Stephen Boydf155d152016-08-15 14:32:23 -07003388 }
Stephen Boyd73e0e492015-02-06 11:42:43 -08003389
Stephen Boydf155d152016-08-15 14:32:23 -07003390 if (!IS_ERR(clk)) {
3391 if (!__clk_get(clk)) {
Stephen Boyd73e0e492015-02-06 11:42:43 -08003392 __clk_free_clk(clk);
3393 clk = ERR_PTR(-ENOENT);
3394 }
3395
Grant Likely766e6a42012-04-09 14:50:06 -05003396 break;
Stephen Boyd73e0e492015-02-06 11:42:43 -08003397 }
Grant Likely766e6a42012-04-09 14:50:06 -05003398 }
Stephen Boyd306c3422015-02-05 15:39:11 -08003399 mutex_unlock(&of_clk_mutex);
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02003400
3401 return clk;
3402}
3403
Stephen Boyd306c3422015-02-05 15:39:11 -08003404/**
3405 * of_clk_get_from_provider() - Lookup a clock from a clock provider
3406 * @clkspec: pointer to a clock specifier data structure
3407 *
3408 * This function looks up a struct clk from the registered list of clock
3409 * providers, an input is a clock specifier data structure as returned
3410 * from the of_parse_phandle_with_args() function call.
3411 */
Sylwester Nawrockid6782c22013-08-23 17:03:43 +02003412struct clk *of_clk_get_from_provider(struct of_phandle_args *clkspec)
3413{
Stephen Boyd306c3422015-02-05 15:39:11 -08003414 return __of_clk_get_from_provider(clkspec, NULL, __func__);
Grant Likely766e6a42012-04-09 14:50:06 -05003415}
Andrew F. Davisfb4dd222016-02-12 12:50:16 -06003416EXPORT_SYMBOL_GPL(of_clk_get_from_provider);
Grant Likely766e6a42012-04-09 14:50:06 -05003417
Stephen Boyd929e7f32016-02-19 15:52:32 -08003418/**
3419 * of_clk_get_parent_count() - Count the number of clocks a device node has
3420 * @np: device node to count
3421 *
3422 * Returns: The number of clocks that are possible parents of this node
3423 */
3424unsigned int of_clk_get_parent_count(struct device_node *np)
Mike Turquettef6102742013-10-07 23:12:13 -07003425{
Stephen Boyd929e7f32016-02-19 15:52:32 -08003426 int count;
3427
3428 count = of_count_phandle_with_args(np, "clocks", "#clock-cells");
3429 if (count < 0)
3430 return 0;
3431
3432 return count;
Mike Turquettef6102742013-10-07 23:12:13 -07003433}
3434EXPORT_SYMBOL_GPL(of_clk_get_parent_count);
3435
Grant Likely766e6a42012-04-09 14:50:06 -05003436const char *of_clk_get_parent_name(struct device_node *np, int index)
3437{
3438 struct of_phandle_args clkspec;
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00003439 struct property *prop;
Grant Likely766e6a42012-04-09 14:50:06 -05003440 const char *clk_name;
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00003441 const __be32 *vp;
3442 u32 pv;
Grant Likely766e6a42012-04-09 14:50:06 -05003443 int rc;
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00003444 int count;
Stephen Boyd0a4807c2015-10-14 14:03:07 -07003445 struct clk *clk;
Grant Likely766e6a42012-04-09 14:50:06 -05003446
Grant Likely766e6a42012-04-09 14:50:06 -05003447 rc = of_parse_phandle_with_args(np, "clocks", "#clock-cells", index,
3448 &clkspec);
3449 if (rc)
3450 return NULL;
3451
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00003452 index = clkspec.args_count ? clkspec.args[0] : 0;
3453 count = 0;
3454
3455 /* if there is an indices property, use it to transfer the index
3456 * specified into an array offset for the clock-output-names property.
3457 */
3458 of_property_for_each_u32(clkspec.np, "clock-indices", prop, vp, pv) {
3459 if (index == pv) {
3460 index = count;
3461 break;
3462 }
3463 count++;
3464 }
Masahiro Yamada8da411c2015-12-03 11:20:35 +09003465 /* We went off the end of 'clock-indices' without finding it */
3466 if (prop && !vp)
3467 return NULL;
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00003468
Grant Likely766e6a42012-04-09 14:50:06 -05003469 if (of_property_read_string_index(clkspec.np, "clock-output-names",
Ben Dooks7a0fc1a2014-02-13 18:02:49 +00003470 index,
Stephen Boyd0a4807c2015-10-14 14:03:07 -07003471 &clk_name) < 0) {
3472 /*
3473 * Best effort to get the name if the clock has been
3474 * registered with the framework. If the clock isn't
3475 * registered, we return the node name as the name of
3476 * the clock as long as #clock-cells = 0.
3477 */
3478 clk = of_clk_get_from_provider(&clkspec);
3479 if (IS_ERR(clk)) {
3480 if (clkspec.args_count == 0)
3481 clk_name = clkspec.np->name;
3482 else
3483 clk_name = NULL;
3484 } else {
3485 clk_name = __clk_get_name(clk);
3486 clk_put(clk);
3487 }
3488 }
3489
Grant Likely766e6a42012-04-09 14:50:06 -05003490
3491 of_node_put(clkspec.np);
3492 return clk_name;
3493}
3494EXPORT_SYMBOL_GPL(of_clk_get_parent_name);
3495
Dinh Nguyen2e61dfb2015-06-05 11:26:13 -05003496/**
3497 * of_clk_parent_fill() - Fill @parents with names of @np's parents and return
3498 * number of parents
3499 * @np: Device node pointer associated with clock provider
3500 * @parents: pointer to char array that hold the parents' names
3501 * @size: size of the @parents array
3502 *
3503 * Return: number of parents for the clock node.
3504 */
3505int of_clk_parent_fill(struct device_node *np, const char **parents,
3506 unsigned int size)
3507{
3508 unsigned int i = 0;
3509
3510 while (i < size && (parents[i] = of_clk_get_parent_name(np, i)) != NULL)
3511 i++;
3512
3513 return i;
3514}
3515EXPORT_SYMBOL_GPL(of_clk_parent_fill);
3516
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003517struct clock_provider {
3518 of_clk_init_cb_t clk_init_cb;
3519 struct device_node *np;
3520 struct list_head node;
3521};
3522
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003523/*
3524 * This function looks for a parent clock. If there is one, then it
3525 * checks that the provider for this parent clock was initialized, in
3526 * this case the parent clock will be ready.
3527 */
3528static int parent_ready(struct device_node *np)
3529{
3530 int i = 0;
3531
3532 while (true) {
3533 struct clk *clk = of_clk_get(np, i);
3534
3535 /* this parent is ready we can check the next one */
3536 if (!IS_ERR(clk)) {
3537 clk_put(clk);
3538 i++;
3539 continue;
3540 }
3541
3542 /* at least one parent is not ready, we exit now */
3543 if (PTR_ERR(clk) == -EPROBE_DEFER)
3544 return 0;
3545
3546 /*
3547 * Here we make assumption that the device tree is
3548 * written correctly. So an error means that there is
3549 * no more parent. As we didn't exit yet, then the
3550 * previous parent are ready. If there is no clock
3551 * parent, no need to wait for them, then we can
3552 * consider their absence as being ready
3553 */
3554 return 1;
3555 }
3556}
3557
Grant Likely766e6a42012-04-09 14:50:06 -05003558/**
Lee Jonesd56f8992016-02-11 13:19:11 -08003559 * of_clk_detect_critical() - set CLK_IS_CRITICAL flag from Device Tree
3560 * @np: Device node pointer associated with clock provider
3561 * @index: clock index
3562 * @flags: pointer to clk_core->flags
3563 *
3564 * Detects if the clock-critical property exists and, if so, sets the
3565 * corresponding CLK_IS_CRITICAL flag.
3566 *
3567 * Do not use this function. It exists only for legacy Device Tree
3568 * bindings, such as the one-clock-per-node style that are outdated.
3569 * Those bindings typically put all clock data into .dts and the Linux
3570 * driver has no clock data, thus making it impossible to set this flag
3571 * correctly from the driver. Only those drivers may call
3572 * of_clk_detect_critical from their setup functions.
3573 *
3574 * Return: error code or zero on success
3575 */
3576int of_clk_detect_critical(struct device_node *np,
3577 int index, unsigned long *flags)
3578{
3579 struct property *prop;
3580 const __be32 *cur;
3581 uint32_t idx;
3582
3583 if (!np || !flags)
3584 return -EINVAL;
3585
3586 of_property_for_each_u32(np, "clock-critical", prop, cur, idx)
3587 if (index == idx)
3588 *flags |= CLK_IS_CRITICAL;
3589
3590 return 0;
3591}
3592
3593/**
Grant Likely766e6a42012-04-09 14:50:06 -05003594 * of_clk_init() - Scan and init clock providers from the DT
3595 * @matches: array of compatible values and init functions for providers.
3596 *
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003597 * This function scans the device tree for matching clock providers
Sylwester Nawrockie5ca8fb2014-03-27 12:08:36 +01003598 * and calls their initialization functions. It also does it by trying
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003599 * to follow the dependencies.
Grant Likely766e6a42012-04-09 14:50:06 -05003600 */
3601void __init of_clk_init(const struct of_device_id *matches)
3602{
Alex Elder7f7ed582013-08-22 11:31:31 -05003603 const struct of_device_id *match;
Grant Likely766e6a42012-04-09 14:50:06 -05003604 struct device_node *np;
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003605 struct clock_provider *clk_provider, *next;
3606 bool is_init_done;
3607 bool force = false;
Stephen Boyd2573a022015-07-06 16:50:00 -07003608 LIST_HEAD(clk_provider_list);
Grant Likely766e6a42012-04-09 14:50:06 -05003609
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +05303610 if (!matches)
Tero Kristo819b4862013-10-22 11:39:36 +03003611 matches = &__clk_of_table;
Prashant Gaikwadf2f6c252013-01-04 12:30:52 +05303612
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003613 /* First prepare the list of the clocks providers */
Alex Elder7f7ed582013-08-22 11:31:31 -05003614 for_each_matching_node_and_match(np, matches, &match) {
Stephen Boyd2e3b19f2015-07-06 16:48:19 -07003615 struct clock_provider *parent;
3616
Geert Uytterhoeven3e5dd6f2016-02-26 16:54:31 +01003617 if (!of_device_is_available(np))
3618 continue;
3619
Stephen Boyd2e3b19f2015-07-06 16:48:19 -07003620 parent = kzalloc(sizeof(*parent), GFP_KERNEL);
3621 if (!parent) {
3622 list_for_each_entry_safe(clk_provider, next,
3623 &clk_provider_list, node) {
3624 list_del(&clk_provider->node);
Julia Lawall6bc9d9d2015-10-21 22:41:36 +02003625 of_node_put(clk_provider->np);
Stephen Boyd2e3b19f2015-07-06 16:48:19 -07003626 kfree(clk_provider);
3627 }
Julia Lawall6bc9d9d2015-10-21 22:41:36 +02003628 of_node_put(np);
Stephen Boyd2e3b19f2015-07-06 16:48:19 -07003629 return;
3630 }
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003631
3632 parent->clk_init_cb = match->data;
Julia Lawall6bc9d9d2015-10-21 22:41:36 +02003633 parent->np = of_node_get(np);
Sylwester Nawrocki3f6d4392014-03-27 11:43:32 +01003634 list_add_tail(&parent->node, &clk_provider_list);
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003635 }
3636
3637 while (!list_empty(&clk_provider_list)) {
3638 is_init_done = false;
3639 list_for_each_entry_safe(clk_provider, next,
3640 &clk_provider_list, node) {
3641 if (force || parent_ready(clk_provider->np)) {
Sylwester Nawrocki86be4082014-06-18 17:29:32 +02003642
Ricardo Ribalda Delgado989eafd2016-07-05 18:23:32 +02003643 /* Don't populate platform devices */
3644 of_node_set_flag(clk_provider->np,
3645 OF_POPULATED);
3646
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003647 clk_provider->clk_init_cb(clk_provider->np);
Sylwester Nawrocki86be4082014-06-18 17:29:32 +02003648 of_clk_set_defaults(clk_provider->np, true);
3649
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003650 list_del(&clk_provider->node);
Julia Lawall6bc9d9d2015-10-21 22:41:36 +02003651 of_node_put(clk_provider->np);
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003652 kfree(clk_provider);
3653 is_init_done = true;
3654 }
3655 }
3656
3657 /*
Sylwester Nawrockie5ca8fb2014-03-27 12:08:36 +01003658 * We didn't manage to initialize any of the
Gregory CLEMENT1771b102014-02-24 19:10:13 +01003659 * remaining providers during the last loop, so now we
3660 * initialize all the remaining ones unconditionally
3661 * in case the clock parent was not mandatory
3662 */
3663 if (!is_init_done)
3664 force = true;
Grant Likely766e6a42012-04-09 14:50:06 -05003665 }
3666}
3667#endif