1 // SPDX-License-Identifier: GPL-2.0-only
5 * Copyright (C) 2008 Russell King.
7 * Helper for the clk API to assist looking up a struct clk.
9 #include <linux/module.h>
10 #include <linux/kernel.h>
11 #include <linux/device.h>
12 #include <linux/list.h>
13 #include <linux/errno.h>
14 #include <linux/err.h>
15 #include <linux/string.h>
16 #include <linux/mutex.h>
17 #include <linux/clk.h>
18 #include <linux/clkdev.h>
19 #include <linux/clk-provider.h>
24 static LIST_HEAD(clocks
);
25 static DEFINE_MUTEX(clocks_mutex
);
28 * Find the correct struct clk for the device and connection ID.
29 * We do slightly fuzzy matching here:
30 * An entry with a NULL ID is assumed to be a wildcard.
31 * If an entry has a device ID, it must match
32 * If an entry has a connection ID, it must match
33 * Then we take the most specific entry - with the following
34 * order of precedence: dev+con > dev only > con only.
36 static struct clk_lookup
*clk_find(const char *dev_id
, const char *con_id
)
38 struct clk_lookup
*p
, *cl
= NULL
;
39 int match
, best_found
= 0, best_possible
= 0;
46 lockdep_assert_held(&clocks_mutex
);
48 list_for_each_entry(p
, &clocks
, node
) {
51 if (!dev_id
|| strcmp(p
->dev_id
, dev_id
))
56 if (!con_id
|| strcmp(p
->con_id
, con_id
))
61 if (match
> best_found
) {
63 if (match
!= best_possible
)
72 struct clk_hw
*clk_find_hw(const char *dev_id
, const char *con_id
)
74 struct clk_lookup
*cl
;
75 struct clk_hw
*hw
= ERR_PTR(-ENOENT
);
77 mutex_lock(&clocks_mutex
);
78 cl
= clk_find(dev_id
, con_id
);
81 mutex_unlock(&clocks_mutex
);
86 static struct clk
*__clk_get_sys(struct device
*dev
, const char *dev_id
,
89 struct clk_hw
*hw
= clk_find_hw(dev_id
, con_id
);
91 return clk_hw_create_clk(dev
, hw
, dev_id
, con_id
);
94 struct clk
*clk_get_sys(const char *dev_id
, const char *con_id
)
96 return __clk_get_sys(NULL
, dev_id
, con_id
);
98 EXPORT_SYMBOL(clk_get_sys
);
100 struct clk
*clk_get(struct device
*dev
, const char *con_id
)
102 const char *dev_id
= dev
? dev_name(dev
) : NULL
;
105 if (dev
&& dev
->of_node
) {
106 hw
= of_clk_get_hw(dev
->of_node
, 0, con_id
);
107 if (!IS_ERR(hw
) || PTR_ERR(hw
) == -EPROBE_DEFER
)
108 return clk_hw_create_clk(dev
, hw
, dev_id
, con_id
);
111 return __clk_get_sys(dev
, dev_id
, con_id
);
113 EXPORT_SYMBOL(clk_get
);
115 void clk_put(struct clk
*clk
)
119 EXPORT_SYMBOL(clk_put
);
121 static void __clkdev_add(struct clk_lookup
*cl
)
123 mutex_lock(&clocks_mutex
);
124 list_add_tail(&cl
->node
, &clocks
);
125 mutex_unlock(&clocks_mutex
);
128 void clkdev_add(struct clk_lookup
*cl
)
131 cl
->clk_hw
= __clk_get_hw(cl
->clk
);
134 EXPORT_SYMBOL(clkdev_add
);
136 void clkdev_add_table(struct clk_lookup
*cl
, size_t num
)
138 mutex_lock(&clocks_mutex
);
140 cl
->clk_hw
= __clk_get_hw(cl
->clk
);
141 list_add_tail(&cl
->node
, &clocks
);
144 mutex_unlock(&clocks_mutex
);
147 #define MAX_DEV_ID 24
148 #define MAX_CON_ID 16
150 struct clk_lookup_alloc
{
151 struct clk_lookup cl
;
152 char dev_id
[MAX_DEV_ID
];
153 char con_id
[MAX_CON_ID
];
156 static struct clk_lookup
* __ref
157 vclkdev_alloc(struct clk_hw
*hw
, const char *con_id
, const char *dev_fmt
,
160 struct clk_lookup_alloc
*cla
;
161 struct va_format vaf
;
167 cla
= kzalloc(sizeof(*cla
), GFP_KERNEL
);
171 va_copy(ap_copy
, ap
);
175 res
= strscpy(cla
->con_id
, con_id
, sizeof(cla
->con_id
));
177 max_size
= sizeof(cla
->con_id
);
178 failure
= "connection";
181 cla
->cl
.con_id
= cla
->con_id
;
185 res
= vsnprintf(cla
->dev_id
, sizeof(cla
->dev_id
), dev_fmt
, ap
);
186 if (res
>= sizeof(cla
->dev_id
)) {
187 max_size
= sizeof(cla
->dev_id
);
191 cla
->cl
.dev_id
= cla
->dev_id
;
202 vaf
.fmt
= "null-device";
204 pr_err("%pV:%s: %s ID is greater than %zu\n",
205 &vaf
, con_id
, failure
, max_size
);
209 * Don't fail in this case, but as the entry won't ever match just
210 * fill it with something that also won't match.
212 strscpy(cla
->con_id
, "bad", sizeof(cla
->con_id
));
213 strscpy(cla
->dev_id
, "bad", sizeof(cla
->dev_id
));
218 static struct clk_lookup
*
219 vclkdev_create(struct clk_hw
*hw
, const char *con_id
, const char *dev_fmt
,
222 struct clk_lookup
*cl
;
224 cl
= vclkdev_alloc(hw
, con_id
, dev_fmt
, ap
);
232 * clkdev_create - allocate and add a clkdev lookup structure
233 * @clk: struct clk to associate with all clk_lookups
234 * @con_id: connection ID string on device
235 * @dev_fmt: format string describing device name
237 * Returns a clk_lookup structure, which can be later unregistered and
240 struct clk_lookup
*clkdev_create(struct clk
*clk
, const char *con_id
,
241 const char *dev_fmt
, ...)
243 struct clk_lookup
*cl
;
246 va_start(ap
, dev_fmt
);
247 cl
= vclkdev_create(__clk_get_hw(clk
), con_id
, dev_fmt
, ap
);
252 EXPORT_SYMBOL_GPL(clkdev_create
);
255 * clkdev_hw_create - allocate and add a clkdev lookup structure
256 * @hw: struct clk_hw to associate with all clk_lookups
257 * @con_id: connection ID string on device
258 * @dev_fmt: format string describing device name
260 * Returns a clk_lookup structure, which can be later unregistered and
263 struct clk_lookup
*clkdev_hw_create(struct clk_hw
*hw
, const char *con_id
,
264 const char *dev_fmt
, ...)
266 struct clk_lookup
*cl
;
269 va_start(ap
, dev_fmt
);
270 cl
= vclkdev_create(hw
, con_id
, dev_fmt
, ap
);
275 EXPORT_SYMBOL_GPL(clkdev_hw_create
);
277 int clk_add_alias(const char *alias
, const char *alias_dev_name
,
278 const char *con_id
, struct device
*dev
)
280 struct clk
*r
= clk_get(dev
, con_id
);
281 struct clk_lookup
*l
;
286 l
= clkdev_create(r
, alias
, alias_dev_name
? "%s" : NULL
,
290 return l
? 0 : -ENODEV
;
292 EXPORT_SYMBOL(clk_add_alias
);
295 * clkdev_drop - remove a clock dynamically allocated
297 void clkdev_drop(struct clk_lookup
*cl
)
299 mutex_lock(&clocks_mutex
);
301 mutex_unlock(&clocks_mutex
);
304 EXPORT_SYMBOL(clkdev_drop
);
306 static struct clk_lookup
*__clk_register_clkdev(struct clk_hw
*hw
,
308 const char *dev_id
, ...)
310 struct clk_lookup
*cl
;
313 va_start(ap
, dev_id
);
314 cl
= vclkdev_create(hw
, con_id
, dev_id
, ap
);
320 static int do_clk_register_clkdev(struct clk_hw
*hw
,
321 struct clk_lookup
**cl
, const char *con_id
, const char *dev_id
)
326 * Since dev_id can be NULL, and NULL is handled specially, we must
327 * pass it as either a NULL format string, or with "%s".
330 *cl
= __clk_register_clkdev(hw
, con_id
, "%s", dev_id
);
332 *cl
= __clk_register_clkdev(hw
, con_id
, NULL
);
334 return *cl
? 0 : -ENOMEM
;
338 * clk_register_clkdev - register one clock lookup for a struct clk
339 * @clk: struct clk to associate with all clk_lookups
340 * @con_id: connection ID string on device
341 * @dev_id: string describing device name
343 * con_id or dev_id may be NULL as a wildcard, just as in the rest of
346 * To make things easier for mass registration, we detect error clks
347 * from a previous clk_register() call, and return the error code for
348 * those. This is to permit this function to be called immediately
349 * after clk_register().
351 int clk_register_clkdev(struct clk
*clk
, const char *con_id
,
354 struct clk_lookup
*cl
;
359 return do_clk_register_clkdev(__clk_get_hw(clk
), &cl
, con_id
,
362 EXPORT_SYMBOL(clk_register_clkdev
);
365 * clk_hw_register_clkdev - register one clock lookup for a struct clk_hw
366 * @hw: struct clk_hw to associate with all clk_lookups
367 * @con_id: connection ID string on device
368 * @dev_id: format string describing device name
370 * con_id or dev_id may be NULL as a wildcard, just as in the rest of
373 * To make things easier for mass registration, we detect error clk_hws
374 * from a previous clk_hw_register_*() call, and return the error code for
375 * those. This is to permit this function to be called immediately
376 * after clk_hw_register_*().
378 int clk_hw_register_clkdev(struct clk_hw
*hw
, const char *con_id
,
381 struct clk_lookup
*cl
;
383 return do_clk_register_clkdev(hw
, &cl
, con_id
, dev_id
);
385 EXPORT_SYMBOL(clk_hw_register_clkdev
);
387 static void devm_clkdev_release(void *res
)
393 * devm_clk_hw_register_clkdev - managed clk lookup registration for clk_hw
394 * @dev: device this lookup is bound
395 * @hw: struct clk_hw to associate with all clk_lookups
396 * @con_id: connection ID string on device
397 * @dev_id: format string describing device name
399 * con_id or dev_id may be NULL as a wildcard, just as in the rest of
402 * To make things easier for mass registration, we detect error clk_hws
403 * from a previous clk_hw_register_*() call, and return the error code for
404 * those. This is to permit this function to be called immediately
405 * after clk_hw_register_*().
407 int devm_clk_hw_register_clkdev(struct device
*dev
, struct clk_hw
*hw
,
408 const char *con_id
, const char *dev_id
)
410 struct clk_lookup
*cl
;
413 rval
= do_clk_register_clkdev(hw
, &cl
, con_id
, dev_id
);
417 return devm_add_action_or_reset(dev
, devm_clkdev_release
, cl
);
419 EXPORT_SYMBOL(devm_clk_hw_register_clkdev
);