mt8192-afe-clk.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669
  1. // SPDX-License-Identifier: GPL-2.0
  2. //
  3. // mt8192-afe-clk.c -- Mediatek 8192 afe clock ctrl
  4. //
  5. // Copyright (c) 2020 MediaTek Inc.
  6. // Author: Shane Chien <[email protected]>
  7. //
  8. #include <linux/arm-smccc.h>
  9. #include <linux/clk.h>
  10. #include <linux/mfd/syscon.h>
  11. #include <linux/regmap.h>
  12. #include "mt8192-afe-clk.h"
  13. #include "mt8192-afe-common.h"
  14. static const char *aud_clks[CLK_NUM] = {
  15. [CLK_AFE] = "aud_afe_clk",
  16. [CLK_TML] = "aud_tml_clk",
  17. [CLK_APLL22M] = "aud_apll22m_clk",
  18. [CLK_APLL24M] = "aud_apll24m_clk",
  19. [CLK_APLL1_TUNER] = "aud_apll1_tuner_clk",
  20. [CLK_APLL2_TUNER] = "aud_apll2_tuner_clk",
  21. [CLK_NLE] = "aud_nle",
  22. [CLK_INFRA_SYS_AUDIO] = "aud_infra_clk",
  23. [CLK_INFRA_AUDIO_26M] = "aud_infra_26m_clk",
  24. [CLK_MUX_AUDIO] = "top_mux_audio",
  25. [CLK_MUX_AUDIOINTBUS] = "top_mux_audio_int",
  26. [CLK_TOP_MAINPLL_D4_D4] = "top_mainpll_d4_d4",
  27. [CLK_TOP_MUX_AUD_1] = "top_mux_aud_1",
  28. [CLK_TOP_APLL1_CK] = "top_apll1_ck",
  29. [CLK_TOP_MUX_AUD_2] = "top_mux_aud_2",
  30. [CLK_TOP_APLL2_CK] = "top_apll2_ck",
  31. [CLK_TOP_MUX_AUD_ENG1] = "top_mux_aud_eng1",
  32. [CLK_TOP_APLL1_D4] = "top_apll1_d4",
  33. [CLK_TOP_MUX_AUD_ENG2] = "top_mux_aud_eng2",
  34. [CLK_TOP_APLL2_D4] = "top_apll2_d4",
  35. [CLK_TOP_MUX_AUDIO_H] = "top_mux_audio_h",
  36. [CLK_TOP_I2S0_M_SEL] = "top_i2s0_m_sel",
  37. [CLK_TOP_I2S1_M_SEL] = "top_i2s1_m_sel",
  38. [CLK_TOP_I2S2_M_SEL] = "top_i2s2_m_sel",
  39. [CLK_TOP_I2S3_M_SEL] = "top_i2s3_m_sel",
  40. [CLK_TOP_I2S4_M_SEL] = "top_i2s4_m_sel",
  41. [CLK_TOP_I2S5_M_SEL] = "top_i2s5_m_sel",
  42. [CLK_TOP_I2S6_M_SEL] = "top_i2s6_m_sel",
  43. [CLK_TOP_I2S7_M_SEL] = "top_i2s7_m_sel",
  44. [CLK_TOP_I2S8_M_SEL] = "top_i2s8_m_sel",
  45. [CLK_TOP_I2S9_M_SEL] = "top_i2s9_m_sel",
  46. [CLK_TOP_APLL12_DIV0] = "top_apll12_div0",
  47. [CLK_TOP_APLL12_DIV1] = "top_apll12_div1",
  48. [CLK_TOP_APLL12_DIV2] = "top_apll12_div2",
  49. [CLK_TOP_APLL12_DIV3] = "top_apll12_div3",
  50. [CLK_TOP_APLL12_DIV4] = "top_apll12_div4",
  51. [CLK_TOP_APLL12_DIVB] = "top_apll12_divb",
  52. [CLK_TOP_APLL12_DIV5] = "top_apll12_div5",
  53. [CLK_TOP_APLL12_DIV6] = "top_apll12_div6",
  54. [CLK_TOP_APLL12_DIV7] = "top_apll12_div7",
  55. [CLK_TOP_APLL12_DIV8] = "top_apll12_div8",
  56. [CLK_TOP_APLL12_DIV9] = "top_apll12_div9",
  57. [CLK_CLK26M] = "top_clk26m_clk",
  58. };
  59. int mt8192_set_audio_int_bus_parent(struct mtk_base_afe *afe,
  60. int clk_id)
  61. {
  62. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  63. int ret;
  64. ret = clk_set_parent(afe_priv->clk[CLK_MUX_AUDIOINTBUS],
  65. afe_priv->clk[clk_id]);
  66. if (ret) {
  67. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  68. __func__, aud_clks[CLK_MUX_AUDIOINTBUS],
  69. aud_clks[clk_id], ret);
  70. }
  71. return ret;
  72. }
  73. static int apll1_mux_setting(struct mtk_base_afe *afe, bool enable)
  74. {
  75. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  76. int ret;
  77. if (enable) {
  78. ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_1]);
  79. if (ret) {
  80. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  81. __func__, aud_clks[CLK_TOP_MUX_AUD_1], ret);
  82. goto EXIT;
  83. }
  84. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_1],
  85. afe_priv->clk[CLK_TOP_APLL1_CK]);
  86. if (ret) {
  87. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  88. __func__, aud_clks[CLK_TOP_MUX_AUD_1],
  89. aud_clks[CLK_TOP_APLL1_CK], ret);
  90. goto EXIT;
  91. }
  92. /* 180.6336 / 4 = 45.1584MHz */
  93. ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1]);
  94. if (ret) {
  95. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  96. __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1], ret);
  97. goto EXIT;
  98. }
  99. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1],
  100. afe_priv->clk[CLK_TOP_APLL1_D4]);
  101. if (ret) {
  102. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  103. __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1],
  104. aud_clks[CLK_TOP_APLL1_D4], ret);
  105. goto EXIT;
  106. }
  107. } else {
  108. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1],
  109. afe_priv->clk[CLK_CLK26M]);
  110. if (ret) {
  111. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  112. __func__, aud_clks[CLK_TOP_MUX_AUD_ENG1],
  113. aud_clks[CLK_CLK26M], ret);
  114. goto EXIT;
  115. }
  116. clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_ENG1]);
  117. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_1],
  118. afe_priv->clk[CLK_CLK26M]);
  119. if (ret) {
  120. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  121. __func__, aud_clks[CLK_TOP_MUX_AUD_1],
  122. aud_clks[CLK_CLK26M], ret);
  123. goto EXIT;
  124. }
  125. clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_1]);
  126. }
  127. EXIT:
  128. return ret;
  129. }
  130. static int apll2_mux_setting(struct mtk_base_afe *afe, bool enable)
  131. {
  132. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  133. int ret;
  134. if (enable) {
  135. ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_2]);
  136. if (ret) {
  137. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  138. __func__, aud_clks[CLK_TOP_MUX_AUD_2], ret);
  139. goto EXIT;
  140. }
  141. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_2],
  142. afe_priv->clk[CLK_TOP_APLL2_CK]);
  143. if (ret) {
  144. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  145. __func__, aud_clks[CLK_TOP_MUX_AUD_2],
  146. aud_clks[CLK_TOP_APLL2_CK], ret);
  147. goto EXIT;
  148. }
  149. /* 196.608 / 4 = 49.152MHz */
  150. ret = clk_prepare_enable(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2]);
  151. if (ret) {
  152. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  153. __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2], ret);
  154. goto EXIT;
  155. }
  156. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2],
  157. afe_priv->clk[CLK_TOP_APLL2_D4]);
  158. if (ret) {
  159. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  160. __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2],
  161. aud_clks[CLK_TOP_APLL2_D4], ret);
  162. goto EXIT;
  163. }
  164. } else {
  165. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2],
  166. afe_priv->clk[CLK_CLK26M]);
  167. if (ret) {
  168. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  169. __func__, aud_clks[CLK_TOP_MUX_AUD_ENG2],
  170. aud_clks[CLK_CLK26M], ret);
  171. goto EXIT;
  172. }
  173. clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_ENG2]);
  174. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUD_2],
  175. afe_priv->clk[CLK_CLK26M]);
  176. if (ret) {
  177. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  178. __func__, aud_clks[CLK_TOP_MUX_AUD_2],
  179. aud_clks[CLK_CLK26M], ret);
  180. goto EXIT;
  181. }
  182. clk_disable_unprepare(afe_priv->clk[CLK_TOP_MUX_AUD_2]);
  183. }
  184. EXIT:
  185. return ret;
  186. }
  187. int mt8192_afe_enable_clock(struct mtk_base_afe *afe)
  188. {
  189. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  190. int ret;
  191. dev_info(afe->dev, "%s()\n", __func__);
  192. ret = clk_prepare_enable(afe_priv->clk[CLK_INFRA_SYS_AUDIO]);
  193. if (ret) {
  194. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  195. __func__, aud_clks[CLK_INFRA_SYS_AUDIO], ret);
  196. goto EXIT;
  197. }
  198. ret = clk_prepare_enable(afe_priv->clk[CLK_INFRA_AUDIO_26M]);
  199. if (ret) {
  200. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  201. __func__, aud_clks[CLK_INFRA_AUDIO_26M], ret);
  202. goto EXIT;
  203. }
  204. ret = clk_prepare_enable(afe_priv->clk[CLK_MUX_AUDIO]);
  205. if (ret) {
  206. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  207. __func__, aud_clks[CLK_MUX_AUDIO], ret);
  208. goto EXIT;
  209. }
  210. ret = clk_set_parent(afe_priv->clk[CLK_MUX_AUDIO],
  211. afe_priv->clk[CLK_CLK26M]);
  212. if (ret) {
  213. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  214. __func__, aud_clks[CLK_MUX_AUDIO],
  215. aud_clks[CLK_CLK26M], ret);
  216. goto EXIT;
  217. }
  218. ret = clk_prepare_enable(afe_priv->clk[CLK_MUX_AUDIOINTBUS]);
  219. if (ret) {
  220. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  221. __func__, aud_clks[CLK_MUX_AUDIOINTBUS], ret);
  222. goto EXIT;
  223. }
  224. ret = mt8192_set_audio_int_bus_parent(afe, CLK_CLK26M);
  225. if (ret) {
  226. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  227. __func__, aud_clks[CLK_MUX_AUDIOINTBUS],
  228. aud_clks[CLK_CLK26M], ret);
  229. goto EXIT;
  230. }
  231. ret = clk_set_parent(afe_priv->clk[CLK_TOP_MUX_AUDIO_H],
  232. afe_priv->clk[CLK_TOP_APLL2_CK]);
  233. if (ret) {
  234. dev_err(afe->dev, "%s clk_set_parent %s-%s fail %d\n",
  235. __func__, aud_clks[CLK_TOP_MUX_AUDIO_H],
  236. aud_clks[CLK_TOP_APLL2_CK], ret);
  237. goto EXIT;
  238. }
  239. ret = clk_prepare_enable(afe_priv->clk[CLK_AFE]);
  240. if (ret) {
  241. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  242. __func__, aud_clks[CLK_AFE], ret);
  243. goto EXIT;
  244. }
  245. EXIT:
  246. return ret;
  247. }
  248. void mt8192_afe_disable_clock(struct mtk_base_afe *afe)
  249. {
  250. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  251. dev_info(afe->dev, "%s()\n", __func__);
  252. clk_disable_unprepare(afe_priv->clk[CLK_AFE]);
  253. mt8192_set_audio_int_bus_parent(afe, CLK_CLK26M);
  254. clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIOINTBUS]);
  255. clk_disable_unprepare(afe_priv->clk[CLK_MUX_AUDIO]);
  256. clk_disable_unprepare(afe_priv->clk[CLK_INFRA_AUDIO_26M]);
  257. clk_disable_unprepare(afe_priv->clk[CLK_INFRA_SYS_AUDIO]);
  258. }
  259. int mt8192_apll1_enable(struct mtk_base_afe *afe)
  260. {
  261. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  262. int ret;
  263. /* setting for APLL */
  264. apll1_mux_setting(afe, true);
  265. ret = clk_prepare_enable(afe_priv->clk[CLK_APLL22M]);
  266. if (ret) {
  267. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  268. __func__, aud_clks[CLK_APLL22M], ret);
  269. goto EXIT;
  270. }
  271. ret = clk_prepare_enable(afe_priv->clk[CLK_APLL1_TUNER]);
  272. if (ret) {
  273. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  274. __func__, aud_clks[CLK_APLL1_TUNER], ret);
  275. goto EXIT;
  276. }
  277. regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG,
  278. 0x0000FFF7, 0x00000832);
  279. regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG, 0x1, 0x1);
  280. regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
  281. AFE_22M_ON_MASK_SFT,
  282. 0x1 << AFE_22M_ON_SFT);
  283. EXIT:
  284. return ret;
  285. }
  286. void mt8192_apll1_disable(struct mtk_base_afe *afe)
  287. {
  288. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  289. regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
  290. AFE_22M_ON_MASK_SFT,
  291. 0x0 << AFE_22M_ON_SFT);
  292. regmap_update_bits(afe->regmap, AFE_APLL1_TUNER_CFG, 0x1, 0x0);
  293. clk_disable_unprepare(afe_priv->clk[CLK_APLL1_TUNER]);
  294. clk_disable_unprepare(afe_priv->clk[CLK_APLL22M]);
  295. apll1_mux_setting(afe, false);
  296. }
  297. int mt8192_apll2_enable(struct mtk_base_afe *afe)
  298. {
  299. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  300. int ret;
  301. /* setting for APLL */
  302. apll2_mux_setting(afe, true);
  303. ret = clk_prepare_enable(afe_priv->clk[CLK_APLL24M]);
  304. if (ret) {
  305. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  306. __func__, aud_clks[CLK_APLL24M], ret);
  307. goto EXIT;
  308. }
  309. ret = clk_prepare_enable(afe_priv->clk[CLK_APLL2_TUNER]);
  310. if (ret) {
  311. dev_err(afe->dev, "%s clk_prepare_enable %s fail %d\n",
  312. __func__, aud_clks[CLK_APLL2_TUNER], ret);
  313. goto EXIT;
  314. }
  315. regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG,
  316. 0x0000FFF7, 0x00000634);
  317. regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG, 0x1, 0x1);
  318. regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
  319. AFE_24M_ON_MASK_SFT,
  320. 0x1 << AFE_24M_ON_SFT);
  321. EXIT:
  322. return ret;
  323. }
  324. void mt8192_apll2_disable(struct mtk_base_afe *afe)
  325. {
  326. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  327. regmap_update_bits(afe->regmap, AFE_HD_ENGEN_ENABLE,
  328. AFE_24M_ON_MASK_SFT,
  329. 0x0 << AFE_24M_ON_SFT);
  330. regmap_update_bits(afe->regmap, AFE_APLL2_TUNER_CFG, 0x1, 0x0);
  331. clk_disable_unprepare(afe_priv->clk[CLK_APLL2_TUNER]);
  332. clk_disable_unprepare(afe_priv->clk[CLK_APLL24M]);
  333. apll2_mux_setting(afe, false);
  334. }
  335. int mt8192_get_apll_rate(struct mtk_base_afe *afe, int apll)
  336. {
  337. return (apll == MT8192_APLL1) ? 180633600 : 196608000;
  338. }
  339. int mt8192_get_apll_by_rate(struct mtk_base_afe *afe, int rate)
  340. {
  341. return ((rate % 8000) == 0) ? MT8192_APLL2 : MT8192_APLL1;
  342. }
  343. int mt8192_get_apll_by_name(struct mtk_base_afe *afe, const char *name)
  344. {
  345. if (strcmp(name, APLL1_W_NAME) == 0)
  346. return MT8192_APLL1;
  347. else
  348. return MT8192_APLL2;
  349. }
  350. /* mck */
  351. struct mt8192_mck_div {
  352. int m_sel_id;
  353. int div_clk_id;
  354. /* below will be deprecated */
  355. int div_pdn_reg;
  356. int div_pdn_mask_sft;
  357. int div_reg;
  358. int div_mask_sft;
  359. int div_mask;
  360. int div_sft;
  361. int div_apll_sel_reg;
  362. int div_apll_sel_mask_sft;
  363. int div_apll_sel_sft;
  364. };
  365. static const struct mt8192_mck_div mck_div[MT8192_MCK_NUM] = {
  366. [MT8192_I2S0_MCK] = {
  367. .m_sel_id = CLK_TOP_I2S0_M_SEL,
  368. .div_clk_id = CLK_TOP_APLL12_DIV0,
  369. .div_pdn_reg = CLK_AUDDIV_0,
  370. .div_pdn_mask_sft = APLL12_DIV0_PDN_MASK_SFT,
  371. .div_reg = CLK_AUDDIV_2,
  372. .div_mask_sft = APLL12_CK_DIV0_MASK_SFT,
  373. .div_mask = APLL12_CK_DIV0_MASK,
  374. .div_sft = APLL12_CK_DIV0_SFT,
  375. .div_apll_sel_reg = CLK_AUDDIV_0,
  376. .div_apll_sel_mask_sft = APLL_I2S0_MCK_SEL_MASK_SFT,
  377. .div_apll_sel_sft = APLL_I2S0_MCK_SEL_SFT,
  378. },
  379. [MT8192_I2S1_MCK] = {
  380. .m_sel_id = CLK_TOP_I2S1_M_SEL,
  381. .div_clk_id = CLK_TOP_APLL12_DIV1,
  382. .div_pdn_reg = CLK_AUDDIV_0,
  383. .div_pdn_mask_sft = APLL12_DIV1_PDN_MASK_SFT,
  384. .div_reg = CLK_AUDDIV_2,
  385. .div_mask_sft = APLL12_CK_DIV1_MASK_SFT,
  386. .div_mask = APLL12_CK_DIV1_MASK,
  387. .div_sft = APLL12_CK_DIV1_SFT,
  388. .div_apll_sel_reg = CLK_AUDDIV_0,
  389. .div_apll_sel_mask_sft = APLL_I2S1_MCK_SEL_MASK_SFT,
  390. .div_apll_sel_sft = APLL_I2S1_MCK_SEL_SFT,
  391. },
  392. [MT8192_I2S2_MCK] = {
  393. .m_sel_id = CLK_TOP_I2S2_M_SEL,
  394. .div_clk_id = CLK_TOP_APLL12_DIV2,
  395. .div_pdn_reg = CLK_AUDDIV_0,
  396. .div_pdn_mask_sft = APLL12_DIV2_PDN_MASK_SFT,
  397. .div_reg = CLK_AUDDIV_2,
  398. .div_mask_sft = APLL12_CK_DIV2_MASK_SFT,
  399. .div_mask = APLL12_CK_DIV2_MASK,
  400. .div_sft = APLL12_CK_DIV2_SFT,
  401. .div_apll_sel_reg = CLK_AUDDIV_0,
  402. .div_apll_sel_mask_sft = APLL_I2S2_MCK_SEL_MASK_SFT,
  403. .div_apll_sel_sft = APLL_I2S2_MCK_SEL_SFT,
  404. },
  405. [MT8192_I2S3_MCK] = {
  406. .m_sel_id = CLK_TOP_I2S3_M_SEL,
  407. .div_clk_id = CLK_TOP_APLL12_DIV3,
  408. .div_pdn_reg = CLK_AUDDIV_0,
  409. .div_pdn_mask_sft = APLL12_DIV3_PDN_MASK_SFT,
  410. .div_reg = CLK_AUDDIV_2,
  411. .div_mask_sft = APLL12_CK_DIV3_MASK_SFT,
  412. .div_mask = APLL12_CK_DIV3_MASK,
  413. .div_sft = APLL12_CK_DIV3_SFT,
  414. .div_apll_sel_reg = CLK_AUDDIV_0,
  415. .div_apll_sel_mask_sft = APLL_I2S3_MCK_SEL_MASK_SFT,
  416. .div_apll_sel_sft = APLL_I2S3_MCK_SEL_SFT,
  417. },
  418. [MT8192_I2S4_MCK] = {
  419. .m_sel_id = CLK_TOP_I2S4_M_SEL,
  420. .div_clk_id = CLK_TOP_APLL12_DIV4,
  421. .div_pdn_reg = CLK_AUDDIV_0,
  422. .div_pdn_mask_sft = APLL12_DIV4_PDN_MASK_SFT,
  423. .div_reg = CLK_AUDDIV_3,
  424. .div_mask_sft = APLL12_CK_DIV4_MASK_SFT,
  425. .div_mask = APLL12_CK_DIV4_MASK,
  426. .div_sft = APLL12_CK_DIV4_SFT,
  427. .div_apll_sel_reg = CLK_AUDDIV_0,
  428. .div_apll_sel_mask_sft = APLL_I2S4_MCK_SEL_MASK_SFT,
  429. .div_apll_sel_sft = APLL_I2S4_MCK_SEL_SFT,
  430. },
  431. [MT8192_I2S4_BCK] = {
  432. .m_sel_id = -1,
  433. .div_clk_id = CLK_TOP_APLL12_DIVB,
  434. .div_pdn_reg = CLK_AUDDIV_0,
  435. .div_pdn_mask_sft = APLL12_DIVB_PDN_MASK_SFT,
  436. .div_reg = CLK_AUDDIV_2,
  437. .div_mask_sft = APLL12_CK_DIVB_MASK_SFT,
  438. .div_mask = APLL12_CK_DIVB_MASK,
  439. .div_sft = APLL12_CK_DIVB_SFT,
  440. },
  441. [MT8192_I2S5_MCK] = {
  442. .m_sel_id = CLK_TOP_I2S5_M_SEL,
  443. .div_clk_id = CLK_TOP_APLL12_DIV5,
  444. .div_pdn_reg = CLK_AUDDIV_0,
  445. .div_pdn_mask_sft = APLL12_DIV5_PDN_MASK_SFT,
  446. .div_reg = CLK_AUDDIV_3,
  447. .div_mask_sft = APLL12_CK_DIV5_MASK_SFT,
  448. .div_mask = APLL12_CK_DIV5_MASK,
  449. .div_sft = APLL12_CK_DIV5_SFT,
  450. .div_apll_sel_reg = CLK_AUDDIV_0,
  451. .div_apll_sel_mask_sft = APLL_I2S5_MCK_SEL_MASK_SFT,
  452. .div_apll_sel_sft = APLL_I2S5_MCK_SEL_SFT,
  453. },
  454. [MT8192_I2S6_MCK] = {
  455. .m_sel_id = CLK_TOP_I2S6_M_SEL,
  456. .div_clk_id = CLK_TOP_APLL12_DIV6,
  457. .div_pdn_reg = CLK_AUDDIV_0,
  458. .div_pdn_mask_sft = APLL12_DIV6_PDN_MASK_SFT,
  459. .div_reg = CLK_AUDDIV_3,
  460. .div_mask_sft = APLL12_CK_DIV6_MASK_SFT,
  461. .div_mask = APLL12_CK_DIV6_MASK,
  462. .div_sft = APLL12_CK_DIV6_SFT,
  463. .div_apll_sel_reg = CLK_AUDDIV_0,
  464. .div_apll_sel_mask_sft = APLL_I2S6_MCK_SEL_MASK_SFT,
  465. .div_apll_sel_sft = APLL_I2S6_MCK_SEL_SFT,
  466. },
  467. [MT8192_I2S7_MCK] = {
  468. .m_sel_id = CLK_TOP_I2S7_M_SEL,
  469. .div_clk_id = CLK_TOP_APLL12_DIV7,
  470. .div_pdn_reg = CLK_AUDDIV_0,
  471. .div_pdn_mask_sft = APLL12_DIV7_PDN_MASK_SFT,
  472. .div_reg = CLK_AUDDIV_4,
  473. .div_mask_sft = APLL12_CK_DIV7_MASK_SFT,
  474. .div_mask = APLL12_CK_DIV7_MASK,
  475. .div_sft = APLL12_CK_DIV7_SFT,
  476. .div_apll_sel_reg = CLK_AUDDIV_0,
  477. .div_apll_sel_mask_sft = APLL_I2S7_MCK_SEL_MASK_SFT,
  478. .div_apll_sel_sft = APLL_I2S7_MCK_SEL_SFT,
  479. },
  480. [MT8192_I2S8_MCK] = {
  481. .m_sel_id = CLK_TOP_I2S8_M_SEL,
  482. .div_clk_id = CLK_TOP_APLL12_DIV8,
  483. .div_pdn_reg = CLK_AUDDIV_0,
  484. .div_pdn_mask_sft = APLL12_DIV8_PDN_MASK_SFT,
  485. .div_reg = CLK_AUDDIV_4,
  486. .div_mask_sft = APLL12_CK_DIV8_MASK_SFT,
  487. .div_mask = APLL12_CK_DIV8_MASK,
  488. .div_sft = APLL12_CK_DIV8_SFT,
  489. .div_apll_sel_reg = CLK_AUDDIV_0,
  490. .div_apll_sel_mask_sft = APLL_I2S8_MCK_SEL_MASK_SFT,
  491. .div_apll_sel_sft = APLL_I2S8_MCK_SEL_SFT,
  492. },
  493. [MT8192_I2S9_MCK] = {
  494. .m_sel_id = CLK_TOP_I2S9_M_SEL,
  495. .div_clk_id = CLK_TOP_APLL12_DIV9,
  496. .div_pdn_reg = CLK_AUDDIV_0,
  497. .div_pdn_mask_sft = APLL12_DIV9_PDN_MASK_SFT,
  498. .div_reg = CLK_AUDDIV_4,
  499. .div_mask_sft = APLL12_CK_DIV9_MASK_SFT,
  500. .div_mask = APLL12_CK_DIV9_MASK,
  501. .div_sft = APLL12_CK_DIV9_SFT,
  502. .div_apll_sel_reg = CLK_AUDDIV_0,
  503. .div_apll_sel_mask_sft = APLL_I2S9_MCK_SEL_MASK_SFT,
  504. .div_apll_sel_sft = APLL_I2S9_MCK_SEL_SFT,
  505. },
  506. };
  507. int mt8192_mck_enable(struct mtk_base_afe *afe, int mck_id, int rate)
  508. {
  509. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  510. int apll = mt8192_get_apll_by_rate(afe, rate);
  511. int apll_clk_id = apll == MT8192_APLL1 ?
  512. CLK_TOP_MUX_AUD_1 : CLK_TOP_MUX_AUD_2;
  513. int m_sel_id = mck_div[mck_id].m_sel_id;
  514. int div_clk_id = mck_div[mck_id].div_clk_id;
  515. int ret;
  516. /* select apll */
  517. if (m_sel_id >= 0) {
  518. ret = clk_prepare_enable(afe_priv->clk[m_sel_id]);
  519. if (ret) {
  520. dev_err(afe->dev, "%s(), clk_prepare_enable %s fail %d\n",
  521. __func__, aud_clks[m_sel_id], ret);
  522. return ret;
  523. }
  524. ret = clk_set_parent(afe_priv->clk[m_sel_id],
  525. afe_priv->clk[apll_clk_id]);
  526. if (ret) {
  527. dev_err(afe->dev, "%s(), clk_set_parent %s-%s fail %d\n",
  528. __func__, aud_clks[m_sel_id],
  529. aud_clks[apll_clk_id], ret);
  530. return ret;
  531. }
  532. }
  533. /* enable div, set rate */
  534. ret = clk_prepare_enable(afe_priv->clk[div_clk_id]);
  535. if (ret) {
  536. dev_err(afe->dev, "%s(), clk_prepare_enable %s fail %d\n",
  537. __func__, aud_clks[div_clk_id], ret);
  538. return ret;
  539. }
  540. ret = clk_set_rate(afe_priv->clk[div_clk_id], rate);
  541. if (ret) {
  542. dev_err(afe->dev, "%s(), clk_set_rate %s, rate %d, fail %d\n",
  543. __func__, aud_clks[div_clk_id],
  544. rate, ret);
  545. return ret;
  546. }
  547. return 0;
  548. }
  549. void mt8192_mck_disable(struct mtk_base_afe *afe, int mck_id)
  550. {
  551. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  552. int m_sel_id = mck_div[mck_id].m_sel_id;
  553. int div_clk_id = mck_div[mck_id].div_clk_id;
  554. clk_disable_unprepare(afe_priv->clk[div_clk_id]);
  555. if (m_sel_id >= 0)
  556. clk_disable_unprepare(afe_priv->clk[m_sel_id]);
  557. }
  558. int mt8192_init_clock(struct mtk_base_afe *afe)
  559. {
  560. struct mt8192_afe_private *afe_priv = afe->platform_priv;
  561. struct device_node *of_node = afe->dev->of_node;
  562. int i = 0;
  563. afe_priv->clk = devm_kcalloc(afe->dev, CLK_NUM, sizeof(*afe_priv->clk),
  564. GFP_KERNEL);
  565. if (!afe_priv->clk)
  566. return -ENOMEM;
  567. for (i = 0; i < CLK_NUM; i++) {
  568. afe_priv->clk[i] = devm_clk_get(afe->dev, aud_clks[i]);
  569. if (IS_ERR(afe_priv->clk[i])) {
  570. dev_warn(afe->dev, "%s devm_clk_get %s fail, ret %ld\n",
  571. __func__,
  572. aud_clks[i], PTR_ERR(afe_priv->clk[i]));
  573. afe_priv->clk[i] = NULL;
  574. }
  575. }
  576. afe_priv->apmixedsys = syscon_regmap_lookup_by_phandle(of_node,
  577. "mediatek,apmixedsys");
  578. if (IS_ERR(afe_priv->apmixedsys)) {
  579. dev_err(afe->dev, "%s() Cannot find apmixedsys controller: %ld\n",
  580. __func__, PTR_ERR(afe_priv->apmixedsys));
  581. return PTR_ERR(afe_priv->apmixedsys);
  582. }
  583. afe_priv->topckgen = syscon_regmap_lookup_by_phandle(of_node,
  584. "mediatek,topckgen");
  585. if (IS_ERR(afe_priv->topckgen)) {
  586. dev_err(afe->dev, "%s() Cannot find topckgen controller: %ld\n",
  587. __func__, PTR_ERR(afe_priv->topckgen));
  588. return PTR_ERR(afe_priv->topckgen);
  589. }
  590. afe_priv->infracfg = syscon_regmap_lookup_by_phandle(of_node,
  591. "mediatek,infracfg");
  592. if (IS_ERR(afe_priv->infracfg)) {
  593. dev_err(afe->dev, "%s() Cannot find infracfg: %ld\n",
  594. __func__, PTR_ERR(afe_priv->infracfg));
  595. return PTR_ERR(afe_priv->infracfg);
  596. }
  597. return 0;
  598. }