bolero-cdc.c 31 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241
  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. case WCD_BOLERO_EVT_RX_COMPANDER_SOFT_RST:
  179. if (priv->macro_params[RX_MACRO].event_handler)
  180. priv->macro_params[RX_MACRO].event_handler(
  181. priv->component,
  182. BOLERO_MACRO_EVT_RX_COMPANDER_SOFT_RST, data);
  183. break;
  184. default:
  185. dev_err(priv->dev, "%s: Invalid event %d trigger from wcd\n",
  186. __func__, event);
  187. return -EINVAL;
  188. }
  189. return 0;
  190. }
  191. static int bolero_cdc_register_notifier(void *handle,
  192. struct notifier_block *nblock,
  193. bool enable)
  194. {
  195. struct bolero_priv *priv = (struct bolero_priv *)handle;
  196. if (!priv) {
  197. pr_err("%s: bolero priv is null\n", __func__);
  198. return -EINVAL;
  199. }
  200. if (enable)
  201. return blocking_notifier_chain_register(&priv->notifier,
  202. nblock);
  203. return blocking_notifier_chain_unregister(&priv->notifier,
  204. nblock);
  205. }
  206. static void bolero_cdc_notifier_call(struct bolero_priv *priv,
  207. u32 data)
  208. {
  209. dev_dbg(priv->dev, "%s: notifier call, data:%d\n", __func__, data);
  210. blocking_notifier_call_chain(&priv->notifier,
  211. data, (void *)priv->wcd_dev);
  212. }
  213. static bool bolero_is_valid_child_dev(struct device *dev)
  214. {
  215. if (of_device_is_compatible(dev->parent->of_node, "qcom,bolero-codec"))
  216. return true;
  217. return false;
  218. }
  219. static bool bolero_is_valid_codec_dev(struct device *dev)
  220. {
  221. if (of_device_is_compatible(dev->of_node, "qcom,bolero-codec"))
  222. return true;
  223. return false;
  224. }
  225. /**
  226. * bolero_clear_amic_tx_hold - clears AMIC register on analog codec
  227. *
  228. * @dev: bolero device ptr.
  229. *
  230. */
  231. void bolero_clear_amic_tx_hold(struct device *dev, u16 adc_n)
  232. {
  233. struct bolero_priv *priv;
  234. u16 event;
  235. u16 amic = 0;
  236. if (!dev) {
  237. pr_err("%s: dev is null\n", __func__);
  238. return;
  239. }
  240. if (!bolero_is_valid_codec_dev(dev)) {
  241. pr_err("%s: invalid codec\n", __func__);
  242. return;
  243. }
  244. priv = dev_get_drvdata(dev);
  245. if (!priv) {
  246. dev_err(dev, "%s: priv is null\n", __func__);
  247. return;
  248. }
  249. event = BOLERO_WCD_EVT_TX_CH_HOLD_CLEAR;
  250. if (adc_n == BOLERO_ADC0)
  251. amic = 0x1;
  252. else if (adc_n == BOLERO_ADC1)
  253. amic = 0x2;
  254. else if (adc_n == BOLERO_ADC2)
  255. amic = 0x2;
  256. else if (adc_n == BOLERO_ADC3)
  257. amic = 0x3;
  258. else
  259. return;
  260. bolero_cdc_notifier_call(priv, (amic << 0x10 | event));
  261. }
  262. EXPORT_SYMBOL(bolero_clear_amic_tx_hold);
  263. /**
  264. * bolero_get_device_ptr - Get child or macro device ptr
  265. *
  266. * @dev: bolero device ptr.
  267. * @macro_id: ID of macro calling this API.
  268. *
  269. * Returns dev ptr on success or NULL on error.
  270. */
  271. struct device *bolero_get_device_ptr(struct device *dev, u16 macro_id)
  272. {
  273. struct bolero_priv *priv;
  274. if (!dev) {
  275. pr_err("%s: dev is null\n", __func__);
  276. return NULL;
  277. }
  278. if (!bolero_is_valid_codec_dev(dev)) {
  279. pr_err("%s: invalid codec\n", __func__);
  280. return NULL;
  281. }
  282. priv = dev_get_drvdata(dev);
  283. if (!priv || (macro_id >= MAX_MACRO)) {
  284. dev_err(dev, "%s: priv is null or invalid macro\n", __func__);
  285. return NULL;
  286. }
  287. return priv->macro_params[macro_id].dev;
  288. }
  289. EXPORT_SYMBOL(bolero_get_device_ptr);
  290. /**
  291. * bolero_get_rsc_clk_device_ptr - Get rsc clk device ptr
  292. *
  293. * @dev: bolero device ptr.
  294. *
  295. * Returns dev ptr on success or NULL on error.
  296. */
  297. struct device *bolero_get_rsc_clk_device_ptr(struct device *dev)
  298. {
  299. struct bolero_priv *priv;
  300. if (!dev) {
  301. pr_err("%s: dev is null\n", __func__);
  302. return NULL;
  303. }
  304. if (!bolero_is_valid_codec_dev(dev)) {
  305. pr_err("%s: invalid codec\n", __func__);
  306. return NULL;
  307. }
  308. priv = dev_get_drvdata(dev);
  309. if (!priv) {
  310. dev_err(dev, "%s: priv is null\n", __func__);
  311. return NULL;
  312. }
  313. return priv->clk_dev;
  314. }
  315. EXPORT_SYMBOL(bolero_get_rsc_clk_device_ptr);
  316. static int bolero_copy_dais_from_macro(struct bolero_priv *priv)
  317. {
  318. struct snd_soc_dai_driver *dai_ptr;
  319. u16 macro_idx;
  320. /* memcpy into bolero_dais all macro dais */
  321. if (!priv->bolero_dais)
  322. priv->bolero_dais = devm_kzalloc(priv->dev,
  323. priv->num_dais *
  324. sizeof(
  325. struct snd_soc_dai_driver),
  326. GFP_KERNEL);
  327. if (!priv->bolero_dais)
  328. return -ENOMEM;
  329. dai_ptr = priv->bolero_dais;
  330. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  331. if (priv->macro_params[macro_idx].dai_ptr) {
  332. memcpy(dai_ptr,
  333. priv->macro_params[macro_idx].dai_ptr,
  334. priv->macro_params[macro_idx].num_dais *
  335. sizeof(struct snd_soc_dai_driver));
  336. dai_ptr += priv->macro_params[macro_idx].num_dais;
  337. }
  338. }
  339. return 0;
  340. }
  341. /**
  342. * bolero_register_res_clk - Registers rsc clk driver to bolero
  343. *
  344. * @dev: rsc clk device ptr.
  345. * @rsc_clk_cb: event handler callback for notifications like SSR
  346. *
  347. * Returns 0 on success or -EINVAL on error.
  348. */
  349. int bolero_register_res_clk(struct device *dev, rsc_clk_cb_t rsc_clk_cb)
  350. {
  351. struct bolero_priv *priv;
  352. if (!dev || !rsc_clk_cb) {
  353. pr_err("%s: dev or rsc_clk_cb is null\n", __func__);
  354. return -EINVAL;
  355. }
  356. if (!bolero_is_valid_child_dev(dev)) {
  357. dev_err(dev, "%s: child device :%pK not added yet\n",
  358. __func__, dev);
  359. return -EINVAL;
  360. }
  361. priv = dev_get_drvdata(dev->parent);
  362. if (!priv) {
  363. dev_err(dev, "%s: priv is null\n", __func__);
  364. return -EINVAL;
  365. }
  366. priv->clk_dev = dev;
  367. priv->rsc_clk_cb = rsc_clk_cb;
  368. return 0;
  369. }
  370. EXPORT_SYMBOL(bolero_register_res_clk);
  371. /**
  372. * bolero_unregister_res_clk - Unregisters rsc clk driver from bolero
  373. *
  374. * @dev: resource clk device ptr.
  375. */
  376. void bolero_unregister_res_clk(struct device *dev)
  377. {
  378. struct bolero_priv *priv;
  379. if (!dev) {
  380. pr_err("%s: dev is NULL\n", __func__);
  381. return;
  382. }
  383. if (!bolero_is_valid_child_dev(dev)) {
  384. dev_err(dev, "%s: child device :%pK not added\n",
  385. __func__, dev);
  386. return;
  387. }
  388. priv = dev_get_drvdata(dev->parent);
  389. if (!priv) {
  390. dev_err(dev, "%s: priv is null\n", __func__);
  391. return;
  392. }
  393. priv->clk_dev = NULL;
  394. priv->rsc_clk_cb = NULL;
  395. }
  396. EXPORT_SYMBOL(bolero_unregister_res_clk);
  397. /**
  398. * bolero_register_macro - Registers macro to bolero
  399. *
  400. * @dev: macro device ptr.
  401. * @macro_id: ID of macro calling this API.
  402. * @ops: macro params to register.
  403. *
  404. * Returns 0 on success or -EINVAL on error.
  405. */
  406. int bolero_register_macro(struct device *dev, u16 macro_id,
  407. struct macro_ops *ops)
  408. {
  409. struct bolero_priv *priv;
  410. int ret = -EINVAL;
  411. if (!dev || !ops) {
  412. pr_err("%s: dev or ops is null\n", __func__);
  413. return -EINVAL;
  414. }
  415. if (!bolero_is_valid_child_dev(dev)) {
  416. dev_err(dev, "%s: child device for macro:%d not added yet\n",
  417. __func__, macro_id);
  418. return -EINVAL;
  419. }
  420. priv = dev_get_drvdata(dev->parent);
  421. if (!priv || (macro_id >= MAX_MACRO)) {
  422. dev_err(dev, "%s: priv is null or invalid macro\n", __func__);
  423. return -EINVAL;
  424. }
  425. priv->macro_params[macro_id].clk_id_req = ops->clk_id_req;
  426. priv->macro_params[macro_id].default_clk_id = ops->default_clk_id;
  427. priv->macro_params[macro_id].init = ops->init;
  428. priv->macro_params[macro_id].exit = ops->exit;
  429. priv->macro_params[macro_id].io_base = ops->io_base;
  430. priv->macro_params[macro_id].num_dais = ops->num_dais;
  431. priv->macro_params[macro_id].dai_ptr = ops->dai_ptr;
  432. priv->macro_params[macro_id].event_handler = ops->event_handler;
  433. priv->macro_params[macro_id].set_port_map = ops->set_port_map;
  434. priv->macro_params[macro_id].dev = dev;
  435. priv->current_mclk_mux_macro[macro_id] =
  436. bolero_mclk_mux_tbl[macro_id][MCLK_MUX0];
  437. if (macro_id == TX_MACRO) {
  438. priv->macro_params[macro_id].reg_wake_irq = ops->reg_wake_irq;
  439. priv->macro_params[macro_id].clk_switch = ops->clk_switch;
  440. priv->macro_params[macro_id].reg_evt_listener =
  441. ops->reg_evt_listener;
  442. }
  443. priv->num_dais += ops->num_dais;
  444. priv->num_macros_registered++;
  445. priv->macros_supported[macro_id] = true;
  446. if (priv->num_macros_registered == priv->num_macros) {
  447. ret = bolero_copy_dais_from_macro(priv);
  448. if (ret < 0) {
  449. dev_err(dev, "%s: copy_dais failed\n", __func__);
  450. return ret;
  451. }
  452. if (priv->macros_supported[TX_MACRO] == false) {
  453. bolero_mclk_mux_tbl[WSA_MACRO][MCLK_MUX0] = WSA_MACRO;
  454. priv->current_mclk_mux_macro[WSA_MACRO] = WSA_MACRO;
  455. bolero_mclk_mux_tbl[VA_MACRO][MCLK_MUX0] = VA_MACRO;
  456. priv->current_mclk_mux_macro[VA_MACRO] = VA_MACRO;
  457. }
  458. ret = snd_soc_register_component(dev->parent, &bolero,
  459. priv->bolero_dais, priv->num_dais);
  460. if (ret < 0) {
  461. dev_err(dev, "%s: register codec failed\n", __func__);
  462. return ret;
  463. }
  464. }
  465. return 0;
  466. }
  467. EXPORT_SYMBOL(bolero_register_macro);
  468. /**
  469. * bolero_unregister_macro - De-Register macro from bolero
  470. *
  471. * @dev: macro device ptr.
  472. * @macro_id: ID of macro calling this API.
  473. *
  474. */
  475. void bolero_unregister_macro(struct device *dev, u16 macro_id)
  476. {
  477. struct bolero_priv *priv;
  478. if (!dev) {
  479. pr_err("%s: dev is null\n", __func__);
  480. return;
  481. }
  482. if (!bolero_is_valid_child_dev(dev)) {
  483. dev_err(dev, "%s: macro:%d not in valid registered macro-list\n",
  484. __func__, macro_id);
  485. return;
  486. }
  487. priv = dev_get_drvdata(dev->parent);
  488. if (!priv || (macro_id >= MAX_MACRO)) {
  489. dev_err(dev, "%s: priv is null or invalid macro\n", __func__);
  490. return;
  491. }
  492. priv->macro_params[macro_id].init = NULL;
  493. priv->macro_params[macro_id].num_dais = 0;
  494. priv->macro_params[macro_id].dai_ptr = NULL;
  495. priv->macro_params[macro_id].event_handler = NULL;
  496. priv->macro_params[macro_id].dev = NULL;
  497. if (macro_id == TX_MACRO) {
  498. priv->macro_params[macro_id].reg_wake_irq = NULL;
  499. priv->macro_params[macro_id].clk_switch = NULL;
  500. priv->macro_params[macro_id].reg_evt_listener = NULL;
  501. }
  502. priv->num_dais -= priv->macro_params[macro_id].num_dais;
  503. priv->num_macros_registered--;
  504. /* UNREGISTER CODEC HERE */
  505. if (priv->num_macros - 1 == priv->num_macros_registered)
  506. snd_soc_unregister_component(dev->parent);
  507. }
  508. EXPORT_SYMBOL(bolero_unregister_macro);
  509. void bolero_wsa_pa_on(struct device *dev)
  510. {
  511. struct bolero_priv *priv;
  512. if (!dev) {
  513. pr_err("%s: dev is null\n", __func__);
  514. return;
  515. }
  516. if (!bolero_is_valid_child_dev(dev)) {
  517. dev_err(dev, "%s: not a valid child dev\n",
  518. __func__);
  519. return;
  520. }
  521. priv = dev_get_drvdata(dev->parent);
  522. if (!priv) {
  523. dev_err(dev, "%s: priv is null\n", __func__);
  524. return;
  525. }
  526. bolero_cdc_notifier_call(priv, BOLERO_WCD_EVT_PA_ON_POST_FSCLK);
  527. }
  528. EXPORT_SYMBOL(bolero_wsa_pa_on);
  529. static ssize_t bolero_version_read(struct snd_info_entry *entry,
  530. void *file_private_data,
  531. struct file *file,
  532. char __user *buf, size_t count,
  533. loff_t pos)
  534. {
  535. struct bolero_priv *priv;
  536. char buffer[BOLERO_VERSION_ENTRY_SIZE];
  537. int len = 0;
  538. priv = (struct bolero_priv *) entry->private_data;
  539. if (!priv) {
  540. pr_err("%s: bolero priv is null\n", __func__);
  541. return -EINVAL;
  542. }
  543. switch (priv->version) {
  544. case BOLERO_VERSION_1_0:
  545. len = snprintf(buffer, sizeof(buffer), "BOLERO_1_0\n");
  546. break;
  547. case BOLERO_VERSION_1_1:
  548. len = snprintf(buffer, sizeof(buffer), "BOLERO_1_1\n");
  549. break;
  550. case BOLERO_VERSION_1_2:
  551. len = snprintf(buffer, sizeof(buffer), "BOLERO_1_2\n");
  552. break;
  553. default:
  554. len = snprintf(buffer, sizeof(buffer), "VER_UNDEFINED\n");
  555. }
  556. return simple_read_from_buffer(buf, count, &pos, buffer, len);
  557. }
  558. static int bolero_ssr_enable(struct device *dev, void *data)
  559. {
  560. struct bolero_priv *priv = data;
  561. int macro_idx;
  562. if (priv->initial_boot) {
  563. priv->initial_boot = false;
  564. return 0;
  565. }
  566. if (priv->rsc_clk_cb)
  567. priv->rsc_clk_cb(priv->clk_dev, BOLERO_MACRO_EVT_SSR_UP);
  568. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  569. if (priv->macro_params[macro_idx].event_handler)
  570. priv->macro_params[macro_idx].event_handler(
  571. priv->component,
  572. BOLERO_MACRO_EVT_CLK_RESET, 0x0);
  573. }
  574. regcache_cache_only(priv->regmap, false);
  575. mutex_lock(&priv->clk_lock);
  576. priv->dev_up = true;
  577. mutex_unlock(&priv->clk_lock);
  578. regcache_mark_dirty(priv->regmap);
  579. regcache_sync(priv->regmap);
  580. /* call ssr event for supported macros */
  581. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  582. if (!priv->macro_params[macro_idx].event_handler)
  583. continue;
  584. priv->macro_params[macro_idx].event_handler(
  585. priv->component,
  586. BOLERO_MACRO_EVT_SSR_UP, 0x0);
  587. }
  588. bolero_cdc_notifier_call(priv, BOLERO_WCD_EVT_SSR_UP);
  589. return 0;
  590. }
  591. static void bolero_ssr_disable(struct device *dev, void *data)
  592. {
  593. struct bolero_priv *priv = data;
  594. int macro_idx;
  595. bolero_cdc_notifier_call(priv, BOLERO_WCD_EVT_PA_OFF_PRE_SSR);
  596. regcache_cache_only(priv->regmap, true);
  597. mutex_lock(&priv->clk_lock);
  598. priv->dev_up = false;
  599. mutex_unlock(&priv->clk_lock);
  600. if (priv->rsc_clk_cb)
  601. priv->rsc_clk_cb(priv->clk_dev, BOLERO_MACRO_EVT_SSR_DOWN);
  602. /* call ssr event for supported macros */
  603. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  604. if (!priv->macro_params[macro_idx].event_handler)
  605. continue;
  606. priv->macro_params[macro_idx].event_handler(
  607. priv->component,
  608. BOLERO_MACRO_EVT_SSR_DOWN, 0x0);
  609. }
  610. bolero_cdc_notifier_call(priv, BOLERO_WCD_EVT_SSR_DOWN);
  611. }
  612. static struct snd_info_entry_ops bolero_info_ops = {
  613. .read = bolero_version_read,
  614. };
  615. static const struct snd_event_ops bolero_ssr_ops = {
  616. .enable = bolero_ssr_enable,
  617. .disable = bolero_ssr_disable,
  618. };
  619. /*
  620. * bolero_info_create_codec_entry - creates bolero module
  621. * @codec_root: The parent directory
  622. * @component: Codec component instance
  623. *
  624. * Creates bolero module and version entry under the given
  625. * parent directory.
  626. *
  627. * Return: 0 on success or negative error code on failure.
  628. */
  629. int bolero_info_create_codec_entry(struct snd_info_entry *codec_root,
  630. struct snd_soc_component *component)
  631. {
  632. struct snd_info_entry *version_entry;
  633. struct bolero_priv *priv;
  634. struct snd_soc_card *card;
  635. if (!codec_root || !component)
  636. return -EINVAL;
  637. priv = snd_soc_component_get_drvdata(component);
  638. if (priv->entry) {
  639. dev_dbg(priv->dev,
  640. "%s:bolero module already created\n", __func__);
  641. return 0;
  642. }
  643. card = component->card;
  644. priv->entry = snd_info_create_subdir(codec_root->module,
  645. "bolero", codec_root);
  646. if (!priv->entry) {
  647. dev_dbg(component->dev, "%s: failed to create bolero entry\n",
  648. __func__);
  649. return -ENOMEM;
  650. }
  651. version_entry = snd_info_create_card_entry(card->snd_card,
  652. "version",
  653. priv->entry);
  654. if (!version_entry) {
  655. dev_err(component->dev, "%s: failed to create bolero version entry\n",
  656. __func__);
  657. return -ENOMEM;
  658. }
  659. version_entry->private_data = priv;
  660. version_entry->size = BOLERO_VERSION_ENTRY_SIZE;
  661. version_entry->content = SNDRV_INFO_CONTENT_DATA;
  662. version_entry->c.ops = &bolero_info_ops;
  663. if (snd_info_register(version_entry) < 0) {
  664. snd_info_free_entry(version_entry);
  665. return -ENOMEM;
  666. }
  667. priv->version_entry = version_entry;
  668. return 0;
  669. }
  670. EXPORT_SYMBOL(bolero_info_create_codec_entry);
  671. /**
  672. * bolero_register_wake_irq - Register wake irq of Tx macro
  673. *
  674. * @component: codec component ptr.
  675. * @ipc_wakeup: bool to identify ipc_wakeup to be used or HW interrupt line.
  676. *
  677. * Return: 0 on success or negative error code on failure.
  678. */
  679. int bolero_register_wake_irq(struct snd_soc_component *component,
  680. u32 ipc_wakeup)
  681. {
  682. struct bolero_priv *priv = NULL;
  683. if (!component)
  684. return -EINVAL;
  685. priv = snd_soc_component_get_drvdata(component);
  686. if (!priv)
  687. return -EINVAL;
  688. if (!bolero_is_valid_codec_dev(priv->dev)) {
  689. dev_err(component->dev, "%s: invalid codec\n", __func__);
  690. return -EINVAL;
  691. }
  692. if (priv->macro_params[TX_MACRO].reg_wake_irq)
  693. priv->macro_params[TX_MACRO].reg_wake_irq(
  694. component, ipc_wakeup);
  695. return 0;
  696. }
  697. EXPORT_SYMBOL(bolero_register_wake_irq);
  698. /**
  699. * bolero_tx_clk_switch - Switch tx macro clock
  700. *
  701. * @component: pointer to codec component instance.
  702. *
  703. * Returns 0 on success or -EINVAL on error.
  704. */
  705. int bolero_tx_clk_switch(struct snd_soc_component *component)
  706. {
  707. struct bolero_priv *priv = NULL;
  708. int ret = 0;
  709. if (!component)
  710. return -EINVAL;
  711. priv = snd_soc_component_get_drvdata(component);
  712. if (!priv)
  713. return -EINVAL;
  714. if (!bolero_is_valid_codec_dev(priv->dev)) {
  715. dev_err(component->dev, "%s: invalid codec\n", __func__);
  716. return -EINVAL;
  717. }
  718. if (priv->macro_params[TX_MACRO].clk_switch)
  719. ret = priv->macro_params[TX_MACRO].clk_switch(component);
  720. return ret;
  721. }
  722. EXPORT_SYMBOL(bolero_tx_clk_switch);
  723. /**
  724. * bolero_register_event_listener - Register/Deregister to event listener
  725. *
  726. * @component: pointer to codec component instance.
  727. * @enable: when set to 1 registers to event listener otherwise, derigisters
  728. * from the event listener
  729. *
  730. * Returns 0 on success or -EINVAL on error.
  731. */
  732. int bolero_register_event_listener(struct snd_soc_component *component,
  733. bool enable)
  734. {
  735. struct bolero_priv *priv = NULL;
  736. int ret = 0;
  737. if (!component)
  738. return -EINVAL;
  739. priv = snd_soc_component_get_drvdata(component);
  740. if (!priv)
  741. return -EINVAL;
  742. if (!bolero_is_valid_codec_dev(priv->dev)) {
  743. dev_err(component->dev, "%s: invalid codec\n", __func__);
  744. return -EINVAL;
  745. }
  746. if (priv->macro_params[TX_MACRO].reg_evt_listener)
  747. ret = priv->macro_params[TX_MACRO].reg_evt_listener(component,
  748. enable);
  749. return ret;
  750. }
  751. EXPORT_SYMBOL(bolero_register_event_listener);
  752. static int bolero_soc_codec_probe(struct snd_soc_component *component)
  753. {
  754. struct bolero_priv *priv = dev_get_drvdata(component->dev);
  755. int macro_idx, ret = 0;
  756. snd_soc_component_init_regmap(component, priv->regmap);
  757. /* call init for supported macros */
  758. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++) {
  759. if (priv->macro_params[macro_idx].init) {
  760. ret = priv->macro_params[macro_idx].init(component);
  761. if (ret < 0) {
  762. dev_err(component->dev,
  763. "%s: init for macro %d failed\n",
  764. __func__, macro_idx);
  765. goto err;
  766. }
  767. }
  768. }
  769. priv->component = component;
  770. /*
  771. * In order for the ADIE RTC to differentiate between targets
  772. * version info is used.
  773. * Assign 1.0 for target with only one macro
  774. * Assign 1.1 for target with two macros
  775. * Assign 1.2 for target with more than two macros
  776. */
  777. if (priv->num_macros_registered == 1)
  778. priv->version = BOLERO_VERSION_1_0;
  779. else if (priv->num_macros_registered == 2)
  780. priv->version = BOLERO_VERSION_1_1;
  781. else if (priv->num_macros_registered > 2)
  782. priv->version = BOLERO_VERSION_1_2;
  783. ret = snd_event_client_register(priv->dev, &bolero_ssr_ops, priv);
  784. if (!ret) {
  785. snd_event_notify(priv->dev, SND_EVENT_UP);
  786. } else {
  787. dev_err(component->dev,
  788. "%s: Registration with SND event FWK failed ret = %d\n",
  789. __func__, ret);
  790. goto err;
  791. }
  792. dev_dbg(component->dev, "%s: bolero soc codec probe success\n",
  793. __func__);
  794. err:
  795. return ret;
  796. }
  797. static void bolero_soc_codec_remove(struct snd_soc_component *component)
  798. {
  799. struct bolero_priv *priv = dev_get_drvdata(component->dev);
  800. int macro_idx;
  801. snd_event_client_deregister(priv->dev);
  802. /* call exit for supported macros */
  803. for (macro_idx = START_MACRO; macro_idx < MAX_MACRO; macro_idx++)
  804. if (priv->macro_params[macro_idx].exit)
  805. priv->macro_params[macro_idx].exit(component);
  806. return;
  807. }
  808. static const struct snd_soc_component_driver bolero = {
  809. .name = DRV_NAME,
  810. .probe = bolero_soc_codec_probe,
  811. .remove = bolero_soc_codec_remove,
  812. };
  813. static void bolero_add_child_devices(struct work_struct *work)
  814. {
  815. struct bolero_priv *priv;
  816. bool split_codec = false;
  817. struct platform_device *pdev;
  818. struct device_node *node;
  819. int ret = 0, count = 0;
  820. struct wcd_ctrl_platform_data *platdata = NULL;
  821. char plat_dev_name[BOLERO_CDC_STRING_LEN] = "";
  822. priv = container_of(work, struct bolero_priv,
  823. bolero_add_child_devices_work);
  824. if (!priv) {
  825. pr_err("%s: Memory for bolero priv does not exist\n",
  826. __func__);
  827. return;
  828. }
  829. if (!priv->dev || !priv->dev->of_node) {
  830. dev_err(priv->dev, "%s: DT node for bolero does not exist\n",
  831. __func__);
  832. return;
  833. }
  834. platdata = &priv->plat_data;
  835. priv->child_count = 0;
  836. for_each_available_child_of_node(priv->dev->of_node, node) {
  837. split_codec = false;
  838. if (of_find_property(node, "qcom,split-codec", NULL)) {
  839. split_codec = true;
  840. dev_dbg(priv->dev, "%s: split codec slave exists\n",
  841. __func__);
  842. }
  843. strlcpy(plat_dev_name, node->name,
  844. (BOLERO_CDC_STRING_LEN - 1));
  845. pdev = platform_device_alloc(plat_dev_name, -1);
  846. if (!pdev) {
  847. dev_err(priv->dev, "%s: pdev memory alloc failed\n",
  848. __func__);
  849. ret = -ENOMEM;
  850. goto err;
  851. }
  852. pdev->dev.parent = priv->dev;
  853. pdev->dev.of_node = node;
  854. if (split_codec) {
  855. priv->dev->platform_data = platdata;
  856. priv->wcd_dev = &pdev->dev;
  857. }
  858. ret = platform_device_add(pdev);
  859. if (ret) {
  860. dev_err(&pdev->dev,
  861. "%s: Cannot add platform device\n",
  862. __func__);
  863. platform_device_put(pdev);
  864. goto fail_pdev_add;
  865. }
  866. if (priv->child_count < BOLERO_CDC_CHILD_DEVICES_MAX)
  867. priv->pdev_child_devices[priv->child_count++] = pdev;
  868. else
  869. goto err;
  870. }
  871. return;
  872. fail_pdev_add:
  873. for (count = 0; count < priv->child_count; count++)
  874. platform_device_put(priv->pdev_child_devices[count]);
  875. err:
  876. return;
  877. }
  878. static int bolero_probe(struct platform_device *pdev)
  879. {
  880. struct bolero_priv *priv;
  881. u32 num_macros = 0;
  882. int ret;
  883. struct clk *lpass_core_hw_vote = NULL;
  884. struct clk *lpass_audio_hw_vote = NULL;
  885. priv = devm_kzalloc(&pdev->dev, sizeof(struct bolero_priv),
  886. GFP_KERNEL);
  887. if (!priv)
  888. return -ENOMEM;
  889. ret = of_property_read_u32(pdev->dev.of_node, "qcom,num-macros",
  890. &num_macros);
  891. if (ret) {
  892. dev_err(&pdev->dev,
  893. "%s:num-macros property not found\n",
  894. __func__);
  895. return ret;
  896. }
  897. priv->num_macros = num_macros;
  898. if (priv->num_macros > MAX_MACRO) {
  899. dev_err(&pdev->dev,
  900. "%s:num_macros(%d) > MAX_MACRO(%d) than supported\n",
  901. __func__, priv->num_macros, MAX_MACRO);
  902. return -EINVAL;
  903. }
  904. priv->va_without_decimation = of_property_read_bool(pdev->dev.of_node,
  905. "qcom,va-without-decimation");
  906. if (priv->va_without_decimation)
  907. bolero_reg_access[VA_MACRO] = bolero_va_top_reg_access;
  908. priv->dev = &pdev->dev;
  909. priv->dev_up = true;
  910. priv->initial_boot = true;
  911. priv->regmap = bolero_regmap_init(priv->dev,
  912. &bolero_regmap_config);
  913. if (IS_ERR_OR_NULL((void *)(priv->regmap))) {
  914. dev_err(&pdev->dev, "%s:regmap init failed\n", __func__);
  915. return -EINVAL;
  916. }
  917. priv->read_dev = __bolero_reg_read;
  918. priv->write_dev = __bolero_reg_write;
  919. priv->plat_data.handle = (void *) priv;
  920. priv->plat_data.update_wcd_event = bolero_cdc_update_wcd_event;
  921. priv->plat_data.register_notifier = bolero_cdc_register_notifier;
  922. priv->core_hw_vote_count = 0;
  923. priv->core_audio_vote_count = 0;
  924. dev_set_drvdata(&pdev->dev, priv);
  925. mutex_init(&priv->io_lock);
  926. mutex_init(&priv->clk_lock);
  927. mutex_init(&priv->vote_lock);
  928. INIT_WORK(&priv->bolero_add_child_devices_work,
  929. bolero_add_child_devices);
  930. schedule_work(&priv->bolero_add_child_devices_work);
  931. /* Register LPASS core hw vote */
  932. lpass_core_hw_vote = devm_clk_get(&pdev->dev, "lpass_core_hw_vote");
  933. if (IS_ERR(lpass_core_hw_vote)) {
  934. ret = PTR_ERR(lpass_core_hw_vote);
  935. dev_dbg(&pdev->dev, "%s: clk get %s failed %d\n",
  936. __func__, "lpass_core_hw_vote", ret);
  937. lpass_core_hw_vote = NULL;
  938. ret = 0;
  939. }
  940. priv->lpass_core_hw_vote = lpass_core_hw_vote;
  941. /* Register LPASS audio hw vote */
  942. lpass_audio_hw_vote = devm_clk_get(&pdev->dev, "lpass_audio_hw_vote");
  943. if (IS_ERR(lpass_audio_hw_vote)) {
  944. ret = PTR_ERR(lpass_audio_hw_vote);
  945. dev_dbg(&pdev->dev, "%s: clk get %s failed %d\n",
  946. __func__, "lpass_audio_hw_vote", ret);
  947. lpass_audio_hw_vote = NULL;
  948. ret = 0;
  949. }
  950. priv->lpass_audio_hw_vote = lpass_audio_hw_vote;
  951. return 0;
  952. }
  953. static int bolero_remove(struct platform_device *pdev)
  954. {
  955. struct bolero_priv *priv = dev_get_drvdata(&pdev->dev);
  956. if (!priv)
  957. return -EINVAL;
  958. of_platform_depopulate(&pdev->dev);
  959. mutex_destroy(&priv->io_lock);
  960. mutex_destroy(&priv->clk_lock);
  961. mutex_destroy(&priv->vote_lock);
  962. return 0;
  963. }
  964. int bolero_runtime_resume(struct device *dev)
  965. {
  966. struct bolero_priv *priv = dev_get_drvdata(dev->parent);
  967. int ret = 0;
  968. if (priv->lpass_core_hw_vote == NULL) {
  969. dev_dbg(dev, "%s: Invalid lpass core hw node\n", __func__);
  970. return 0;
  971. }
  972. mutex_lock(&priv->vote_lock);
  973. if (priv->core_hw_vote_count == 0) {
  974. ret = clk_prepare_enable(priv->lpass_core_hw_vote);
  975. if (ret < 0) {
  976. dev_err(dev, "%s:lpass core hw enable failed\n",
  977. __func__);
  978. goto audio_vote;
  979. }
  980. }
  981. priv->core_hw_vote_count++;
  982. audio_vote:
  983. if (priv->lpass_audio_hw_vote == NULL) {
  984. dev_dbg(dev, "%s: Invalid lpass audio hw node\n", __func__);
  985. goto done;
  986. }
  987. if (priv->core_audio_vote_count == 0) {
  988. ret = clk_prepare_enable(priv->lpass_audio_hw_vote);
  989. if (ret < 0) {
  990. dev_err(dev, "%s:lpass audio hw enable failed\n",
  991. __func__);
  992. goto done;
  993. }
  994. }
  995. priv->core_audio_vote_count++;
  996. done:
  997. mutex_unlock(&priv->vote_lock);
  998. pm_runtime_set_autosuspend_delay(priv->dev, BOLERO_AUTO_SUSPEND_DELAY);
  999. return 0;
  1000. }
  1001. EXPORT_SYMBOL(bolero_runtime_resume);
  1002. int bolero_runtime_suspend(struct device *dev)
  1003. {
  1004. struct bolero_priv *priv = dev_get_drvdata(dev->parent);
  1005. mutex_lock(&priv->vote_lock);
  1006. if (priv->lpass_core_hw_vote != NULL) {
  1007. if (--priv->core_hw_vote_count == 0)
  1008. clk_disable_unprepare(priv->lpass_core_hw_vote);
  1009. if (priv->core_hw_vote_count < 0)
  1010. priv->core_hw_vote_count = 0;
  1011. } else {
  1012. dev_dbg(dev, "%s: Invalid lpass core hw node\n",
  1013. __func__);
  1014. }
  1015. if (priv->lpass_audio_hw_vote != NULL) {
  1016. if (--priv->core_audio_vote_count == 0)
  1017. clk_disable_unprepare(priv->lpass_audio_hw_vote);
  1018. if (priv->core_audio_vote_count < 0)
  1019. priv->core_audio_vote_count = 0;
  1020. } else {
  1021. dev_dbg(dev, "%s: Invalid lpass audio hw node\n",
  1022. __func__);
  1023. }
  1024. mutex_unlock(&priv->vote_lock);
  1025. return 0;
  1026. }
  1027. EXPORT_SYMBOL(bolero_runtime_suspend);
  1028. bool bolero_check_core_votes(struct device *dev)
  1029. {
  1030. struct bolero_priv *priv = dev_get_drvdata(dev->parent);
  1031. bool ret = true;
  1032. mutex_lock(&priv->vote_lock);
  1033. if ((priv->lpass_core_hw_vote && !priv->core_hw_vote_count) ||
  1034. (priv->lpass_audio_hw_vote && !priv->core_audio_vote_count))
  1035. ret = false;
  1036. mutex_unlock(&priv->vote_lock);
  1037. return ret;
  1038. }
  1039. EXPORT_SYMBOL(bolero_check_core_votes);
  1040. static const struct of_device_id bolero_dt_match[] = {
  1041. {.compatible = "qcom,bolero-codec"},
  1042. {}
  1043. };
  1044. MODULE_DEVICE_TABLE(of, bolero_dt_match);
  1045. static struct platform_driver bolero_drv = {
  1046. .driver = {
  1047. .name = "bolero-codec",
  1048. .owner = THIS_MODULE,
  1049. .of_match_table = bolero_dt_match,
  1050. .suppress_bind_attrs = true,
  1051. },
  1052. .probe = bolero_probe,
  1053. .remove = bolero_remove,
  1054. };
  1055. static int bolero_drv_init(void)
  1056. {
  1057. return platform_driver_register(&bolero_drv);
  1058. }
  1059. static void bolero_drv_exit(void)
  1060. {
  1061. platform_driver_unregister(&bolero_drv);
  1062. }
  1063. static int __init bolero_init(void)
  1064. {
  1065. bolero_drv_init();
  1066. bolero_clk_rsc_mgr_init();
  1067. return 0;
  1068. }
  1069. module_init(bolero_init);
  1070. static void __exit bolero_exit(void)
  1071. {
  1072. bolero_clk_rsc_mgr_exit();
  1073. bolero_drv_exit();
  1074. }
  1075. module_exit(bolero_exit);
  1076. MODULE_DESCRIPTION("Bolero driver");
  1077. MODULE_LICENSE("GPL v2");