audio-ext-clk-up.c 17 KB

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