clk.c 49 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079
  1. /*
  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. #include <linux/clk-private.h>
  12. #include <linux/module.h>
  13. #include <linux/mutex.h>
  14. #include <linux/spinlock.h>
  15. #include <linux/err.h>
  16. #include <linux/list.h>
  17. #include <linux/slab.h>
  18. #include <linux/of.h>
  19. #include <linux/device.h>
  20. #include <linux/init.h>
  21. #include <linux/sched.h>
  22. static DEFINE_SPINLOCK(enable_lock);
  23. static DEFINE_MUTEX(prepare_lock);
  24. static struct task_struct *prepare_owner;
  25. static struct task_struct *enable_owner;
  26. static int prepare_refcnt;
  27. static int enable_refcnt;
  28. static HLIST_HEAD(clk_root_list);
  29. static HLIST_HEAD(clk_orphan_list);
  30. static LIST_HEAD(clk_notifier_list);
  31. /*** locking ***/
  32. static void clk_prepare_lock(void)
  33. {
  34. if (!mutex_trylock(&prepare_lock)) {
  35. if (prepare_owner == current) {
  36. prepare_refcnt++;
  37. return;
  38. }
  39. mutex_lock(&prepare_lock);
  40. }
  41. WARN_ON_ONCE(prepare_owner != NULL);
  42. WARN_ON_ONCE(prepare_refcnt != 0);
  43. prepare_owner = current;
  44. prepare_refcnt = 1;
  45. }
  46. static void clk_prepare_unlock(void)
  47. {
  48. WARN_ON_ONCE(prepare_owner != current);
  49. WARN_ON_ONCE(prepare_refcnt == 0);
  50. if (--prepare_refcnt)
  51. return;
  52. prepare_owner = NULL;
  53. mutex_unlock(&prepare_lock);
  54. }
  55. static unsigned long clk_enable_lock(void)
  56. {
  57. unsigned long flags;
  58. if (!spin_trylock_irqsave(&enable_lock, flags)) {
  59. if (enable_owner == current) {
  60. enable_refcnt++;
  61. return flags;
  62. }
  63. spin_lock_irqsave(&enable_lock, flags);
  64. }
  65. WARN_ON_ONCE(enable_owner != NULL);
  66. WARN_ON_ONCE(enable_refcnt != 0);
  67. enable_owner = current;
  68. enable_refcnt = 1;
  69. return flags;
  70. }
  71. static void clk_enable_unlock(unsigned long flags)
  72. {
  73. WARN_ON_ONCE(enable_owner != current);
  74. WARN_ON_ONCE(enable_refcnt == 0);
  75. if (--enable_refcnt)
  76. return;
  77. enable_owner = NULL;
  78. spin_unlock_irqrestore(&enable_lock, flags);
  79. }
  80. /*** debugfs support ***/
  81. #ifdef CONFIG_COMMON_CLK_DEBUG
  82. #include <linux/debugfs.h>
  83. static struct dentry *rootdir;
  84. static struct dentry *orphandir;
  85. static int inited = 0;
  86. static void clk_summary_show_one(struct seq_file *s, struct clk *c, int level)
  87. {
  88. if (!c)
  89. return;
  90. seq_printf(s, "%*s%-*s %-11d %-12d %-10lu",
  91. level * 3 + 1, "",
  92. 30 - level * 3, c->name,
  93. c->enable_count, c->prepare_count, c->rate);
  94. seq_printf(s, "\n");
  95. }
  96. static void clk_summary_show_subtree(struct seq_file *s, struct clk *c,
  97. int level)
  98. {
  99. struct clk *child;
  100. if (!c)
  101. return;
  102. clk_summary_show_one(s, c, level);
  103. hlist_for_each_entry(child, &c->children, child_node)
  104. clk_summary_show_subtree(s, child, level + 1);
  105. }
  106. static int clk_summary_show(struct seq_file *s, void *data)
  107. {
  108. struct clk *c;
  109. seq_printf(s, " clock enable_cnt prepare_cnt rate\n");
  110. seq_printf(s, "---------------------------------------------------------------------\n");
  111. clk_prepare_lock();
  112. hlist_for_each_entry(c, &clk_root_list, child_node)
  113. clk_summary_show_subtree(s, c, 0);
  114. hlist_for_each_entry(c, &clk_orphan_list, child_node)
  115. clk_summary_show_subtree(s, c, 0);
  116. clk_prepare_unlock();
  117. return 0;
  118. }
  119. static int clk_summary_open(struct inode *inode, struct file *file)
  120. {
  121. return single_open(file, clk_summary_show, inode->i_private);
  122. }
  123. static const struct file_operations clk_summary_fops = {
  124. .open = clk_summary_open,
  125. .read = seq_read,
  126. .llseek = seq_lseek,
  127. .release = single_release,
  128. };
  129. static void clk_dump_one(struct seq_file *s, struct clk *c, int level)
  130. {
  131. if (!c)
  132. return;
  133. seq_printf(s, "\"%s\": { ", c->name);
  134. seq_printf(s, "\"enable_count\": %d,", c->enable_count);
  135. seq_printf(s, "\"prepare_count\": %d,", c->prepare_count);
  136. seq_printf(s, "\"rate\": %lu", c->rate);
  137. }
  138. static void clk_dump_subtree(struct seq_file *s, struct clk *c, int level)
  139. {
  140. struct clk *child;
  141. if (!c)
  142. return;
  143. clk_dump_one(s, c, level);
  144. hlist_for_each_entry(child, &c->children, child_node) {
  145. seq_printf(s, ",");
  146. clk_dump_subtree(s, child, level + 1);
  147. }
  148. seq_printf(s, "}");
  149. }
  150. static int clk_dump(struct seq_file *s, void *data)
  151. {
  152. struct clk *c;
  153. bool first_node = true;
  154. seq_printf(s, "{");
  155. clk_prepare_lock();
  156. hlist_for_each_entry(c, &clk_root_list, child_node) {
  157. if (!first_node)
  158. seq_printf(s, ",");
  159. first_node = false;
  160. clk_dump_subtree(s, c, 0);
  161. }
  162. hlist_for_each_entry(c, &clk_orphan_list, child_node) {
  163. seq_printf(s, ",");
  164. clk_dump_subtree(s, c, 0);
  165. }
  166. clk_prepare_unlock();
  167. seq_printf(s, "}");
  168. return 0;
  169. }
  170. static int clk_dump_open(struct inode *inode, struct file *file)
  171. {
  172. return single_open(file, clk_dump, inode->i_private);
  173. }
  174. static const struct file_operations clk_dump_fops = {
  175. .open = clk_dump_open,
  176. .read = seq_read,
  177. .llseek = seq_lseek,
  178. .release = single_release,
  179. };
  180. /* caller must hold prepare_lock */
  181. static int clk_debug_create_one(struct clk *clk, struct dentry *pdentry)
  182. {
  183. struct dentry *d;
  184. int ret = -ENOMEM;
  185. if (!clk || !pdentry) {
  186. ret = -EINVAL;
  187. goto out;
  188. }
  189. d = debugfs_create_dir(clk->name, pdentry);
  190. if (!d)
  191. goto out;
  192. clk->dentry = d;
  193. d = debugfs_create_u32("clk_rate", S_IRUGO, clk->dentry,
  194. (u32 *)&clk->rate);
  195. if (!d)
  196. goto err_out;
  197. d = debugfs_create_x32("clk_flags", S_IRUGO, clk->dentry,
  198. (u32 *)&clk->flags);
  199. if (!d)
  200. goto err_out;
  201. d = debugfs_create_u32("clk_prepare_count", S_IRUGO, clk->dentry,
  202. (u32 *)&clk->prepare_count);
  203. if (!d)
  204. goto err_out;
  205. d = debugfs_create_u32("clk_enable_count", S_IRUGO, clk->dentry,
  206. (u32 *)&clk->enable_count);
  207. if (!d)
  208. goto err_out;
  209. d = debugfs_create_u32("clk_notifier_count", S_IRUGO, clk->dentry,
  210. (u32 *)&clk->notifier_count);
  211. if (!d)
  212. goto err_out;
  213. ret = 0;
  214. goto out;
  215. err_out:
  216. debugfs_remove(clk->dentry);
  217. out:
  218. return ret;
  219. }
  220. /* caller must hold prepare_lock */
  221. static int clk_debug_create_subtree(struct clk *clk, struct dentry *pdentry)
  222. {
  223. struct clk *child;
  224. int ret = -EINVAL;;
  225. if (!clk || !pdentry)
  226. goto out;
  227. ret = clk_debug_create_one(clk, pdentry);
  228. if (ret)
  229. goto out;
  230. hlist_for_each_entry(child, &clk->children, child_node)
  231. clk_debug_create_subtree(child, clk->dentry);
  232. ret = 0;
  233. out:
  234. return ret;
  235. }
  236. /**
  237. * clk_debug_register - add a clk node to the debugfs clk tree
  238. * @clk: the clk being added to the debugfs clk tree
  239. *
  240. * Dynamically adds a clk to the debugfs clk tree if debugfs has been
  241. * initialized. Otherwise it bails out early since the debugfs clk tree
  242. * will be created lazily by clk_debug_init as part of a late_initcall.
  243. *
  244. * Caller must hold prepare_lock. Only clk_init calls this function (so
  245. * far) so this is taken care.
  246. */
  247. static int clk_debug_register(struct clk *clk)
  248. {
  249. struct clk *parent;
  250. struct dentry *pdentry;
  251. int ret = 0;
  252. if (!inited)
  253. goto out;
  254. parent = clk->parent;
  255. /*
  256. * Check to see if a clk is a root clk. Also check that it is
  257. * safe to add this clk to debugfs
  258. */
  259. if (!parent)
  260. if (clk->flags & CLK_IS_ROOT)
  261. pdentry = rootdir;
  262. else
  263. pdentry = orphandir;
  264. else
  265. if (parent->dentry)
  266. pdentry = parent->dentry;
  267. else
  268. goto out;
  269. ret = clk_debug_create_subtree(clk, pdentry);
  270. out:
  271. return ret;
  272. }
  273. /**
  274. * clk_debug_reparent - reparent clk node in the debugfs clk tree
  275. * @clk: the clk being reparented
  276. * @new_parent: the new clk parent, may be NULL
  277. *
  278. * Rename clk entry in the debugfs clk tree if debugfs has been
  279. * initialized. Otherwise it bails out early since the debugfs clk tree
  280. * will be created lazily by clk_debug_init as part of a late_initcall.
  281. *
  282. * Caller must hold prepare_lock.
  283. */
  284. static void clk_debug_reparent(struct clk *clk, struct clk *new_parent)
  285. {
  286. struct dentry *d;
  287. struct dentry *new_parent_d;
  288. if (!inited)
  289. return;
  290. if (new_parent)
  291. new_parent_d = new_parent->dentry;
  292. else
  293. new_parent_d = orphandir;
  294. d = debugfs_rename(clk->dentry->d_parent, clk->dentry,
  295. new_parent_d, clk->name);
  296. if (d)
  297. clk->dentry = d;
  298. else
  299. pr_debug("%s: failed to rename debugfs entry for %s\n",
  300. __func__, clk->name);
  301. }
  302. /**
  303. * clk_debug_init - lazily create the debugfs clk tree visualization
  304. *
  305. * clks are often initialized very early during boot before memory can
  306. * be dynamically allocated and well before debugfs is setup.
  307. * clk_debug_init walks the clk tree hierarchy while holding
  308. * prepare_lock and creates the topology as part of a late_initcall,
  309. * thus insuring that clks initialized very early will still be
  310. * represented in the debugfs clk tree. This function should only be
  311. * called once at boot-time, and all other clks added dynamically will
  312. * be done so with clk_debug_register.
  313. */
  314. static int __init clk_debug_init(void)
  315. {
  316. struct clk *clk;
  317. struct dentry *d;
  318. rootdir = debugfs_create_dir("clk", NULL);
  319. if (!rootdir)
  320. return -ENOMEM;
  321. d = debugfs_create_file("clk_summary", S_IRUGO, rootdir, NULL,
  322. &clk_summary_fops);
  323. if (!d)
  324. return -ENOMEM;
  325. d = debugfs_create_file("clk_dump", S_IRUGO, rootdir, NULL,
  326. &clk_dump_fops);
  327. if (!d)
  328. return -ENOMEM;
  329. orphandir = debugfs_create_dir("orphans", rootdir);
  330. if (!orphandir)
  331. return -ENOMEM;
  332. clk_prepare_lock();
  333. hlist_for_each_entry(clk, &clk_root_list, child_node)
  334. clk_debug_create_subtree(clk, rootdir);
  335. hlist_for_each_entry(clk, &clk_orphan_list, child_node)
  336. clk_debug_create_subtree(clk, orphandir);
  337. inited = 1;
  338. clk_prepare_unlock();
  339. return 0;
  340. }
  341. late_initcall(clk_debug_init);
  342. #else
  343. static inline int clk_debug_register(struct clk *clk) { return 0; }
  344. static inline void clk_debug_reparent(struct clk *clk, struct clk *new_parent)
  345. {
  346. }
  347. #endif
  348. /* caller must hold prepare_lock */
  349. static void clk_unprepare_unused_subtree(struct clk *clk)
  350. {
  351. struct clk *child;
  352. if (!clk)
  353. return;
  354. hlist_for_each_entry(child, &clk->children, child_node)
  355. clk_unprepare_unused_subtree(child);
  356. if (clk->prepare_count)
  357. return;
  358. if (clk->flags & CLK_IGNORE_UNUSED)
  359. return;
  360. if (__clk_is_prepared(clk)) {
  361. if (clk->ops->unprepare_unused)
  362. clk->ops->unprepare_unused(clk->hw);
  363. else if (clk->ops->unprepare)
  364. clk->ops->unprepare(clk->hw);
  365. }
  366. }
  367. /* caller must hold prepare_lock */
  368. static void clk_disable_unused_subtree(struct clk *clk)
  369. {
  370. struct clk *child;
  371. unsigned long flags;
  372. if (!clk)
  373. goto out;
  374. hlist_for_each_entry(child, &clk->children, child_node)
  375. clk_disable_unused_subtree(child);
  376. flags = clk_enable_lock();
  377. if (clk->enable_count)
  378. goto unlock_out;
  379. if (clk->flags & CLK_IGNORE_UNUSED)
  380. goto unlock_out;
  381. /*
  382. * some gate clocks have special needs during the disable-unused
  383. * sequence. call .disable_unused if available, otherwise fall
  384. * back to .disable
  385. */
  386. if (__clk_is_enabled(clk)) {
  387. if (clk->ops->disable_unused)
  388. clk->ops->disable_unused(clk->hw);
  389. else if (clk->ops->disable)
  390. clk->ops->disable(clk->hw);
  391. }
  392. unlock_out:
  393. clk_enable_unlock(flags);
  394. out:
  395. return;
  396. }
  397. static int clk_disable_unused(void)
  398. {
  399. struct clk *clk;
  400. clk_prepare_lock();
  401. hlist_for_each_entry(clk, &clk_root_list, child_node)
  402. clk_disable_unused_subtree(clk);
  403. hlist_for_each_entry(clk, &clk_orphan_list, child_node)
  404. clk_disable_unused_subtree(clk);
  405. hlist_for_each_entry(clk, &clk_root_list, child_node)
  406. clk_unprepare_unused_subtree(clk);
  407. hlist_for_each_entry(clk, &clk_orphan_list, child_node)
  408. clk_unprepare_unused_subtree(clk);
  409. clk_prepare_unlock();
  410. return 0;
  411. }
  412. late_initcall(clk_disable_unused);
  413. /*** helper functions ***/
  414. const char *__clk_get_name(struct clk *clk)
  415. {
  416. return !clk ? NULL : clk->name;
  417. }
  418. EXPORT_SYMBOL_GPL(__clk_get_name);
  419. struct clk_hw *__clk_get_hw(struct clk *clk)
  420. {
  421. return !clk ? NULL : clk->hw;
  422. }
  423. u8 __clk_get_num_parents(struct clk *clk)
  424. {
  425. return !clk ? 0 : clk->num_parents;
  426. }
  427. struct clk *__clk_get_parent(struct clk *clk)
  428. {
  429. return !clk ? NULL : clk->parent;
  430. }
  431. unsigned int __clk_get_enable_count(struct clk *clk)
  432. {
  433. return !clk ? 0 : clk->enable_count;
  434. }
  435. unsigned int __clk_get_prepare_count(struct clk *clk)
  436. {
  437. return !clk ? 0 : clk->prepare_count;
  438. }
  439. unsigned long __clk_get_rate(struct clk *clk)
  440. {
  441. unsigned long ret;
  442. if (!clk) {
  443. ret = 0;
  444. goto out;
  445. }
  446. ret = clk->rate;
  447. if (clk->flags & CLK_IS_ROOT)
  448. goto out;
  449. if (!clk->parent)
  450. ret = 0;
  451. out:
  452. return ret;
  453. }
  454. unsigned long __clk_get_flags(struct clk *clk)
  455. {
  456. return !clk ? 0 : clk->flags;
  457. }
  458. bool __clk_is_prepared(struct clk *clk)
  459. {
  460. int ret;
  461. if (!clk)
  462. return false;
  463. /*
  464. * .is_prepared is optional for clocks that can prepare
  465. * fall back to software usage counter if it is missing
  466. */
  467. if (!clk->ops->is_prepared) {
  468. ret = clk->prepare_count ? 1 : 0;
  469. goto out;
  470. }
  471. ret = clk->ops->is_prepared(clk->hw);
  472. out:
  473. return !!ret;
  474. }
  475. bool __clk_is_enabled(struct clk *clk)
  476. {
  477. int ret;
  478. if (!clk)
  479. return false;
  480. /*
  481. * .is_enabled is only mandatory for clocks that gate
  482. * fall back to software usage counter if .is_enabled is missing
  483. */
  484. if (!clk->ops->is_enabled) {
  485. ret = clk->enable_count ? 1 : 0;
  486. goto out;
  487. }
  488. ret = clk->ops->is_enabled(clk->hw);
  489. out:
  490. return !!ret;
  491. }
  492. static struct clk *__clk_lookup_subtree(const char *name, struct clk *clk)
  493. {
  494. struct clk *child;
  495. struct clk *ret;
  496. if (!strcmp(clk->name, name))
  497. return clk;
  498. hlist_for_each_entry(child, &clk->children, child_node) {
  499. ret = __clk_lookup_subtree(name, child);
  500. if (ret)
  501. return ret;
  502. }
  503. return NULL;
  504. }
  505. struct clk *__clk_lookup(const char *name)
  506. {
  507. struct clk *root_clk;
  508. struct clk *ret;
  509. if (!name)
  510. return NULL;
  511. /* search the 'proper' clk tree first */
  512. hlist_for_each_entry(root_clk, &clk_root_list, child_node) {
  513. ret = __clk_lookup_subtree(name, root_clk);
  514. if (ret)
  515. return ret;
  516. }
  517. /* if not found, then search the orphan tree */
  518. hlist_for_each_entry(root_clk, &clk_orphan_list, child_node) {
  519. ret = __clk_lookup_subtree(name, root_clk);
  520. if (ret)
  521. return ret;
  522. }
  523. return NULL;
  524. }
  525. /*** clk api ***/
  526. void __clk_unprepare(struct clk *clk)
  527. {
  528. if (!clk)
  529. return;
  530. if (WARN_ON(clk->prepare_count == 0))
  531. return;
  532. if (--clk->prepare_count > 0)
  533. return;
  534. WARN_ON(clk->enable_count > 0);
  535. if (clk->ops->unprepare)
  536. clk->ops->unprepare(clk->hw);
  537. __clk_unprepare(clk->parent);
  538. }
  539. /**
  540. * clk_unprepare - undo preparation of a clock source
  541. * @clk: the clk being unprepare
  542. *
  543. * clk_unprepare may sleep, which differentiates it from clk_disable. In a
  544. * simple case, clk_unprepare can be used instead of clk_disable to gate a clk
  545. * if the operation may sleep. One example is a clk which is accessed over
  546. * I2c. In the complex case a clk gate operation may require a fast and a slow
  547. * part. It is this reason that clk_unprepare and clk_disable are not mutually
  548. * exclusive. In fact clk_disable must be called before clk_unprepare.
  549. */
  550. void clk_unprepare(struct clk *clk)
  551. {
  552. clk_prepare_lock();
  553. __clk_unprepare(clk);
  554. clk_prepare_unlock();
  555. }
  556. EXPORT_SYMBOL_GPL(clk_unprepare);
  557. int __clk_prepare(struct clk *clk)
  558. {
  559. int ret = 0;
  560. if (!clk)
  561. return 0;
  562. if (clk->prepare_count == 0) {
  563. ret = __clk_prepare(clk->parent);
  564. if (ret)
  565. return ret;
  566. if (clk->ops->prepare) {
  567. ret = clk->ops->prepare(clk->hw);
  568. if (ret) {
  569. __clk_unprepare(clk->parent);
  570. return ret;
  571. }
  572. }
  573. }
  574. clk->prepare_count++;
  575. return 0;
  576. }
  577. /**
  578. * clk_prepare - prepare a clock source
  579. * @clk: the clk being prepared
  580. *
  581. * clk_prepare may sleep, which differentiates it from clk_enable. In a simple
  582. * case, clk_prepare can be used instead of clk_enable to ungate a clk if the
  583. * operation may sleep. One example is a clk which is accessed over I2c. In
  584. * the complex case a clk ungate operation may require a fast and a slow part.
  585. * It is this reason that clk_prepare and clk_enable are not mutually
  586. * exclusive. In fact clk_prepare must be called before clk_enable.
  587. * Returns 0 on success, -EERROR otherwise.
  588. */
  589. int clk_prepare(struct clk *clk)
  590. {
  591. int ret;
  592. clk_prepare_lock();
  593. ret = __clk_prepare(clk);
  594. clk_prepare_unlock();
  595. return ret;
  596. }
  597. EXPORT_SYMBOL_GPL(clk_prepare);
  598. static void __clk_disable(struct clk *clk)
  599. {
  600. if (!clk)
  601. return;
  602. if (WARN_ON(IS_ERR(clk)))
  603. return;
  604. if (WARN_ON(clk->enable_count == 0))
  605. return;
  606. if (--clk->enable_count > 0)
  607. return;
  608. if (clk->ops->disable)
  609. clk->ops->disable(clk->hw);
  610. __clk_disable(clk->parent);
  611. }
  612. /**
  613. * clk_disable - gate a clock
  614. * @clk: the clk being gated
  615. *
  616. * clk_disable must not sleep, which differentiates it from clk_unprepare. In
  617. * a simple case, clk_disable can be used instead of clk_unprepare to gate a
  618. * clk if the operation is fast and will never sleep. One example is a
  619. * SoC-internal clk which is controlled via simple register writes. In the
  620. * complex case a clk gate operation may require a fast and a slow part. It is
  621. * this reason that clk_unprepare and clk_disable are not mutually exclusive.
  622. * In fact clk_disable must be called before clk_unprepare.
  623. */
  624. void clk_disable(struct clk *clk)
  625. {
  626. unsigned long flags;
  627. flags = clk_enable_lock();
  628. __clk_disable(clk);
  629. clk_enable_unlock(flags);
  630. }
  631. EXPORT_SYMBOL_GPL(clk_disable);
  632. static int __clk_enable(struct clk *clk)
  633. {
  634. int ret = 0;
  635. if (!clk)
  636. return 0;
  637. if (WARN_ON(clk->prepare_count == 0))
  638. return -ESHUTDOWN;
  639. if (clk->enable_count == 0) {
  640. ret = __clk_enable(clk->parent);
  641. if (ret)
  642. return ret;
  643. if (clk->ops->enable) {
  644. ret = clk->ops->enable(clk->hw);
  645. if (ret) {
  646. __clk_disable(clk->parent);
  647. return ret;
  648. }
  649. }
  650. }
  651. clk->enable_count++;
  652. return 0;
  653. }
  654. /**
  655. * clk_enable - ungate a clock
  656. * @clk: the clk being ungated
  657. *
  658. * clk_enable must not sleep, which differentiates it from clk_prepare. In a
  659. * simple case, clk_enable can be used instead of clk_prepare to ungate a clk
  660. * if the operation will never sleep. One example is a SoC-internal clk which
  661. * is controlled via simple register writes. In the complex case a clk ungate
  662. * operation may require a fast and a slow part. It is this reason that
  663. * clk_enable and clk_prepare are not mutually exclusive. In fact clk_prepare
  664. * must be called before clk_enable. Returns 0 on success, -EERROR
  665. * otherwise.
  666. */
  667. int clk_enable(struct clk *clk)
  668. {
  669. unsigned long flags;
  670. int ret;
  671. flags = clk_enable_lock();
  672. ret = __clk_enable(clk);
  673. clk_enable_unlock(flags);
  674. return ret;
  675. }
  676. EXPORT_SYMBOL_GPL(clk_enable);
  677. /**
  678. * __clk_round_rate - round the given rate for a clk
  679. * @clk: round the rate of this clock
  680. *
  681. * Caller must hold prepare_lock. Useful for clk_ops such as .set_rate
  682. */
  683. unsigned long __clk_round_rate(struct clk *clk, unsigned long rate)
  684. {
  685. unsigned long parent_rate = 0;
  686. if (!clk)
  687. return 0;
  688. if (!clk->ops->round_rate) {
  689. if (clk->flags & CLK_SET_RATE_PARENT)
  690. return __clk_round_rate(clk->parent, rate);
  691. else
  692. return clk->rate;
  693. }
  694. if (clk->parent)
  695. parent_rate = clk->parent->rate;
  696. return clk->ops->round_rate(clk->hw, rate, &parent_rate);
  697. }
  698. /**
  699. * clk_round_rate - round the given rate for a clk
  700. * @clk: the clk for which we are rounding a rate
  701. * @rate: the rate which is to be rounded
  702. *
  703. * Takes in a rate as input and rounds it to a rate that the clk can actually
  704. * use which is then returned. If clk doesn't support round_rate operation
  705. * then the parent rate is returned.
  706. */
  707. long clk_round_rate(struct clk *clk, unsigned long rate)
  708. {
  709. unsigned long ret;
  710. clk_prepare_lock();
  711. ret = __clk_round_rate(clk, rate);
  712. clk_prepare_unlock();
  713. return ret;
  714. }
  715. EXPORT_SYMBOL_GPL(clk_round_rate);
  716. /**
  717. * __clk_notify - call clk notifier chain
  718. * @clk: struct clk * that is changing rate
  719. * @msg: clk notifier type (see include/linux/clk.h)
  720. * @old_rate: old clk rate
  721. * @new_rate: new clk rate
  722. *
  723. * Triggers a notifier call chain on the clk rate-change notification
  724. * for 'clk'. Passes a pointer to the struct clk and the previous
  725. * and current rates to the notifier callback. Intended to be called by
  726. * internal clock code only. Returns NOTIFY_DONE from the last driver
  727. * called if all went well, or NOTIFY_STOP or NOTIFY_BAD immediately if
  728. * a driver returns that.
  729. */
  730. static int __clk_notify(struct clk *clk, unsigned long msg,
  731. unsigned long old_rate, unsigned long new_rate)
  732. {
  733. struct clk_notifier *cn;
  734. struct clk_notifier_data cnd;
  735. int ret = NOTIFY_DONE;
  736. cnd.clk = clk;
  737. cnd.old_rate = old_rate;
  738. cnd.new_rate = new_rate;
  739. list_for_each_entry(cn, &clk_notifier_list, node) {
  740. if (cn->clk == clk) {
  741. ret = srcu_notifier_call_chain(&cn->notifier_head, msg,
  742. &cnd);
  743. break;
  744. }
  745. }
  746. return ret;
  747. }
  748. /**
  749. * __clk_recalc_rates
  750. * @clk: first clk in the subtree
  751. * @msg: notification type (see include/linux/clk.h)
  752. *
  753. * Walks the subtree of clks starting with clk and recalculates rates as it
  754. * goes. Note that if a clk does not implement the .recalc_rate callback then
  755. * it is assumed that the clock will take on the rate of it's parent.
  756. *
  757. * clk_recalc_rates also propagates the POST_RATE_CHANGE notification,
  758. * if necessary.
  759. *
  760. * Caller must hold prepare_lock.
  761. */
  762. static void __clk_recalc_rates(struct clk *clk, unsigned long msg)
  763. {
  764. unsigned long old_rate;
  765. unsigned long parent_rate = 0;
  766. struct clk *child;
  767. old_rate = clk->rate;
  768. if (clk->parent)
  769. parent_rate = clk->parent->rate;
  770. if (clk->ops->recalc_rate)
  771. clk->rate = clk->ops->recalc_rate(clk->hw, parent_rate);
  772. else
  773. clk->rate = parent_rate;
  774. /*
  775. * ignore NOTIFY_STOP and NOTIFY_BAD return values for POST_RATE_CHANGE
  776. * & ABORT_RATE_CHANGE notifiers
  777. */
  778. if (clk->notifier_count && msg)
  779. __clk_notify(clk, msg, old_rate, clk->rate);
  780. hlist_for_each_entry(child, &clk->children, child_node)
  781. __clk_recalc_rates(child, msg);
  782. }
  783. /**
  784. * clk_get_rate - return the rate of clk
  785. * @clk: the clk whose rate is being returned
  786. *
  787. * Simply returns the cached rate of the clk, unless CLK_GET_RATE_NOCACHE flag
  788. * is set, which means a recalc_rate will be issued.
  789. * If clk is NULL then returns 0.
  790. */
  791. unsigned long clk_get_rate(struct clk *clk)
  792. {
  793. unsigned long rate;
  794. clk_prepare_lock();
  795. if (clk && (clk->flags & CLK_GET_RATE_NOCACHE))
  796. __clk_recalc_rates(clk, 0);
  797. rate = __clk_get_rate(clk);
  798. clk_prepare_unlock();
  799. return rate;
  800. }
  801. EXPORT_SYMBOL_GPL(clk_get_rate);
  802. /**
  803. * __clk_speculate_rates
  804. * @clk: first clk in the subtree
  805. * @parent_rate: the "future" rate of clk's parent
  806. *
  807. * Walks the subtree of clks starting with clk, speculating rates as it
  808. * goes and firing off PRE_RATE_CHANGE notifications as necessary.
  809. *
  810. * Unlike clk_recalc_rates, clk_speculate_rates exists only for sending
  811. * pre-rate change notifications and returns early if no clks in the
  812. * subtree have subscribed to the notifications. Note that if a clk does not
  813. * implement the .recalc_rate callback then it is assumed that the clock will
  814. * take on the rate of it's parent.
  815. *
  816. * Caller must hold prepare_lock.
  817. */
  818. static int __clk_speculate_rates(struct clk *clk, unsigned long parent_rate)
  819. {
  820. struct clk *child;
  821. unsigned long new_rate;
  822. int ret = NOTIFY_DONE;
  823. if (clk->ops->recalc_rate)
  824. new_rate = clk->ops->recalc_rate(clk->hw, parent_rate);
  825. else
  826. new_rate = parent_rate;
  827. /* abort the rate change if a driver returns NOTIFY_BAD */
  828. if (clk->notifier_count)
  829. ret = __clk_notify(clk, PRE_RATE_CHANGE, clk->rate, new_rate);
  830. if (ret == NOTIFY_BAD)
  831. goto out;
  832. hlist_for_each_entry(child, &clk->children, child_node) {
  833. ret = __clk_speculate_rates(child, new_rate);
  834. if (ret == NOTIFY_BAD)
  835. break;
  836. }
  837. out:
  838. return ret;
  839. }
  840. static void clk_calc_subtree(struct clk *clk, unsigned long new_rate)
  841. {
  842. struct clk *child;
  843. clk->new_rate = new_rate;
  844. hlist_for_each_entry(child, &clk->children, child_node) {
  845. if (child->ops->recalc_rate)
  846. child->new_rate = child->ops->recalc_rate(child->hw, new_rate);
  847. else
  848. child->new_rate = new_rate;
  849. clk_calc_subtree(child, child->new_rate);
  850. }
  851. }
  852. /*
  853. * calculate the new rates returning the topmost clock that has to be
  854. * changed.
  855. */
  856. static struct clk *clk_calc_new_rates(struct clk *clk, unsigned long rate)
  857. {
  858. struct clk *top = clk;
  859. unsigned long best_parent_rate = 0;
  860. unsigned long new_rate;
  861. /* sanity */
  862. if (IS_ERR_OR_NULL(clk))
  863. return NULL;
  864. /* save parent rate, if it exists */
  865. if (clk->parent)
  866. best_parent_rate = clk->parent->rate;
  867. /* never propagate up to the parent */
  868. if (!(clk->flags & CLK_SET_RATE_PARENT)) {
  869. if (!clk->ops->round_rate) {
  870. clk->new_rate = clk->rate;
  871. return NULL;
  872. }
  873. new_rate = clk->ops->round_rate(clk->hw, rate, &best_parent_rate);
  874. goto out;
  875. }
  876. /* need clk->parent from here on out */
  877. if (!clk->parent) {
  878. pr_debug("%s: %s has NULL parent\n", __func__, clk->name);
  879. return NULL;
  880. }
  881. if (!clk->ops->round_rate) {
  882. top = clk_calc_new_rates(clk->parent, rate);
  883. new_rate = clk->parent->new_rate;
  884. goto out;
  885. }
  886. new_rate = clk->ops->round_rate(clk->hw, rate, &best_parent_rate);
  887. if (best_parent_rate != clk->parent->rate) {
  888. top = clk_calc_new_rates(clk->parent, best_parent_rate);
  889. goto out;
  890. }
  891. out:
  892. clk_calc_subtree(clk, new_rate);
  893. return top;
  894. }
  895. /*
  896. * Notify about rate changes in a subtree. Always walk down the whole tree
  897. * so that in case of an error we can walk down the whole tree again and
  898. * abort the change.
  899. */
  900. static struct clk *clk_propagate_rate_change(struct clk *clk, unsigned long event)
  901. {
  902. struct clk *child, *fail_clk = NULL;
  903. int ret = NOTIFY_DONE;
  904. if (clk->rate == clk->new_rate)
  905. return NULL;
  906. if (clk->notifier_count) {
  907. ret = __clk_notify(clk, event, clk->rate, clk->new_rate);
  908. if (ret == NOTIFY_BAD)
  909. fail_clk = clk;
  910. }
  911. hlist_for_each_entry(child, &clk->children, child_node) {
  912. clk = clk_propagate_rate_change(child, event);
  913. if (clk)
  914. fail_clk = clk;
  915. }
  916. return fail_clk;
  917. }
  918. /*
  919. * walk down a subtree and set the new rates notifying the rate
  920. * change on the way
  921. */
  922. static void clk_change_rate(struct clk *clk)
  923. {
  924. struct clk *child;
  925. unsigned long old_rate;
  926. unsigned long best_parent_rate = 0;
  927. old_rate = clk->rate;
  928. if (clk->parent)
  929. best_parent_rate = clk->parent->rate;
  930. if (clk->ops->set_rate)
  931. clk->ops->set_rate(clk->hw, clk->new_rate, best_parent_rate);
  932. if (clk->ops->recalc_rate)
  933. clk->rate = clk->ops->recalc_rate(clk->hw, best_parent_rate);
  934. else
  935. clk->rate = best_parent_rate;
  936. if (clk->notifier_count && old_rate != clk->rate)
  937. __clk_notify(clk, POST_RATE_CHANGE, old_rate, clk->rate);
  938. hlist_for_each_entry(child, &clk->children, child_node)
  939. clk_change_rate(child);
  940. }
  941. /**
  942. * clk_set_rate - specify a new rate for clk
  943. * @clk: the clk whose rate is being changed
  944. * @rate: the new rate for clk
  945. *
  946. * In the simplest case clk_set_rate will only adjust the rate of clk.
  947. *
  948. * Setting the CLK_SET_RATE_PARENT flag allows the rate change operation to
  949. * propagate up to clk's parent; whether or not this happens depends on the
  950. * outcome of clk's .round_rate implementation. If *parent_rate is unchanged
  951. * after calling .round_rate then upstream parent propagation is ignored. If
  952. * *parent_rate comes back with a new rate for clk's parent then we propagate
  953. * up to clk's parent and set it's rate. Upward propagation will continue
  954. * until either a clk does not support the CLK_SET_RATE_PARENT flag or
  955. * .round_rate stops requesting changes to clk's parent_rate.
  956. *
  957. * Rate changes are accomplished via tree traversal that also recalculates the
  958. * rates for the clocks and fires off POST_RATE_CHANGE notifiers.
  959. *
  960. * Returns 0 on success, -EERROR otherwise.
  961. */
  962. int clk_set_rate(struct clk *clk, unsigned long rate)
  963. {
  964. struct clk *top, *fail_clk;
  965. int ret = 0;
  966. /* prevent racing with updates to the clock topology */
  967. clk_prepare_lock();
  968. /* bail early if nothing to do */
  969. if (rate == clk->rate)
  970. goto out;
  971. if ((clk->flags & CLK_SET_RATE_GATE) && clk->prepare_count) {
  972. ret = -EBUSY;
  973. goto out;
  974. }
  975. /* calculate new rates and get the topmost changed clock */
  976. top = clk_calc_new_rates(clk, rate);
  977. if (!top) {
  978. ret = -EINVAL;
  979. goto out;
  980. }
  981. /* notify that we are about to change rates */
  982. fail_clk = clk_propagate_rate_change(top, PRE_RATE_CHANGE);
  983. if (fail_clk) {
  984. pr_warn("%s: failed to set %s rate\n", __func__,
  985. fail_clk->name);
  986. clk_propagate_rate_change(top, ABORT_RATE_CHANGE);
  987. ret = -EBUSY;
  988. goto out;
  989. }
  990. /* change the rates */
  991. clk_change_rate(top);
  992. out:
  993. clk_prepare_unlock();
  994. return ret;
  995. }
  996. EXPORT_SYMBOL_GPL(clk_set_rate);
  997. /**
  998. * clk_get_parent - return the parent of a clk
  999. * @clk: the clk whose parent gets returned
  1000. *
  1001. * Simply returns clk->parent. Returns NULL if clk is NULL.
  1002. */
  1003. struct clk *clk_get_parent(struct clk *clk)
  1004. {
  1005. struct clk *parent;
  1006. clk_prepare_lock();
  1007. parent = __clk_get_parent(clk);
  1008. clk_prepare_unlock();
  1009. return parent;
  1010. }
  1011. EXPORT_SYMBOL_GPL(clk_get_parent);
  1012. /*
  1013. * .get_parent is mandatory for clocks with multiple possible parents. It is
  1014. * optional for single-parent clocks. Always call .get_parent if it is
  1015. * available and WARN if it is missing for multi-parent clocks.
  1016. *
  1017. * For single-parent clocks without .get_parent, first check to see if the
  1018. * .parents array exists, and if so use it to avoid an expensive tree
  1019. * traversal. If .parents does not exist then walk the tree with __clk_lookup.
  1020. */
  1021. static struct clk *__clk_init_parent(struct clk *clk)
  1022. {
  1023. struct clk *ret = NULL;
  1024. u8 index;
  1025. /* handle the trivial cases */
  1026. if (!clk->num_parents)
  1027. goto out;
  1028. if (clk->num_parents == 1) {
  1029. if (IS_ERR_OR_NULL(clk->parent))
  1030. ret = clk->parent = __clk_lookup(clk->parent_names[0]);
  1031. ret = clk->parent;
  1032. goto out;
  1033. }
  1034. if (!clk->ops->get_parent) {
  1035. WARN(!clk->ops->get_parent,
  1036. "%s: multi-parent clocks must implement .get_parent\n",
  1037. __func__);
  1038. goto out;
  1039. };
  1040. /*
  1041. * Do our best to cache parent clocks in clk->parents. This prevents
  1042. * unnecessary and expensive calls to __clk_lookup. We don't set
  1043. * clk->parent here; that is done by the calling function
  1044. */
  1045. index = clk->ops->get_parent(clk->hw);
  1046. if (!clk->parents)
  1047. clk->parents =
  1048. kzalloc((sizeof(struct clk*) * clk->num_parents),
  1049. GFP_KERNEL);
  1050. if (!clk->parents)
  1051. ret = __clk_lookup(clk->parent_names[index]);
  1052. else if (!clk->parents[index])
  1053. ret = clk->parents[index] =
  1054. __clk_lookup(clk->parent_names[index]);
  1055. else
  1056. ret = clk->parents[index];
  1057. out:
  1058. return ret;
  1059. }
  1060. static void clk_reparent(struct clk *clk, struct clk *new_parent)
  1061. {
  1062. hlist_del(&clk->child_node);
  1063. if (new_parent)
  1064. hlist_add_head(&clk->child_node, &new_parent->children);
  1065. else
  1066. hlist_add_head(&clk->child_node, &clk_orphan_list);
  1067. clk->parent = new_parent;
  1068. }
  1069. void __clk_reparent(struct clk *clk, struct clk *new_parent)
  1070. {
  1071. clk_reparent(clk, new_parent);
  1072. clk_debug_reparent(clk, new_parent);
  1073. __clk_recalc_rates(clk, POST_RATE_CHANGE);
  1074. }
  1075. static u8 clk_fetch_parent_index(struct clk *clk, struct clk *parent)
  1076. {
  1077. u8 i;
  1078. if (!clk->parents)
  1079. clk->parents = kzalloc((sizeof(struct clk*) * clk->num_parents),
  1080. GFP_KERNEL);
  1081. /*
  1082. * find index of new parent clock using cached parent ptrs,
  1083. * or if not yet cached, use string name comparison and cache
  1084. * them now to avoid future calls to __clk_lookup.
  1085. */
  1086. for (i = 0; i < clk->num_parents; i++) {
  1087. if (clk->parents && clk->parents[i] == parent)
  1088. break;
  1089. else if (!strcmp(clk->parent_names[i], parent->name)) {
  1090. if (clk->parents)
  1091. clk->parents[i] = __clk_lookup(parent->name);
  1092. break;
  1093. }
  1094. }
  1095. return i;
  1096. }
  1097. static int __clk_set_parent(struct clk *clk, struct clk *parent, u8 p_index)
  1098. {
  1099. unsigned long flags;
  1100. int ret = 0;
  1101. struct clk *old_parent = clk->parent;
  1102. /* migrate prepare and enable */
  1103. if (clk->prepare_count)
  1104. __clk_prepare(parent);
  1105. /* FIXME replace with clk_is_enabled(clk) someday */
  1106. flags = clk_enable_lock();
  1107. if (clk->enable_count)
  1108. __clk_enable(parent);
  1109. clk_enable_unlock(flags);
  1110. /* change clock input source */
  1111. if (parent && clk->ops->set_parent)
  1112. ret = clk->ops->set_parent(clk->hw, p_index);
  1113. /* clean up old prepare and enable */
  1114. flags = clk_enable_lock();
  1115. if (clk->enable_count)
  1116. __clk_disable(old_parent);
  1117. clk_enable_unlock(flags);
  1118. if (clk->prepare_count)
  1119. __clk_unprepare(old_parent);
  1120. return ret;
  1121. }
  1122. /**
  1123. * clk_set_parent - switch the parent of a mux clk
  1124. * @clk: the mux clk whose input we are switching
  1125. * @parent: the new input to clk
  1126. *
  1127. * Re-parent clk to use parent as it's new input source. If clk has the
  1128. * CLK_SET_PARENT_GATE flag set then clk must be gated for this
  1129. * operation to succeed. After successfully changing clk's parent
  1130. * clk_set_parent will update the clk topology, sysfs topology and
  1131. * propagate rate recalculation via __clk_recalc_rates. Returns 0 on
  1132. * success, -EERROR otherwise.
  1133. */
  1134. int clk_set_parent(struct clk *clk, struct clk *parent)
  1135. {
  1136. int ret = 0;
  1137. u8 p_index = 0;
  1138. unsigned long p_rate = 0;
  1139. if (!clk || !clk->ops)
  1140. return -EINVAL;
  1141. /* verify ops for for multi-parent clks */
  1142. if ((clk->num_parents > 1) && (!clk->ops->set_parent))
  1143. return -ENOSYS;
  1144. /* prevent racing with updates to the clock topology */
  1145. clk_prepare_lock();
  1146. if (clk->parent == parent)
  1147. goto out;
  1148. /* check that we are allowed to re-parent if the clock is in use */
  1149. if ((clk->flags & CLK_SET_PARENT_GATE) && clk->prepare_count) {
  1150. ret = -EBUSY;
  1151. goto out;
  1152. }
  1153. /* try finding the new parent index */
  1154. if (parent) {
  1155. p_index = clk_fetch_parent_index(clk, parent);
  1156. p_rate = parent->rate;
  1157. if (p_index == clk->num_parents) {
  1158. pr_debug("%s: clk %s can not be parent of clk %s\n",
  1159. __func__, parent->name, clk->name);
  1160. ret = -EINVAL;
  1161. goto out;
  1162. }
  1163. }
  1164. /* propagate PRE_RATE_CHANGE notifications */
  1165. if (clk->notifier_count)
  1166. ret = __clk_speculate_rates(clk, p_rate);
  1167. /* abort if a driver objects */
  1168. if (ret == NOTIFY_STOP)
  1169. goto out;
  1170. /* do the re-parent */
  1171. ret = __clk_set_parent(clk, parent, p_index);
  1172. /* propagate ABORT_RATE_CHANGE if .set_parent failed */
  1173. if (ret) {
  1174. __clk_recalc_rates(clk, ABORT_RATE_CHANGE);
  1175. goto out;
  1176. }
  1177. /* propagate rate recalculation downstream */
  1178. __clk_reparent(clk, parent);
  1179. out:
  1180. clk_prepare_unlock();
  1181. return ret;
  1182. }
  1183. EXPORT_SYMBOL_GPL(clk_set_parent);
  1184. /**
  1185. * __clk_init - initialize the data structures in a struct clk
  1186. * @dev: device initializing this clk, placeholder for now
  1187. * @clk: clk being initialized
  1188. *
  1189. * Initializes the lists in struct clk, queries the hardware for the
  1190. * parent and rate and sets them both.
  1191. */
  1192. int __clk_init(struct device *dev, struct clk *clk)
  1193. {
  1194. int i, ret = 0;
  1195. struct clk *orphan;
  1196. struct hlist_node *tmp2;
  1197. if (!clk)
  1198. return -EINVAL;
  1199. clk_prepare_lock();
  1200. /* check to see if a clock with this name is already registered */
  1201. if (__clk_lookup(clk->name)) {
  1202. pr_debug("%s: clk %s already initialized\n",
  1203. __func__, clk->name);
  1204. ret = -EEXIST;
  1205. goto out;
  1206. }
  1207. /* check that clk_ops are sane. See Documentation/clk.txt */
  1208. if (clk->ops->set_rate &&
  1209. !(clk->ops->round_rate && clk->ops->recalc_rate)) {
  1210. pr_warning("%s: %s must implement .round_rate & .recalc_rate\n",
  1211. __func__, clk->name);
  1212. ret = -EINVAL;
  1213. goto out;
  1214. }
  1215. if (clk->ops->set_parent && !clk->ops->get_parent) {
  1216. pr_warning("%s: %s must implement .get_parent & .set_parent\n",
  1217. __func__, clk->name);
  1218. ret = -EINVAL;
  1219. goto out;
  1220. }
  1221. /* throw a WARN if any entries in parent_names are NULL */
  1222. for (i = 0; i < clk->num_parents; i++)
  1223. WARN(!clk->parent_names[i],
  1224. "%s: invalid NULL in %s's .parent_names\n",
  1225. __func__, clk->name);
  1226. /*
  1227. * Allocate an array of struct clk *'s to avoid unnecessary string
  1228. * look-ups of clk's possible parents. This can fail for clocks passed
  1229. * in to clk_init during early boot; thus any access to clk->parents[]
  1230. * must always check for a NULL pointer and try to populate it if
  1231. * necessary.
  1232. *
  1233. * If clk->parents is not NULL we skip this entire block. This allows
  1234. * for clock drivers to statically initialize clk->parents.
  1235. */
  1236. if (clk->num_parents > 1 && !clk->parents) {
  1237. clk->parents = kzalloc((sizeof(struct clk*) * clk->num_parents),
  1238. GFP_KERNEL);
  1239. /*
  1240. * __clk_lookup returns NULL for parents that have not been
  1241. * clk_init'd; thus any access to clk->parents[] must check
  1242. * for a NULL pointer. We can always perform lazy lookups for
  1243. * missing parents later on.
  1244. */
  1245. if (clk->parents)
  1246. for (i = 0; i < clk->num_parents; i++)
  1247. clk->parents[i] =
  1248. __clk_lookup(clk->parent_names[i]);
  1249. }
  1250. clk->parent = __clk_init_parent(clk);
  1251. /*
  1252. * Populate clk->parent if parent has already been __clk_init'd. If
  1253. * parent has not yet been __clk_init'd then place clk in the orphan
  1254. * list. If clk has set the CLK_IS_ROOT flag then place it in the root
  1255. * clk list.
  1256. *
  1257. * Every time a new clk is clk_init'd then we walk the list of orphan
  1258. * clocks and re-parent any that are children of the clock currently
  1259. * being clk_init'd.
  1260. */
  1261. if (clk->parent)
  1262. hlist_add_head(&clk->child_node,
  1263. &clk->parent->children);
  1264. else if (clk->flags & CLK_IS_ROOT)
  1265. hlist_add_head(&clk->child_node, &clk_root_list);
  1266. else
  1267. hlist_add_head(&clk->child_node, &clk_orphan_list);
  1268. /*
  1269. * Set clk's rate. The preferred method is to use .recalc_rate. For
  1270. * simple clocks and lazy developers the default fallback is to use the
  1271. * parent's rate. If a clock doesn't have a parent (or is orphaned)
  1272. * then rate is set to zero.
  1273. */
  1274. if (clk->ops->recalc_rate)
  1275. clk->rate = clk->ops->recalc_rate(clk->hw,
  1276. __clk_get_rate(clk->parent));
  1277. else if (clk->parent)
  1278. clk->rate = clk->parent->rate;
  1279. else
  1280. clk->rate = 0;
  1281. /*
  1282. * walk the list of orphan clocks and reparent any that are children of
  1283. * this clock
  1284. */
  1285. hlist_for_each_entry_safe(orphan, tmp2, &clk_orphan_list, child_node) {
  1286. if (orphan->ops->get_parent) {
  1287. i = orphan->ops->get_parent(orphan->hw);
  1288. if (!strcmp(clk->name, orphan->parent_names[i]))
  1289. __clk_reparent(orphan, clk);
  1290. continue;
  1291. }
  1292. for (i = 0; i < orphan->num_parents; i++)
  1293. if (!strcmp(clk->name, orphan->parent_names[i])) {
  1294. __clk_reparent(orphan, clk);
  1295. break;
  1296. }
  1297. }
  1298. /*
  1299. * optional platform-specific magic
  1300. *
  1301. * The .init callback is not used by any of the basic clock types, but
  1302. * exists for weird hardware that must perform initialization magic.
  1303. * Please consider other ways of solving initialization problems before
  1304. * using this callback, as it's use is discouraged.
  1305. */
  1306. if (clk->ops->init)
  1307. clk->ops->init(clk->hw);
  1308. clk_debug_register(clk);
  1309. out:
  1310. clk_prepare_unlock();
  1311. return ret;
  1312. }
  1313. /**
  1314. * __clk_register - register a clock and return a cookie.
  1315. *
  1316. * Same as clk_register, except that the .clk field inside hw shall point to a
  1317. * preallocated (generally statically allocated) struct clk. None of the fields
  1318. * of the struct clk need to be initialized.
  1319. *
  1320. * The data pointed to by .init and .clk field shall NOT be marked as init
  1321. * data.
  1322. *
  1323. * __clk_register is only exposed via clk-private.h and is intended for use with
  1324. * very large numbers of clocks that need to be statically initialized. It is
  1325. * a layering violation to include clk-private.h from any code which implements
  1326. * a clock's .ops; as such any statically initialized clock data MUST be in a
  1327. * separate C file from the logic that implements it's operations. Returns 0
  1328. * on success, otherwise an error code.
  1329. */
  1330. struct clk *__clk_register(struct device *dev, struct clk_hw *hw)
  1331. {
  1332. int ret;
  1333. struct clk *clk;
  1334. clk = hw->clk;
  1335. clk->name = hw->init->name;
  1336. clk->ops = hw->init->ops;
  1337. clk->hw = hw;
  1338. clk->flags = hw->init->flags;
  1339. clk->parent_names = hw->init->parent_names;
  1340. clk->num_parents = hw->init->num_parents;
  1341. ret = __clk_init(dev, clk);
  1342. if (ret)
  1343. return ERR_PTR(ret);
  1344. return clk;
  1345. }
  1346. EXPORT_SYMBOL_GPL(__clk_register);
  1347. static int _clk_register(struct device *dev, struct clk_hw *hw, struct clk *clk)
  1348. {
  1349. int i, ret;
  1350. clk->name = kstrdup(hw->init->name, GFP_KERNEL);
  1351. if (!clk->name) {
  1352. pr_err("%s: could not allocate clk->name\n", __func__);
  1353. ret = -ENOMEM;
  1354. goto fail_name;
  1355. }
  1356. clk->ops = hw->init->ops;
  1357. clk->hw = hw;
  1358. clk->flags = hw->init->flags;
  1359. clk->num_parents = hw->init->num_parents;
  1360. hw->clk = clk;
  1361. /* allocate local copy in case parent_names is __initdata */
  1362. clk->parent_names = kzalloc((sizeof(char*) * clk->num_parents),
  1363. GFP_KERNEL);
  1364. if (!clk->parent_names) {
  1365. pr_err("%s: could not allocate clk->parent_names\n", __func__);
  1366. ret = -ENOMEM;
  1367. goto fail_parent_names;
  1368. }
  1369. /* copy each string name in case parent_names is __initdata */
  1370. for (i = 0; i < clk->num_parents; i++) {
  1371. clk->parent_names[i] = kstrdup(hw->init->parent_names[i],
  1372. GFP_KERNEL);
  1373. if (!clk->parent_names[i]) {
  1374. pr_err("%s: could not copy parent_names\n", __func__);
  1375. ret = -ENOMEM;
  1376. goto fail_parent_names_copy;
  1377. }
  1378. }
  1379. ret = __clk_init(dev, clk);
  1380. if (!ret)
  1381. return 0;
  1382. fail_parent_names_copy:
  1383. while (--i >= 0)
  1384. kfree(clk->parent_names[i]);
  1385. kfree(clk->parent_names);
  1386. fail_parent_names:
  1387. kfree(clk->name);
  1388. fail_name:
  1389. return ret;
  1390. }
  1391. /**
  1392. * clk_register - allocate a new clock, register it and return an opaque cookie
  1393. * @dev: device that is registering this clock
  1394. * @hw: link to hardware-specific clock data
  1395. *
  1396. * clk_register is the primary interface for populating the clock tree with new
  1397. * clock nodes. It returns a pointer to the newly allocated struct clk which
  1398. * cannot be dereferenced by driver code but may be used in conjuction with the
  1399. * rest of the clock API. In the event of an error clk_register will return an
  1400. * error code; drivers must test for an error code after calling clk_register.
  1401. */
  1402. struct clk *clk_register(struct device *dev, struct clk_hw *hw)
  1403. {
  1404. int ret;
  1405. struct clk *clk;
  1406. clk = kzalloc(sizeof(*clk), GFP_KERNEL);
  1407. if (!clk) {
  1408. pr_err("%s: could not allocate clk\n", __func__);
  1409. ret = -ENOMEM;
  1410. goto fail_out;
  1411. }
  1412. ret = _clk_register(dev, hw, clk);
  1413. if (!ret)
  1414. return clk;
  1415. kfree(clk);
  1416. fail_out:
  1417. return ERR_PTR(ret);
  1418. }
  1419. EXPORT_SYMBOL_GPL(clk_register);
  1420. /**
  1421. * clk_unregister - unregister a currently registered clock
  1422. * @clk: clock to unregister
  1423. *
  1424. * Currently unimplemented.
  1425. */
  1426. void clk_unregister(struct clk *clk) {}
  1427. EXPORT_SYMBOL_GPL(clk_unregister);
  1428. static void devm_clk_release(struct device *dev, void *res)
  1429. {
  1430. clk_unregister(res);
  1431. }
  1432. /**
  1433. * devm_clk_register - resource managed clk_register()
  1434. * @dev: device that is registering this clock
  1435. * @hw: link to hardware-specific clock data
  1436. *
  1437. * Managed clk_register(). Clocks returned from this function are
  1438. * automatically clk_unregister()ed on driver detach. See clk_register() for
  1439. * more information.
  1440. */
  1441. struct clk *devm_clk_register(struct device *dev, struct clk_hw *hw)
  1442. {
  1443. struct clk *clk;
  1444. int ret;
  1445. clk = devres_alloc(devm_clk_release, sizeof(*clk), GFP_KERNEL);
  1446. if (!clk)
  1447. return ERR_PTR(-ENOMEM);
  1448. ret = _clk_register(dev, hw, clk);
  1449. if (!ret) {
  1450. devres_add(dev, clk);
  1451. } else {
  1452. devres_free(clk);
  1453. clk = ERR_PTR(ret);
  1454. }
  1455. return clk;
  1456. }
  1457. EXPORT_SYMBOL_GPL(devm_clk_register);
  1458. static int devm_clk_match(struct device *dev, void *res, void *data)
  1459. {
  1460. struct clk *c = res;
  1461. if (WARN_ON(!c))
  1462. return 0;
  1463. return c == data;
  1464. }
  1465. /**
  1466. * devm_clk_unregister - resource managed clk_unregister()
  1467. * @clk: clock to unregister
  1468. *
  1469. * Deallocate a clock allocated with devm_clk_register(). Normally
  1470. * this function will not need to be called and the resource management
  1471. * code will ensure that the resource is freed.
  1472. */
  1473. void devm_clk_unregister(struct device *dev, struct clk *clk)
  1474. {
  1475. WARN_ON(devres_release(dev, devm_clk_release, devm_clk_match, clk));
  1476. }
  1477. EXPORT_SYMBOL_GPL(devm_clk_unregister);
  1478. /*** clk rate change notifiers ***/
  1479. /**
  1480. * clk_notifier_register - add a clk rate change notifier
  1481. * @clk: struct clk * to watch
  1482. * @nb: struct notifier_block * with callback info
  1483. *
  1484. * Request notification when clk's rate changes. This uses an SRCU
  1485. * notifier because we want it to block and notifier unregistrations are
  1486. * uncommon. The callbacks associated with the notifier must not
  1487. * re-enter into the clk framework by calling any top-level clk APIs;
  1488. * this will cause a nested prepare_lock mutex.
  1489. *
  1490. * Pre-change notifier callbacks will be passed the current, pre-change
  1491. * rate of the clk via struct clk_notifier_data.old_rate. The new,
  1492. * post-change rate of the clk is passed via struct
  1493. * clk_notifier_data.new_rate.
  1494. *
  1495. * Post-change notifiers will pass the now-current, post-change rate of
  1496. * the clk in both struct clk_notifier_data.old_rate and struct
  1497. * clk_notifier_data.new_rate.
  1498. *
  1499. * Abort-change notifiers are effectively the opposite of pre-change
  1500. * notifiers: the original pre-change clk rate is passed in via struct
  1501. * clk_notifier_data.new_rate and the failed post-change rate is passed
  1502. * in via struct clk_notifier_data.old_rate.
  1503. *
  1504. * clk_notifier_register() must be called from non-atomic context.
  1505. * Returns -EINVAL if called with null arguments, -ENOMEM upon
  1506. * allocation failure; otherwise, passes along the return value of
  1507. * srcu_notifier_chain_register().
  1508. */
  1509. int clk_notifier_register(struct clk *clk, struct notifier_block *nb)
  1510. {
  1511. struct clk_notifier *cn;
  1512. int ret = -ENOMEM;
  1513. if (!clk || !nb)
  1514. return -EINVAL;
  1515. clk_prepare_lock();
  1516. /* search the list of notifiers for this clk */
  1517. list_for_each_entry(cn, &clk_notifier_list, node)
  1518. if (cn->clk == clk)
  1519. break;
  1520. /* if clk wasn't in the notifier list, allocate new clk_notifier */
  1521. if (cn->clk != clk) {
  1522. cn = kzalloc(sizeof(struct clk_notifier), GFP_KERNEL);
  1523. if (!cn)
  1524. goto out;
  1525. cn->clk = clk;
  1526. srcu_init_notifier_head(&cn->notifier_head);
  1527. list_add(&cn->node, &clk_notifier_list);
  1528. }
  1529. ret = srcu_notifier_chain_register(&cn->notifier_head, nb);
  1530. clk->notifier_count++;
  1531. out:
  1532. clk_prepare_unlock();
  1533. return ret;
  1534. }
  1535. EXPORT_SYMBOL_GPL(clk_notifier_register);
  1536. /**
  1537. * clk_notifier_unregister - remove a clk rate change notifier
  1538. * @clk: struct clk *
  1539. * @nb: struct notifier_block * with callback info
  1540. *
  1541. * Request no further notification for changes to 'clk' and frees memory
  1542. * allocated in clk_notifier_register.
  1543. *
  1544. * Returns -EINVAL if called with null arguments; otherwise, passes
  1545. * along the return value of srcu_notifier_chain_unregister().
  1546. */
  1547. int clk_notifier_unregister(struct clk *clk, struct notifier_block *nb)
  1548. {
  1549. struct clk_notifier *cn = NULL;
  1550. int ret = -EINVAL;
  1551. if (!clk || !nb)
  1552. return -EINVAL;
  1553. clk_prepare_lock();
  1554. list_for_each_entry(cn, &clk_notifier_list, node)
  1555. if (cn->clk == clk)
  1556. break;
  1557. if (cn->clk == clk) {
  1558. ret = srcu_notifier_chain_unregister(&cn->notifier_head, nb);
  1559. clk->notifier_count--;
  1560. /* XXX the notifier code should handle this better */
  1561. if (!cn->notifier_head.head) {
  1562. srcu_cleanup_notifier_head(&cn->notifier_head);
  1563. kfree(cn);
  1564. }
  1565. } else {
  1566. ret = -ENOENT;
  1567. }
  1568. clk_prepare_unlock();
  1569. return ret;
  1570. }
  1571. EXPORT_SYMBOL_GPL(clk_notifier_unregister);
  1572. #ifdef CONFIG_OF
  1573. /**
  1574. * struct of_clk_provider - Clock provider registration structure
  1575. * @link: Entry in global list of clock providers
  1576. * @node: Pointer to device tree node of clock provider
  1577. * @get: Get clock callback. Returns NULL or a struct clk for the
  1578. * given clock specifier
  1579. * @data: context pointer to be passed into @get callback
  1580. */
  1581. struct of_clk_provider {
  1582. struct list_head link;
  1583. struct device_node *node;
  1584. struct clk *(*get)(struct of_phandle_args *clkspec, void *data);
  1585. void *data;
  1586. };
  1587. extern struct of_device_id __clk_of_table[];
  1588. static const struct of_device_id __clk_of_table_sentinel
  1589. __used __section(__clk_of_table_end);
  1590. static LIST_HEAD(of_clk_providers);
  1591. static DEFINE_MUTEX(of_clk_lock);
  1592. struct clk *of_clk_src_simple_get(struct of_phandle_args *clkspec,
  1593. void *data)
  1594. {
  1595. return data;
  1596. }
  1597. EXPORT_SYMBOL_GPL(of_clk_src_simple_get);
  1598. struct clk *of_clk_src_onecell_get(struct of_phandle_args *clkspec, void *data)
  1599. {
  1600. struct clk_onecell_data *clk_data = data;
  1601. unsigned int idx = clkspec->args[0];
  1602. if (idx >= clk_data->clk_num) {
  1603. pr_err("%s: invalid clock index %d\n", __func__, idx);
  1604. return ERR_PTR(-EINVAL);
  1605. }
  1606. return clk_data->clks[idx];
  1607. }
  1608. EXPORT_SYMBOL_GPL(of_clk_src_onecell_get);
  1609. /**
  1610. * of_clk_add_provider() - Register a clock provider for a node
  1611. * @np: Device node pointer associated with clock provider
  1612. * @clk_src_get: callback for decoding clock
  1613. * @data: context pointer for @clk_src_get callback.
  1614. */
  1615. int of_clk_add_provider(struct device_node *np,
  1616. struct clk *(*clk_src_get)(struct of_phandle_args *clkspec,
  1617. void *data),
  1618. void *data)
  1619. {
  1620. struct of_clk_provider *cp;
  1621. cp = kzalloc(sizeof(struct of_clk_provider), GFP_KERNEL);
  1622. if (!cp)
  1623. return -ENOMEM;
  1624. cp->node = of_node_get(np);
  1625. cp->data = data;
  1626. cp->get = clk_src_get;
  1627. mutex_lock(&of_clk_lock);
  1628. list_add(&cp->link, &of_clk_providers);
  1629. mutex_unlock(&of_clk_lock);
  1630. pr_debug("Added clock from %s\n", np->full_name);
  1631. return 0;
  1632. }
  1633. EXPORT_SYMBOL_GPL(of_clk_add_provider);
  1634. /**
  1635. * of_clk_del_provider() - Remove a previously registered clock provider
  1636. * @np: Device node pointer associated with clock provider
  1637. */
  1638. void of_clk_del_provider(struct device_node *np)
  1639. {
  1640. struct of_clk_provider *cp;
  1641. mutex_lock(&of_clk_lock);
  1642. list_for_each_entry(cp, &of_clk_providers, link) {
  1643. if (cp->node == np) {
  1644. list_del(&cp->link);
  1645. of_node_put(cp->node);
  1646. kfree(cp);
  1647. break;
  1648. }
  1649. }
  1650. mutex_unlock(&of_clk_lock);
  1651. }
  1652. EXPORT_SYMBOL_GPL(of_clk_del_provider);
  1653. struct clk *of_clk_get_from_provider(struct of_phandle_args *clkspec)
  1654. {
  1655. struct of_clk_provider *provider;
  1656. struct clk *clk = ERR_PTR(-ENOENT);
  1657. /* Check if we have such a provider in our array */
  1658. mutex_lock(&of_clk_lock);
  1659. list_for_each_entry(provider, &of_clk_providers, link) {
  1660. if (provider->node == clkspec->np)
  1661. clk = provider->get(clkspec, provider->data);
  1662. if (!IS_ERR(clk))
  1663. break;
  1664. }
  1665. mutex_unlock(&of_clk_lock);
  1666. return clk;
  1667. }
  1668. const char *of_clk_get_parent_name(struct device_node *np, int index)
  1669. {
  1670. struct of_phandle_args clkspec;
  1671. const char *clk_name;
  1672. int rc;
  1673. if (index < 0)
  1674. return NULL;
  1675. rc = of_parse_phandle_with_args(np, "clocks", "#clock-cells", index,
  1676. &clkspec);
  1677. if (rc)
  1678. return NULL;
  1679. if (of_property_read_string_index(clkspec.np, "clock-output-names",
  1680. clkspec.args_count ? clkspec.args[0] : 0,
  1681. &clk_name) < 0)
  1682. clk_name = clkspec.np->name;
  1683. of_node_put(clkspec.np);
  1684. return clk_name;
  1685. }
  1686. EXPORT_SYMBOL_GPL(of_clk_get_parent_name);
  1687. /**
  1688. * of_clk_init() - Scan and init clock providers from the DT
  1689. * @matches: array of compatible values and init functions for providers.
  1690. *
  1691. * This function scans the device tree for matching clock providers and
  1692. * calls their initialization functions
  1693. */
  1694. void __init of_clk_init(const struct of_device_id *matches)
  1695. {
  1696. struct device_node *np;
  1697. if (!matches)
  1698. matches = __clk_of_table;
  1699. for_each_matching_node(np, matches) {
  1700. const struct of_device_id *match = of_match_node(matches, np);
  1701. of_clk_init_cb_t clk_init_cb = match->data;
  1702. clk_init_cb(np);
  1703. }
  1704. }
  1705. #endif