clk-pll.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648
  1. /*
  2. * Copyright (c) 2013 Samsung Electronics Co., Ltd.
  3. * Copyright (c) 2013 Linaro Ltd.
  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. * This file contains the utility functions to register the pll clocks.
  10. */
  11. #include <linux/errno.h>
  12. #include "clk.h"
  13. #include "clk-pll.h"
  14. struct samsung_clk_pll {
  15. struct clk_hw hw;
  16. void __iomem *lock_reg;
  17. void __iomem *con_reg;
  18. enum samsung_pll_type type;
  19. unsigned int rate_count;
  20. const struct samsung_pll_rate_table *rate_table;
  21. };
  22. #define to_clk_pll(_hw) container_of(_hw, struct samsung_clk_pll, hw)
  23. static const struct samsung_pll_rate_table *samsung_get_pll_settings(
  24. struct samsung_clk_pll *pll, unsigned long rate)
  25. {
  26. const struct samsung_pll_rate_table *rate_table = pll->rate_table;
  27. int i;
  28. for (i = 0; i < pll->rate_count; i++) {
  29. if (rate == rate_table[i].rate)
  30. return &rate_table[i];
  31. }
  32. return NULL;
  33. }
  34. static long samsung_pll_round_rate(struct clk_hw *hw,
  35. unsigned long drate, unsigned long *prate)
  36. {
  37. struct samsung_clk_pll *pll = to_clk_pll(hw);
  38. const struct samsung_pll_rate_table *rate_table = pll->rate_table;
  39. int i;
  40. /* Assumming rate_table is in descending order */
  41. for (i = 0; i < pll->rate_count; i++) {
  42. if (drate >= rate_table[i].rate)
  43. return rate_table[i].rate;
  44. }
  45. /* return minimum supported value */
  46. return rate_table[i - 1].rate;
  47. }
  48. /*
  49. * PLL35xx Clock Type
  50. */
  51. /* Maximum lock time can be 270 * PDIV cycles */
  52. #define PLL35XX_LOCK_FACTOR (270)
  53. #define PLL35XX_MDIV_MASK (0x3FF)
  54. #define PLL35XX_PDIV_MASK (0x3F)
  55. #define PLL35XX_SDIV_MASK (0x7)
  56. #define PLL35XX_LOCK_STAT_MASK (0x1)
  57. #define PLL35XX_MDIV_SHIFT (16)
  58. #define PLL35XX_PDIV_SHIFT (8)
  59. #define PLL35XX_SDIV_SHIFT (0)
  60. #define PLL35XX_LOCK_STAT_SHIFT (29)
  61. static unsigned long samsung_pll35xx_recalc_rate(struct clk_hw *hw,
  62. unsigned long parent_rate)
  63. {
  64. struct samsung_clk_pll *pll = to_clk_pll(hw);
  65. u32 mdiv, pdiv, sdiv, pll_con;
  66. u64 fvco = parent_rate;
  67. pll_con = __raw_readl(pll->con_reg);
  68. mdiv = (pll_con >> PLL35XX_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
  69. pdiv = (pll_con >> PLL35XX_PDIV_SHIFT) & PLL35XX_PDIV_MASK;
  70. sdiv = (pll_con >> PLL35XX_SDIV_SHIFT) & PLL35XX_SDIV_MASK;
  71. fvco *= mdiv;
  72. do_div(fvco, (pdiv << sdiv));
  73. return (unsigned long)fvco;
  74. }
  75. static inline bool samsung_pll35xx_mp_change(
  76. const struct samsung_pll_rate_table *rate, u32 pll_con)
  77. {
  78. u32 old_mdiv, old_pdiv;
  79. old_mdiv = (pll_con >> PLL35XX_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
  80. old_pdiv = (pll_con >> PLL35XX_PDIV_SHIFT) & PLL35XX_PDIV_MASK;
  81. return (rate->mdiv != old_mdiv || rate->pdiv != old_pdiv);
  82. }
  83. static int samsung_pll35xx_set_rate(struct clk_hw *hw, unsigned long drate,
  84. unsigned long prate)
  85. {
  86. struct samsung_clk_pll *pll = to_clk_pll(hw);
  87. const struct samsung_pll_rate_table *rate;
  88. u32 tmp;
  89. /* Get required rate settings from table */
  90. rate = samsung_get_pll_settings(pll, drate);
  91. if (!rate) {
  92. pr_err("%s: Invalid rate : %lu for pll clk %s\n", __func__,
  93. drate, __clk_get_name(hw->clk));
  94. return -EINVAL;
  95. }
  96. tmp = __raw_readl(pll->con_reg);
  97. if (!(samsung_pll35xx_mp_change(rate, tmp))) {
  98. /* If only s change, change just s value only*/
  99. tmp &= ~(PLL35XX_SDIV_MASK << PLL35XX_SDIV_SHIFT);
  100. tmp |= rate->sdiv << PLL35XX_SDIV_SHIFT;
  101. __raw_writel(tmp, pll->con_reg);
  102. return 0;
  103. }
  104. /* Set PLL lock time. */
  105. __raw_writel(rate->pdiv * PLL35XX_LOCK_FACTOR,
  106. pll->lock_reg);
  107. /* Change PLL PMS values */
  108. tmp &= ~((PLL35XX_MDIV_MASK << PLL35XX_MDIV_SHIFT) |
  109. (PLL35XX_PDIV_MASK << PLL35XX_PDIV_SHIFT) |
  110. (PLL35XX_SDIV_MASK << PLL35XX_SDIV_SHIFT));
  111. tmp |= (rate->mdiv << PLL35XX_MDIV_SHIFT) |
  112. (rate->pdiv << PLL35XX_PDIV_SHIFT) |
  113. (rate->sdiv << PLL35XX_SDIV_SHIFT);
  114. __raw_writel(tmp, pll->con_reg);
  115. /* wait_lock_time */
  116. do {
  117. cpu_relax();
  118. tmp = __raw_readl(pll->con_reg);
  119. } while (!(tmp & (PLL35XX_LOCK_STAT_MASK
  120. << PLL35XX_LOCK_STAT_SHIFT)));
  121. return 0;
  122. }
  123. static const struct clk_ops samsung_pll35xx_clk_ops = {
  124. .recalc_rate = samsung_pll35xx_recalc_rate,
  125. .round_rate = samsung_pll_round_rate,
  126. .set_rate = samsung_pll35xx_set_rate,
  127. };
  128. static const struct clk_ops samsung_pll35xx_clk_min_ops = {
  129. .recalc_rate = samsung_pll35xx_recalc_rate,
  130. };
  131. /*
  132. * PLL36xx Clock Type
  133. */
  134. /* Maximum lock time can be 3000 * PDIV cycles */
  135. #define PLL36XX_LOCK_FACTOR (3000)
  136. #define PLL36XX_KDIV_MASK (0xFFFF)
  137. #define PLL36XX_MDIV_MASK (0x1FF)
  138. #define PLL36XX_PDIV_MASK (0x3F)
  139. #define PLL36XX_SDIV_MASK (0x7)
  140. #define PLL36XX_MDIV_SHIFT (16)
  141. #define PLL36XX_PDIV_SHIFT (8)
  142. #define PLL36XX_SDIV_SHIFT (0)
  143. #define PLL36XX_KDIV_SHIFT (0)
  144. #define PLL36XX_LOCK_STAT_SHIFT (29)
  145. static unsigned long samsung_pll36xx_recalc_rate(struct clk_hw *hw,
  146. unsigned long parent_rate)
  147. {
  148. struct samsung_clk_pll *pll = to_clk_pll(hw);
  149. u32 mdiv, pdiv, sdiv, pll_con0, pll_con1;
  150. s16 kdiv;
  151. u64 fvco = parent_rate;
  152. pll_con0 = __raw_readl(pll->con_reg);
  153. pll_con1 = __raw_readl(pll->con_reg + 4);
  154. mdiv = (pll_con0 >> PLL36XX_MDIV_SHIFT) & PLL36XX_MDIV_MASK;
  155. pdiv = (pll_con0 >> PLL36XX_PDIV_SHIFT) & PLL36XX_PDIV_MASK;
  156. sdiv = (pll_con0 >> PLL36XX_SDIV_SHIFT) & PLL36XX_SDIV_MASK;
  157. kdiv = (s16)(pll_con1 & PLL36XX_KDIV_MASK);
  158. fvco *= (mdiv << 16) + kdiv;
  159. do_div(fvco, (pdiv << sdiv));
  160. fvco >>= 16;
  161. return (unsigned long)fvco;
  162. }
  163. static inline bool samsung_pll36xx_mpk_change(
  164. const struct samsung_pll_rate_table *rate, u32 pll_con0, u32 pll_con1)
  165. {
  166. u32 old_mdiv, old_pdiv, old_kdiv;
  167. old_mdiv = (pll_con0 >> PLL36XX_MDIV_SHIFT) & PLL36XX_MDIV_MASK;
  168. old_pdiv = (pll_con0 >> PLL36XX_PDIV_SHIFT) & PLL36XX_PDIV_MASK;
  169. old_kdiv = (pll_con1 >> PLL36XX_KDIV_SHIFT) & PLL36XX_KDIV_MASK;
  170. return (rate->mdiv != old_mdiv || rate->pdiv != old_pdiv ||
  171. rate->kdiv != old_kdiv);
  172. }
  173. static int samsung_pll36xx_set_rate(struct clk_hw *hw, unsigned long drate,
  174. unsigned long parent_rate)
  175. {
  176. struct samsung_clk_pll *pll = to_clk_pll(hw);
  177. u32 tmp, pll_con0, pll_con1;
  178. const struct samsung_pll_rate_table *rate;
  179. rate = samsung_get_pll_settings(pll, drate);
  180. if (!rate) {
  181. pr_err("%s: Invalid rate : %lu for pll clk %s\n", __func__,
  182. drate, __clk_get_name(hw->clk));
  183. return -EINVAL;
  184. }
  185. pll_con0 = __raw_readl(pll->con_reg);
  186. pll_con1 = __raw_readl(pll->con_reg + 4);
  187. if (!(samsung_pll36xx_mpk_change(rate, pll_con0, pll_con1))) {
  188. /* If only s change, change just s value only*/
  189. pll_con0 &= ~(PLL36XX_SDIV_MASK << PLL36XX_SDIV_SHIFT);
  190. pll_con0 |= (rate->sdiv << PLL36XX_SDIV_SHIFT);
  191. __raw_writel(pll_con0, pll->con_reg);
  192. return 0;
  193. }
  194. /* Set PLL lock time. */
  195. __raw_writel(rate->pdiv * PLL36XX_LOCK_FACTOR, pll->lock_reg);
  196. /* Change PLL PMS values */
  197. pll_con0 &= ~((PLL36XX_MDIV_MASK << PLL36XX_MDIV_SHIFT) |
  198. (PLL36XX_PDIV_MASK << PLL36XX_PDIV_SHIFT) |
  199. (PLL36XX_SDIV_MASK << PLL36XX_SDIV_SHIFT));
  200. pll_con0 |= (rate->mdiv << PLL36XX_MDIV_SHIFT) |
  201. (rate->pdiv << PLL36XX_PDIV_SHIFT) |
  202. (rate->sdiv << PLL36XX_SDIV_SHIFT);
  203. __raw_writel(pll_con0, pll->con_reg);
  204. pll_con1 &= ~(PLL36XX_KDIV_MASK << PLL36XX_KDIV_SHIFT);
  205. pll_con1 |= rate->kdiv << PLL36XX_KDIV_SHIFT;
  206. __raw_writel(pll_con1, pll->con_reg + 4);
  207. /* wait_lock_time */
  208. do {
  209. cpu_relax();
  210. tmp = __raw_readl(pll->con_reg);
  211. } while (!(tmp & (1 << PLL36XX_LOCK_STAT_SHIFT)));
  212. return 0;
  213. }
  214. static const struct clk_ops samsung_pll36xx_clk_ops = {
  215. .recalc_rate = samsung_pll36xx_recalc_rate,
  216. .set_rate = samsung_pll36xx_set_rate,
  217. .round_rate = samsung_pll_round_rate,
  218. };
  219. static const struct clk_ops samsung_pll36xx_clk_min_ops = {
  220. .recalc_rate = samsung_pll36xx_recalc_rate,
  221. };
  222. /*
  223. * PLL45xx Clock Type
  224. */
  225. #define PLL45XX_MDIV_MASK (0x3FF)
  226. #define PLL45XX_PDIV_MASK (0x3F)
  227. #define PLL45XX_SDIV_MASK (0x7)
  228. #define PLL45XX_MDIV_SHIFT (16)
  229. #define PLL45XX_PDIV_SHIFT (8)
  230. #define PLL45XX_SDIV_SHIFT (0)
  231. static unsigned long samsung_pll45xx_recalc_rate(struct clk_hw *hw,
  232. unsigned long parent_rate)
  233. {
  234. struct samsung_clk_pll *pll = to_clk_pll(hw);
  235. u32 mdiv, pdiv, sdiv, pll_con;
  236. u64 fvco = parent_rate;
  237. pll_con = __raw_readl(pll->con_reg);
  238. mdiv = (pll_con >> PLL45XX_MDIV_SHIFT) & PLL45XX_MDIV_MASK;
  239. pdiv = (pll_con >> PLL45XX_PDIV_SHIFT) & PLL45XX_PDIV_MASK;
  240. sdiv = (pll_con >> PLL45XX_SDIV_SHIFT) & PLL45XX_SDIV_MASK;
  241. if (pll->type == pll_4508)
  242. sdiv = sdiv - 1;
  243. fvco *= mdiv;
  244. do_div(fvco, (pdiv << sdiv));
  245. return (unsigned long)fvco;
  246. }
  247. static const struct clk_ops samsung_pll45xx_clk_ops = {
  248. .recalc_rate = samsung_pll45xx_recalc_rate,
  249. };
  250. /*
  251. * PLL46xx Clock Type
  252. */
  253. #define PLL46XX_MDIV_MASK (0x1FF)
  254. #define PLL46XX_PDIV_MASK (0x3F)
  255. #define PLL46XX_SDIV_MASK (0x7)
  256. #define PLL46XX_MDIV_SHIFT (16)
  257. #define PLL46XX_PDIV_SHIFT (8)
  258. #define PLL46XX_SDIV_SHIFT (0)
  259. #define PLL46XX_KDIV_MASK (0xFFFF)
  260. #define PLL4650C_KDIV_MASK (0xFFF)
  261. #define PLL46XX_KDIV_SHIFT (0)
  262. struct samsung_clk_pll46xx {
  263. struct clk_hw hw;
  264. enum pll46xx_type type;
  265. const void __iomem *con_reg;
  266. };
  267. #define to_clk_pll46xx(_hw) container_of(_hw, struct samsung_clk_pll46xx, hw)
  268. static unsigned long samsung_pll46xx_recalc_rate(struct clk_hw *hw,
  269. unsigned long parent_rate)
  270. {
  271. struct samsung_clk_pll46xx *pll = to_clk_pll46xx(hw);
  272. u32 mdiv, pdiv, sdiv, kdiv, pll_con0, pll_con1, shift;
  273. u64 fvco = parent_rate;
  274. pll_con0 = __raw_readl(pll->con_reg);
  275. pll_con1 = __raw_readl(pll->con_reg + 4);
  276. mdiv = (pll_con0 >> PLL46XX_MDIV_SHIFT) & PLL46XX_MDIV_MASK;
  277. pdiv = (pll_con0 >> PLL46XX_PDIV_SHIFT) & PLL46XX_PDIV_MASK;
  278. sdiv = (pll_con0 >> PLL46XX_SDIV_SHIFT) & PLL46XX_SDIV_MASK;
  279. kdiv = pll->type == pll_4650c ? pll_con1 & PLL4650C_KDIV_MASK :
  280. pll_con1 & PLL46XX_KDIV_MASK;
  281. shift = pll->type == pll_4600 ? 16 : 10;
  282. fvco *= (mdiv << shift) + kdiv;
  283. do_div(fvco, (pdiv << sdiv));
  284. fvco >>= shift;
  285. return (unsigned long)fvco;
  286. }
  287. static const struct clk_ops samsung_pll46xx_clk_ops = {
  288. .recalc_rate = samsung_pll46xx_recalc_rate,
  289. };
  290. struct clk * __init samsung_clk_register_pll46xx(const char *name,
  291. const char *pname, const void __iomem *con_reg,
  292. enum pll46xx_type type)
  293. {
  294. struct samsung_clk_pll46xx *pll;
  295. struct clk *clk;
  296. struct clk_init_data init;
  297. pll = kzalloc(sizeof(*pll), GFP_KERNEL);
  298. if (!pll) {
  299. pr_err("%s: could not allocate pll clk %s\n", __func__, name);
  300. return NULL;
  301. }
  302. init.name = name;
  303. init.ops = &samsung_pll46xx_clk_ops;
  304. init.flags = CLK_GET_RATE_NOCACHE;
  305. init.parent_names = &pname;
  306. init.num_parents = 1;
  307. pll->hw.init = &init;
  308. pll->con_reg = con_reg;
  309. pll->type = type;
  310. clk = clk_register(NULL, &pll->hw);
  311. if (IS_ERR(clk)) {
  312. pr_err("%s: failed to register pll clock %s\n", __func__,
  313. name);
  314. kfree(pll);
  315. }
  316. if (clk_register_clkdev(clk, name, NULL))
  317. pr_err("%s: failed to register lookup for %s", __func__, name);
  318. return clk;
  319. }
  320. /*
  321. * PLL6552 Clock Type
  322. */
  323. #define PLL6552_MDIV_MASK 0x3ff
  324. #define PLL6552_PDIV_MASK 0x3f
  325. #define PLL6552_SDIV_MASK 0x7
  326. #define PLL6552_MDIV_SHIFT 16
  327. #define PLL6552_PDIV_SHIFT 8
  328. #define PLL6552_SDIV_SHIFT 0
  329. static unsigned long samsung_pll6552_recalc_rate(struct clk_hw *hw,
  330. unsigned long parent_rate)
  331. {
  332. struct samsung_clk_pll *pll = to_clk_pll(hw);
  333. u32 mdiv, pdiv, sdiv, pll_con;
  334. u64 fvco = parent_rate;
  335. pll_con = __raw_readl(pll->con_reg);
  336. mdiv = (pll_con >> PLL6552_MDIV_SHIFT) & PLL6552_MDIV_MASK;
  337. pdiv = (pll_con >> PLL6552_PDIV_SHIFT) & PLL6552_PDIV_MASK;
  338. sdiv = (pll_con >> PLL6552_SDIV_SHIFT) & PLL6552_SDIV_MASK;
  339. fvco *= mdiv;
  340. do_div(fvco, (pdiv << sdiv));
  341. return (unsigned long)fvco;
  342. }
  343. static const struct clk_ops samsung_pll6552_clk_ops = {
  344. .recalc_rate = samsung_pll6552_recalc_rate,
  345. };
  346. /*
  347. * PLL6553 Clock Type
  348. */
  349. #define PLL6553_MDIV_MASK 0xff
  350. #define PLL6553_PDIV_MASK 0x3f
  351. #define PLL6553_SDIV_MASK 0x7
  352. #define PLL6553_KDIV_MASK 0xffff
  353. #define PLL6553_MDIV_SHIFT 16
  354. #define PLL6553_PDIV_SHIFT 8
  355. #define PLL6553_SDIV_SHIFT 0
  356. #define PLL6553_KDIV_SHIFT 0
  357. static unsigned long samsung_pll6553_recalc_rate(struct clk_hw *hw,
  358. unsigned long parent_rate)
  359. {
  360. struct samsung_clk_pll *pll = to_clk_pll(hw);
  361. u32 mdiv, pdiv, sdiv, kdiv, pll_con0, pll_con1;
  362. u64 fvco = parent_rate;
  363. pll_con0 = __raw_readl(pll->con_reg);
  364. pll_con1 = __raw_readl(pll->con_reg + 0x4);
  365. mdiv = (pll_con0 >> PLL6553_MDIV_SHIFT) & PLL6553_MDIV_MASK;
  366. pdiv = (pll_con0 >> PLL6553_PDIV_SHIFT) & PLL6553_PDIV_MASK;
  367. sdiv = (pll_con0 >> PLL6553_SDIV_SHIFT) & PLL6553_SDIV_MASK;
  368. kdiv = (pll_con1 >> PLL6553_KDIV_SHIFT) & PLL6553_KDIV_MASK;
  369. fvco *= (mdiv << 16) + kdiv;
  370. do_div(fvco, (pdiv << sdiv));
  371. fvco >>= 16;
  372. return (unsigned long)fvco;
  373. }
  374. static const struct clk_ops samsung_pll6553_clk_ops = {
  375. .recalc_rate = samsung_pll6553_recalc_rate,
  376. };
  377. /*
  378. * PLL2550x Clock Type
  379. */
  380. #define PLL2550X_R_MASK (0x1)
  381. #define PLL2550X_P_MASK (0x3F)
  382. #define PLL2550X_M_MASK (0x3FF)
  383. #define PLL2550X_S_MASK (0x7)
  384. #define PLL2550X_R_SHIFT (20)
  385. #define PLL2550X_P_SHIFT (14)
  386. #define PLL2550X_M_SHIFT (4)
  387. #define PLL2550X_S_SHIFT (0)
  388. struct samsung_clk_pll2550x {
  389. struct clk_hw hw;
  390. const void __iomem *reg_base;
  391. unsigned long offset;
  392. };
  393. #define to_clk_pll2550x(_hw) container_of(_hw, struct samsung_clk_pll2550x, hw)
  394. static unsigned long samsung_pll2550x_recalc_rate(struct clk_hw *hw,
  395. unsigned long parent_rate)
  396. {
  397. struct samsung_clk_pll2550x *pll = to_clk_pll2550x(hw);
  398. u32 r, p, m, s, pll_stat;
  399. u64 fvco = parent_rate;
  400. pll_stat = __raw_readl(pll->reg_base + pll->offset * 3);
  401. r = (pll_stat >> PLL2550X_R_SHIFT) & PLL2550X_R_MASK;
  402. if (!r)
  403. return 0;
  404. p = (pll_stat >> PLL2550X_P_SHIFT) & PLL2550X_P_MASK;
  405. m = (pll_stat >> PLL2550X_M_SHIFT) & PLL2550X_M_MASK;
  406. s = (pll_stat >> PLL2550X_S_SHIFT) & PLL2550X_S_MASK;
  407. fvco *= m;
  408. do_div(fvco, (p << s));
  409. return (unsigned long)fvco;
  410. }
  411. static const struct clk_ops samsung_pll2550x_clk_ops = {
  412. .recalc_rate = samsung_pll2550x_recalc_rate,
  413. };
  414. struct clk * __init samsung_clk_register_pll2550x(const char *name,
  415. const char *pname, const void __iomem *reg_base,
  416. const unsigned long offset)
  417. {
  418. struct samsung_clk_pll2550x *pll;
  419. struct clk *clk;
  420. struct clk_init_data init;
  421. pll = kzalloc(sizeof(*pll), GFP_KERNEL);
  422. if (!pll) {
  423. pr_err("%s: could not allocate pll clk %s\n", __func__, name);
  424. return NULL;
  425. }
  426. init.name = name;
  427. init.ops = &samsung_pll2550x_clk_ops;
  428. init.flags = CLK_GET_RATE_NOCACHE;
  429. init.parent_names = &pname;
  430. init.num_parents = 1;
  431. pll->hw.init = &init;
  432. pll->reg_base = reg_base;
  433. pll->offset = offset;
  434. clk = clk_register(NULL, &pll->hw);
  435. if (IS_ERR(clk)) {
  436. pr_err("%s: failed to register pll clock %s\n", __func__,
  437. name);
  438. kfree(pll);
  439. }
  440. if (clk_register_clkdev(clk, name, NULL))
  441. pr_err("%s: failed to register lookup for %s", __func__, name);
  442. return clk;
  443. }
  444. static void __init _samsung_clk_register_pll(struct samsung_pll_clock *pll_clk,
  445. void __iomem *base)
  446. {
  447. struct samsung_clk_pll *pll;
  448. struct clk *clk;
  449. struct clk_init_data init;
  450. int ret, len;
  451. pll = kzalloc(sizeof(*pll), GFP_KERNEL);
  452. if (!pll) {
  453. pr_err("%s: could not allocate pll clk %s\n",
  454. __func__, pll_clk->name);
  455. return;
  456. }
  457. init.name = pll_clk->name;
  458. init.flags = pll_clk->flags;
  459. init.parent_names = &pll_clk->parent_name;
  460. init.num_parents = 1;
  461. if (pll_clk->rate_table) {
  462. /* find count of rates in rate_table */
  463. for (len = 0; pll_clk->rate_table[len].rate != 0; )
  464. len++;
  465. pll->rate_count = len;
  466. pll->rate_table = kmemdup(pll_clk->rate_table,
  467. pll->rate_count *
  468. sizeof(struct samsung_pll_rate_table),
  469. GFP_KERNEL);
  470. WARN(!pll->rate_table,
  471. "%s: could not allocate rate table for %s\n",
  472. __func__, pll_clk->name);
  473. }
  474. switch (pll_clk->type) {
  475. /* clk_ops for 35xx and 2550 are similar */
  476. case pll_35xx:
  477. case pll_2550:
  478. if (!pll->rate_table)
  479. init.ops = &samsung_pll35xx_clk_min_ops;
  480. else
  481. init.ops = &samsung_pll35xx_clk_ops;
  482. break;
  483. case pll_4500:
  484. case pll_4502:
  485. case pll_4508:
  486. init.ops = &samsung_pll45xx_clk_ops;
  487. break;
  488. /* clk_ops for 36xx and 2650 are similar */
  489. case pll_36xx:
  490. case pll_2650:
  491. if (!pll->rate_table)
  492. init.ops = &samsung_pll36xx_clk_min_ops;
  493. else
  494. init.ops = &samsung_pll36xx_clk_ops;
  495. break;
  496. case pll_6552:
  497. init.ops = &samsung_pll6552_clk_ops;
  498. break;
  499. case pll_6553:
  500. init.ops = &samsung_pll6553_clk_ops;
  501. break;
  502. default:
  503. pr_warn("%s: Unknown pll type for pll clk %s\n",
  504. __func__, pll_clk->name);
  505. }
  506. pll->hw.init = &init;
  507. pll->type = pll_clk->type;
  508. pll->lock_reg = base + pll_clk->lock_offset;
  509. pll->con_reg = base + pll_clk->con_offset;
  510. clk = clk_register(NULL, &pll->hw);
  511. if (IS_ERR(clk)) {
  512. pr_err("%s: failed to register pll clock %s : %ld\n",
  513. __func__, pll_clk->name, PTR_ERR(clk));
  514. kfree(pll);
  515. return;
  516. }
  517. samsung_clk_add_lookup(clk, pll_clk->id);
  518. if (!pll_clk->alias)
  519. return;
  520. ret = clk_register_clkdev(clk, pll_clk->alias, pll_clk->dev_name);
  521. if (ret)
  522. pr_err("%s: failed to register lookup for %s : %d",
  523. __func__, pll_clk->name, ret);
  524. }
  525. void __init samsung_clk_register_pll(struct samsung_pll_clock *pll_list,
  526. unsigned int nr_pll, void __iomem *base)
  527. {
  528. int cnt;
  529. for (cnt = 0; cnt < nr_pll; cnt++)
  530. _samsung_clk_register_pll(&pll_list[cnt], base);
  531. }