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

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