clock.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589
  1. /*
  2. * Copyright (c) 2010-2014, NVIDIA CORPORATION. All rights reserved.
  3. *
  4. * This program is free software; you can redistribute it and/or modify it
  5. * under the terms and conditions of the GNU General Public License,
  6. * version 2, as published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope it will be useful, but WITHOUT
  9. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  10. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  11. * more details.
  12. *
  13. * You should have received a copy of the GNU General Public License
  14. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  15. */
  16. /* Tegra30 Clock control functions */
  17. #include <common.h>
  18. #include <asm/io.h>
  19. #include <asm/arch/clock.h>
  20. #include <asm/arch/tegra.h>
  21. #include <asm/arch-tegra/clk_rst.h>
  22. #include <asm/arch-tegra/timer.h>
  23. #include <div64.h>
  24. #include <fdtdec.h>
  25. /*
  26. * Clock types that we can use as a source. The Tegra30 has muxes for the
  27. * peripheral clocks, and in most cases there are four options for the clock
  28. * source. This gives us a clock 'type' and exploits what commonality exists
  29. * in the device.
  30. *
  31. * Letters are obvious, except for T which means CLK_M, and S which means the
  32. * clock derived from 32KHz. Beware that CLK_M (also called OSC in the
  33. * datasheet) and PLL_M are different things. The former is the basic
  34. * clock supplied to the SOC from an external oscillator. The latter is the
  35. * memory clock PLL.
  36. *
  37. * See definitions in clock_id in the header file.
  38. */
  39. enum clock_type_id {
  40. CLOCK_TYPE_AXPT, /* PLL_A, PLL_X, PLL_P, CLK_M */
  41. CLOCK_TYPE_MCPA, /* and so on */
  42. CLOCK_TYPE_MCPT,
  43. CLOCK_TYPE_PCM,
  44. CLOCK_TYPE_PCMT,
  45. CLOCK_TYPE_PCMT16,
  46. CLOCK_TYPE_PDCT,
  47. CLOCK_TYPE_ACPT,
  48. CLOCK_TYPE_ASPTE,
  49. CLOCK_TYPE_PMDACD2T,
  50. CLOCK_TYPE_PCST,
  51. CLOCK_TYPE_COUNT,
  52. CLOCK_TYPE_NONE = -1, /* invalid clock type */
  53. };
  54. enum {
  55. CLOCK_MAX_MUX = 8 /* number of source options for each clock */
  56. };
  57. /*
  58. * Clock source mux for each clock type. This just converts our enum into
  59. * a list of mux sources for use by the code.
  60. *
  61. * Note:
  62. * The extra column in each clock source array is used to store the mask
  63. * bits in its register for the source.
  64. */
  65. #define CLK(x) CLOCK_ID_ ## x
  66. static enum clock_id clock_source[CLOCK_TYPE_COUNT][CLOCK_MAX_MUX+1] = {
  67. { CLK(AUDIO), CLK(XCPU), CLK(PERIPH), CLK(OSC),
  68. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  69. MASK_BITS_31_30},
  70. { CLK(MEMORY), CLK(CGENERAL), CLK(PERIPH), CLK(AUDIO),
  71. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  72. MASK_BITS_31_30},
  73. { CLK(MEMORY), CLK(CGENERAL), CLK(PERIPH), CLK(OSC),
  74. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  75. MASK_BITS_31_30},
  76. { CLK(PERIPH), CLK(CGENERAL), CLK(MEMORY), CLK(NONE),
  77. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  78. MASK_BITS_31_30},
  79. { CLK(PERIPH), CLK(CGENERAL), CLK(MEMORY), CLK(OSC),
  80. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  81. MASK_BITS_31_30},
  82. { CLK(PERIPH), CLK(CGENERAL), CLK(MEMORY), CLK(OSC),
  83. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  84. MASK_BITS_31_30},
  85. { CLK(PERIPH), CLK(DISPLAY), CLK(CGENERAL), CLK(OSC),
  86. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  87. MASK_BITS_31_30},
  88. { CLK(AUDIO), CLK(CGENERAL), CLK(PERIPH), CLK(OSC),
  89. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  90. MASK_BITS_31_30},
  91. { CLK(AUDIO), CLK(SFROM32KHZ), CLK(PERIPH), CLK(OSC),
  92. CLK(EPCI), CLK(NONE), CLK(NONE), CLK(NONE),
  93. MASK_BITS_31_29},
  94. { CLK(PERIPH), CLK(MEMORY), CLK(DISPLAY), CLK(AUDIO),
  95. CLK(CGENERAL), CLK(DISPLAY2), CLK(OSC), CLK(NONE),
  96. MASK_BITS_31_29},
  97. { CLK(PERIPH), CLK(CGENERAL), CLK(SFROM32KHZ), CLK(OSC),
  98. CLK(NONE), CLK(NONE), CLK(NONE), CLK(NONE),
  99. MASK_BITS_31_28}
  100. };
  101. /*
  102. * Clock type for each peripheral clock source. We put the name in each
  103. * record just so it is easy to match things up
  104. */
  105. #define TYPE(name, type) type
  106. static enum clock_type_id clock_periph_type[PERIPHC_COUNT] = {
  107. /* 0x00 */
  108. TYPE(PERIPHC_I2S1, CLOCK_TYPE_AXPT),
  109. TYPE(PERIPHC_I2S2, CLOCK_TYPE_AXPT),
  110. TYPE(PERIPHC_SPDIF_OUT, CLOCK_TYPE_AXPT),
  111. TYPE(PERIPHC_SPDIF_IN, CLOCK_TYPE_PCM),
  112. TYPE(PERIPHC_PWM, CLOCK_TYPE_PCST), /* only PWM uses b29:28 */
  113. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  114. TYPE(PERIPHC_SBC2, CLOCK_TYPE_PCMT),
  115. TYPE(PERIPHC_SBC3, CLOCK_TYPE_PCMT),
  116. /* 0x08 */
  117. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  118. TYPE(PERIPHC_I2C1, CLOCK_TYPE_PCMT16),
  119. TYPE(PERIPHC_DVC_I2C, CLOCK_TYPE_PCMT16),
  120. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  121. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  122. TYPE(PERIPHC_SBC1, CLOCK_TYPE_PCMT),
  123. TYPE(PERIPHC_DISP1, CLOCK_TYPE_PMDACD2T),
  124. TYPE(PERIPHC_DISP2, CLOCK_TYPE_PMDACD2T),
  125. /* 0x10 */
  126. TYPE(PERIPHC_CVE, CLOCK_TYPE_PDCT),
  127. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  128. TYPE(PERIPHC_VI, CLOCK_TYPE_MCPA),
  129. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  130. TYPE(PERIPHC_SDMMC1, CLOCK_TYPE_PCMT),
  131. TYPE(PERIPHC_SDMMC2, CLOCK_TYPE_PCMT),
  132. TYPE(PERIPHC_G3D, CLOCK_TYPE_MCPA),
  133. TYPE(PERIPHC_G2D, CLOCK_TYPE_MCPA),
  134. /* 0x18 */
  135. TYPE(PERIPHC_NDFLASH, CLOCK_TYPE_PCMT),
  136. TYPE(PERIPHC_SDMMC4, CLOCK_TYPE_PCMT),
  137. TYPE(PERIPHC_VFIR, CLOCK_TYPE_PCMT),
  138. TYPE(PERIPHC_EPP, CLOCK_TYPE_MCPA),
  139. TYPE(PERIPHC_MPE, CLOCK_TYPE_MCPA),
  140. TYPE(PERIPHC_MIPI, CLOCK_TYPE_PCMT), /* MIPI base-band HSI */
  141. TYPE(PERIPHC_UART1, CLOCK_TYPE_PCMT),
  142. TYPE(PERIPHC_UART2, CLOCK_TYPE_PCMT),
  143. /* 0x20 */
  144. TYPE(PERIPHC_HOST1X, CLOCK_TYPE_MCPA),
  145. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  146. TYPE(PERIPHC_TVO, CLOCK_TYPE_PDCT),
  147. TYPE(PERIPHC_HDMI, CLOCK_TYPE_PMDACD2T),
  148. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  149. TYPE(PERIPHC_TVDAC, CLOCK_TYPE_PDCT),
  150. TYPE(PERIPHC_I2C2, CLOCK_TYPE_PCMT16),
  151. TYPE(PERIPHC_EMC, CLOCK_TYPE_MCPT),
  152. /* 0x28 */
  153. TYPE(PERIPHC_UART3, CLOCK_TYPE_PCMT),
  154. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  155. TYPE(PERIPHC_VI, CLOCK_TYPE_MCPA),
  156. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  157. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  158. TYPE(PERIPHC_SBC4, CLOCK_TYPE_PCMT),
  159. TYPE(PERIPHC_I2C3, CLOCK_TYPE_PCMT16),
  160. TYPE(PERIPHC_SDMMC3, CLOCK_TYPE_PCMT),
  161. /* 0x30 */
  162. TYPE(PERIPHC_UART4, CLOCK_TYPE_PCMT),
  163. TYPE(PERIPHC_UART5, CLOCK_TYPE_PCMT),
  164. TYPE(PERIPHC_VDE, CLOCK_TYPE_PCMT),
  165. TYPE(PERIPHC_OWR, CLOCK_TYPE_PCMT),
  166. TYPE(PERIPHC_NOR, CLOCK_TYPE_PCMT),
  167. TYPE(PERIPHC_CSITE, CLOCK_TYPE_PCMT),
  168. TYPE(PERIPHC_I2S0, CLOCK_TYPE_AXPT),
  169. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  170. /* 0x38h */ /* Jumps to reg offset 0x3B0h - new for T30 */
  171. TYPE(PERIPHC_G3D2, CLOCK_TYPE_MCPA),
  172. TYPE(PERIPHC_MSELECT, CLOCK_TYPE_PCMT),
  173. TYPE(PERIPHC_TSENSOR, CLOCK_TYPE_PCST), /* s/b PCTS */
  174. TYPE(PERIPHC_I2S3, CLOCK_TYPE_AXPT),
  175. TYPE(PERIPHC_I2S4, CLOCK_TYPE_AXPT),
  176. TYPE(PERIPHC_I2C4, CLOCK_TYPE_PCMT16),
  177. TYPE(PERIPHC_SBC5, CLOCK_TYPE_PCMT),
  178. TYPE(PERIPHC_SBC6, CLOCK_TYPE_PCMT),
  179. /* 0x40 */
  180. TYPE(PERIPHC_AUDIO, CLOCK_TYPE_ACPT),
  181. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  182. TYPE(PERIPHC_DAM0, CLOCK_TYPE_ACPT),
  183. TYPE(PERIPHC_DAM1, CLOCK_TYPE_ACPT),
  184. TYPE(PERIPHC_DAM2, CLOCK_TYPE_ACPT),
  185. TYPE(PERIPHC_HDA2CODEC2X, CLOCK_TYPE_PCMT),
  186. TYPE(PERIPHC_ACTMON, CLOCK_TYPE_PCST), /* MASK 31:30 */
  187. TYPE(PERIPHC_EXTPERIPH1, CLOCK_TYPE_ASPTE),
  188. /* 0x48 */
  189. TYPE(PERIPHC_EXTPERIPH2, CLOCK_TYPE_ASPTE),
  190. TYPE(PERIPHC_EXTPERIPH3, CLOCK_TYPE_ASPTE),
  191. TYPE(PERIPHC_NANDSPEED, CLOCK_TYPE_PCMT),
  192. TYPE(PERIPHC_I2CSLOW, CLOCK_TYPE_PCST), /* MASK 31:30 */
  193. TYPE(PERIPHC_SYS, CLOCK_TYPE_NONE),
  194. TYPE(PERIPHC_SPEEDO, CLOCK_TYPE_PCMT),
  195. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  196. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  197. /* 0x50 */
  198. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  199. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  200. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  201. TYPE(PERIPHC_NONE, CLOCK_TYPE_NONE),
  202. TYPE(PERIPHC_SATAOOB, CLOCK_TYPE_PCMT), /* offset 0x420h */
  203. TYPE(PERIPHC_SATA, CLOCK_TYPE_PCMT),
  204. TYPE(PERIPHC_HDA, CLOCK_TYPE_PCMT),
  205. };
  206. /*
  207. * This array translates a periph_id to a periphc_internal_id
  208. *
  209. * Not present/matched up:
  210. * uint vi_sensor; _VI_SENSOR_0, 0x1A8
  211. * SPDIF - which is both 0x08 and 0x0c
  212. *
  213. */
  214. #define NONE(name) (-1)
  215. #define OFFSET(name, value) PERIPHC_ ## name
  216. static s8 periph_id_to_internal_id[PERIPH_ID_COUNT] = {
  217. /* Low word: 31:0 */
  218. NONE(CPU),
  219. NONE(COP),
  220. NONE(TRIGSYS),
  221. NONE(RESERVED3),
  222. NONE(RESERVED4),
  223. NONE(TMR),
  224. PERIPHC_UART1,
  225. PERIPHC_UART2, /* and vfir 0x68 */
  226. /* 8 */
  227. NONE(GPIO),
  228. PERIPHC_SDMMC2,
  229. NONE(SPDIF), /* 0x08 and 0x0c, unclear which to use */
  230. PERIPHC_I2S1,
  231. PERIPHC_I2C1,
  232. PERIPHC_NDFLASH,
  233. PERIPHC_SDMMC1,
  234. PERIPHC_SDMMC4,
  235. /* 16 */
  236. NONE(RESERVED16),
  237. PERIPHC_PWM,
  238. PERIPHC_I2S2,
  239. PERIPHC_EPP,
  240. PERIPHC_VI,
  241. PERIPHC_G2D,
  242. NONE(USBD),
  243. NONE(ISP),
  244. /* 24 */
  245. PERIPHC_G3D,
  246. NONE(RESERVED25),
  247. PERIPHC_DISP2,
  248. PERIPHC_DISP1,
  249. PERIPHC_HOST1X,
  250. NONE(VCP),
  251. PERIPHC_I2S0,
  252. NONE(CACHE2),
  253. /* Middle word: 63:32 */
  254. NONE(MEM),
  255. NONE(AHBDMA),
  256. NONE(APBDMA),
  257. NONE(RESERVED35),
  258. NONE(RESERVED36),
  259. NONE(STAT_MON),
  260. NONE(RESERVED38),
  261. NONE(RESERVED39),
  262. /* 40 */
  263. NONE(KFUSE),
  264. PERIPHC_SBC1,
  265. PERIPHC_NOR,
  266. NONE(RESERVED43),
  267. PERIPHC_SBC2,
  268. NONE(RESERVED45),
  269. PERIPHC_SBC3,
  270. PERIPHC_DVC_I2C,
  271. /* 48 */
  272. NONE(DSI),
  273. PERIPHC_TVO, /* also CVE 0x40 */
  274. PERIPHC_MIPI,
  275. PERIPHC_HDMI,
  276. NONE(CSI),
  277. PERIPHC_TVDAC,
  278. PERIPHC_I2C2,
  279. PERIPHC_UART3,
  280. /* 56 */
  281. NONE(RESERVED56),
  282. PERIPHC_EMC,
  283. NONE(USB2),
  284. NONE(USB3),
  285. PERIPHC_MPE,
  286. PERIPHC_VDE,
  287. NONE(BSEA),
  288. NONE(BSEV),
  289. /* Upper word 95:64 */
  290. PERIPHC_SPEEDO,
  291. PERIPHC_UART4,
  292. PERIPHC_UART5,
  293. PERIPHC_I2C3,
  294. PERIPHC_SBC4,
  295. PERIPHC_SDMMC3,
  296. NONE(PCIE),
  297. PERIPHC_OWR,
  298. /* 72 */
  299. NONE(AFI),
  300. PERIPHC_CSITE,
  301. NONE(PCIEXCLK),
  302. NONE(AVPUCQ),
  303. NONE(RESERVED76),
  304. NONE(RESERVED77),
  305. NONE(RESERVED78),
  306. NONE(DTV),
  307. /* 80 */
  308. PERIPHC_NANDSPEED,
  309. PERIPHC_I2CSLOW,
  310. NONE(DSIB),
  311. NONE(RESERVED83),
  312. NONE(IRAMA),
  313. NONE(IRAMB),
  314. NONE(IRAMC),
  315. NONE(IRAMD),
  316. /* 88 */
  317. NONE(CRAM2),
  318. NONE(RESERVED89),
  319. NONE(MDOUBLER),
  320. NONE(RESERVED91),
  321. NONE(SUSOUT),
  322. NONE(RESERVED93),
  323. NONE(RESERVED94),
  324. NONE(RESERVED95),
  325. /* V word: 31:0 */
  326. NONE(CPUG),
  327. NONE(CPULP),
  328. PERIPHC_G3D2,
  329. PERIPHC_MSELECT,
  330. PERIPHC_TSENSOR,
  331. PERIPHC_I2S3,
  332. PERIPHC_I2S4,
  333. PERIPHC_I2C4,
  334. /* 08 */
  335. PERIPHC_SBC5,
  336. PERIPHC_SBC6,
  337. PERIPHC_AUDIO,
  338. NONE(APBIF),
  339. PERIPHC_DAM0,
  340. PERIPHC_DAM1,
  341. PERIPHC_DAM2,
  342. PERIPHC_HDA2CODEC2X,
  343. /* 16 */
  344. NONE(ATOMICS),
  345. NONE(RESERVED17),
  346. NONE(RESERVED18),
  347. NONE(RESERVED19),
  348. NONE(RESERVED20),
  349. NONE(RESERVED21),
  350. NONE(RESERVED22),
  351. PERIPHC_ACTMON,
  352. /* 24 */
  353. NONE(RESERVED24),
  354. NONE(RESERVED25),
  355. NONE(RESERVED26),
  356. NONE(RESERVED27),
  357. PERIPHC_SATA,
  358. PERIPHC_HDA,
  359. NONE(RESERVED30),
  360. NONE(RESERVED31),
  361. /* W word: 31:0 */
  362. NONE(HDA2HDMICODEC),
  363. NONE(SATACOLD),
  364. NONE(RESERVED0_PCIERX0),
  365. NONE(RESERVED1_PCIERX1),
  366. NONE(RESERVED2_PCIERX2),
  367. NONE(RESERVED3_PCIERX3),
  368. NONE(RESERVED4_PCIERX4),
  369. NONE(RESERVED5_PCIERX5),
  370. /* 40 */
  371. NONE(CEC),
  372. NONE(RESERVED6_PCIE2),
  373. NONE(RESERVED7_EMC),
  374. NONE(RESERVED8_HDMI),
  375. NONE(RESERVED9_SATA),
  376. NONE(RESERVED10_MIPI),
  377. NONE(EX_RESERVED46),
  378. NONE(EX_RESERVED47),
  379. };
  380. /*
  381. * Get the oscillator frequency, from the corresponding hardware configuration
  382. * field. Note that T30 supports 3 new higher freqs, but we map back
  383. * to the old T20 freqs. Support for the higher oscillators is TBD.
  384. */
  385. enum clock_osc_freq clock_get_osc_freq(void)
  386. {
  387. struct clk_rst_ctlr *clkrst =
  388. (struct clk_rst_ctlr *)NV_PA_CLK_RST_BASE;
  389. u32 reg;
  390. reg = readl(&clkrst->crc_osc_ctrl);
  391. reg = (reg & OSC_FREQ_MASK) >> OSC_FREQ_SHIFT;
  392. if (reg & 1) /* one of the newer freqs */
  393. printf("Warning: OSC_FREQ is unsupported! (%d)\n", reg);
  394. return reg >> 2; /* Map to most common (T20) freqs */
  395. }
  396. /* Returns a pointer to the clock source register for a peripheral */
  397. u32 *get_periph_source_reg(enum periph_id periph_id)
  398. {
  399. struct clk_rst_ctlr *clkrst =
  400. (struct clk_rst_ctlr *)NV_PA_CLK_RST_BASE;
  401. enum periphc_internal_id internal_id;
  402. /* Coresight is a special case */
  403. if (periph_id == PERIPH_ID_CSI)
  404. return &clkrst->crc_clk_src[PERIPH_ID_CSI+1];
  405. assert(periph_id >= PERIPH_ID_FIRST && periph_id < PERIPH_ID_COUNT);
  406. internal_id = periph_id_to_internal_id[periph_id];
  407. assert(internal_id != -1);
  408. if (internal_id >= PERIPHC_VW_FIRST) {
  409. internal_id -= PERIPHC_VW_FIRST;
  410. return &clkrst->crc_clk_src_vw[internal_id];
  411. } else
  412. return &clkrst->crc_clk_src[internal_id];
  413. }
  414. /**
  415. * Given a peripheral ID and the required source clock, this returns which
  416. * value should be programmed into the source mux for that peripheral.
  417. *
  418. * There is special code here to handle the one source type with 5 sources.
  419. *
  420. * @param periph_id peripheral to start
  421. * @param source PLL id of required parent clock
  422. * @param mux_bits Set to number of bits in mux register: 2 or 4
  423. * @param divider_bits Set to number of divider bits (8 or 16)
  424. * @return mux value (0-4, or -1 if not found)
  425. */
  426. int get_periph_clock_source(enum periph_id periph_id,
  427. enum clock_id parent, int *mux_bits, int *divider_bits)
  428. {
  429. enum clock_type_id type;
  430. enum periphc_internal_id internal_id;
  431. int mux;
  432. assert(clock_periph_id_isvalid(periph_id));
  433. internal_id = periph_id_to_internal_id[periph_id];
  434. assert(periphc_internal_id_isvalid(internal_id));
  435. type = clock_periph_type[internal_id];
  436. assert(clock_type_id_isvalid(type));
  437. *mux_bits = clock_source[type][CLOCK_MAX_MUX];
  438. if (type == CLOCK_TYPE_PCMT16)
  439. *divider_bits = 16;
  440. else
  441. *divider_bits = 8;
  442. for (mux = 0; mux < CLOCK_MAX_MUX; mux++)
  443. if (clock_source[type][mux] == parent)
  444. return mux;
  445. /* if we get here, either us or the caller has made a mistake */
  446. printf("Caller requested bad clock: periph=%d, parent=%d\n", periph_id,
  447. parent);
  448. return -1;
  449. }
  450. void clock_set_enable(enum periph_id periph_id, int enable)
  451. {
  452. struct clk_rst_ctlr *clkrst =
  453. (struct clk_rst_ctlr *)NV_PA_CLK_RST_BASE;
  454. u32 *clk;
  455. u32 reg;
  456. /* Enable/disable the clock to this peripheral */
  457. assert(clock_periph_id_isvalid(periph_id));
  458. if ((int)periph_id < (int)PERIPH_ID_VW_FIRST)
  459. clk = &clkrst->crc_clk_out_enb[PERIPH_REG(periph_id)];
  460. else
  461. clk = &clkrst->crc_clk_out_enb_vw[PERIPH_REG(periph_id)];
  462. reg = readl(clk);
  463. if (enable)
  464. reg |= PERIPH_MASK(periph_id);
  465. else
  466. reg &= ~PERIPH_MASK(periph_id);
  467. writel(reg, clk);
  468. }
  469. void reset_set_enable(enum periph_id periph_id, int enable)
  470. {
  471. struct clk_rst_ctlr *clkrst =
  472. (struct clk_rst_ctlr *)NV_PA_CLK_RST_BASE;
  473. u32 *reset;
  474. u32 reg;
  475. /* Enable/disable reset to the peripheral */
  476. assert(clock_periph_id_isvalid(periph_id));
  477. if (periph_id < PERIPH_ID_VW_FIRST)
  478. reset = &clkrst->crc_rst_dev[PERIPH_REG(periph_id)];
  479. else
  480. reset = &clkrst->crc_rst_dev_vw[PERIPH_REG(periph_id)];
  481. reg = readl(reset);
  482. if (enable)
  483. reg |= PERIPH_MASK(periph_id);
  484. else
  485. reg &= ~PERIPH_MASK(periph_id);
  486. writel(reg, reset);
  487. }
  488. #ifdef CONFIG_OF_CONTROL
  489. /*
  490. * Convert a device tree clock ID to our peripheral ID. They are mostly
  491. * the same but we are very cautious so we check that a valid clock ID is
  492. * provided.
  493. *
  494. * @param clk_id Clock ID according to tegra30 device tree binding
  495. * @return peripheral ID, or PERIPH_ID_NONE if the clock ID is invalid
  496. */
  497. enum periph_id clk_id_to_periph_id(int clk_id)
  498. {
  499. if (clk_id > PERIPH_ID_COUNT)
  500. return PERIPH_ID_NONE;
  501. switch (clk_id) {
  502. case PERIPH_ID_RESERVED3:
  503. case PERIPH_ID_RESERVED4:
  504. case PERIPH_ID_RESERVED16:
  505. case PERIPH_ID_RESERVED24:
  506. case PERIPH_ID_RESERVED35:
  507. case PERIPH_ID_RESERVED43:
  508. case PERIPH_ID_RESERVED45:
  509. case PERIPH_ID_RESERVED56:
  510. case PERIPH_ID_RESERVED76:
  511. case PERIPH_ID_RESERVED77:
  512. case PERIPH_ID_RESERVED78:
  513. case PERIPH_ID_RESERVED83:
  514. case PERIPH_ID_RESERVED89:
  515. case PERIPH_ID_RESERVED91:
  516. case PERIPH_ID_RESERVED93:
  517. case PERIPH_ID_RESERVED94:
  518. case PERIPH_ID_RESERVED95:
  519. return PERIPH_ID_NONE;
  520. default:
  521. return clk_id;
  522. }
  523. }
  524. #endif /* CONFIG_OF_CONTROL */
  525. void clock_early_init(void)
  526. {
  527. tegra30_set_up_pllp();
  528. }
  529. void arch_timer_init(void)
  530. {
  531. }