msm-qti-pp-config.c 50 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628
  1. // SPDX-License-Identifier: GPL-2.0
  2. /* Copyright (c) 2012-2018, The Linux Foundation. All rights reserved.
  3. */
  4. #include <linux/err.h>
  5. #include <linux/module.h>
  6. #include <linux/bitops.h>
  7. #include <linux/mutex.h>
  8. #include <sound/control.h>
  9. #include <sound/asound.h>
  10. #include <sound/tlv.h>
  11. #include <dsp/q6adm-v2.h>
  12. #include <dsp/q6asm-v2.h>
  13. #include <dsp/q6afe-v2.h>
  14. #include <dsp/q6audio-v2.h>
  15. #include <dsp/q6common.h>
  16. #include "msm-qti-pp-config.h"
  17. #include "msm-pcm-routing-v2.h"
  18. /* EQUALIZER */
  19. /* Equal to Frontend after last of the MULTIMEDIA SESSIONS */
  20. #define MAX_EQ_SESSIONS (MSM_FRONTEND_DAI_MAX + 1)
  21. #define CHMIX_CFG_CONST_PARAM_SIZE 4
  22. enum {
  23. EQ_BAND1 = 0,
  24. EQ_BAND2,
  25. EQ_BAND3,
  26. EQ_BAND4,
  27. EQ_BAND5,
  28. EQ_BAND6,
  29. EQ_BAND7,
  30. EQ_BAND8,
  31. EQ_BAND9,
  32. EQ_BAND10,
  33. EQ_BAND11,
  34. EQ_BAND12,
  35. EQ_BAND_MAX,
  36. };
  37. /* Audio Sphere data structures */
  38. struct msm_audio_pp_asphere_state_s {
  39. uint32_t enabled;
  40. uint32_t strength;
  41. uint32_t mode;
  42. uint32_t version;
  43. int port_id[AFE_MAX_PORTS];
  44. int copp_idx[AFE_MAX_PORTS];
  45. bool initialized;
  46. uint32_t enabled_prev;
  47. uint32_t strength_prev;
  48. };
  49. static struct msm_audio_pp_asphere_state_s asphere_state;
  50. struct msm_audio_eq_stream_config eq_data[MAX_EQ_SESSIONS];
  51. static int msm_route_hfp_vol_control;
  52. static const DECLARE_TLV_DB_LINEAR(hfp_rx_vol_gain, 0,
  53. INT_RX_VOL_MAX_STEPS);
  54. static int msm_route_icc_vol_control;
  55. static const DECLARE_TLV_DB_LINEAR(icc_rx_vol_gain, 0,
  56. INT_RX_VOL_MAX_STEPS);
  57. static int msm_route_pri_auxpcm_lb_vol_ctrl;
  58. static const DECLARE_TLV_DB_LINEAR(pri_auxpcm_lb_vol_gain, 0,
  59. INT_RX_VOL_MAX_STEPS);
  60. static int msm_route_sec_auxpcm_lb_vol_ctrl;
  61. static const DECLARE_TLV_DB_LINEAR(sec_auxpcm_lb_vol_gain, 0,
  62. INT_RX_VOL_MAX_STEPS);
  63. static int msm_multichannel_ec_primary_mic_ch;
  64. static void msm_qti_pp_send_eq_values_(int eq_idx)
  65. {
  66. int result;
  67. struct msm_pcm_routing_fdai_data fe_dai;
  68. struct audio_client *ac = NULL;
  69. msm_pcm_routing_get_fedai_info(eq_idx, SESSION_TYPE_RX, &fe_dai);
  70. ac = q6asm_get_audio_client(fe_dai.strm_id);
  71. if (ac == NULL) {
  72. pr_err("%s: Could not get audio client for session: %d\n",
  73. __func__, fe_dai.strm_id);
  74. goto done;
  75. }
  76. result = q6asm_equalizer(ac, &eq_data[eq_idx]);
  77. if (result < 0)
  78. pr_err("%s: Call to ASM equalizer failed, returned = %d\n",
  79. __func__, result);
  80. done:
  81. return;
  82. }
  83. static int msm_qti_pp_get_eq_enable_mixer(struct snd_kcontrol *kcontrol,
  84. struct snd_ctl_elem_value *ucontrol)
  85. {
  86. int eq_idx = ((struct soc_multi_mixer_control *)
  87. kcontrol->private_value)->reg;
  88. if ((eq_idx < 0) || (eq_idx >= MAX_EQ_SESSIONS))
  89. return -EINVAL;
  90. ucontrol->value.integer.value[0] = eq_data[eq_idx].enable;
  91. pr_debug("%s: EQ #%d enable %d\n", __func__,
  92. eq_idx, eq_data[eq_idx].enable);
  93. return 0;
  94. }
  95. static int msm_qti_pp_put_eq_enable_mixer(struct snd_kcontrol *kcontrol,
  96. struct snd_ctl_elem_value *ucontrol)
  97. {
  98. int eq_idx = ((struct soc_multi_mixer_control *)
  99. kcontrol->private_value)->reg;
  100. int value = ucontrol->value.integer.value[0];
  101. if ((eq_idx < 0) || (eq_idx >= MAX_EQ_SESSIONS))
  102. return -EINVAL;
  103. pr_debug("%s: EQ #%d enable %d\n", __func__,
  104. eq_idx, value);
  105. eq_data[eq_idx].enable = value;
  106. msm_pcm_routing_acquire_lock();
  107. msm_qti_pp_send_eq_values_(eq_idx);
  108. msm_pcm_routing_release_lock();
  109. return 0;
  110. }
  111. static int msm_qti_pp_get_eq_band_count_audio_mixer(
  112. struct snd_kcontrol *kcontrol,
  113. struct snd_ctl_elem_value *ucontrol)
  114. {
  115. int eq_idx = ((struct soc_multi_mixer_control *)
  116. kcontrol->private_value)->reg;
  117. if ((eq_idx < 0) || (eq_idx >= MAX_EQ_SESSIONS))
  118. return -EINVAL;
  119. ucontrol->value.integer.value[0] = eq_data[eq_idx].num_bands;
  120. pr_debug("%s: EQ #%d bands %d\n", __func__,
  121. eq_idx, eq_data[eq_idx].num_bands);
  122. return eq_data[eq_idx].num_bands;
  123. }
  124. static int msm_qti_pp_put_eq_band_count_audio_mixer(
  125. struct snd_kcontrol *kcontrol,
  126. struct snd_ctl_elem_value *ucontrol)
  127. {
  128. int eq_idx = ((struct soc_multi_mixer_control *)
  129. kcontrol->private_value)->reg;
  130. int value = ucontrol->value.integer.value[0];
  131. if ((eq_idx < 0) || (eq_idx >= MAX_EQ_SESSIONS))
  132. return -EINVAL;
  133. pr_debug("%s: EQ #%d bands %d\n", __func__,
  134. eq_idx, value);
  135. eq_data[eq_idx].num_bands = value;
  136. return 0;
  137. }
  138. static int msm_qti_pp_get_eq_band_audio_mixer(struct snd_kcontrol *kcontrol,
  139. struct snd_ctl_elem_value *ucontrol)
  140. {
  141. int eq_idx = ((struct soc_multi_mixer_control *)
  142. kcontrol->private_value)->reg;
  143. int band_idx = ((struct soc_multi_mixer_control *)
  144. kcontrol->private_value)->shift;
  145. if ((eq_idx < 0) || (eq_idx >= MAX_EQ_SESSIONS) ||
  146. (band_idx < EQ_BAND1) || (band_idx >= EQ_BAND_MAX))
  147. return -EINVAL;
  148. ucontrol->value.integer.value[0] =
  149. eq_data[eq_idx].eq_bands[band_idx].band_idx;
  150. ucontrol->value.integer.value[1] =
  151. eq_data[eq_idx].eq_bands[band_idx].filter_type;
  152. ucontrol->value.integer.value[2] =
  153. eq_data[eq_idx].eq_bands[band_idx].center_freq_hz;
  154. ucontrol->value.integer.value[3] =
  155. eq_data[eq_idx].eq_bands[band_idx].filter_gain;
  156. ucontrol->value.integer.value[4] =
  157. eq_data[eq_idx].eq_bands[band_idx].q_factor;
  158. pr_debug("%s: band_idx = %d\n", __func__,
  159. eq_data[eq_idx].eq_bands[band_idx].band_idx);
  160. pr_debug("%s: filter_type = %d\n", __func__,
  161. eq_data[eq_idx].eq_bands[band_idx].filter_type);
  162. pr_debug("%s: center_freq_hz = %d\n", __func__,
  163. eq_data[eq_idx].eq_bands[band_idx].center_freq_hz);
  164. pr_debug("%s: filter_gain = %d\n", __func__,
  165. eq_data[eq_idx].eq_bands[band_idx].filter_gain);
  166. pr_debug("%s: q_factor = %d\n", __func__,
  167. eq_data[eq_idx].eq_bands[band_idx].q_factor);
  168. return 0;
  169. }
  170. static int msm_qti_pp_put_eq_band_audio_mixer(struct snd_kcontrol *kcontrol,
  171. struct snd_ctl_elem_value *ucontrol)
  172. {
  173. int eq_idx = ((struct soc_multi_mixer_control *)
  174. kcontrol->private_value)->reg;
  175. int band_idx = ((struct soc_multi_mixer_control *)
  176. kcontrol->private_value)->shift;
  177. if ((eq_idx < 0) || (eq_idx >= MAX_EQ_SESSIONS) ||
  178. (band_idx < EQ_BAND1) || (band_idx >= EQ_BAND_MAX))
  179. return -EINVAL;
  180. eq_data[eq_idx].eq_bands[band_idx].band_idx =
  181. ucontrol->value.integer.value[0];
  182. eq_data[eq_idx].eq_bands[band_idx].filter_type =
  183. ucontrol->value.integer.value[1];
  184. eq_data[eq_idx].eq_bands[band_idx].center_freq_hz =
  185. ucontrol->value.integer.value[2];
  186. eq_data[eq_idx].eq_bands[band_idx].filter_gain =
  187. ucontrol->value.integer.value[3];
  188. eq_data[eq_idx].eq_bands[band_idx].q_factor =
  189. ucontrol->value.integer.value[4];
  190. return 0;
  191. }
  192. #ifdef CONFIG_QTI_PP
  193. void msm_qti_pp_send_eq_values(int fedai_id)
  194. {
  195. if (eq_data[fedai_id].enable)
  196. msm_qti_pp_send_eq_values_(fedai_id);
  197. }
  198. /* CUSTOM MIXING */
  199. int msm_qti_pp_send_stereo_to_custom_stereo_cmd(int port_id, int copp_idx,
  200. unsigned int session_id,
  201. uint16_t op_FL_ip_FL_weight,
  202. uint16_t op_FL_ip_FR_weight,
  203. uint16_t op_FR_ip_FL_weight,
  204. uint16_t op_FR_ip_FR_weight)
  205. {
  206. char *params_value;
  207. int *update_params_value32, rc = 0;
  208. int16_t *update_params_value16 = 0;
  209. uint32_t params_length = CUSTOM_STEREO_PAYLOAD_SIZE * sizeof(uint32_t);
  210. uint32_t avail_length = params_length;
  211. pr_debug("%s: port_id - %d, session id - %d\n", __func__, port_id,
  212. session_id);
  213. params_value = kzalloc(params_length, GFP_KERNEL);
  214. if (!params_value) {
  215. pr_err("%s, params memory alloc failed\n", __func__);
  216. return -ENOMEM;
  217. }
  218. update_params_value32 = (int *)params_value;
  219. if (avail_length < 2 * sizeof(uint32_t))
  220. goto skip_send_cmd;
  221. /*
  222. * This module is internal to ADSP and cannot be configured with
  223. * an instance id
  224. */
  225. *update_params_value32++ = MTMX_MODULE_ID_DEFAULT_CHMIXER;
  226. *update_params_value32++ = DEFAULT_CHMIXER_PARAM_ID_COEFF;
  227. avail_length = avail_length - (2 * sizeof(uint32_t));
  228. update_params_value16 = (int16_t *)update_params_value32;
  229. if (avail_length < 10 * sizeof(uint16_t))
  230. goto skip_send_cmd;
  231. *update_params_value16++ = CUSTOM_STEREO_CMD_PARAM_SIZE;
  232. /*for alignment only*/
  233. *update_params_value16++ = 0;
  234. /*index is 32-bit param in little endian*/
  235. *update_params_value16++ = CUSTOM_STEREO_INDEX_PARAM;
  236. *update_params_value16++ = 0;
  237. /*for stereo mixing num out ch*/
  238. *update_params_value16++ = CUSTOM_STEREO_NUM_OUT_CH;
  239. /*for stereo mixing num in ch*/
  240. *update_params_value16++ = CUSTOM_STEREO_NUM_IN_CH;
  241. /* Out ch map FL/FR*/
  242. *update_params_value16++ = PCM_CHANNEL_FL;
  243. *update_params_value16++ = PCM_CHANNEL_FR;
  244. /* In ch map FL/FR*/
  245. *update_params_value16++ = PCM_CHANNEL_FL;
  246. *update_params_value16++ = PCM_CHANNEL_FR;
  247. avail_length = avail_length - (10 * sizeof(uint16_t));
  248. /* weighting coefficients as name suggests,
  249. * mixing will be done according to these coefficients
  250. */
  251. if (avail_length < 4 * sizeof(uint16_t))
  252. goto skip_send_cmd;
  253. *update_params_value16++ = op_FL_ip_FL_weight;
  254. *update_params_value16++ = op_FL_ip_FR_weight;
  255. *update_params_value16++ = op_FR_ip_FL_weight;
  256. *update_params_value16++ = op_FR_ip_FR_weight;
  257. avail_length = avail_length - (4 * sizeof(uint16_t));
  258. if (params_length) {
  259. rc = adm_set_stereo_to_custom_stereo(port_id,
  260. copp_idx,
  261. session_id,
  262. params_value,
  263. params_length);
  264. if (rc) {
  265. pr_err("%s: send params failed rc=%d\n", __func__, rc);
  266. kfree(params_value);
  267. return -EINVAL;
  268. }
  269. }
  270. kfree(params_value);
  271. return 0;
  272. skip_send_cmd:
  273. pr_err("%s: insufficient memory, send cmd failed\n",
  274. __func__);
  275. kfree(params_value);
  276. return -ENOMEM;
  277. }
  278. static int msm_qti_pp_arrange_mch_map(int16_t *update_params_value16,
  279. int channel_count)
  280. {
  281. int i;
  282. int16_t ch_map[PCM_FORMAT_MAX_CHANNELS_9] = {
  283. PCM_CHANNEL_FL, PCM_CHANNEL_FR, PCM_CHANNEL_FC,
  284. PCM_CHANNEL_LS, PCM_CHANNEL_RS, PCM_CHANNEL_LFE,
  285. PCM_CHANNEL_LB, PCM_CHANNEL_RB, PCM_CHANNEL_CS };
  286. if (channel_count < 1 ||
  287. channel_count > PCM_FORMAT_MAX_CHANNELS_9) {
  288. pr_err("%s: invalid ch_cnt %d\n",
  289. __func__, channel_count);
  290. return -EINVAL;
  291. }
  292. switch (channel_count) {
  293. /* Add special cases here */
  294. case 1:
  295. *update_params_value16++ = PCM_CHANNEL_FC;
  296. break;
  297. case 4:
  298. *update_params_value16++ = PCM_CHANNEL_FL;
  299. *update_params_value16++ = PCM_CHANNEL_FR;
  300. *update_params_value16++ = PCM_CHANNEL_LS;
  301. *update_params_value16++ = PCM_CHANNEL_RS;
  302. break;
  303. /* Add standard cases here */
  304. default:
  305. for (i = 0; i < channel_count; i++)
  306. *update_params_value16++ = ch_map[i];
  307. break;
  308. }
  309. return 0;
  310. }
  311. static uint32_t msm_qti_pp_get_chmix_param_size(int ip_ch_cnt, int op_ch_cnt)
  312. {
  313. uint32_t param_size;
  314. /* Assign constant part of param length initially -
  315. * Index, Num out channels, Num in channels.
  316. */
  317. param_size = CHMIX_CFG_CONST_PARAM_SIZE * sizeof(uint16_t);
  318. /* Calculate variable part of param length using ip and op channels */
  319. /* channel map for input and output channels */
  320. param_size += op_ch_cnt * sizeof(uint16_t);
  321. param_size += ip_ch_cnt * sizeof(uint16_t);
  322. /* weightage coeff for each op ch corresponding to each ip ch */
  323. param_size += (ip_ch_cnt * op_ch_cnt) * sizeof(uint16_t);
  324. /* Params length should be multiple of 4 bytes i.e 32bit aligned*/
  325. param_size = (param_size + 3) & 0xFFFFFFFC;
  326. return param_size;
  327. }
  328. /*
  329. * msm_qti_pp_send_chmix_cfg_cmd:
  330. * Send the custom channel mixer configuration command.
  331. *
  332. * @port_id: Backend port id
  333. * @copp_idx: ADM copp index
  334. * @session_id: id for the session requesting channel mixer
  335. * @ip_channel_cnt: Input channel count
  336. * @op_channel_cnt: Output channel count
  337. * @ch_wght_coeff: Channel weight co-efficients for mixing
  338. * @session_type: Indicates TX or RX session
  339. * @stream_type: Indicates Audio or Listen stream type
  340. */
  341. int msm_qti_pp_send_chmix_cfg_cmd(int port_id, int copp_idx,
  342. unsigned int session_id, int ip_channel_cnt,
  343. int op_channel_cnt, int *ch_wght_coeff,
  344. int session_type, int stream_type)
  345. {
  346. char *params_value;
  347. int rc = 0, i, direction;
  348. u8 *param_ptr;
  349. int16_t *update_params_value16 = 0;
  350. uint32_t param_size = msm_qti_pp_get_chmix_param_size(ip_channel_cnt,
  351. op_channel_cnt);
  352. struct param_hdr_v3 *param_hdr;
  353. /* constant payload data size represents module_id, param_id,
  354. * param size, reserved field.
  355. */
  356. uint32_t params_length = param_size + sizeof(*param_hdr);
  357. pr_debug("%s: port_id - %d, session id - %d\n", __func__, port_id,
  358. session_id);
  359. params_value = kzalloc(params_length, GFP_KERNEL);
  360. if (!params_value)
  361. return -ENOMEM;
  362. param_ptr = params_value;
  363. param_hdr = (struct param_hdr_v3 *) param_ptr;
  364. param_hdr->module_id = MTMX_MODULE_ID_DEFAULT_CHMIXER;
  365. param_hdr->instance_id = INSTANCE_ID_0;
  366. param_hdr->param_id = DEFAULT_CHMIXER_PARAM_ID_COEFF;
  367. param_hdr->param_size = param_size;
  368. param_ptr += sizeof(*param_hdr);
  369. update_params_value16 = (int16_t *) param_ptr;
  370. /*for alignment only*/
  371. *update_params_value16++ = 0;
  372. /*index is 32-bit param in little endian*/
  373. *update_params_value16++ = CUSTOM_STEREO_INDEX_PARAM;
  374. *update_params_value16++ = 0;
  375. /*number of out ch*/
  376. *update_params_value16++ = op_channel_cnt;
  377. /*number of in ch*/
  378. *update_params_value16++ = ip_channel_cnt;
  379. /* Out ch map FL/FR*/
  380. msm_qti_pp_arrange_mch_map(update_params_value16, op_channel_cnt);
  381. update_params_value16 += op_channel_cnt;
  382. /* In ch map FL/FR*/
  383. msm_qti_pp_arrange_mch_map(update_params_value16, ip_channel_cnt);
  384. update_params_value16 += ip_channel_cnt;
  385. /* weighting coefficients as name suggests,
  386. * mixing will be done according to these coefficients.
  387. */
  388. for (i = 0; i < ip_channel_cnt * op_channel_cnt; i++)
  389. *update_params_value16++ =
  390. ch_wght_coeff[i] ? Q14_GAIN_UNITY : 0;
  391. if (params_length) {
  392. direction = (session_type == SESSION_TYPE_RX) ?
  393. ADM_MATRIX_ID_AUDIO_RX : ADM_MATRIX_ID_AUDIO_TX;
  394. rc = adm_set_custom_chmix_cfg(port_id,
  395. copp_idx,
  396. session_id,
  397. params_value,
  398. params_length,
  399. direction,
  400. stream_type);
  401. if (rc) {
  402. pr_err("%s: send params failed rc=%d\n", __func__, rc);
  403. kfree(params_value);
  404. return -EINVAL;
  405. }
  406. }
  407. kfree(params_value);
  408. return 0;
  409. }
  410. EXPORT_SYMBOL(msm_qti_pp_send_chmix_cfg_cmd);
  411. #endif /* CONFIG_QTI_PP */
  412. /* RMS */
  413. static int msm_qti_pp_get_rms_value_control(struct snd_kcontrol *kcontrol,
  414. struct snd_ctl_elem_value *ucontrol)
  415. {
  416. int rc = 0;
  417. int be_idx = 0, copp_idx;
  418. char *param_value;
  419. int *update_param_value;
  420. uint32_t param_size = (RMS_PAYLOAD_LEN + 1) * sizeof(uint32_t);
  421. struct msm_pcm_routing_bdai_data msm_bedai;
  422. struct param_hdr_v3 param_hdr;
  423. param_value = kzalloc(param_size, GFP_KERNEL);
  424. if (!param_value)
  425. return -ENOMEM;
  426. msm_pcm_routing_acquire_lock();
  427. for (be_idx = 0; be_idx < MSM_BACKEND_DAI_MAX; be_idx++) {
  428. msm_pcm_routing_get_bedai_info(be_idx, &msm_bedai);
  429. if (msm_bedai.port_id == SLIMBUS_0_TX)
  430. break;
  431. }
  432. if ((be_idx >= MSM_BACKEND_DAI_MAX) || !msm_bedai.active) {
  433. pr_err("%s, back not active to query rms be_idx:%d\n",
  434. __func__, be_idx);
  435. rc = -EINVAL;
  436. goto get_rms_value_err;
  437. }
  438. copp_idx = adm_get_default_copp_idx(SLIMBUS_0_TX);
  439. if ((copp_idx < 0) || (copp_idx > MAX_COPPS_PER_PORT)) {
  440. pr_err("%s, no active copp to query rms copp_idx:%d\n",
  441. __func__, copp_idx);
  442. rc = -EINVAL;
  443. goto get_rms_value_err;
  444. }
  445. memset(&param_hdr, 0, sizeof(param_hdr));
  446. param_hdr.module_id = RMS_MODULEID_APPI_PASSTHRU;
  447. param_hdr.instance_id = INSTANCE_ID_0;
  448. param_hdr.param_id = RMS_PARAM_FIRST_SAMPLE;
  449. param_hdr.param_size = param_size;
  450. rc = adm_get_pp_params(SLIMBUS_0_TX, copp_idx, ADM_CLIENT_ID_DEFAULT,
  451. NULL, &param_hdr, param_value);
  452. if (rc) {
  453. pr_err("%s: get parameters failed rc=%d\n", __func__, rc);
  454. rc = -EINVAL;
  455. goto get_rms_value_err;
  456. }
  457. update_param_value = (int *)param_value;
  458. ucontrol->value.integer.value[0] = update_param_value[0];
  459. pr_debug("%s: FROM DSP value[0] 0x%x\n",
  460. __func__, update_param_value[0]);
  461. get_rms_value_err:
  462. msm_pcm_routing_release_lock();
  463. kfree(param_value);
  464. return rc;
  465. }
  466. static int msm_qti_pp_put_rms_value_control(struct snd_kcontrol *kcontrol,
  467. struct snd_ctl_elem_value *ucontrol)
  468. {
  469. /* not used */
  470. return 0;
  471. }
  472. /* VOLUME */
  473. static int msm_route_fm_vol_control;
  474. static int msm_afe_lb_vol_ctrl;
  475. static int msm_afe_sec_mi2s_lb_vol_ctrl;
  476. static int msm_afe_tert_mi2s_lb_vol_ctrl;
  477. static int msm_afe_quat_mi2s_lb_vol_ctrl;
  478. static int msm_afe_slimbus_7_lb_vol_ctrl;
  479. static int msm_afe_slimbus_8_lb_vol_ctrl;
  480. static int msm_asm_bit_width;
  481. static const DECLARE_TLV_DB_LINEAR(fm_rx_vol_gain, 0, INT_RX_VOL_MAX_STEPS);
  482. static const DECLARE_TLV_DB_LINEAR(afe_lb_vol_gain, 0, INT_RX_VOL_MAX_STEPS);
  483. static int msm_qti_pp_get_fm_vol_mixer(struct snd_kcontrol *kcontrol,
  484. struct snd_ctl_elem_value *ucontrol)
  485. {
  486. ucontrol->value.integer.value[0] = msm_route_fm_vol_control;
  487. return 0;
  488. }
  489. static int msm_qti_pp_set_fm_vol_mixer(struct snd_kcontrol *kcontrol,
  490. struct snd_ctl_elem_value *ucontrol)
  491. {
  492. afe_loopback_gain(INT_FM_TX, ucontrol->value.integer.value[0]);
  493. msm_route_fm_vol_control = ucontrol->value.integer.value[0];
  494. return 0;
  495. }
  496. static int msm_asm_bit_width_get(struct snd_kcontrol *kcontrol,
  497. struct snd_ctl_elem_value *ucontrol)
  498. {
  499. pr_debug("%s get ASM bitwidth = %d\n",
  500. __func__, msm_asm_bit_width);
  501. ucontrol->value.integer.value[0] = msm_asm_bit_width;
  502. return 0;
  503. }
  504. static int msm_asm_bit_width_put(struct snd_kcontrol *kcontrol,
  505. struct snd_ctl_elem_value *ucontrol)
  506. {
  507. switch (ucontrol->value.integer.value[0]) {
  508. case 16:
  509. msm_asm_bit_width = 16;
  510. break;
  511. case 24:
  512. msm_asm_bit_width = 24;
  513. break;
  514. case 32:
  515. msm_asm_bit_width = 32;
  516. break;
  517. default:
  518. msm_asm_bit_width = 0;
  519. break;
  520. }
  521. return 0;
  522. }
  523. static int msm_qti_pp_get_pri_mi2s_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  524. struct snd_ctl_elem_value *ucontrol)
  525. {
  526. ucontrol->value.integer.value[0] = msm_afe_lb_vol_ctrl;
  527. return 0;
  528. }
  529. static int msm_qti_pp_set_pri_mi2s_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  530. struct snd_ctl_elem_value *ucontrol)
  531. {
  532. afe_loopback_gain(AFE_PORT_ID_PRIMARY_MI2S_TX,
  533. ucontrol->value.integer.value[0]);
  534. msm_afe_lb_vol_ctrl = ucontrol->value.integer.value[0];
  535. return 0;
  536. }
  537. static int msm_qti_pp_get_sec_mi2s_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  538. struct snd_ctl_elem_value *ucontrol)
  539. {
  540. ucontrol->value.integer.value[0] = msm_afe_sec_mi2s_lb_vol_ctrl;
  541. return 0;
  542. }
  543. static int msm_qti_pp_set_sec_mi2s_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  544. struct snd_ctl_elem_value *ucontrol)
  545. {
  546. afe_loopback_gain(AFE_PORT_ID_SECONDARY_MI2S_TX,
  547. ucontrol->value.integer.value[0]);
  548. msm_afe_sec_mi2s_lb_vol_ctrl = ucontrol->value.integer.value[0];
  549. return 0;
  550. }
  551. static int msm_qti_pp_get_tert_mi2s_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  552. struct snd_ctl_elem_value *ucontrol)
  553. {
  554. ucontrol->value.integer.value[0] = msm_afe_tert_mi2s_lb_vol_ctrl;
  555. return 0;
  556. }
  557. static int msm_qti_pp_set_tert_mi2s_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  558. struct snd_ctl_elem_value *ucontrol)
  559. {
  560. afe_loopback_gain(AFE_PORT_ID_TERTIARY_MI2S_TX,
  561. ucontrol->value.integer.value[0]);
  562. msm_afe_tert_mi2s_lb_vol_ctrl = ucontrol->value.integer.value[0];
  563. return 0;
  564. }
  565. static int msm_qti_pp_get_slimbus_7_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  566. struct snd_ctl_elem_value *ucontrol)
  567. {
  568. ucontrol->value.integer.value[0] = msm_afe_slimbus_7_lb_vol_ctrl;
  569. return 0;
  570. }
  571. static int msm_qti_pp_set_slimbus_7_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  572. struct snd_ctl_elem_value *ucontrol)
  573. {
  574. int ret = afe_loopback_gain(SLIMBUS_7_TX,
  575. ucontrol->value.integer.value[0]);
  576. if (ret)
  577. pr_err("%s: failed to set LB vol for SLIMBUS_7_TX, err %d\n",
  578. __func__, ret);
  579. else
  580. msm_afe_slimbus_7_lb_vol_ctrl =
  581. ucontrol->value.integer.value[0];
  582. return ret;
  583. }
  584. static int msm_qti_pp_get_slimbus_8_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  585. struct snd_ctl_elem_value *ucontrol)
  586. {
  587. ucontrol->value.integer.value[0] = msm_afe_slimbus_8_lb_vol_ctrl;
  588. return 0;
  589. }
  590. static int msm_qti_pp_set_slimbus_8_lb_vol_mixer(struct snd_kcontrol *kcontrol,
  591. struct snd_ctl_elem_value *ucontrol)
  592. {
  593. int ret = 0;
  594. ret = afe_loopback_gain(SLIMBUS_8_TX,
  595. ucontrol->value.integer.value[0]);
  596. if (ret)
  597. pr_err("%s: failed to set LB vol for SLIMBUS_8_TX", __func__);
  598. else
  599. msm_afe_slimbus_8_lb_vol_ctrl =
  600. ucontrol->value.integer.value[0];
  601. return ret;
  602. }
  603. static int msm_qti_pp_get_icc_vol_mixer(struct snd_kcontrol *kcontrol,
  604. struct snd_ctl_elem_value *ucontrol)
  605. {
  606. ucontrol->value.integer.value[0] = msm_route_icc_vol_control;
  607. return 0;
  608. }
  609. static int msm_qti_pp_set_icc_vol_mixer(struct snd_kcontrol *kcontrol,
  610. struct snd_ctl_elem_value *ucontrol)
  611. {
  612. adm_set_mic_gain(AFE_PORT_ID_QUATERNARY_TDM_TX,
  613. adm_get_default_copp_idx(AFE_PORT_ID_QUATERNARY_TDM_TX),
  614. ucontrol->value.integer.value[0]);
  615. msm_route_icc_vol_control = ucontrol->value.integer.value[0];
  616. return 0;
  617. }
  618. static int msm_qti_pp_get_quat_mi2s_fm_vol_mixer(struct snd_kcontrol *kcontrol,
  619. struct snd_ctl_elem_value *ucontrol)
  620. {
  621. ucontrol->value.integer.value[0] = msm_afe_quat_mi2s_lb_vol_ctrl;
  622. return 0;
  623. }
  624. static int msm_qti_pp_set_quat_mi2s_fm_vol_mixer(struct snd_kcontrol *kcontrol,
  625. struct snd_ctl_elem_value *ucontrol)
  626. {
  627. afe_loopback_gain(AFE_PORT_ID_QUATERNARY_MI2S_TX,
  628. ucontrol->value.integer.value[0]);
  629. msm_afe_quat_mi2s_lb_vol_ctrl = ucontrol->value.integer.value[0];
  630. return 0;
  631. }
  632. static int msm_qti_pp_get_hfp_vol_mixer(struct snd_kcontrol *kcontrol,
  633. struct snd_ctl_elem_value *ucontrol)
  634. {
  635. ucontrol->value.integer.value[0] = msm_route_hfp_vol_control;
  636. return 0;
  637. }
  638. static int msm_qti_pp_set_hfp_vol_mixer(struct snd_kcontrol *kcontrol,
  639. struct snd_ctl_elem_value *ucontrol)
  640. {
  641. afe_loopback_gain(INT_BT_SCO_TX, ucontrol->value.integer.value[0]);
  642. msm_route_hfp_vol_control = ucontrol->value.integer.value[0];
  643. return 0;
  644. }
  645. static int msm_qti_pp_get_pri_auxpcm_lb_vol_mixer(
  646. struct snd_kcontrol *kcontrol,
  647. struct snd_ctl_elem_value *ucontrol)
  648. {
  649. ucontrol->value.integer.value[0] = msm_route_pri_auxpcm_lb_vol_ctrl;
  650. pr_debug("%s: Volume = %ld\n", __func__,
  651. ucontrol->value.integer.value[0]);
  652. return 0;
  653. }
  654. static int msm_qti_pp_set_pri_auxpcm_lb_vol_mixer(
  655. struct snd_kcontrol *kcontrol,
  656. struct snd_ctl_elem_value *ucontrol)
  657. {
  658. struct soc_mixer_control *mc =
  659. (struct soc_mixer_control *)kcontrol->private_value;
  660. afe_loopback_gain(mc->reg, ucontrol->value.integer.value[0]);
  661. msm_route_pri_auxpcm_lb_vol_ctrl = ucontrol->value.integer.value[0];
  662. return 0;
  663. }
  664. static int msm_qti_pp_get_sec_auxpcm_lb_vol_mixer(
  665. struct snd_kcontrol *kcontrol,
  666. struct snd_ctl_elem_value *ucontrol)
  667. {
  668. ucontrol->value.integer.value[0] = msm_route_sec_auxpcm_lb_vol_ctrl;
  669. pr_debug("%s: Volume = %ld\n", __func__,
  670. ucontrol->value.integer.value[0]);
  671. return 0;
  672. }
  673. static int msm_qti_pp_set_sec_auxpcm_lb_vol_mixer(
  674. struct snd_kcontrol *kcontrol,
  675. struct snd_ctl_elem_value *ucontrol)
  676. {
  677. struct soc_mixer_control *mc =
  678. (struct soc_mixer_control *)kcontrol->private_value;
  679. afe_loopback_gain(mc->reg, ucontrol->value.integer.value[0]);
  680. msm_route_sec_auxpcm_lb_vol_ctrl = ucontrol->value.integer.value[0];
  681. return 0;
  682. }
  683. static int msm_qti_pp_get_channel_map_mixer(struct snd_kcontrol *kcontrol,
  684. struct snd_ctl_elem_value *ucontrol)
  685. {
  686. char channel_map[PCM_FORMAT_MAX_NUM_CHANNEL_V8] = {0};
  687. int i;
  688. adm_get_multi_ch_map(channel_map, ADM_PATH_PLAYBACK);
  689. for (i = 0; i < PCM_FORMAT_MAX_NUM_CHANNEL_V8; i++)
  690. ucontrol->value.integer.value[i] =
  691. (unsigned int) channel_map[i];
  692. return 0;
  693. }
  694. static int msm_qti_pp_put_channel_map_mixer(struct snd_kcontrol *kcontrol,
  695. struct snd_ctl_elem_value *ucontrol)
  696. {
  697. char channel_map[PCM_FORMAT_MAX_NUM_CHANNEL_V8];
  698. int i;
  699. for (i = 0; i < PCM_FORMAT_MAX_NUM_CHANNEL_V8; i++)
  700. channel_map[i] = (char)(ucontrol->value.integer.value[i]);
  701. adm_set_multi_ch_map(channel_map, ADM_PATH_PLAYBACK);
  702. return 0;
  703. }
  704. /* Audio Sphere functions */
  705. static void msm_qti_pp_asphere_init_state(void)
  706. {
  707. int i;
  708. if (asphere_state.initialized)
  709. return;
  710. asphere_state.initialized = true;
  711. for (i = 0; i < AFE_MAX_PORTS; i++) {
  712. asphere_state.port_id[i] = -1;
  713. asphere_state.copp_idx[i] = -1;
  714. }
  715. asphere_state.enabled = 0;
  716. asphere_state.strength = 0;
  717. asphere_state.mode = 0;
  718. asphere_state.version = 0;
  719. asphere_state.enabled_prev = 0;
  720. asphere_state.strength_prev = 0;
  721. }
  722. static int msm_qti_pp_asphere_send_params(int port_id, int copp_idx, bool force)
  723. {
  724. u8 *packed_params = NULL;
  725. u32 packed_params_size = 0;
  726. u32 param_size = 0;
  727. struct param_hdr_v3 param_hdr;
  728. bool set_enable = force ||
  729. (asphere_state.enabled != asphere_state.enabled_prev);
  730. bool set_strength = asphere_state.enabled == 1 && (set_enable ||
  731. (asphere_state.strength != asphere_state.strength_prev));
  732. int param_count = 0;
  733. int ret = 0;
  734. if (set_enable)
  735. param_count++;
  736. if (set_strength)
  737. param_count++;
  738. if (param_count == 0) {
  739. pr_debug("%s: Nothing to send, exiting\n", __func__);
  740. return 0;
  741. }
  742. pr_debug("%s: port_id %d, copp_id %d, forced %d, param_count %d\n",
  743. __func__, port_id, copp_idx, force, param_count);
  744. pr_debug("%s: enable prev:%u cur:%u, strength prev:%u cur:%u\n",
  745. __func__, asphere_state.enabled_prev, asphere_state.enabled,
  746. asphere_state.strength_prev, asphere_state.strength);
  747. packed_params_size =
  748. param_count * (sizeof(struct param_hdr_v3) + sizeof(uint32_t));
  749. packed_params = kzalloc(packed_params_size, GFP_KERNEL);
  750. if (!packed_params)
  751. return -ENOMEM;
  752. memset(&param_hdr, 0, sizeof(param_hdr));
  753. packed_params_size = 0;
  754. param_hdr.module_id = AUDPROC_MODULE_ID_AUDIOSPHERE;
  755. param_hdr.instance_id = INSTANCE_ID_0;
  756. if (set_strength) {
  757. /* add strength command */
  758. param_hdr.param_id = AUDPROC_PARAM_ID_AUDIOSPHERE_STRENGTH;
  759. param_hdr.param_size = sizeof(asphere_state.strength);
  760. ret = q6common_pack_pp_params(packed_params +
  761. packed_params_size,
  762. &param_hdr,
  763. (u8 *) &asphere_state.strength,
  764. &param_size);
  765. if (ret) {
  766. pr_err("%s: Failed to pack params for audio sphere"
  767. " strength, error %d\n", __func__, ret);
  768. goto done;
  769. }
  770. packed_params_size += param_size;
  771. }
  772. if (set_enable) {
  773. /* add enable command */
  774. param_hdr.param_id = AUDPROC_PARAM_ID_AUDIOSPHERE_ENABLE;
  775. param_hdr.param_size = sizeof(asphere_state.enabled);
  776. q6common_pack_pp_params(packed_params + packed_params_size,
  777. &param_hdr,
  778. (u8 *) &asphere_state.enabled,
  779. &param_size);
  780. if (ret) {
  781. pr_err("%s: Failed to pack params for audio sphere"
  782. " enable, error %d\n", __func__, ret);
  783. goto done;
  784. }
  785. packed_params_size += param_size;
  786. }
  787. pr_debug("%s: packed data size: %d\n", __func__, packed_params_size);
  788. ret = adm_set_pp_params(port_id, copp_idx, NULL, packed_params,
  789. packed_params_size);
  790. if (ret)
  791. pr_err("%s: set param failed with err=%d\n", __func__, ret);
  792. done:
  793. kfree(packed_params);
  794. return 0;
  795. }
  796. #if defined(CONFIG_QTI_PP) && defined(CONFIG_QTI_PP_AUDIOSPHERE)
  797. int msm_qti_pp_asphere_init(int port_id, int copp_idx)
  798. {
  799. int index = adm_validate_and_get_port_index(port_id);
  800. pr_debug("%s, port_id %d, copp_id %d\n", __func__, port_id, copp_idx);
  801. if (index < 0) {
  802. pr_err("%s: Invalid port idx %d port_id %#x\n", __func__, index,
  803. port_id);
  804. return -EINVAL;
  805. }
  806. msm_qti_pp_asphere_init_state();
  807. asphere_state.port_id[index] = port_id;
  808. asphere_state.copp_idx[index] = copp_idx;
  809. if (asphere_state.enabled)
  810. msm_qti_pp_asphere_send_params(port_id, copp_idx, true);
  811. return 0;
  812. }
  813. void msm_qti_pp_asphere_deinit(int port_id)
  814. {
  815. int index = adm_validate_and_get_port_index(port_id);
  816. pr_debug("%s, port_id %d\n", __func__, port_id);
  817. if (index < 0) {
  818. pr_err("%s: Invalid port idx %d port_id %#x\n", __func__, index,
  819. port_id);
  820. return;
  821. }
  822. if (asphere_state.port_id[index] == port_id) {
  823. asphere_state.port_id[index] = -1;
  824. asphere_state.copp_idx[index] = -1;
  825. }
  826. }
  827. #endif
  828. static int msm_qti_pp_asphere_get(struct snd_kcontrol *kcontrol,
  829. struct snd_ctl_elem_value *ucontrol)
  830. {
  831. if (!asphere_state.initialized)
  832. return -EAGAIN;
  833. ucontrol->value.integer.value[0] = asphere_state.enabled;
  834. ucontrol->value.integer.value[1] = asphere_state.strength;
  835. pr_debug("%s, enable %u, strength %u\n", __func__,
  836. asphere_state.enabled, asphere_state.strength);
  837. return 0;
  838. }
  839. static int msm_qti_pp_asphere_set(struct snd_kcontrol *kcontrol,
  840. struct snd_ctl_elem_value *ucontrol)
  841. {
  842. int32_t enable = ucontrol->value.integer.value[0];
  843. int32_t strength = ucontrol->value.integer.value[1];
  844. int i;
  845. pr_debug("%s, enable %u, strength %u\n", __func__, enable, strength);
  846. msm_qti_pp_asphere_init_state();
  847. if (enable == 0 || enable == 1) {
  848. asphere_state.enabled_prev = asphere_state.enabled;
  849. asphere_state.enabled = enable;
  850. }
  851. if (strength >= 0 && strength <= 1000) {
  852. asphere_state.strength_prev = asphere_state.strength;
  853. asphere_state.strength = strength;
  854. }
  855. if (asphere_state.strength != asphere_state.strength_prev ||
  856. asphere_state.enabled != asphere_state.enabled_prev) {
  857. for (i = 0; i < AFE_MAX_PORTS; i++) {
  858. if (asphere_state.port_id[i] >= 0)
  859. msm_qti_pp_asphere_send_params(
  860. asphere_state.port_id[i],
  861. asphere_state.copp_idx[i],
  862. false);
  863. }
  864. }
  865. return 0;
  866. }
  867. int msm_adsp_init_mixer_ctl_pp_event_queue(struct snd_soc_pcm_runtime *rtd)
  868. {
  869. struct snd_kcontrol *kctl;
  870. const char *deviceNo = "NN";
  871. char *mixer_str = NULL;
  872. int ctl_len = 0, ret = 0;
  873. const char *mixer_ctl_name = DSP_STREAM_CALLBACK;
  874. struct dsp_stream_callback_prtd *kctl_prtd = NULL;
  875. if (!rtd) {
  876. pr_err("%s: rtd is NULL\n", __func__);
  877. ret = -EINVAL;
  878. goto done;
  879. }
  880. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  881. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  882. if (!mixer_str) {
  883. ret = -EINVAL;
  884. goto done;
  885. }
  886. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name,
  887. rtd->pcm->device);
  888. kctl = snd_soc_card_get_kcontrol(rtd->card, mixer_str);
  889. kfree(mixer_str);
  890. if (!kctl) {
  891. pr_err("%s: failed to get kctl.\n", __func__);
  892. ret = -EINVAL;
  893. goto done;
  894. }
  895. if (kctl->private_data != NULL) {
  896. pr_err("%s: kctl_prtd is not NULL at initialization.\n",
  897. __func__);
  898. return -EINVAL;
  899. }
  900. kctl_prtd = kzalloc(sizeof(struct dsp_stream_callback_prtd),
  901. GFP_KERNEL);
  902. if (!kctl_prtd) {
  903. ret = -ENOMEM;
  904. goto done;
  905. }
  906. spin_lock_init(&kctl_prtd->prtd_spin_lock);
  907. INIT_LIST_HEAD(&kctl_prtd->event_queue);
  908. kctl_prtd->event_count = 0;
  909. kctl->private_data = kctl_prtd;
  910. done:
  911. return ret;
  912. }
  913. int msm_adsp_clean_mixer_ctl_pp_event_queue(struct snd_soc_pcm_runtime *rtd)
  914. {
  915. struct snd_kcontrol *kctl;
  916. const char *deviceNo = "NN";
  917. char *mixer_str = NULL;
  918. int ctl_len = 0, ret = 0;
  919. struct dsp_stream_callback_list *node, *n;
  920. unsigned long spin_flags;
  921. const char *mixer_ctl_name = DSP_STREAM_CALLBACK;
  922. struct dsp_stream_callback_prtd *kctl_prtd = NULL;
  923. if (!rtd) {
  924. pr_err("%s: rtd is NULL\n", __func__);
  925. ret = -EINVAL;
  926. goto done;
  927. }
  928. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  929. mixer_str = kzalloc(ctl_len, GFP_KERNEL);
  930. if (!mixer_str) {
  931. ret = -EINVAL;
  932. goto done;
  933. }
  934. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name,
  935. rtd->pcm->device);
  936. kctl = snd_soc_card_get_kcontrol(rtd->card, mixer_str);
  937. kfree(mixer_str);
  938. if (!kctl) {
  939. pr_err("%s: failed to get kctl.\n", __func__);
  940. ret = -EINVAL;
  941. goto done;
  942. }
  943. kctl_prtd = (struct dsp_stream_callback_prtd *)
  944. kctl->private_data;
  945. if (kctl_prtd != NULL) {
  946. spin_lock_irqsave(&kctl_prtd->prtd_spin_lock, spin_flags);
  947. /* clean the queue */
  948. list_for_each_entry_safe(node, n,
  949. &kctl_prtd->event_queue, list) {
  950. list_del(&node->list);
  951. kctl_prtd->event_count--;
  952. pr_debug("%s: %d remaining events after del.\n",
  953. __func__, kctl_prtd->event_count);
  954. kfree(node);
  955. }
  956. spin_unlock_irqrestore(&kctl_prtd->prtd_spin_lock, spin_flags);
  957. }
  958. kfree(kctl_prtd);
  959. kctl->private_data = NULL;
  960. done:
  961. return ret;
  962. }
  963. int msm_adsp_inform_mixer_ctl(struct snd_soc_pcm_runtime *rtd,
  964. uint32_t *payload)
  965. {
  966. /* adsp pp event notifier */
  967. struct snd_kcontrol *kctl;
  968. struct snd_ctl_elem_value control;
  969. const char *deviceNo = "NN";
  970. char *mixer_str = NULL;
  971. int ctl_len = 0, ret = 0;
  972. struct dsp_stream_callback_list *new_event;
  973. struct dsp_stream_callback_list *oldest_event;
  974. unsigned long spin_flags;
  975. struct dsp_stream_callback_prtd *kctl_prtd = NULL;
  976. struct msm_adsp_event_data *event_data = NULL;
  977. const char *mixer_ctl_name = DSP_STREAM_CALLBACK;
  978. struct snd_ctl_elem_info kctl_info;
  979. if (!rtd || !payload) {
  980. pr_err("%s: %s is NULL\n", __func__,
  981. (!rtd) ? "rtd" : "payload");
  982. ret = -EINVAL;
  983. goto done;
  984. }
  985. if (rtd->card->snd_card == NULL) {
  986. pr_err("%s: snd_card is null.\n", __func__);
  987. ret = -EINVAL;
  988. goto done;
  989. }
  990. ctl_len = strlen(mixer_ctl_name) + 1 + strlen(deviceNo) + 1;
  991. mixer_str = kzalloc(ctl_len, GFP_ATOMIC);
  992. if (!mixer_str) {
  993. ret = -EINVAL;
  994. goto done;
  995. }
  996. snprintf(mixer_str, ctl_len, "%s %d", mixer_ctl_name,
  997. rtd->pcm->device);
  998. kctl = snd_soc_card_get_kcontrol(rtd->card, mixer_str);
  999. kfree(mixer_str);
  1000. if (!kctl) {
  1001. pr_err("%s: failed to get kctl.\n", __func__);
  1002. ret = -EINVAL;
  1003. goto done;
  1004. }
  1005. event_data = (struct msm_adsp_event_data *)payload;
  1006. kctl->info(kctl, &kctl_info);
  1007. if (event_data->payload_len >
  1008. kctl_info.count - sizeof(struct msm_adsp_event_data)) {
  1009. pr_err("%s: payload length exceeds limit of %u bytes.\n",
  1010. __func__, kctl_info.count);
  1011. ret = -EINVAL;
  1012. goto done;
  1013. }
  1014. kctl_prtd = (struct dsp_stream_callback_prtd *)
  1015. kctl->private_data;
  1016. if (kctl_prtd == NULL) {
  1017. /* queue is not initialized */
  1018. ret = -EINVAL;
  1019. pr_err("%s: event queue is not initialized.\n", __func__);
  1020. goto done;
  1021. }
  1022. new_event = kzalloc(sizeof(struct dsp_stream_callback_list)
  1023. + event_data->payload_len,
  1024. GFP_ATOMIC);
  1025. if (new_event == NULL) {
  1026. ret = -ENOMEM;
  1027. goto done;
  1028. }
  1029. memcpy((void *)&new_event->event, (void *)payload,
  1030. event_data->payload_len
  1031. + sizeof(struct msm_adsp_event_data));
  1032. spin_lock_irqsave(&kctl_prtd->prtd_spin_lock, spin_flags);
  1033. while (kctl_prtd->event_count >= DSP_STREAM_CALLBACK_QUEUE_SIZE) {
  1034. pr_info("%s: queue of size %d is full. delete oldest one.\n",
  1035. __func__, DSP_STREAM_CALLBACK_QUEUE_SIZE);
  1036. oldest_event = list_first_entry(&kctl_prtd->event_queue,
  1037. struct dsp_stream_callback_list, list);
  1038. pr_info("%s: event deleted: type %d length %d\n",
  1039. __func__, oldest_event->event.event_type,
  1040. oldest_event->event.payload_len);
  1041. list_del(&oldest_event->list);
  1042. kctl_prtd->event_count--;
  1043. kfree(oldest_event);
  1044. }
  1045. list_add_tail(&new_event->list, &kctl_prtd->event_queue);
  1046. kctl_prtd->event_count++;
  1047. spin_unlock_irqrestore(&kctl_prtd->prtd_spin_lock, spin_flags);
  1048. control.id = kctl->id;
  1049. snd_ctl_notify(rtd->card->snd_card,
  1050. SNDRV_CTL_EVENT_MASK_INFO,
  1051. &control.id);
  1052. done:
  1053. return ret;
  1054. }
  1055. int msm_adsp_stream_cmd_info(struct snd_kcontrol *kcontrol,
  1056. struct snd_ctl_elem_info *uinfo)
  1057. {
  1058. uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
  1059. uinfo->count =
  1060. sizeof(((struct snd_ctl_elem_value *)0)->value.bytes.data);
  1061. return 0;
  1062. }
  1063. int msm_adsp_stream_callback_get(struct snd_kcontrol *kcontrol,
  1064. struct snd_ctl_elem_value *ucontrol)
  1065. {
  1066. uint32_t payload_size = 0;
  1067. struct dsp_stream_callback_list *oldest_event;
  1068. unsigned long spin_flags;
  1069. struct dsp_stream_callback_prtd *kctl_prtd = NULL;
  1070. int ret = 0;
  1071. kctl_prtd = (struct dsp_stream_callback_prtd *)
  1072. kcontrol->private_data;
  1073. if (kctl_prtd == NULL) {
  1074. pr_debug("%s: ASM Stream PP event queue is not initialized.\n",
  1075. __func__);
  1076. ret = -EINVAL;
  1077. goto done;
  1078. }
  1079. spin_lock_irqsave(&kctl_prtd->prtd_spin_lock, spin_flags);
  1080. pr_debug("%s: %d events in queue.\n", __func__, kctl_prtd->event_count);
  1081. if (list_empty(&kctl_prtd->event_queue)) {
  1082. pr_err("%s: ASM Stream PP event queue is empty.\n", __func__);
  1083. ret = -EINVAL;
  1084. spin_unlock_irqrestore(&kctl_prtd->prtd_spin_lock, spin_flags);
  1085. goto done;
  1086. }
  1087. oldest_event = list_first_entry(&kctl_prtd->event_queue,
  1088. struct dsp_stream_callback_list, list);
  1089. list_del(&oldest_event->list);
  1090. kctl_prtd->event_count--;
  1091. spin_unlock_irqrestore(&kctl_prtd->prtd_spin_lock, spin_flags);
  1092. payload_size = oldest_event->event.payload_len;
  1093. pr_debug("%s: event fetched: type %d length %d\n",
  1094. __func__, oldest_event->event.event_type,
  1095. oldest_event->event.payload_len);
  1096. memcpy(ucontrol->value.bytes.data, &oldest_event->event,
  1097. sizeof(struct msm_adsp_event_data) + payload_size);
  1098. kfree(oldest_event);
  1099. done:
  1100. return ret;
  1101. }
  1102. int msm_adsp_stream_callback_info(struct snd_kcontrol *kcontrol,
  1103. struct snd_ctl_elem_info *uinfo)
  1104. {
  1105. uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
  1106. uinfo->count =
  1107. sizeof(((struct snd_ctl_elem_value *)0)->value.bytes.data);
  1108. return 0;
  1109. }
  1110. static int msm_multichannel_ec_primary_mic_ch_put(struct snd_kcontrol *kcontrol,
  1111. struct snd_ctl_elem_value *ucontrol)
  1112. {
  1113. int ret = 0;
  1114. int copp_idx = 0;
  1115. int port_id = AFE_PORT_ID_QUATERNARY_TDM_TX;
  1116. msm_multichannel_ec_primary_mic_ch = ucontrol->value.integer.value[0];
  1117. pr_debug("%s: msm_multichannel_ec_primary_mic_ch = %u\n",
  1118. __func__, msm_multichannel_ec_primary_mic_ch);
  1119. copp_idx = adm_get_default_copp_idx(port_id);
  1120. if ((copp_idx < 0) || (copp_idx > MAX_COPPS_PER_PORT)) {
  1121. pr_err("%s : no active copp to query multichannel ec copp_idx: %u\n",
  1122. __func__, copp_idx);
  1123. return -EINVAL;
  1124. }
  1125. adm_send_set_multichannel_ec_primary_mic_ch(port_id, copp_idx,
  1126. msm_multichannel_ec_primary_mic_ch);
  1127. return ret;
  1128. }
  1129. static int msm_multichannel_ec_primary_mic_ch_get(struct snd_kcontrol *kcontrol,
  1130. struct snd_ctl_elem_value *ucontrol)
  1131. {
  1132. ucontrol->value.integer.value[0] = msm_multichannel_ec_primary_mic_ch;
  1133. pr_debug("%s: msm_multichannel_ec_primary_mic_ch = %lu\n",
  1134. __func__, ucontrol->value.integer.value[0]);
  1135. return 0;
  1136. }
  1137. static const struct snd_kcontrol_new msm_multichannel_ec_controls[] = {
  1138. SOC_SINGLE_EXT("Multichannel EC Primary Mic Ch", SND_SOC_NOPM, 0,
  1139. 0xFFFFFFFF, 0, msm_multichannel_ec_primary_mic_ch_get,
  1140. msm_multichannel_ec_primary_mic_ch_put),
  1141. };
  1142. static const struct snd_kcontrol_new int_fm_vol_mixer_controls[] = {
  1143. SOC_SINGLE_EXT_TLV("Internal FM RX Volume", SND_SOC_NOPM, 0,
  1144. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_fm_vol_mixer,
  1145. msm_qti_pp_set_fm_vol_mixer, fm_rx_vol_gain),
  1146. SOC_SINGLE_EXT_TLV("Quat MI2S FM RX Volume", SND_SOC_NOPM, 0,
  1147. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_quat_mi2s_fm_vol_mixer,
  1148. msm_qti_pp_set_quat_mi2s_fm_vol_mixer, fm_rx_vol_gain),
  1149. };
  1150. static const struct snd_kcontrol_new dsp_bit_width_controls[] = {
  1151. SOC_SINGLE_EXT(DSP_BIT_WIDTH_MIXER_CTL, SND_SOC_NOPM, 0, 0x20,
  1152. 0, msm_asm_bit_width_get, msm_asm_bit_width_put),
  1153. };
  1154. static const struct snd_kcontrol_new pri_mi2s_lb_vol_mixer_controls[] = {
  1155. SOC_SINGLE_EXT_TLV("PRI MI2S LOOPBACK Volume", SND_SOC_NOPM, 0,
  1156. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_pri_mi2s_lb_vol_mixer,
  1157. msm_qti_pp_set_pri_mi2s_lb_vol_mixer, afe_lb_vol_gain),
  1158. };
  1159. static const struct snd_kcontrol_new sec_mi2s_lb_vol_mixer_controls[] = {
  1160. SOC_SINGLE_EXT_TLV("SEC MI2S LOOPBACK Volume", SND_SOC_NOPM, 0,
  1161. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_sec_mi2s_lb_vol_mixer,
  1162. msm_qti_pp_set_sec_mi2s_lb_vol_mixer, afe_lb_vol_gain),
  1163. };
  1164. static const struct snd_kcontrol_new tert_mi2s_lb_vol_mixer_controls[] = {
  1165. SOC_SINGLE_EXT_TLV("Tert MI2S LOOPBACK Volume", SND_SOC_NOPM, 0,
  1166. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_tert_mi2s_lb_vol_mixer,
  1167. msm_qti_pp_set_tert_mi2s_lb_vol_mixer, afe_lb_vol_gain),
  1168. };
  1169. static const struct snd_kcontrol_new slimbus_7_lb_vol_mixer_controls[] = {
  1170. SOC_SINGLE_EXT_TLV("SLIMBUS_7 LOOPBACK Volume", SND_SOC_NOPM, 0,
  1171. INT_RX_VOL_GAIN, 0,
  1172. msm_qti_pp_get_slimbus_7_lb_vol_mixer,
  1173. msm_qti_pp_set_slimbus_7_lb_vol_mixer,
  1174. afe_lb_vol_gain),
  1175. };
  1176. static const struct snd_kcontrol_new slimbus_8_lb_vol_mixer_controls[] = {
  1177. SOC_SINGLE_EXT_TLV("SLIMBUS_8 LOOPBACK Volume", SND_SOC_NOPM, 0,
  1178. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_slimbus_8_lb_vol_mixer,
  1179. msm_qti_pp_set_slimbus_8_lb_vol_mixer, afe_lb_vol_gain),
  1180. };
  1181. static const struct snd_kcontrol_new int_hfp_vol_mixer_controls[] = {
  1182. SOC_SINGLE_EXT_TLV("Internal HFP RX Volume", SND_SOC_NOPM, 0,
  1183. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_hfp_vol_mixer,
  1184. msm_qti_pp_set_hfp_vol_mixer, hfp_rx_vol_gain),
  1185. };
  1186. static const struct snd_kcontrol_new int_icc_vol_mixer_controls[] = {
  1187. SOC_SINGLE_EXT_TLV("Internal ICC Volume", SND_SOC_NOPM, 0,
  1188. INT_RX_VOL_GAIN, 0, msm_qti_pp_get_icc_vol_mixer,
  1189. msm_qti_pp_set_icc_vol_mixer, icc_rx_vol_gain),
  1190. };
  1191. static const struct snd_kcontrol_new pri_auxpcm_lb_vol_mixer_controls[] = {
  1192. SOC_SINGLE_EXT_TLV("PRI AUXPCM LOOPBACK Volume",
  1193. AFE_PORT_ID_PRIMARY_PCM_TX, 0, INT_RX_VOL_GAIN, 0,
  1194. msm_qti_pp_get_pri_auxpcm_lb_vol_mixer,
  1195. msm_qti_pp_set_pri_auxpcm_lb_vol_mixer,
  1196. pri_auxpcm_lb_vol_gain),
  1197. };
  1198. static const struct snd_kcontrol_new sec_auxpcm_lb_vol_mixer_controls[] = {
  1199. SOC_SINGLE_EXT_TLV("SEC AUXPCM LOOPBACK Volume",
  1200. AFE_PORT_ID_SECONDARY_PCM_TX, 0, INT_RX_VOL_GAIN, 0,
  1201. msm_qti_pp_get_sec_auxpcm_lb_vol_mixer,
  1202. msm_qti_pp_set_sec_auxpcm_lb_vol_mixer,
  1203. sec_auxpcm_lb_vol_gain),
  1204. };
  1205. static const struct snd_kcontrol_new multi_ch_channel_map_mixer_controls[] = {
  1206. SOC_SINGLE_MULTI_EXT("Playback Device Channel Map", SND_SOC_NOPM, 0, 34,
  1207. 0, PCM_FORMAT_MAX_NUM_CHANNEL_V8, msm_qti_pp_get_channel_map_mixer,
  1208. msm_qti_pp_put_channel_map_mixer),
  1209. };
  1210. static const struct snd_kcontrol_new get_rms_controls[] = {
  1211. SOC_SINGLE_EXT("Get RMS", SND_SOC_NOPM, 0, 0xFFFFFFFF,
  1212. 0, msm_qti_pp_get_rms_value_control, msm_qti_pp_put_rms_value_control),
  1213. };
  1214. static const struct snd_kcontrol_new eq_enable_mixer_controls[] = {
  1215. SOC_SINGLE_EXT("MultiMedia1 EQ Enable", SND_SOC_NOPM,
  1216. MSM_FRONTEND_DAI_MULTIMEDIA1, 1, 0, msm_qti_pp_get_eq_enable_mixer,
  1217. msm_qti_pp_put_eq_enable_mixer),
  1218. SOC_SINGLE_EXT("MultiMedia2 EQ Enable", SND_SOC_NOPM,
  1219. MSM_FRONTEND_DAI_MULTIMEDIA2, 1, 0, msm_qti_pp_get_eq_enable_mixer,
  1220. msm_qti_pp_put_eq_enable_mixer),
  1221. SOC_SINGLE_EXT("MultiMedia3 EQ Enable", SND_SOC_NOPM,
  1222. MSM_FRONTEND_DAI_MULTIMEDIA3, 1, 0, msm_qti_pp_get_eq_enable_mixer,
  1223. msm_qti_pp_put_eq_enable_mixer),
  1224. };
  1225. static const struct snd_kcontrol_new eq_band_mixer_controls[] = {
  1226. SOC_SINGLE_EXT("MultiMedia1 EQ Band Count", SND_SOC_NOPM,
  1227. MSM_FRONTEND_DAI_MULTIMEDIA1, 11, 0,
  1228. msm_qti_pp_get_eq_band_count_audio_mixer,
  1229. msm_qti_pp_put_eq_band_count_audio_mixer),
  1230. SOC_SINGLE_EXT("MultiMedia2 EQ Band Count", SND_SOC_NOPM,
  1231. MSM_FRONTEND_DAI_MULTIMEDIA2, 11, 0,
  1232. msm_qti_pp_get_eq_band_count_audio_mixer,
  1233. msm_qti_pp_put_eq_band_count_audio_mixer),
  1234. SOC_SINGLE_EXT("MultiMedia3 EQ Band Count", SND_SOC_NOPM,
  1235. MSM_FRONTEND_DAI_MULTIMEDIA3, 11, 0,
  1236. msm_qti_pp_get_eq_band_count_audio_mixer,
  1237. msm_qti_pp_put_eq_band_count_audio_mixer),
  1238. };
  1239. static const struct snd_kcontrol_new eq_coeff_mixer_controls[] = {
  1240. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band1", EQ_BAND1,
  1241. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1242. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1243. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band2", EQ_BAND2,
  1244. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1245. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1246. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band3", EQ_BAND3,
  1247. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1248. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1249. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band4", EQ_BAND4,
  1250. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1251. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1252. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band5", EQ_BAND5,
  1253. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1254. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1255. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band6", EQ_BAND6,
  1256. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1257. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1258. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band7", EQ_BAND7,
  1259. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1260. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1261. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band8", EQ_BAND8,
  1262. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1263. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1264. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band9", EQ_BAND9,
  1265. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1266. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1267. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band10", EQ_BAND10,
  1268. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1269. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1270. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band11", EQ_BAND11,
  1271. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1272. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1273. SOC_SINGLE_MULTI_EXT("MultiMedia1 EQ Band12", EQ_BAND12,
  1274. MSM_FRONTEND_DAI_MULTIMEDIA1, 255, 0, 5,
  1275. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1276. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band1", EQ_BAND1,
  1277. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1278. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1279. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band2", EQ_BAND2,
  1280. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1281. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1282. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band3", EQ_BAND3,
  1283. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1284. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1285. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band4", EQ_BAND4,
  1286. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1287. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1288. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band5", EQ_BAND5,
  1289. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1290. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1291. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band6", EQ_BAND6,
  1292. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1293. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1294. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band7", EQ_BAND7,
  1295. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1296. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1297. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band8", EQ_BAND8,
  1298. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1299. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1300. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band9", EQ_BAND9,
  1301. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1302. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1303. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band10", EQ_BAND10,
  1304. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1305. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1306. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band11", EQ_BAND11,
  1307. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1308. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1309. SOC_SINGLE_MULTI_EXT("MultiMedia2 EQ Band12", EQ_BAND12,
  1310. MSM_FRONTEND_DAI_MULTIMEDIA2, 255, 0, 5,
  1311. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1312. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band1", EQ_BAND1,
  1313. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1314. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1315. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band2", EQ_BAND2,
  1316. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1317. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1318. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band3", EQ_BAND3,
  1319. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1320. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1321. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band4", EQ_BAND4,
  1322. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1323. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1324. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band5", EQ_BAND5,
  1325. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1326. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1327. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band6", EQ_BAND6,
  1328. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1329. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1330. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band7", EQ_BAND7,
  1331. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1332. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1333. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band8", EQ_BAND8,
  1334. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1335. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1336. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band9", EQ_BAND9,
  1337. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1338. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1339. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band10", EQ_BAND10,
  1340. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1341. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1342. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band11", EQ_BAND11,
  1343. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1344. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1345. SOC_SINGLE_MULTI_EXT("MultiMedia3 EQ Band12", EQ_BAND12,
  1346. MSM_FRONTEND_DAI_MULTIMEDIA3, 255, 0, 5,
  1347. msm_qti_pp_get_eq_band_audio_mixer, msm_qti_pp_put_eq_band_audio_mixer),
  1348. };
  1349. static const struct snd_kcontrol_new asphere_mixer_controls[] = {
  1350. SOC_SINGLE_MULTI_EXT("MSM ASphere Set Param", SND_SOC_NOPM, 0,
  1351. 0xFFFFFFFF, 0, 2, msm_qti_pp_asphere_get, msm_qti_pp_asphere_set),
  1352. };
  1353. #ifdef CONFIG_QTI_PP
  1354. void msm_qti_pp_add_controls(struct snd_soc_component *component)
  1355. {
  1356. snd_soc_add_component_controls(component, int_fm_vol_mixer_controls,
  1357. ARRAY_SIZE(int_fm_vol_mixer_controls));
  1358. snd_soc_add_component_controls(component,
  1359. pri_mi2s_lb_vol_mixer_controls,
  1360. ARRAY_SIZE(pri_mi2s_lb_vol_mixer_controls));
  1361. snd_soc_add_component_controls(component,
  1362. sec_mi2s_lb_vol_mixer_controls,
  1363. ARRAY_SIZE(sec_mi2s_lb_vol_mixer_controls));
  1364. snd_soc_add_component_controls(component,
  1365. tert_mi2s_lb_vol_mixer_controls,
  1366. ARRAY_SIZE(tert_mi2s_lb_vol_mixer_controls));
  1367. snd_soc_add_component_controls(component,
  1368. slimbus_7_lb_vol_mixer_controls,
  1369. ARRAY_SIZE(slimbus_7_lb_vol_mixer_controls));
  1370. snd_soc_add_component_controls(component,
  1371. slimbus_8_lb_vol_mixer_controls,
  1372. ARRAY_SIZE(slimbus_8_lb_vol_mixer_controls));
  1373. snd_soc_add_component_controls(component, int_hfp_vol_mixer_controls,
  1374. ARRAY_SIZE(int_hfp_vol_mixer_controls));
  1375. snd_soc_add_component_controls(component, int_icc_vol_mixer_controls,
  1376. ARRAY_SIZE(int_icc_vol_mixer_controls));
  1377. snd_soc_add_component_controls(component,
  1378. pri_auxpcm_lb_vol_mixer_controls,
  1379. ARRAY_SIZE(pri_auxpcm_lb_vol_mixer_controls));
  1380. snd_soc_add_component_controls(component,
  1381. sec_auxpcm_lb_vol_mixer_controls,
  1382. ARRAY_SIZE(sec_auxpcm_lb_vol_mixer_controls));
  1383. snd_soc_add_component_controls(component,
  1384. multi_ch_channel_map_mixer_controls,
  1385. ARRAY_SIZE(multi_ch_channel_map_mixer_controls));
  1386. snd_soc_add_component_controls(component, get_rms_controls,
  1387. ARRAY_SIZE(get_rms_controls));
  1388. snd_soc_add_component_controls(component, eq_enable_mixer_controls,
  1389. ARRAY_SIZE(eq_enable_mixer_controls));
  1390. snd_soc_add_component_controls(component, eq_band_mixer_controls,
  1391. ARRAY_SIZE(eq_band_mixer_controls));
  1392. snd_soc_add_component_controls(component, eq_coeff_mixer_controls,
  1393. ARRAY_SIZE(eq_coeff_mixer_controls));
  1394. snd_soc_add_component_controls(component, asphere_mixer_controls,
  1395. ARRAY_SIZE(asphere_mixer_controls));
  1396. snd_soc_add_component_controls(component, msm_multichannel_ec_controls,
  1397. ARRAY_SIZE(msm_multichannel_ec_controls));
  1398. snd_soc_add_component_controls(component, dsp_bit_width_controls,
  1399. ARRAY_SIZE(dsp_bit_width_controls));
  1400. }
  1401. #endif /* CONFIG_QTI_PP */