msm-digital-cdc.c 65 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188
  1. /* Copyright (c) 2015-2017, The Linux Foundation. All rights reserved.
  2. *
  3. * This program is free software; you can redistribute it and/or modify
  4. * it under the terms of the GNU General Public License version 2 and
  5. * only version 2 as published by the Free Software Foundation.
  6. *
  7. * This program is distributed in the hope that it will be useful,
  8. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  9. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  10. * GNU General Public License for more details.
  11. */
  12. #include <linux/module.h>
  13. #include <linux/init.h>
  14. #include <linux/io.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/printk.h>
  17. #include <linux/debugfs.h>
  18. #include <linux/delay.h>
  19. #include <linux/workqueue.h>
  20. #include <linux/regmap.h>
  21. #include <sound/pcm.h>
  22. #include <sound/pcm_params.h>
  23. #include <sound/soc.h>
  24. #include <sound/soc-dapm.h>
  25. #include <sound/tlv.h>
  26. #include <dsp/q6afe-v2.h>
  27. #include <ipc/apr.h>
  28. #include <soc/internal.h>
  29. #include "sdm660-cdc-registers.h"
  30. #include "msm-digital-cdc.h"
  31. #include "msm-cdc-common.h"
  32. #include "../../sdm660-common.h"
  33. #define DRV_NAME "msm_digital_codec"
  34. #define MCLK_RATE_9P6MHZ 9600000
  35. #define MCLK_RATE_12P288MHZ 12288000
  36. #define TX_MUX_CTL_CUT_OFF_FREQ_MASK 0x30
  37. #define CF_MIN_3DB_4HZ 0x0
  38. #define CF_MIN_3DB_75HZ 0x1
  39. #define CF_MIN_3DB_150HZ 0x2
  40. #define MSM_DIG_CDC_VERSION_ENTRY_SIZE 32
  41. static unsigned long rx_digital_gain_reg[] = {
  42. MSM89XX_CDC_CORE_RX1_VOL_CTL_B2_CTL,
  43. MSM89XX_CDC_CORE_RX2_VOL_CTL_B2_CTL,
  44. MSM89XX_CDC_CORE_RX3_VOL_CTL_B2_CTL,
  45. };
  46. static unsigned long tx_digital_gain_reg[] = {
  47. MSM89XX_CDC_CORE_TX1_VOL_CTL_GAIN,
  48. MSM89XX_CDC_CORE_TX2_VOL_CTL_GAIN,
  49. MSM89XX_CDC_CORE_TX3_VOL_CTL_GAIN,
  50. MSM89XX_CDC_CORE_TX4_VOL_CTL_GAIN,
  51. MSM89XX_CDC_CORE_TX5_VOL_CTL_GAIN,
  52. };
  53. static const DECLARE_TLV_DB_SCALE(digital_gain, 0, 1, 0);
  54. struct snd_soc_codec *registered_digcodec;
  55. struct hpf_work tx_hpf_work[NUM_DECIMATORS];
  56. /* Codec supports 2 IIR filters */
  57. enum {
  58. IIR1 = 0,
  59. IIR2,
  60. IIR_MAX,
  61. };
  62. static int msm_digcdc_clock_control(bool flag)
  63. {
  64. int ret = -EINVAL;
  65. struct msm_asoc_mach_data *pdata = NULL;
  66. struct msm_dig_priv *msm_dig_cdc =
  67. snd_soc_codec_get_drvdata(registered_digcodec);
  68. pdata = snd_soc_card_get_drvdata(registered_digcodec->component.card);
  69. if (flag) {
  70. mutex_lock(&pdata->cdc_int_mclk0_mutex);
  71. if (atomic_read(&pdata->int_mclk0_enabled) == false) {
  72. pdata->digital_cdc_core_clk.enable = 1;
  73. ret = afe_set_lpass_clock_v2(
  74. AFE_PORT_ID_INT0_MI2S_RX,
  75. &pdata->digital_cdc_core_clk);
  76. if (ret < 0) {
  77. pr_err("%s:failed to enable the MCLK\n",
  78. __func__);
  79. /*
  80. * Avoid access to lpass register
  81. * as clock enable failed during SSR.
  82. */
  83. if (ret == -ENODEV)
  84. msm_dig_cdc->regmap->cache_only = true;
  85. return ret;
  86. }
  87. pr_debug("enabled digital codec core clk\n");
  88. atomic_set(&pdata->int_mclk0_enabled, true);
  89. schedule_delayed_work(&pdata->disable_int_mclk0_work,
  90. 50);
  91. }
  92. } else {
  93. mutex_unlock(&pdata->cdc_int_mclk0_mutex);
  94. dev_dbg(registered_digcodec->dev,
  95. "disable MCLK, workq to disable set already\n");
  96. }
  97. return 0;
  98. }
  99. static void enable_digital_callback(void *flag)
  100. {
  101. msm_digcdc_clock_control(true);
  102. }
  103. static void disable_digital_callback(void *flag)
  104. {
  105. msm_digcdc_clock_control(false);
  106. pr_debug("disable mclk happens in workq\n");
  107. }
  108. static int msm_dig_cdc_put_dec_enum(struct snd_kcontrol *kcontrol,
  109. struct snd_ctl_elem_value *ucontrol)
  110. {
  111. struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
  112. struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
  113. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  114. unsigned int dec_mux, decimator;
  115. char *dec_name = NULL;
  116. char *widget_name = NULL;
  117. char *temp;
  118. u16 tx_mux_ctl_reg;
  119. u8 adc_dmic_sel = 0x0;
  120. int ret = 0;
  121. char *dec_num;
  122. if (ucontrol->value.enumerated.item[0] > e->items) {
  123. dev_err(codec->dev, "%s: Invalid enum value: %d\n",
  124. __func__, ucontrol->value.enumerated.item[0]);
  125. return -EINVAL;
  126. }
  127. dec_mux = ucontrol->value.enumerated.item[0];
  128. widget_name = kstrndup(w->name, 15, GFP_KERNEL);
  129. if (!widget_name) {
  130. dev_err(codec->dev, "%s: failed to copy string\n",
  131. __func__);
  132. return -ENOMEM;
  133. }
  134. temp = widget_name;
  135. dec_name = strsep(&widget_name, " ");
  136. widget_name = temp;
  137. if (!dec_name) {
  138. dev_err(codec->dev, "%s: Invalid decimator = %s\n",
  139. __func__, w->name);
  140. ret = -EINVAL;
  141. goto out;
  142. }
  143. dec_num = strpbrk(dec_name, "12345");
  144. if (dec_num == NULL) {
  145. dev_err(codec->dev, "%s: Invalid DEC selected\n", __func__);
  146. ret = -EINVAL;
  147. goto out;
  148. }
  149. ret = kstrtouint(dec_num, 10, &decimator);
  150. if (ret < 0) {
  151. dev_err(codec->dev, "%s: Invalid decimator = %s\n",
  152. __func__, dec_name);
  153. ret = -EINVAL;
  154. goto out;
  155. }
  156. dev_dbg(w->dapm->dev, "%s(): widget = %s decimator = %u dec_mux = %u\n"
  157. , __func__, w->name, decimator, dec_mux);
  158. switch (decimator) {
  159. case 1:
  160. case 2:
  161. case 3:
  162. case 4:
  163. case 5:
  164. if ((dec_mux == 4) || (dec_mux == 5) ||
  165. (dec_mux == 6) || (dec_mux == 7))
  166. adc_dmic_sel = 0x1;
  167. else
  168. adc_dmic_sel = 0x0;
  169. break;
  170. default:
  171. dev_err(codec->dev, "%s: Invalid Decimator = %u\n",
  172. __func__, decimator);
  173. ret = -EINVAL;
  174. goto out;
  175. }
  176. tx_mux_ctl_reg =
  177. MSM89XX_CDC_CORE_TX1_MUX_CTL + 32 * (decimator - 1);
  178. snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x1, adc_dmic_sel);
  179. ret = snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
  180. out:
  181. kfree(widget_name);
  182. return ret;
  183. }
  184. static int msm_dig_cdc_codec_config_compander(struct snd_soc_codec *codec,
  185. int interp_n, int event)
  186. {
  187. struct msm_dig_priv *dig_cdc = snd_soc_codec_get_drvdata(codec);
  188. int comp_ch_bits_set = 0x03;
  189. dev_dbg(codec->dev, "%s: event %d shift %d, enabled %d\n",
  190. __func__, event, interp_n,
  191. dig_cdc->comp_enabled[interp_n]);
  192. /* compander is invalid */
  193. if (dig_cdc->comp_enabled[interp_n] != COMPANDER_1 &&
  194. dig_cdc->comp_enabled[interp_n]) {
  195. dev_dbg(codec->dev, "%s: Invalid compander %d\n", __func__,
  196. dig_cdc->comp_enabled[interp_n]);
  197. return 0;
  198. }
  199. if (SND_SOC_DAPM_EVENT_ON(event)) {
  200. /* Enable Compander Clock */
  201. snd_soc_update_bits(codec,
  202. MSM89XX_CDC_CORE_COMP0_B2_CTL, 0x0F, 0x09);
  203. snd_soc_update_bits(codec,
  204. MSM89XX_CDC_CORE_CLK_RX_B2_CTL, 0x01, 0x01);
  205. snd_soc_update_bits(codec,
  206. MSM89XX_CDC_CORE_COMP0_B1_CTL,
  207. 1 << interp_n, 1 << interp_n);
  208. snd_soc_update_bits(codec,
  209. MSM89XX_CDC_CORE_COMP0_B3_CTL, 0xFF, 0x01);
  210. snd_soc_update_bits(codec,
  211. MSM89XX_CDC_CORE_COMP0_B2_CTL, 0xF0, 0x50);
  212. /* add sleep for compander to settle */
  213. usleep_range(1000, 1100);
  214. snd_soc_update_bits(codec,
  215. MSM89XX_CDC_CORE_COMP0_B3_CTL, 0xFF, 0x28);
  216. snd_soc_update_bits(codec,
  217. MSM89XX_CDC_CORE_COMP0_B2_CTL, 0xF0, 0xB0);
  218. /* Enable Compander GPIO */
  219. if (dig_cdc->codec_hph_comp_gpio)
  220. dig_cdc->codec_hph_comp_gpio(1, codec);
  221. } else if (SND_SOC_DAPM_EVENT_OFF(event)) {
  222. /* Disable Compander GPIO */
  223. if (dig_cdc->codec_hph_comp_gpio)
  224. dig_cdc->codec_hph_comp_gpio(0, codec);
  225. snd_soc_update_bits(codec,
  226. MSM89XX_CDC_CORE_COMP0_B1_CTL,
  227. 1 << interp_n, 0);
  228. comp_ch_bits_set = snd_soc_read(codec,
  229. MSM89XX_CDC_CORE_COMP0_B1_CTL);
  230. if ((comp_ch_bits_set & 0x03) == 0x00) {
  231. snd_soc_update_bits(codec,
  232. MSM89XX_CDC_CORE_COMP0_B2_CTL, 0x0F, 0x05);
  233. snd_soc_update_bits(codec,
  234. MSM89XX_CDC_CORE_CLK_RX_B2_CTL, 0x01, 0x00);
  235. }
  236. }
  237. return 0;
  238. }
  239. /**
  240. * msm_dig_cdc_hph_comp_cb - registers callback to codec by machine driver.
  241. *
  242. * @codec_hph_comp_gpio: function pointer to set comp gpio at machine driver
  243. * @codec: codec pointer
  244. *
  245. */
  246. void msm_dig_cdc_hph_comp_cb(
  247. int (*codec_hph_comp_gpio)(bool enable, struct snd_soc_codec *codec),
  248. struct snd_soc_codec *codec)
  249. {
  250. struct msm_dig_priv *dig_cdc = snd_soc_codec_get_drvdata(codec);
  251. pr_debug("%s: Enter\n", __func__);
  252. dig_cdc->codec_hph_comp_gpio = codec_hph_comp_gpio;
  253. }
  254. EXPORT_SYMBOL(msm_dig_cdc_hph_comp_cb);
  255. static int msm_dig_cdc_codec_enable_interpolator(struct snd_soc_dapm_widget *w,
  256. struct snd_kcontrol *kcontrol,
  257. int event)
  258. {
  259. struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
  260. struct msm_dig_priv *msm_dig_cdc = snd_soc_codec_get_drvdata(codec);
  261. dev_dbg(codec->dev, "%s %d %s\n", __func__, event, w->name);
  262. if (w->shift >= MSM89XX_RX_MAX || w->shift < 0) {
  263. dev_err(codec->dev, "%s: wrong RX index: %d\n",
  264. __func__, w->shift);
  265. return -EINVAL;
  266. }
  267. switch (event) {
  268. case SND_SOC_DAPM_POST_PMU:
  269. msm_dig_cdc_codec_config_compander(codec, w->shift, event);
  270. /* apply the digital gain after the interpolator is enabled*/
  271. if ((w->shift) < ARRAY_SIZE(rx_digital_gain_reg))
  272. snd_soc_write(codec,
  273. rx_digital_gain_reg[w->shift],
  274. snd_soc_read(codec,
  275. rx_digital_gain_reg[w->shift])
  276. );
  277. break;
  278. case SND_SOC_DAPM_POST_PMD:
  279. msm_dig_cdc_codec_config_compander(codec, w->shift, event);
  280. snd_soc_update_bits(codec,
  281. MSM89XX_CDC_CORE_CLK_RX_RESET_CTL,
  282. 1 << w->shift, 1 << w->shift);
  283. snd_soc_update_bits(codec,
  284. MSM89XX_CDC_CORE_CLK_RX_RESET_CTL,
  285. 1 << w->shift, 0x0);
  286. /*
  287. * disable the mute enabled during the PMD of this device
  288. */
  289. if ((w->shift == 0) &&
  290. (msm_dig_cdc->mute_mask & HPHL_PA_DISABLE)) {
  291. pr_debug("disabling HPHL mute\n");
  292. snd_soc_update_bits(codec,
  293. MSM89XX_CDC_CORE_RX1_B6_CTL, 0x01, 0x00);
  294. msm_dig_cdc->mute_mask &= ~(HPHL_PA_DISABLE);
  295. } else if ((w->shift == 1) &&
  296. (msm_dig_cdc->mute_mask & HPHR_PA_DISABLE)) {
  297. pr_debug("disabling HPHR mute\n");
  298. snd_soc_update_bits(codec,
  299. MSM89XX_CDC_CORE_RX2_B6_CTL, 0x01, 0x00);
  300. msm_dig_cdc->mute_mask &= ~(HPHR_PA_DISABLE);
  301. } else if ((w->shift == 2) &&
  302. (msm_dig_cdc->mute_mask & SPKR_PA_DISABLE)) {
  303. pr_debug("disabling SPKR mute\n");
  304. snd_soc_update_bits(codec,
  305. MSM89XX_CDC_CORE_RX3_B6_CTL, 0x01, 0x00);
  306. msm_dig_cdc->mute_mask &= ~(SPKR_PA_DISABLE);
  307. }
  308. }
  309. return 0;
  310. }
  311. static int msm_dig_cdc_get_iir_enable_audio_mixer(
  312. struct snd_kcontrol *kcontrol,
  313. struct snd_ctl_elem_value *ucontrol)
  314. {
  315. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  316. int iir_idx = ((struct soc_multi_mixer_control *)
  317. kcontrol->private_value)->reg;
  318. int band_idx = ((struct soc_multi_mixer_control *)
  319. kcontrol->private_value)->shift;
  320. ucontrol->value.integer.value[0] =
  321. (snd_soc_read(codec,
  322. (MSM89XX_CDC_CORE_IIR1_CTL + 64 * iir_idx)) &
  323. (1 << band_idx)) != 0;
  324. dev_dbg(codec->dev, "%s: IIR #%d band #%d enable %d\n", __func__,
  325. iir_idx, band_idx,
  326. (uint32_t)ucontrol->value.integer.value[0]);
  327. return 0;
  328. }
  329. static int msm_dig_cdc_put_iir_enable_audio_mixer(
  330. struct snd_kcontrol *kcontrol,
  331. struct snd_ctl_elem_value *ucontrol)
  332. {
  333. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  334. int iir_idx = ((struct soc_multi_mixer_control *)
  335. kcontrol->private_value)->reg;
  336. int band_idx = ((struct soc_multi_mixer_control *)
  337. kcontrol->private_value)->shift;
  338. int value = ucontrol->value.integer.value[0];
  339. /* Mask first 5 bits, 6-8 are reserved */
  340. snd_soc_update_bits(codec,
  341. (MSM89XX_CDC_CORE_IIR1_CTL + 64 * iir_idx),
  342. (1 << band_idx), (value << band_idx));
  343. dev_dbg(codec->dev, "%s: IIR #%d band #%d enable %d\n", __func__,
  344. iir_idx, band_idx,
  345. ((snd_soc_read(codec,
  346. (MSM89XX_CDC_CORE_IIR1_CTL + 64 * iir_idx)) &
  347. (1 << band_idx)) != 0));
  348. return 0;
  349. }
  350. static uint32_t get_iir_band_coeff(struct snd_soc_codec *codec,
  351. int iir_idx, int band_idx,
  352. int coeff_idx)
  353. {
  354. uint32_t value = 0;
  355. /* Address does not automatically update if reading */
  356. snd_soc_write(codec,
  357. (MSM89XX_CDC_CORE_IIR1_COEF_B1_CTL + 64 * iir_idx),
  358. ((band_idx * BAND_MAX + coeff_idx)
  359. * sizeof(uint32_t)) & 0x7F);
  360. value |= snd_soc_read(codec,
  361. (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL + 64 * iir_idx));
  362. snd_soc_write(codec,
  363. (MSM89XX_CDC_CORE_IIR1_COEF_B1_CTL + 64 * iir_idx),
  364. ((band_idx * BAND_MAX + coeff_idx)
  365. * sizeof(uint32_t) + 1) & 0x7F);
  366. value |= (snd_soc_read(codec,
  367. (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL + 64 * iir_idx)) << 8);
  368. snd_soc_write(codec,
  369. (MSM89XX_CDC_CORE_IIR1_COEF_B1_CTL + 64 * iir_idx),
  370. ((band_idx * BAND_MAX + coeff_idx)
  371. * sizeof(uint32_t) + 2) & 0x7F);
  372. value |= (snd_soc_read(codec,
  373. (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL + 64 * iir_idx)) << 16);
  374. snd_soc_write(codec,
  375. (MSM89XX_CDC_CORE_IIR1_COEF_B1_CTL + 64 * iir_idx),
  376. ((band_idx * BAND_MAX + coeff_idx)
  377. * sizeof(uint32_t) + 3) & 0x7F);
  378. /* Mask bits top 2 bits since they are reserved */
  379. value |= ((snd_soc_read(codec, (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL
  380. + 64 * iir_idx)) & 0x3f) << 24);
  381. return value;
  382. }
  383. static void set_iir_band_coeff(struct snd_soc_codec *codec,
  384. int iir_idx, int band_idx,
  385. uint32_t value)
  386. {
  387. snd_soc_write(codec,
  388. (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL + 64 * iir_idx),
  389. (value & 0xFF));
  390. snd_soc_write(codec,
  391. (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL + 64 * iir_idx),
  392. (value >> 8) & 0xFF);
  393. snd_soc_write(codec,
  394. (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL + 64 * iir_idx),
  395. (value >> 16) & 0xFF);
  396. /* Mask top 2 bits, 7-8 are reserved */
  397. snd_soc_write(codec,
  398. (MSM89XX_CDC_CORE_IIR1_COEF_B2_CTL + 64 * iir_idx),
  399. (value >> 24) & 0x3F);
  400. }
  401. static int msm_dig_cdc_get_iir_band_audio_mixer(
  402. struct snd_kcontrol *kcontrol,
  403. struct snd_ctl_elem_value *ucontrol)
  404. {
  405. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  406. int iir_idx = ((struct soc_multi_mixer_control *)
  407. kcontrol->private_value)->reg;
  408. int band_idx = ((struct soc_multi_mixer_control *)
  409. kcontrol->private_value)->shift;
  410. ucontrol->value.integer.value[0] =
  411. get_iir_band_coeff(codec, iir_idx, band_idx, 0);
  412. ucontrol->value.integer.value[1] =
  413. get_iir_band_coeff(codec, iir_idx, band_idx, 1);
  414. ucontrol->value.integer.value[2] =
  415. get_iir_band_coeff(codec, iir_idx, band_idx, 2);
  416. ucontrol->value.integer.value[3] =
  417. get_iir_band_coeff(codec, iir_idx, band_idx, 3);
  418. ucontrol->value.integer.value[4] =
  419. get_iir_band_coeff(codec, iir_idx, band_idx, 4);
  420. dev_dbg(codec->dev, "%s: IIR #%d band #%d b0 = 0x%x\n"
  421. "%s: IIR #%d band #%d b1 = 0x%x\n"
  422. "%s: IIR #%d band #%d b2 = 0x%x\n"
  423. "%s: IIR #%d band #%d a1 = 0x%x\n"
  424. "%s: IIR #%d band #%d a2 = 0x%x\n",
  425. __func__, iir_idx, band_idx,
  426. (uint32_t)ucontrol->value.integer.value[0],
  427. __func__, iir_idx, band_idx,
  428. (uint32_t)ucontrol->value.integer.value[1],
  429. __func__, iir_idx, band_idx,
  430. (uint32_t)ucontrol->value.integer.value[2],
  431. __func__, iir_idx, band_idx,
  432. (uint32_t)ucontrol->value.integer.value[3],
  433. __func__, iir_idx, band_idx,
  434. (uint32_t)ucontrol->value.integer.value[4]);
  435. return 0;
  436. }
  437. static int msm_dig_cdc_put_iir_band_audio_mixer(
  438. struct snd_kcontrol *kcontrol,
  439. struct snd_ctl_elem_value *ucontrol)
  440. {
  441. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  442. int iir_idx = ((struct soc_multi_mixer_control *)
  443. kcontrol->private_value)->reg;
  444. int band_idx = ((struct soc_multi_mixer_control *)
  445. kcontrol->private_value)->shift;
  446. /* Mask top bit it is reserved */
  447. /* Updates addr automatically for each B2 write */
  448. snd_soc_write(codec,
  449. (MSM89XX_CDC_CORE_IIR1_COEF_B1_CTL + 64 * iir_idx),
  450. (band_idx * BAND_MAX * sizeof(uint32_t)) & 0x7F);
  451. set_iir_band_coeff(codec, iir_idx, band_idx,
  452. ucontrol->value.integer.value[0]);
  453. set_iir_band_coeff(codec, iir_idx, band_idx,
  454. ucontrol->value.integer.value[1]);
  455. set_iir_band_coeff(codec, iir_idx, band_idx,
  456. ucontrol->value.integer.value[2]);
  457. set_iir_band_coeff(codec, iir_idx, band_idx,
  458. ucontrol->value.integer.value[3]);
  459. set_iir_band_coeff(codec, iir_idx, band_idx,
  460. ucontrol->value.integer.value[4]);
  461. dev_dbg(codec->dev, "%s: IIR #%d band #%d b0 = 0x%x\n"
  462. "%s: IIR #%d band #%d b1 = 0x%x\n"
  463. "%s: IIR #%d band #%d b2 = 0x%x\n"
  464. "%s: IIR #%d band #%d a1 = 0x%x\n"
  465. "%s: IIR #%d band #%d a2 = 0x%x\n",
  466. __func__, iir_idx, band_idx,
  467. get_iir_band_coeff(codec, iir_idx, band_idx, 0),
  468. __func__, iir_idx, band_idx,
  469. get_iir_band_coeff(codec, iir_idx, band_idx, 1),
  470. __func__, iir_idx, band_idx,
  471. get_iir_band_coeff(codec, iir_idx, band_idx, 2),
  472. __func__, iir_idx, band_idx,
  473. get_iir_band_coeff(codec, iir_idx, band_idx, 3),
  474. __func__, iir_idx, band_idx,
  475. get_iir_band_coeff(codec, iir_idx, band_idx, 4));
  476. return 0;
  477. }
  478. static void tx_hpf_corner_freq_callback(struct work_struct *work)
  479. {
  480. struct delayed_work *hpf_delayed_work;
  481. struct hpf_work *hpf_work;
  482. struct snd_soc_codec *codec;
  483. struct msm_dig_priv *msm_dig_cdc;
  484. u16 tx_mux_ctl_reg;
  485. u8 hpf_cut_of_freq;
  486. hpf_delayed_work = to_delayed_work(work);
  487. hpf_work = container_of(hpf_delayed_work, struct hpf_work, dwork);
  488. codec = hpf_work->dig_cdc->codec;
  489. msm_dig_cdc = hpf_work->dig_cdc;
  490. hpf_cut_of_freq = hpf_work->tx_hpf_cut_of_freq;
  491. tx_mux_ctl_reg = MSM89XX_CDC_CORE_TX1_MUX_CTL +
  492. (hpf_work->decimator - 1) * 32;
  493. dev_dbg(codec->dev, "%s(): decimator %u hpf_cut_of_freq 0x%x\n",
  494. __func__, hpf_work->decimator, (unsigned int)hpf_cut_of_freq);
  495. msm_dig_cdc->update_clkdiv(msm_dig_cdc->handle, 0x51);
  496. snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x30, hpf_cut_of_freq << 4);
  497. }
  498. static int msm_dig_cdc_codec_set_iir_gain(struct snd_soc_dapm_widget *w,
  499. struct snd_kcontrol *kcontrol, int event)
  500. {
  501. struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
  502. int value = 0, reg;
  503. switch (event) {
  504. case SND_SOC_DAPM_POST_PMU:
  505. if (w->shift == 0)
  506. reg = MSM89XX_CDC_CORE_IIR1_GAIN_B1_CTL;
  507. else if (w->shift == 1)
  508. reg = MSM89XX_CDC_CORE_IIR2_GAIN_B1_CTL;
  509. else
  510. goto ret;
  511. value = snd_soc_read(codec, reg);
  512. snd_soc_write(codec, reg, value);
  513. break;
  514. default:
  515. pr_err("%s: event = %d not expected\n", __func__, event);
  516. }
  517. ret:
  518. return 0;
  519. }
  520. static int msm_dig_cdc_compander_get(struct snd_kcontrol *kcontrol,
  521. struct snd_ctl_elem_value *ucontrol)
  522. {
  523. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  524. struct msm_dig_priv *dig_cdc = snd_soc_codec_get_drvdata(codec);
  525. int comp_idx = ((struct soc_multi_mixer_control *)
  526. kcontrol->private_value)->reg;
  527. int rx_idx = ((struct soc_multi_mixer_control *)
  528. kcontrol->private_value)->shift;
  529. dev_dbg(codec->dev, "%s: msm_dig_cdc->comp[%d]_enabled[%d] = %d\n",
  530. __func__, comp_idx, rx_idx,
  531. dig_cdc->comp_enabled[rx_idx]);
  532. ucontrol->value.integer.value[0] = dig_cdc->comp_enabled[rx_idx];
  533. dev_dbg(codec->dev, "%s: ucontrol->value.integer.value[0] = %ld\n",
  534. __func__, ucontrol->value.integer.value[0]);
  535. return 0;
  536. }
  537. static int msm_dig_cdc_compander_set(struct snd_kcontrol *kcontrol,
  538. struct snd_ctl_elem_value *ucontrol)
  539. {
  540. struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
  541. struct msm_dig_priv *dig_cdc = snd_soc_codec_get_drvdata(codec);
  542. int comp_idx = ((struct soc_multi_mixer_control *)
  543. kcontrol->private_value)->reg;
  544. int rx_idx = ((struct soc_multi_mixer_control *)
  545. kcontrol->private_value)->shift;
  546. int value = ucontrol->value.integer.value[0];
  547. dev_dbg(codec->dev, "%s: ucontrol->value.integer.value[0] = %ld\n",
  548. __func__, ucontrol->value.integer.value[0]);
  549. if (dig_cdc->version >= DIANGU) {
  550. if (!value)
  551. dig_cdc->comp_enabled[rx_idx] = 0;
  552. else
  553. dig_cdc->comp_enabled[rx_idx] = comp_idx;
  554. }
  555. dev_dbg(codec->dev, "%s: msm_dig_cdc->comp[%d]_enabled[%d] = %d\n",
  556. __func__, comp_idx, rx_idx,
  557. dig_cdc->comp_enabled[rx_idx]);
  558. return 0;
  559. }
  560. static const struct snd_kcontrol_new compander_kcontrols[] = {
  561. SOC_SINGLE_EXT("COMP0 RX1", COMPANDER_1, MSM89XX_RX1, 1, 0,
  562. msm_dig_cdc_compander_get, msm_dig_cdc_compander_set),
  563. SOC_SINGLE_EXT("COMP0 RX2", COMPANDER_1, MSM89XX_RX2, 1, 0,
  564. msm_dig_cdc_compander_get, msm_dig_cdc_compander_set),
  565. };
  566. static int msm_dig_cdc_set_interpolator_rate(struct snd_soc_dai *dai,
  567. u8 rx_fs_rate_reg_val,
  568. u32 sample_rate)
  569. {
  570. snd_soc_update_bits(dai->codec,
  571. MSM89XX_CDC_CORE_RX1_B5_CTL, 0xF0, rx_fs_rate_reg_val);
  572. snd_soc_update_bits(dai->codec,
  573. MSM89XX_CDC_CORE_RX2_B5_CTL, 0xF0, rx_fs_rate_reg_val);
  574. return 0;
  575. }
  576. static int msm_dig_cdc_hw_params(struct snd_pcm_substream *substream,
  577. struct snd_pcm_hw_params *params,
  578. struct snd_soc_dai *dai)
  579. {
  580. u8 tx_fs_rate, rx_fs_rate, rx_clk_fs_rate;
  581. int ret;
  582. dev_dbg(dai->codec->dev,
  583. "%s: dai_name = %s DAI-ID %x rate %d num_ch %d format %d\n",
  584. __func__, dai->name, dai->id, params_rate(params),
  585. params_channels(params), params_format(params));
  586. switch (params_rate(params)) {
  587. case 8000:
  588. tx_fs_rate = 0x00;
  589. rx_fs_rate = 0x00;
  590. rx_clk_fs_rate = 0x00;
  591. break;
  592. case 16000:
  593. tx_fs_rate = 0x20;
  594. rx_fs_rate = 0x20;
  595. rx_clk_fs_rate = 0x01;
  596. break;
  597. case 32000:
  598. tx_fs_rate = 0x40;
  599. rx_fs_rate = 0x40;
  600. rx_clk_fs_rate = 0x02;
  601. break;
  602. case 44100:
  603. case 48000:
  604. tx_fs_rate = 0x60;
  605. rx_fs_rate = 0x60;
  606. rx_clk_fs_rate = 0x03;
  607. break;
  608. case 96000:
  609. tx_fs_rate = 0x80;
  610. rx_fs_rate = 0x80;
  611. rx_clk_fs_rate = 0x04;
  612. break;
  613. case 192000:
  614. tx_fs_rate = 0xA0;
  615. rx_fs_rate = 0xA0;
  616. rx_clk_fs_rate = 0x05;
  617. break;
  618. default:
  619. dev_err(dai->codec->dev,
  620. "%s: Invalid sampling rate %d\n", __func__,
  621. params_rate(params));
  622. return -EINVAL;
  623. }
  624. snd_soc_update_bits(dai->codec,
  625. MSM89XX_CDC_CORE_CLK_RX_I2S_CTL, 0x0F, rx_clk_fs_rate);
  626. switch (substream->stream) {
  627. case SNDRV_PCM_STREAM_CAPTURE:
  628. break;
  629. case SNDRV_PCM_STREAM_PLAYBACK:
  630. ret = msm_dig_cdc_set_interpolator_rate(dai, rx_fs_rate,
  631. params_rate(params));
  632. if (ret < 0) {
  633. dev_err(dai->codec->dev,
  634. "%s: set decimator rate failed %d\n", __func__,
  635. ret);
  636. return ret;
  637. }
  638. break;
  639. default:
  640. dev_err(dai->codec->dev,
  641. "%s: Invalid stream type %d\n", __func__,
  642. substream->stream);
  643. return -EINVAL;
  644. }
  645. switch (params_format(params)) {
  646. case SNDRV_PCM_FORMAT_S16_LE:
  647. snd_soc_update_bits(dai->codec,
  648. MSM89XX_CDC_CORE_CLK_RX_I2S_CTL, 0x20, 0x20);
  649. break;
  650. case SNDRV_PCM_FORMAT_S24_LE:
  651. case SNDRV_PCM_FORMAT_S24_3LE:
  652. snd_soc_update_bits(dai->codec,
  653. MSM89XX_CDC_CORE_CLK_RX_I2S_CTL, 0x20, 0x00);
  654. break;
  655. default:
  656. dev_err(dai->codec->dev, "%s: wrong format selected\n",
  657. __func__);
  658. return -EINVAL;
  659. }
  660. return 0;
  661. }
  662. static int msm_dig_cdc_codec_enable_dmic(struct snd_soc_dapm_widget *w,
  663. struct snd_kcontrol *kcontrol,
  664. int event)
  665. {
  666. struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
  667. struct msm_dig_priv *dig_cdc = snd_soc_codec_get_drvdata(codec);
  668. u8 dmic_clk_en;
  669. u16 dmic_clk_reg;
  670. s32 *dmic_clk_cnt;
  671. unsigned int dmic;
  672. int ret;
  673. char *dmic_num = strpbrk(w->name, "1234");
  674. if (dmic_num == NULL) {
  675. dev_err(codec->dev, "%s: Invalid DMIC\n", __func__);
  676. return -EINVAL;
  677. }
  678. ret = kstrtouint(dmic_num, 10, &dmic);
  679. if (ret < 0) {
  680. dev_err(codec->dev,
  681. "%s: Invalid DMIC line on the codec\n", __func__);
  682. return -EINVAL;
  683. }
  684. switch (dmic) {
  685. case 1:
  686. case 2:
  687. dmic_clk_en = 0x01;
  688. dmic_clk_cnt = &(dig_cdc->dmic_1_2_clk_cnt);
  689. dmic_clk_reg = MSM89XX_CDC_CORE_CLK_DMIC_B1_CTL;
  690. dev_dbg(codec->dev,
  691. "%s() event %d DMIC%d dmic_1_2_clk_cnt %d\n",
  692. __func__, event, dmic, *dmic_clk_cnt);
  693. break;
  694. case 3:
  695. case 4:
  696. dmic_clk_en = 0x01;
  697. dmic_clk_cnt = &(dig_cdc->dmic_3_4_clk_cnt);
  698. dmic_clk_reg = MSM89XX_CDC_CORE_CLK_DMIC_B2_CTL;
  699. dev_dbg(codec->dev,
  700. "%s() event %d DMIC%d dmic_3_4_clk_cnt %d\n",
  701. __func__, event, dmic, *dmic_clk_cnt);
  702. break;
  703. default:
  704. dev_err(codec->dev, "%s: Invalid DMIC Selection\n", __func__);
  705. return -EINVAL;
  706. }
  707. switch (event) {
  708. case SND_SOC_DAPM_PRE_PMU:
  709. (*dmic_clk_cnt)++;
  710. if (*dmic_clk_cnt == 1) {
  711. snd_soc_update_bits(codec, dmic_clk_reg,
  712. 0x0E, 0x04);
  713. snd_soc_update_bits(codec, dmic_clk_reg,
  714. dmic_clk_en, dmic_clk_en);
  715. }
  716. snd_soc_update_bits(codec,
  717. MSM89XX_CDC_CORE_TX1_DMIC_CTL + (dmic - 1) * 0x20,
  718. 0x07, 0x02);
  719. break;
  720. case SND_SOC_DAPM_POST_PMD:
  721. (*dmic_clk_cnt)--;
  722. if (*dmic_clk_cnt == 0)
  723. snd_soc_update_bits(codec, dmic_clk_reg,
  724. dmic_clk_en, 0);
  725. break;
  726. }
  727. return 0;
  728. }
  729. static int msm_dig_cdc_codec_enable_dec(struct snd_soc_dapm_widget *w,
  730. struct snd_kcontrol *kcontrol,
  731. int event)
  732. {
  733. struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
  734. struct msm_asoc_mach_data *pdata = NULL;
  735. unsigned int decimator;
  736. struct msm_dig_priv *msm_dig_cdc = snd_soc_codec_get_drvdata(codec);
  737. char *dec_name = NULL;
  738. char *widget_name = NULL;
  739. char *temp;
  740. int ret = 0, i;
  741. u16 dec_reset_reg, tx_vol_ctl_reg, tx_mux_ctl_reg;
  742. u8 dec_hpf_cut_of_freq;
  743. int offset;
  744. char *dec_num;
  745. pdata = snd_soc_card_get_drvdata(codec->component.card);
  746. dev_dbg(codec->dev, "%s %d\n", __func__, event);
  747. widget_name = kstrndup(w->name, 15, GFP_KERNEL);
  748. if (!widget_name)
  749. return -ENOMEM;
  750. temp = widget_name;
  751. dec_name = strsep(&widget_name, " ");
  752. widget_name = temp;
  753. if (!dec_name) {
  754. dev_err(codec->dev,
  755. "%s: Invalid decimator = %s\n", __func__, w->name);
  756. ret = -EINVAL;
  757. goto out;
  758. }
  759. dec_num = strpbrk(dec_name, "12345");
  760. if (dec_num == NULL) {
  761. dev_err(codec->dev, "%s: Invalid Decimator\n", __func__);
  762. ret = -EINVAL;
  763. goto out;
  764. }
  765. ret = kstrtouint(dec_num, 10, &decimator);
  766. if (ret < 0) {
  767. dev_err(codec->dev,
  768. "%s: Invalid decimator = %s\n", __func__, dec_name);
  769. ret = -EINVAL;
  770. goto out;
  771. }
  772. dev_dbg(codec->dev,
  773. "%s(): widget = %s dec_name = %s decimator = %u\n", __func__,
  774. w->name, dec_name, decimator);
  775. if (w->reg == MSM89XX_CDC_CORE_CLK_TX_CLK_EN_B1_CTL) {
  776. dec_reset_reg = MSM89XX_CDC_CORE_CLK_TX_RESET_B1_CTL;
  777. offset = 0;
  778. } else {
  779. dev_err(codec->dev, "%s: Error, incorrect dec\n", __func__);
  780. ret = -EINVAL;
  781. goto out;
  782. }
  783. tx_vol_ctl_reg = MSM89XX_CDC_CORE_TX1_VOL_CTL_CFG +
  784. 32 * (decimator - 1);
  785. tx_mux_ctl_reg = MSM89XX_CDC_CORE_TX1_MUX_CTL +
  786. 32 * (decimator - 1);
  787. if (decimator == 5) {
  788. tx_vol_ctl_reg = MSM89XX_CDC_CORE_TX5_VOL_CTL_CFG;
  789. tx_mux_ctl_reg = MSM89XX_CDC_CORE_TX5_MUX_CTL;
  790. }
  791. switch (event) {
  792. case SND_SOC_DAPM_PRE_PMU:
  793. /* Enableable TX digital mute */
  794. snd_soc_update_bits(codec, tx_vol_ctl_reg, 0x01, 0x01);
  795. for (i = 0; i < NUM_DECIMATORS; i++) {
  796. if (decimator == i + 1)
  797. msm_dig_cdc->dec_active[i] = true;
  798. }
  799. dec_hpf_cut_of_freq = snd_soc_read(codec, tx_mux_ctl_reg);
  800. dec_hpf_cut_of_freq = (dec_hpf_cut_of_freq & 0x30) >> 4;
  801. tx_hpf_work[decimator - 1].tx_hpf_cut_of_freq =
  802. dec_hpf_cut_of_freq;
  803. if (dec_hpf_cut_of_freq != CF_MIN_3DB_150HZ) {
  804. /* set cut of freq to CF_MIN_3DB_150HZ (0x1); */
  805. snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x30,
  806. CF_MIN_3DB_150HZ << 4);
  807. }
  808. msm_dig_cdc->update_clkdiv(msm_dig_cdc->handle, 0x42);
  809. break;
  810. case SND_SOC_DAPM_POST_PMU:
  811. /* enable HPF */
  812. snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x08, 0x00);
  813. if (tx_hpf_work[decimator - 1].tx_hpf_cut_of_freq !=
  814. CF_MIN_3DB_150HZ) {
  815. schedule_delayed_work(&tx_hpf_work[decimator - 1].dwork,
  816. msecs_to_jiffies(300));
  817. }
  818. /* apply the digital gain after the decimator is enabled*/
  819. if ((w->shift) < ARRAY_SIZE(tx_digital_gain_reg))
  820. snd_soc_write(codec,
  821. tx_digital_gain_reg[w->shift + offset],
  822. snd_soc_read(codec,
  823. tx_digital_gain_reg[w->shift + offset])
  824. );
  825. if (pdata->lb_mode) {
  826. pr_debug("%s: loopback mode unmute the DEC\n",
  827. __func__);
  828. snd_soc_update_bits(codec, tx_vol_ctl_reg, 0x01, 0x00);
  829. }
  830. snd_soc_update_bits(codec, tx_vol_ctl_reg,
  831. 0x01, 0x00);
  832. break;
  833. case SND_SOC_DAPM_PRE_PMD:
  834. snd_soc_update_bits(codec, tx_vol_ctl_reg, 0x01, 0x01);
  835. msleep(20);
  836. snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x08, 0x08);
  837. cancel_delayed_work_sync(&tx_hpf_work[decimator - 1].dwork);
  838. break;
  839. case SND_SOC_DAPM_POST_PMD:
  840. snd_soc_update_bits(codec, dec_reset_reg, 1 << w->shift,
  841. 1 << w->shift);
  842. snd_soc_update_bits(codec, dec_reset_reg, 1 << w->shift, 0x0);
  843. snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x08, 0x08);
  844. snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x30,
  845. (tx_hpf_work[decimator - 1].tx_hpf_cut_of_freq) << 4);
  846. snd_soc_update_bits(codec, tx_vol_ctl_reg, 0x01, 0x00);
  847. for (i = 0; i < NUM_DECIMATORS; i++) {
  848. if (decimator == i + 1)
  849. msm_dig_cdc->dec_active[i] = false;
  850. }
  851. break;
  852. }
  853. out:
  854. kfree(widget_name);
  855. return ret;
  856. }
  857. static int msm_dig_cdc_event_notify(struct notifier_block *block,
  858. unsigned long val,
  859. void *data)
  860. {
  861. enum dig_cdc_notify_event event = (enum dig_cdc_notify_event)val;
  862. struct snd_soc_codec *codec = registered_digcodec;
  863. struct msm_dig_priv *msm_dig_cdc = snd_soc_codec_get_drvdata(codec);
  864. struct msm_asoc_mach_data *pdata = NULL;
  865. int ret = -EINVAL;
  866. pdata = snd_soc_card_get_drvdata(codec->component.card);
  867. switch (event) {
  868. case DIG_CDC_EVENT_CLK_ON:
  869. snd_soc_update_bits(codec,
  870. MSM89XX_CDC_CORE_CLK_PDM_CTL, 0x03, 0x03);
  871. if (pdata->mclk_freq == MCLK_RATE_12P288MHZ ||
  872. pdata->native_clk_set)
  873. snd_soc_update_bits(codec,
  874. MSM89XX_CDC_CORE_TOP_CTL, 0x01, 0x00);
  875. else if (pdata->mclk_freq == MCLK_RATE_9P6MHZ)
  876. snd_soc_update_bits(codec,
  877. MSM89XX_CDC_CORE_TOP_CTL, 0x01, 0x01);
  878. snd_soc_update_bits(codec,
  879. MSM89XX_CDC_CORE_CLK_MCLK_CTL, 0x01, 0x01);
  880. break;
  881. case DIG_CDC_EVENT_CLK_OFF:
  882. snd_soc_update_bits(codec,
  883. MSM89XX_CDC_CORE_CLK_PDM_CTL, 0x03, 0x00);
  884. snd_soc_update_bits(codec,
  885. MSM89XX_CDC_CORE_CLK_MCLK_CTL, 0x01, 0x00);
  886. break;
  887. case DIG_CDC_EVENT_RX1_MUTE_ON:
  888. snd_soc_update_bits(codec,
  889. MSM89XX_CDC_CORE_RX1_B6_CTL, 0x01, 0x01);
  890. msm_dig_cdc->mute_mask |= HPHL_PA_DISABLE;
  891. break;
  892. case DIG_CDC_EVENT_RX1_MUTE_OFF:
  893. snd_soc_update_bits(codec,
  894. MSM89XX_CDC_CORE_RX1_B6_CTL, 0x01, 0x00);
  895. msm_dig_cdc->mute_mask &= (~HPHL_PA_DISABLE);
  896. break;
  897. case DIG_CDC_EVENT_RX2_MUTE_ON:
  898. snd_soc_update_bits(codec,
  899. MSM89XX_CDC_CORE_RX2_B6_CTL, 0x01, 0x01);
  900. msm_dig_cdc->mute_mask |= HPHR_PA_DISABLE;
  901. break;
  902. case DIG_CDC_EVENT_RX2_MUTE_OFF:
  903. snd_soc_update_bits(codec,
  904. MSM89XX_CDC_CORE_RX2_B6_CTL, 0x01, 0x00);
  905. msm_dig_cdc->mute_mask &= (~HPHR_PA_DISABLE);
  906. break;
  907. case DIG_CDC_EVENT_RX3_MUTE_ON:
  908. snd_soc_update_bits(codec,
  909. MSM89XX_CDC_CORE_RX3_B6_CTL, 0x01, 0x01);
  910. msm_dig_cdc->mute_mask |= SPKR_PA_DISABLE;
  911. break;
  912. case DIG_CDC_EVENT_RX3_MUTE_OFF:
  913. snd_soc_update_bits(codec,
  914. MSM89XX_CDC_CORE_RX3_B6_CTL, 0x01, 0x00);
  915. msm_dig_cdc->mute_mask &= (~SPKR_PA_DISABLE);
  916. break;
  917. case DIG_CDC_EVENT_PRE_RX1_INT_ON:
  918. snd_soc_update_bits(codec,
  919. MSM89XX_CDC_CORE_RX1_B3_CTL, 0x3C, 0x28);
  920. snd_soc_update_bits(codec,
  921. MSM89XX_CDC_CORE_RX1_B4_CTL, 0x18, 0x10);
  922. snd_soc_update_bits(codec,
  923. MSM89XX_CDC_CORE_RX1_B3_CTL, 0x80, 0x80);
  924. break;
  925. case DIG_CDC_EVENT_PRE_RX2_INT_ON:
  926. snd_soc_update_bits(codec,
  927. MSM89XX_CDC_CORE_RX2_B3_CTL, 0x3C, 0x28);
  928. snd_soc_update_bits(codec,
  929. MSM89XX_CDC_CORE_RX2_B4_CTL, 0x18, 0x10);
  930. snd_soc_update_bits(codec,
  931. MSM89XX_CDC_CORE_RX2_B3_CTL, 0x80, 0x80);
  932. break;
  933. case DIG_CDC_EVENT_POST_RX1_INT_OFF:
  934. snd_soc_update_bits(codec,
  935. MSM89XX_CDC_CORE_RX1_B3_CTL, 0x3C, 0x00);
  936. snd_soc_update_bits(codec,
  937. MSM89XX_CDC_CORE_RX1_B4_CTL, 0x18, 0xFF);
  938. snd_soc_update_bits(codec,
  939. MSM89XX_CDC_CORE_RX1_B3_CTL, 0x80, 0x00);
  940. break;
  941. case DIG_CDC_EVENT_POST_RX2_INT_OFF:
  942. snd_soc_update_bits(codec,
  943. MSM89XX_CDC_CORE_RX2_B3_CTL, 0x3C, 0x00);
  944. snd_soc_update_bits(codec,
  945. MSM89XX_CDC_CORE_RX2_B4_CTL, 0x18, 0xFF);
  946. snd_soc_update_bits(codec,
  947. MSM89XX_CDC_CORE_RX2_B3_CTL, 0x80, 0x00);
  948. break;
  949. case DIG_CDC_EVENT_SSR_DOWN:
  950. regcache_cache_only(msm_dig_cdc->regmap, true);
  951. break;
  952. case DIG_CDC_EVENT_SSR_UP:
  953. regcache_cache_only(msm_dig_cdc->regmap, false);
  954. regcache_mark_dirty(msm_dig_cdc->regmap);
  955. mutex_lock(&pdata->cdc_int_mclk0_mutex);
  956. pdata->digital_cdc_core_clk.enable = 1;
  957. ret = afe_set_lpass_clock_v2(
  958. AFE_PORT_ID_INT0_MI2S_RX,
  959. &pdata->digital_cdc_core_clk);
  960. if (ret < 0) {
  961. pr_err("%s:failed to enable the MCLK\n",
  962. __func__);
  963. mutex_unlock(&pdata->cdc_int_mclk0_mutex);
  964. break;
  965. }
  966. mutex_unlock(&pdata->cdc_int_mclk0_mutex);
  967. regcache_sync(msm_dig_cdc->regmap);
  968. mutex_lock(&pdata->cdc_int_mclk0_mutex);
  969. pdata->digital_cdc_core_clk.enable = 0;
  970. afe_set_lpass_clock_v2(
  971. AFE_PORT_ID_INT0_MI2S_RX,
  972. &pdata->digital_cdc_core_clk);
  973. mutex_unlock(&pdata->cdc_int_mclk0_mutex);
  974. break;
  975. case DIG_CDC_EVENT_INVALID:
  976. default:
  977. break;
  978. }
  979. return 0;
  980. }
  981. static ssize_t msm_dig_codec_version_read(struct snd_info_entry *entry,
  982. void *file_private_data,
  983. struct file *file,
  984. char __user *buf, size_t count,
  985. loff_t pos)
  986. {
  987. struct msm_dig_priv *msm_dig;
  988. char buffer[MSM_DIG_CDC_VERSION_ENTRY_SIZE];
  989. int len = 0;
  990. msm_dig = (struct msm_dig_priv *) entry->private_data;
  991. if (!msm_dig) {
  992. pr_err("%s: msm_dig priv is null\n", __func__);
  993. return -EINVAL;
  994. }
  995. switch (msm_dig->version) {
  996. case DRAX_CDC:
  997. len = snprintf(buffer, sizeof(buffer), "SDM660-CDC_1_0\n");
  998. break;
  999. default:
  1000. len = snprintf(buffer, sizeof(buffer), "VER_UNDEFINED\n");
  1001. }
  1002. return simple_read_from_buffer(buf, count, &pos, buffer, len);
  1003. }
  1004. static struct snd_info_entry_ops msm_dig_codec_info_ops = {
  1005. .read = msm_dig_codec_version_read,
  1006. };
  1007. /*
  1008. * msm_dig_codec_info_create_codec_entry - creates msm_dig module
  1009. * @codec_root: The parent directory
  1010. * @codec: Codec instance
  1011. *
  1012. * Creates msm_dig module and version entry under the given
  1013. * parent directory.
  1014. *
  1015. * Return: 0 on success or negative error code on failure.
  1016. */
  1017. int msm_dig_codec_info_create_codec_entry(struct snd_info_entry *codec_root,
  1018. struct snd_soc_codec *codec)
  1019. {
  1020. struct snd_info_entry *version_entry;
  1021. struct msm_dig_priv *msm_dig;
  1022. struct snd_soc_card *card;
  1023. if (!codec_root || !codec)
  1024. return -EINVAL;
  1025. msm_dig = snd_soc_codec_get_drvdata(codec);
  1026. card = codec->component.card;
  1027. msm_dig->entry = snd_info_create_subdir(codec_root->module,
  1028. "msm_digital_codec",
  1029. codec_root);
  1030. if (!msm_dig->entry) {
  1031. dev_dbg(codec->dev, "%s: failed to create msm_digital entry\n",
  1032. __func__);
  1033. return -ENOMEM;
  1034. }
  1035. version_entry = snd_info_create_card_entry(card->snd_card,
  1036. "version",
  1037. msm_dig->entry);
  1038. if (!version_entry) {
  1039. dev_dbg(codec->dev, "%s: failed to create msm_digital version entry\n",
  1040. __func__);
  1041. return -ENOMEM;
  1042. }
  1043. version_entry->private_data = msm_dig;
  1044. version_entry->size = MSM_DIG_CDC_VERSION_ENTRY_SIZE;
  1045. version_entry->content = SNDRV_INFO_CONTENT_DATA;
  1046. version_entry->c.ops = &msm_dig_codec_info_ops;
  1047. if (snd_info_register(version_entry) < 0) {
  1048. snd_info_free_entry(version_entry);
  1049. return -ENOMEM;
  1050. }
  1051. msm_dig->version_entry = version_entry;
  1052. if (msm_dig->get_cdc_version)
  1053. msm_dig->version = msm_dig->get_cdc_version(msm_dig->handle);
  1054. else
  1055. msm_dig->version = DRAX_CDC;
  1056. return 0;
  1057. }
  1058. EXPORT_SYMBOL(msm_dig_codec_info_create_codec_entry);
  1059. static int msm_dig_cdc_soc_probe(struct snd_soc_codec *codec)
  1060. {
  1061. struct msm_dig_priv *msm_dig_cdc = dev_get_drvdata(codec->dev);
  1062. struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
  1063. int i, ret;
  1064. msm_dig_cdc->codec = codec;
  1065. snd_soc_add_codec_controls(codec, compander_kcontrols,
  1066. ARRAY_SIZE(compander_kcontrols));
  1067. for (i = 0; i < NUM_DECIMATORS; i++) {
  1068. tx_hpf_work[i].dig_cdc = msm_dig_cdc;
  1069. tx_hpf_work[i].decimator = i + 1;
  1070. INIT_DELAYED_WORK(&tx_hpf_work[i].dwork,
  1071. tx_hpf_corner_freq_callback);
  1072. }
  1073. for (i = 0; i < MSM89XX_RX_MAX; i++)
  1074. msm_dig_cdc->comp_enabled[i] = COMPANDER_NONE;
  1075. /* Register event notifier */
  1076. msm_dig_cdc->nblock.notifier_call = msm_dig_cdc_event_notify;
  1077. if (msm_dig_cdc->register_notifier) {
  1078. ret = msm_dig_cdc->register_notifier(msm_dig_cdc->handle,
  1079. &msm_dig_cdc->nblock,
  1080. true);
  1081. if (ret) {
  1082. pr_err("%s: Failed to register notifier %d\n",
  1083. __func__, ret);
  1084. return ret;
  1085. }
  1086. }
  1087. registered_digcodec = codec;
  1088. snd_soc_dapm_ignore_suspend(dapm, "AIF1 Playback");
  1089. snd_soc_dapm_ignore_suspend(dapm, "AIF1 Capture");
  1090. snd_soc_dapm_ignore_suspend(dapm, "ADC1_IN");
  1091. snd_soc_dapm_ignore_suspend(dapm, "ADC2_IN");
  1092. snd_soc_dapm_ignore_suspend(dapm, "ADC3_IN");
  1093. snd_soc_dapm_ignore_suspend(dapm, "PDM_OUT_RX1");
  1094. snd_soc_dapm_ignore_suspend(dapm, "PDM_OUT_RX2");
  1095. snd_soc_dapm_ignore_suspend(dapm, "PDM_OUT_RX3");
  1096. snd_soc_dapm_sync(dapm);
  1097. return 0;
  1098. }
  1099. static int msm_dig_cdc_soc_remove(struct snd_soc_codec *codec)
  1100. {
  1101. struct msm_dig_priv *msm_dig_cdc = dev_get_drvdata(codec->dev);
  1102. if (msm_dig_cdc->register_notifier)
  1103. msm_dig_cdc->register_notifier(msm_dig_cdc->handle,
  1104. &msm_dig_cdc->nblock,
  1105. false);
  1106. iounmap(msm_dig_cdc->dig_base);
  1107. return 0;
  1108. }
  1109. static const struct snd_soc_dapm_route audio_dig_map[] = {
  1110. {"RX_I2S_CLK", NULL, "CDC_CONN"},
  1111. {"I2S RX1", NULL, "RX_I2S_CLK"},
  1112. {"I2S RX2", NULL, "RX_I2S_CLK"},
  1113. {"I2S RX3", NULL, "RX_I2S_CLK"},
  1114. {"I2S TX1", NULL, "TX_I2S_CLK"},
  1115. {"I2S TX2", NULL, "TX_I2S_CLK"},
  1116. {"I2S TX3", NULL, "TX_I2S_CLK"},
  1117. {"I2S TX4", NULL, "TX_I2S_CLK"},
  1118. {"I2S TX5", NULL, "TX_I2S_CLK"},
  1119. {"I2S TX6", NULL, "TX_I2S_CLK"},
  1120. {"I2S TX1", NULL, "DEC1 MUX"},
  1121. {"I2S TX2", NULL, "DEC2 MUX"},
  1122. {"I2S TX3", NULL, "I2S TX2 INP1"},
  1123. {"I2S TX4", NULL, "I2S TX2 INP2"},
  1124. {"I2S TX5", NULL, "DEC3 MUX"},
  1125. {"I2S TX6", NULL, "I2S TX3 INP2"},
  1126. {"I2S TX2 INP1", "RX_MIX1", "RX1 MIX2"},
  1127. {"I2S TX2 INP1", "DEC3", "DEC3 MUX"},
  1128. {"I2S TX2 INP2", "RX_MIX2", "RX2 MIX2"},
  1129. {"I2S TX2 INP2", "RX_MIX3", "RX3 MIX1"},
  1130. {"I2S TX2 INP2", "DEC4", "DEC4 MUX"},
  1131. {"I2S TX3 INP2", "DEC4", "DEC4 MUX"},
  1132. {"I2S TX3 INP2", "DEC5", "DEC5 MUX"},
  1133. {"PDM_OUT_RX1", NULL, "RX1 CHAIN"},
  1134. {"PDM_OUT_RX2", NULL, "RX2 CHAIN"},
  1135. {"PDM_OUT_RX3", NULL, "RX3 CHAIN"},
  1136. {"RX1 CHAIN", NULL, "RX1 MIX2"},
  1137. {"RX2 CHAIN", NULL, "RX2 MIX2"},
  1138. {"RX3 CHAIN", NULL, "RX3 MIX1"},
  1139. {"RX1 MIX1", NULL, "RX1 MIX1 INP1"},
  1140. {"RX1 MIX1", NULL, "RX1 MIX1 INP2"},
  1141. {"RX1 MIX1", NULL, "RX1 MIX1 INP3"},
  1142. {"RX2 MIX1", NULL, "RX2 MIX1 INP1"},
  1143. {"RX2 MIX1", NULL, "RX2 MIX1 INP2"},
  1144. {"RX3 MIX1", NULL, "RX3 MIX1 INP1"},
  1145. {"RX3 MIX1", NULL, "RX3 MIX1 INP2"},
  1146. {"RX1 MIX2", NULL, "RX1 MIX1"},
  1147. {"RX1 MIX2", NULL, "RX1 MIX2 INP1"},
  1148. {"RX2 MIX2", NULL, "RX2 MIX1"},
  1149. {"RX2 MIX2", NULL, "RX2 MIX2 INP1"},
  1150. {"RX1 MIX1 INP1", "RX1", "I2S RX1"},
  1151. {"RX1 MIX1 INP1", "RX2", "I2S RX2"},
  1152. {"RX1 MIX1 INP1", "RX3", "I2S RX3"},
  1153. {"RX1 MIX1 INP1", "IIR1", "IIR1"},
  1154. {"RX1 MIX1 INP1", "IIR2", "IIR2"},
  1155. {"RX1 MIX1 INP2", "RX1", "I2S RX1"},
  1156. {"RX1 MIX1 INP2", "RX2", "I2S RX2"},
  1157. {"RX1 MIX1 INP2", "RX3", "I2S RX3"},
  1158. {"RX1 MIX1 INP2", "IIR1", "IIR1"},
  1159. {"RX1 MIX1 INP2", "IIR2", "IIR2"},
  1160. {"RX1 MIX1 INP3", "RX1", "I2S RX1"},
  1161. {"RX1 MIX1 INP3", "RX2", "I2S RX2"},
  1162. {"RX1 MIX1 INP3", "RX3", "I2S RX3"},
  1163. {"RX2 MIX1 INP1", "RX1", "I2S RX1"},
  1164. {"RX2 MIX1 INP1", "RX2", "I2S RX2"},
  1165. {"RX2 MIX1 INP1", "RX3", "I2S RX3"},
  1166. {"RX2 MIX1 INP1", "IIR1", "IIR1"},
  1167. {"RX2 MIX1 INP1", "IIR2", "IIR2"},
  1168. {"RX2 MIX1 INP2", "RX1", "I2S RX1"},
  1169. {"RX2 MIX1 INP2", "RX2", "I2S RX2"},
  1170. {"RX2 MIX1 INP2", "RX3", "I2S RX3"},
  1171. {"RX2 MIX1 INP2", "IIR1", "IIR1"},
  1172. {"RX2 MIX1 INP2", "IIR2", "IIR2"},
  1173. {"RX3 MIX1 INP1", "RX1", "I2S RX1"},
  1174. {"RX3 MIX1 INP1", "RX2", "I2S RX2"},
  1175. {"RX3 MIX1 INP1", "RX3", "I2S RX3"},
  1176. {"RX3 MIX1 INP1", "IIR1", "IIR1"},
  1177. {"RX3 MIX1 INP1", "IIR2", "IIR2"},
  1178. {"RX3 MIX1 INP2", "RX1", "I2S RX1"},
  1179. {"RX3 MIX1 INP2", "RX2", "I2S RX2"},
  1180. {"RX3 MIX1 INP2", "RX3", "I2S RX3"},
  1181. {"RX3 MIX1 INP2", "IIR1", "IIR1"},
  1182. {"RX3 MIX1 INP2", "IIR2", "IIR2"},
  1183. {"RX1 MIX2 INP1", "IIR1", "IIR1"},
  1184. {"RX2 MIX2 INP1", "IIR1", "IIR1"},
  1185. {"RX1 MIX2 INP1", "IIR2", "IIR2"},
  1186. {"RX2 MIX2 INP1", "IIR2", "IIR2"},
  1187. /* Decimator Inputs */
  1188. {"DEC1 MUX", "DMIC1", "DMIC1"},
  1189. {"DEC1 MUX", "DMIC2", "DMIC2"},
  1190. {"DEC1 MUX", "DMIC3", "DMIC3"},
  1191. {"DEC1 MUX", "DMIC4", "DMIC4"},
  1192. {"DEC1 MUX", "ADC1", "ADC1_IN"},
  1193. {"DEC1 MUX", "ADC2", "ADC2_IN"},
  1194. {"DEC1 MUX", "ADC3", "ADC3_IN"},
  1195. {"DEC1 MUX", NULL, "CDC_CONN"},
  1196. {"DEC2 MUX", "DMIC1", "DMIC1"},
  1197. {"DEC2 MUX", "DMIC2", "DMIC2"},
  1198. {"DEC2 MUX", "DMIC3", "DMIC3"},
  1199. {"DEC2 MUX", "DMIC4", "DMIC4"},
  1200. {"DEC2 MUX", "ADC1", "ADC1_IN"},
  1201. {"DEC2 MUX", "ADC2", "ADC2_IN"},
  1202. {"DEC2 MUX", "ADC3", "ADC3_IN"},
  1203. {"DEC2 MUX", NULL, "CDC_CONN"},
  1204. {"DEC3 MUX", "DMIC1", "DMIC1"},
  1205. {"DEC3 MUX", "DMIC2", "DMIC2"},
  1206. {"DEC3 MUX", "DMIC3", "DMIC3"},
  1207. {"DEC3 MUX", "DMIC4", "DMIC4"},
  1208. {"DEC3 MUX", "ADC1", "ADC1_IN"},
  1209. {"DEC3 MUX", "ADC2", "ADC2_IN"},
  1210. {"DEC3 MUX", "ADC3", "ADC3_IN"},
  1211. {"DEC3 MUX", NULL, "CDC_CONN"},
  1212. {"DEC4 MUX", "DMIC1", "DMIC1"},
  1213. {"DEC4 MUX", "DMIC2", "DMIC2"},
  1214. {"DEC4 MUX", "DMIC3", "DMIC3"},
  1215. {"DEC4 MUX", "DMIC4", "DMIC4"},
  1216. {"DEC4 MUX", "ADC1", "ADC1_IN"},
  1217. {"DEC4 MUX", "ADC2", "ADC2_IN"},
  1218. {"DEC4 MUX", "ADC3", "ADC3_IN"},
  1219. {"DEC4 MUX", NULL, "CDC_CONN"},
  1220. {"DEC5 MUX", "DMIC1", "DMIC1"},
  1221. {"DEC5 MUX", "DMIC2", "DMIC2"},
  1222. {"DEC5 MUX", "DMIC3", "DMIC3"},
  1223. {"DEC5 MUX", "DMIC4", "DMIC4"},
  1224. {"DEC5 MUX", "ADC1", "ADC1_IN"},
  1225. {"DEC5 MUX", "ADC2", "ADC2_IN"},
  1226. {"DEC5 MUX", "ADC3", "ADC3_IN"},
  1227. {"DEC5 MUX", NULL, "CDC_CONN"},
  1228. {"IIR1", NULL, "IIR1 INP1 MUX"},
  1229. {"IIR1 INP1 MUX", "DEC1", "DEC1 MUX"},
  1230. {"IIR1 INP1 MUX", "DEC2", "DEC2 MUX"},
  1231. {"IIR1 INP1 MUX", "DEC3", "DEC3 MUX"},
  1232. {"IIR1 INP1 MUX", "DEC4", "DEC4 MUX"},
  1233. {"IIR2", NULL, "IIR2 INP1 MUX"},
  1234. {"IIR2 INP1 MUX", "DEC1", "DEC1 MUX"},
  1235. {"IIR2 INP1 MUX", "DEC2", "DEC2 MUX"},
  1236. {"IIR1 INP1 MUX", "DEC3", "DEC3 MUX"},
  1237. {"IIR1 INP1 MUX", "DEC4", "DEC4 MUX"},
  1238. };
  1239. static const char * const i2s_tx2_inp1_text[] = {
  1240. "ZERO", "RX_MIX1", "DEC3"
  1241. };
  1242. static const char * const i2s_tx2_inp2_text[] = {
  1243. "ZERO", "RX_MIX2", "RX_MIX3", "DEC4"
  1244. };
  1245. static const char * const i2s_tx3_inp2_text[] = {
  1246. "DEC4", "DEC5"
  1247. };
  1248. static const char * const rx_mix1_text[] = {
  1249. "ZERO", "IIR1", "IIR2", "RX1", "RX2", "RX3"
  1250. };
  1251. static const char * const rx_mix2_text[] = {
  1252. "ZERO", "IIR1", "IIR2"
  1253. };
  1254. static const char * const dec_mux_text[] = {
  1255. "ZERO", "ADC1", "ADC2", "ADC3", "DMIC1", "DMIC2", "DMIC3", "DMIC4"
  1256. };
  1257. static const char * const iir_inp1_text[] = {
  1258. "ZERO", "DEC1", "DEC2", "RX1", "RX2", "RX3", "DEC3", "DEC4"
  1259. };
  1260. /* I2S TX MUXes */
  1261. static const struct soc_enum i2s_tx2_inp1_chain_enum =
  1262. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_I2S_SD1_CTL,
  1263. 2, 3, i2s_tx2_inp1_text);
  1264. static const struct soc_enum i2s_tx2_inp2_chain_enum =
  1265. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_I2S_SD1_CTL,
  1266. 0, 4, i2s_tx2_inp2_text);
  1267. static const struct soc_enum i2s_tx3_inp2_chain_enum =
  1268. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_I2S_SD1_CTL,
  1269. 4, 2, i2s_tx3_inp2_text);
  1270. /* RX1 MIX1 */
  1271. static const struct soc_enum rx_mix1_inp1_chain_enum =
  1272. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX1_B1_CTL,
  1273. 0, 6, rx_mix1_text);
  1274. static const struct soc_enum rx_mix1_inp2_chain_enum =
  1275. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX1_B1_CTL,
  1276. 3, 6, rx_mix1_text);
  1277. static const struct soc_enum rx_mix1_inp3_chain_enum =
  1278. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX1_B2_CTL,
  1279. 0, 6, rx_mix1_text);
  1280. /* RX1 MIX2 */
  1281. static const struct soc_enum rx_mix2_inp1_chain_enum =
  1282. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX1_B3_CTL,
  1283. 0, 3, rx_mix2_text);
  1284. /* RX2 MIX1 */
  1285. static const struct soc_enum rx2_mix1_inp1_chain_enum =
  1286. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX2_B1_CTL,
  1287. 0, 6, rx_mix1_text);
  1288. static const struct soc_enum rx2_mix1_inp2_chain_enum =
  1289. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX2_B1_CTL,
  1290. 3, 6, rx_mix1_text);
  1291. static const struct soc_enum rx2_mix1_inp3_chain_enum =
  1292. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX2_B1_CTL,
  1293. 0, 6, rx_mix1_text);
  1294. /* RX2 MIX2 */
  1295. static const struct soc_enum rx2_mix2_inp1_chain_enum =
  1296. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX2_B3_CTL,
  1297. 0, 3, rx_mix2_text);
  1298. /* RX3 MIX1 */
  1299. static const struct soc_enum rx3_mix1_inp1_chain_enum =
  1300. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX3_B1_CTL,
  1301. 0, 6, rx_mix1_text);
  1302. static const struct soc_enum rx3_mix1_inp2_chain_enum =
  1303. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX3_B1_CTL,
  1304. 3, 6, rx_mix1_text);
  1305. static const struct soc_enum rx3_mix1_inp3_chain_enum =
  1306. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_RX3_B1_CTL,
  1307. 0, 6, rx_mix1_text);
  1308. /* DEC */
  1309. static const struct soc_enum dec1_mux_enum =
  1310. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_B1_CTL,
  1311. 0, 8, dec_mux_text);
  1312. static const struct soc_enum dec2_mux_enum =
  1313. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_B1_CTL,
  1314. 3, 8, dec_mux_text);
  1315. static const struct soc_enum dec3_mux_enum =
  1316. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_B2_CTL,
  1317. 0, 8, dec_mux_text);
  1318. static const struct soc_enum dec4_mux_enum =
  1319. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_B2_CTL,
  1320. 3, 8, dec_mux_text);
  1321. static const struct soc_enum decsva_mux_enum =
  1322. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_TX_B3_CTL,
  1323. 0, 8, dec_mux_text);
  1324. static const struct soc_enum iir1_inp1_mux_enum =
  1325. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_EQ1_B1_CTL,
  1326. 0, 8, iir_inp1_text);
  1327. static const struct soc_enum iir2_inp1_mux_enum =
  1328. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_CONN_EQ2_B1_CTL,
  1329. 0, 8, iir_inp1_text);
  1330. /*cut of frequency for high pass filter*/
  1331. static const char * const cf_text[] = {
  1332. "MIN_3DB_4Hz", "MIN_3DB_75Hz", "MIN_3DB_150Hz"
  1333. };
  1334. static const struct soc_enum cf_rxmix1_enum =
  1335. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_RX1_B4_CTL, 0, 3, cf_text);
  1336. static const struct soc_enum cf_rxmix2_enum =
  1337. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_RX2_B4_CTL, 0, 3, cf_text);
  1338. static const struct soc_enum cf_rxmix3_enum =
  1339. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_RX3_B4_CTL, 0, 3, cf_text);
  1340. static const struct snd_kcontrol_new rx3_mix1_inp1_mux =
  1341. SOC_DAPM_ENUM("RX3 MIX1 INP1 Mux", rx3_mix1_inp1_chain_enum);
  1342. #define MSM89XX_DEC_ENUM(xname, xenum) \
  1343. { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
  1344. .info = snd_soc_info_enum_double, \
  1345. .get = snd_soc_dapm_get_enum_double, \
  1346. .put = msm_dig_cdc_put_dec_enum, \
  1347. .private_value = (unsigned long)&xenum }
  1348. static const struct snd_kcontrol_new dec1_mux =
  1349. MSM89XX_DEC_ENUM("DEC1 MUX Mux", dec1_mux_enum);
  1350. static const struct snd_kcontrol_new dec2_mux =
  1351. MSM89XX_DEC_ENUM("DEC2 MUX Mux", dec2_mux_enum);
  1352. static const struct snd_kcontrol_new dec3_mux =
  1353. MSM89XX_DEC_ENUM("DEC3 MUX Mux", dec3_mux_enum);
  1354. static const struct snd_kcontrol_new dec4_mux =
  1355. MSM89XX_DEC_ENUM("DEC4 MUX Mux", dec4_mux_enum);
  1356. static const struct snd_kcontrol_new decsva_mux =
  1357. MSM89XX_DEC_ENUM("DEC5 MUX Mux", decsva_mux_enum);
  1358. static const struct snd_kcontrol_new i2s_tx2_inp1_mux =
  1359. SOC_DAPM_ENUM("I2S TX2 INP1 Mux", i2s_tx2_inp1_chain_enum);
  1360. static const struct snd_kcontrol_new i2s_tx2_inp2_mux =
  1361. SOC_DAPM_ENUM("I2S TX2 INP2 Mux", i2s_tx2_inp2_chain_enum);
  1362. static const struct snd_kcontrol_new i2s_tx3_inp2_mux =
  1363. SOC_DAPM_ENUM("I2S TX3 INP2 Mux", i2s_tx3_inp2_chain_enum);
  1364. static const struct snd_kcontrol_new iir1_inp1_mux =
  1365. SOC_DAPM_ENUM("IIR1 INP1 Mux", iir1_inp1_mux_enum);
  1366. static const struct snd_kcontrol_new iir2_inp1_mux =
  1367. SOC_DAPM_ENUM("IIR2 INP1 Mux", iir2_inp1_mux_enum);
  1368. static const struct snd_kcontrol_new rx_mix1_inp1_mux =
  1369. SOC_DAPM_ENUM("RX1 MIX1 INP1 Mux", rx_mix1_inp1_chain_enum);
  1370. static const struct snd_kcontrol_new rx_mix1_inp2_mux =
  1371. SOC_DAPM_ENUM("RX1 MIX1 INP2 Mux", rx_mix1_inp2_chain_enum);
  1372. static const struct snd_kcontrol_new rx_mix1_inp3_mux =
  1373. SOC_DAPM_ENUM("RX1 MIX1 INP3 Mux", rx_mix1_inp3_chain_enum);
  1374. static const struct snd_kcontrol_new rx2_mix1_inp1_mux =
  1375. SOC_DAPM_ENUM("RX2 MIX1 INP1 Mux", rx2_mix1_inp1_chain_enum);
  1376. static const struct snd_kcontrol_new rx2_mix1_inp2_mux =
  1377. SOC_DAPM_ENUM("RX2 MIX1 INP2 Mux", rx2_mix1_inp2_chain_enum);
  1378. static const struct snd_kcontrol_new rx2_mix1_inp3_mux =
  1379. SOC_DAPM_ENUM("RX2 MIX1 INP3 Mux", rx2_mix1_inp3_chain_enum);
  1380. static const struct snd_kcontrol_new rx3_mix1_inp2_mux =
  1381. SOC_DAPM_ENUM("RX3 MIX1 INP2 Mux", rx3_mix1_inp2_chain_enum);
  1382. static const struct snd_kcontrol_new rx3_mix1_inp3_mux =
  1383. SOC_DAPM_ENUM("RX3 MIX1 INP3 Mux", rx3_mix1_inp3_chain_enum);
  1384. static const struct snd_kcontrol_new rx1_mix2_inp1_mux =
  1385. SOC_DAPM_ENUM("RX1 MIX2 INP1 Mux", rx_mix2_inp1_chain_enum);
  1386. static const struct snd_kcontrol_new rx2_mix2_inp1_mux =
  1387. SOC_DAPM_ENUM("RX2 MIX2 INP1 Mux", rx2_mix2_inp1_chain_enum);
  1388. static const struct snd_soc_dapm_widget msm_dig_dapm_widgets[] = {
  1389. SND_SOC_DAPM_AIF_IN("I2S RX1", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
  1390. SND_SOC_DAPM_AIF_IN("I2S RX2", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
  1391. SND_SOC_DAPM_AIF_IN("I2S RX3", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
  1392. SND_SOC_DAPM_AIF_OUT("I2S TX1", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
  1393. SND_SOC_DAPM_AIF_OUT("I2S TX2", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
  1394. SND_SOC_DAPM_AIF_OUT("I2S TX3", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
  1395. SND_SOC_DAPM_AIF_OUT("I2S TX4", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
  1396. SND_SOC_DAPM_AIF_OUT("I2S TX5", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
  1397. SND_SOC_DAPM_AIF_OUT("I2S TX6", "AIF2 Capture", 0, SND_SOC_NOPM, 0, 0),
  1398. SND_SOC_DAPM_MIXER_E("RX1 MIX2", MSM89XX_CDC_CORE_CLK_RX_B1_CTL,
  1399. MSM89XX_RX1, 0, NULL, 0,
  1400. msm_dig_cdc_codec_enable_interpolator,
  1401. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1402. SND_SOC_DAPM_MIXER_E("RX2 MIX2", MSM89XX_CDC_CORE_CLK_RX_B1_CTL,
  1403. MSM89XX_RX2, 0, NULL, 0,
  1404. msm_dig_cdc_codec_enable_interpolator,
  1405. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1406. SND_SOC_DAPM_MIXER_E("RX3 MIX1", MSM89XX_CDC_CORE_CLK_RX_B1_CTL,
  1407. MSM89XX_RX3, 0, NULL, 0,
  1408. msm_dig_cdc_codec_enable_interpolator,
  1409. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1410. SND_SOC_DAPM_MIXER("RX1 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
  1411. SND_SOC_DAPM_MIXER("RX2 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
  1412. SND_SOC_DAPM_MIXER("RX1 CHAIN", SND_SOC_NOPM, 0, 0, NULL, 0),
  1413. SND_SOC_DAPM_MIXER("RX2 CHAIN", SND_SOC_NOPM, 0, 0, NULL, 0),
  1414. SND_SOC_DAPM_MIXER("RX3 CHAIN", SND_SOC_NOPM, 0, 0, NULL, 0),
  1415. SND_SOC_DAPM_MUX("RX1 MIX1 INP1", SND_SOC_NOPM, 0, 0,
  1416. &rx_mix1_inp1_mux),
  1417. SND_SOC_DAPM_MUX("RX1 MIX1 INP2", SND_SOC_NOPM, 0, 0,
  1418. &rx_mix1_inp2_mux),
  1419. SND_SOC_DAPM_MUX("RX1 MIX1 INP3", SND_SOC_NOPM, 0, 0,
  1420. &rx_mix1_inp3_mux),
  1421. SND_SOC_DAPM_MUX("RX2 MIX1 INP1", SND_SOC_NOPM, 0, 0,
  1422. &rx2_mix1_inp1_mux),
  1423. SND_SOC_DAPM_MUX("RX2 MIX1 INP2", SND_SOC_NOPM, 0, 0,
  1424. &rx2_mix1_inp2_mux),
  1425. SND_SOC_DAPM_MUX("RX2 MIX1 INP3", SND_SOC_NOPM, 0, 0,
  1426. &rx2_mix1_inp3_mux),
  1427. SND_SOC_DAPM_MUX("RX3 MIX1 INP1", SND_SOC_NOPM, 0, 0,
  1428. &rx3_mix1_inp1_mux),
  1429. SND_SOC_DAPM_MUX("RX3 MIX1 INP2", SND_SOC_NOPM, 0, 0,
  1430. &rx3_mix1_inp2_mux),
  1431. SND_SOC_DAPM_MUX("RX3 MIX1 INP3", SND_SOC_NOPM, 0, 0,
  1432. &rx3_mix1_inp3_mux),
  1433. SND_SOC_DAPM_MUX("RX1 MIX2 INP1", SND_SOC_NOPM, 0, 0,
  1434. &rx1_mix2_inp1_mux),
  1435. SND_SOC_DAPM_MUX("RX2 MIX2 INP1", SND_SOC_NOPM, 0, 0,
  1436. &rx2_mix2_inp1_mux),
  1437. SND_SOC_DAPM_SUPPLY_S("CDC_CONN", -2, MSM89XX_CDC_CORE_CLK_OTHR_CTL,
  1438. 2, 0, NULL, 0),
  1439. SND_SOC_DAPM_MUX_E("DEC1 MUX",
  1440. MSM89XX_CDC_CORE_CLK_TX_CLK_EN_B1_CTL, 0, 0,
  1441. &dec1_mux, msm_dig_cdc_codec_enable_dec,
  1442. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1443. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1444. SND_SOC_DAPM_MUX_E("DEC2 MUX",
  1445. MSM89XX_CDC_CORE_CLK_TX_CLK_EN_B1_CTL, 1, 0,
  1446. &dec2_mux, msm_dig_cdc_codec_enable_dec,
  1447. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1448. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1449. SND_SOC_DAPM_MUX_E("DEC3 MUX",
  1450. MSM89XX_CDC_CORE_CLK_TX_CLK_EN_B1_CTL, 2, 0,
  1451. &dec3_mux, msm_dig_cdc_codec_enable_dec,
  1452. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1453. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1454. SND_SOC_DAPM_MUX_E("DEC4 MUX",
  1455. MSM89XX_CDC_CORE_CLK_TX_CLK_EN_B1_CTL, 3, 0,
  1456. &dec4_mux, msm_dig_cdc_codec_enable_dec,
  1457. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1458. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1459. SND_SOC_DAPM_MUX_E("DEC5 MUX",
  1460. MSM89XX_CDC_CORE_CLK_TX_CLK_EN_B1_CTL, 4, 0,
  1461. &decsva_mux, msm_dig_cdc_codec_enable_dec,
  1462. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1463. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1464. /* Sidetone */
  1465. SND_SOC_DAPM_MUX("IIR1 INP1 MUX", SND_SOC_NOPM, 0, 0, &iir1_inp1_mux),
  1466. SND_SOC_DAPM_PGA_E("IIR1", MSM89XX_CDC_CORE_CLK_SD_CTL, 0, 0, NULL, 0,
  1467. msm_dig_cdc_codec_set_iir_gain, SND_SOC_DAPM_POST_PMU),
  1468. SND_SOC_DAPM_MUX("IIR2 INP1 MUX", SND_SOC_NOPM, 0, 0, &iir2_inp1_mux),
  1469. SND_SOC_DAPM_PGA_E("IIR2", MSM89XX_CDC_CORE_CLK_SD_CTL, 1, 0, NULL, 0,
  1470. msm_dig_cdc_codec_set_iir_gain, SND_SOC_DAPM_POST_PMU),
  1471. SND_SOC_DAPM_SUPPLY("RX_I2S_CLK",
  1472. MSM89XX_CDC_CORE_CLK_RX_I2S_CTL, 4, 0, NULL, 0),
  1473. SND_SOC_DAPM_SUPPLY("TX_I2S_CLK",
  1474. MSM89XX_CDC_CORE_CLK_TX_I2S_CTL, 4, 0, NULL, 0),
  1475. SND_SOC_DAPM_MUX("I2S TX2 INP1", SND_SOC_NOPM, 0, 0,
  1476. &i2s_tx2_inp1_mux),
  1477. SND_SOC_DAPM_MUX("I2S TX2 INP2", SND_SOC_NOPM, 0, 0,
  1478. &i2s_tx2_inp2_mux),
  1479. SND_SOC_DAPM_MUX("I2S TX3 INP2", SND_SOC_NOPM, 0, 0,
  1480. &i2s_tx3_inp2_mux),
  1481. /* Digital Mic Inputs */
  1482. SND_SOC_DAPM_ADC_E("DMIC1", NULL, SND_SOC_NOPM, 0, 0,
  1483. msm_dig_cdc_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1484. SND_SOC_DAPM_POST_PMD),
  1485. SND_SOC_DAPM_ADC_E("DMIC2", NULL, SND_SOC_NOPM, 0, 0,
  1486. msm_dig_cdc_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1487. SND_SOC_DAPM_POST_PMD),
  1488. SND_SOC_DAPM_ADC_E("DMIC3", NULL, SND_SOC_NOPM, 0, 0,
  1489. msm_dig_cdc_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1490. SND_SOC_DAPM_POST_PMD),
  1491. SND_SOC_DAPM_ADC_E("DMIC4", NULL, SND_SOC_NOPM, 0, 0,
  1492. msm_dig_cdc_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1493. SND_SOC_DAPM_POST_PMD),
  1494. SND_SOC_DAPM_INPUT("ADC1_IN"),
  1495. SND_SOC_DAPM_INPUT("ADC2_IN"),
  1496. SND_SOC_DAPM_INPUT("ADC3_IN"),
  1497. SND_SOC_DAPM_OUTPUT("PDM_OUT_RX1"),
  1498. SND_SOC_DAPM_OUTPUT("PDM_OUT_RX2"),
  1499. SND_SOC_DAPM_OUTPUT("PDM_OUT_RX3"),
  1500. };
  1501. static const struct soc_enum cf_dec1_enum =
  1502. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_TX1_MUX_CTL, 4, 3, cf_text);
  1503. static const struct soc_enum cf_dec2_enum =
  1504. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_TX2_MUX_CTL, 4, 3, cf_text);
  1505. static const struct soc_enum cf_dec3_enum =
  1506. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_TX3_MUX_CTL, 4, 3, cf_text);
  1507. static const struct soc_enum cf_dec4_enum =
  1508. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_TX4_MUX_CTL, 4, 3, cf_text);
  1509. static const struct soc_enum cf_decsva_enum =
  1510. SOC_ENUM_SINGLE(MSM89XX_CDC_CORE_TX5_MUX_CTL, 4, 3, cf_text);
  1511. static const struct snd_kcontrol_new msm_dig_snd_controls[] = {
  1512. SOC_SINGLE_SX_TLV("DEC1 Volume",
  1513. MSM89XX_CDC_CORE_TX1_VOL_CTL_GAIN,
  1514. 0, -84, 40, digital_gain),
  1515. SOC_SINGLE_SX_TLV("DEC2 Volume",
  1516. MSM89XX_CDC_CORE_TX2_VOL_CTL_GAIN,
  1517. 0, -84, 40, digital_gain),
  1518. SOC_SINGLE_SX_TLV("DEC3 Volume",
  1519. MSM89XX_CDC_CORE_TX3_VOL_CTL_GAIN,
  1520. 0, -84, 40, digital_gain),
  1521. SOC_SINGLE_SX_TLV("DEC4 Volume",
  1522. MSM89XX_CDC_CORE_TX4_VOL_CTL_GAIN,
  1523. 0, -84, 40, digital_gain),
  1524. SOC_SINGLE_SX_TLV("DEC5 Volume",
  1525. MSM89XX_CDC_CORE_TX5_VOL_CTL_GAIN,
  1526. 0, -84, 40, digital_gain),
  1527. SOC_SINGLE_SX_TLV("IIR1 INP1 Volume",
  1528. MSM89XX_CDC_CORE_IIR1_GAIN_B1_CTL,
  1529. 0, -84, 40, digital_gain),
  1530. SOC_SINGLE_SX_TLV("IIR1 INP2 Volume",
  1531. MSM89XX_CDC_CORE_IIR1_GAIN_B2_CTL,
  1532. 0, -84, 40, digital_gain),
  1533. SOC_SINGLE_SX_TLV("IIR1 INP3 Volume",
  1534. MSM89XX_CDC_CORE_IIR1_GAIN_B3_CTL,
  1535. 0, -84, 40, digital_gain),
  1536. SOC_SINGLE_SX_TLV("IIR1 INP4 Volume",
  1537. MSM89XX_CDC_CORE_IIR1_GAIN_B4_CTL,
  1538. 0, -84, 40, digital_gain),
  1539. SOC_SINGLE_SX_TLV("IIR2 INP1 Volume",
  1540. MSM89XX_CDC_CORE_IIR2_GAIN_B1_CTL,
  1541. 0, -84, 40, digital_gain),
  1542. SOC_SINGLE_SX_TLV("RX1 Digital Volume",
  1543. MSM89XX_CDC_CORE_RX1_VOL_CTL_B2_CTL,
  1544. 0, -84, 40, digital_gain),
  1545. SOC_SINGLE_SX_TLV("RX2 Digital Volume",
  1546. MSM89XX_CDC_CORE_RX2_VOL_CTL_B2_CTL,
  1547. 0, -84, 40, digital_gain),
  1548. SOC_SINGLE_SX_TLV("RX3 Digital Volume",
  1549. MSM89XX_CDC_CORE_RX3_VOL_CTL_B2_CTL,
  1550. 0, -84, 40, digital_gain),
  1551. SOC_SINGLE_EXT("IIR1 Enable Band1", IIR1, BAND1, 1, 0,
  1552. msm_dig_cdc_get_iir_enable_audio_mixer,
  1553. msm_dig_cdc_put_iir_enable_audio_mixer),
  1554. SOC_SINGLE_EXT("IIR1 Enable Band2", IIR1, BAND2, 1, 0,
  1555. msm_dig_cdc_get_iir_enable_audio_mixer,
  1556. msm_dig_cdc_put_iir_enable_audio_mixer),
  1557. SOC_SINGLE_EXT("IIR1 Enable Band3", IIR1, BAND3, 1, 0,
  1558. msm_dig_cdc_get_iir_enable_audio_mixer,
  1559. msm_dig_cdc_put_iir_enable_audio_mixer),
  1560. SOC_SINGLE_EXT("IIR1 Enable Band4", IIR1, BAND4, 1, 0,
  1561. msm_dig_cdc_get_iir_enable_audio_mixer,
  1562. msm_dig_cdc_put_iir_enable_audio_mixer),
  1563. SOC_SINGLE_EXT("IIR1 Enable Band5", IIR1, BAND5, 1, 0,
  1564. msm_dig_cdc_get_iir_enable_audio_mixer,
  1565. msm_dig_cdc_put_iir_enable_audio_mixer),
  1566. SOC_SINGLE_EXT("IIR2 Enable Band1", IIR2, BAND1, 1, 0,
  1567. msm_dig_cdc_get_iir_enable_audio_mixer,
  1568. msm_dig_cdc_put_iir_enable_audio_mixer),
  1569. SOC_SINGLE_EXT("IIR2 Enable Band2", IIR2, BAND2, 1, 0,
  1570. msm_dig_cdc_get_iir_enable_audio_mixer,
  1571. msm_dig_cdc_put_iir_enable_audio_mixer),
  1572. SOC_SINGLE_EXT("IIR2 Enable Band3", IIR2, BAND3, 1, 0,
  1573. msm_dig_cdc_get_iir_enable_audio_mixer,
  1574. msm_dig_cdc_put_iir_enable_audio_mixer),
  1575. SOC_SINGLE_EXT("IIR2 Enable Band4", IIR2, BAND4, 1, 0,
  1576. msm_dig_cdc_get_iir_enable_audio_mixer,
  1577. msm_dig_cdc_put_iir_enable_audio_mixer),
  1578. SOC_SINGLE_EXT("IIR2 Enable Band5", IIR2, BAND5, 1, 0,
  1579. msm_dig_cdc_get_iir_enable_audio_mixer,
  1580. msm_dig_cdc_put_iir_enable_audio_mixer),
  1581. SOC_SINGLE_MULTI_EXT("IIR1 Band1", IIR1, BAND1, 255, 0, 5,
  1582. msm_dig_cdc_get_iir_band_audio_mixer,
  1583. msm_dig_cdc_put_iir_band_audio_mixer),
  1584. SOC_SINGLE_MULTI_EXT("IIR1 Band2", IIR1, BAND2, 255, 0, 5,
  1585. msm_dig_cdc_get_iir_band_audio_mixer,
  1586. msm_dig_cdc_put_iir_band_audio_mixer),
  1587. SOC_SINGLE_MULTI_EXT("IIR1 Band3", IIR1, BAND3, 255, 0, 5,
  1588. msm_dig_cdc_get_iir_band_audio_mixer,
  1589. msm_dig_cdc_put_iir_band_audio_mixer),
  1590. SOC_SINGLE_MULTI_EXT("IIR1 Band4", IIR1, BAND4, 255, 0, 5,
  1591. msm_dig_cdc_get_iir_band_audio_mixer,
  1592. msm_dig_cdc_put_iir_band_audio_mixer),
  1593. SOC_SINGLE_MULTI_EXT("IIR1 Band5", IIR1, BAND5, 255, 0, 5,
  1594. msm_dig_cdc_get_iir_band_audio_mixer,
  1595. msm_dig_cdc_put_iir_band_audio_mixer),
  1596. SOC_SINGLE_MULTI_EXT("IIR2 Band1", IIR2, BAND1, 255, 0, 5,
  1597. msm_dig_cdc_get_iir_band_audio_mixer,
  1598. msm_dig_cdc_put_iir_band_audio_mixer),
  1599. SOC_SINGLE_MULTI_EXT("IIR2 Band2", IIR2, BAND2, 255, 0, 5,
  1600. msm_dig_cdc_get_iir_band_audio_mixer,
  1601. msm_dig_cdc_put_iir_band_audio_mixer),
  1602. SOC_SINGLE_MULTI_EXT("IIR2 Band3", IIR2, BAND3, 255, 0, 5,
  1603. msm_dig_cdc_get_iir_band_audio_mixer,
  1604. msm_dig_cdc_put_iir_band_audio_mixer),
  1605. SOC_SINGLE_MULTI_EXT("IIR2 Band4", IIR2, BAND4, 255, 0, 5,
  1606. msm_dig_cdc_get_iir_band_audio_mixer,
  1607. msm_dig_cdc_put_iir_band_audio_mixer),
  1608. SOC_SINGLE_MULTI_EXT("IIR2 Band5", IIR2, BAND5, 255, 0, 5,
  1609. msm_dig_cdc_get_iir_band_audio_mixer,
  1610. msm_dig_cdc_put_iir_band_audio_mixer),
  1611. SOC_SINGLE("RX1 HPF Switch",
  1612. MSM89XX_CDC_CORE_RX1_B5_CTL, 2, 1, 0),
  1613. SOC_SINGLE("RX2 HPF Switch",
  1614. MSM89XX_CDC_CORE_RX2_B5_CTL, 2, 1, 0),
  1615. SOC_SINGLE("RX3 HPF Switch",
  1616. MSM89XX_CDC_CORE_RX3_B5_CTL, 2, 1, 0),
  1617. SOC_ENUM("RX1 HPF cut off", cf_rxmix1_enum),
  1618. SOC_ENUM("RX2 HPF cut off", cf_rxmix2_enum),
  1619. SOC_ENUM("RX3 HPF cut off", cf_rxmix3_enum),
  1620. SOC_ENUM("TX1 HPF cut off", cf_dec1_enum),
  1621. SOC_ENUM("TX2 HPF cut off", cf_dec2_enum),
  1622. SOC_ENUM("TX3 HPF cut off", cf_dec3_enum),
  1623. SOC_ENUM("TX4 HPF cut off", cf_dec4_enum),
  1624. SOC_ENUM("TX5 HPF cut off", cf_decsva_enum),
  1625. SOC_SINGLE("TX1 HPF Switch",
  1626. MSM89XX_CDC_CORE_TX1_MUX_CTL, 3, 1, 0),
  1627. SOC_SINGLE("TX2 HPF Switch",
  1628. MSM89XX_CDC_CORE_TX2_MUX_CTL, 3, 1, 0),
  1629. SOC_SINGLE("TX3 HPF Switch",
  1630. MSM89XX_CDC_CORE_TX3_MUX_CTL, 3, 1, 0),
  1631. SOC_SINGLE("TX4 HPF Switch",
  1632. MSM89XX_CDC_CORE_TX4_MUX_CTL, 3, 1, 0),
  1633. SOC_SINGLE("TX5 HPF Switch",
  1634. MSM89XX_CDC_CORE_TX5_MUX_CTL, 3, 1, 0),
  1635. };
  1636. static int msm_dig_cdc_digital_mute(struct snd_soc_dai *dai, int mute)
  1637. {
  1638. struct snd_soc_codec *codec = NULL;
  1639. u16 tx_vol_ctl_reg = 0;
  1640. u8 decimator = 0, i;
  1641. struct msm_dig_priv *dig_cdc;
  1642. pr_debug("%s: Digital Mute val = %d\n", __func__, mute);
  1643. if (!dai || !dai->codec) {
  1644. pr_err("%s: Invalid params\n", __func__);
  1645. return -EINVAL;
  1646. }
  1647. codec = dai->codec;
  1648. dig_cdc = snd_soc_codec_get_drvdata(codec);
  1649. if (dai->id == AIF1_PB) {
  1650. dev_dbg(codec->dev, "%s: Not capture use case skip\n",
  1651. __func__);
  1652. return 0;
  1653. }
  1654. mute = (mute) ? 1 : 0;
  1655. if (!mute) {
  1656. /*
  1657. * 15 ms is an emperical value for the mute time
  1658. * that was arrived by checking the pop level
  1659. * to be inaudible
  1660. */
  1661. usleep_range(15000, 15010);
  1662. }
  1663. if (dai->id == AIF3_SVA) {
  1664. snd_soc_update_bits(codec,
  1665. MSM89XX_CDC_CORE_TX5_VOL_CTL_CFG, 0x01, mute);
  1666. goto ret;
  1667. }
  1668. for (i = 0; i < (NUM_DECIMATORS - 1); i++) {
  1669. if (dig_cdc->dec_active[i])
  1670. decimator = i + 1;
  1671. if (decimator && decimator < NUM_DECIMATORS) {
  1672. /* mute/unmute decimators corresponding to Tx DAI's */
  1673. tx_vol_ctl_reg =
  1674. MSM89XX_CDC_CORE_TX1_VOL_CTL_CFG +
  1675. 32 * (decimator - 1);
  1676. snd_soc_update_bits(codec, tx_vol_ctl_reg,
  1677. 0x01, mute);
  1678. }
  1679. decimator = 0;
  1680. }
  1681. ret:
  1682. return 0;
  1683. }
  1684. static struct snd_soc_dai_ops msm_dig_dai_ops = {
  1685. .hw_params = msm_dig_cdc_hw_params,
  1686. .digital_mute = msm_dig_cdc_digital_mute,
  1687. };
  1688. static struct snd_soc_dai_driver msm_codec_dais[] = {
  1689. {
  1690. .name = "msm_dig_cdc_dai_rx1",
  1691. .id = AIF1_PB,
  1692. .playback = { /* Support maximum range */
  1693. .stream_name = "AIF1 Playback",
  1694. .channels_min = 1,
  1695. .channels_max = 2,
  1696. .rates = SNDRV_PCM_RATE_8000_192000,
  1697. .rate_max = 192000,
  1698. .rate_min = 8000,
  1699. .formats = SNDRV_PCM_FMTBIT_S16_LE |
  1700. SNDRV_PCM_FMTBIT_S24_LE |
  1701. SNDRV_PCM_FMTBIT_S24_3LE,
  1702. },
  1703. .ops = &msm_dig_dai_ops,
  1704. },
  1705. {
  1706. .name = "msm_dig_cdc_dai_tx1",
  1707. .id = AIF1_CAP,
  1708. .capture = { /* Support maximum range */
  1709. .stream_name = "AIF1 Capture",
  1710. .channels_min = 1,
  1711. .channels_max = 4,
  1712. .rates = SNDRV_PCM_RATE_8000_48000,
  1713. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1714. },
  1715. .ops = &msm_dig_dai_ops,
  1716. },
  1717. {
  1718. .name = "msm_dig_cdc_dai_tx2",
  1719. .id = AIF3_SVA,
  1720. .capture = { /* Support maximum range */
  1721. .stream_name = "AIF2 Capture",
  1722. .channels_min = 1,
  1723. .channels_max = 2,
  1724. .rates = SNDRV_PCM_RATE_8000_48000,
  1725. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1726. },
  1727. .ops = &msm_dig_dai_ops,
  1728. },
  1729. {
  1730. .name = "msm_dig_cdc_dai_vifeed",
  1731. .id = AIF2_VIFEED,
  1732. .capture = { /* Support maximum range */
  1733. .stream_name = "AIF2 Capture",
  1734. .channels_min = 1,
  1735. .channels_max = 2,
  1736. .rates = SNDRV_PCM_RATE_8000_48000,
  1737. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  1738. },
  1739. .ops = &msm_dig_dai_ops,
  1740. },
  1741. };
  1742. static struct regmap *msm_digital_get_regmap(struct device *dev)
  1743. {
  1744. struct msm_dig_priv *msm_dig_cdc = dev_get_drvdata(dev);
  1745. return msm_dig_cdc->regmap;
  1746. }
  1747. static int msm_dig_cdc_suspend(struct snd_soc_codec *codec)
  1748. {
  1749. struct msm_dig_priv *msm_dig_cdc = dev_get_drvdata(codec->dev);
  1750. msm_dig_cdc->dapm_bias_off = 1;
  1751. return 0;
  1752. }
  1753. static int msm_dig_cdc_resume(struct snd_soc_codec *codec)
  1754. {
  1755. struct msm_dig_priv *msm_dig_cdc = dev_get_drvdata(codec->dev);
  1756. msm_dig_cdc->dapm_bias_off = 0;
  1757. return 0;
  1758. }
  1759. static struct snd_soc_codec_driver soc_msm_dig_codec = {
  1760. .probe = msm_dig_cdc_soc_probe,
  1761. .remove = msm_dig_cdc_soc_remove,
  1762. .suspend = msm_dig_cdc_suspend,
  1763. .resume = msm_dig_cdc_resume,
  1764. .get_regmap = msm_digital_get_regmap,
  1765. .component_driver = {
  1766. .controls = msm_dig_snd_controls,
  1767. .num_controls = ARRAY_SIZE(msm_dig_snd_controls),
  1768. .dapm_widgets = msm_dig_dapm_widgets,
  1769. .num_dapm_widgets = ARRAY_SIZE(msm_dig_dapm_widgets),
  1770. .dapm_routes = audio_dig_map,
  1771. .num_dapm_routes = ARRAY_SIZE(audio_dig_map),
  1772. },
  1773. };
  1774. const struct regmap_config msm_digital_regmap_config = {
  1775. .reg_bits = 32,
  1776. .reg_stride = 4,
  1777. .val_bits = 8,
  1778. .lock = enable_digital_callback,
  1779. .unlock = disable_digital_callback,
  1780. .cache_type = REGCACHE_FLAT,
  1781. .reg_defaults = msm89xx_cdc_core_defaults,
  1782. .num_reg_defaults = MSM89XX_CDC_CORE_MAX_REGISTER,
  1783. .writeable_reg = msm89xx_cdc_core_writeable_reg,
  1784. .readable_reg = msm89xx_cdc_core_readable_reg,
  1785. .volatile_reg = msm89xx_cdc_core_volatile_reg,
  1786. .reg_format_endian = REGMAP_ENDIAN_NATIVE,
  1787. .val_format_endian = REGMAP_ENDIAN_NATIVE,
  1788. .max_register = MSM89XX_CDC_CORE_MAX_REGISTER,
  1789. };
  1790. static int msm_dig_cdc_probe(struct platform_device *pdev)
  1791. {
  1792. int ret;
  1793. u32 dig_cdc_addr;
  1794. struct msm_dig_priv *msm_dig_cdc;
  1795. struct dig_ctrl_platform_data *pdata;
  1796. msm_dig_cdc = devm_kzalloc(&pdev->dev, sizeof(struct msm_dig_priv),
  1797. GFP_KERNEL);
  1798. if (!msm_dig_cdc)
  1799. return -ENOMEM;
  1800. pdata = dev_get_platdata(&pdev->dev);
  1801. if (!pdata) {
  1802. dev_err(&pdev->dev, "%s: pdata from parent is NULL\n",
  1803. __func__);
  1804. ret = -EINVAL;
  1805. goto rtn;
  1806. }
  1807. ret = of_property_read_u32(pdev->dev.of_node, "reg",
  1808. &dig_cdc_addr);
  1809. if (ret) {
  1810. dev_err(&pdev->dev, "%s: could not find %s entry in dt\n",
  1811. __func__, "reg");
  1812. return ret;
  1813. }
  1814. msm_dig_cdc->dig_base = ioremap(dig_cdc_addr,
  1815. MSM89XX_CDC_CORE_MAX_REGISTER);
  1816. if (msm_dig_cdc->dig_base == NULL) {
  1817. dev_err(&pdev->dev, "%s ioremap failed\n", __func__);
  1818. return -ENOMEM;
  1819. }
  1820. msm_dig_cdc->regmap =
  1821. devm_regmap_init_mmio_clk(&pdev->dev, NULL,
  1822. msm_dig_cdc->dig_base, &msm_digital_regmap_config);
  1823. msm_dig_cdc->update_clkdiv = pdata->update_clkdiv;
  1824. msm_dig_cdc->get_cdc_version = pdata->get_cdc_version;
  1825. msm_dig_cdc->handle = pdata->handle;
  1826. msm_dig_cdc->register_notifier = pdata->register_notifier;
  1827. dev_set_drvdata(&pdev->dev, msm_dig_cdc);
  1828. snd_soc_register_codec(&pdev->dev, &soc_msm_dig_codec,
  1829. msm_codec_dais, ARRAY_SIZE(msm_codec_dais));
  1830. dev_dbg(&pdev->dev, "%s: registered DIG CODEC 0x%x\n",
  1831. __func__, dig_cdc_addr);
  1832. rtn:
  1833. return ret;
  1834. }
  1835. static int msm_dig_cdc_remove(struct platform_device *pdev)
  1836. {
  1837. snd_soc_unregister_codec(&pdev->dev);
  1838. return 0;
  1839. }
  1840. #ifdef CONFIG_PM
  1841. static int msm_dig_suspend(struct device *dev)
  1842. {
  1843. struct msm_asoc_mach_data *pdata;
  1844. struct msm_dig_priv *msm_dig_cdc = dev_get_drvdata(dev);
  1845. if (!registered_digcodec || !msm_dig_cdc) {
  1846. pr_debug("%s:digcodec not initialized, return\n", __func__);
  1847. return 0;
  1848. }
  1849. pdata = snd_soc_card_get_drvdata(registered_digcodec->component.card);
  1850. if (!pdata) {
  1851. pr_debug("%s:card not initialized, return\n", __func__);
  1852. return 0;
  1853. }
  1854. if (msm_dig_cdc->dapm_bias_off) {
  1855. pr_debug("%s: mclk cnt = %d, mclk_enabled = %d\n",
  1856. __func__, atomic_read(&pdata->int_mclk0_rsc_ref),
  1857. atomic_read(&pdata->int_mclk0_enabled));
  1858. if (atomic_read(&pdata->int_mclk0_enabled) == true) {
  1859. cancel_delayed_work_sync(
  1860. &pdata->disable_int_mclk0_work);
  1861. mutex_lock(&pdata->cdc_int_mclk0_mutex);
  1862. pdata->digital_cdc_core_clk.enable = 0;
  1863. afe_set_lpass_clock_v2(AFE_PORT_ID_INT0_MI2S_RX,
  1864. &pdata->digital_cdc_core_clk);
  1865. atomic_set(&pdata->int_mclk0_enabled, false);
  1866. mutex_unlock(&pdata->cdc_int_mclk0_mutex);
  1867. }
  1868. }
  1869. return 0;
  1870. }
  1871. static int msm_dig_resume(struct device *dev)
  1872. {
  1873. return 0;
  1874. }
  1875. static const struct dev_pm_ops msm_dig_pm_ops = {
  1876. .suspend_late = msm_dig_suspend,
  1877. .resume_early = msm_dig_resume,
  1878. };
  1879. #endif
  1880. static const struct of_device_id msm_dig_cdc_of_match[] = {
  1881. {.compatible = "qcom,msm-digital-codec"},
  1882. {},
  1883. };
  1884. static struct platform_driver msm_digcodec_driver = {
  1885. .driver = {
  1886. .owner = THIS_MODULE,
  1887. .name = DRV_NAME,
  1888. .of_match_table = msm_dig_cdc_of_match,
  1889. #ifdef CONFIG_PM
  1890. .pm = &msm_dig_pm_ops,
  1891. #endif
  1892. },
  1893. .probe = msm_dig_cdc_probe,
  1894. .remove = msm_dig_cdc_remove,
  1895. };
  1896. module_platform_driver(msm_digcodec_driver);
  1897. MODULE_DESCRIPTION("MSM Audio Digital codec driver");
  1898. MODULE_LICENSE("GPL v2");