bolero-cdc.c 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /* Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.
  3. */
  4. #include <linux/of_platform.h>
  5. #include <linux/module.h>
  6. #include <linux/io.h>
  7. #include <linux/init.h>
  8. #include <linux/platform_device.h>
  9. #include <linux/printk.h>
  10. #include <linux/delay.h>
  11. #include <linux/kernel.h>
  12. #include <linux/clk.h>
  13. #include <soc/snd_event.h>
  14. #include <linux/pm_runtime.h>
  15. #include <soc/swr-common.h>
  16. #include "bolero-cdc.h"
  17. #include "internal.h"
  18. #include "bolero-clk-rsc.h"
  19. #define DRV_NAME "bolero_codec"
  20. #define BOLERO_VERSION_1_0 0x0001
  21. #define BOLERO_VERSION_1_1 0x0002
  22. #define BOLERO_VERSION_1_2 0x0003
  23. #define BOLERO_VERSION_ENTRY_SIZE 32
  24. #define BOLERO_CDC_STRING_LEN 80
  25. static const struct snd_soc_component_driver bolero;
  26. /* pm runtime auto suspend timer in msecs */
  27. #define BOLERO_AUTO_SUSPEND_DELAY 100 /* delay in msec */
  28. /* MCLK_MUX table for all macros */
  29. static u16 bolero_mclk_mux_tbl[MAX_MACRO][MCLK_MUX_MAX] = {
  30. {TX_MACRO, VA_MACRO},
  31. {TX_MACRO, RX_MACRO},
  32. {TX_MACRO, WSA_MACRO},
  33. {TX_MACRO, VA_MACRO},
  34. };
  35. static bool bolero_is_valid_codec_dev(struct device *dev);
  36. int bolero_set_port_map(struct snd_soc_component *component,
  37. u32 size, void *data)
  38. {
  39. struct bolero_priv *priv = NULL;
  40. struct swr_mstr_port_map *map = NULL;
  41. u16 idx;
  42. if (!component || (size == 0) || !data)
  43. return -EINVAL;
  44. priv = snd_soc_component_get_drvdata(component);
  45. if (!priv)
  46. return -EINVAL;
  47. if (!bolero_is_valid_codec_dev(priv->dev)) {
  48. dev_err(priv->dev, "%s: invalid codec\n", __func__);
  49. return -EINVAL;
  50. }
  51. map = (struct swr_mstr_port_map *)data;
  52. for (idx = 0; idx < size; idx++) {
  53. if (priv->macro_params[map->id].set_port_map)
  54. priv->macro_params[map->id].set_port_map(component,
  55. map->uc,
  56. SWR_MSTR_PORT_LEN,
  57. map->swr_port_params);
  58. map += 1;
  59. }
  60. return 0;
  61. }
  62. EXPORT_SYMBOL(bolero_set_port_map);
  63. static void bolero_ahb_write_device(char __iomem *io_base,
  64. u16 reg, u8 value)
  65. {
  66. u32 temp = (u32)(value) & 0x000000FF;
  67. iowrite32(temp, io_base + reg);
  68. }
  69. static void bolero_ahb_read_device(char __iomem *io_base,
  70. u16 reg, u8 *value)
  71. {
  72. u32 temp;
  73. temp = ioread32(io_base + reg);
  74. *value = (u8)temp;
  75. }
  76. static int __bolero_reg_read(struct bolero_priv *priv,
  77. u16 macro_id, u16 reg, u8 *val)
  78. {
  79. int ret = 0;
  80. mutex_lock(&priv->clk_lock);
  81. if (!priv->dev_up) {
  82. dev_dbg_ratelimited(priv->dev,
  83. "%s: SSR in progress, exit\n", __func__);
  84. ret = -EINVAL;
  85. goto ssr_err;
  86. }
  87. if (priv->macro_params[VA_MACRO].dev)
  88. pm_runtime_get_sync(priv->macro_params[VA_MACRO].dev);
  89. /* Request Clk before register access */
  90. ret = bolero_clk_rsc_request_clock(priv->macro_params[macro_id].dev,
  91. priv->macro_params[macro_id].default_clk_id,
  92. priv->macro_params[macro_id].clk_id_req,
  93. true);
  94. if (ret < 0) {
  95. dev_err_ratelimited(priv->dev,
  96. "%s: Failed to enable clock, ret:%d\n", __func__, ret);
  97. goto err;
  98. }
  99. bolero_ahb_read_device(
  100. priv->macro_params[macro_id].io_base, reg, val);
  101. bolero_clk_rsc_request_clock(priv->macro_params[macro_id].dev,
  102. priv->macro_params[macro_id].default_clk_id,
  103. priv->macro_params[macro_id].clk_id_req,
  104. false);
  105. err:
  106. if (priv->macro_params[VA_MACRO].dev) {
  107. pm_runtime_mark_last_busy(priv->macro_params[VA_MACRO].dev);
  108. pm_runtime_put_autosuspend(priv->macro_params[VA_MACRO].dev);
  109. }
  110. ssr_err:
  111. mutex_unlock(&priv->clk_lock);
  112. return ret;
  113. }
  114. static int __bolero_reg_write(struct bolero_priv *priv,
  115. u16 macro_id, u16 reg, u8 val)
  116. {
  117. int ret = 0;
  118. mutex_lock(&priv->clk_lock);
  119. if (!priv->dev_up) {
  120. dev_dbg_ratelimited(priv->dev,
  121. "%s: SSR in progress, exit\n", __func__);
  122. ret = -EINVAL;
  123. goto ssr_err;
  124. }
  125. if (priv->macro_params[VA_MACRO].dev)
  126. pm_runtime_get_sync(priv->macro_params[VA_MACRO].dev);
  127. /* Request Clk before register access */
  128. ret = bolero_clk_rsc_request_clock(priv->macro_params[macro_id].dev,
  129. priv->macro_params[macro_id].default_clk_id,
  130. priv->macro_params[macro_id].clk_id_req,
  131. true);
  132. if (ret < 0) {
  133. dev_err_ratelimited(priv->dev,
  134. "%s: Failed to enable clock, ret:%d\n", __func__, ret);
  135. goto err;
  136. }
  137. bolero_ahb_write_device(
  138. priv->macro_params[macro_id].io_base, reg, val);
  139. bolero_clk_rsc_request_clock(priv->macro_params[macro_id].dev,
  140. priv->macro_params[macro_id].default_clk_id,
  141. priv->macro_params[macro_id].clk_id_req,
  142. false);
  143. err:
  144. if (priv->macro_params[VA_MACRO].dev) {
  145. pm_runtime_mark_last_busy(priv->macro_params[VA_MACRO].dev);
  146. pm_runtime_put_autosuspend(priv->macro_params[VA_MACRO].dev);
  147. }
  148. ssr_err:
  149. mutex_unlock(&priv->clk_lock);
  150. return ret;
  151. }
  152. static int bolero_cdc_update_wcd_event(void *handle, u16 event, u32 data)
  153. {
  154. struct bolero_priv *priv = (struct bolero_priv *)handle;
  155. if (!priv) {
  156. pr_err("%s:Invalid bolero priv handle\n", __func__);
  157. return -EINVAL;
  158. }
  159. switch (event) {
  160. case WCD_BOLERO_EVT_RX_MUTE:
  161. if (priv->macro_params[RX_MACRO].event_handler)
  162. priv->macro_params[RX_MACRO].event_handler(
  163. priv->component,
  164. BOLERO_MACRO_EVT_RX_MUTE, data);
  165. break;
  166. case WCD_BOLERO_EVT_IMPED_TRUE:
  167. if (priv->macro_params[RX_MACRO].event_handler)
  168. priv->macro_params[RX_MACRO].event_handler(
  169. priv->component,
  170. BOLERO_MACRO_EVT_IMPED_TRUE, data);
  171. break;
  172. case WCD_BOLERO_EVT_IMPED_FALSE:
  173. if (priv->macro_params[RX_MACRO].event_handler)
  174. priv->macro_params[RX_MACRO].event_handler(
  175. priv->component,
  176. BOLERO_MACRO_EVT_IMPED_FALSE, data);
  177. break;
  178. default:
  179. dev_err(priv->dev, "%s: Invalid event %d trigger from wcd\n",
  180. __func__, event);
  181. return -EINVAL;
  182. }
  183. return 0;
  184. }
  185. static int bolero_cdc_register_notifier(void *handle,
  186. struct notifier_block *nblock,
  187. bool enable)
  188. {
  189. struct bolero_priv *priv = (struct bolero_priv *)handle;
  190. if (!priv) {
  191. pr_err("%s: bolero priv is null\n", __func__);
  192. return -EINVAL;
  193. }
  194. if (enable)
  195. return blocking_notifier_chain_register(&priv->notifier,
  196. nblock);
  197. return blocking_notifier_chain_unregister(&priv->notifier,
  198. nblock);
  199. }
  200. static void bolero_cdc_notifier_call(struct bolero_priv *priv,
  201. u32 data)
  202. {
  203. dev_dbg(priv->dev, "%s: notifier call, data:%d\n", __func__, data);
  204. blocking_notifier_call_chain(&priv->notifier,
  205. data, (void *)priv->wcd_dev);
  206. }
  207. static bool bolero_is_valid_child_dev(struct device *dev)
  208. {
  209. if (of_device_is_compatible(dev->parent->of_node, "qcom,bolero-codec"))
  210. return true;
  211. return false;
  212. }
  213. static bool bolero_is_valid_codec_dev(struct device *dev)
  214. {
  215. if (of_device_is_compatible(dev->of_node, "qcom,bolero-codec"))
  216. return true;
  217. return false;
  218. }
  219. /**
  220. * bolero_clear_amic_tx_hold - clears AMIC register on analog codec
  221. *
  222. * @dev: bolero device ptr.
  223. *
  224. */
  225. void bolero_clear_amic_tx_hold(struct device *dev, u16 adc_n)
  226. {
  227. struct bolero_priv *priv;
  228. u16 event;
  229. u16 amic = 0;
  230. if (!dev) {
  231. pr_err("%s: dev is null\n", __func__);
  232. return;
  233. }
  234. if (!bolero_is_valid_codec_dev(dev)) {
  235. pr_err("%s: invalid codec\n", __func__);
  236. return;
  237. }
  238. priv = dev_get_drvdata(dev);
  239. if (!priv) {
  240. dev_err(dev, "%s: priv is null\n", __func__);
  241. return;
  242. }
  243. event = BOLERO_WCD_EVT_TX_CH_HOLD_CLEAR;
  244. if (adc_n == BOLERO_ADC0)
  245. amic = 0x1;
  246. else if (adc_n == BOLERO_ADC1)
  247. amic = 0x2;
  248. else if (adc_n == BOLERO_ADC2)
  249. amic = 0x2;
  250. else if (adc_n == BOLERO_ADC3)
  251. amic = 0x3;
  252. else
  253. return;
  254. bolero_cdc_notifier_call(priv, (amic << 0x10 | event));
  255. }
  256. EXPORT_SYMBOL(bolero_clear_amic_tx_hold);
  257. /**
  258. * bolero_get_device_ptr - Get child or macro device ptr
  259. *
  260. * @dev: bolero device ptr.
  261. * @macro_id: ID of macro calling this API.
  262. *
  263. * Returns dev ptr on success or NULL on error.
  264. */
  265. struct device *bolero_get_device_ptr(struct device *dev, u16 macro_id)
  266. {
  267. struct bolero_priv *priv;
  268. if (!dev) {
  269. pr_err("%s: dev is null\n", __func__);
  270. return NULL;
  271. }
  272. if (!bolero_is_valid_codec_dev(dev)) {
  273. pr_err("%s: invalid codec\n", __func__);
  274. return NULL;
  275. }
  276. priv = dev_get_drvdata(dev);
  277. if (!priv || (macro_id >= MAX_MACRO)) {
  278. dev_err(dev, "%s: priv is null or invalid macro\n", __func__);
  279. return NULL;
  280. }
  281. return priv->macro_params[macro_id].dev;
  282. }
  283. EXPORT_SYMBOL(bolero_get_device_ptr);
  284. /**
  285. * bolero_get_rsc_clk_device_ptr - Get rsc clk device ptr
  286. *
  287. * @dev: bolero device ptr.
  288. *
  289. * Returns dev ptr on success or NULL on error.
  290. */
  291. struct device *bolero_get_rsc_clk_device_ptr(struct device *dev)
  292. {
  293. struct bolero_priv *priv;
  294. if (!dev) {
  295. pr_err("%s: dev is null\n", __func__);
  296. return NULL;
  297. }
  298. if (!bolero_is_valid_codec_dev(dev)) {
  299. pr_err("%s: invalid codec\n", __func__);
  300. return NULL;
  301. }
  302. priv = dev_get_drvdata(dev);
  303. if (!priv) {
  304. dev_err(dev, "%s: priv is null\n", __func__);
  305. return NULL;
  306. }
  307. return priv->clk_dev;
  308. }
  309. EXPORT_SYMBOL(bolero_get_rsc_clk_device_ptr);
  310. static int bolero_copy_dais_from_macro(struct bolero_priv *priv)
  311. {
  312. struct snd_soc_dai_driver *dai_ptr;
  313. u16 macro_idx;
  314. /* memcpy into bolero_dais all macro dais */
  315. if (!priv->bolero_dais)
  316. priv->bolero_dais = devm_kzalloc(priv->dev,
  317. priv->num_dais *
  318. sizeof(
  319. struct snd_soc_dai_driver),
  320. GFP_KERNEL);
  321. if (!priv->bolero_dais)
  322. return -ENOMEM;
  323. dai_ptr = priv->bolero_dais;
  324. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  325. if (priv->macro_params[macro_idx].dai_ptr) {
  326. memcpy(dai_ptr,
  327. priv->macro_params[macro_idx].dai_ptr,
  328. priv->macro_params[macro_idx].num_dais *
  329. sizeof(struct snd_soc_dai_driver));
  330. dai_ptr += priv->macro_params[macro_idx].num_dais;
  331. }
  332. }
  333. return 0;
  334. }
  335. /**
  336. * bolero_register_res_clk - Registers rsc clk driver to bolero
  337. *
  338. * @dev: rsc clk device ptr.
  339. * @rsc_clk_cb: event handler callback for notifications like SSR
  340. *
  341. * Returns 0 on success or -EINVAL on error.
  342. */
  343. int bolero_register_res_clk(struct device *dev, rsc_clk_cb_t rsc_clk_cb)
  344. {
  345. struct bolero_priv *priv;
  346. if (!dev || !rsc_clk_cb) {
  347. pr_err("%s: dev or rsc_clk_cb is null\n", __func__);
  348. return -EINVAL;
  349. }
  350. if (!bolero_is_valid_child_dev(dev)) {
  351. dev_err(dev, "%s: child device :%pK not added yet\n",
  352. __func__, dev);
  353. return -EINVAL;
  354. }
  355. priv = dev_get_drvdata(dev->parent);
  356. if (!priv) {
  357. dev_err(dev, "%s: priv is null\n", __func__);
  358. return -EINVAL;
  359. }
  360. priv->clk_dev = dev;
  361. priv->rsc_clk_cb = rsc_clk_cb;
  362. return 0;
  363. }
  364. EXPORT_SYMBOL(bolero_register_res_clk);
  365. /**
  366. * bolero_unregister_res_clk - Unregisters rsc clk driver from bolero
  367. *
  368. * @dev: resource clk device ptr.
  369. */
  370. void bolero_unregister_res_clk(struct device *dev)
  371. {
  372. struct bolero_priv *priv;
  373. if (!dev) {
  374. pr_err("%s: dev is NULL\n", __func__);
  375. return;
  376. }
  377. if (!bolero_is_valid_child_dev(dev)) {
  378. dev_err(dev, "%s: child device :%pK not added\n",
  379. __func__, dev);
  380. return;
  381. }
  382. priv = dev_get_drvdata(dev->parent);
  383. if (!priv) {
  384. dev_err(dev, "%s: priv is null\n", __func__);
  385. return;
  386. }
  387. priv->clk_dev = NULL;
  388. priv->rsc_clk_cb = NULL;
  389. }
  390. EXPORT_SYMBOL(bolero_unregister_res_clk);
  391. /**
  392. * bolero_register_macro - Registers macro to bolero
  393. *
  394. * @dev: macro device ptr.
  395. * @macro_id: ID of macro calling this API.
  396. * @ops: macro params to register.
  397. *
  398. * Returns 0 on success or -EINVAL on error.
  399. */
  400. int bolero_register_macro(struct device *dev, u16 macro_id,
  401. struct macro_ops *ops)
  402. {
  403. struct bolero_priv *priv;
  404. int ret = -EINVAL;
  405. if (!dev || !ops) {
  406. pr_err("%s: dev or ops is null\n", __func__);
  407. return -EINVAL;
  408. }
  409. if (!bolero_is_valid_child_dev(dev)) {
  410. dev_err(dev, "%s: child device for macro:%d not added yet\n",
  411. __func__, macro_id);
  412. return -EINVAL;
  413. }
  414. priv = dev_get_drvdata(dev->parent);
  415. if (!priv || (macro_id >= MAX_MACRO)) {
  416. dev_err(dev, "%s: priv is null or invalid macro\n", __func__);
  417. return -EINVAL;
  418. }
  419. priv->macro_params[macro_id].clk_id_req = ops->clk_id_req;
  420. priv->macro_params[macro_id].default_clk_id = ops->default_clk_id;
  421. priv->macro_params[macro_id].init = ops->init;
  422. priv->macro_params[macro_id].exit = ops->exit;
  423. priv->macro_params[macro_id].io_base = ops->io_base;
  424. priv->macro_params[macro_id].num_dais = ops->num_dais;
  425. priv->macro_params[macro_id].dai_ptr = ops->dai_ptr;
  426. priv->macro_params[macro_id].event_handler = ops->event_handler;
  427. priv->macro_params[macro_id].set_port_map = ops->set_port_map;
  428. priv->macro_params[macro_id].dev = dev;
  429. priv->current_mclk_mux_macro[macro_id] =
  430. bolero_mclk_mux_tbl[macro_id][MCLK_MUX0];
  431. if (macro_id == TX_MACRO)
  432. priv->macro_params[macro_id].reg_wake_irq = ops->reg_wake_irq;
  433. priv->num_dais += ops->num_dais;
  434. priv->num_macros_registered++;
  435. priv->macros_supported[macro_id] = true;
  436. if (priv->num_macros_registered == priv->num_macros) {
  437. ret = bolero_copy_dais_from_macro(priv);
  438. if (ret < 0) {
  439. dev_err(dev, "%s: copy_dais failed\n", __func__);
  440. return ret;
  441. }
  442. if (priv->macros_supported[TX_MACRO] == false) {
  443. bolero_mclk_mux_tbl[WSA_MACRO][MCLK_MUX0] = WSA_MACRO;
  444. priv->current_mclk_mux_macro[WSA_MACRO] = WSA_MACRO;
  445. bolero_mclk_mux_tbl[VA_MACRO][MCLK_MUX0] = VA_MACRO;
  446. priv->current_mclk_mux_macro[VA_MACRO] = VA_MACRO;
  447. }
  448. ret = snd_soc_register_component(dev->parent, &bolero,
  449. priv->bolero_dais, priv->num_dais);
  450. if (ret < 0) {
  451. dev_err(dev, "%s: register codec failed\n", __func__);
  452. return ret;
  453. }
  454. }
  455. return 0;
  456. }
  457. EXPORT_SYMBOL(bolero_register_macro);
  458. /**
  459. * bolero_unregister_macro - De-Register macro from bolero
  460. *
  461. * @dev: macro device ptr.
  462. * @macro_id: ID of macro calling this API.
  463. *
  464. */
  465. void bolero_unregister_macro(struct device *dev, u16 macro_id)
  466. {
  467. struct bolero_priv *priv;
  468. if (!dev) {
  469. pr_err("%s: dev is null\n", __func__);
  470. return;
  471. }
  472. if (!bolero_is_valid_child_dev(dev)) {
  473. dev_err(dev, "%s: macro:%d not in valid registered macro-list\n",
  474. __func__, macro_id);
  475. return;
  476. }
  477. priv = dev_get_drvdata(dev->parent);
  478. if (!priv || (macro_id >= MAX_MACRO)) {
  479. dev_err(dev, "%s: priv is null or invalid macro\n", __func__);
  480. return;
  481. }
  482. priv->macro_params[macro_id].init = NULL;
  483. priv->macro_params[macro_id].num_dais = 0;
  484. priv->macro_params[macro_id].dai_ptr = NULL;
  485. priv->macro_params[macro_id].event_handler = NULL;
  486. priv->macro_params[macro_id].dev = NULL;
  487. if (macro_id == TX_MACRO)
  488. priv->macro_params[macro_id].reg_wake_irq = NULL;
  489. priv->num_dais -= priv->macro_params[macro_id].num_dais;
  490. priv->num_macros_registered--;
  491. /* UNREGISTER CODEC HERE */
  492. if (priv->num_macros - 1 == priv->num_macros_registered)
  493. snd_soc_unregister_component(dev->parent);
  494. }
  495. EXPORT_SYMBOL(bolero_unregister_macro);
  496. static ssize_t bolero_version_read(struct snd_info_entry *entry,
  497. void *file_private_data,
  498. struct file *file,
  499. char __user *buf, size_t count,
  500. loff_t pos)
  501. {
  502. struct bolero_priv *priv;
  503. char buffer[BOLERO_VERSION_ENTRY_SIZE];
  504. int len = 0;
  505. priv = (struct bolero_priv *) entry->private_data;
  506. if (!priv) {
  507. pr_err("%s: bolero priv is null\n", __func__);
  508. return -EINVAL;
  509. }
  510. switch (priv->version) {
  511. case BOLERO_VERSION_1_0:
  512. len = snprintf(buffer, sizeof(buffer), "BOLERO_1_0\n");
  513. break;
  514. case BOLERO_VERSION_1_1:
  515. len = snprintf(buffer, sizeof(buffer), "BOLERO_1_1\n");
  516. break;
  517. case BOLERO_VERSION_1_2:
  518. len = snprintf(buffer, sizeof(buffer), "BOLERO_1_2\n");
  519. break;
  520. default:
  521. len = snprintf(buffer, sizeof(buffer), "VER_UNDEFINED\n");
  522. }
  523. return simple_read_from_buffer(buf, count, &pos, buffer, len);
  524. }
  525. static int bolero_ssr_enable(struct device *dev, void *data)
  526. {
  527. struct bolero_priv *priv = data;
  528. int macro_idx;
  529. if (priv->initial_boot) {
  530. priv->initial_boot = false;
  531. return 0;
  532. }
  533. if (priv->rsc_clk_cb)
  534. priv->rsc_clk_cb(priv->clk_dev, BOLERO_MACRO_EVT_SSR_UP);
  535. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  536. if (priv->macro_params[macro_idx].event_handler)
  537. priv->macro_params[macro_idx].event_handler(
  538. priv->component,
  539. BOLERO_MACRO_EVT_CLK_RESET, 0x0);
  540. }
  541. regcache_cache_only(priv->regmap, false);
  542. mutex_lock(&priv->clk_lock);
  543. priv->dev_up = true;
  544. mutex_unlock(&priv->clk_lock);
  545. /* call ssr event for supported macros */
  546. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  547. if (!priv->macro_params[macro_idx].event_handler)
  548. continue;
  549. priv->macro_params[macro_idx].event_handler(
  550. priv->component,
  551. BOLERO_MACRO_EVT_SSR_UP, 0x0);
  552. }
  553. bolero_cdc_notifier_call(priv, BOLERO_WCD_EVT_SSR_UP);
  554. return 0;
  555. }
  556. static void bolero_ssr_disable(struct device *dev, void *data)
  557. {
  558. struct bolero_priv *priv = data;
  559. int macro_idx;
  560. bolero_cdc_notifier_call(priv, BOLERO_WCD_EVT_PA_OFF_PRE_SSR);
  561. regcache_cache_only(priv->regmap, true);
  562. mutex_lock(&priv->clk_lock);
  563. priv->dev_up = false;
  564. mutex_unlock(&priv->clk_lock);
  565. if (priv->rsc_clk_cb)
  566. priv->rsc_clk_cb(priv->clk_dev, BOLERO_MACRO_EVT_SSR_DOWN);
  567. /* call ssr event for supported macros */
  568. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  569. if (!priv->macro_params[macro_idx].event_handler)
  570. continue;
  571. priv->macro_params[macro_idx].event_handler(
  572. priv->component,
  573. BOLERO_MACRO_EVT_SSR_DOWN, 0x0);
  574. }
  575. bolero_cdc_notifier_call(priv, BOLERO_WCD_EVT_SSR_DOWN);
  576. }
  577. static struct snd_info_entry_ops bolero_info_ops = {
  578. .read = bolero_version_read,
  579. };
  580. static const struct snd_event_ops bolero_ssr_ops = {
  581. .enable = bolero_ssr_enable,
  582. .disable = bolero_ssr_disable,
  583. };
  584. /*
  585. * bolero_info_create_codec_entry - creates bolero module
  586. * @codec_root: The parent directory
  587. * @component: Codec component instance
  588. *
  589. * Creates bolero module and version entry under the given
  590. * parent directory.
  591. *
  592. * Return: 0 on success or negative error code on failure.
  593. */
  594. int bolero_info_create_codec_entry(struct snd_info_entry *codec_root,
  595. struct snd_soc_component *component)
  596. {
  597. struct snd_info_entry *version_entry;
  598. struct bolero_priv *priv;
  599. struct snd_soc_card *card;
  600. if (!codec_root || !component)
  601. return -EINVAL;
  602. priv = snd_soc_component_get_drvdata(component);
  603. if (priv->entry) {
  604. dev_dbg(priv->dev,
  605. "%s:bolero module already created\n", __func__);
  606. return 0;
  607. }
  608. card = component->card;
  609. priv->entry = snd_info_create_subdir(codec_root->module,
  610. "bolero", codec_root);
  611. if (!priv->entry) {
  612. dev_dbg(component->dev, "%s: failed to create bolero entry\n",
  613. __func__);
  614. return -ENOMEM;
  615. }
  616. version_entry = snd_info_create_card_entry(card->snd_card,
  617. "version",
  618. priv->entry);
  619. if (!version_entry) {
  620. dev_err(component->dev, "%s: failed to create bolero version entry\n",
  621. __func__);
  622. return -ENOMEM;
  623. }
  624. version_entry->private_data = priv;
  625. version_entry->size = BOLERO_VERSION_ENTRY_SIZE;
  626. version_entry->content = SNDRV_INFO_CONTENT_DATA;
  627. version_entry->c.ops = &bolero_info_ops;
  628. if (snd_info_register(version_entry) < 0) {
  629. snd_info_free_entry(version_entry);
  630. return -ENOMEM;
  631. }
  632. priv->version_entry = version_entry;
  633. return 0;
  634. }
  635. EXPORT_SYMBOL(bolero_info_create_codec_entry);
  636. /**
  637. * bolero_register_wake_irq - Register wake irq of Tx macro
  638. *
  639. * @component: codec component ptr.
  640. * @ipc_wakeup: bool to identify ipc_wakeup to be used or HW interrupt line.
  641. *
  642. * Return: 0 on success or negative error code on failure.
  643. */
  644. int bolero_register_wake_irq(struct snd_soc_component *component,
  645. u32 ipc_wakeup)
  646. {
  647. struct bolero_priv *priv = NULL;
  648. if (!component)
  649. return -EINVAL;
  650. priv = snd_soc_component_get_drvdata(component);
  651. if (!priv)
  652. return -EINVAL;
  653. if (!bolero_is_valid_codec_dev(priv->dev)) {
  654. dev_err(component->dev, "%s: invalid codec\n", __func__);
  655. return -EINVAL;
  656. }
  657. if (priv->macro_params[TX_MACRO].reg_wake_irq)
  658. priv->macro_params[TX_MACRO].reg_wake_irq(
  659. component, ipc_wakeup);
  660. return 0;
  661. }
  662. EXPORT_SYMBOL(bolero_register_wake_irq);
  663. static int bolero_soc_codec_probe(struct snd_soc_component *component)
  664. {
  665. struct bolero_priv *priv = dev_get_drvdata(component->dev);
  666. int macro_idx, ret = 0;
  667. snd_soc_component_init_regmap(component, priv->regmap);
  668. /* call init for supported macros */
  669. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  670. if (priv->macro_params[macro_idx].init) {
  671. ret = priv->macro_params[macro_idx].init(component);
  672. if (ret < 0) {
  673. dev_err(component->dev,
  674. "%s: init for macro %d failed\n",
  675. __func__, macro_idx);
  676. goto err;
  677. }
  678. }
  679. }
  680. priv->component = component;
  681. /*
  682. * In order for the ADIE RTC to differentiate between targets
  683. * version info is used.
  684. * Assign 1.0 for target with only one macro
  685. * Assign 1.1 for target with two macros
  686. * Assign 1.2 for target with more than two macros
  687. */
  688. if (priv->num_macros_registered == 1)
  689. priv->version = BOLERO_VERSION_1_0;
  690. else if (priv->num_macros_registered == 2)
  691. priv->version = BOLERO_VERSION_1_1;
  692. else if (priv->num_macros_registered > 2)
  693. priv->version = BOLERO_VERSION_1_2;
  694. ret = snd_event_client_register(priv->dev, &bolero_ssr_ops, priv);
  695. if (!ret) {
  696. snd_event_notify(priv->dev, SND_EVENT_UP);
  697. } else {
  698. dev_err(component->dev,
  699. "%s: Registration with SND event FWK failed ret = %d\n",
  700. __func__, ret);
  701. goto err;
  702. }
  703. dev_dbg(component->dev, "%s: bolero soc codec probe success\n",
  704. __func__);
  705. err:
  706. return ret;
  707. }
  708. static void bolero_soc_codec_remove(struct snd_soc_component *component)
  709. {
  710. struct bolero_priv *priv = dev_get_drvdata(component->dev);
  711. int macro_idx;
  712. snd_event_client_deregister(priv->dev);
  713. /* call exit for supported macros */
  714. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++)
  715. if (priv->macro_params[macro_idx].exit)
  716. priv->macro_params[macro_idx].exit(component);
  717. return;
  718. }
  719. static const struct snd_soc_component_driver bolero = {
  720. .name = DRV_NAME,
  721. .probe = bolero_soc_codec_probe,
  722. .remove = bolero_soc_codec_remove,
  723. };
  724. static void bolero_add_child_devices(struct work_struct *work)
  725. {
  726. struct bolero_priv *priv;
  727. bool split_codec = false;
  728. struct platform_device *pdev;
  729. struct device_node *node;
  730. int ret = 0, count = 0;
  731. struct wcd_ctrl_platform_data *platdata = NULL;
  732. char plat_dev_name[BOLERO_CDC_STRING_LEN] = "";
  733. priv = container_of(work, struct bolero_priv,
  734. bolero_add_child_devices_work);
  735. if (!priv) {
  736. pr_err("%s: Memory for bolero priv does not exist\n",
  737. __func__);
  738. return;
  739. }
  740. if (!priv->dev || !priv->dev->of_node) {
  741. dev_err(priv->dev, "%s: DT node for bolero does not exist\n",
  742. __func__);
  743. return;
  744. }
  745. platdata = &priv->plat_data;
  746. priv->child_count = 0;
  747. for_each_available_child_of_node(priv->dev->of_node, node) {
  748. split_codec = false;
  749. if (of_find_property(node, "qcom,split-codec", NULL)) {
  750. split_codec = true;
  751. dev_dbg(priv->dev, "%s: split codec slave exists\n",
  752. __func__);
  753. }
  754. strlcpy(plat_dev_name, node->name,
  755. (BOLERO_CDC_STRING_LEN - 1));
  756. pdev = platform_device_alloc(plat_dev_name, -1);
  757. if (!pdev) {
  758. dev_err(priv->dev, "%s: pdev memory alloc failed\n",
  759. __func__);
  760. ret = -ENOMEM;
  761. goto err;
  762. }
  763. pdev->dev.parent = priv->dev;
  764. pdev->dev.of_node = node;
  765. if (split_codec) {
  766. priv->dev->platform_data = platdata;
  767. priv->wcd_dev = &pdev->dev;
  768. }
  769. ret = platform_device_add(pdev);
  770. if (ret) {
  771. dev_err(&pdev->dev,
  772. "%s: Cannot add platform device\n",
  773. __func__);
  774. platform_device_put(pdev);
  775. goto fail_pdev_add;
  776. }
  777. if (priv->child_count < BOLERO_CDC_CHILD_DEVICES_MAX)
  778. priv->pdev_child_devices[priv->child_count++] = pdev;
  779. else
  780. goto err;
  781. }
  782. return;
  783. fail_pdev_add:
  784. for (count = 0; count < priv->child_count; count++)
  785. platform_device_put(priv->pdev_child_devices[count]);
  786. err:
  787. return;
  788. }
  789. static int bolero_probe(struct platform_device *pdev)
  790. {
  791. struct bolero_priv *priv;
  792. u32 num_macros = 0;
  793. int ret;
  794. struct clk *lpass_core_hw_vote = NULL;
  795. struct clk *lpass_audio_hw_vote = NULL;
  796. priv = devm_kzalloc(&pdev->dev, sizeof(struct bolero_priv),
  797. GFP_KERNEL);
  798. if (!priv)
  799. return -ENOMEM;
  800. ret = of_property_read_u32(pdev->dev.of_node, "qcom,num-macros",
  801. &num_macros);
  802. if (ret) {
  803. dev_err(&pdev->dev,
  804. "%s:num-macros property not found\n",
  805. __func__);
  806. return ret;
  807. }
  808. priv->num_macros = num_macros;
  809. if (priv->num_macros > MAX_MACRO) {
  810. dev_err(&pdev->dev,
  811. "%s:num_macros(%d) > MAX_MACRO(%d) than supported\n",
  812. __func__, priv->num_macros, MAX_MACRO);
  813. return -EINVAL;
  814. }
  815. priv->va_without_decimation = of_property_read_bool(pdev->dev.of_node,
  816. "qcom,va-without-decimation");
  817. if (priv->va_without_decimation)
  818. bolero_reg_access[VA_MACRO] = bolero_va_top_reg_access;
  819. priv->dev = &pdev->dev;
  820. priv->dev_up = true;
  821. priv->initial_boot = true;
  822. priv->regmap = bolero_regmap_init(priv->dev,
  823. &bolero_regmap_config);
  824. if (IS_ERR_OR_NULL((void *)(priv->regmap))) {
  825. dev_err(&pdev->dev, "%s:regmap init failed\n", __func__);
  826. return -EINVAL;
  827. }
  828. priv->read_dev = __bolero_reg_read;
  829. priv->write_dev = __bolero_reg_write;
  830. priv->plat_data.handle = (void *) priv;
  831. priv->plat_data.update_wcd_event = bolero_cdc_update_wcd_event;
  832. priv->plat_data.register_notifier = bolero_cdc_register_notifier;
  833. dev_set_drvdata(&pdev->dev, priv);
  834. mutex_init(&priv->io_lock);
  835. mutex_init(&priv->clk_lock);
  836. INIT_WORK(&priv->bolero_add_child_devices_work,
  837. bolero_add_child_devices);
  838. schedule_work(&priv->bolero_add_child_devices_work);
  839. /* Register LPASS core hw vote */
  840. lpass_core_hw_vote = devm_clk_get(&pdev->dev, "lpass_core_hw_vote");
  841. if (IS_ERR(lpass_core_hw_vote)) {
  842. ret = PTR_ERR(lpass_core_hw_vote);
  843. dev_dbg(&pdev->dev, "%s: clk get %s failed %d\n",
  844. __func__, "lpass_core_hw_vote", ret);
  845. lpass_core_hw_vote = NULL;
  846. ret = 0;
  847. }
  848. priv->lpass_core_hw_vote = lpass_core_hw_vote;
  849. /* Register LPASS audio hw vote */
  850. lpass_audio_hw_vote = devm_clk_get(&pdev->dev, "lpass_audio_hw_vote");
  851. if (IS_ERR(lpass_audio_hw_vote)) {
  852. ret = PTR_ERR(lpass_audio_hw_vote);
  853. dev_dbg(&pdev->dev, "%s: clk get %s failed %d\n",
  854. __func__, "lpass_audio_hw_vote", ret);
  855. lpass_audio_hw_vote = NULL;
  856. ret = 0;
  857. }
  858. priv->lpass_audio_hw_vote = lpass_audio_hw_vote;
  859. return 0;
  860. }
  861. static int bolero_remove(struct platform_device *pdev)
  862. {
  863. struct bolero_priv *priv = dev_get_drvdata(&pdev->dev);
  864. if (!priv)
  865. return -EINVAL;
  866. of_platform_depopulate(&pdev->dev);
  867. mutex_destroy(&priv->io_lock);
  868. mutex_destroy(&priv->clk_lock);
  869. return 0;
  870. }
  871. int bolero_runtime_resume(struct device *dev)
  872. {
  873. struct bolero_priv *priv = dev_get_drvdata(dev->parent);
  874. int ret = 0;
  875. if (priv->lpass_core_hw_vote == NULL) {
  876. dev_dbg(dev, "%s: Invalid lpass core hw node\n", __func__);
  877. return 0;
  878. }
  879. ret = clk_prepare_enable(priv->lpass_core_hw_vote);
  880. if (ret < 0)
  881. dev_err(dev, "%s:lpass core hw enable failed\n",
  882. __func__);
  883. if (priv->lpass_audio_hw_vote == NULL) {
  884. dev_dbg(dev, "%s: Invalid lpass audio hw node\n", __func__);
  885. return 0;
  886. }
  887. ret = clk_prepare_enable(priv->lpass_audio_hw_vote);
  888. if (ret < 0)
  889. dev_err(dev, "%s:lpass audio hw enable failed\n",
  890. __func__);
  891. pm_runtime_set_autosuspend_delay(priv->dev, BOLERO_AUTO_SUSPEND_DELAY);
  892. return 0;
  893. }
  894. EXPORT_SYMBOL(bolero_runtime_resume);
  895. int bolero_runtime_suspend(struct device *dev)
  896. {
  897. struct bolero_priv *priv = dev_get_drvdata(dev->parent);
  898. if (priv->lpass_core_hw_vote != NULL)
  899. clk_disable_unprepare(priv->lpass_core_hw_vote);
  900. else
  901. dev_dbg(dev, "%s: Invalid lpass core hw node\n",
  902. __func__);
  903. if (priv->lpass_audio_hw_vote != NULL)
  904. clk_disable_unprepare(priv->lpass_audio_hw_vote);
  905. else
  906. dev_dbg(dev, "%s: Invalid lpass audio hw node\n",
  907. __func__);
  908. return 0;
  909. }
  910. EXPORT_SYMBOL(bolero_runtime_suspend);
  911. static const struct of_device_id bolero_dt_match[] = {
  912. {.compatible = "qcom,bolero-codec"},
  913. {}
  914. };
  915. MODULE_DEVICE_TABLE(of, bolero_dt_match);
  916. static struct platform_driver bolero_drv = {
  917. .driver = {
  918. .name = "bolero-codec",
  919. .owner = THIS_MODULE,
  920. .of_match_table = bolero_dt_match,
  921. .suppress_bind_attrs = true,
  922. },
  923. .probe = bolero_probe,
  924. .remove = bolero_remove,
  925. };
  926. static int bolero_drv_init(void)
  927. {
  928. return platform_driver_register(&bolero_drv);
  929. }
  930. static void bolero_drv_exit(void)
  931. {
  932. platform_driver_unregister(&bolero_drv);
  933. }
  934. static int __init bolero_init(void)
  935. {
  936. bolero_drv_init();
  937. bolero_clk_rsc_mgr_init();
  938. return 0;
  939. }
  940. module_init(bolero_init);
  941. static void __exit bolero_exit(void)
  942. {
  943. bolero_clk_rsc_mgr_exit();
  944. bolero_drv_exit();
  945. }
  946. module_exit(bolero_exit);
  947. MODULE_DESCRIPTION("Bolero driver");
  948. MODULE_LICENSE("GPL v2");