123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225 |
- // SPDX-License-Identifier: GPL-2.0
- #include <linux/clk.h>
- #include <linux/device.h>
- #include <linux/export.h>
- #include <linux/gfp.h>
- struct devm_clk_state {
- struct clk *clk;
- void (*exit)(struct clk *clk);
- };
- static void devm_clk_release(struct device *dev, void *res)
- {
- struct devm_clk_state *state = res;
- if (state->exit)
- state->exit(state->clk);
- clk_put(state->clk);
- }
- static struct clk *__devm_clk_get(struct device *dev, const char *id,
- struct clk *(*get)(struct device *dev, const char *id),
- int (*init)(struct clk *clk),
- void (*exit)(struct clk *clk))
- {
- struct devm_clk_state *state;
- struct clk *clk;
- int ret;
- state = devres_alloc(devm_clk_release, sizeof(*state), GFP_KERNEL);
- if (!state)
- return ERR_PTR(-ENOMEM);
- clk = get(dev, id);
- if (IS_ERR(clk)) {
- ret = PTR_ERR(clk);
- goto err_clk_get;
- }
- if (init) {
- ret = init(clk);
- if (ret)
- goto err_clk_init;
- }
- state->clk = clk;
- state->exit = exit;
- devres_add(dev, state);
- return clk;
- err_clk_init:
- clk_put(clk);
- err_clk_get:
- devres_free(state);
- return ERR_PTR(ret);
- }
- struct clk *devm_clk_get(struct device *dev, const char *id)
- {
- return __devm_clk_get(dev, id, clk_get, NULL, NULL);
- }
- EXPORT_SYMBOL(devm_clk_get);
- struct clk *devm_clk_get_prepared(struct device *dev, const char *id)
- {
- return __devm_clk_get(dev, id, clk_get, clk_prepare, clk_unprepare);
- }
- EXPORT_SYMBOL_GPL(devm_clk_get_prepared);
- struct clk *devm_clk_get_enabled(struct device *dev, const char *id)
- {
- return __devm_clk_get(dev, id, clk_get,
- clk_prepare_enable, clk_disable_unprepare);
- }
- EXPORT_SYMBOL_GPL(devm_clk_get_enabled);
- struct clk *devm_clk_get_optional(struct device *dev, const char *id)
- {
- return __devm_clk_get(dev, id, clk_get_optional, NULL, NULL);
- }
- EXPORT_SYMBOL(devm_clk_get_optional);
- struct clk *devm_clk_get_optional_prepared(struct device *dev, const char *id)
- {
- return __devm_clk_get(dev, id, clk_get_optional,
- clk_prepare, clk_unprepare);
- }
- EXPORT_SYMBOL_GPL(devm_clk_get_optional_prepared);
- struct clk *devm_clk_get_optional_enabled(struct device *dev, const char *id)
- {
- return __devm_clk_get(dev, id, clk_get_optional,
- clk_prepare_enable, clk_disable_unprepare);
- }
- EXPORT_SYMBOL_GPL(devm_clk_get_optional_enabled);
- struct clk_bulk_devres {
- struct clk_bulk_data *clks;
- int num_clks;
- };
- static void devm_clk_bulk_release(struct device *dev, void *res)
- {
- struct clk_bulk_devres *devres = res;
- clk_bulk_put(devres->num_clks, devres->clks);
- }
- static int __devm_clk_bulk_get(struct device *dev, int num_clks,
- struct clk_bulk_data *clks, bool optional)
- {
- struct clk_bulk_devres *devres;
- int ret;
- devres = devres_alloc(devm_clk_bulk_release,
- sizeof(*devres), GFP_KERNEL);
- if (!devres)
- return -ENOMEM;
- if (optional)
- ret = clk_bulk_get_optional(dev, num_clks, clks);
- else
- ret = clk_bulk_get(dev, num_clks, clks);
- if (!ret) {
- devres->clks = clks;
- devres->num_clks = num_clks;
- devres_add(dev, devres);
- } else {
- devres_free(devres);
- }
- return ret;
- }
- int __must_check devm_clk_bulk_get(struct device *dev, int num_clks,
- struct clk_bulk_data *clks)
- {
- return __devm_clk_bulk_get(dev, num_clks, clks, false);
- }
- EXPORT_SYMBOL_GPL(devm_clk_bulk_get);
- int __must_check devm_clk_bulk_get_optional(struct device *dev, int num_clks,
- struct clk_bulk_data *clks)
- {
- return __devm_clk_bulk_get(dev, num_clks, clks, true);
- }
- EXPORT_SYMBOL_GPL(devm_clk_bulk_get_optional);
- static void devm_clk_bulk_release_all(struct device *dev, void *res)
- {
- struct clk_bulk_devres *devres = res;
- clk_bulk_put_all(devres->num_clks, devres->clks);
- }
- int __must_check devm_clk_bulk_get_all(struct device *dev,
- struct clk_bulk_data **clks)
- {
- struct clk_bulk_devres *devres;
- int ret;
- devres = devres_alloc(devm_clk_bulk_release_all,
- sizeof(*devres), GFP_KERNEL);
- if (!devres)
- return -ENOMEM;
- ret = clk_bulk_get_all(dev, &devres->clks);
- if (ret > 0) {
- *clks = devres->clks;
- devres->num_clks = ret;
- devres_add(dev, devres);
- } else {
- devres_free(devres);
- }
- return ret;
- }
- EXPORT_SYMBOL_GPL(devm_clk_bulk_get_all);
- static int devm_clk_match(struct device *dev, void *res, void *data)
- {
- struct clk **c = res;
- if (!c || !*c) {
- WARN_ON(!c || !*c);
- return 0;
- }
- return *c == data;
- }
- void devm_clk_put(struct device *dev, struct clk *clk)
- {
- int ret;
- ret = devres_release(dev, devm_clk_release, devm_clk_match, clk);
- WARN_ON(ret);
- }
- EXPORT_SYMBOL(devm_clk_put);
- struct clk *devm_get_clk_from_child(struct device *dev,
- struct device_node *np, const char *con_id)
- {
- struct devm_clk_state *state;
- struct clk *clk;
- state = devres_alloc(devm_clk_release, sizeof(*state), GFP_KERNEL);
- if (!state)
- return ERR_PTR(-ENOMEM);
- clk = of_clk_get_by_name(np, con_id);
- if (!IS_ERR(clk)) {
- state->clk = clk;
- devres_add(dev, state);
- } else {
- devres_free(state);
- }
- return clk;
- }
- EXPORT_SYMBOL(devm_get_clk_from_child);
|