msm-transcode-loopback-q6-v2.c 44 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
  3. */
  4. #include <linux/init.h>
  5. #include <linux/err.h>
  6. #include <linux/module.h>
  7. #include <linux/moduleparam.h>
  8. #include <linux/time.h>
  9. #include <linux/math64.h>
  10. #include <linux/wait.h>
  11. #include <linux/platform_device.h>
  12. #include <linux/slab.h>
  13. #include <sound/core.h>
  14. #include <sound/soc.h>
  15. #include <sound/soc-dapm.h>
  16. #include <sound/pcm.h>
  17. #include <sound/initval.h>
  18. #include <sound/control.h>
  19. #include <sound/audio_effects.h>
  20. #include <sound/pcm_params.h>
  21. #include <sound/timer.h>
  22. #include <sound/tlv.h>
  23. #include <sound/compress_params.h>
  24. #include <sound/compress_offload.h>
  25. #include <sound/compress_driver.h>
  26. #include <dsp/msm_audio_ion.h>
  27. #include <dsp/apr_audio-v2.h>
  28. #include <dsp/q6asm-v2.h>
  29. #include <dsp/q6audio-v2.h>
  30. #include <dsp/msm-audio-effects-q6-v2.h>
  31. #include "msm-pcm-routing-v2.h"
  32. #include "msm-qti-pp-config.h"
  33. #define DRV_NAME "msm-transcode-loopback-v2"
  34. #define LOOPBACK_SESSION_MAX_NUM_STREAMS 2
  35. /* Max volume corresponding to 24dB */
  36. #define TRANSCODE_LR_VOL_MAX_DB 0xFFFF
  37. #define APP_TYPE_CONFIG_IDX_APP_TYPE 0
  38. #define APP_TYPE_CONFIG_IDX_ACDB_ID 1
  39. #define APP_TYPE_CONFIG_IDX_SAMPLE_RATE 2
  40. #define APP_TYPE_CONFIG_IDX_BE_ID 3
  41. static DEFINE_MUTEX(transcode_loopback_session_lock);
  42. struct msm_transcode_audio_effects {
  43. struct bass_boost_params bass_boost;
  44. struct pbe_params pbe;
  45. struct virtualizer_params virtualizer;
  46. struct reverb_params reverb;
  47. struct eq_params equalizer;
  48. struct soft_volume_params volume;
  49. };
  50. struct trans_loopback_pdata {
  51. struct snd_compr_stream *cstream[MSM_FRONTEND_DAI_MAX];
  52. uint32_t master_gain;
  53. int perf_mode[MSM_FRONTEND_DAI_MAX];
  54. struct msm_transcode_audio_effects *audio_effects[MSM_FRONTEND_DAI_MAX];
  55. };
  56. struct loopback_stream {
  57. struct snd_compr_stream *cstream;
  58. uint32_t codec_format;
  59. bool start;
  60. int perf_mode;
  61. };
  62. enum loopback_session_state {
  63. /* One or both streams not opened */
  64. LOOPBACK_SESSION_CLOSE = 0,
  65. /* Loopback streams opened */
  66. LOOPBACK_SESSION_READY,
  67. /* Loopback streams opened and formats configured */
  68. LOOPBACK_SESSION_START,
  69. /* Trigger issued on either of streams when in START state */
  70. LOOPBACK_SESSION_RUN
  71. };
  72. struct msm_transcode_loopback {
  73. struct loopback_stream source;
  74. struct loopback_stream sink;
  75. struct snd_compr_caps source_compr_cap;
  76. struct snd_compr_caps sink_compr_cap;
  77. uint32_t instance;
  78. uint32_t num_streams;
  79. int session_state;
  80. struct mutex lock;
  81. int session_id;
  82. struct audio_client *audio_client;
  83. };
  84. /* Transcode loopback global info struct */
  85. static struct msm_transcode_loopback transcode_info;
  86. static void loopback_event_handler(uint32_t opcode,
  87. uint32_t token, uint32_t *payload, void *priv)
  88. {
  89. struct msm_transcode_loopback *trans =
  90. (struct msm_transcode_loopback *)priv;
  91. struct snd_soc_pcm_runtime *rtd;
  92. struct snd_compr_stream *cstream;
  93. struct audio_client *ac;
  94. int stream_id;
  95. int ret;
  96. if (!trans || !payload) {
  97. pr_err("%s: rtd or payload is NULL\n", __func__);
  98. return;
  99. }
  100. cstream = trans->sink.cstream;
  101. ac = trans->audio_client;
  102. /*
  103. * Token for rest of the compressed commands use to set
  104. * session id, stream id, dir etc.
  105. */
  106. stream_id = q6asm_get_stream_id_from_token(token);
  107. switch (opcode) {
  108. case ASM_STREAM_CMD_ENCDEC_EVENTS:
  109. case ASM_IEC_61937_MEDIA_FMT_EVENT:
  110. pr_debug("%s: Handling stream event : 0X%x\n",
  111. __func__, opcode);
  112. rtd = cstream->private_data;
  113. if (!rtd) {
  114. pr_err("%s: rtd is NULL\n", __func__);
  115. return;
  116. }
  117. ret = msm_adsp_inform_mixer_ctl(rtd, payload);
  118. if (ret) {
  119. pr_err("%s: failed to inform mixer ctrl. err = %d\n",
  120. __func__, ret);
  121. return;
  122. }
  123. break;
  124. case APR_BASIC_RSP_RESULT: {
  125. switch (payload[0]) {
  126. case ASM_SESSION_CMD_RUN_V2:
  127. pr_debug("%s: ASM_SESSION_CMD_RUN_V2:", __func__);
  128. pr_debug("token 0x%x, stream id %d\n", token,
  129. stream_id);
  130. break;
  131. case ASM_STREAM_CMD_CLOSE:
  132. pr_debug("%s: ASM_DATA_CMD_CLOSE:", __func__);
  133. pr_debug("token 0x%x, stream id %d\n", token,
  134. stream_id);
  135. break;
  136. default:
  137. break;
  138. }
  139. break;
  140. }
  141. default:
  142. pr_debug("%s: Not Supported Event opcode[0x%x]\n",
  143. __func__, opcode);
  144. break;
  145. }
  146. }
  147. static void populate_codec_list(struct msm_transcode_loopback *trans,
  148. struct snd_compr_stream *cstream)
  149. {
  150. struct snd_compr_caps compr_cap;
  151. pr_debug("%s\n", __func__);
  152. memset(&compr_cap, 0, sizeof(struct snd_compr_caps));
  153. if (cstream->direction == SND_COMPRESS_CAPTURE) {
  154. compr_cap.direction = SND_COMPRESS_CAPTURE;
  155. compr_cap.num_codecs = 4;
  156. compr_cap.codecs[0] = SND_AUDIOCODEC_PCM;
  157. compr_cap.codecs[1] = SND_AUDIOCODEC_AC3;
  158. compr_cap.codecs[2] = SND_AUDIOCODEC_EAC3;
  159. compr_cap.codecs[3] = SND_AUDIOCODEC_TRUEHD;
  160. memcpy(&trans->source_compr_cap, &compr_cap,
  161. sizeof(struct snd_compr_caps));
  162. }
  163. if (cstream->direction == SND_COMPRESS_PLAYBACK) {
  164. compr_cap.direction = SND_COMPRESS_PLAYBACK;
  165. compr_cap.num_codecs = 1;
  166. compr_cap.codecs[0] = SND_AUDIOCODEC_PCM;
  167. memcpy(&trans->sink_compr_cap, &compr_cap,
  168. sizeof(struct snd_compr_caps));
  169. }
  170. }
  171. static int msm_transcode_loopback_open(struct snd_compr_stream *cstream)
  172. {
  173. int ret = 0;
  174. struct snd_compr_runtime *runtime;
  175. struct snd_soc_pcm_runtime *rtd;
  176. struct msm_transcode_loopback *trans = &transcode_info;
  177. struct trans_loopback_pdata *pdata;
  178. struct snd_soc_component *component;
  179. if (cstream == NULL) {
  180. pr_err("%s: Invalid substream\n", __func__);
  181. return -EINVAL;
  182. }
  183. runtime = cstream->runtime;
  184. rtd = snd_pcm_substream_chip(cstream);
  185. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  186. if (!component) {
  187. pr_err("%s: component is NULL\n", __func__);
  188. return -EINVAL;
  189. }
  190. pdata = snd_soc_component_get_drvdata(component);
  191. pdata->cstream[rtd->dai_link->id] = cstream;
  192. pdata->audio_effects[rtd->dai_link->id] =
  193. kzalloc(sizeof(struct msm_transcode_audio_effects), GFP_KERNEL);
  194. if (pdata->audio_effects[rtd->dai_link->id] == NULL) {
  195. ret = -ENOMEM;
  196. goto effect_error;
  197. }
  198. mutex_lock(&trans->lock);
  199. if (trans->num_streams > LOOPBACK_SESSION_MAX_NUM_STREAMS) {
  200. pr_err("msm_transcode_open failed..invalid stream\n");
  201. ret = -EINVAL;
  202. goto exit;
  203. }
  204. if (cstream->direction == SND_COMPRESS_CAPTURE) {
  205. if (trans->source.cstream == NULL) {
  206. trans->source.cstream = cstream;
  207. trans->num_streams++;
  208. } else {
  209. pr_err("%s: capture stream already opened\n",
  210. __func__);
  211. ret = -EINVAL;
  212. goto exit;
  213. }
  214. } else if (cstream->direction == SND_COMPRESS_PLAYBACK) {
  215. if (trans->sink.cstream == NULL) {
  216. trans->sink.cstream = cstream;
  217. trans->num_streams++;
  218. } else {
  219. pr_debug("%s: playback stream already opened\n",
  220. __func__);
  221. ret = -EINVAL;
  222. goto exit;
  223. }
  224. msm_adsp_init_mixer_ctl_pp_event_queue(rtd);
  225. }
  226. pr_debug("%s: num stream%d, stream name %s\n", __func__,
  227. trans->num_streams, cstream->name);
  228. populate_codec_list(trans, cstream);
  229. if (trans->num_streams == LOOPBACK_SESSION_MAX_NUM_STREAMS) {
  230. pr_debug("%s: Moving loopback session to READY state %d\n",
  231. __func__, trans->session_state);
  232. trans->session_state = LOOPBACK_SESSION_READY;
  233. }
  234. runtime->private_data = trans;
  235. exit:
  236. mutex_unlock(&trans->lock);
  237. if ((pdata->audio_effects[rtd->dai_link->id] != NULL) && (ret < 0)) {
  238. kfree(pdata->audio_effects[rtd->dai_link->id]);
  239. pdata->audio_effects[rtd->dai_link->id] = NULL;
  240. }
  241. effect_error:
  242. return ret;
  243. }
  244. static void stop_transcoding(struct msm_transcode_loopback *trans)
  245. {
  246. struct snd_soc_pcm_runtime *soc_pcm_rx;
  247. struct snd_soc_pcm_runtime *soc_pcm_tx;
  248. if (trans->audio_client != NULL) {
  249. q6asm_cmd(trans->audio_client, CMD_CLOSE);
  250. if (trans->sink.cstream != NULL) {
  251. soc_pcm_rx = trans->sink.cstream->private_data;
  252. msm_pcm_routing_dereg_phy_stream(
  253. soc_pcm_rx->dai_link->id,
  254. SND_COMPRESS_PLAYBACK);
  255. }
  256. if (trans->source.cstream != NULL) {
  257. soc_pcm_tx = trans->source.cstream->private_data;
  258. msm_pcm_routing_dereg_phy_stream(
  259. soc_pcm_tx->dai_link->id,
  260. SND_COMPRESS_CAPTURE);
  261. }
  262. q6asm_audio_client_free(trans->audio_client);
  263. trans->audio_client = NULL;
  264. }
  265. }
  266. static int msm_transcode_loopback_free(struct snd_compr_stream *cstream)
  267. {
  268. struct snd_compr_runtime *runtime = cstream->runtime;
  269. struct msm_transcode_loopback *trans = runtime->private_data;
  270. struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(cstream);
  271. struct snd_soc_component *component;
  272. struct trans_loopback_pdata *pdata;
  273. int ret = 0;
  274. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  275. if (!component) {
  276. pr_err("%s: component is NULL\n", __func__);
  277. return -EINVAL;
  278. }
  279. pdata = snd_soc_component_get_drvdata(component);
  280. mutex_lock(&trans->lock);
  281. if (pdata->audio_effects[rtd->dai_link->id] != NULL) {
  282. kfree(pdata->audio_effects[rtd->dai_link->id]);
  283. pdata->audio_effects[rtd->dai_link->id] = NULL;
  284. }
  285. pr_debug("%s: Transcode loopback end:%d, streams %d\n", __func__,
  286. cstream->direction, trans->num_streams);
  287. trans->num_streams--;
  288. stop_transcoding(trans);
  289. if (cstream->direction == SND_COMPRESS_PLAYBACK) {
  290. memset(&trans->sink, 0, sizeof(struct loopback_stream));
  291. msm_adsp_clean_mixer_ctl_pp_event_queue(rtd);
  292. } else if (cstream->direction == SND_COMPRESS_CAPTURE) {
  293. memset(&trans->source, 0, sizeof(struct loopback_stream));
  294. }
  295. trans->session_state = LOOPBACK_SESSION_CLOSE;
  296. mutex_unlock(&trans->lock);
  297. return ret;
  298. }
  299. static int msm_transcode_loopback_trigger(struct snd_compr_stream *cstream,
  300. int cmd)
  301. {
  302. struct snd_compr_runtime *runtime = cstream->runtime;
  303. struct msm_transcode_loopback *trans = runtime->private_data;
  304. switch (cmd) {
  305. case SNDRV_PCM_TRIGGER_START:
  306. case SNDRV_PCM_TRIGGER_RESUME:
  307. case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
  308. if (trans->session_state == LOOPBACK_SESSION_START) {
  309. pr_debug("%s: Issue Loopback session %d RUN\n",
  310. __func__, trans->instance);
  311. q6asm_run_nowait(trans->audio_client, 0, 0, 0);
  312. trans->session_state = LOOPBACK_SESSION_RUN;
  313. }
  314. break;
  315. case SNDRV_PCM_TRIGGER_SUSPEND:
  316. case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
  317. case SNDRV_PCM_TRIGGER_STOP:
  318. pr_debug("%s: Issue Loopback session %d STOP\n", __func__,
  319. trans->instance);
  320. if (trans->session_state == LOOPBACK_SESSION_RUN)
  321. q6asm_cmd_nowait(trans->audio_client, CMD_PAUSE);
  322. trans->session_state = LOOPBACK_SESSION_START;
  323. break;
  324. default:
  325. break;
  326. }
  327. return 0;
  328. }
  329. static int msm_transcode_set_render_window(struct audio_client *ac,
  330. uint32_t ws_lsw, uint32_t ws_msw,
  331. uint32_t we_lsw, uint32_t we_msw)
  332. {
  333. int ret = -EINVAL;
  334. struct asm_session_mtmx_strtr_param_window_v2_t asm_mtmx_strtr_window;
  335. uint32_t param_id;
  336. pr_debug("%s, ws_lsw 0x%x ws_msw 0x%x we_lsw 0x%x we_msw 0x%x\n",
  337. __func__, ws_lsw, ws_msw, we_lsw, we_msw);
  338. memset(&asm_mtmx_strtr_window, 0,
  339. sizeof(struct asm_session_mtmx_strtr_param_window_v2_t));
  340. asm_mtmx_strtr_window.window_lsw = ws_lsw;
  341. asm_mtmx_strtr_window.window_msw = ws_msw;
  342. param_id = ASM_SESSION_MTMX_STRTR_PARAM_RENDER_WINDOW_START_V2;
  343. ret = q6asm_send_mtmx_strtr_window(ac, &asm_mtmx_strtr_window, param_id);
  344. if (ret) {
  345. pr_err("%s, start window can't be set error %d\n", __func__, ret);
  346. goto exit;
  347. }
  348. asm_mtmx_strtr_window.window_lsw = we_lsw;
  349. asm_mtmx_strtr_window.window_msw = we_msw;
  350. param_id = ASM_SESSION_MTMX_STRTR_PARAM_RENDER_WINDOW_END_V2;
  351. ret = q6asm_send_mtmx_strtr_window(ac, &asm_mtmx_strtr_window, param_id);
  352. if (ret)
  353. pr_err("%s, end window can't be set error %d\n", __func__, ret);
  354. exit:
  355. return ret;
  356. }
  357. static int msm_transcode_loopback_set_params(struct snd_compr_stream *cstream,
  358. struct snd_compr_params *codec_param)
  359. {
  360. struct snd_compr_runtime *runtime = cstream->runtime;
  361. struct msm_transcode_loopback *trans = runtime->private_data;
  362. struct snd_soc_pcm_runtime *soc_pcm_rx;
  363. struct snd_soc_pcm_runtime *soc_pcm_tx;
  364. struct snd_soc_pcm_runtime *rtd;
  365. struct snd_soc_component *component;
  366. struct trans_loopback_pdata *pdata;
  367. uint32_t bit_width = 16;
  368. int ret = 0;
  369. if (trans == NULL) {
  370. pr_err("%s: Invalid param\n", __func__);
  371. return -EINVAL;
  372. }
  373. mutex_lock(&trans->lock);
  374. rtd = snd_pcm_substream_chip(cstream);
  375. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  376. pdata = snd_soc_component_get_drvdata(component);
  377. if (cstream->direction == SND_COMPRESS_PLAYBACK) {
  378. if (codec_param->codec.id == SND_AUDIOCODEC_PCM) {
  379. trans->sink.codec_format =
  380. FORMAT_LINEAR_PCM;
  381. switch (codec_param->codec.format) {
  382. case SNDRV_PCM_FORMAT_S32_LE:
  383. bit_width = 32;
  384. break;
  385. case SNDRV_PCM_FORMAT_S24_LE:
  386. bit_width = 24;
  387. break;
  388. case SNDRV_PCM_FORMAT_S24_3LE:
  389. bit_width = 24;
  390. break;
  391. case SNDRV_PCM_FORMAT_S16_LE:
  392. default:
  393. bit_width = 16;
  394. break;
  395. }
  396. } else {
  397. pr_debug("%s: unknown sink codec\n", __func__);
  398. ret = -EINVAL;
  399. goto exit;
  400. }
  401. trans->sink.start = true;
  402. trans->sink.perf_mode = pdata->perf_mode[rtd->dai_link->id];
  403. }
  404. if (cstream->direction == SND_COMPRESS_CAPTURE) {
  405. switch (codec_param->codec.id) {
  406. case SND_AUDIOCODEC_PCM:
  407. pr_debug("Source SND_AUDIOCODEC_PCM\n");
  408. trans->source.codec_format =
  409. FORMAT_LINEAR_PCM;
  410. break;
  411. case SND_AUDIOCODEC_AC3:
  412. pr_debug("Source SND_AUDIOCODEC_AC3\n");
  413. trans->source.codec_format =
  414. FORMAT_AC3;
  415. break;
  416. case SND_AUDIOCODEC_EAC3:
  417. pr_debug("Source SND_AUDIOCODEC_EAC3\n");
  418. trans->source.codec_format =
  419. FORMAT_EAC3;
  420. break;
  421. case SND_AUDIOCODEC_TRUEHD:
  422. pr_debug("Source SND_AUDIOCODEC_TRUEHD\n");
  423. trans->source.codec_format =
  424. FORMAT_TRUEHD;
  425. break;
  426. default:
  427. pr_debug("%s: unknown source codec\n", __func__);
  428. ret = -EINVAL;
  429. goto exit;
  430. }
  431. trans->source.start = true;
  432. trans->source.perf_mode = pdata->perf_mode[rtd->dai_link->id];
  433. }
  434. pr_debug("%s: trans->source.start %d trans->sink.start %d trans->source.cstream %pK trans->sink.cstream %pK trans->session_state %d\n",
  435. __func__, trans->source.start, trans->sink.start,
  436. trans->source.cstream, trans->sink.cstream,
  437. trans->session_state);
  438. if ((trans->session_state == LOOPBACK_SESSION_READY) &&
  439. trans->source.start && trans->sink.start) {
  440. pr_debug("%s: Moving loopback session to start state\n",
  441. __func__);
  442. trans->session_state = LOOPBACK_SESSION_START;
  443. }
  444. if (trans->session_state == LOOPBACK_SESSION_START) {
  445. if (trans->audio_client != NULL) {
  446. pr_debug("%s: ASM client already opened, closing\n",
  447. __func__);
  448. stop_transcoding(trans);
  449. }
  450. trans->audio_client = q6asm_audio_client_alloc(
  451. (app_cb)loopback_event_handler, trans);
  452. if (!trans->audio_client) {
  453. pr_err("%s: Could not allocate memory\n", __func__);
  454. ret = -EINVAL;
  455. goto exit;
  456. }
  457. pr_debug("%s: ASM client allocated, callback %pK\n", __func__,
  458. loopback_event_handler);
  459. trans->session_id = trans->audio_client->session;
  460. trans->audio_client->perf_mode = trans->sink.perf_mode;
  461. ret = q6asm_open_transcode_loopback(trans->audio_client,
  462. bit_width,
  463. trans->source.codec_format,
  464. trans->sink.codec_format);
  465. if (ret < 0) {
  466. pr_err("%s: Session transcode loopback open failed\n",
  467. __func__);
  468. q6asm_audio_client_free(trans->audio_client);
  469. trans->audio_client = NULL;
  470. goto exit;
  471. }
  472. pr_debug("%s: Starting ADM open for loopback\n", __func__);
  473. soc_pcm_rx = trans->sink.cstream->private_data;
  474. soc_pcm_tx = trans->source.cstream->private_data;
  475. if (trans->source.codec_format != FORMAT_LINEAR_PCM)
  476. msm_pcm_routing_reg_phy_compr_stream(
  477. soc_pcm_tx->dai_link->id,
  478. LEGACY_PCM_MODE,
  479. trans->session_id,
  480. SNDRV_PCM_STREAM_CAPTURE,
  481. COMPRESSED_PASSTHROUGH_GEN);
  482. else
  483. msm_pcm_routing_reg_phy_stream(
  484. soc_pcm_tx->dai_link->id,
  485. trans->source.perf_mode,
  486. trans->session_id,
  487. SNDRV_PCM_STREAM_CAPTURE);
  488. /* Opening Rx ADM in LOW_LATENCY mode by default */
  489. msm_pcm_routing_reg_phy_stream(
  490. soc_pcm_rx->dai_link->id,
  491. trans->sink.perf_mode,
  492. trans->session_id,
  493. SNDRV_PCM_STREAM_PLAYBACK);
  494. pr_debug("%s: Successfully opened ADM sessions\n", __func__);
  495. }
  496. exit:
  497. mutex_unlock(&trans->lock);
  498. return ret;
  499. }
  500. static int msm_transcode_loopback_get_caps(struct snd_compr_stream *cstream,
  501. struct snd_compr_caps *arg)
  502. {
  503. struct snd_compr_runtime *runtime;
  504. struct msm_transcode_loopback *trans;
  505. if (!arg || !cstream) {
  506. pr_err("%s: Invalid arguments\n", __func__);
  507. return -EINVAL;
  508. }
  509. runtime = cstream->runtime;
  510. trans = runtime->private_data;
  511. pr_debug("%s\n", __func__);
  512. if (cstream->direction == SND_COMPRESS_CAPTURE)
  513. memcpy(arg, &trans->source_compr_cap,
  514. sizeof(struct snd_compr_caps));
  515. else
  516. memcpy(arg, &trans->sink_compr_cap,
  517. sizeof(struct snd_compr_caps));
  518. return 0;
  519. }
  520. static int msm_transcode_loopback_set_metadata(struct snd_compr_stream *cstream,
  521. struct snd_compr_metadata *metadata)
  522. {
  523. struct snd_soc_pcm_runtime *rtd;
  524. struct trans_loopback_pdata *pdata;
  525. struct msm_transcode_loopback *prtd = NULL;
  526. struct snd_soc_component *component;
  527. struct audio_client *ac = NULL;
  528. if (!metadata || !cstream) {
  529. pr_err("%s: Invalid arguments\n", __func__);
  530. return -EINVAL;
  531. }
  532. rtd = snd_pcm_substream_chip(cstream);
  533. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  534. pdata = snd_soc_component_get_drvdata(component);
  535. prtd = cstream->runtime->private_data;
  536. if (!prtd || !prtd->audio_client) {
  537. pr_err("%s: prtd or audio client is NULL\n", __func__);
  538. return -EINVAL;
  539. }
  540. ac = prtd->audio_client;
  541. switch (metadata->key) {
  542. case SNDRV_COMPRESS_LATENCY_MODE:
  543. {
  544. switch (metadata->value[0]) {
  545. case SNDRV_COMPRESS_LEGACY_LATENCY_MODE:
  546. pdata->perf_mode[rtd->dai_link->id] = LEGACY_PCM_MODE;
  547. break;
  548. case SNDRV_COMPRESS_LOW_LATENCY_MODE:
  549. pdata->perf_mode[rtd->dai_link->id] =
  550. LOW_LATENCY_PCM_MODE;
  551. break;
  552. default:
  553. pr_debug("%s: Unsupported latency mode %d, default to Legacy\n",
  554. __func__, metadata->value[0]);
  555. pdata->perf_mode[rtd->dai_link->id] = LEGACY_PCM_MODE;
  556. break;
  557. }
  558. break;
  559. }
  560. case SNDRV_COMPRESS_RENDER_WINDOW:
  561. {
  562. return msm_transcode_set_render_window(
  563. ac,
  564. metadata->value[0],
  565. metadata->value[1],
  566. metadata->value[2],
  567. metadata->value[3]);
  568. }
  569. default:
  570. pr_debug("%s: Unsupported metadata %d\n",
  571. __func__, metadata->key);
  572. break;
  573. }
  574. return 0;
  575. }
  576. static int msm_transcode_stream_cmd_put(struct snd_kcontrol *kcontrol,
  577. struct snd_ctl_elem_value *ucontrol)
  578. {
  579. struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
  580. unsigned long fe_id = kcontrol->private_value;
  581. struct trans_loopback_pdata *pdata = (struct trans_loopback_pdata *)
  582. snd_soc_component_get_drvdata(comp);
  583. struct snd_compr_stream *cstream = NULL;
  584. struct msm_transcode_loopback *prtd;
  585. int ret = 0;
  586. struct msm_adsp_event_data *event_data = NULL;
  587. if (fe_id >= MSM_FRONTEND_DAI_MAX) {
  588. pr_err("%s Received invalid fe_id %lu\n",
  589. __func__, fe_id);
  590. ret = -EINVAL;
  591. goto done;
  592. }
  593. cstream = pdata->cstream[fe_id];
  594. if (cstream == NULL) {
  595. pr_err("%s cstream is null.\n", __func__);
  596. ret = -EINVAL;
  597. goto done;
  598. }
  599. prtd = cstream->runtime->private_data;
  600. if (!prtd) {
  601. pr_err("%s: prtd is null.\n", __func__);
  602. ret = -EINVAL;
  603. goto done;
  604. }
  605. if (prtd->audio_client == NULL) {
  606. pr_err("%s: audio_client is null.\n", __func__);
  607. ret = -EINVAL;
  608. goto done;
  609. }
  610. event_data = (struct msm_adsp_event_data *)ucontrol->value.bytes.data;
  611. if ((event_data->event_type < ADSP_STREAM_PP_EVENT) ||
  612. (event_data->event_type >= ADSP_STREAM_EVENT_MAX)) {
  613. pr_err("%s: invalid event_type=%d",
  614. __func__, event_data->event_type);
  615. ret = -EINVAL;
  616. goto done;
  617. }
  618. if (event_data->payload_len > sizeof(ucontrol->value.bytes.data)
  619. - sizeof(struct msm_adsp_event_data)) {
  620. pr_err("%s param length=%d exceeds limit",
  621. __func__, event_data->payload_len);
  622. ret = -EINVAL;
  623. goto done;
  624. }
  625. ret = q6asm_send_stream_cmd(prtd->audio_client, event_data);
  626. if (ret < 0)
  627. pr_err("%s: failed to send stream event cmd, err = %d\n",
  628. __func__, ret);
  629. done:
  630. return ret;
  631. }
  632. static int msm_transcode_ion_fd_map_put(struct snd_kcontrol *kcontrol,
  633. struct snd_ctl_elem_value *ucontrol)
  634. {
  635. struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
  636. unsigned long fe_id = kcontrol->private_value;
  637. struct trans_loopback_pdata *pdata = (struct trans_loopback_pdata *)
  638. snd_soc_component_get_drvdata(comp);
  639. struct snd_compr_stream *cstream = NULL;
  640. struct msm_transcode_loopback *prtd;
  641. int fd;
  642. int ret = 0;
  643. if (fe_id >= MSM_FRONTEND_DAI_MAX) {
  644. pr_err("%s Received out of bounds invalid fe_id %lu\n",
  645. __func__, fe_id);
  646. ret = -EINVAL;
  647. goto done;
  648. }
  649. cstream = pdata->cstream[fe_id];
  650. if (cstream == NULL) {
  651. pr_err("%s cstream is null\n", __func__);
  652. ret = -EINVAL;
  653. goto done;
  654. }
  655. prtd = cstream->runtime->private_data;
  656. if (!prtd) {
  657. pr_err("%s: prtd is null\n", __func__);
  658. ret = -EINVAL;
  659. goto done;
  660. }
  661. if (prtd->audio_client == NULL) {
  662. pr_err("%s: audio_client is null\n", __func__);
  663. ret = -EINVAL;
  664. goto done;
  665. }
  666. memcpy(&fd, ucontrol->value.bytes.data, sizeof(fd));
  667. ret = q6asm_send_ion_fd(prtd->audio_client, fd);
  668. if (ret < 0)
  669. pr_err("%s: failed to register ion fd\n", __func__);
  670. done:
  671. return ret;
  672. }
  673. static int msm_transcode_rtic_event_ack_put(struct snd_kcontrol *kcontrol,
  674. struct snd_ctl_elem_value *ucontrol)
  675. {
  676. struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
  677. unsigned long fe_id = kcontrol->private_value;
  678. struct trans_loopback_pdata *pdata = (struct trans_loopback_pdata *)
  679. snd_soc_component_get_drvdata(comp);
  680. struct snd_compr_stream *cstream = NULL;
  681. struct msm_transcode_loopback *prtd;
  682. int ret = 0;
  683. int param_length = 0;
  684. if (fe_id >= MSM_FRONTEND_DAI_MAX) {
  685. pr_err("%s Received invalid fe_id %lu\n",
  686. __func__, fe_id);
  687. ret = -EINVAL;
  688. goto done;
  689. }
  690. cstream = pdata->cstream[fe_id];
  691. if (cstream == NULL) {
  692. pr_err("%s cstream is null\n", __func__);
  693. ret = -EINVAL;
  694. goto done;
  695. }
  696. prtd = cstream->runtime->private_data;
  697. if (!prtd) {
  698. pr_err("%s: prtd is null\n", __func__);
  699. ret = -EINVAL;
  700. goto done;
  701. }
  702. if (prtd->audio_client == NULL) {
  703. pr_err("%s: audio_client is null\n", __func__);
  704. ret = -EINVAL;
  705. goto done;
  706. }
  707. memcpy(&param_length, ucontrol->value.bytes.data,
  708. sizeof(param_length));
  709. if ((param_length + sizeof(param_length))
  710. >= sizeof(ucontrol->value.bytes.data)) {
  711. pr_err("%s param length=%d exceeds limit",
  712. __func__, param_length);
  713. ret = -EINVAL;
  714. goto done;
  715. }
  716. ret = q6asm_send_rtic_event_ack(prtd->audio_client,
  717. ucontrol->value.bytes.data + sizeof(param_length),
  718. param_length);
  719. if (ret < 0)
  720. pr_err("%s: failed to send rtic event ack, err = %d\n",
  721. __func__, ret);
  722. done:
  723. return ret;
  724. }
  725. static int msm_transcode_playback_app_type_cfg_put(
  726. struct snd_kcontrol *kcontrol,
  727. struct snd_ctl_elem_value *ucontrol)
  728. {
  729. u64 fe_id = kcontrol->private_value;
  730. int session_type = SESSION_TYPE_RX;
  731. int be_id = ucontrol->value.integer.value[APP_TYPE_CONFIG_IDX_BE_ID];
  732. struct msm_pcm_stream_app_type_cfg cfg_data = {0, 0, 48000};
  733. int ret = 0;
  734. cfg_data.app_type = ucontrol->value.integer.value[
  735. APP_TYPE_CONFIG_IDX_APP_TYPE];
  736. cfg_data.acdb_dev_id = ucontrol->value.integer.value[
  737. APP_TYPE_CONFIG_IDX_ACDB_ID];
  738. if (ucontrol->value.integer.value[APP_TYPE_CONFIG_IDX_SAMPLE_RATE] != 0)
  739. cfg_data.sample_rate = ucontrol->value.integer.value[
  740. APP_TYPE_CONFIG_IDX_SAMPLE_RATE];
  741. pr_debug("%s: fe_id %llu session_type %d be_id %d app_type %d acdb_dev_id %d sample_rate- %d\n",
  742. __func__, fe_id, session_type, be_id,
  743. cfg_data.app_type, cfg_data.acdb_dev_id, cfg_data.sample_rate);
  744. ret = msm_pcm_routing_reg_stream_app_type_cfg(fe_id, session_type,
  745. be_id, &cfg_data);
  746. if (ret < 0)
  747. pr_err("%s: msm_transcode_playback_stream_app_type_cfg set failed returned %d\n",
  748. __func__, ret);
  749. return ret;
  750. }
  751. static int msm_transcode_playback_app_type_cfg_get(
  752. struct snd_kcontrol *kcontrol,
  753. struct snd_ctl_elem_value *ucontrol)
  754. {
  755. u64 fe_id = kcontrol->private_value;
  756. int session_type = SESSION_TYPE_RX;
  757. int be_id = 0;
  758. struct msm_pcm_stream_app_type_cfg cfg_data = {0};
  759. int ret = 0;
  760. ret = msm_pcm_routing_get_stream_app_type_cfg(fe_id, session_type,
  761. &be_id, &cfg_data);
  762. if (ret < 0) {
  763. pr_err("%s: msm_transcode_playback_stream_app_type_cfg get failed returned %d\n",
  764. __func__, ret);
  765. goto done;
  766. }
  767. ucontrol->value.integer.value[APP_TYPE_CONFIG_IDX_APP_TYPE] =
  768. cfg_data.app_type;
  769. ucontrol->value.integer.value[APP_TYPE_CONFIG_IDX_ACDB_ID] =
  770. cfg_data.acdb_dev_id;
  771. ucontrol->value.integer.value[APP_TYPE_CONFIG_IDX_SAMPLE_RATE] =
  772. cfg_data.sample_rate;
  773. ucontrol->value.integer.value[APP_TYPE_CONFIG_IDX_BE_ID] = be_id;
  774. pr_debug("%s: fedai_id %llu, session_type %d, be_id %d, app_type %d, acdb_dev_id %d, sample_rate %d\n",
  775. __func__, fe_id, session_type, be_id,
  776. cfg_data.app_type, cfg_data.acdb_dev_id, cfg_data.sample_rate);
  777. done:
  778. return ret;
  779. }
  780. static int msm_transcode_set_volume(struct snd_compr_stream *cstream,
  781. uint32_t master_gain)
  782. {
  783. int rc = 0;
  784. struct msm_transcode_loopback *prtd;
  785. struct snd_soc_pcm_runtime *rtd;
  786. pr_debug("%s: master_gain %d\n", __func__, master_gain);
  787. if (!cstream || !cstream->runtime) {
  788. pr_err("%s: session not active\n", __func__);
  789. return -EINVAL;
  790. }
  791. rtd = cstream->private_data;
  792. prtd = cstream->runtime->private_data;
  793. if (!rtd || !prtd || !prtd->audio_client) {
  794. pr_err("%s: invalid rtd, prtd or audio client", __func__);
  795. return -EINVAL;
  796. }
  797. rc = q6asm_set_volume(prtd->audio_client, master_gain);
  798. if (rc < 0)
  799. pr_err("%s: Send vol gain command failed rc=%d\n",
  800. __func__, rc);
  801. return rc;
  802. }
  803. static int msm_transcode_volume_put(struct snd_kcontrol *kcontrol,
  804. struct snd_ctl_elem_value *ucontrol)
  805. {
  806. struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
  807. unsigned long fe_id = kcontrol->private_value;
  808. struct trans_loopback_pdata *pdata = (struct trans_loopback_pdata *)
  809. snd_soc_component_get_drvdata(comp);
  810. struct snd_compr_stream *cstream = NULL;
  811. uint32_t ret = 0;
  812. if (fe_id >= MSM_FRONTEND_DAI_MAX) {
  813. pr_err("%s Received out of bounds fe_id %lu\n",
  814. __func__, fe_id);
  815. return -EINVAL;
  816. }
  817. cstream = pdata->cstream[fe_id];
  818. pdata->master_gain = ucontrol->value.integer.value[0];
  819. pr_debug("%s: fe_id %lu master_gain %d\n",
  820. __func__, fe_id, pdata->master_gain);
  821. if (cstream)
  822. ret = msm_transcode_set_volume(cstream, pdata->master_gain);
  823. return ret;
  824. }
  825. static int msm_transcode_volume_get(struct snd_kcontrol *kcontrol,
  826. struct snd_ctl_elem_value *ucontrol)
  827. {
  828. struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
  829. unsigned long fe_id = kcontrol->private_value;
  830. struct trans_loopback_pdata *pdata = (struct trans_loopback_pdata *)
  831. snd_soc_component_get_drvdata(comp);
  832. if (fe_id >= MSM_FRONTEND_DAI_MAX) {
  833. pr_err("%s Received out of bound fe_id %lu\n", __func__, fe_id);
  834. return -EINVAL;
  835. }
  836. pr_debug("%s: fe_id %lu\n", __func__, fe_id);
  837. ucontrol->value.integer.value[0] = pdata->master_gain;
  838. return 0;
  839. }
  840. static int msm_transcode_audio_effects_config_info(struct snd_kcontrol *kcontrol,
  841. struct snd_ctl_elem_info *uinfo)
  842. {
  843. uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
  844. uinfo->count = MAX_PP_PARAMS_SZ;
  845. uinfo->value.integer.min = 0;
  846. uinfo->value.integer.max = 0xFFFFFFFF;
  847. return 0;
  848. }
  849. static int msm_transcode_audio_effects_config_get(struct snd_kcontrol *kcontrol,
  850. struct snd_ctl_elem_value *ucontrol)
  851. {
  852. struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
  853. unsigned long fe_id = kcontrol->private_value;
  854. struct trans_loopback_pdata *pdata = (struct trans_loopback_pdata *)
  855. snd_soc_component_get_drvdata(comp);
  856. struct msm_transcode_audio_effects *audio_effects = NULL;
  857. struct snd_compr_stream *cstream = NULL;
  858. pr_debug("%s: fe_id: %lu\n", __func__, fe_id);
  859. if (fe_id >= MSM_FRONTEND_DAI_MAX) {
  860. pr_err("%s Received out of bounds fe_id %lu\n",
  861. __func__, fe_id);
  862. return -EINVAL;
  863. }
  864. cstream = pdata->cstream[fe_id];
  865. audio_effects = pdata->audio_effects[fe_id];
  866. if (!cstream || !audio_effects) {
  867. pr_err("%s: stream or effects inactive\n", __func__);
  868. return -EINVAL;
  869. }
  870. return 0;
  871. }
  872. static int msm_transcode_audio_effects_config_put(struct snd_kcontrol *kcontrol,
  873. struct snd_ctl_elem_value *ucontrol)
  874. {
  875. struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
  876. unsigned long fe_id = kcontrol->private_value;
  877. struct trans_loopback_pdata *pdata = (struct trans_loopback_pdata *)
  878. snd_soc_component_get_drvdata(comp);
  879. struct msm_transcode_audio_effects *audio_effects = NULL;
  880. struct snd_compr_stream *cstream = NULL;
  881. struct msm_transcode_loopback *prtd = NULL;
  882. long *values = &(ucontrol->value.integer.value[0]);
  883. int effects_module;
  884. int ret = 0;
  885. pr_debug("%s: fe_id: %lu\n", __func__, fe_id);
  886. if (fe_id >= MSM_FRONTEND_DAI_MAX) {
  887. pr_err("%s Received out of bounds fe_id %lu\n",
  888. __func__, fe_id);
  889. ret = -EINVAL;
  890. goto exit;
  891. }
  892. cstream = pdata->cstream[fe_id];
  893. audio_effects = pdata->audio_effects[fe_id];
  894. if (!cstream || !audio_effects) {
  895. pr_err("%s: stream or effects inactive\n", __func__);
  896. ret = -EINVAL;
  897. goto exit;
  898. }
  899. prtd = cstream->runtime->private_data;
  900. if (!prtd) {
  901. pr_err("%s: cannot set audio effects\n", __func__);
  902. ret = -EINVAL;
  903. goto exit;
  904. }
  905. effects_module = *values++;
  906. switch (effects_module) {
  907. case VIRTUALIZER_MODULE:
  908. pr_debug("%s: VIRTUALIZER_MODULE\n", __func__);
  909. if (msm_audio_effects_is_effmodule_supp_in_top(effects_module,
  910. prtd->audio_client->topology))
  911. ret = msm_audio_effects_virtualizer_handler(
  912. prtd->audio_client,
  913. &(audio_effects->virtualizer),
  914. values);
  915. break;
  916. case REVERB_MODULE:
  917. pr_debug("%s: REVERB_MODULE\n", __func__);
  918. if (msm_audio_effects_is_effmodule_supp_in_top(effects_module,
  919. prtd->audio_client->topology))
  920. ret = msm_audio_effects_reverb_handler(prtd->audio_client,
  921. &(audio_effects->reverb),
  922. values);
  923. break;
  924. case BASS_BOOST_MODULE:
  925. pr_debug("%s: BASS_BOOST_MODULE\n", __func__);
  926. if (msm_audio_effects_is_effmodule_supp_in_top(effects_module,
  927. prtd->audio_client->topology))
  928. ret = msm_audio_effects_bass_boost_handler(prtd->audio_client,
  929. &(audio_effects->bass_boost),
  930. values);
  931. break;
  932. case PBE_MODULE:
  933. pr_debug("%s: PBE_MODULE\n", __func__);
  934. if (msm_audio_effects_is_effmodule_supp_in_top(effects_module,
  935. prtd->audio_client->topology))
  936. ret = msm_audio_effects_pbe_handler(prtd->audio_client,
  937. &(audio_effects->pbe),
  938. values);
  939. break;
  940. case EQ_MODULE:
  941. pr_debug("%s: EQ_MODULE\n", __func__);
  942. if (msm_audio_effects_is_effmodule_supp_in_top(effects_module,
  943. prtd->audio_client->topology))
  944. ret = msm_audio_effects_popless_eq_handler(prtd->audio_client,
  945. &(audio_effects->equalizer),
  946. values);
  947. break;
  948. case SOFT_VOLUME_MODULE:
  949. pr_debug("%s: SOFT_VOLUME_MODULE\n", __func__);
  950. break;
  951. case SOFT_VOLUME2_MODULE:
  952. pr_debug("%s: SOFT_VOLUME2_MODULE\n", __func__);
  953. if (msm_audio_effects_is_effmodule_supp_in_top(effects_module,
  954. prtd->audio_client->topology))
  955. ret = msm_audio_effects_volume_handler_v2(prtd->audio_client,
  956. &(audio_effects->volume),
  957. values, SOFT_VOLUME_INSTANCE_2);
  958. break;
  959. default:
  960. pr_err("%s Invalid effects config module\n", __func__);
  961. ret = -EINVAL;
  962. }
  963. exit:
  964. return ret;
  965. }
  966. static int msm_transcode_add_audio_effects_control(struct snd_soc_pcm_runtime *rtd)
  967. {
  968. struct snd_soc_component *component = NULL;
  969. const char *mixer_ctl_name = "Audio Effects Config";
  970. const char *deviceNo = "NN";
  971. char *mixer_str = NULL;
  972. int ctl_len = 0;
  973. int ret = 0;
  974. struct snd_kcontrol_new fe_audio_effects_config_control[1] = {
  975. {
  976. .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
  977. .name = "?",
  978. .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
  979. .info = msm_transcode_audio_effects_config_info,
  980. .get = msm_transcode_audio_effects_config_get,
  981. .put = msm_transcode_audio_effects_config_put,
  982. .private_value = 0,
  983. }
  984. };
  985. if (!rtd) {
  986. pr_err("%s NULL rtd\n", __func__);
  987. ret = -EINVAL;
  988. goto done;
  989. }
  990. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  991. if (!component) {
  992. pr_err("%s: component is NULL\n", __func__);
  993. return -EINVAL;
  994. }
  995. pr_debug("%s: added new compr FE with name %s, id %d, cpu dai %s, device no %d\n", __func__,
  996. rtd->dai_link->name, rtd->dai_link->id,
  997. rtd->dai_link->cpu_dai_name, rtd->pcm->device);
  998. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  999. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  1000. if (!mixer_str) {
  1001. ret = -ENOMEM;
  1002. goto done;
  1003. }
  1004. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name, rtd->pcm->device);
  1005. fe_audio_effects_config_control[0].name = mixer_str;
  1006. fe_audio_effects_config_control[0].private_value = rtd->dai_link->id;
  1007. ret = snd_soc_add_component_controls(component,
  1008. fe_audio_effects_config_control,
  1009. ARRAY_SIZE(fe_audio_effects_config_control));
  1010. if (ret < 0)
  1011. pr_err("%s: failed to add ctl %s. err = %d\n", __func__, mixer_str, ret);
  1012. kfree(mixer_str);
  1013. done:
  1014. return ret;
  1015. }
  1016. static int msm_transcode_stream_cmd_control(
  1017. struct snd_soc_pcm_runtime *rtd)
  1018. {
  1019. struct snd_soc_component *component = NULL;
  1020. const char *mixer_ctl_name = DSP_STREAM_CMD;
  1021. const char *deviceNo = "NN";
  1022. char *mixer_str = NULL;
  1023. int ctl_len = 0, ret = 0;
  1024. struct snd_kcontrol_new fe_loopback_stream_cmd_config_control[1] = {
  1025. {
  1026. .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
  1027. .name = "?",
  1028. .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
  1029. .info = msm_adsp_stream_cmd_info,
  1030. .put = msm_transcode_stream_cmd_put,
  1031. .private_value = 0,
  1032. }
  1033. };
  1034. if (!rtd) {
  1035. pr_err("%s NULL rtd\n", __func__);
  1036. ret = -EINVAL;
  1037. goto done;
  1038. }
  1039. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  1040. if (!component) {
  1041. pr_err("%s: component is NULL\n", __func__);
  1042. return -EINVAL;
  1043. }
  1044. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  1045. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  1046. if (!mixer_str) {
  1047. ret = -ENOMEM;
  1048. goto done;
  1049. }
  1050. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name, rtd->pcm->device);
  1051. fe_loopback_stream_cmd_config_control[0].name = mixer_str;
  1052. fe_loopback_stream_cmd_config_control[0].private_value =
  1053. rtd->dai_link->id;
  1054. pr_debug("%s: Registering new mixer ctl %s\n", __func__, mixer_str);
  1055. ret = snd_soc_add_component_controls(component,
  1056. fe_loopback_stream_cmd_config_control,
  1057. ARRAY_SIZE(fe_loopback_stream_cmd_config_control));
  1058. if (ret < 0)
  1059. pr_err("%s: failed to add ctl %s. err = %d\n",
  1060. __func__, mixer_str, ret);
  1061. kfree(mixer_str);
  1062. done:
  1063. return ret;
  1064. }
  1065. static int msm_transcode_stream_callback_control(
  1066. struct snd_soc_pcm_runtime *rtd)
  1067. {
  1068. struct snd_soc_component *component = NULL;
  1069. const char *mixer_ctl_name = DSP_STREAM_CALLBACK;
  1070. const char *deviceNo = "NN";
  1071. char *mixer_str = NULL;
  1072. int ctl_len = 0, ret = 0;
  1073. struct snd_kcontrol *kctl;
  1074. struct snd_kcontrol_new fe_loopback_callback_config_control[1] = {
  1075. {
  1076. .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
  1077. .name = "?",
  1078. .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
  1079. .info = msm_adsp_stream_callback_info,
  1080. .get = msm_adsp_stream_callback_get,
  1081. .private_value = 0,
  1082. }
  1083. };
  1084. if (!rtd) {
  1085. pr_err("%s: rtd is NULL\n", __func__);
  1086. ret = -EINVAL;
  1087. goto done;
  1088. }
  1089. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  1090. if (!component) {
  1091. pr_err("%s: component is NULL\n", __func__);
  1092. return -EINVAL;
  1093. }
  1094. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  1095. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  1096. if (!mixer_str) {
  1097. ret = -ENOMEM;
  1098. goto done;
  1099. }
  1100. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name, rtd->pcm->device);
  1101. fe_loopback_callback_config_control[0].name = mixer_str;
  1102. fe_loopback_callback_config_control[0].private_value =
  1103. rtd->dai_link->id;
  1104. pr_debug("%s: Registering new mixer ctl %s\n", __func__, mixer_str);
  1105. ret = snd_soc_add_component_controls(component,
  1106. fe_loopback_callback_config_control,
  1107. ARRAY_SIZE(fe_loopback_callback_config_control));
  1108. if (ret < 0) {
  1109. pr_err("%s: failed to add ctl %s. err = %d\n",
  1110. __func__, mixer_str, ret);
  1111. ret = -EINVAL;
  1112. goto free_mixer_str;
  1113. }
  1114. kctl = snd_soc_card_get_kcontrol(rtd->card, mixer_str);
  1115. if (!kctl) {
  1116. pr_err("%s: failed to get kctl %s.\n", __func__, mixer_str);
  1117. ret = -EINVAL;
  1118. goto free_mixer_str;
  1119. }
  1120. kctl->private_data = NULL;
  1121. free_mixer_str:
  1122. kfree(mixer_str);
  1123. done:
  1124. return ret;
  1125. }
  1126. static int msm_transcode_add_ion_fd_cmd_control(struct snd_soc_pcm_runtime *rtd)
  1127. {
  1128. struct snd_soc_component *component = NULL;
  1129. const char *mixer_ctl_name = "Playback ION FD";
  1130. const char *deviceNo = "NN";
  1131. char *mixer_str = NULL;
  1132. int ctl_len = 0, ret = 0;
  1133. struct snd_kcontrol_new fe_ion_fd_config_control[1] = {
  1134. {
  1135. .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
  1136. .name = "?",
  1137. .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
  1138. .info = msm_adsp_stream_cmd_info,
  1139. .put = msm_transcode_ion_fd_map_put,
  1140. .private_value = 0,
  1141. }
  1142. };
  1143. if (!rtd) {
  1144. pr_err("%s NULL rtd\n", __func__);
  1145. ret = -EINVAL;
  1146. goto done;
  1147. }
  1148. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  1149. if (!component) {
  1150. pr_err("%s: component is NULL\n", __func__);
  1151. return -EINVAL;
  1152. }
  1153. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  1154. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  1155. if (!mixer_str) {
  1156. ret = -ENOMEM;
  1157. goto done;
  1158. }
  1159. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name, rtd->pcm->device);
  1160. fe_ion_fd_config_control[0].name = mixer_str;
  1161. fe_ion_fd_config_control[0].private_value = rtd->dai_link->id;
  1162. pr_debug("%s: Registering new mixer ctl %s\n", __func__, mixer_str);
  1163. ret = snd_soc_add_component_controls(component,
  1164. fe_ion_fd_config_control,
  1165. ARRAY_SIZE(fe_ion_fd_config_control));
  1166. if (ret < 0)
  1167. pr_err("%s: failed to add ctl %s\n", __func__, mixer_str);
  1168. kfree(mixer_str);
  1169. done:
  1170. return ret;
  1171. }
  1172. static int msm_transcode_add_event_ack_cmd_control(
  1173. struct snd_soc_pcm_runtime *rtd)
  1174. {
  1175. struct snd_soc_component *component = NULL;
  1176. const char *mixer_ctl_name = "Playback Event Ack";
  1177. const char *deviceNo = "NN";
  1178. char *mixer_str = NULL;
  1179. int ctl_len = 0, ret = 0;
  1180. struct snd_kcontrol_new fe_event_ack_config_control[1] = {
  1181. {
  1182. .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
  1183. .name = "?",
  1184. .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
  1185. .info = msm_adsp_stream_cmd_info,
  1186. .put = msm_transcode_rtic_event_ack_put,
  1187. .private_value = 0,
  1188. }
  1189. };
  1190. if (!rtd) {
  1191. pr_err("%s NULL rtd\n", __func__);
  1192. ret = -EINVAL;
  1193. goto done;
  1194. }
  1195. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  1196. if (!component) {
  1197. pr_err("%s: component is NULL\n", __func__);
  1198. return -EINVAL;
  1199. }
  1200. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  1201. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  1202. if (!mixer_str) {
  1203. ret = -ENOMEM;
  1204. goto done;
  1205. }
  1206. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name, rtd->pcm->device);
  1207. fe_event_ack_config_control[0].name = mixer_str;
  1208. fe_event_ack_config_control[0].private_value = rtd->dai_link->id;
  1209. pr_debug("%s: Registering new mixer ctl %s\n", __func__, mixer_str);
  1210. ret = snd_soc_add_component_controls(component,
  1211. fe_event_ack_config_control,
  1212. ARRAY_SIZE(fe_event_ack_config_control));
  1213. if (ret < 0)
  1214. pr_err("%s: failed to add ctl %s\n", __func__, mixer_str);
  1215. kfree(mixer_str);
  1216. done:
  1217. return ret;
  1218. }
  1219. static int msm_transcode_app_type_cfg_info(struct snd_kcontrol *kcontrol,
  1220. struct snd_ctl_elem_info *uinfo)
  1221. {
  1222. uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
  1223. uinfo->count = 5;
  1224. uinfo->value.integer.min = 0;
  1225. uinfo->value.integer.max = 0xFFFFFFFF;
  1226. return 0;
  1227. }
  1228. static int msm_transcode_add_app_type_cfg_control(
  1229. struct snd_soc_pcm_runtime *rtd)
  1230. {
  1231. struct snd_soc_component *component = NULL;
  1232. char mixer_str[32];
  1233. struct snd_kcontrol_new fe_app_type_cfg_control[1] = {
  1234. {
  1235. .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
  1236. .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
  1237. .info = msm_transcode_app_type_cfg_info,
  1238. .put = msm_transcode_playback_app_type_cfg_put,
  1239. .get = msm_transcode_playback_app_type_cfg_get,
  1240. .private_value = 0,
  1241. }
  1242. };
  1243. if (!rtd) {
  1244. pr_err("%s NULL rtd\n", __func__);
  1245. return -EINVAL;
  1246. }
  1247. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  1248. if (!component) {
  1249. pr_err("%s: component is NULL\n", __func__);
  1250. return -EINVAL;
  1251. }
  1252. if (rtd->compr->direction == SND_COMPRESS_PLAYBACK) {
  1253. snprintf(mixer_str, sizeof(mixer_str),
  1254. "Audio Stream %d App Type Cfg",
  1255. rtd->pcm->device);
  1256. fe_app_type_cfg_control[0].name = mixer_str;
  1257. fe_app_type_cfg_control[0].private_value = rtd->dai_link->id;
  1258. fe_app_type_cfg_control[0].put =
  1259. msm_transcode_playback_app_type_cfg_put;
  1260. fe_app_type_cfg_control[0].get =
  1261. msm_transcode_playback_app_type_cfg_get;
  1262. pr_debug("Registering new mixer ctl %s", mixer_str);
  1263. snd_soc_add_component_controls(component,
  1264. fe_app_type_cfg_control,
  1265. ARRAY_SIZE(fe_app_type_cfg_control));
  1266. }
  1267. return 0;
  1268. }
  1269. static int msm_transcode_volume_info(struct snd_kcontrol *kcontrol,
  1270. struct snd_ctl_elem_info *uinfo)
  1271. {
  1272. uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
  1273. uinfo->count = 1;
  1274. uinfo->value.integer.min = 0;
  1275. uinfo->value.integer.max = TRANSCODE_LR_VOL_MAX_DB;
  1276. return 0;
  1277. }
  1278. static int msm_transcode_add_volume_control(struct snd_soc_pcm_runtime *rtd)
  1279. {
  1280. struct snd_soc_component *component = NULL;
  1281. struct snd_kcontrol_new fe_volume_control[1] = {
  1282. {
  1283. .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
  1284. .name = "Transcode Loopback Rx Volume",
  1285. .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |
  1286. SNDRV_CTL_ELEM_ACCESS_READWRITE,
  1287. .info = msm_transcode_volume_info,
  1288. .get = msm_transcode_volume_get,
  1289. .put = msm_transcode_volume_put,
  1290. .private_value = 0,
  1291. }
  1292. };
  1293. if (!rtd) {
  1294. pr_err("%s NULL rtd\n", __func__);
  1295. return -EINVAL;
  1296. }
  1297. component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
  1298. if (!component) {
  1299. pr_err("%s: component is NULL\n", __func__);
  1300. return -EINVAL;
  1301. }
  1302. if (rtd->compr->direction == SND_COMPRESS_PLAYBACK) {
  1303. fe_volume_control[0].private_value = rtd->dai_link->id;
  1304. pr_debug("Registering new mixer ctl %s",
  1305. fe_volume_control[0].name);
  1306. snd_soc_add_component_controls(component, fe_volume_control,
  1307. ARRAY_SIZE(fe_volume_control));
  1308. }
  1309. return 0;
  1310. }
  1311. static int msm_transcode_loopback_new(struct snd_soc_pcm_runtime *rtd)
  1312. {
  1313. int rc;
  1314. rc = msm_transcode_add_audio_effects_control(rtd);
  1315. if (rc)
  1316. pr_err("%s: Could not add Compr Audio Effects Control\n",
  1317. __func__);
  1318. rc = msm_transcode_stream_cmd_control(rtd);
  1319. if (rc)
  1320. pr_err("%s: ADSP Stream Cmd Control open failed\n", __func__);
  1321. rc = msm_transcode_stream_callback_control(rtd);
  1322. if (rc)
  1323. pr_err("%s: ADSP Stream callback Control open failed\n",
  1324. __func__);
  1325. rc = msm_transcode_add_ion_fd_cmd_control(rtd);
  1326. if (rc)
  1327. pr_err("%s: Could not add transcode ion fd Control\n",
  1328. __func__);
  1329. rc = msm_transcode_add_event_ack_cmd_control(rtd);
  1330. if (rc)
  1331. pr_err("%s: Could not add transcode event ack Control\n",
  1332. __func__);
  1333. rc = msm_transcode_add_app_type_cfg_control(rtd);
  1334. if (rc)
  1335. pr_err("%s: Could not add Compr App Type Cfg Control\n",
  1336. __func__);
  1337. rc = msm_transcode_add_volume_control(rtd);
  1338. if (rc)
  1339. pr_err("%s: Could not add transcode volume Control\n",
  1340. __func__);
  1341. return 0;
  1342. }
  1343. static struct snd_compr_ops msm_transcode_loopback_ops = {
  1344. .open = msm_transcode_loopback_open,
  1345. .free = msm_transcode_loopback_free,
  1346. .trigger = msm_transcode_loopback_trigger,
  1347. .set_params = msm_transcode_loopback_set_params,
  1348. .get_caps = msm_transcode_loopback_get_caps,
  1349. .set_metadata = msm_transcode_loopback_set_metadata,
  1350. };
  1351. static int msm_transcode_loopback_probe(struct snd_soc_component *component)
  1352. {
  1353. struct trans_loopback_pdata *pdata = NULL;
  1354. int i;
  1355. pr_debug("%s\n", __func__);
  1356. pdata = (struct trans_loopback_pdata *)
  1357. kzalloc(sizeof(struct trans_loopback_pdata),
  1358. GFP_KERNEL);
  1359. if (!pdata)
  1360. return -ENOMEM;
  1361. for (i = 0; i < MSM_FRONTEND_DAI_MAX; i++) {
  1362. pdata->audio_effects[i] = NULL;
  1363. pdata->perf_mode[i] = LOW_LATENCY_PCM_MODE;
  1364. }
  1365. snd_soc_component_set_drvdata(component, pdata);
  1366. return 0;
  1367. }
  1368. static void msm_transcode_loopback_remove(struct snd_soc_component *component)
  1369. {
  1370. struct trans_loopback_pdata *pdata = NULL;
  1371. pdata = (struct trans_loopback_pdata *)
  1372. snd_soc_component_get_drvdata(component);
  1373. kfree(pdata);
  1374. return;
  1375. }
  1376. static struct snd_soc_component_driver msm_soc_component = {
  1377. .name = DRV_NAME,
  1378. .probe = msm_transcode_loopback_probe,
  1379. .compr_ops = &msm_transcode_loopback_ops,
  1380. .pcm_new = msm_transcode_loopback_new,
  1381. .remove = msm_transcode_loopback_remove,
  1382. };
  1383. static int msm_transcode_dev_probe(struct platform_device *pdev)
  1384. {
  1385. pr_debug("%s: dev name %s\n", __func__, dev_name(&pdev->dev));
  1386. if (pdev->dev.of_node)
  1387. dev_set_name(&pdev->dev, "%s", "msm-transcode-loopback");
  1388. return snd_soc_register_component(&pdev->dev,
  1389. &msm_soc_component,
  1390. NULL, 0);
  1391. }
  1392. static int msm_transcode_remove(struct platform_device *pdev)
  1393. {
  1394. snd_soc_unregister_component(&pdev->dev);
  1395. return 0;
  1396. }
  1397. static const struct of_device_id msm_transcode_loopback_dt_match[] = {
  1398. {.compatible = "qcom,msm-transcode-loopback"},
  1399. {}
  1400. };
  1401. MODULE_DEVICE_TABLE(of, msm_transcode_loopback_dt_match);
  1402. static struct platform_driver msm_transcode_loopback_driver = {
  1403. .driver = {
  1404. .name = "msm-transcode-loopback",
  1405. .owner = THIS_MODULE,
  1406. .of_match_table = msm_transcode_loopback_dt_match,
  1407. },
  1408. .probe = msm_transcode_dev_probe,
  1409. .remove = msm_transcode_remove,
  1410. };
  1411. int __init msm_transcode_loopback_init(void)
  1412. {
  1413. memset(&transcode_info, 0, sizeof(struct msm_transcode_loopback));
  1414. mutex_init(&transcode_info.lock);
  1415. return platform_driver_register(&msm_transcode_loopback_driver);
  1416. }
  1417. void msm_transcode_loopback_exit(void)
  1418. {
  1419. mutex_destroy(&transcode_info.lock);
  1420. platform_driver_unregister(&msm_transcode_loopback_driver);
  1421. }
  1422. MODULE_DESCRIPTION("Transcode loopback platform driver");
  1423. MODULE_LICENSE("GPL v2");