drivers/clk/clkdev.c

   1 /*
   2  * drivers/clk/clkdev.c
   3  *
   4  *  Copyright (C) 2008 Russell King.
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  *
  10  * Helper for the clk API to assist looking up a struct clk.
  11  */
  12 #include <linux/module.h>
  13 #include <linux/kernel.h>
  14 #include <linux/device.h>
  15 #include <linux/list.h>
  16 #include <linux/errno.h>
  17 #include <linux/err.h>
  18 #include <linux/string.h>
  19 #include <linux/mutex.h>
  20 #include <linux/clk.h>
  21 #include <linux/clkdev.h>
  22 #include <linux/clk-provider.h>
  23 #include <linux/of.h>
  24
  25 #include "clk.h"
  26
  27 static LIST_HEAD(clocks);
  28 static DEFINE_MUTEX(clocks_mutex);
  29
  30 /*
  31  * Find the correct struct clk for the device and connection ID.
  32  * We do slightly fuzzy matching here:
  33  *  An entry with a NULL ID is assumed to be a wildcard.
  34  *  If an entry has a device ID, it must match
  35  *  If an entry has a connection ID, it must match
  36  * Then we take the most specific entry - with the following
  37  * order of precedence: dev+con > dev only > con only.
  38  */
  39 static struct clk_lookup *clk_find(const char *dev_id, const char *con_id)
  40 {
  41         struct clk_lookup *p, *cl = NULL;
  42         int match, best_found = 0, best_possible = 0;
  43
  44         if (dev_id)
  45                 best_possible += 2;
  46         if (con_id)
  47                 best_possible += 1;
  48
  49         list_for_each_entry(p, &clocks, node) {
  50                 match = 0;
  51                 if (p->dev_id) {
  52                         if (!dev_id || strcmp(p->dev_id, dev_id))
  53                                 continue;
  54                         match += 2;
  55                 }
  56                 if (p->con_id) {
  57                         if (!con_id || strcmp(p->con_id, con_id))
  58                                 continue;
  59                         match += 1;
  60                 }
  61
  62                 if (match > best_found) {
  63                         cl = p;
  64                         if (match != best_possible)
  65                                 best_found = match;
  66                         else
  67                                 break;
  68                 }
  69         }
  70         return cl;
  71 }
  72
  73 static struct clk *__clk_get_sys(struct device *dev, const char *dev_id,
  74                                  const char *con_id)
  75 {
  76         struct clk_lookup *cl;
  77         struct clk *clk = NULL;
  78
  79         mutex_lock(&clocks_mutex);
  80
  81         cl = clk_find(dev_id, con_id);
  82         if (!cl)
  83                 goto out;
  84
  85         clk = clk_hw_create_clk(dev, cl->clk_hw, dev_id, con_id);
  86         if (IS_ERR(clk))
  87                 cl = NULL;
  88 out:
  89         mutex_unlock(&clocks_mutex);
  90
  91         return cl ? clk : ERR_PTR(-ENOENT);
  92 }
  93
  94 struct clk *clk_get_sys(const char *dev_id, const char *con_id)
  95 {
  96         return __clk_get_sys(NULL, dev_id, con_id);
  97 }
  98 EXPORT_SYMBOL(clk_get_sys);
  99
 100 struct clk *clk_get(struct device *dev, const char *con_id)
 101 {
 102         const char *dev_id = dev ? dev_name(dev) : NULL;
 103         struct clk_hw *hw;
 104
 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);
 109         }
 110
 111         return __clk_get_sys(dev, dev_id, con_id);
 112 }
 113 EXPORT_SYMBOL(clk_get);
 114
 115 void clk_put(struct clk *clk)
 116 {
 117         __clk_put(clk);
 118 }
 119 EXPORT_SYMBOL(clk_put);
 120
 121 static void __clkdev_add(struct clk_lookup *cl)
 122 {
 123         mutex_lock(&clocks_mutex);
 124         list_add_tail(&cl->node, &clocks);
 125         mutex_unlock(&clocks_mutex);
 126 }
 127
 128 void clkdev_add(struct clk_lookup *cl)
 129 {
 130         if (!cl->clk_hw)
 131                 cl->clk_hw = __clk_get_hw(cl->clk);
 132         __clkdev_add(cl);
 133 }
 134 EXPORT_SYMBOL(clkdev_add);
 135
 136 void clkdev_add_table(struct clk_lookup *cl, size_t num)
 137 {
 138         mutex_lock(&clocks_mutex);
 139         while (num--) {
 140                 cl->clk_hw = __clk_get_hw(cl->clk);
 141                 list_add_tail(&cl->node, &clocks);
 142                 cl++;
 143         }
 144         mutex_unlock(&clocks_mutex);
 145 }
 146
 147 #define MAX_DEV_ID      20
 148 #define MAX_CON_ID      16
 149
 150 struct clk_lookup_alloc {
 151         struct clk_lookup cl;
 152         char    dev_id[MAX_DEV_ID];
 153         char    con_id[MAX_CON_ID];
 154 };
 155
 156 static struct clk_lookup * __ref
 157 vclkdev_alloc(struct clk_hw *hw, const char *con_id, const char *dev_fmt,
 158         va_list ap)
 159 {
 160         struct clk_lookup_alloc *cla;
 161
 162         cla = kzalloc(sizeof(*cla), GFP_KERNEL);
 163         if (!cla)
 164                 return NULL;
 165
 166         cla->cl.clk_hw = hw;
 167         if (con_id) {
 168                 strlcpy(cla->con_id, con_id, sizeof(cla->con_id));
 169                 cla->cl.con_id = cla->con_id;
 170         }
 171
 172         if (dev_fmt) {
 173                 vscnprintf(cla->dev_id, sizeof(cla->dev_id), dev_fmt, ap);
 174                 cla->cl.dev_id = cla->dev_id;
 175         }
 176
 177         return &cla->cl;
 178 }
 179
 180 static struct clk_lookup *
 181 vclkdev_create(struct clk_hw *hw, const char *con_id, const char *dev_fmt,
 182         va_list ap)
 183 {
 184         struct clk_lookup *cl;
 185
 186         cl = vclkdev_alloc(hw, con_id, dev_fmt, ap);
 187         if (cl)
 188                 __clkdev_add(cl);
 189
 190         return cl;
 191 }
 192
 193 struct clk_lookup * __ref
 194 clkdev_alloc(struct clk *clk, const char *con_id, const char *dev_fmt, ...)
 195 {
 196         struct clk_lookup *cl;
 197         va_list ap;
 198
 199         va_start(ap, dev_fmt);
 200         cl = vclkdev_alloc(__clk_get_hw(clk), con_id, dev_fmt, ap);
 201         va_end(ap);
 202
 203         return cl;
 204 }
 205 EXPORT_SYMBOL(clkdev_alloc);
 206
 207 struct clk_lookup *
 208 clkdev_hw_alloc(struct clk_hw *hw, const char *con_id, const char *dev_fmt, ...)
 209 {
 210         struct clk_lookup *cl;
 211         va_list ap;
 212
 213         va_start(ap, dev_fmt);
 214         cl = vclkdev_alloc(hw, con_id, dev_fmt, ap);
 215         va_end(ap);
 216
 217         return cl;
 218 }
 219 EXPORT_SYMBOL(clkdev_hw_alloc);
 220
 221 /**
 222  * clkdev_create - allocate and add a clkdev lookup structure
 223  * @clk: struct clk to associate with all clk_lookups
 224  * @con_id: connection ID string on device
 225  * @dev_fmt: format string describing device name
 226  *
 227  * Returns a clk_lookup structure, which can be later unregistered and
 228  * freed.
 229  */
 230 struct clk_lookup *clkdev_create(struct clk *clk, const char *con_id,
 231         const char *dev_fmt, ...)
 232 {
 233         struct clk_lookup *cl;
 234         va_list ap;
 235
 236         va_start(ap, dev_fmt);
 237         cl = vclkdev_create(__clk_get_hw(clk), con_id, dev_fmt, ap);
 238         va_end(ap);
 239
 240         return cl;
 241 }
 242 EXPORT_SYMBOL_GPL(clkdev_create);
 243
 244 /**
 245  * clkdev_hw_create - allocate and add a clkdev lookup structure
 246  * @hw: struct clk_hw to associate with all clk_lookups
 247  * @con_id: connection ID string on device
 248  * @dev_fmt: format string describing device name
 249  *
 250  * Returns a clk_lookup structure, which can be later unregistered and
 251  * freed.
 252  */
 253 struct clk_lookup *clkdev_hw_create(struct clk_hw *hw, const char *con_id,
 254         const char *dev_fmt, ...)
 255 {
 256         struct clk_lookup *cl;
 257         va_list ap;
 258
 259         va_start(ap, dev_fmt);
 260         cl = vclkdev_create(hw, con_id, dev_fmt, ap);
 261         va_end(ap);
 262
 263         return cl;
 264 }
 265 EXPORT_SYMBOL_GPL(clkdev_hw_create);
 266
 267 int clk_add_alias(const char *alias, const char *alias_dev_name,
 268         const char *con_id, struct device *dev)
 269 {
 270         struct clk *r = clk_get(dev, con_id);
 271         struct clk_lookup *l;
 272
 273         if (IS_ERR(r))
 274                 return PTR_ERR(r);
 275
 276         l = clkdev_create(r, alias, alias_dev_name ? "%s" : NULL,
 277                           alias_dev_name);
 278         clk_put(r);
 279
 280         return l ? 0 : -ENODEV;
 281 }
 282 EXPORT_SYMBOL(clk_add_alias);
 283
 284 /*
 285  * clkdev_drop - remove a clock dynamically allocated
 286  */
 287 void clkdev_drop(struct clk_lookup *cl)
 288 {
 289         mutex_lock(&clocks_mutex);
 290         list_del(&cl->node);
 291         mutex_unlock(&clocks_mutex);
 292         kfree(cl);
 293 }
 294 EXPORT_SYMBOL(clkdev_drop);
 295
 296 static struct clk_lookup *__clk_register_clkdev(struct clk_hw *hw,
 297                                                 const char *con_id,
 298                                                 const char *dev_id, ...)
 299 {
 300         struct clk_lookup *cl;
 301         va_list ap;
 302
 303         va_start(ap, dev_id);
 304         cl = vclkdev_create(hw, con_id, dev_id, ap);
 305         va_end(ap);
 306
 307         return cl;
 308 }
 309
 310 static int do_clk_register_clkdev(struct clk_hw *hw,
 311         struct clk_lookup **cl, const char *con_id, const char *dev_id)
 312 {
 313         if (IS_ERR(hw))
 314                 return PTR_ERR(hw);
 315         /*
 316          * Since dev_id can be NULL, and NULL is handled specially, we must
 317          * pass it as either a NULL format string, or with "%s".
 318          */
 319         if (dev_id)
 320                 *cl = __clk_register_clkdev(hw, con_id, "%s", dev_id);
 321         else
 322                 *cl = __clk_register_clkdev(hw, con_id, NULL);
 323
 324         return *cl ? 0 : -ENOMEM;
 325 }
 326
 327 /**
 328  * clk_register_clkdev - register one clock lookup for a struct clk
 329  * @clk: struct clk to associate with all clk_lookups
 330  * @con_id: connection ID string on device
 331  * @dev_id: string describing device name
 332  *
 333  * con_id or dev_id may be NULL as a wildcard, just as in the rest of
 334  * clkdev.
 335  *
 336  * To make things easier for mass registration, we detect error clks
 337  * from a previous clk_register() call, and return the error code for
 338  * those.  This is to permit this function to be called immediately
 339  * after clk_register().
 340  */
 341 int clk_register_clkdev(struct clk *clk, const char *con_id,
 342         const char *dev_id)
 343 {
 344         struct clk_lookup *cl;
 345
 346         if (IS_ERR(clk))
 347                 return PTR_ERR(clk);
 348
 349         return do_clk_register_clkdev(__clk_get_hw(clk), &cl, con_id,
 350                                               dev_id);
 351 }
 352 EXPORT_SYMBOL(clk_register_clkdev);
 353
 354 /**
 355  * clk_hw_register_clkdev - register one clock lookup for a struct clk_hw
 356  * @hw: struct clk_hw to associate with all clk_lookups
 357  * @con_id: connection ID string on device
 358  * @dev_id: format string describing device name
 359  *
 360  * con_id or dev_id may be NULL as a wildcard, just as in the rest of
 361  * clkdev.
 362  *
 363  * To make things easier for mass registration, we detect error clk_hws
 364  * from a previous clk_hw_register_*() call, and return the error code for
 365  * those.  This is to permit this function to be called immediately
 366  * after clk_hw_register_*().
 367  */
 368 int clk_hw_register_clkdev(struct clk_hw *hw, const char *con_id,
 369         const char *dev_id)
 370 {
 371         struct clk_lookup *cl;
 372
 373         return do_clk_register_clkdev(hw, &cl, con_id, dev_id);
 374 }
 375 EXPORT_SYMBOL(clk_hw_register_clkdev);
 376
 377 static void devm_clkdev_release(struct device *dev, void *res)
 378 {
 379         clkdev_drop(*(struct clk_lookup **)res);
 380 }
 381
 382 static int devm_clk_match_clkdev(struct device *dev, void *res, void *data)
 383 {
 384         struct clk_lookup **l = res;
 385
 386         return *l == data;
 387 }
 388
 389 /**
 390  * devm_clk_release_clkdev - Resource managed clkdev lookup release
 391  * @dev: device this lookup is bound
 392  * @con_id: connection ID string on device
 393  * @dev_id: format string describing device name
 394  *
 395  * Drop the clkdev lookup created with devm_clk_hw_register_clkdev.
 396  * Normally this function will not need to be called and the resource
 397  * management code will ensure that the resource is freed.
 398  */
 399 void devm_clk_release_clkdev(struct device *dev, const char *con_id,
 400                              const char *dev_id)
 401 {
 402         struct clk_lookup *cl;
 403         int rval;
 404
 405         cl = clk_find(dev_id, con_id);
 406         WARN_ON(!cl);
 407         rval = devres_release(dev, devm_clkdev_release,
 408                               devm_clk_match_clkdev, cl);
 409         WARN_ON(rval);
 410 }
 411 EXPORT_SYMBOL(devm_clk_release_clkdev);
 412
 413 /**
 414  * devm_clk_hw_register_clkdev - managed clk lookup registration for clk_hw
 415  * @dev: device this lookup is bound
 416  * @hw: struct clk_hw to associate with all clk_lookups
 417  * @con_id: connection ID string on device
 418  * @dev_id: format string describing device name
 419  *
 420  * con_id or dev_id may be NULL as a wildcard, just as in the rest of
 421  * clkdev.
 422  *
 423  * To make things easier for mass registration, we detect error clk_hws
 424  * from a previous clk_hw_register_*() call, and return the error code for
 425  * those.  This is to permit this function to be called immediately
 426  * after clk_hw_register_*().
 427  */
 428 int devm_clk_hw_register_clkdev(struct device *dev, struct clk_hw *hw,
 429                                 const char *con_id, const char *dev_id)
 430 {
 431         int rval = -ENOMEM;
 432         struct clk_lookup **cl;
 433
 434         cl = devres_alloc(devm_clkdev_release, sizeof(*cl), GFP_KERNEL);
 435         if (cl) {
 436                 rval = do_clk_register_clkdev(hw, cl, con_id, dev_id);
 437                 if (!rval)
 438                         devres_add(dev, cl);
 439                 else
 440                         devres_free(cl);
 441         }
 442         return rval;
 443 }
 444 EXPORT_SYMBOL(devm_clk_hw_register_clkdev);