audio-ext-clk-up.c 18 KB

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