audio-ext-clk-up.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /* Copyright (c) 2015-2021, 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 <bindings/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
  154. return 0;
  155. }
  156. static int lpass_hw_vote_prepare(struct clk_hw *hw)
  157. {
  158. struct audio_ext_clk_priv *clk_priv = to_audio_clk(hw);
  159. int ret;
  160. static DEFINE_RATELIMIT_STATE(rtl, 1 * HZ, 1);
  161. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_CORE_HW_VOTE) {
  162. #ifdef CONFIG_AUDIO_PRM
  163. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  164. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  165. HW_CORE_ID_LPASS, 1);
  166. #else
  167. ret = afe_vote_lpass_core_hw(AFE_LPASS_CORE_HW_MACRO_BLOCK,
  168. "LPASS_HW_MACRO",
  169. &clk_priv->lpass_core_hwvote_client_handle);
  170. #endif
  171. if (ret < 0) {
  172. pr_err("%s lpass core hw vote failed %d\n",
  173. __func__, ret);
  174. return ret;
  175. }
  176. }
  177. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_AUDIO_HW_VOTE) {
  178. #ifdef CONFIG_AUDIO_PRM
  179. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  180. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  181. HW_CORE_ID_DCODEC, 1);
  182. #else
  183. ret = afe_vote_lpass_core_hw(AFE_LPASS_CORE_HW_DCODEC_BLOCK,
  184. "LPASS_HW_DCODEC",
  185. &clk_priv->lpass_audio_hwvote_client_handle);
  186. #endif
  187. if (ret < 0) {
  188. if (__ratelimit(&rtl))
  189. pr_err("%s lpass audio hw vote failed %d\n",
  190. __func__, ret);
  191. return ret;
  192. }
  193. }
  194. return 0;
  195. }
  196. static void lpass_hw_vote_unprepare(struct clk_hw *hw)
  197. {
  198. struct audio_ext_clk_priv *clk_priv = to_audio_clk(hw);
  199. int ret = 0;
  200. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_CORE_HW_VOTE) {
  201. #ifdef CONFIG_AUDIO_PRM
  202. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  203. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  204. HW_CORE_ID_LPASS, 0);
  205. #else
  206. ret = afe_unvote_lpass_core_hw(
  207. AFE_LPASS_CORE_HW_MACRO_BLOCK,
  208. clk_priv->lpass_core_hwvote_client_handle);
  209. #endif
  210. if (ret < 0) {
  211. pr_err("%s lpass core hw vote failed %d\n",
  212. __func__, ret);
  213. }
  214. }
  215. if (clk_priv->clk_src == AUDIO_EXT_CLK_LPASS_AUDIO_HW_VOTE) {
  216. #ifdef CONFIG_AUDIO_PRM
  217. pr_debug("%s: clk_id %d ",__func__, clk_priv->prm_clk_cfg.clk_id);
  218. ret = audio_prm_set_lpass_hw_core_req(&clk_priv->prm_clk_cfg,
  219. HW_CORE_ID_DCODEC, 0);
  220. #else
  221. ret = afe_unvote_lpass_core_hw(
  222. AFE_LPASS_CORE_HW_DCODEC_BLOCK,
  223. clk_priv->lpass_audio_hwvote_client_handle);
  224. #endif
  225. if (ret < 0) {
  226. pr_err("%s lpass audio hw unvote failed %d\n",
  227. __func__, ret);
  228. }
  229. }
  230. }
  231. static const struct clk_ops audio_ext_clk_ops = {
  232. .prepare = audio_ext_clk_prepare,
  233. .unprepare = audio_ext_clk_unprepare,
  234. .get_parent = audio_ext_clk_get_parent,
  235. };
  236. static const struct clk_ops lpass_hw_vote_ops = {
  237. .prepare = lpass_hw_vote_prepare,
  238. .unprepare = lpass_hw_vote_unprepare,
  239. };
  240. static const char * const audio_ext_pmi_div_clk[] = {
  241. "qpnp_clkdiv_1",
  242. "pms405_div_clk1",
  243. "pm6150_div_clk1",
  244. "pm6125_div_clk1",
  245. };
  246. static int audio_ext_clk_dummy_prepare(struct clk_hw *hw)
  247. {
  248. return 0;
  249. }
  250. static void audio_ext_clk_dummy_unprepare(struct clk_hw *hw)
  251. {
  252. }
  253. static const struct clk_ops audio_ext_clk_dummy_ops = {
  254. .prepare = audio_ext_clk_dummy_prepare,
  255. .unprepare = audio_ext_clk_dummy_unprepare,
  256. };
  257. static struct audio_ext_clk audio_clk_array[] = {
  258. {
  259. .pnctrl_info = {NULL},
  260. .fact = {
  261. .mult = 1,
  262. .div = 1,
  263. .hw.init = &(struct clk_init_data){
  264. .name = "audio_ext_pmi_clk",
  265. .parent_names = audio_ext_pmi_div_clk,
  266. .num_parents =
  267. ARRAY_SIZE(audio_ext_pmi_div_clk),
  268. .ops = &audio_ext_clk_ops,
  269. },
  270. },
  271. },
  272. {
  273. .pnctrl_info = {NULL},
  274. .fact = {
  275. .mult = 1,
  276. .div = 1,
  277. .hw.init = &(struct clk_init_data){
  278. .name = "audio_ext_pmi_lnbb_clk",
  279. .parent_names = (const char *[])
  280. { "ln_bb_clk2" },
  281. .num_parents = 1,
  282. .ops = &audio_ext_clk_dummy_ops,
  283. },
  284. },
  285. },
  286. {
  287. .pnctrl_info = {NULL},
  288. .fact = {
  289. .mult = 1,
  290. .div = 1,
  291. .hw.init = &(struct clk_init_data){
  292. .name = "audio_lpass_mclk",
  293. .ops = &audio_ext_clk_ops,
  294. },
  295. },
  296. },
  297. {
  298. .pnctrl_info = {NULL},
  299. .fact = {
  300. .mult = 1,
  301. .div = 1,
  302. .hw.init = &(struct clk_init_data){
  303. .name = "audio_lpass_mclk2",
  304. .ops = &audio_ext_clk_ops,
  305. },
  306. },
  307. },
  308. {
  309. .pnctrl_info = {NULL},
  310. .fact = {
  311. .mult = 1,
  312. .div = 1,
  313. .hw.init = &(struct clk_init_data){
  314. .name = "audio_lpass_mclk3",
  315. .ops = &audio_ext_clk_ops,
  316. },
  317. },
  318. },
  319. {
  320. .pnctrl_info = {NULL},
  321. .fact = {
  322. .mult = 1,
  323. .div = 1,
  324. .hw.init = &(struct clk_init_data){
  325. .name = "audio_lpass_mclk4",
  326. .ops = &audio_ext_clk_ops,
  327. },
  328. },
  329. },
  330. {
  331. .pnctrl_info = {NULL},
  332. .fact = {
  333. .mult = 1,
  334. .div = 1,
  335. .hw.init = &(struct clk_init_data){
  336. .name = "audio_lpass_mclk5",
  337. .ops = &audio_ext_clk_ops,
  338. },
  339. },
  340. },
  341. {
  342. .pnctrl_info = {NULL},
  343. .fact = {
  344. .mult = 1,
  345. .div = 1,
  346. .hw.init = &(struct clk_init_data){
  347. .name = "audio_lpass_mclk6",
  348. .ops = &audio_ext_clk_ops,
  349. },
  350. },
  351. },
  352. {
  353. .pnctrl_info = {NULL},
  354. .fact = {
  355. .mult = 1,
  356. .div = 1,
  357. .hw.init = &(struct clk_init_data){
  358. .name = "audio_lpass_mclk7",
  359. .ops = &audio_ext_clk_ops,
  360. },
  361. },
  362. },
  363. {
  364. .pnctrl_info = {NULL},
  365. .fact = {
  366. .hw.init = &(struct clk_init_data){
  367. .name = "lpass_hw_vote_clk",
  368. .ops = &lpass_hw_vote_ops,
  369. },
  370. },
  371. },
  372. {
  373. .pnctrl_info = {NULL},
  374. .fact = {
  375. .mult = 1,
  376. .div = 1,
  377. .hw.init = &(struct clk_init_data){
  378. .name = "audio_lpass_mclk8",
  379. .ops = &audio_ext_clk_ops,
  380. },
  381. },
  382. },
  383. {
  384. .pnctrl_info = {NULL},
  385. .fact = {
  386. .hw.init = &(struct clk_init_data){
  387. .name = "lpass_audio_hw_vote_clk",
  388. .ops = &lpass_hw_vote_ops,
  389. },
  390. },
  391. },
  392. {
  393. .pnctrl_info = {NULL},
  394. .fact = {
  395. .mult = 1,
  396. .div = 1,
  397. .hw.init = &(struct clk_init_data){
  398. .name = "audio_lpass_mclk9",
  399. .ops = &audio_ext_clk_ops,
  400. },
  401. },
  402. },
  403. {
  404. .pnctrl_info = {NULL},
  405. .fact = {
  406. .mult = 1,
  407. .div = 1,
  408. .hw.init = &(struct clk_init_data){
  409. .name = "audio_lpass_mclk10",
  410. .ops = &audio_ext_clk_ops,
  411. },
  412. },
  413. },
  414. {
  415. .pnctrl_info = {NULL},
  416. .fact = {
  417. .mult = 1,
  418. .div = 1,
  419. .hw.init = &(struct clk_init_data){
  420. .name = "audio_lpass_mclk11",
  421. .ops = &audio_ext_clk_ops,
  422. },
  423. },
  424. },
  425. {
  426. .pnctrl_info = {NULL},
  427. .fact = {
  428. .mult = 1,
  429. .div = 1,
  430. .hw.init = &(struct clk_init_data){
  431. .name = "audio_lpass_mclk12",
  432. .ops = &audio_ext_clk_ops,
  433. },
  434. },
  435. },
  436. {
  437. .pnctrl_info = {NULL},
  438. .fact = {
  439. .mult = 1,
  440. .div = 1,
  441. .hw.init = &(struct clk_init_data){
  442. .name = "audio_lpass_mclk13",
  443. .ops = &audio_ext_clk_ops,
  444. },
  445. },
  446. },
  447. {
  448. .pnctrl_info = {NULL},
  449. .fact = {
  450. .mult = 1,
  451. .div = 1,
  452. .hw.init = &(struct clk_init_data){
  453. .name = "audio_external_pll_clk",
  454. .ops = &audio_ext_clk_ops,
  455. },
  456. },
  457. },
  458. };
  459. static int audio_get_pinctrl(struct platform_device *pdev)
  460. {
  461. struct device *dev = &pdev->dev;
  462. struct audio_ext_clk_priv *clk_priv = platform_get_drvdata(pdev);
  463. struct pinctrl_info *pnctrl_info;
  464. struct pinctrl *pinctrl;
  465. int ret;
  466. u32 reg;
  467. pnctrl_info = &clk_priv->audio_clk.pnctrl_info;
  468. if (pnctrl_info->pinctrl) {
  469. dev_err(dev, "%s: already requested before\n",
  470. __func__);
  471. return -EINVAL;
  472. }
  473. pinctrl = devm_pinctrl_get(dev);
  474. if (IS_ERR_OR_NULL(pinctrl)) {
  475. dev_err(dev, "%s: Unable to get pinctrl handle\n",
  476. __func__);
  477. return -EINVAL;
  478. }
  479. pnctrl_info->pinctrl = pinctrl;
  480. /* get all state handles from Device Tree */
  481. pnctrl_info->sleep = pinctrl_lookup_state(pinctrl, "sleep");
  482. if (IS_ERR(pnctrl_info->sleep)) {
  483. dev_err(dev, "%s: could not get sleep pinstate\n",
  484. __func__);
  485. goto err;
  486. }
  487. pnctrl_info->active = pinctrl_lookup_state(pinctrl, "active");
  488. if (IS_ERR(pnctrl_info->active)) {
  489. dev_err(dev, "%s: could not get active pinstate\n",
  490. __func__);
  491. goto err;
  492. }
  493. /* Reset the TLMM pins to a default state */
  494. ret = pinctrl_select_state(pnctrl_info->pinctrl,
  495. pnctrl_info->sleep);
  496. if (ret) {
  497. dev_err(dev, "%s: Disable TLMM pins failed with %d\n",
  498. __func__, ret);
  499. goto err;
  500. }
  501. ret = of_property_read_u32(dev->of_node, "qcom,mclk-clk-reg", &reg);
  502. if (ret < 0) {
  503. dev_dbg(dev, "%s: miss mclk reg\n", __func__);
  504. } else {
  505. pnctrl_info->base = ioremap(reg, sizeof(u32));
  506. if (pnctrl_info->base == NULL) {
  507. dev_err(dev, "%s ioremap failed\n", __func__);
  508. goto err;
  509. }
  510. }
  511. return 0;
  512. err:
  513. devm_pinctrl_put(pnctrl_info->pinctrl);
  514. return -EINVAL;
  515. }
  516. static int audio_put_pinctrl(struct platform_device *pdev)
  517. {
  518. struct audio_ext_clk_priv *clk_priv = platform_get_drvdata(pdev);
  519. struct pinctrl_info *pnctrl_info = NULL;
  520. pnctrl_info = &clk_priv->audio_clk.pnctrl_info;
  521. if (pnctrl_info && pnctrl_info->pinctrl) {
  522. devm_pinctrl_put(pnctrl_info->pinctrl);
  523. pnctrl_info->pinctrl = NULL;
  524. }
  525. return 0;
  526. }
  527. static int audio_get_clk_data(struct platform_device *pdev)
  528. {
  529. int ret;
  530. struct clk *audio_clk;
  531. struct clk_hw *clkhw;
  532. struct clk_onecell_data *clk_data;
  533. struct audio_ext_clk_priv *clk_priv = platform_get_drvdata(pdev);
  534. clk_data = devm_kzalloc(&pdev->dev, sizeof(*clk_data), GFP_KERNEL);
  535. if (!clk_data)
  536. return -ENOMEM;
  537. clk_data->clk_num = 1;
  538. clk_data->clks = devm_kzalloc(&pdev->dev,
  539. sizeof(struct clk *),
  540. GFP_KERNEL);
  541. if (!clk_data->clks)
  542. return -ENOMEM;
  543. clkhw = &clk_priv->audio_clk.fact.hw;
  544. audio_clk = devm_clk_register(&pdev->dev, clkhw);
  545. if (IS_ERR(audio_clk)) {
  546. dev_err(&pdev->dev,
  547. "%s: clock register failed for clk_src = %d\\n",
  548. __func__, clk_priv->clk_src);
  549. ret = PTR_ERR(audio_clk);
  550. return ret;
  551. }
  552. clk_data->clks[0] = audio_clk;
  553. ret = of_clk_add_provider(pdev->dev.of_node,
  554. of_clk_src_onecell_get, clk_data);
  555. if (ret)
  556. dev_err(&pdev->dev, "%s: clock add failed for clk_src = %d\n",
  557. __func__, clk_priv->clk_src);
  558. return ret;
  559. }
  560. static int audio_ref_clk_probe(struct platform_device *pdev)
  561. {
  562. int ret;
  563. struct audio_ext_clk_priv *clk_priv;
  564. u32 clk_freq = 0, clk_id = 0, clk_src = 0, use_pinctrl = 0;
  565. clk_priv = devm_kzalloc(&pdev->dev, sizeof(*clk_priv), GFP_KERNEL);
  566. if (!clk_priv)
  567. return -ENOMEM;
  568. ret = of_property_read_u32(pdev->dev.of_node,
  569. "qcom,codec-ext-clk-src",
  570. &clk_src);
  571. if (ret) {
  572. dev_err(&pdev->dev, "%s: could not get clk source, ret = %d\n",
  573. __func__, ret);
  574. return ret;
  575. }
  576. if (clk_src >= AUDIO_EXT_CLK_MAX) {
  577. dev_err(&pdev->dev, "%s: Invalid clk source = %d\n",
  578. __func__, clk_src);
  579. return -EINVAL;
  580. }
  581. clk_priv->clk_name = NULL;
  582. clk_priv->clk_src = clk_src;
  583. memcpy(&clk_priv->audio_clk, &audio_clk_array[clk_src],
  584. sizeof(struct audio_ext_clk));
  585. /* Init lpass clk default values */
  586. clk_priv->clk_cfg.clk_set_minor_version =
  587. Q6AFE_LPASS_CLK_CONFIG_API_VERSION;
  588. clk_priv->clk_cfg.clk_id = Q6AFE_LPASS_CLK_ID_SPEAKER_I2S_OSR;
  589. clk_priv->clk_cfg.clk_freq_in_hz = Q6AFE_LPASS_OSR_CLK_9_P600_MHZ;
  590. clk_priv->clk_cfg.clk_attri = Q6AFE_LPASS_CLK_ATTRIBUTE_COUPLE_NO;
  591. #ifdef CONFIG_AUDIO_PRM
  592. /* Init prm clk cfg default values */
  593. clk_priv->prm_clk_cfg.clk_id = Q6AFE_LPASS_CLK_ID_SPEAKER_I2S_OSR;
  594. clk_priv->prm_clk_cfg.clk_freq_in_hz = Q6AFE_LPASS_OSR_CLK_9_P600_MHZ;
  595. clk_priv->prm_clk_cfg.clk_attri = Q6AFE_LPASS_CLK_ATTRIBUTE_COUPLE_NO;
  596. clk_priv->prm_clk_cfg.clk_root = 0;
  597. #endif
  598. ret = of_property_read_u32(pdev->dev.of_node,
  599. "qcom,codec-lpass-ext-clk-freq",
  600. &clk_freq);
  601. if (!ret) {
  602. clk_priv->clk_cfg.clk_freq_in_hz = clk_freq;
  603. #ifdef CONFIG_AUDIO_PRM
  604. clk_priv->prm_clk_cfg.clk_freq_in_hz = clk_freq;
  605. #endif
  606. }
  607. ret = of_property_read_u32(pdev->dev.of_node,
  608. "qcom,codec-lpass-clk-id",
  609. &clk_id);
  610. if (!ret) {
  611. clk_priv->clk_cfg.clk_id = clk_id;
  612. #ifdef CONFIG_AUDIO_PRM
  613. clk_priv->prm_clk_cfg.clk_id = clk_id;
  614. dev_info(&pdev->dev, "%s: PRM ext-clk freq: %d, lpass clk_id: %d, clk_src: %d\n",
  615. __func__, clk_priv->prm_clk_cfg.clk_freq_in_hz,
  616. clk_priv->prm_clk_cfg.clk_id, clk_priv->clk_src);
  617. #endif
  618. }
  619. dev_info(&pdev->dev, "%s: ext-clk freq: %d, lpass clk_id: %d, clk_src: %d\n",
  620. __func__, clk_priv->clk_cfg.clk_freq_in_hz,
  621. clk_priv->clk_cfg.clk_id, clk_priv->clk_src);
  622. dev_info(&pdev->dev, "%s: PRM2 ext-clk freq: %d, lpass clk_id: %d, clk_src: %d\n",
  623. __func__, clk_priv->prm_clk_cfg.clk_freq_in_hz,
  624. clk_priv->prm_clk_cfg.clk_id, clk_priv->clk_src);
  625. platform_set_drvdata(pdev, clk_priv);
  626. ret = of_property_read_string(pdev->dev.of_node, "pmic-clock-names",
  627. &clk_priv->clk_name);
  628. if (ret)
  629. dev_dbg(&pdev->dev, "%s: could not find pmic clock names\n",
  630. __func__);
  631. /*
  632. * property qcom,use-pinctrl to be defined in DTSI to val 1
  633. * for clock nodes using pinctrl
  634. */
  635. of_property_read_u32(pdev->dev.of_node, "qcom,use-pinctrl",
  636. &use_pinctrl);
  637. dev_dbg(&pdev->dev, "%s: use-pinctrl : %d\n",
  638. __func__, use_pinctrl);
  639. if (use_pinctrl) {
  640. ret = audio_get_pinctrl(pdev);
  641. if (ret) {
  642. dev_err(&pdev->dev, "%s: Parsing PMI pinctrl failed\n",
  643. __func__);
  644. return ret;
  645. }
  646. }
  647. ret = audio_get_clk_data(pdev);
  648. if (ret) {
  649. dev_err(&pdev->dev, "%s: clk_init is failed\n",
  650. __func__);
  651. audio_put_pinctrl(pdev);
  652. return ret;
  653. }
  654. return 0;
  655. }
  656. static int audio_ref_clk_remove(struct platform_device *pdev)
  657. {
  658. audio_put_pinctrl(pdev);
  659. return 0;
  660. }
  661. static const struct of_device_id audio_ref_clk_match[] = {
  662. {.compatible = "qcom,audio-ref-clk"},
  663. {}
  664. };
  665. MODULE_DEVICE_TABLE(of, audio_ref_clk_match);
  666. static struct platform_driver audio_ref_clk_driver = {
  667. .driver = {
  668. .name = "audio-ref-clk",
  669. .owner = THIS_MODULE,
  670. .of_match_table = audio_ref_clk_match,
  671. .suppress_bind_attrs = true,
  672. },
  673. .probe = audio_ref_clk_probe,
  674. .remove = audio_ref_clk_remove,
  675. };
  676. int audio_ref_clk_platform_init(void)
  677. {
  678. return platform_driver_register(&audio_ref_clk_driver);
  679. }
  680. void audio_ref_clk_platform_exit(void)
  681. {
  682. platform_driver_unregister(&audio_ref_clk_driver);
  683. }
  684. MODULE_DESCRIPTION("Audio Ref Up Clock module platform driver");
  685. MODULE_LICENSE("GPL v2");