clk_rk3288.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618
  1. /*
  2. * (C) Copyright 2015 Google, Inc
  3. *
  4. * SPDX-License-Identifier: GPL-2.0
  5. */
  6. #include <common.h>
  7. #include <clk.h>
  8. #include <dm.h>
  9. #include <errno.h>
  10. #include <syscon.h>
  11. #include <asm/io.h>
  12. #include <asm/arch/clock.h>
  13. #include <asm/arch/cru_rk3288.h>
  14. #include <asm/arch/grf_rk3288.h>
  15. #include <asm/arch/hardware.h>
  16. #include <asm/arch/periph.h>
  17. #include <dm/lists.h>
  18. DECLARE_GLOBAL_DATA_PTR;
  19. struct rk3288_clk_plat {
  20. enum rk_clk_id clk_id;
  21. };
  22. struct rk3288_clk_priv {
  23. struct rk3288_grf *grf;
  24. struct rk3288_cru *cru;
  25. ulong rate;
  26. };
  27. struct pll_div {
  28. u32 nr;
  29. u32 nf;
  30. u32 no;
  31. };
  32. enum {
  33. VCO_MAX_HZ = 2200U * 1000000,
  34. VCO_MIN_HZ = 440 * 1000000,
  35. OUTPUT_MAX_HZ = 2200U * 1000000,
  36. OUTPUT_MIN_HZ = 27500000,
  37. FREF_MAX_HZ = 2200U * 1000000,
  38. FREF_MIN_HZ = 269 * 1000000,
  39. };
  40. enum {
  41. /* PLL CON0 */
  42. PLL_OD_MASK = 0x0f,
  43. /* PLL CON1 */
  44. PLL_NF_MASK = 0x1fff,
  45. /* PLL CON2 */
  46. PLL_BWADJ_MASK = 0x0fff,
  47. /* PLL CON3 */
  48. PLL_RESET_SHIFT = 5,
  49. /* CLKSEL1: pd bus clk pll sel: codec or general */
  50. PD_BUS_SEL_PLL_MASK = 15,
  51. PD_BUS_SEL_CPLL = 0,
  52. PD_BUS_SEL_GPLL,
  53. /* pd bus pclk div: pclk = pd_bus_aclk /(div + 1) */
  54. PD_BUS_PCLK_DIV_SHIFT = 12,
  55. PD_BUS_PCLK_DIV_MASK = 7,
  56. /* pd bus hclk div: aclk_bus: hclk_bus = 1:1 or 2:1 or 4:1 */
  57. PD_BUS_HCLK_DIV_SHIFT = 8,
  58. PD_BUS_HCLK_DIV_MASK = 3,
  59. /* pd bus aclk div: pd_bus_aclk = pd_bus_src_clk /(div0 * div1) */
  60. PD_BUS_ACLK_DIV0_SHIFT = 3,
  61. PD_BUS_ACLK_DIV0_MASK = 0x1f,
  62. PD_BUS_ACLK_DIV1_SHIFT = 0,
  63. PD_BUS_ACLK_DIV1_MASK = 0x7,
  64. /*
  65. * CLKSEL10
  66. * peripheral bus pclk div:
  67. * aclk_bus: pclk_bus = 1:1 or 2:1 or 4:1 or 8:1
  68. */
  69. PERI_PCLK_DIV_SHIFT = 12,
  70. PERI_PCLK_DIV_MASK = 7,
  71. /* peripheral bus hclk div: aclk_bus: hclk_bus = 1:1 or 2:1 or 4:1 */
  72. PERI_HCLK_DIV_SHIFT = 8,
  73. PERI_HCLK_DIV_MASK = 3,
  74. /*
  75. * peripheral bus aclk div:
  76. * aclk_periph = periph_clk_src / (peri_aclk_div_con + 1)
  77. */
  78. PERI_ACLK_DIV_SHIFT = 0,
  79. PERI_ACLK_DIV_MASK = 0x1f,
  80. /* CLKSEL37 */
  81. DPLL_MODE_MASK = 0x3,
  82. DPLL_MODE_SHIFT = 4,
  83. DPLL_MODE_SLOW = 0,
  84. DPLL_MODE_NORM,
  85. CPLL_MODE_MASK = 3,
  86. CPLL_MODE_SHIFT = 8,
  87. CPLL_MODE_SLOW = 0,
  88. CPLL_MODE_NORM,
  89. GPLL_MODE_MASK = 3,
  90. GPLL_MODE_SHIFT = 12,
  91. GPLL_MODE_SLOW = 0,
  92. GPLL_MODE_NORM,
  93. NPLL_MODE_MASK = 3,
  94. NPLL_MODE_SHIFT = 14,
  95. NPLL_MODE_SLOW = 0,
  96. NPLL_MODE_NORM,
  97. SOCSTS_DPLL_LOCK = 1 << 5,
  98. SOCSTS_APLL_LOCK = 1 << 6,
  99. SOCSTS_CPLL_LOCK = 1 << 7,
  100. SOCSTS_GPLL_LOCK = 1 << 8,
  101. SOCSTS_NPLL_LOCK = 1 << 9,
  102. };
  103. #define RATE_TO_DIV(input_rate, output_rate) \
  104. ((input_rate) / (output_rate) - 1);
  105. #define DIV_TO_RATE(input_rate, div) ((input_rate) / ((div) + 1))
  106. #define PLL_DIVISORS(hz, _nr, _no) {\
  107. .nr = _nr, .nf = (u32)((u64)hz * _nr * _no / OSC_HZ), .no = _no};\
  108. _Static_assert(((u64)hz * _nr * _no / OSC_HZ) * OSC_HZ /\
  109. (_nr * _no) == hz, #hz "Hz cannot be hit with PLL "\
  110. "divisors on line " __stringify(__LINE__));
  111. /* Keep divisors as low as possible to reduce jitter and power usage */
  112. static const struct pll_div apll_init_cfg = PLL_DIVISORS(APLL_HZ, 1, 1);
  113. static const struct pll_div gpll_init_cfg = PLL_DIVISORS(GPLL_HZ, 2, 2);
  114. static const struct pll_div cpll_init_cfg = PLL_DIVISORS(CPLL_HZ, 1, 2);
  115. static int rkclk_set_pll(struct rk3288_cru *cru, enum rk_clk_id clk_id,
  116. const struct pll_div *div)
  117. {
  118. int pll_id = rk_pll_id(clk_id);
  119. struct rk3288_pll *pll = &cru->pll[pll_id];
  120. /* All PLLs have same VCO and output frequency range restrictions. */
  121. uint vco_hz = OSC_HZ / 1000 * div->nf / div->nr * 1000;
  122. uint output_hz = vco_hz / div->no;
  123. debug("PLL at %p: nf=%d, nr=%d, no=%d, vco=%u Hz, output=%u Hz\n",
  124. pll, div->nf, div->nr, div->no, vco_hz, output_hz);
  125. assert(vco_hz >= VCO_MIN_HZ && vco_hz <= VCO_MAX_HZ &&
  126. output_hz >= OUTPUT_MIN_HZ && output_hz <= OUTPUT_MAX_HZ &&
  127. (div->no == 1 || !(div->no % 2)));
  128. /* enter rest */
  129. rk_setreg(&pll->con3, 1 << PLL_RESET_SHIFT);
  130. rk_clrsetreg(&pll->con0,
  131. CLKR_MASK << CLKR_SHIFT | PLL_OD_MASK,
  132. ((div->nr - 1) << CLKR_SHIFT) | (div->no - 1));
  133. rk_clrsetreg(&pll->con1, CLKF_MASK, div->nf - 1);
  134. rk_clrsetreg(&pll->con2, PLL_BWADJ_MASK, (div->nf >> 1) - 1);
  135. udelay(10);
  136. /* return form rest */
  137. rk_clrreg(&pll->con3, 1 << PLL_RESET_SHIFT);
  138. return 0;
  139. }
  140. static inline unsigned int log2(unsigned int value)
  141. {
  142. return fls(value) - 1;
  143. }
  144. static int rkclk_configure_ddr(struct rk3288_cru *cru, struct rk3288_grf *grf,
  145. unsigned int hz)
  146. {
  147. static const struct pll_div dpll_cfg[] = {
  148. {.nf = 25, .nr = 2, .no = 1},
  149. {.nf = 400, .nr = 9, .no = 2},
  150. {.nf = 500, .nr = 9, .no = 2},
  151. {.nf = 100, .nr = 3, .no = 1},
  152. };
  153. int cfg;
  154. debug("%s: cru=%p, grf=%p, hz=%u\n", __func__, cru, grf, hz);
  155. switch (hz) {
  156. case 300000000:
  157. cfg = 0;
  158. break;
  159. case 533000000: /* actually 533.3P MHz */
  160. cfg = 1;
  161. break;
  162. case 666000000: /* actually 666.6P MHz */
  163. cfg = 2;
  164. break;
  165. case 800000000:
  166. cfg = 3;
  167. break;
  168. default:
  169. debug("Unsupported SDRAM frequency, add to clock.c!");
  170. return -EINVAL;
  171. }
  172. /* pll enter slow-mode */
  173. rk_clrsetreg(&cru->cru_mode_con, DPLL_MODE_MASK << DPLL_MODE_SHIFT,
  174. DPLL_MODE_SLOW << DPLL_MODE_SHIFT);
  175. rkclk_set_pll(cru, CLK_DDR, &dpll_cfg[cfg]);
  176. /* wait for pll lock */
  177. while (!(readl(&grf->soc_status[1]) & SOCSTS_DPLL_LOCK))
  178. udelay(1);
  179. /* PLL enter normal-mode */
  180. rk_clrsetreg(&cru->cru_mode_con, DPLL_MODE_MASK << DPLL_MODE_SHIFT,
  181. DPLL_MODE_NORM << DPLL_MODE_SHIFT);
  182. return 0;
  183. }
  184. #ifdef CONFIG_SPL_BUILD
  185. static void rkclk_init(struct rk3288_cru *cru, struct rk3288_grf *grf)
  186. {
  187. u32 aclk_div;
  188. u32 hclk_div;
  189. u32 pclk_div;
  190. /* pll enter slow-mode */
  191. rk_clrsetreg(&cru->cru_mode_con,
  192. GPLL_MODE_MASK << GPLL_MODE_SHIFT |
  193. CPLL_MODE_MASK << CPLL_MODE_SHIFT,
  194. GPLL_MODE_SLOW << GPLL_MODE_SHIFT |
  195. CPLL_MODE_SLOW << CPLL_MODE_SHIFT);
  196. /* init pll */
  197. rkclk_set_pll(cru, CLK_GENERAL, &gpll_init_cfg);
  198. rkclk_set_pll(cru, CLK_CODEC, &cpll_init_cfg);
  199. /* waiting for pll lock */
  200. while ((readl(&grf->soc_status[1]) &
  201. (SOCSTS_CPLL_LOCK | SOCSTS_GPLL_LOCK)) !=
  202. (SOCSTS_CPLL_LOCK | SOCSTS_GPLL_LOCK))
  203. udelay(1);
  204. /*
  205. * pd_bus clock pll source selection and
  206. * set up dependent divisors for PCLK/HCLK and ACLK clocks.
  207. */
  208. aclk_div = GPLL_HZ / PD_BUS_ACLK_HZ - 1;
  209. assert((aclk_div + 1) * PD_BUS_ACLK_HZ == GPLL_HZ && aclk_div < 0x1f);
  210. hclk_div = PD_BUS_ACLK_HZ / PD_BUS_HCLK_HZ - 1;
  211. assert((hclk_div + 1) * PD_BUS_HCLK_HZ ==
  212. PD_BUS_ACLK_HZ && (hclk_div < 0x4) && (hclk_div != 0x2));
  213. pclk_div = PD_BUS_ACLK_HZ / PD_BUS_PCLK_HZ - 1;
  214. assert((pclk_div + 1) * PD_BUS_PCLK_HZ ==
  215. PD_BUS_ACLK_HZ && pclk_div < 0x7);
  216. rk_clrsetreg(&cru->cru_clksel_con[1],
  217. PD_BUS_PCLK_DIV_MASK << PD_BUS_PCLK_DIV_SHIFT |
  218. PD_BUS_HCLK_DIV_MASK << PD_BUS_HCLK_DIV_SHIFT |
  219. PD_BUS_ACLK_DIV0_MASK << PD_BUS_ACLK_DIV0_SHIFT |
  220. PD_BUS_ACLK_DIV1_MASK << PD_BUS_ACLK_DIV1_SHIFT,
  221. pclk_div << PD_BUS_PCLK_DIV_SHIFT |
  222. hclk_div << PD_BUS_HCLK_DIV_SHIFT |
  223. aclk_div << PD_BUS_ACLK_DIV0_SHIFT |
  224. 0 << 0);
  225. /*
  226. * peri clock pll source selection and
  227. * set up dependent divisors for PCLK/HCLK and ACLK clocks.
  228. */
  229. aclk_div = GPLL_HZ / PERI_ACLK_HZ - 1;
  230. assert((aclk_div + 1) * PERI_ACLK_HZ == GPLL_HZ && aclk_div < 0x1f);
  231. hclk_div = log2(PERI_ACLK_HZ / PERI_HCLK_HZ);
  232. assert((1 << hclk_div) * PERI_HCLK_HZ ==
  233. PERI_ACLK_HZ && (hclk_div < 0x4));
  234. pclk_div = log2(PERI_ACLK_HZ / PERI_PCLK_HZ);
  235. assert((1 << pclk_div) * PERI_PCLK_HZ ==
  236. PERI_ACLK_HZ && (pclk_div < 0x4));
  237. rk_clrsetreg(&cru->cru_clksel_con[10],
  238. PERI_PCLK_DIV_MASK << PERI_PCLK_DIV_SHIFT |
  239. PERI_HCLK_DIV_MASK << PERI_HCLK_DIV_SHIFT |
  240. PERI_ACLK_DIV_MASK << PERI_ACLK_DIV_SHIFT,
  241. pclk_div << PERI_PCLK_DIV_SHIFT |
  242. hclk_div << PERI_HCLK_DIV_SHIFT |
  243. aclk_div << PERI_ACLK_DIV_SHIFT);
  244. /* PLL enter normal-mode */
  245. rk_clrsetreg(&cru->cru_mode_con,
  246. GPLL_MODE_MASK << GPLL_MODE_SHIFT |
  247. CPLL_MODE_MASK << CPLL_MODE_SHIFT,
  248. GPLL_MODE_NORM << GPLL_MODE_SHIFT |
  249. GPLL_MODE_NORM << CPLL_MODE_SHIFT);
  250. }
  251. #endif
  252. /* Get pll rate by id */
  253. static uint32_t rkclk_pll_get_rate(struct rk3288_cru *cru,
  254. enum rk_clk_id clk_id)
  255. {
  256. uint32_t nr, no, nf;
  257. uint32_t con;
  258. int pll_id = rk_pll_id(clk_id);
  259. struct rk3288_pll *pll = &cru->pll[pll_id];
  260. static u8 clk_shift[CLK_COUNT] = {
  261. 0xff, APLL_WORK_SHIFT, DPLL_WORK_SHIFT, CPLL_WORK_SHIFT,
  262. GPLL_WORK_SHIFT, NPLL_WORK_SHIFT
  263. };
  264. uint shift;
  265. con = readl(&cru->cru_mode_con);
  266. shift = clk_shift[clk_id];
  267. switch ((con >> shift) & APLL_WORK_MASK) {
  268. case APLL_WORK_SLOW:
  269. return OSC_HZ;
  270. case APLL_WORK_NORMAL:
  271. /* normal mode */
  272. con = readl(&pll->con0);
  273. no = ((con >> CLKOD_SHIFT) & CLKOD_MASK) + 1;
  274. nr = ((con >> CLKR_SHIFT) & CLKR_MASK) + 1;
  275. con = readl(&pll->con1);
  276. nf = ((con >> CLKF_SHIFT) & CLKF_MASK) + 1;
  277. return (24 * nf / (nr * no)) * 1000000;
  278. case APLL_WORK_DEEP:
  279. default:
  280. return 32768;
  281. }
  282. }
  283. static ulong rk3288_clk_get_rate(struct udevice *dev)
  284. {
  285. struct rk3288_clk_plat *plat = dev_get_platdata(dev);
  286. struct rk3288_clk_priv *priv = dev_get_priv(dev);
  287. debug("%s\n", dev->name);
  288. return rkclk_pll_get_rate(priv->cru, plat->clk_id);
  289. }
  290. static ulong rk3288_clk_set_rate(struct udevice *dev, ulong rate)
  291. {
  292. struct rk3288_clk_plat *plat = dev_get_platdata(dev);
  293. struct rk3288_clk_priv *priv = dev_get_priv(dev);
  294. debug("%s\n", dev->name);
  295. switch (plat->clk_id) {
  296. case CLK_DDR:
  297. rkclk_configure_ddr(priv->cru, priv->grf, rate);
  298. break;
  299. default:
  300. return -ENOENT;
  301. }
  302. return 0;
  303. }
  304. static ulong rockchip_mmc_get_clk(struct rk3288_cru *cru, uint clk_general_rate,
  305. enum periph_id periph)
  306. {
  307. uint src_rate;
  308. uint div, mux;
  309. u32 con;
  310. switch (periph) {
  311. case PERIPH_ID_EMMC:
  312. con = readl(&cru->cru_clksel_con[12]);
  313. mux = (con >> EMMC_PLL_SHIFT) & EMMC_PLL_MASK;
  314. div = (con >> EMMC_DIV_SHIFT) & EMMC_DIV_MASK;
  315. break;
  316. case PERIPH_ID_SDCARD:
  317. con = readl(&cru->cru_clksel_con[12]);
  318. mux = (con >> MMC0_PLL_SHIFT) & MMC0_PLL_MASK;
  319. div = (con >> MMC0_DIV_SHIFT) & MMC0_DIV_MASK;
  320. break;
  321. case PERIPH_ID_SDMMC2:
  322. con = readl(&cru->cru_clksel_con[12]);
  323. mux = (con >> SDIO0_PLL_SHIFT) & SDIO0_PLL_MASK;
  324. div = (con >> SDIO0_DIV_SHIFT) & SDIO0_DIV_MASK;
  325. break;
  326. default:
  327. return -EINVAL;
  328. }
  329. src_rate = mux == EMMC_PLL_SELECT_24MHZ ? OSC_HZ : clk_general_rate;
  330. return DIV_TO_RATE(src_rate, div);
  331. }
  332. static ulong rockchip_mmc_set_clk(struct rk3288_cru *cru, uint clk_general_rate,
  333. enum periph_id periph, uint freq)
  334. {
  335. int src_clk_div;
  336. int mux;
  337. debug("%s: clk_general_rate=%u\n", __func__, clk_general_rate);
  338. src_clk_div = RATE_TO_DIV(clk_general_rate, freq);
  339. if (src_clk_div > 0x3f) {
  340. src_clk_div = RATE_TO_DIV(OSC_HZ, freq);
  341. mux = EMMC_PLL_SELECT_24MHZ;
  342. assert((int)EMMC_PLL_SELECT_24MHZ ==
  343. (int)MMC0_PLL_SELECT_24MHZ);
  344. } else {
  345. mux = EMMC_PLL_SELECT_GENERAL;
  346. assert((int)EMMC_PLL_SELECT_GENERAL ==
  347. (int)MMC0_PLL_SELECT_GENERAL);
  348. }
  349. switch (periph) {
  350. case PERIPH_ID_EMMC:
  351. rk_clrsetreg(&cru->cru_clksel_con[12],
  352. EMMC_PLL_MASK << EMMC_PLL_SHIFT |
  353. EMMC_DIV_MASK << EMMC_DIV_SHIFT,
  354. mux << EMMC_PLL_SHIFT |
  355. (src_clk_div - 1) << EMMC_DIV_SHIFT);
  356. break;
  357. case PERIPH_ID_SDCARD:
  358. rk_clrsetreg(&cru->cru_clksel_con[11],
  359. MMC0_PLL_MASK << MMC0_PLL_SHIFT |
  360. MMC0_DIV_MASK << MMC0_DIV_SHIFT,
  361. mux << MMC0_PLL_SHIFT |
  362. (src_clk_div - 1) << MMC0_DIV_SHIFT);
  363. break;
  364. case PERIPH_ID_SDMMC2:
  365. rk_clrsetreg(&cru->cru_clksel_con[12],
  366. SDIO0_PLL_MASK << SDIO0_PLL_SHIFT |
  367. SDIO0_DIV_MASK << SDIO0_DIV_SHIFT,
  368. mux << SDIO0_PLL_SHIFT |
  369. (src_clk_div - 1) << SDIO0_DIV_SHIFT);
  370. break;
  371. default:
  372. return -EINVAL;
  373. }
  374. return rockchip_mmc_get_clk(cru, clk_general_rate, periph);
  375. }
  376. static ulong rockchip_spi_get_clk(struct rk3288_cru *cru, uint clk_general_rate,
  377. enum periph_id periph)
  378. {
  379. uint div, mux;
  380. u32 con;
  381. switch (periph) {
  382. case PERIPH_ID_SPI0:
  383. con = readl(&cru->cru_clksel_con[25]);
  384. mux = (con >> SPI0_PLL_SHIFT) & SPI0_PLL_MASK;
  385. div = (con >> SPI0_DIV_SHIFT) & SPI0_DIV_MASK;
  386. break;
  387. case PERIPH_ID_SPI1:
  388. con = readl(&cru->cru_clksel_con[25]);
  389. mux = (con >> SPI1_PLL_SHIFT) & SPI1_PLL_MASK;
  390. div = (con >> SPI1_DIV_SHIFT) & SPI1_DIV_MASK;
  391. break;
  392. case PERIPH_ID_SPI2:
  393. con = readl(&cru->cru_clksel_con[39]);
  394. mux = (con >> SPI2_PLL_SHIFT) & SPI2_PLL_MASK;
  395. div = (con >> SPI2_DIV_SHIFT) & SPI2_DIV_MASK;
  396. break;
  397. default:
  398. return -EINVAL;
  399. }
  400. assert(mux == SPI0_PLL_SELECT_GENERAL);
  401. return DIV_TO_RATE(clk_general_rate, div);
  402. }
  403. static ulong rockchip_spi_set_clk(struct rk3288_cru *cru, uint clk_general_rate,
  404. enum periph_id periph, uint freq)
  405. {
  406. int src_clk_div;
  407. debug("%s: clk_general_rate=%u\n", __func__, clk_general_rate);
  408. src_clk_div = RATE_TO_DIV(clk_general_rate, freq);
  409. switch (periph) {
  410. case PERIPH_ID_SPI0:
  411. rk_clrsetreg(&cru->cru_clksel_con[25],
  412. SPI0_PLL_MASK << SPI0_PLL_SHIFT |
  413. SPI0_DIV_MASK << SPI0_DIV_SHIFT,
  414. SPI0_PLL_SELECT_GENERAL << SPI0_PLL_SHIFT |
  415. src_clk_div << SPI0_DIV_SHIFT);
  416. break;
  417. case PERIPH_ID_SPI1:
  418. rk_clrsetreg(&cru->cru_clksel_con[25],
  419. SPI1_PLL_MASK << SPI1_PLL_SHIFT |
  420. SPI1_DIV_MASK << SPI1_DIV_SHIFT,
  421. SPI1_PLL_SELECT_GENERAL << SPI1_PLL_SHIFT |
  422. src_clk_div << SPI1_DIV_SHIFT);
  423. break;
  424. case PERIPH_ID_SPI2:
  425. rk_clrsetreg(&cru->cru_clksel_con[39],
  426. SPI2_PLL_MASK << SPI2_PLL_SHIFT |
  427. SPI2_DIV_MASK << SPI2_DIV_SHIFT,
  428. SPI2_PLL_SELECT_GENERAL << SPI2_PLL_SHIFT |
  429. src_clk_div << SPI2_DIV_SHIFT);
  430. break;
  431. default:
  432. return -EINVAL;
  433. }
  434. return rockchip_spi_get_clk(cru, clk_general_rate, periph);
  435. }
  436. static ulong rk3288_set_periph_rate(struct udevice *dev, int periph, ulong rate)
  437. {
  438. struct rk3288_clk_priv *priv = dev_get_priv(dev);
  439. ulong new_rate;
  440. switch (periph) {
  441. case PERIPH_ID_EMMC:
  442. case PERIPH_ID_SDCARD:
  443. new_rate = rockchip_mmc_set_clk(priv->cru, clk_get_rate(dev),
  444. periph, rate);
  445. break;
  446. case PERIPH_ID_SPI0:
  447. case PERIPH_ID_SPI1:
  448. case PERIPH_ID_SPI2:
  449. new_rate = rockchip_spi_set_clk(priv->cru, clk_get_rate(dev),
  450. periph, rate);
  451. break;
  452. default:
  453. return -ENOENT;
  454. }
  455. return new_rate;
  456. }
  457. static struct clk_ops rk3288_clk_ops = {
  458. .get_rate = rk3288_clk_get_rate,
  459. .set_rate = rk3288_clk_set_rate,
  460. .set_periph_rate = rk3288_set_periph_rate,
  461. };
  462. static int rk3288_clk_probe(struct udevice *dev)
  463. {
  464. struct rk3288_clk_plat *plat = dev_get_platdata(dev);
  465. struct rk3288_clk_priv *priv = dev_get_priv(dev);
  466. if (plat->clk_id != CLK_OSC) {
  467. struct rk3288_clk_priv *parent_priv = dev_get_priv(dev->parent);
  468. priv->cru = parent_priv->cru;
  469. priv->grf = parent_priv->grf;
  470. return 0;
  471. }
  472. priv->cru = (struct rk3288_cru *)dev_get_addr(dev);
  473. priv->grf = syscon_get_first_range(ROCKCHIP_SYSCON_GRF);
  474. #ifdef CONFIG_SPL_BUILD
  475. rkclk_init(priv->cru, priv->grf);
  476. #endif
  477. return 0;
  478. }
  479. static const char *const clk_name[CLK_COUNT] = {
  480. "osc",
  481. "apll",
  482. "dpll",
  483. "cpll",
  484. "gpll",
  485. "mpll",
  486. };
  487. static int rk3288_clk_bind(struct udevice *dev)
  488. {
  489. struct rk3288_clk_plat *plat = dev_get_platdata(dev);
  490. int pll, ret;
  491. /* We only need to set up the root clock */
  492. if (dev->of_offset == -1) {
  493. plat->clk_id = CLK_OSC;
  494. return 0;
  495. }
  496. /* Create devices for P main clocks */
  497. for (pll = 1; pll < CLK_COUNT; pll++) {
  498. struct udevice *child;
  499. struct rk3288_clk_plat *cplat;
  500. debug("%s %s\n", __func__, clk_name[pll]);
  501. ret = device_bind_driver(dev, "clk_rk3288", clk_name[pll],
  502. &child);
  503. if (ret)
  504. return ret;
  505. cplat = dev_get_platdata(child);
  506. cplat->clk_id = pll;
  507. }
  508. /* The reset driver does not have a device node, so bind it here */
  509. ret = device_bind_driver(gd->dm_root, "rk3288_reset", "reset", &dev);
  510. if (ret)
  511. debug("Warning: No RK3288 reset driver: ret=%d\n", ret);
  512. return 0;
  513. }
  514. static const struct udevice_id rk3288_clk_ids[] = {
  515. { .compatible = "rockchip,rk3288-cru" },
  516. { }
  517. };
  518. U_BOOT_DRIVER(clk_rk3288) = {
  519. .name = "clk_rk3288",
  520. .id = UCLASS_CLK,
  521. .of_match = rk3288_clk_ids,
  522. .priv_auto_alloc_size = sizeof(struct rk3288_clk_priv),
  523. .platdata_auto_alloc_size = sizeof(struct rk3288_clk_plat),
  524. .ops = &rk3288_clk_ops,
  525. .bind = rk3288_clk_bind,
  526. .probe = rk3288_clk_probe,
  527. };