msm-digital-cdc.c 65 KB

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