axg-audio.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857
  1. // SPDX-License-Identifier: (GPL-2.0 OR MIT)
  2. /*
  3. * Copyright (c) 2018 BayLibre, SAS.
  4. * Author: Jerome Brunet <jbrunet@baylibre.com>
  5. */
  6. #include <linux/clk.h>
  7. #include <linux/clk-provider.h>
  8. #include <linux/init.h>
  9. #include <linux/of_device.h>
  10. #include <linux/module.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/regmap.h>
  13. #include <linux/reset.h>
  14. #include <linux/slab.h>
  15. #include "clkc-audio.h"
  16. #include "axg-audio.h"
  17. #define AXG_MST_IN_COUNT 8
  18. #define AXG_SLV_SCLK_COUNT 10
  19. #define AXG_SLV_LRCLK_COUNT 10
  20. #define AXG_AUD_GATE(_name, _reg, _bit, _pname, _iflags) \
  21. struct clk_regmap axg_##_name = { \
  22. .data = &(struct clk_regmap_gate_data){ \
  23. .offset = (_reg), \
  24. .bit_idx = (_bit), \
  25. }, \
  26. .hw.init = &(struct clk_init_data) { \
  27. .name = "axg_"#_name, \
  28. .ops = &clk_regmap_gate_ops, \
  29. .parent_names = (const char *[]){ _pname }, \
  30. .num_parents = 1, \
  31. .flags = CLK_DUTY_CYCLE_PARENT | (_iflags), \
  32. }, \
  33. }
  34. #define AXG_AUD_MUX(_name, _reg, _mask, _shift, _dflags, _pnames, _iflags) \
  35. struct clk_regmap axg_##_name = { \
  36. .data = &(struct clk_regmap_mux_data){ \
  37. .offset = (_reg), \
  38. .mask = (_mask), \
  39. .shift = (_shift), \
  40. .flags = (_dflags), \
  41. }, \
  42. .hw.init = &(struct clk_init_data){ \
  43. .name = "axg_"#_name, \
  44. .ops = &clk_regmap_mux_ops, \
  45. .parent_names = (_pnames), \
  46. .num_parents = ARRAY_SIZE(_pnames), \
  47. .flags = CLK_DUTY_CYCLE_PARENT | (_iflags), \
  48. }, \
  49. }
  50. #define AXG_AUD_DIV(_name, _reg, _shift, _width, _dflags, _pname, _iflags) \
  51. struct clk_regmap axg_##_name = { \
  52. .data = &(struct clk_regmap_div_data){ \
  53. .offset = (_reg), \
  54. .shift = (_shift), \
  55. .width = (_width), \
  56. .flags = (_dflags), \
  57. }, \
  58. .hw.init = &(struct clk_init_data){ \
  59. .name = "axg_"#_name, \
  60. .ops = &clk_regmap_divider_ops, \
  61. .parent_names = (const char *[]) { _pname }, \
  62. .num_parents = 1, \
  63. .flags = (_iflags), \
  64. }, \
  65. }
  66. #define AXG_PCLK_GATE(_name, _bit) \
  67. AXG_AUD_GATE(_name, AUDIO_CLK_GATE_EN, _bit, "axg_audio_pclk", 0)
  68. /* Audio peripheral clocks */
  69. static AXG_PCLK_GATE(ddr_arb, 0);
  70. static AXG_PCLK_GATE(pdm, 1);
  71. static AXG_PCLK_GATE(tdmin_a, 2);
  72. static AXG_PCLK_GATE(tdmin_b, 3);
  73. static AXG_PCLK_GATE(tdmin_c, 4);
  74. static AXG_PCLK_GATE(tdmin_lb, 5);
  75. static AXG_PCLK_GATE(tdmout_a, 6);
  76. static AXG_PCLK_GATE(tdmout_b, 7);
  77. static AXG_PCLK_GATE(tdmout_c, 8);
  78. static AXG_PCLK_GATE(frddr_a, 9);
  79. static AXG_PCLK_GATE(frddr_b, 10);
  80. static AXG_PCLK_GATE(frddr_c, 11);
  81. static AXG_PCLK_GATE(toddr_a, 12);
  82. static AXG_PCLK_GATE(toddr_b, 13);
  83. static AXG_PCLK_GATE(toddr_c, 14);
  84. static AXG_PCLK_GATE(loopback, 15);
  85. static AXG_PCLK_GATE(spdifin, 16);
  86. static AXG_PCLK_GATE(spdifout, 17);
  87. static AXG_PCLK_GATE(resample, 18);
  88. static AXG_PCLK_GATE(power_detect, 19);
  89. /* Audio Master Clocks */
  90. static const char * const mst_mux_parent_names[] = {
  91. "axg_mst_in0", "axg_mst_in1", "axg_mst_in2", "axg_mst_in3",
  92. "axg_mst_in4", "axg_mst_in5", "axg_mst_in6", "axg_mst_in7",
  93. };
  94. #define AXG_MST_MUX(_name, _reg, _flag) \
  95. AXG_AUD_MUX(_name##_sel, _reg, 0x7, 24, _flag, \
  96. mst_mux_parent_names, CLK_SET_RATE_PARENT)
  97. #define AXG_MST_MCLK_MUX(_name, _reg) \
  98. AXG_MST_MUX(_name, _reg, CLK_MUX_ROUND_CLOSEST)
  99. #define AXG_MST_SYS_MUX(_name, _reg) \
  100. AXG_MST_MUX(_name, _reg, 0)
  101. static AXG_MST_MCLK_MUX(mst_a_mclk, AUDIO_MCLK_A_CTRL);
  102. static AXG_MST_MCLK_MUX(mst_b_mclk, AUDIO_MCLK_B_CTRL);
  103. static AXG_MST_MCLK_MUX(mst_c_mclk, AUDIO_MCLK_C_CTRL);
  104. static AXG_MST_MCLK_MUX(mst_d_mclk, AUDIO_MCLK_D_CTRL);
  105. static AXG_MST_MCLK_MUX(mst_e_mclk, AUDIO_MCLK_E_CTRL);
  106. static AXG_MST_MCLK_MUX(mst_f_mclk, AUDIO_MCLK_F_CTRL);
  107. static AXG_MST_MCLK_MUX(spdifout_clk, AUDIO_CLK_SPDIFOUT_CTRL);
  108. static AXG_MST_MCLK_MUX(pdm_dclk, AUDIO_CLK_PDMIN_CTRL0);
  109. static AXG_MST_SYS_MUX(spdifin_clk, AUDIO_CLK_SPDIFIN_CTRL);
  110. static AXG_MST_SYS_MUX(pdm_sysclk, AUDIO_CLK_PDMIN_CTRL1);
  111. #define AXG_MST_DIV(_name, _reg, _flag) \
  112. AXG_AUD_DIV(_name##_div, _reg, 0, 16, _flag, \
  113. "axg_"#_name"_sel", CLK_SET_RATE_PARENT) \
  114. #define AXG_MST_MCLK_DIV(_name, _reg) \
  115. AXG_MST_DIV(_name, _reg, CLK_DIVIDER_ROUND_CLOSEST)
  116. #define AXG_MST_SYS_DIV(_name, _reg) \
  117. AXG_MST_DIV(_name, _reg, 0)
  118. static AXG_MST_MCLK_DIV(mst_a_mclk, AUDIO_MCLK_A_CTRL);
  119. static AXG_MST_MCLK_DIV(mst_b_mclk, AUDIO_MCLK_B_CTRL);
  120. static AXG_MST_MCLK_DIV(mst_c_mclk, AUDIO_MCLK_C_CTRL);
  121. static AXG_MST_MCLK_DIV(mst_d_mclk, AUDIO_MCLK_D_CTRL);
  122. static AXG_MST_MCLK_DIV(mst_e_mclk, AUDIO_MCLK_E_CTRL);
  123. static AXG_MST_MCLK_DIV(mst_f_mclk, AUDIO_MCLK_F_CTRL);
  124. static AXG_MST_MCLK_DIV(spdifout_clk, AUDIO_CLK_SPDIFOUT_CTRL);
  125. static AXG_MST_MCLK_DIV(pdm_dclk, AUDIO_CLK_PDMIN_CTRL0);
  126. static AXG_MST_SYS_DIV(spdifin_clk, AUDIO_CLK_SPDIFIN_CTRL);
  127. static AXG_MST_SYS_DIV(pdm_sysclk, AUDIO_CLK_PDMIN_CTRL1);
  128. #define AXG_MST_MCLK_GATE(_name, _reg) \
  129. AXG_AUD_GATE(_name, _reg, 31, "axg_"#_name"_div", \
  130. CLK_SET_RATE_PARENT)
  131. static AXG_MST_MCLK_GATE(mst_a_mclk, AUDIO_MCLK_A_CTRL);
  132. static AXG_MST_MCLK_GATE(mst_b_mclk, AUDIO_MCLK_B_CTRL);
  133. static AXG_MST_MCLK_GATE(mst_c_mclk, AUDIO_MCLK_C_CTRL);
  134. static AXG_MST_MCLK_GATE(mst_d_mclk, AUDIO_MCLK_D_CTRL);
  135. static AXG_MST_MCLK_GATE(mst_e_mclk, AUDIO_MCLK_E_CTRL);
  136. static AXG_MST_MCLK_GATE(mst_f_mclk, AUDIO_MCLK_F_CTRL);
  137. static AXG_MST_MCLK_GATE(spdifout_clk, AUDIO_CLK_SPDIFOUT_CTRL);
  138. static AXG_MST_MCLK_GATE(spdifin_clk, AUDIO_CLK_SPDIFIN_CTRL);
  139. static AXG_MST_MCLK_GATE(pdm_dclk, AUDIO_CLK_PDMIN_CTRL0);
  140. static AXG_MST_MCLK_GATE(pdm_sysclk, AUDIO_CLK_PDMIN_CTRL1);
  141. /* Sample Clocks */
  142. #define AXG_MST_SCLK_PRE_EN(_name, _reg) \
  143. AXG_AUD_GATE(mst_##_name##_sclk_pre_en, _reg, 31, \
  144. "axg_mst_"#_name"_mclk", 0)
  145. static AXG_MST_SCLK_PRE_EN(a, AUDIO_MST_A_SCLK_CTRL0);
  146. static AXG_MST_SCLK_PRE_EN(b, AUDIO_MST_B_SCLK_CTRL0);
  147. static AXG_MST_SCLK_PRE_EN(c, AUDIO_MST_C_SCLK_CTRL0);
  148. static AXG_MST_SCLK_PRE_EN(d, AUDIO_MST_D_SCLK_CTRL0);
  149. static AXG_MST_SCLK_PRE_EN(e, AUDIO_MST_E_SCLK_CTRL0);
  150. static AXG_MST_SCLK_PRE_EN(f, AUDIO_MST_F_SCLK_CTRL0);
  151. #define AXG_AUD_SCLK_DIV(_name, _reg, _div_shift, _div_width, \
  152. _hi_shift, _hi_width, _pname, _iflags) \
  153. struct clk_regmap axg_##_name = { \
  154. .data = &(struct meson_sclk_div_data) { \
  155. .div = { \
  156. .reg_off = (_reg), \
  157. .shift = (_div_shift), \
  158. .width = (_div_width), \
  159. }, \
  160. .hi = { \
  161. .reg_off = (_reg), \
  162. .shift = (_hi_shift), \
  163. .width = (_hi_width), \
  164. }, \
  165. }, \
  166. .hw.init = &(struct clk_init_data) { \
  167. .name = "axg_"#_name, \
  168. .ops = &meson_sclk_div_ops, \
  169. .parent_names = (const char *[]) { _pname }, \
  170. .num_parents = 1, \
  171. .flags = (_iflags), \
  172. }, \
  173. }
  174. #define AXG_MST_SCLK_DIV(_name, _reg) \
  175. AXG_AUD_SCLK_DIV(mst_##_name##_sclk_div, _reg, 20, 10, 0, 0, \
  176. "axg_mst_"#_name"_sclk_pre_en", \
  177. CLK_SET_RATE_PARENT)
  178. static AXG_MST_SCLK_DIV(a, AUDIO_MST_A_SCLK_CTRL0);
  179. static AXG_MST_SCLK_DIV(b, AUDIO_MST_B_SCLK_CTRL0);
  180. static AXG_MST_SCLK_DIV(c, AUDIO_MST_C_SCLK_CTRL0);
  181. static AXG_MST_SCLK_DIV(d, AUDIO_MST_D_SCLK_CTRL0);
  182. static AXG_MST_SCLK_DIV(e, AUDIO_MST_E_SCLK_CTRL0);
  183. static AXG_MST_SCLK_DIV(f, AUDIO_MST_F_SCLK_CTRL0);
  184. #define AXG_MST_SCLK_POST_EN(_name, _reg) \
  185. AXG_AUD_GATE(mst_##_name##_sclk_post_en, _reg, 30, \
  186. "axg_mst_"#_name"_sclk_div", CLK_SET_RATE_PARENT)
  187. static AXG_MST_SCLK_POST_EN(a, AUDIO_MST_A_SCLK_CTRL0);
  188. static AXG_MST_SCLK_POST_EN(b, AUDIO_MST_B_SCLK_CTRL0);
  189. static AXG_MST_SCLK_POST_EN(c, AUDIO_MST_C_SCLK_CTRL0);
  190. static AXG_MST_SCLK_POST_EN(d, AUDIO_MST_D_SCLK_CTRL0);
  191. static AXG_MST_SCLK_POST_EN(e, AUDIO_MST_E_SCLK_CTRL0);
  192. static AXG_MST_SCLK_POST_EN(f, AUDIO_MST_F_SCLK_CTRL0);
  193. #define AXG_AUD_TRIPHASE(_name, _reg, _width, _shift0, _shift1, _shift2, \
  194. _pname, _iflags) \
  195. struct clk_regmap axg_##_name = { \
  196. .data = &(struct meson_clk_triphase_data) { \
  197. .ph0 = { \
  198. .reg_off = (_reg), \
  199. .shift = (_shift0), \
  200. .width = (_width), \
  201. }, \
  202. .ph1 = { \
  203. .reg_off = (_reg), \
  204. .shift = (_shift1), \
  205. .width = (_width), \
  206. }, \
  207. .ph2 = { \
  208. .reg_off = (_reg), \
  209. .shift = (_shift2), \
  210. .width = (_width), \
  211. }, \
  212. }, \
  213. .hw.init = &(struct clk_init_data) { \
  214. .name = "axg_"#_name, \
  215. .ops = &meson_clk_triphase_ops, \
  216. .parent_names = (const char *[]) { _pname }, \
  217. .num_parents = 1, \
  218. .flags = CLK_DUTY_CYCLE_PARENT | (_iflags), \
  219. }, \
  220. }
  221. #define AXG_MST_SCLK(_name, _reg) \
  222. AXG_AUD_TRIPHASE(mst_##_name##_sclk, _reg, 1, 0, 2, 4, \
  223. "axg_mst_"#_name"_sclk_post_en", CLK_SET_RATE_PARENT)
  224. static AXG_MST_SCLK(a, AUDIO_MST_A_SCLK_CTRL1);
  225. static AXG_MST_SCLK(b, AUDIO_MST_B_SCLK_CTRL1);
  226. static AXG_MST_SCLK(c, AUDIO_MST_C_SCLK_CTRL1);
  227. static AXG_MST_SCLK(d, AUDIO_MST_D_SCLK_CTRL1);
  228. static AXG_MST_SCLK(e, AUDIO_MST_E_SCLK_CTRL1);
  229. static AXG_MST_SCLK(f, AUDIO_MST_F_SCLK_CTRL1);
  230. #define AXG_MST_LRCLK_DIV(_name, _reg) \
  231. AXG_AUD_SCLK_DIV(mst_##_name##_lrclk_div, _reg, 0, 10, 10, 10, \
  232. "axg_mst_"#_name"_sclk_post_en", 0) \
  233. static AXG_MST_LRCLK_DIV(a, AUDIO_MST_A_SCLK_CTRL0);
  234. static AXG_MST_LRCLK_DIV(b, AUDIO_MST_B_SCLK_CTRL0);
  235. static AXG_MST_LRCLK_DIV(c, AUDIO_MST_C_SCLK_CTRL0);
  236. static AXG_MST_LRCLK_DIV(d, AUDIO_MST_D_SCLK_CTRL0);
  237. static AXG_MST_LRCLK_DIV(e, AUDIO_MST_E_SCLK_CTRL0);
  238. static AXG_MST_LRCLK_DIV(f, AUDIO_MST_F_SCLK_CTRL0);
  239. #define AXG_MST_LRCLK(_name, _reg) \
  240. AXG_AUD_TRIPHASE(mst_##_name##_lrclk, _reg, 1, 1, 3, 5, \
  241. "axg_mst_"#_name"_lrclk_div", CLK_SET_RATE_PARENT)
  242. static AXG_MST_LRCLK(a, AUDIO_MST_A_SCLK_CTRL1);
  243. static AXG_MST_LRCLK(b, AUDIO_MST_B_SCLK_CTRL1);
  244. static AXG_MST_LRCLK(c, AUDIO_MST_C_SCLK_CTRL1);
  245. static AXG_MST_LRCLK(d, AUDIO_MST_D_SCLK_CTRL1);
  246. static AXG_MST_LRCLK(e, AUDIO_MST_E_SCLK_CTRL1);
  247. static AXG_MST_LRCLK(f, AUDIO_MST_F_SCLK_CTRL1);
  248. static const char * const tdm_sclk_parent_names[] = {
  249. "axg_mst_a_sclk", "axg_mst_b_sclk", "axg_mst_c_sclk",
  250. "axg_mst_d_sclk", "axg_mst_e_sclk", "axg_mst_f_sclk",
  251. "axg_slv_sclk0", "axg_slv_sclk1", "axg_slv_sclk2",
  252. "axg_slv_sclk3", "axg_slv_sclk4", "axg_slv_sclk5",
  253. "axg_slv_sclk6", "axg_slv_sclk7", "axg_slv_sclk8",
  254. "axg_slv_sclk9"
  255. };
  256. #define AXG_TDM_SCLK_MUX(_name, _reg) \
  257. AXG_AUD_MUX(tdm##_name##_sclk_sel, _reg, 0xf, 24, \
  258. CLK_MUX_ROUND_CLOSEST, \
  259. tdm_sclk_parent_names, 0)
  260. static AXG_TDM_SCLK_MUX(in_a, AUDIO_CLK_TDMIN_A_CTRL);
  261. static AXG_TDM_SCLK_MUX(in_b, AUDIO_CLK_TDMIN_B_CTRL);
  262. static AXG_TDM_SCLK_MUX(in_c, AUDIO_CLK_TDMIN_C_CTRL);
  263. static AXG_TDM_SCLK_MUX(in_lb, AUDIO_CLK_TDMIN_LB_CTRL);
  264. static AXG_TDM_SCLK_MUX(out_a, AUDIO_CLK_TDMOUT_A_CTRL);
  265. static AXG_TDM_SCLK_MUX(out_b, AUDIO_CLK_TDMOUT_B_CTRL);
  266. static AXG_TDM_SCLK_MUX(out_c, AUDIO_CLK_TDMOUT_C_CTRL);
  267. #define AXG_TDM_SCLK_PRE_EN(_name, _reg) \
  268. AXG_AUD_GATE(tdm##_name##_sclk_pre_en, _reg, 31, \
  269. "axg_tdm"#_name"_sclk_sel", CLK_SET_RATE_PARENT)
  270. static AXG_TDM_SCLK_PRE_EN(in_a, AUDIO_CLK_TDMIN_A_CTRL);
  271. static AXG_TDM_SCLK_PRE_EN(in_b, AUDIO_CLK_TDMIN_B_CTRL);
  272. static AXG_TDM_SCLK_PRE_EN(in_c, AUDIO_CLK_TDMIN_C_CTRL);
  273. static AXG_TDM_SCLK_PRE_EN(in_lb, AUDIO_CLK_TDMIN_LB_CTRL);
  274. static AXG_TDM_SCLK_PRE_EN(out_a, AUDIO_CLK_TDMOUT_A_CTRL);
  275. static AXG_TDM_SCLK_PRE_EN(out_b, AUDIO_CLK_TDMOUT_B_CTRL);
  276. static AXG_TDM_SCLK_PRE_EN(out_c, AUDIO_CLK_TDMOUT_C_CTRL);
  277. #define AXG_TDM_SCLK_POST_EN(_name, _reg) \
  278. AXG_AUD_GATE(tdm##_name##_sclk_post_en, _reg, 30, \
  279. "axg_tdm"#_name"_sclk_pre_en", CLK_SET_RATE_PARENT)
  280. static AXG_TDM_SCLK_POST_EN(in_a, AUDIO_CLK_TDMIN_A_CTRL);
  281. static AXG_TDM_SCLK_POST_EN(in_b, AUDIO_CLK_TDMIN_B_CTRL);
  282. static AXG_TDM_SCLK_POST_EN(in_c, AUDIO_CLK_TDMIN_C_CTRL);
  283. static AXG_TDM_SCLK_POST_EN(in_lb, AUDIO_CLK_TDMIN_LB_CTRL);
  284. static AXG_TDM_SCLK_POST_EN(out_a, AUDIO_CLK_TDMOUT_A_CTRL);
  285. static AXG_TDM_SCLK_POST_EN(out_b, AUDIO_CLK_TDMOUT_B_CTRL);
  286. static AXG_TDM_SCLK_POST_EN(out_c, AUDIO_CLK_TDMOUT_C_CTRL);
  287. #define AXG_TDM_SCLK(_name, _reg) \
  288. struct clk_regmap axg_tdm##_name##_sclk = { \
  289. .data = &(struct meson_clk_phase_data) { \
  290. .ph = { \
  291. .reg_off = (_reg), \
  292. .shift = 29, \
  293. .width = 1, \
  294. }, \
  295. }, \
  296. .hw.init = &(struct clk_init_data) { \
  297. .name = "axg_tdm"#_name"_sclk", \
  298. .ops = &meson_clk_phase_ops, \
  299. .parent_names = (const char *[]) \
  300. { "axg_tdm"#_name"_sclk_post_en" }, \
  301. .num_parents = 1, \
  302. .flags = CLK_DUTY_CYCLE_PARENT | CLK_SET_RATE_PARENT, \
  303. }, \
  304. }
  305. static AXG_TDM_SCLK(in_a, AUDIO_CLK_TDMIN_A_CTRL);
  306. static AXG_TDM_SCLK(in_b, AUDIO_CLK_TDMIN_B_CTRL);
  307. static AXG_TDM_SCLK(in_c, AUDIO_CLK_TDMIN_C_CTRL);
  308. static AXG_TDM_SCLK(in_lb, AUDIO_CLK_TDMIN_LB_CTRL);
  309. static AXG_TDM_SCLK(out_a, AUDIO_CLK_TDMOUT_A_CTRL);
  310. static AXG_TDM_SCLK(out_b, AUDIO_CLK_TDMOUT_B_CTRL);
  311. static AXG_TDM_SCLK(out_c, AUDIO_CLK_TDMOUT_C_CTRL);
  312. static const char * const tdm_lrclk_parent_names[] = {
  313. "axg_mst_a_lrclk", "axg_mst_b_lrclk", "axg_mst_c_lrclk",
  314. "axg_mst_d_lrclk", "axg_mst_e_lrclk", "axg_mst_f_lrclk",
  315. "axg_slv_lrclk0", "axg_slv_lrclk1", "axg_slv_lrclk2",
  316. "axg_slv_lrclk3", "axg_slv_lrclk4", "axg_slv_lrclk5",
  317. "axg_slv_lrclk6", "axg_slv_lrclk7", "axg_slv_lrclk8",
  318. "axg_slv_lrclk9"
  319. };
  320. #define AXG_TDM_LRLCK(_name, _reg) \
  321. AXG_AUD_MUX(tdm##_name##_lrclk, _reg, 0xf, 20, \
  322. CLK_MUX_ROUND_CLOSEST, \
  323. tdm_lrclk_parent_names, 0)
  324. static AXG_TDM_LRLCK(in_a, AUDIO_CLK_TDMIN_A_CTRL);
  325. static AXG_TDM_LRLCK(in_b, AUDIO_CLK_TDMIN_B_CTRL);
  326. static AXG_TDM_LRLCK(in_c, AUDIO_CLK_TDMIN_C_CTRL);
  327. static AXG_TDM_LRLCK(in_lb, AUDIO_CLK_TDMIN_LB_CTRL);
  328. static AXG_TDM_LRLCK(out_a, AUDIO_CLK_TDMOUT_A_CTRL);
  329. static AXG_TDM_LRLCK(out_b, AUDIO_CLK_TDMOUT_B_CTRL);
  330. static AXG_TDM_LRLCK(out_c, AUDIO_CLK_TDMOUT_C_CTRL);
  331. /*
  332. * Array of all clocks provided by this provider
  333. * The input clocks of the controller will be populated at runtime
  334. */
  335. static struct clk_hw_onecell_data axg_audio_hw_onecell_data = {
  336. .hws = {
  337. [AUD_CLKID_DDR_ARB] = &axg_ddr_arb.hw,
  338. [AUD_CLKID_PDM] = &axg_pdm.hw,
  339. [AUD_CLKID_TDMIN_A] = &axg_tdmin_a.hw,
  340. [AUD_CLKID_TDMIN_B] = &axg_tdmin_b.hw,
  341. [AUD_CLKID_TDMIN_C] = &axg_tdmin_c.hw,
  342. [AUD_CLKID_TDMIN_LB] = &axg_tdmin_lb.hw,
  343. [AUD_CLKID_TDMOUT_A] = &axg_tdmout_a.hw,
  344. [AUD_CLKID_TDMOUT_B] = &axg_tdmout_b.hw,
  345. [AUD_CLKID_TDMOUT_C] = &axg_tdmout_c.hw,
  346. [AUD_CLKID_FRDDR_A] = &axg_frddr_a.hw,
  347. [AUD_CLKID_FRDDR_B] = &axg_frddr_b.hw,
  348. [AUD_CLKID_FRDDR_C] = &axg_frddr_c.hw,
  349. [AUD_CLKID_TODDR_A] = &axg_toddr_a.hw,
  350. [AUD_CLKID_TODDR_B] = &axg_toddr_b.hw,
  351. [AUD_CLKID_TODDR_C] = &axg_toddr_c.hw,
  352. [AUD_CLKID_LOOPBACK] = &axg_loopback.hw,
  353. [AUD_CLKID_SPDIFIN] = &axg_spdifin.hw,
  354. [AUD_CLKID_SPDIFOUT] = &axg_spdifout.hw,
  355. [AUD_CLKID_RESAMPLE] = &axg_resample.hw,
  356. [AUD_CLKID_POWER_DETECT] = &axg_power_detect.hw,
  357. [AUD_CLKID_MST_A_MCLK_SEL] = &axg_mst_a_mclk_sel.hw,
  358. [AUD_CLKID_MST_B_MCLK_SEL] = &axg_mst_b_mclk_sel.hw,
  359. [AUD_CLKID_MST_C_MCLK_SEL] = &axg_mst_c_mclk_sel.hw,
  360. [AUD_CLKID_MST_D_MCLK_SEL] = &axg_mst_d_mclk_sel.hw,
  361. [AUD_CLKID_MST_E_MCLK_SEL] = &axg_mst_e_mclk_sel.hw,
  362. [AUD_CLKID_MST_F_MCLK_SEL] = &axg_mst_f_mclk_sel.hw,
  363. [AUD_CLKID_MST_A_MCLK_DIV] = &axg_mst_a_mclk_div.hw,
  364. [AUD_CLKID_MST_B_MCLK_DIV] = &axg_mst_b_mclk_div.hw,
  365. [AUD_CLKID_MST_C_MCLK_DIV] = &axg_mst_c_mclk_div.hw,
  366. [AUD_CLKID_MST_D_MCLK_DIV] = &axg_mst_d_mclk_div.hw,
  367. [AUD_CLKID_MST_E_MCLK_DIV] = &axg_mst_e_mclk_div.hw,
  368. [AUD_CLKID_MST_F_MCLK_DIV] = &axg_mst_f_mclk_div.hw,
  369. [AUD_CLKID_MST_A_MCLK] = &axg_mst_a_mclk.hw,
  370. [AUD_CLKID_MST_B_MCLK] = &axg_mst_b_mclk.hw,
  371. [AUD_CLKID_MST_C_MCLK] = &axg_mst_c_mclk.hw,
  372. [AUD_CLKID_MST_D_MCLK] = &axg_mst_d_mclk.hw,
  373. [AUD_CLKID_MST_E_MCLK] = &axg_mst_e_mclk.hw,
  374. [AUD_CLKID_MST_F_MCLK] = &axg_mst_f_mclk.hw,
  375. [AUD_CLKID_SPDIFOUT_CLK_SEL] = &axg_spdifout_clk_sel.hw,
  376. [AUD_CLKID_SPDIFOUT_CLK_DIV] = &axg_spdifout_clk_div.hw,
  377. [AUD_CLKID_SPDIFOUT_CLK] = &axg_spdifout_clk.hw,
  378. [AUD_CLKID_SPDIFIN_CLK_SEL] = &axg_spdifin_clk_sel.hw,
  379. [AUD_CLKID_SPDIFIN_CLK_DIV] = &axg_spdifin_clk_div.hw,
  380. [AUD_CLKID_SPDIFIN_CLK] = &axg_spdifin_clk.hw,
  381. [AUD_CLKID_PDM_DCLK_SEL] = &axg_pdm_dclk_sel.hw,
  382. [AUD_CLKID_PDM_DCLK_DIV] = &axg_pdm_dclk_div.hw,
  383. [AUD_CLKID_PDM_DCLK] = &axg_pdm_dclk.hw,
  384. [AUD_CLKID_PDM_SYSCLK_SEL] = &axg_pdm_sysclk_sel.hw,
  385. [AUD_CLKID_PDM_SYSCLK_DIV] = &axg_pdm_sysclk_div.hw,
  386. [AUD_CLKID_PDM_SYSCLK] = &axg_pdm_sysclk.hw,
  387. [AUD_CLKID_MST_A_SCLK_PRE_EN] = &axg_mst_a_sclk_pre_en.hw,
  388. [AUD_CLKID_MST_B_SCLK_PRE_EN] = &axg_mst_b_sclk_pre_en.hw,
  389. [AUD_CLKID_MST_C_SCLK_PRE_EN] = &axg_mst_c_sclk_pre_en.hw,
  390. [AUD_CLKID_MST_D_SCLK_PRE_EN] = &axg_mst_d_sclk_pre_en.hw,
  391. [AUD_CLKID_MST_E_SCLK_PRE_EN] = &axg_mst_e_sclk_pre_en.hw,
  392. [AUD_CLKID_MST_F_SCLK_PRE_EN] = &axg_mst_f_sclk_pre_en.hw,
  393. [AUD_CLKID_MST_A_SCLK_DIV] = &axg_mst_a_sclk_div.hw,
  394. [AUD_CLKID_MST_B_SCLK_DIV] = &axg_mst_b_sclk_div.hw,
  395. [AUD_CLKID_MST_C_SCLK_DIV] = &axg_mst_c_sclk_div.hw,
  396. [AUD_CLKID_MST_D_SCLK_DIV] = &axg_mst_d_sclk_div.hw,
  397. [AUD_CLKID_MST_E_SCLK_DIV] = &axg_mst_e_sclk_div.hw,
  398. [AUD_CLKID_MST_F_SCLK_DIV] = &axg_mst_f_sclk_div.hw,
  399. [AUD_CLKID_MST_A_SCLK_POST_EN] = &axg_mst_a_sclk_post_en.hw,
  400. [AUD_CLKID_MST_B_SCLK_POST_EN] = &axg_mst_b_sclk_post_en.hw,
  401. [AUD_CLKID_MST_C_SCLK_POST_EN] = &axg_mst_c_sclk_post_en.hw,
  402. [AUD_CLKID_MST_D_SCLK_POST_EN] = &axg_mst_d_sclk_post_en.hw,
  403. [AUD_CLKID_MST_E_SCLK_POST_EN] = &axg_mst_e_sclk_post_en.hw,
  404. [AUD_CLKID_MST_F_SCLK_POST_EN] = &axg_mst_f_sclk_post_en.hw,
  405. [AUD_CLKID_MST_A_SCLK] = &axg_mst_a_sclk.hw,
  406. [AUD_CLKID_MST_B_SCLK] = &axg_mst_b_sclk.hw,
  407. [AUD_CLKID_MST_C_SCLK] = &axg_mst_c_sclk.hw,
  408. [AUD_CLKID_MST_D_SCLK] = &axg_mst_d_sclk.hw,
  409. [AUD_CLKID_MST_E_SCLK] = &axg_mst_e_sclk.hw,
  410. [AUD_CLKID_MST_F_SCLK] = &axg_mst_f_sclk.hw,
  411. [AUD_CLKID_MST_A_LRCLK_DIV] = &axg_mst_a_lrclk_div.hw,
  412. [AUD_CLKID_MST_B_LRCLK_DIV] = &axg_mst_b_lrclk_div.hw,
  413. [AUD_CLKID_MST_C_LRCLK_DIV] = &axg_mst_c_lrclk_div.hw,
  414. [AUD_CLKID_MST_D_LRCLK_DIV] = &axg_mst_d_lrclk_div.hw,
  415. [AUD_CLKID_MST_E_LRCLK_DIV] = &axg_mst_e_lrclk_div.hw,
  416. [AUD_CLKID_MST_F_LRCLK_DIV] = &axg_mst_f_lrclk_div.hw,
  417. [AUD_CLKID_MST_A_LRCLK] = &axg_mst_a_lrclk.hw,
  418. [AUD_CLKID_MST_B_LRCLK] = &axg_mst_b_lrclk.hw,
  419. [AUD_CLKID_MST_C_LRCLK] = &axg_mst_c_lrclk.hw,
  420. [AUD_CLKID_MST_D_LRCLK] = &axg_mst_d_lrclk.hw,
  421. [AUD_CLKID_MST_E_LRCLK] = &axg_mst_e_lrclk.hw,
  422. [AUD_CLKID_MST_F_LRCLK] = &axg_mst_f_lrclk.hw,
  423. [AUD_CLKID_TDMIN_A_SCLK_SEL] = &axg_tdmin_a_sclk_sel.hw,
  424. [AUD_CLKID_TDMIN_B_SCLK_SEL] = &axg_tdmin_b_sclk_sel.hw,
  425. [AUD_CLKID_TDMIN_C_SCLK_SEL] = &axg_tdmin_c_sclk_sel.hw,
  426. [AUD_CLKID_TDMIN_LB_SCLK_SEL] = &axg_tdmin_lb_sclk_sel.hw,
  427. [AUD_CLKID_TDMOUT_A_SCLK_SEL] = &axg_tdmout_a_sclk_sel.hw,
  428. [AUD_CLKID_TDMOUT_B_SCLK_SEL] = &axg_tdmout_b_sclk_sel.hw,
  429. [AUD_CLKID_TDMOUT_C_SCLK_SEL] = &axg_tdmout_c_sclk_sel.hw,
  430. [AUD_CLKID_TDMIN_A_SCLK_PRE_EN] = &axg_tdmin_a_sclk_pre_en.hw,
  431. [AUD_CLKID_TDMIN_B_SCLK_PRE_EN] = &axg_tdmin_b_sclk_pre_en.hw,
  432. [AUD_CLKID_TDMIN_C_SCLK_PRE_EN] = &axg_tdmin_c_sclk_pre_en.hw,
  433. [AUD_CLKID_TDMIN_LB_SCLK_PRE_EN] = &axg_tdmin_lb_sclk_pre_en.hw,
  434. [AUD_CLKID_TDMOUT_A_SCLK_PRE_EN] = &axg_tdmout_a_sclk_pre_en.hw,
  435. [AUD_CLKID_TDMOUT_B_SCLK_PRE_EN] = &axg_tdmout_b_sclk_pre_en.hw,
  436. [AUD_CLKID_TDMOUT_C_SCLK_PRE_EN] = &axg_tdmout_c_sclk_pre_en.hw,
  437. [AUD_CLKID_TDMIN_A_SCLK_POST_EN] = &axg_tdmin_a_sclk_post_en.hw,
  438. [AUD_CLKID_TDMIN_B_SCLK_POST_EN] = &axg_tdmin_b_sclk_post_en.hw,
  439. [AUD_CLKID_TDMIN_C_SCLK_POST_EN] = &axg_tdmin_c_sclk_post_en.hw,
  440. [AUD_CLKID_TDMIN_LB_SCLK_POST_EN] = &axg_tdmin_lb_sclk_post_en.hw,
  441. [AUD_CLKID_TDMOUT_A_SCLK_POST_EN] = &axg_tdmout_a_sclk_post_en.hw,
  442. [AUD_CLKID_TDMOUT_B_SCLK_POST_EN] = &axg_tdmout_b_sclk_post_en.hw,
  443. [AUD_CLKID_TDMOUT_C_SCLK_POST_EN] = &axg_tdmout_c_sclk_post_en.hw,
  444. [AUD_CLKID_TDMIN_A_SCLK] = &axg_tdmin_a_sclk.hw,
  445. [AUD_CLKID_TDMIN_B_SCLK] = &axg_tdmin_b_sclk.hw,
  446. [AUD_CLKID_TDMIN_C_SCLK] = &axg_tdmin_c_sclk.hw,
  447. [AUD_CLKID_TDMIN_LB_SCLK] = &axg_tdmin_lb_sclk.hw,
  448. [AUD_CLKID_TDMOUT_A_SCLK] = &axg_tdmout_a_sclk.hw,
  449. [AUD_CLKID_TDMOUT_B_SCLK] = &axg_tdmout_b_sclk.hw,
  450. [AUD_CLKID_TDMOUT_C_SCLK] = &axg_tdmout_c_sclk.hw,
  451. [AUD_CLKID_TDMIN_A_LRCLK] = &axg_tdmin_a_lrclk.hw,
  452. [AUD_CLKID_TDMIN_B_LRCLK] = &axg_tdmin_b_lrclk.hw,
  453. [AUD_CLKID_TDMIN_C_LRCLK] = &axg_tdmin_c_lrclk.hw,
  454. [AUD_CLKID_TDMIN_LB_LRCLK] = &axg_tdmin_lb_lrclk.hw,
  455. [AUD_CLKID_TDMOUT_A_LRCLK] = &axg_tdmout_a_lrclk.hw,
  456. [AUD_CLKID_TDMOUT_B_LRCLK] = &axg_tdmout_b_lrclk.hw,
  457. [AUD_CLKID_TDMOUT_C_LRCLK] = &axg_tdmout_c_lrclk.hw,
  458. [NR_CLKS] = NULL,
  459. },
  460. .num = NR_CLKS,
  461. };
  462. /* Convenience table to populate regmap in .probe() */
  463. static struct clk_regmap *const axg_audio_clk_regmaps[] = {
  464. &axg_ddr_arb,
  465. &axg_pdm,
  466. &axg_tdmin_a,
  467. &axg_tdmin_b,
  468. &axg_tdmin_c,
  469. &axg_tdmin_lb,
  470. &axg_tdmout_a,
  471. &axg_tdmout_b,
  472. &axg_tdmout_c,
  473. &axg_frddr_a,
  474. &axg_frddr_b,
  475. &axg_frddr_c,
  476. &axg_toddr_a,
  477. &axg_toddr_b,
  478. &axg_toddr_c,
  479. &axg_loopback,
  480. &axg_spdifin,
  481. &axg_spdifout,
  482. &axg_resample,
  483. &axg_power_detect,
  484. &axg_mst_a_mclk_sel,
  485. &axg_mst_b_mclk_sel,
  486. &axg_mst_c_mclk_sel,
  487. &axg_mst_d_mclk_sel,
  488. &axg_mst_e_mclk_sel,
  489. &axg_mst_f_mclk_sel,
  490. &axg_mst_a_mclk_div,
  491. &axg_mst_b_mclk_div,
  492. &axg_mst_c_mclk_div,
  493. &axg_mst_d_mclk_div,
  494. &axg_mst_e_mclk_div,
  495. &axg_mst_f_mclk_div,
  496. &axg_mst_a_mclk,
  497. &axg_mst_b_mclk,
  498. &axg_mst_c_mclk,
  499. &axg_mst_d_mclk,
  500. &axg_mst_e_mclk,
  501. &axg_mst_f_mclk,
  502. &axg_spdifout_clk_sel,
  503. &axg_spdifout_clk_div,
  504. &axg_spdifout_clk,
  505. &axg_spdifin_clk_sel,
  506. &axg_spdifin_clk_div,
  507. &axg_spdifin_clk,
  508. &axg_pdm_dclk_sel,
  509. &axg_pdm_dclk_div,
  510. &axg_pdm_dclk,
  511. &axg_pdm_sysclk_sel,
  512. &axg_pdm_sysclk_div,
  513. &axg_pdm_sysclk,
  514. &axg_mst_a_sclk_pre_en,
  515. &axg_mst_b_sclk_pre_en,
  516. &axg_mst_c_sclk_pre_en,
  517. &axg_mst_d_sclk_pre_en,
  518. &axg_mst_e_sclk_pre_en,
  519. &axg_mst_f_sclk_pre_en,
  520. &axg_mst_a_sclk_div,
  521. &axg_mst_b_sclk_div,
  522. &axg_mst_c_sclk_div,
  523. &axg_mst_d_sclk_div,
  524. &axg_mst_e_sclk_div,
  525. &axg_mst_f_sclk_div,
  526. &axg_mst_a_sclk_post_en,
  527. &axg_mst_b_sclk_post_en,
  528. &axg_mst_c_sclk_post_en,
  529. &axg_mst_d_sclk_post_en,
  530. &axg_mst_e_sclk_post_en,
  531. &axg_mst_f_sclk_post_en,
  532. &axg_mst_a_sclk,
  533. &axg_mst_b_sclk,
  534. &axg_mst_c_sclk,
  535. &axg_mst_d_sclk,
  536. &axg_mst_e_sclk,
  537. &axg_mst_f_sclk,
  538. &axg_mst_a_lrclk_div,
  539. &axg_mst_b_lrclk_div,
  540. &axg_mst_c_lrclk_div,
  541. &axg_mst_d_lrclk_div,
  542. &axg_mst_e_lrclk_div,
  543. &axg_mst_f_lrclk_div,
  544. &axg_mst_a_lrclk,
  545. &axg_mst_b_lrclk,
  546. &axg_mst_c_lrclk,
  547. &axg_mst_d_lrclk,
  548. &axg_mst_e_lrclk,
  549. &axg_mst_f_lrclk,
  550. &axg_tdmin_a_sclk_sel,
  551. &axg_tdmin_b_sclk_sel,
  552. &axg_tdmin_c_sclk_sel,
  553. &axg_tdmin_lb_sclk_sel,
  554. &axg_tdmout_a_sclk_sel,
  555. &axg_tdmout_b_sclk_sel,
  556. &axg_tdmout_c_sclk_sel,
  557. &axg_tdmin_a_sclk_pre_en,
  558. &axg_tdmin_b_sclk_pre_en,
  559. &axg_tdmin_c_sclk_pre_en,
  560. &axg_tdmin_lb_sclk_pre_en,
  561. &axg_tdmout_a_sclk_pre_en,
  562. &axg_tdmout_b_sclk_pre_en,
  563. &axg_tdmout_c_sclk_pre_en,
  564. &axg_tdmin_a_sclk_post_en,
  565. &axg_tdmin_b_sclk_post_en,
  566. &axg_tdmin_c_sclk_post_en,
  567. &axg_tdmin_lb_sclk_post_en,
  568. &axg_tdmout_a_sclk_post_en,
  569. &axg_tdmout_b_sclk_post_en,
  570. &axg_tdmout_c_sclk_post_en,
  571. &axg_tdmin_a_sclk,
  572. &axg_tdmin_b_sclk,
  573. &axg_tdmin_c_sclk,
  574. &axg_tdmin_lb_sclk,
  575. &axg_tdmout_a_sclk,
  576. &axg_tdmout_b_sclk,
  577. &axg_tdmout_c_sclk,
  578. &axg_tdmin_a_lrclk,
  579. &axg_tdmin_b_lrclk,
  580. &axg_tdmin_c_lrclk,
  581. &axg_tdmin_lb_lrclk,
  582. &axg_tdmout_a_lrclk,
  583. &axg_tdmout_b_lrclk,
  584. &axg_tdmout_c_lrclk,
  585. };
  586. static struct clk *devm_clk_get_enable(struct device *dev, char *id)
  587. {
  588. struct clk *clk;
  589. int ret;
  590. clk = devm_clk_get(dev, id);
  591. if (IS_ERR(clk)) {
  592. if (PTR_ERR(clk) != -EPROBE_DEFER)
  593. dev_err(dev, "failed to get %s", id);
  594. return clk;
  595. }
  596. ret = clk_prepare_enable(clk);
  597. if (ret) {
  598. dev_err(dev, "failed to enable %s", id);
  599. return ERR_PTR(ret);
  600. }
  601. ret = devm_add_action_or_reset(dev,
  602. (void(*)(void *))clk_disable_unprepare,
  603. clk);
  604. if (ret) {
  605. dev_err(dev, "failed to add reset action on %s", id);
  606. return ERR_PTR(ret);
  607. }
  608. return clk;
  609. }
  610. static const struct clk_ops axg_clk_no_ops = {};
  611. static struct clk_hw *axg_clk_hw_register_bypass(struct device *dev,
  612. const char *name,
  613. const char *parent_name)
  614. {
  615. struct clk_hw *hw;
  616. struct clk_init_data init;
  617. char *clk_name;
  618. int ret;
  619. hw = devm_kzalloc(dev, sizeof(*hw), GFP_KERNEL);
  620. if (!hw)
  621. return ERR_PTR(-ENOMEM);
  622. clk_name = kasprintf(GFP_KERNEL, "axg_%s", name);
  623. if (!clk_name)
  624. return ERR_PTR(-ENOMEM);
  625. init.name = clk_name;
  626. init.ops = &axg_clk_no_ops;
  627. init.flags = 0;
  628. init.parent_names = parent_name ? &parent_name : NULL;
  629. init.num_parents = parent_name ? 1 : 0;
  630. hw->init = &init;
  631. ret = devm_clk_hw_register(dev, hw);
  632. kfree(clk_name);
  633. return ret ? ERR_PTR(ret) : hw;
  634. }
  635. static int axg_register_clk_hw_input(struct device *dev,
  636. const char *name,
  637. unsigned int clkid)
  638. {
  639. struct clk *parent_clk = devm_clk_get(dev, name);
  640. struct clk_hw *hw = NULL;
  641. if (IS_ERR(parent_clk)) {
  642. int err = PTR_ERR(parent_clk);
  643. /* It is ok if an input clock is missing */
  644. if (err == -ENOENT) {
  645. dev_dbg(dev, "%s not provided", name);
  646. } else {
  647. if (err != -EPROBE_DEFER)
  648. dev_err(dev, "failed to get %s clock", name);
  649. return err;
  650. }
  651. } else {
  652. hw = axg_clk_hw_register_bypass(dev, name,
  653. __clk_get_name(parent_clk));
  654. }
  655. if (IS_ERR(hw)) {
  656. dev_err(dev, "failed to register %s clock", name);
  657. return PTR_ERR(hw);
  658. }
  659. axg_audio_hw_onecell_data.hws[clkid] = hw;
  660. return 0;
  661. }
  662. static int axg_register_clk_hw_inputs(struct device *dev,
  663. const char *basename,
  664. unsigned int count,
  665. unsigned int clkid)
  666. {
  667. char *name;
  668. int i, ret;
  669. for (i = 0; i < count; i++) {
  670. name = kasprintf(GFP_KERNEL, "%s%d", basename, i);
  671. if (!name)
  672. return -ENOMEM;
  673. ret = axg_register_clk_hw_input(dev, name, clkid + i);
  674. kfree(name);
  675. if (ret)
  676. return ret;
  677. }
  678. return 0;
  679. }
  680. static const struct regmap_config axg_audio_regmap_cfg = {
  681. .reg_bits = 32,
  682. .val_bits = 32,
  683. .reg_stride = 4,
  684. .max_register = AUDIO_CLK_PDMIN_CTRL1,
  685. };
  686. static int axg_audio_clkc_probe(struct platform_device *pdev)
  687. {
  688. struct device *dev = &pdev->dev;
  689. struct regmap *map;
  690. struct resource *res;
  691. void __iomem *regs;
  692. struct clk *clk;
  693. struct clk_hw *hw;
  694. int ret, i;
  695. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  696. regs = devm_ioremap_resource(dev, res);
  697. if (IS_ERR(regs))
  698. return PTR_ERR(regs);
  699. map = devm_regmap_init_mmio(dev, regs, &axg_audio_regmap_cfg);
  700. if (IS_ERR(map)) {
  701. dev_err(dev, "failed to init regmap: %ld\n", PTR_ERR(map));
  702. return PTR_ERR(map);
  703. }
  704. /* Get the mandatory peripheral clock */
  705. clk = devm_clk_get_enable(dev, "pclk");
  706. if (IS_ERR(clk))
  707. return PTR_ERR(clk);
  708. ret = device_reset(dev);
  709. if (ret) {
  710. dev_err(dev, "failed to reset device\n");
  711. return ret;
  712. }
  713. /* Register the peripheral input clock */
  714. hw = axg_clk_hw_register_bypass(dev, "audio_pclk",
  715. __clk_get_name(clk));
  716. if (IS_ERR(hw))
  717. return PTR_ERR(hw);
  718. axg_audio_hw_onecell_data.hws[AUD_CLKID_PCLK] = hw;
  719. /* Register optional input master clocks */
  720. ret = axg_register_clk_hw_inputs(dev, "mst_in",
  721. AXG_MST_IN_COUNT,
  722. AUD_CLKID_MST0);
  723. if (ret)
  724. return ret;
  725. /* Register optional input slave sclks */
  726. ret = axg_register_clk_hw_inputs(dev, "slv_sclk",
  727. AXG_SLV_SCLK_COUNT,
  728. AUD_CLKID_SLV_SCLK0);
  729. if (ret)
  730. return ret;
  731. /* Register optional input slave lrclks */
  732. ret = axg_register_clk_hw_inputs(dev, "slv_lrclk",
  733. AXG_SLV_LRCLK_COUNT,
  734. AUD_CLKID_SLV_LRCLK0);
  735. if (ret)
  736. return ret;
  737. /* Populate regmap for the regmap backed clocks */
  738. for (i = 0; i < ARRAY_SIZE(axg_audio_clk_regmaps); i++)
  739. axg_audio_clk_regmaps[i]->map = map;
  740. /* Take care to skip the registered input clocks */
  741. for (i = AUD_CLKID_DDR_ARB; i < axg_audio_hw_onecell_data.num; i++) {
  742. hw = axg_audio_hw_onecell_data.hws[i];
  743. /* array might be sparse */
  744. if (!hw)
  745. continue;
  746. ret = devm_clk_hw_register(dev, hw);
  747. if (ret) {
  748. dev_err(dev, "failed to register clock %s\n",
  749. hw->init->name);
  750. return ret;
  751. }
  752. }
  753. return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get,
  754. &axg_audio_hw_onecell_data);
  755. }
  756. static const struct of_device_id clkc_match_table[] = {
  757. { .compatible = "amlogic,axg-audio-clkc" },
  758. {}
  759. };
  760. MODULE_DEVICE_TABLE(of, clkc_match_table);
  761. static struct platform_driver axg_audio_driver = {
  762. .probe = axg_audio_clkc_probe,
  763. .driver = {
  764. .name = "axg-audio-clkc",
  765. .of_match_table = clkc_match_table,
  766. },
  767. };
  768. module_platform_driver(axg_audio_driver);
  769. MODULE_DESCRIPTION("Amlogic A113x Audio Clock driver");
  770. MODULE_AUTHOR("Jerome Brunet <jbrunet@baylibre.com>");
  771. MODULE_LICENSE("GPL v2");