audio-ext-clk-up.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /* Copyright (c) 2015-2020, The Linux Foundation. All rights reserved.
  3. */
  4. #include <linux/kernel.h>
  5. #include <linux/init.h>
  6. #include <linux/io.h>
  7. #include <linux/err.h>
  8. #include <linux/module.h>
  9. #include <linux/of.h>
  10. #include <linux/clk.h>
  11. #include <linux/clk-provider.h>
  12. #include "../../../drivers/clk/qcom/common.h"
  13. #include <linux/pinctrl/consumer.h>
  14. #include <linux/platform_device.h>
  15. #include <dsp/apr_audio-v2.h>
  16. #include <dt-bindings/clock/qcom,audio-ext-clk.h>
  17. #include <linux/ratelimit.h>
  18. #ifdef CONFIG_AUDIO_PRM
  19. #include <dsp/audio_prm.h>
  20. #else
  21. #include "audio-ext-clk-up.h"
  22. #endif
  23. enum {
  24. AUDIO_EXT_CLK_PMI,
  25. AUDIO_EXT_CLK_LNBB2,
  26. AUDIO_EXT_CLK_LPASS,
  27. AUDIO_EXT_CLK_LPASS2,
  28. AUDIO_EXT_CLK_LPASS3,
  29. AUDIO_EXT_CLK_LPASS4,
  30. AUDIO_EXT_CLK_LPASS5,
  31. AUDIO_EXT_CLK_LPASS6,
  32. AUDIO_EXT_CLK_LPASS7,
  33. AUDIO_EXT_CLK_LPASS_CORE_HW_VOTE,
  34. AUDIO_EXT_CLK_LPASS8,
  35. AUDIO_EXT_CLK_LPASS_AUDIO_HW_VOTE,
  36. AUDIO_EXT_CLK_LPASS9,
  37. AUDIO_EXT_CLK_LPASS10,
  38. AUDIO_EXT_CLK_LPASS11,
  39. AUDIO_EXT_CLK_LPASS12,
  40. AUDIO_EXT_CLK_LPASS13,
  41. AUDIO_EXT_CLK_LPASS_MAX,
  42. AUDIO_EXT_CLK_EXTERNAL_PLL = AUDIO_EXT_CLK_LPASS_MAX,
  43. AUDIO_EXT_CLK_MAX,
  44. };
  45. struct pinctrl_info {
  46. struct pinctrl *pinctrl;
  47. struct pinctrl_state *sleep;
  48. struct pinctrl_state *active;
  49. char __iomem *base;
  50. };
  51. struct audio_ext_clk {
  52. struct pinctrl_info pnctrl_info;
  53. struct clk_fixed_factor fact;
  54. };
  55. struct audio_ext_clk_priv {
  56. struct device *dev;
  57. int clk_src;
  58. struct afe_clk_set clk_cfg;
  59. #ifdef CONFIG_AUDIO_PRM
  60. struct clk_cfg prm_clk_cfg;
  61. #endif
  62. struct audio_ext_clk audio_clk;
  63. const char *clk_name;
  64. uint32_t lpass_core_hwvote_client_handle;
  65. uint32_t lpass_audio_hwvote_client_handle;
  66. };
  67. static inline struct audio_ext_clk_priv *to_audio_clk(struct clk_hw *hw)
  68. {
  69. return container_of(hw, struct audio_ext_clk_priv, audio_clk.fact.hw);
  70. }
  71. static int audio_ext_clk_prepare(struct clk_hw *hw)
  72. {
  73. struct audio_ext_clk_priv *clk_priv = to_audio_clk(hw);
  74. struct pinctrl_info *pnctrl_info = &clk_priv->audio_clk.pnctrl_info;
  75. int ret;
  76. static DEFINE_RATELIMIT_STATE(rtl, 1 * HZ, 1);
  77. if ((clk_priv->clk_src >= AUDIO_EXT_CLK_LPASS) &&
  78. (clk_priv->clk_src < AUDIO_EXT_CLK_LPASS_MAX) && !clk_priv->clk_cfg.enable) {
  79. #ifdef CONFIG_AUDIO_PRM
  80. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  81. ret = audio_prm_set_lpass_clk_cfg(&clk_priv->prm_clk_cfg,1);
  82. #else
  83. ret = afe_set_lpass_clk_cfg(IDX_RSVD_3, &clk_priv->clk_cfg);
  84. #endif
  85. if (ret < 0) {
  86. if (__ratelimit(&rtl))
  87. pr_err_ratelimited("%s afe_set_digital_codec_core_clock failed\n",
  88. __func__);
  89. return ret;
  90. }
  91. clk_priv->clk_cfg.enable = 1;
  92. }
  93. if (pnctrl_info->pinctrl) {
  94. ret = pinctrl_select_state(pnctrl_info->pinctrl,
  95. pnctrl_info->active);
  96. if (ret) {
  97. pr_err("%s: active state select failed with %d\n",
  98. __func__, ret);
  99. return -EIO;
  100. }
  101. }
  102. if (pnctrl_info->base)
  103. iowrite32(1, pnctrl_info->base);
  104. return 0;
  105. }
  106. static void audio_ext_clk_unprepare(struct clk_hw *hw)
  107. {
  108. struct audio_ext_clk_priv *clk_priv = to_audio_clk(hw);
  109. struct pinctrl_info *pnctrl_info = &clk_priv->audio_clk.pnctrl_info;
  110. int ret;
  111. static DEFINE_RATELIMIT_STATE(rtl, 1 * HZ, 1);
  112. if (pnctrl_info->pinctrl) {
  113. ret = pinctrl_select_state(pnctrl_info->pinctrl,
  114. pnctrl_info->sleep);
  115. if (ret) {
  116. pr_err("%s: active state select failed with %d\n",
  117. __func__, ret);
  118. return;
  119. }
  120. }
  121. if ((clk_priv->clk_src >= AUDIO_EXT_CLK_LPASS) &&
  122. (clk_priv->clk_src < AUDIO_EXT_CLK_LPASS_MAX)) {
  123. clk_priv->clk_cfg.enable = 0;
  124. #ifdef CONFIG_AUDIO_PRM
  125. pr_debug("%s: clk_id %d",__func__,
  126. clk_priv->prm_clk_cfg.clk_id);
  127. ret = audio_prm_set_lpass_clk_cfg(&clk_priv->prm_clk_cfg,0);
  128. #else
  129. ret = afe_set_lpass_clk_cfg(IDX_RSVD_3, &clk_priv->clk_cfg);
  130. #endif
  131. if (ret < 0) {
  132. if (__ratelimit(&rtl))
  133. pr_err_ratelimited("%s: afe_set_lpass_clk_cfg failed, ret = %d\n",
  134. __func__, ret);
  135. }
  136. }
  137. if (pnctrl_info->base)
  138. iowrite32(0, pnctrl_info->base);
  139. }
  140. static u8 audio_ext_clk_get_parent(struct clk_hw *hw)
  141. {
  142. struct audio_ext_clk_priv *clk_priv = to_audio_clk(hw);
  143. int num_parents = clk_hw_get_num_parents(hw);
  144. const char * const *parent_names = hw->init->parent_names;
  145. u8 i = 0, ret = hw->init->num_parents + 1;
  146. if ((clk_priv->clk_src == AUDIO_EXT_CLK_PMI) && clk_priv->clk_name) {
  147. for (i = 0; i < num_parents; i++) {
  148. if (!strcmp(parent_names[i], clk_priv->clk_name))
  149. ret = i;
  150. }
  151. pr_debug("%s: parent index = %u\n", __func__, ret);
  152. return ret;
  153. } else if ((clk_priv->clk_src >= AUDIO_EXT_CLK_LPASS10) &&
  154. (clk_priv->clk_src < AUDIO_EXT_CLK_LPASS13) &&
  155. clk_priv->clk_name) {
  156. for (i = 0; i < num_parents; i++) {
  157. if (!strcmp(parent_names[i],
  158. clk_priv->clk_name))
  159. ret = i;
  160. }
  161. pr_debug("%s: parent index = %u\n", __func__, ret);
  162. return ret;
  163. } else
  164. return 0;
  165. }
  166. static int lpass_hw_vote_prepare(struct clk_hw *hw)
  167. {
  168. struct audio_ext_clk_priv *clk_priv = to_audio_clk(hw);
  169. int ret;
  170. static DEFINE_RATELIMIT_STATE(rtl, 1 * HZ, 1);
  171. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_CORE_HW_VOTE) {
  172. #ifdef CONFIG_AUDIO_PRM
  173. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  174. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  175. HW_CORE_ID_LPASS, 1);
  176. #else
  177. ret = afe_vote_lpass_core_hw(AFE_LPASS_CORE_HW_MACRO_BLOCK,
  178. "LPASS_HW_MACRO",
  179. &clk_priv->lpass_core_hwvote_client_handle);
  180. #endif
  181. if (ret < 0) {
  182. pr_err("%s lpass core hw vote failed %d\n",
  183. __func__, ret);
  184. return ret;
  185. }
  186. }
  187. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_AUDIO_HW_VOTE) {
  188. #ifdef CONFIG_AUDIO_PRM
  189. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  190. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  191. HW_CORE_ID_DCODEC, 1);
  192. #else
  193. ret = afe_vote_lpass_core_hw(AFE_LPASS_CORE_HW_DCODEC_BLOCK,
  194. "LPASS_HW_DCODEC",
  195. &clk_priv->lpass_audio_hwvote_client_handle);
  196. #endif
  197. if (ret < 0) {
  198. if (__ratelimit(&rtl))
  199. pr_err("%s lpass audio hw vote failed %d\n",
  200. __func__, ret);
  201. return ret;
  202. }
  203. }
  204. return 0;
  205. }
  206. static void lpass_hw_vote_unprepare(struct clk_hw *hw)
  207. {
  208. struct audio_ext_clk_priv *clk_priv = to_audio_clk(hw);
  209. int ret = 0;
  210. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_CORE_HW_VOTE) {
  211. #ifdef CONFIG_AUDIO_PRM
  212. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  213. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  214. HW_CORE_ID_LPASS, 0);
  215. #else
  216. ret = afe_unvote_lpass_core_hw(
  217. AFE_LPASS_CORE_HW_MACRO_BLOCK,
  218. clk_priv->lpass_core_hwvote_client_handle);
  219. #endif
  220. if (ret < 0) {
  221. pr_err("%s lpass core hw vote failed %d\n",
  222. __func__, ret);
  223. }
  224. }
  225. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_AUDIO_HW_VOTE) {
  226. #ifdef CONFIG_AUDIO_PRM
  227. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  228. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  229. HW_CORE_ID_DCODEC, 0);
  230. #else
  231. ret = afe_unvote_lpass_core_hw(
  232. AFE_LPASS_CORE_HW_DCODEC_BLOCK,
  233. clk_priv->lpass_audio_hwvote_client_handle);
  234. #endif
  235. if (ret < 0) {
  236. pr_err("%s lpass audio hw unvote failed %d\n",
  237. __func__, ret);
  238. }
  239. }
  240. }
  241. static const struct clk_ops audio_ext_clk_ops = {
  242. .prepare = audio_ext_clk_prepare,
  243. .unprepare = audio_ext_clk_unprepare,
  244. .get_parent = audio_ext_clk_get_parent,
  245. };
  246. static const struct clk_ops lpass_hw_vote_ops = {
  247. .prepare = lpass_hw_vote_prepare,
  248. .unprepare = lpass_hw_vote_unprepare,
  249. };
  250. static const char * const audio_ext_pmi_div_clk[] = {
  251. "qpnp_clkdiv_1",
  252. "pms405_div_clk1",
  253. "pm6150_div_clk1",
  254. "pm6125_div_clk1",
  255. };
  256. static int audio_ext_clk_dummy_prepare(struct clk_hw *hw)
  257. {
  258. return 0;
  259. }
  260. static void audio_ext_clk_dummy_unprepare(struct clk_hw *hw)
  261. {
  262. }
  263. static const struct clk_ops audio_ext_clk_dummy_ops = {
  264. .prepare = audio_ext_clk_dummy_prepare,
  265. .unprepare = audio_ext_clk_dummy_unprepare,
  266. };
  267. static struct audio_ext_clk audio_clk_array[] = {
  268. {
  269. .pnctrl_info = {NULL},
  270. .fact = {
  271. .mult = 1,
  272. .div = 1,
  273. .hw.init = &(struct clk_init_data){
  274. .name = "audio_ext_pmi_clk",
  275. .parent_names = audio_ext_pmi_div_clk,
  276. .num_parents =
  277. ARRAY_SIZE(audio_ext_pmi_div_clk),
  278. .ops = &audio_ext_clk_ops,
  279. },
  280. },
  281. },
  282. {
  283. .pnctrl_info = {NULL},
  284. .fact = {
  285. .mult = 1,
  286. .div = 1,
  287. .hw.init = &(struct clk_init_data){
  288. .name = "audio_ext_pmi_lnbb_clk",
  289. .parent_names = (const char *[])
  290. { "ln_bb_clk2" },
  291. .num_parents = 1,
  292. .ops = &audio_ext_clk_dummy_ops,
  293. },
  294. },
  295. },
  296. {
  297. .pnctrl_info = {NULL},
  298. .fact = {
  299. .mult = 1,
  300. .div = 1,
  301. .hw.init = &(struct clk_init_data){
  302. .name = "audio_lpass_mclk",
  303. .ops = &audio_ext_clk_ops,
  304. },
  305. },
  306. },
  307. {
  308. .pnctrl_info = {NULL},
  309. .fact = {
  310. .mult = 1,
  311. .div = 1,
  312. .hw.init = &(struct clk_init_data){
  313. .name = "audio_lpass_mclk2",
  314. .ops = &audio_ext_clk_ops,
  315. },
  316. },
  317. },
  318. {
  319. .pnctrl_info = {NULL},
  320. .fact = {
  321. .mult = 1,
  322. .div = 1,
  323. .hw.init = &(struct clk_init_data){
  324. .name = "audio_lpass_mclk3",
  325. .ops = &audio_ext_clk_ops,
  326. },
  327. },
  328. },
  329. {
  330. .pnctrl_info = {NULL},
  331. .fact = {
  332. .mult = 1,
  333. .div = 1,
  334. .hw.init = &(struct clk_init_data){
  335. .name = "audio_lpass_mclk4",
  336. .ops = &audio_ext_clk_ops,
  337. },
  338. },
  339. },
  340. {
  341. .pnctrl_info = {NULL},
  342. .fact = {
  343. .mult = 1,
  344. .div = 1,
  345. .hw.init = &(struct clk_init_data){
  346. .name = "audio_lpass_mclk5",
  347. .ops = &audio_ext_clk_ops,
  348. },
  349. },
  350. },
  351. {
  352. .pnctrl_info = {NULL},
  353. .fact = {
  354. .mult = 1,
  355. .div = 1,
  356. .hw.init = &(struct clk_init_data){
  357. .name = "audio_lpass_mclk6",
  358. .ops = &audio_ext_clk_ops,
  359. },
  360. },
  361. },
  362. {
  363. .pnctrl_info = {NULL},
  364. .fact = {
  365. .mult = 1,
  366. .div = 1,
  367. .hw.init = &(struct clk_init_data){
  368. .name = "audio_lpass_mclk7",
  369. .ops = &audio_ext_clk_ops,
  370. },
  371. },
  372. },
  373. {
  374. .pnctrl_info = {NULL},
  375. .fact = {
  376. .hw.init = &(struct clk_init_data){
  377. .name = "lpass_hw_vote_clk",
  378. .ops = &lpass_hw_vote_ops,
  379. },
  380. },
  381. },
  382. {
  383. .pnctrl_info = {NULL},
  384. .fact = {
  385. .mult = 1,
  386. .div = 1,
  387. .hw.init = &(struct clk_init_data){
  388. .name = "audio_lpass_mclk8",
  389. .ops = &audio_ext_clk_ops,
  390. },
  391. },
  392. },
  393. {
  394. .pnctrl_info = {NULL},
  395. .fact = {
  396. .hw.init = &(struct clk_init_data){
  397. .name = "lpass_audio_hw_vote_clk",
  398. .ops = &lpass_hw_vote_ops,
  399. },
  400. },
  401. },
  402. {
  403. .pnctrl_info = {NULL},
  404. .fact = {
  405. .mult = 1,
  406. .div = 1,
  407. .hw.init = &(struct clk_init_data){
  408. .name = "audio_lpass_mclk9",
  409. .ops = &audio_ext_clk_ops,
  410. },
  411. },
  412. },
  413. {
  414. .pnctrl_info = {NULL},
  415. .fact = {
  416. .mult = 1,
  417. .div = 1,
  418. .hw.init = &(struct clk_init_data){
  419. .name = "audio_lpass_mclk10",
  420. .parent_names = (const char *[])
  421. { "audio_lpass_mclk6" },
  422. .num_parents = 1,
  423. .ops = &audio_ext_clk_ops,
  424. },
  425. },
  426. },
  427. {
  428. .pnctrl_info = {NULL},
  429. .fact = {
  430. .mult = 1,
  431. .div = 1,
  432. .hw.init = &(struct clk_init_data){
  433. .name = "audio_lpass_mclk11",
  434. .parent_names = (const char *[])
  435. { "audio_lpass_mclk6" },
  436. .num_parents = 1,
  437. .ops = &audio_ext_clk_ops,
  438. },
  439. },
  440. },
  441. {
  442. .pnctrl_info = {NULL},
  443. .fact = {
  444. .mult = 1,
  445. .div = 1,
  446. .hw.init = &(struct clk_init_data){
  447. .name = "audio_lpass_mclk12",
  448. .parent_names = (const char *[])
  449. { "audio_lpass_mclk6" },
  450. .num_parents = 1,
  451. .ops = &audio_ext_clk_ops,
  452. },
  453. },
  454. },
  455. {
  456. .pnctrl_info = {NULL},
  457. .fact = {
  458. .mult = 1,
  459. .div = 1,
  460. .hw.init = &(struct clk_init_data){
  461. .name = "audio_lpass_mclk13",
  462. .ops = &audio_ext_clk_ops,
  463. },
  464. },
  465. },
  466. {
  467. .pnctrl_info = {NULL},
  468. .fact = {
  469. .mult = 1,
  470. .div = 1,
  471. .hw.init = &(struct clk_init_data){
  472. .name = "audio_external_pll_clk",
  473. .ops = &audio_ext_clk_ops,
  474. },
  475. },
  476. },
  477. };
  478. static int audio_get_pinctrl(struct platform_device *pdev)
  479. {
  480. struct device *dev = &pdev->dev;
  481. struct audio_ext_clk_priv *clk_priv = platform_get_drvdata(pdev);
  482. struct pinctrl_info *pnctrl_info;
  483. struct pinctrl *pinctrl;
  484. int ret;
  485. u32 reg;
  486. pnctrl_info = &clk_priv->audio_clk.pnctrl_info;
  487. if (pnctrl_info->pinctrl) {
  488. dev_err(dev, "%s: already requested before\n",
  489. __func__);
  490. return -EINVAL;
  491. }
  492. pinctrl = devm_pinctrl_get(dev);
  493. if (IS_ERR_OR_NULL(pinctrl)) {
  494. dev_err(dev, "%s: Unable to get pinctrl handle\n",
  495. __func__);
  496. return -EINVAL;
  497. }
  498. pnctrl_info->pinctrl = pinctrl;
  499. /* get all state handles from Device Tree */
  500. pnctrl_info->sleep = pinctrl_lookup_state(pinctrl, "sleep");
  501. if (IS_ERR(pnctrl_info->sleep)) {
  502. dev_err(dev, "%s: could not get sleep pinstate\n",
  503. __func__);
  504. goto err;
  505. }
  506. pnctrl_info->active = pinctrl_lookup_state(pinctrl, "active");
  507. if (IS_ERR(pnctrl_info->active)) {
  508. dev_err(dev, "%s: could not get active pinstate\n",
  509. __func__);
  510. goto err;
  511. }
  512. /* Reset the TLMM pins to a default state */
  513. ret = pinctrl_select_state(pnctrl_info->pinctrl,
  514. pnctrl_info->sleep);
  515. if (ret) {
  516. dev_err(dev, "%s: Disable TLMM pins failed with %d\n",
  517. __func__, ret);
  518. goto err;
  519. }
  520. ret = of_property_read_u32(dev->of_node, "qcom,mclk-clk-reg", &reg);
  521. if (ret < 0) {
  522. dev_dbg(dev, "%s: miss mclk reg\n", __func__);
  523. } else {
  524. pnctrl_info->base = ioremap(reg, sizeof(u32));
  525. if (pnctrl_info->base == NULL) {
  526. dev_err(dev, "%s ioremap failed\n", __func__);
  527. goto err;
  528. }
  529. }
  530. return 0;
  531. err:
  532. devm_pinctrl_put(pnctrl_info->pinctrl);
  533. return -EINVAL;
  534. }
  535. static int audio_put_pinctrl(struct platform_device *pdev)
  536. {
  537. struct audio_ext_clk_priv *clk_priv = platform_get_drvdata(pdev);
  538. struct pinctrl_info *pnctrl_info = NULL;
  539. pnctrl_info = &clk_priv->audio_clk.pnctrl_info;
  540. if (pnctrl_info && pnctrl_info->pinctrl) {
  541. devm_pinctrl_put(pnctrl_info->pinctrl);
  542. pnctrl_info->pinctrl = NULL;
  543. }
  544. return 0;
  545. }
  546. static int audio_get_clk_data(struct platform_device *pdev)
  547. {
  548. int ret;
  549. struct clk *audio_clk;
  550. struct clk_hw *clkhw;
  551. struct clk_onecell_data *clk_data;
  552. struct audio_ext_clk_priv *clk_priv = platform_get_drvdata(pdev);
  553. clk_data = devm_kzalloc(&pdev->dev, sizeof(*clk_data), GFP_KERNEL);
  554. if (!clk_data)
  555. return -ENOMEM;
  556. clk_data->clk_num = 1;
  557. clk_data->clks = devm_kzalloc(&pdev->dev,
  558. sizeof(struct clk *),
  559. GFP_KERNEL);
  560. if (!clk_data->clks)
  561. return -ENOMEM;
  562. clkhw = &clk_priv->audio_clk.fact.hw;
  563. audio_clk = devm_clk_register(&pdev->dev, clkhw);
  564. if (IS_ERR(audio_clk)) {
  565. dev_err(&pdev->dev,
  566. "%s: clock register failed for clk_src = %d\\n",
  567. __func__, clk_priv->clk_src);
  568. ret = PTR_ERR(audio_clk);
  569. return ret;
  570. }
  571. clk_data->clks[0] = audio_clk;
  572. ret = of_clk_add_provider(pdev->dev.of_node,
  573. of_clk_src_onecell_get, clk_data);
  574. if (ret)
  575. dev_err(&pdev->dev, "%s: clock add failed for clk_src = %d\n",
  576. __func__, clk_priv->clk_src);
  577. return ret;
  578. }
  579. static int audio_ref_clk_probe(struct platform_device *pdev)
  580. {
  581. int ret;
  582. struct audio_ext_clk_priv *clk_priv;
  583. u32 clk_freq = 0, clk_id = 0, clk_src = 0, use_pinctrl = 0;
  584. clk_priv = devm_kzalloc(&pdev->dev, sizeof(*clk_priv), GFP_KERNEL);
  585. if (!clk_priv)
  586. return -ENOMEM;
  587. ret = of_property_read_u32(pdev->dev.of_node,
  588. "qcom,codec-ext-clk-src",
  589. &clk_src);
  590. if (ret) {
  591. dev_err(&pdev->dev, "%s: could not get clk source, ret = %d\n",
  592. __func__, ret);
  593. return ret;
  594. }
  595. if (clk_src >= AUDIO_EXT_CLK_MAX) {
  596. dev_err(&pdev->dev, "%s: Invalid clk source = %d\n",
  597. __func__, clk_src);
  598. return -EINVAL;
  599. }
  600. clk_priv->clk_name = NULL;
  601. clk_priv->clk_src = clk_src;
  602. memcpy(&clk_priv->audio_clk, &audio_clk_array[clk_src],
  603. sizeof(struct audio_ext_clk));
  604. /* Init lpass clk default values */
  605. clk_priv->clk_cfg.clk_set_minor_version =
  606. Q6AFE_LPASS_CLK_CONFIG_API_VERSION;
  607. clk_priv->clk_cfg.clk_id = Q6AFE_LPASS_CLK_ID_SPEAKER_I2S_OSR;
  608. clk_priv->clk_cfg.clk_freq_in_hz = Q6AFE_LPASS_OSR_CLK_9_P600_MHZ;
  609. clk_priv->clk_cfg.clk_attri = Q6AFE_LPASS_CLK_ATTRIBUTE_COUPLE_NO;
  610. #ifdef CONFIG_AUDIO_PRM
  611. /* Init prm clk cfg default values */
  612. clk_priv->prm_clk_cfg.clk_id = Q6AFE_LPASS_CLK_ID_SPEAKER_I2S_OSR;
  613. clk_priv->prm_clk_cfg.clk_freq_in_hz = Q6AFE_LPASS_OSR_CLK_9_P600_MHZ;
  614. clk_priv->prm_clk_cfg.clk_attri = Q6AFE_LPASS_CLK_ATTRIBUTE_COUPLE_NO;
  615. clk_priv->prm_clk_cfg.clk_root = 0;
  616. #endif
  617. ret = of_property_read_u32(pdev->dev.of_node,
  618. "qcom,codec-lpass-ext-clk-freq",
  619. &clk_freq);
  620. if (!ret) {
  621. clk_priv->clk_cfg.clk_freq_in_hz = clk_freq;
  622. #ifdef CONFIG_AUDIO_PRM
  623. clk_priv->prm_clk_cfg.clk_freq_in_hz = clk_freq;
  624. #endif
  625. }
  626. ret = of_property_read_u32(pdev->dev.of_node,
  627. "qcom,codec-lpass-clk-id",
  628. &clk_id);
  629. if (!ret) {
  630. clk_priv->clk_cfg.clk_id = clk_id;
  631. #ifdef CONFIG_AUDIO_PRM
  632. clk_priv->prm_clk_cfg.clk_id = clk_id;
  633. dev_info(&pdev->dev, "%s: PRM ext-clk freq: %d, lpass clk_id: %d, clk_src: %d\n",
  634. __func__, clk_priv->prm_clk_cfg.clk_freq_in_hz,
  635. clk_priv->prm_clk_cfg.clk_id, clk_priv->clk_src);
  636. #endif
  637. }
  638. dev_info(&pdev->dev, "%s: ext-clk freq: %d, lpass clk_id: %d, clk_src: %d\n",
  639. __func__, clk_priv->clk_cfg.clk_freq_in_hz,
  640. clk_priv->clk_cfg.clk_id, clk_priv->clk_src);
  641. dev_info(&pdev->dev, "%s: PRM2 ext-clk freq: %d, lpass clk_id: %d, clk_src: %d\n",
  642. __func__, clk_priv->prm_clk_cfg.clk_freq_in_hz,
  643. clk_priv->prm_clk_cfg.clk_id, clk_priv->clk_src);
  644. platform_set_drvdata(pdev, clk_priv);
  645. ret = of_property_read_string(pdev->dev.of_node, "pmic-clock-names",
  646. &clk_priv->clk_name);
  647. if (ret)
  648. dev_dbg(&pdev->dev, "%s: could not find pmic clock names\n",
  649. __func__);
  650. /*
  651. * property qcom,use-pinctrl to be defined in DTSI to val 1
  652. * for clock nodes using pinctrl
  653. */
  654. of_property_read_u32(pdev->dev.of_node, "qcom,use-pinctrl",
  655. &use_pinctrl);
  656. dev_dbg(&pdev->dev, "%s: use-pinctrl : %d\n",
  657. __func__, use_pinctrl);
  658. if (use_pinctrl) {
  659. ret = audio_get_pinctrl(pdev);
  660. if (ret) {
  661. dev_err(&pdev->dev, "%s: Parsing PMI pinctrl failed\n",
  662. __func__);
  663. return ret;
  664. }
  665. }
  666. ret = audio_get_clk_data(pdev);
  667. if (ret) {
  668. dev_err(&pdev->dev, "%s: clk_init is failed\n",
  669. __func__);
  670. audio_put_pinctrl(pdev);
  671. return ret;
  672. }
  673. return 0;
  674. }
  675. static int audio_ref_clk_remove(struct platform_device *pdev)
  676. {
  677. audio_put_pinctrl(pdev);
  678. return 0;
  679. }
  680. static const struct of_device_id audio_ref_clk_match[] = {
  681. {.compatible = "qcom,audio-ref-clk"},
  682. {}
  683. };
  684. MODULE_DEVICE_TABLE(of, audio_ref_clk_match);
  685. static struct platform_driver audio_ref_clk_driver = {
  686. .driver = {
  687. .name = "audio-ref-clk",
  688. .owner = THIS_MODULE,
  689. .of_match_table = audio_ref_clk_match,
  690. .suppress_bind_attrs = true,
  691. },
  692. .probe = audio_ref_clk_probe,
  693. .remove = audio_ref_clk_remove,
  694. };
  695. int audio_ref_clk_platform_init(void)
  696. {
  697. return platform_driver_register(&audio_ref_clk_driver);
  698. }
  699. void audio_ref_clk_platform_exit(void)
  700. {
  701. platform_driver_unregister(&audio_ref_clk_driver);
  702. }
  703. MODULE_DESCRIPTION("Audio Ref Up Clock module platform driver");
  704. MODULE_LICENSE("GPL v2");