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