mt8173-afe-pcm.c 32 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Mediatek 8173 ALSA SoC AFE platform driver
  4. *
  5. * Copyright (c) 2015 MediaTek Inc.
  6. * Author: Koro Chen <[email protected]>
  7. * Sascha Hauer <[email protected]>
  8. * Hidalgo Huang <[email protected]>
  9. * Ir Lian <[email protected]>
  10. */
  11. #include <linux/delay.h>
  12. #include <linux/module.h>
  13. #include <linux/of.h>
  14. #include <linux/of_address.h>
  15. #include <linux/dma-mapping.h>
  16. #include <linux/pm_runtime.h>
  17. #include <sound/soc.h>
  18. #include "mt8173-afe-common.h"
  19. #include "../common/mtk-base-afe.h"
  20. #include "../common/mtk-afe-platform-driver.h"
  21. #include "../common/mtk-afe-fe-dai.h"
  22. /*****************************************************************************
  23. * R E G I S T E R D E F I N I T I O N
  24. *****************************************************************************/
  25. #define AUDIO_TOP_CON0 0x0000
  26. #define AUDIO_TOP_CON1 0x0004
  27. #define AFE_DAC_CON0 0x0010
  28. #define AFE_DAC_CON1 0x0014
  29. #define AFE_I2S_CON1 0x0034
  30. #define AFE_I2S_CON2 0x0038
  31. #define AFE_CONN_24BIT 0x006c
  32. #define AFE_MEMIF_MSB 0x00cc
  33. #define AFE_CONN1 0x0024
  34. #define AFE_CONN2 0x0028
  35. #define AFE_CONN3 0x002c
  36. #define AFE_CONN7 0x0460
  37. #define AFE_CONN8 0x0464
  38. #define AFE_HDMI_CONN0 0x0390
  39. /* Memory interface */
  40. #define AFE_DL1_BASE 0x0040
  41. #define AFE_DL1_CUR 0x0044
  42. #define AFE_DL1_END 0x0048
  43. #define AFE_DL2_BASE 0x0050
  44. #define AFE_DL2_CUR 0x0054
  45. #define AFE_AWB_BASE 0x0070
  46. #define AFE_AWB_CUR 0x007c
  47. #define AFE_VUL_BASE 0x0080
  48. #define AFE_VUL_CUR 0x008c
  49. #define AFE_VUL_END 0x0088
  50. #define AFE_DAI_BASE 0x0090
  51. #define AFE_DAI_CUR 0x009c
  52. #define AFE_MOD_PCM_BASE 0x0330
  53. #define AFE_MOD_PCM_CUR 0x033c
  54. #define AFE_HDMI_OUT_BASE 0x0374
  55. #define AFE_HDMI_OUT_CUR 0x0378
  56. #define AFE_HDMI_OUT_END 0x037c
  57. #define AFE_ADDA_TOP_CON0 0x0120
  58. #define AFE_ADDA2_TOP_CON0 0x0600
  59. #define AFE_HDMI_OUT_CON0 0x0370
  60. #define AFE_IRQ_MCU_CON 0x03a0
  61. #define AFE_IRQ_STATUS 0x03a4
  62. #define AFE_IRQ_CLR 0x03a8
  63. #define AFE_IRQ_CNT1 0x03ac
  64. #define AFE_IRQ_CNT2 0x03b0
  65. #define AFE_IRQ_MCU_EN 0x03b4
  66. #define AFE_IRQ_CNT5 0x03bc
  67. #define AFE_IRQ_CNT7 0x03dc
  68. #define AFE_TDM_CON1 0x0548
  69. #define AFE_TDM_CON2 0x054c
  70. #define AFE_IRQ_STATUS_BITS 0xff
  71. /* AUDIO_TOP_CON0 (0x0000) */
  72. #define AUD_TCON0_PDN_SPDF (0x1 << 21)
  73. #define AUD_TCON0_PDN_HDMI (0x1 << 20)
  74. #define AUD_TCON0_PDN_24M (0x1 << 9)
  75. #define AUD_TCON0_PDN_22M (0x1 << 8)
  76. #define AUD_TCON0_PDN_AFE (0x1 << 2)
  77. /* AFE_I2S_CON1 (0x0034) */
  78. #define AFE_I2S_CON1_LOW_JITTER_CLK (0x1 << 12)
  79. #define AFE_I2S_CON1_RATE(x) (((x) & 0xf) << 8)
  80. #define AFE_I2S_CON1_FORMAT_I2S (0x1 << 3)
  81. #define AFE_I2S_CON1_EN (0x1 << 0)
  82. /* AFE_I2S_CON2 (0x0038) */
  83. #define AFE_I2S_CON2_LOW_JITTER_CLK (0x1 << 12)
  84. #define AFE_I2S_CON2_RATE(x) (((x) & 0xf) << 8)
  85. #define AFE_I2S_CON2_FORMAT_I2S (0x1 << 3)
  86. #define AFE_I2S_CON2_EN (0x1 << 0)
  87. /* AFE_CONN_24BIT (0x006c) */
  88. #define AFE_CONN_24BIT_O04 (0x1 << 4)
  89. #define AFE_CONN_24BIT_O03 (0x1 << 3)
  90. /* AFE_HDMI_CONN0 (0x0390) */
  91. #define AFE_HDMI_CONN0_O37_I37 (0x7 << 21)
  92. #define AFE_HDMI_CONN0_O36_I36 (0x6 << 18)
  93. #define AFE_HDMI_CONN0_O35_I33 (0x3 << 15)
  94. #define AFE_HDMI_CONN0_O34_I32 (0x2 << 12)
  95. #define AFE_HDMI_CONN0_O33_I35 (0x5 << 9)
  96. #define AFE_HDMI_CONN0_O32_I34 (0x4 << 6)
  97. #define AFE_HDMI_CONN0_O31_I31 (0x1 << 3)
  98. #define AFE_HDMI_CONN0_O30_I30 (0x0 << 0)
  99. /* AFE_TDM_CON1 (0x0548) */
  100. #define AFE_TDM_CON1_LRCK_WIDTH(x) (((x) - 1) << 24)
  101. #define AFE_TDM_CON1_32_BCK_CYCLES (0x2 << 12)
  102. #define AFE_TDM_CON1_WLEN_32BIT (0x2 << 8)
  103. #define AFE_TDM_CON1_MSB_ALIGNED (0x1 << 4)
  104. #define AFE_TDM_CON1_1_BCK_DELAY (0x1 << 3)
  105. #define AFE_TDM_CON1_LRCK_INV (0x1 << 2)
  106. #define AFE_TDM_CON1_BCK_INV (0x1 << 1)
  107. #define AFE_TDM_CON1_EN (0x1 << 0)
  108. enum afe_tdm_ch_start {
  109. AFE_TDM_CH_START_O30_O31 = 0,
  110. AFE_TDM_CH_START_O32_O33,
  111. AFE_TDM_CH_START_O34_O35,
  112. AFE_TDM_CH_START_O36_O37,
  113. AFE_TDM_CH_ZERO,
  114. };
  115. static const unsigned int mt8173_afe_backup_list[] = {
  116. AUDIO_TOP_CON0,
  117. AFE_CONN1,
  118. AFE_CONN2,
  119. AFE_CONN7,
  120. AFE_CONN8,
  121. AFE_DAC_CON1,
  122. AFE_DL1_BASE,
  123. AFE_DL1_END,
  124. AFE_VUL_BASE,
  125. AFE_VUL_END,
  126. AFE_HDMI_OUT_BASE,
  127. AFE_HDMI_OUT_END,
  128. AFE_HDMI_CONN0,
  129. AFE_DAC_CON0,
  130. };
  131. struct mt8173_afe_private {
  132. struct clk *clocks[MT8173_CLK_NUM];
  133. };
  134. static const struct snd_pcm_hardware mt8173_afe_hardware = {
  135. .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
  136. SNDRV_PCM_INFO_MMAP_VALID),
  137. .buffer_bytes_max = 256 * 1024,
  138. .period_bytes_min = 512,
  139. .period_bytes_max = 128 * 1024,
  140. .periods_min = 2,
  141. .periods_max = 256,
  142. .fifo_size = 0,
  143. };
  144. struct mt8173_afe_rate {
  145. unsigned int rate;
  146. unsigned int regvalue;
  147. };
  148. static const struct mt8173_afe_rate mt8173_afe_i2s_rates[] = {
  149. { .rate = 8000, .regvalue = 0 },
  150. { .rate = 11025, .regvalue = 1 },
  151. { .rate = 12000, .regvalue = 2 },
  152. { .rate = 16000, .regvalue = 4 },
  153. { .rate = 22050, .regvalue = 5 },
  154. { .rate = 24000, .regvalue = 6 },
  155. { .rate = 32000, .regvalue = 8 },
  156. { .rate = 44100, .regvalue = 9 },
  157. { .rate = 48000, .regvalue = 10 },
  158. { .rate = 88000, .regvalue = 11 },
  159. { .rate = 96000, .regvalue = 12 },
  160. { .rate = 174000, .regvalue = 13 },
  161. { .rate = 192000, .regvalue = 14 },
  162. };
  163. static int mt8173_afe_i2s_fs(unsigned int sample_rate)
  164. {
  165. int i;
  166. for (i = 0; i < ARRAY_SIZE(mt8173_afe_i2s_rates); i++)
  167. if (mt8173_afe_i2s_rates[i].rate == sample_rate)
  168. return mt8173_afe_i2s_rates[i].regvalue;
  169. return -EINVAL;
  170. }
  171. static int mt8173_afe_set_i2s(struct mtk_base_afe *afe, unsigned int rate)
  172. {
  173. unsigned int val;
  174. int fs = mt8173_afe_i2s_fs(rate);
  175. if (fs < 0)
  176. return -EINVAL;
  177. /* from external ADC */
  178. regmap_update_bits(afe->regmap, AFE_ADDA_TOP_CON0, 0x1, 0x1);
  179. regmap_update_bits(afe->regmap, AFE_ADDA2_TOP_CON0, 0x1, 0x1);
  180. /* set input */
  181. val = AFE_I2S_CON2_LOW_JITTER_CLK |
  182. AFE_I2S_CON2_RATE(fs) |
  183. AFE_I2S_CON2_FORMAT_I2S;
  184. regmap_update_bits(afe->regmap, AFE_I2S_CON2, ~AFE_I2S_CON2_EN, val);
  185. /* set output */
  186. val = AFE_I2S_CON1_LOW_JITTER_CLK |
  187. AFE_I2S_CON1_RATE(fs) |
  188. AFE_I2S_CON1_FORMAT_I2S;
  189. regmap_update_bits(afe->regmap, AFE_I2S_CON1, ~AFE_I2S_CON1_EN, val);
  190. return 0;
  191. }
  192. static void mt8173_afe_set_i2s_enable(struct mtk_base_afe *afe, bool enable)
  193. {
  194. unsigned int val;
  195. regmap_read(afe->regmap, AFE_I2S_CON2, &val);
  196. if (!!(val & AFE_I2S_CON2_EN) == enable)
  197. return;
  198. /* input */
  199. regmap_update_bits(afe->regmap, AFE_I2S_CON2, 0x1, enable);
  200. /* output */
  201. regmap_update_bits(afe->regmap, AFE_I2S_CON1, 0x1, enable);
  202. }
  203. static int mt8173_afe_dais_enable_clks(struct mtk_base_afe *afe,
  204. struct clk *m_ck, struct clk *b_ck)
  205. {
  206. int ret;
  207. if (m_ck) {
  208. ret = clk_prepare_enable(m_ck);
  209. if (ret) {
  210. dev_err(afe->dev, "Failed to enable m_ck\n");
  211. return ret;
  212. }
  213. }
  214. if (b_ck) {
  215. ret = clk_prepare_enable(b_ck);
  216. if (ret) {
  217. dev_err(afe->dev, "Failed to enable b_ck\n");
  218. return ret;
  219. }
  220. }
  221. return 0;
  222. }
  223. static int mt8173_afe_dais_set_clks(struct mtk_base_afe *afe,
  224. struct clk *m_ck, unsigned int mck_rate,
  225. struct clk *b_ck, unsigned int bck_rate)
  226. {
  227. int ret;
  228. if (m_ck) {
  229. ret = clk_set_rate(m_ck, mck_rate);
  230. if (ret) {
  231. dev_err(afe->dev, "Failed to set m_ck rate\n");
  232. return ret;
  233. }
  234. }
  235. if (b_ck) {
  236. ret = clk_set_rate(b_ck, bck_rate);
  237. if (ret) {
  238. dev_err(afe->dev, "Failed to set b_ck rate\n");
  239. return ret;
  240. }
  241. }
  242. return 0;
  243. }
  244. static void mt8173_afe_dais_disable_clks(struct mtk_base_afe *afe,
  245. struct clk *m_ck, struct clk *b_ck)
  246. {
  247. clk_disable_unprepare(m_ck);
  248. clk_disable_unprepare(b_ck);
  249. }
  250. static int mt8173_afe_i2s_startup(struct snd_pcm_substream *substream,
  251. struct snd_soc_dai *dai)
  252. {
  253. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  254. if (snd_soc_dai_active(dai))
  255. return 0;
  256. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  257. AUD_TCON0_PDN_22M | AUD_TCON0_PDN_24M, 0);
  258. return 0;
  259. }
  260. static void mt8173_afe_i2s_shutdown(struct snd_pcm_substream *substream,
  261. struct snd_soc_dai *dai)
  262. {
  263. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  264. if (snd_soc_dai_active(dai))
  265. return;
  266. mt8173_afe_set_i2s_enable(afe, false);
  267. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  268. AUD_TCON0_PDN_22M | AUD_TCON0_PDN_24M,
  269. AUD_TCON0_PDN_22M | AUD_TCON0_PDN_24M);
  270. }
  271. static int mt8173_afe_i2s_prepare(struct snd_pcm_substream *substream,
  272. struct snd_soc_dai *dai)
  273. {
  274. struct snd_pcm_runtime * const runtime = substream->runtime;
  275. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  276. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  277. int ret;
  278. mt8173_afe_dais_set_clks(afe, afe_priv->clocks[MT8173_CLK_I2S1_M],
  279. runtime->rate * 256, NULL, 0);
  280. mt8173_afe_dais_set_clks(afe, afe_priv->clocks[MT8173_CLK_I2S2_M],
  281. runtime->rate * 256, NULL, 0);
  282. /* config I2S */
  283. ret = mt8173_afe_set_i2s(afe, substream->runtime->rate);
  284. if (ret)
  285. return ret;
  286. mt8173_afe_set_i2s_enable(afe, true);
  287. return 0;
  288. }
  289. static int mt8173_afe_hdmi_startup(struct snd_pcm_substream *substream,
  290. struct snd_soc_dai *dai)
  291. {
  292. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  293. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  294. if (snd_soc_dai_active(dai))
  295. return 0;
  296. mt8173_afe_dais_enable_clks(afe, afe_priv->clocks[MT8173_CLK_I2S3_M],
  297. afe_priv->clocks[MT8173_CLK_I2S3_B]);
  298. return 0;
  299. }
  300. static void mt8173_afe_hdmi_shutdown(struct snd_pcm_substream *substream,
  301. struct snd_soc_dai *dai)
  302. {
  303. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  304. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  305. if (snd_soc_dai_active(dai))
  306. return;
  307. mt8173_afe_dais_disable_clks(afe, afe_priv->clocks[MT8173_CLK_I2S3_M],
  308. afe_priv->clocks[MT8173_CLK_I2S3_B]);
  309. }
  310. static int mt8173_afe_hdmi_prepare(struct snd_pcm_substream *substream,
  311. struct snd_soc_dai *dai)
  312. {
  313. struct snd_pcm_runtime * const runtime = substream->runtime;
  314. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  315. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  316. unsigned int val;
  317. mt8173_afe_dais_set_clks(afe, afe_priv->clocks[MT8173_CLK_I2S3_M],
  318. runtime->rate * 128,
  319. afe_priv->clocks[MT8173_CLK_I2S3_B],
  320. runtime->rate * runtime->channels * 32);
  321. val = AFE_TDM_CON1_BCK_INV |
  322. AFE_TDM_CON1_LRCK_INV |
  323. AFE_TDM_CON1_1_BCK_DELAY |
  324. AFE_TDM_CON1_MSB_ALIGNED | /* I2S mode */
  325. AFE_TDM_CON1_WLEN_32BIT |
  326. AFE_TDM_CON1_32_BCK_CYCLES |
  327. AFE_TDM_CON1_LRCK_WIDTH(32);
  328. regmap_update_bits(afe->regmap, AFE_TDM_CON1, ~AFE_TDM_CON1_EN, val);
  329. /* set tdm2 config */
  330. switch (runtime->channels) {
  331. case 1:
  332. case 2:
  333. val = AFE_TDM_CH_START_O30_O31;
  334. val |= (AFE_TDM_CH_ZERO << 4);
  335. val |= (AFE_TDM_CH_ZERO << 8);
  336. val |= (AFE_TDM_CH_ZERO << 12);
  337. break;
  338. case 3:
  339. case 4:
  340. val = AFE_TDM_CH_START_O30_O31;
  341. val |= (AFE_TDM_CH_START_O32_O33 << 4);
  342. val |= (AFE_TDM_CH_ZERO << 8);
  343. val |= (AFE_TDM_CH_ZERO << 12);
  344. break;
  345. case 5:
  346. case 6:
  347. val = AFE_TDM_CH_START_O30_O31;
  348. val |= (AFE_TDM_CH_START_O32_O33 << 4);
  349. val |= (AFE_TDM_CH_START_O34_O35 << 8);
  350. val |= (AFE_TDM_CH_ZERO << 12);
  351. break;
  352. case 7:
  353. case 8:
  354. val = AFE_TDM_CH_START_O30_O31;
  355. val |= (AFE_TDM_CH_START_O32_O33 << 4);
  356. val |= (AFE_TDM_CH_START_O34_O35 << 8);
  357. val |= (AFE_TDM_CH_START_O36_O37 << 12);
  358. break;
  359. default:
  360. val = 0;
  361. }
  362. regmap_update_bits(afe->regmap, AFE_TDM_CON2, 0x0000ffff, val);
  363. regmap_update_bits(afe->regmap, AFE_HDMI_OUT_CON0,
  364. 0x000000f0, runtime->channels << 4);
  365. return 0;
  366. }
  367. static int mt8173_afe_hdmi_trigger(struct snd_pcm_substream *substream, int cmd,
  368. struct snd_soc_dai *dai)
  369. {
  370. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  371. dev_info(afe->dev, "%s cmd=%d %s\n", __func__, cmd, dai->name);
  372. switch (cmd) {
  373. case SNDRV_PCM_TRIGGER_START:
  374. case SNDRV_PCM_TRIGGER_RESUME:
  375. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  376. AUD_TCON0_PDN_HDMI | AUD_TCON0_PDN_SPDF, 0);
  377. /* set connections: O30~O37: L/R/LS/RS/C/LFE/CH7/CH8 */
  378. regmap_write(afe->regmap, AFE_HDMI_CONN0,
  379. AFE_HDMI_CONN0_O30_I30 |
  380. AFE_HDMI_CONN0_O31_I31 |
  381. AFE_HDMI_CONN0_O32_I34 |
  382. AFE_HDMI_CONN0_O33_I35 |
  383. AFE_HDMI_CONN0_O34_I32 |
  384. AFE_HDMI_CONN0_O35_I33 |
  385. AFE_HDMI_CONN0_O36_I36 |
  386. AFE_HDMI_CONN0_O37_I37);
  387. /* enable Out control */
  388. regmap_update_bits(afe->regmap, AFE_HDMI_OUT_CON0, 0x1, 0x1);
  389. /* enable tdm */
  390. regmap_update_bits(afe->regmap, AFE_TDM_CON1, 0x1, 0x1);
  391. return 0;
  392. case SNDRV_PCM_TRIGGER_STOP:
  393. case SNDRV_PCM_TRIGGER_SUSPEND:
  394. /* disable tdm */
  395. regmap_update_bits(afe->regmap, AFE_TDM_CON1, 0x1, 0);
  396. /* disable Out control */
  397. regmap_update_bits(afe->regmap, AFE_HDMI_OUT_CON0, 0x1, 0);
  398. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  399. AUD_TCON0_PDN_HDMI | AUD_TCON0_PDN_SPDF,
  400. AUD_TCON0_PDN_HDMI | AUD_TCON0_PDN_SPDF);
  401. return 0;
  402. default:
  403. return -EINVAL;
  404. }
  405. }
  406. static int mt8173_memif_fs(struct snd_pcm_substream *substream,
  407. unsigned int rate)
  408. {
  409. struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
  410. struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, AFE_PCM_NAME);
  411. struct mtk_base_afe *afe = snd_soc_component_get_drvdata(component);
  412. struct mtk_base_afe_memif *memif = &afe->memif[asoc_rtd_to_cpu(rtd, 0)->id];
  413. int fs;
  414. if (memif->data->id == MT8173_AFE_MEMIF_DAI ||
  415. memif->data->id == MT8173_AFE_MEMIF_MOD_DAI) {
  416. switch (rate) {
  417. case 8000:
  418. fs = 0;
  419. break;
  420. case 16000:
  421. fs = 1;
  422. break;
  423. case 32000:
  424. fs = 2;
  425. break;
  426. default:
  427. return -EINVAL;
  428. }
  429. } else {
  430. fs = mt8173_afe_i2s_fs(rate);
  431. }
  432. return fs;
  433. }
  434. static int mt8173_irq_fs(struct snd_pcm_substream *substream, unsigned int rate)
  435. {
  436. return mt8173_afe_i2s_fs(rate);
  437. }
  438. /* BE DAIs */
  439. static const struct snd_soc_dai_ops mt8173_afe_i2s_ops = {
  440. .startup = mt8173_afe_i2s_startup,
  441. .shutdown = mt8173_afe_i2s_shutdown,
  442. .prepare = mt8173_afe_i2s_prepare,
  443. };
  444. static const struct snd_soc_dai_ops mt8173_afe_hdmi_ops = {
  445. .startup = mt8173_afe_hdmi_startup,
  446. .shutdown = mt8173_afe_hdmi_shutdown,
  447. .prepare = mt8173_afe_hdmi_prepare,
  448. .trigger = mt8173_afe_hdmi_trigger,
  449. };
  450. static struct snd_soc_dai_driver mt8173_afe_pcm_dais[] = {
  451. /* FE DAIs: memory intefaces to CPU */
  452. {
  453. .name = "DL1", /* downlink 1 */
  454. .id = MT8173_AFE_MEMIF_DL1,
  455. .playback = {
  456. .stream_name = "DL1",
  457. .channels_min = 1,
  458. .channels_max = 2,
  459. .rates = SNDRV_PCM_RATE_8000_48000,
  460. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  461. },
  462. .ops = &mtk_afe_fe_ops,
  463. }, {
  464. .name = "VUL", /* voice uplink */
  465. .id = MT8173_AFE_MEMIF_VUL,
  466. .capture = {
  467. .stream_name = "VUL",
  468. .channels_min = 1,
  469. .channels_max = 2,
  470. .rates = SNDRV_PCM_RATE_8000_48000,
  471. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  472. },
  473. .ops = &mtk_afe_fe_ops,
  474. }, {
  475. /* BE DAIs */
  476. .name = "I2S",
  477. .id = MT8173_AFE_IO_I2S,
  478. .playback = {
  479. .stream_name = "I2S Playback",
  480. .channels_min = 1,
  481. .channels_max = 2,
  482. .rates = SNDRV_PCM_RATE_8000_48000,
  483. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  484. },
  485. .capture = {
  486. .stream_name = "I2S Capture",
  487. .channels_min = 1,
  488. .channels_max = 2,
  489. .rates = SNDRV_PCM_RATE_8000_48000,
  490. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  491. },
  492. .ops = &mt8173_afe_i2s_ops,
  493. .symmetric_rate = 1,
  494. },
  495. };
  496. static struct snd_soc_dai_driver mt8173_afe_hdmi_dais[] = {
  497. /* FE DAIs */
  498. {
  499. .name = "HDMI",
  500. .id = MT8173_AFE_MEMIF_HDMI,
  501. .playback = {
  502. .stream_name = "HDMI",
  503. .channels_min = 2,
  504. .channels_max = 8,
  505. .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  506. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  507. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  508. SNDRV_PCM_RATE_192000,
  509. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  510. },
  511. .ops = &mtk_afe_fe_ops,
  512. }, {
  513. /* BE DAIs */
  514. .name = "HDMIO",
  515. .id = MT8173_AFE_IO_HDMI,
  516. .playback = {
  517. .stream_name = "HDMIO Playback",
  518. .channels_min = 2,
  519. .channels_max = 8,
  520. .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  521. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  522. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  523. SNDRV_PCM_RATE_192000,
  524. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  525. },
  526. .ops = &mt8173_afe_hdmi_ops,
  527. },
  528. };
  529. static const struct snd_kcontrol_new mt8173_afe_o03_mix[] = {
  530. SOC_DAPM_SINGLE_AUTODISABLE("I05 Switch", AFE_CONN1, 21, 1, 0),
  531. };
  532. static const struct snd_kcontrol_new mt8173_afe_o04_mix[] = {
  533. SOC_DAPM_SINGLE_AUTODISABLE("I06 Switch", AFE_CONN2, 6, 1, 0),
  534. };
  535. static const struct snd_kcontrol_new mt8173_afe_o09_mix[] = {
  536. SOC_DAPM_SINGLE_AUTODISABLE("I03 Switch", AFE_CONN3, 0, 1, 0),
  537. SOC_DAPM_SINGLE_AUTODISABLE("I17 Switch", AFE_CONN7, 30, 1, 0),
  538. };
  539. static const struct snd_kcontrol_new mt8173_afe_o10_mix[] = {
  540. SOC_DAPM_SINGLE_AUTODISABLE("I04 Switch", AFE_CONN3, 3, 1, 0),
  541. SOC_DAPM_SINGLE_AUTODISABLE("I18 Switch", AFE_CONN8, 0, 1, 0),
  542. };
  543. static const struct snd_soc_dapm_widget mt8173_afe_pcm_widgets[] = {
  544. /* inter-connections */
  545. SND_SOC_DAPM_MIXER("I03", SND_SOC_NOPM, 0, 0, NULL, 0),
  546. SND_SOC_DAPM_MIXER("I04", SND_SOC_NOPM, 0, 0, NULL, 0),
  547. SND_SOC_DAPM_MIXER("I05", SND_SOC_NOPM, 0, 0, NULL, 0),
  548. SND_SOC_DAPM_MIXER("I06", SND_SOC_NOPM, 0, 0, NULL, 0),
  549. SND_SOC_DAPM_MIXER("I17", SND_SOC_NOPM, 0, 0, NULL, 0),
  550. SND_SOC_DAPM_MIXER("I18", SND_SOC_NOPM, 0, 0, NULL, 0),
  551. SND_SOC_DAPM_MIXER("O03", SND_SOC_NOPM, 0, 0,
  552. mt8173_afe_o03_mix, ARRAY_SIZE(mt8173_afe_o03_mix)),
  553. SND_SOC_DAPM_MIXER("O04", SND_SOC_NOPM, 0, 0,
  554. mt8173_afe_o04_mix, ARRAY_SIZE(mt8173_afe_o04_mix)),
  555. SND_SOC_DAPM_MIXER("O09", SND_SOC_NOPM, 0, 0,
  556. mt8173_afe_o09_mix, ARRAY_SIZE(mt8173_afe_o09_mix)),
  557. SND_SOC_DAPM_MIXER("O10", SND_SOC_NOPM, 0, 0,
  558. mt8173_afe_o10_mix, ARRAY_SIZE(mt8173_afe_o10_mix)),
  559. };
  560. static const struct snd_soc_dapm_route mt8173_afe_pcm_routes[] = {
  561. {"I05", NULL, "DL1"},
  562. {"I06", NULL, "DL1"},
  563. {"I2S Playback", NULL, "O03"},
  564. {"I2S Playback", NULL, "O04"},
  565. {"VUL", NULL, "O09"},
  566. {"VUL", NULL, "O10"},
  567. {"I03", NULL, "I2S Capture"},
  568. {"I04", NULL, "I2S Capture"},
  569. {"I17", NULL, "I2S Capture"},
  570. {"I18", NULL, "I2S Capture"},
  571. { "O03", "I05 Switch", "I05" },
  572. { "O04", "I06 Switch", "I06" },
  573. { "O09", "I17 Switch", "I17" },
  574. { "O09", "I03 Switch", "I03" },
  575. { "O10", "I18 Switch", "I18" },
  576. { "O10", "I04 Switch", "I04" },
  577. };
  578. static const struct snd_soc_dapm_route mt8173_afe_hdmi_routes[] = {
  579. {"HDMIO Playback", NULL, "HDMI"},
  580. };
  581. static const struct snd_soc_component_driver mt8173_afe_pcm_dai_component = {
  582. .name = "mt8173-afe-pcm-dai",
  583. .dapm_widgets = mt8173_afe_pcm_widgets,
  584. .num_dapm_widgets = ARRAY_SIZE(mt8173_afe_pcm_widgets),
  585. .dapm_routes = mt8173_afe_pcm_routes,
  586. .num_dapm_routes = ARRAY_SIZE(mt8173_afe_pcm_routes),
  587. .suspend = mtk_afe_suspend,
  588. .resume = mtk_afe_resume,
  589. };
  590. static const struct snd_soc_component_driver mt8173_afe_hdmi_dai_component = {
  591. .name = "mt8173-afe-hdmi-dai",
  592. .dapm_routes = mt8173_afe_hdmi_routes,
  593. .num_dapm_routes = ARRAY_SIZE(mt8173_afe_hdmi_routes),
  594. .suspend = mtk_afe_suspend,
  595. .resume = mtk_afe_resume,
  596. };
  597. static const char *aud_clks[MT8173_CLK_NUM] = {
  598. [MT8173_CLK_INFRASYS_AUD] = "infra_sys_audio_clk",
  599. [MT8173_CLK_TOP_PDN_AUD] = "top_pdn_audio",
  600. [MT8173_CLK_TOP_PDN_AUD_BUS] = "top_pdn_aud_intbus",
  601. [MT8173_CLK_I2S0_M] = "i2s0_m",
  602. [MT8173_CLK_I2S1_M] = "i2s1_m",
  603. [MT8173_CLK_I2S2_M] = "i2s2_m",
  604. [MT8173_CLK_I2S3_M] = "i2s3_m",
  605. [MT8173_CLK_I2S3_B] = "i2s3_b",
  606. [MT8173_CLK_BCK0] = "bck0",
  607. [MT8173_CLK_BCK1] = "bck1",
  608. };
  609. static const struct mtk_base_memif_data memif_data[MT8173_AFE_MEMIF_NUM] = {
  610. {
  611. .name = "DL1",
  612. .id = MT8173_AFE_MEMIF_DL1,
  613. .reg_ofs_base = AFE_DL1_BASE,
  614. .reg_ofs_cur = AFE_DL1_CUR,
  615. .fs_reg = AFE_DAC_CON1,
  616. .fs_shift = 0,
  617. .fs_maskbit = 0xf,
  618. .mono_reg = AFE_DAC_CON1,
  619. .mono_shift = 21,
  620. .hd_reg = -1,
  621. .enable_reg = AFE_DAC_CON0,
  622. .enable_shift = 1,
  623. .msb_reg = AFE_MEMIF_MSB,
  624. .msb_shift = 0,
  625. .agent_disable_reg = -1,
  626. }, {
  627. .name = "DL2",
  628. .id = MT8173_AFE_MEMIF_DL2,
  629. .reg_ofs_base = AFE_DL2_BASE,
  630. .reg_ofs_cur = AFE_DL2_CUR,
  631. .fs_reg = AFE_DAC_CON1,
  632. .fs_shift = 4,
  633. .fs_maskbit = 0xf,
  634. .mono_reg = AFE_DAC_CON1,
  635. .mono_shift = 22,
  636. .hd_reg = -1,
  637. .enable_reg = AFE_DAC_CON0,
  638. .enable_shift = 2,
  639. .msb_reg = AFE_MEMIF_MSB,
  640. .msb_shift = 1,
  641. .agent_disable_reg = -1,
  642. }, {
  643. .name = "VUL",
  644. .id = MT8173_AFE_MEMIF_VUL,
  645. .reg_ofs_base = AFE_VUL_BASE,
  646. .reg_ofs_cur = AFE_VUL_CUR,
  647. .fs_reg = AFE_DAC_CON1,
  648. .fs_shift = 16,
  649. .fs_maskbit = 0xf,
  650. .mono_reg = AFE_DAC_CON1,
  651. .mono_shift = 27,
  652. .hd_reg = -1,
  653. .enable_reg = AFE_DAC_CON0,
  654. .enable_shift = 3,
  655. .msb_reg = AFE_MEMIF_MSB,
  656. .msb_shift = 6,
  657. .agent_disable_reg = -1,
  658. }, {
  659. .name = "DAI",
  660. .id = MT8173_AFE_MEMIF_DAI,
  661. .reg_ofs_base = AFE_DAI_BASE,
  662. .reg_ofs_cur = AFE_DAI_CUR,
  663. .fs_reg = AFE_DAC_CON0,
  664. .fs_shift = 24,
  665. .fs_maskbit = 0x3,
  666. .mono_reg = -1,
  667. .mono_shift = -1,
  668. .hd_reg = -1,
  669. .enable_reg = AFE_DAC_CON0,
  670. .enable_shift = 4,
  671. .msb_reg = AFE_MEMIF_MSB,
  672. .msb_shift = 5,
  673. .agent_disable_reg = -1,
  674. }, {
  675. .name = "AWB",
  676. .id = MT8173_AFE_MEMIF_AWB,
  677. .reg_ofs_base = AFE_AWB_BASE,
  678. .reg_ofs_cur = AFE_AWB_CUR,
  679. .fs_reg = AFE_DAC_CON1,
  680. .fs_shift = 12,
  681. .fs_maskbit = 0xf,
  682. .mono_reg = AFE_DAC_CON1,
  683. .mono_shift = 24,
  684. .hd_reg = -1,
  685. .enable_reg = AFE_DAC_CON0,
  686. .enable_shift = 6,
  687. .msb_reg = AFE_MEMIF_MSB,
  688. .msb_shift = 3,
  689. .agent_disable_reg = -1,
  690. }, {
  691. .name = "MOD_DAI",
  692. .id = MT8173_AFE_MEMIF_MOD_DAI,
  693. .reg_ofs_base = AFE_MOD_PCM_BASE,
  694. .reg_ofs_cur = AFE_MOD_PCM_CUR,
  695. .fs_reg = AFE_DAC_CON1,
  696. .fs_shift = 30,
  697. .fs_maskbit = 0x3,
  698. .mono_reg = AFE_DAC_CON1,
  699. .mono_shift = 30,
  700. .hd_reg = -1,
  701. .enable_reg = AFE_DAC_CON0,
  702. .enable_shift = 7,
  703. .msb_reg = AFE_MEMIF_MSB,
  704. .msb_shift = 4,
  705. .agent_disable_reg = -1,
  706. }, {
  707. .name = "HDMI",
  708. .id = MT8173_AFE_MEMIF_HDMI,
  709. .reg_ofs_base = AFE_HDMI_OUT_BASE,
  710. .reg_ofs_cur = AFE_HDMI_OUT_CUR,
  711. .fs_reg = -1,
  712. .fs_shift = -1,
  713. .fs_maskbit = -1,
  714. .mono_reg = -1,
  715. .mono_shift = -1,
  716. .hd_reg = -1,
  717. .enable_reg = -1,
  718. .msb_reg = AFE_MEMIF_MSB,
  719. .msb_shift = 8,
  720. .agent_disable_reg = -1,
  721. },
  722. };
  723. static const struct mtk_base_irq_data irq_data[MT8173_AFE_IRQ_NUM] = {
  724. {
  725. .id = MT8173_AFE_IRQ_DL1,
  726. .irq_cnt_reg = AFE_IRQ_CNT1,
  727. .irq_cnt_shift = 0,
  728. .irq_cnt_maskbit = 0x3ffff,
  729. .irq_en_reg = AFE_IRQ_MCU_CON,
  730. .irq_en_shift = 0,
  731. .irq_fs_reg = AFE_IRQ_MCU_CON,
  732. .irq_fs_shift = 4,
  733. .irq_fs_maskbit = 0xf,
  734. .irq_clr_reg = AFE_IRQ_CLR,
  735. .irq_clr_shift = 0,
  736. }, {
  737. .id = MT8173_AFE_IRQ_DL2,
  738. .irq_cnt_reg = AFE_IRQ_CNT1,
  739. .irq_cnt_shift = 20,
  740. .irq_cnt_maskbit = 0x3ffff,
  741. .irq_en_reg = AFE_IRQ_MCU_CON,
  742. .irq_en_shift = 2,
  743. .irq_fs_reg = AFE_IRQ_MCU_CON,
  744. .irq_fs_shift = 16,
  745. .irq_fs_maskbit = 0xf,
  746. .irq_clr_reg = AFE_IRQ_CLR,
  747. .irq_clr_shift = 2,
  748. }, {
  749. .id = MT8173_AFE_IRQ_VUL,
  750. .irq_cnt_reg = AFE_IRQ_CNT2,
  751. .irq_cnt_shift = 0,
  752. .irq_cnt_maskbit = 0x3ffff,
  753. .irq_en_reg = AFE_IRQ_MCU_CON,
  754. .irq_en_shift = 1,
  755. .irq_fs_reg = AFE_IRQ_MCU_CON,
  756. .irq_fs_shift = 8,
  757. .irq_fs_maskbit = 0xf,
  758. .irq_clr_reg = AFE_IRQ_CLR,
  759. .irq_clr_shift = 1,
  760. }, {
  761. .id = MT8173_AFE_IRQ_DAI,
  762. .irq_cnt_reg = AFE_IRQ_CNT2,
  763. .irq_cnt_shift = 20,
  764. .irq_cnt_maskbit = 0x3ffff,
  765. .irq_en_reg = AFE_IRQ_MCU_CON,
  766. .irq_en_shift = 3,
  767. .irq_fs_reg = AFE_IRQ_MCU_CON,
  768. .irq_fs_shift = 20,
  769. .irq_fs_maskbit = 0xf,
  770. .irq_clr_reg = AFE_IRQ_CLR,
  771. .irq_clr_shift = 3,
  772. }, {
  773. .id = MT8173_AFE_IRQ_AWB,
  774. .irq_cnt_reg = AFE_IRQ_CNT7,
  775. .irq_cnt_shift = 0,
  776. .irq_cnt_maskbit = 0x3ffff,
  777. .irq_en_reg = AFE_IRQ_MCU_CON,
  778. .irq_en_shift = 14,
  779. .irq_fs_reg = AFE_IRQ_MCU_CON,
  780. .irq_fs_shift = 24,
  781. .irq_fs_maskbit = 0xf,
  782. .irq_clr_reg = AFE_IRQ_CLR,
  783. .irq_clr_shift = 6,
  784. }, {
  785. .id = MT8173_AFE_IRQ_DAI,
  786. .irq_cnt_reg = AFE_IRQ_CNT2,
  787. .irq_cnt_shift = 20,
  788. .irq_cnt_maskbit = 0x3ffff,
  789. .irq_en_reg = AFE_IRQ_MCU_CON,
  790. .irq_en_shift = 3,
  791. .irq_fs_reg = AFE_IRQ_MCU_CON,
  792. .irq_fs_shift = 20,
  793. .irq_fs_maskbit = 0xf,
  794. .irq_clr_reg = AFE_IRQ_CLR,
  795. .irq_clr_shift = 3,
  796. }, {
  797. .id = MT8173_AFE_IRQ_HDMI,
  798. .irq_cnt_reg = AFE_IRQ_CNT5,
  799. .irq_cnt_shift = 0,
  800. .irq_cnt_maskbit = 0x3ffff,
  801. .irq_en_reg = AFE_IRQ_MCU_CON,
  802. .irq_en_shift = 12,
  803. .irq_fs_reg = -1,
  804. .irq_fs_maskbit = -1,
  805. .irq_clr_reg = AFE_IRQ_CLR,
  806. .irq_clr_shift = 4,
  807. },
  808. };
  809. static const struct regmap_config mt8173_afe_regmap_config = {
  810. .reg_bits = 32,
  811. .reg_stride = 4,
  812. .val_bits = 32,
  813. .max_register = AFE_ADDA2_TOP_CON0,
  814. .cache_type = REGCACHE_NONE,
  815. };
  816. static irqreturn_t mt8173_afe_irq_handler(int irq, void *dev_id)
  817. {
  818. struct mtk_base_afe *afe = dev_id;
  819. unsigned int reg_value;
  820. int i, ret;
  821. ret = regmap_read(afe->regmap, AFE_IRQ_STATUS, &reg_value);
  822. if (ret) {
  823. dev_err(afe->dev, "%s irq status err\n", __func__);
  824. reg_value = AFE_IRQ_STATUS_BITS;
  825. goto err_irq;
  826. }
  827. for (i = 0; i < MT8173_AFE_MEMIF_NUM; i++) {
  828. struct mtk_base_afe_memif *memif = &afe->memif[i];
  829. struct mtk_base_afe_irq *irq_p;
  830. if (memif->irq_usage < 0)
  831. continue;
  832. irq_p = &afe->irqs[memif->irq_usage];
  833. if (!(reg_value & (1 << irq_p->irq_data->irq_clr_shift)))
  834. continue;
  835. snd_pcm_period_elapsed(memif->substream);
  836. }
  837. err_irq:
  838. /* clear irq */
  839. regmap_write(afe->regmap, AFE_IRQ_CLR,
  840. reg_value & AFE_IRQ_STATUS_BITS);
  841. return IRQ_HANDLED;
  842. }
  843. static int mt8173_afe_runtime_suspend(struct device *dev)
  844. {
  845. struct mtk_base_afe *afe = dev_get_drvdata(dev);
  846. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  847. /* disable AFE */
  848. regmap_update_bits(afe->regmap, AFE_DAC_CON0, 0x1, 0);
  849. /* disable AFE clk */
  850. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  851. AUD_TCON0_PDN_AFE, AUD_TCON0_PDN_AFE);
  852. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S1_M]);
  853. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S2_M]);
  854. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_BCK0]);
  855. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_BCK1]);
  856. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD]);
  857. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD_BUS]);
  858. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_INFRASYS_AUD]);
  859. return 0;
  860. }
  861. static int mt8173_afe_runtime_resume(struct device *dev)
  862. {
  863. struct mtk_base_afe *afe = dev_get_drvdata(dev);
  864. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  865. int ret;
  866. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_INFRASYS_AUD]);
  867. if (ret)
  868. return ret;
  869. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD_BUS]);
  870. if (ret)
  871. goto err_infra;
  872. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD]);
  873. if (ret)
  874. goto err_top_aud_bus;
  875. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_BCK0]);
  876. if (ret)
  877. goto err_top_aud;
  878. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_BCK1]);
  879. if (ret)
  880. goto err_bck0;
  881. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_I2S1_M]);
  882. if (ret)
  883. goto err_i2s1_m;
  884. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_I2S2_M]);
  885. if (ret)
  886. goto err_i2s2_m;
  887. /* enable AFE clk */
  888. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0, AUD_TCON0_PDN_AFE, 0);
  889. /* set O3/O4 16bits */
  890. regmap_update_bits(afe->regmap, AFE_CONN_24BIT,
  891. AFE_CONN_24BIT_O03 | AFE_CONN_24BIT_O04, 0);
  892. /* unmask all IRQs */
  893. regmap_update_bits(afe->regmap, AFE_IRQ_MCU_EN, 0xff, 0xff);
  894. /* enable AFE */
  895. regmap_update_bits(afe->regmap, AFE_DAC_CON0, 0x1, 0x1);
  896. return 0;
  897. err_i2s1_m:
  898. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S1_M]);
  899. err_i2s2_m:
  900. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S2_M]);
  901. err_bck0:
  902. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_BCK0]);
  903. err_top_aud:
  904. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD]);
  905. err_top_aud_bus:
  906. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD_BUS]);
  907. err_infra:
  908. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_INFRASYS_AUD]);
  909. return ret;
  910. }
  911. static int mt8173_afe_init_audio_clk(struct mtk_base_afe *afe)
  912. {
  913. size_t i;
  914. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  915. for (i = 0; i < ARRAY_SIZE(aud_clks); i++) {
  916. afe_priv->clocks[i] = devm_clk_get(afe->dev, aud_clks[i]);
  917. if (IS_ERR(afe_priv->clocks[i])) {
  918. dev_err(afe->dev, "%s devm_clk_get %s fail\n",
  919. __func__, aud_clks[i]);
  920. return PTR_ERR(afe_priv->clocks[i]);
  921. }
  922. }
  923. clk_set_rate(afe_priv->clocks[MT8173_CLK_BCK0], 22579200); /* 22M */
  924. clk_set_rate(afe_priv->clocks[MT8173_CLK_BCK1], 24576000); /* 24M */
  925. return 0;
  926. }
  927. static int mt8173_afe_pcm_dev_probe(struct platform_device *pdev)
  928. {
  929. int ret, i;
  930. int irq_id;
  931. struct mtk_base_afe *afe;
  932. struct mt8173_afe_private *afe_priv;
  933. struct snd_soc_component *comp_pcm, *comp_hdmi;
  934. ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(33));
  935. if (ret)
  936. return ret;
  937. afe = devm_kzalloc(&pdev->dev, sizeof(*afe), GFP_KERNEL);
  938. if (!afe)
  939. return -ENOMEM;
  940. afe->platform_priv = devm_kzalloc(&pdev->dev, sizeof(*afe_priv),
  941. GFP_KERNEL);
  942. afe_priv = afe->platform_priv;
  943. if (!afe_priv)
  944. return -ENOMEM;
  945. afe->dev = &pdev->dev;
  946. irq_id = platform_get_irq(pdev, 0);
  947. if (irq_id <= 0)
  948. return irq_id < 0 ? irq_id : -ENXIO;
  949. afe->base_addr = devm_platform_ioremap_resource(pdev, 0);
  950. if (IS_ERR(afe->base_addr))
  951. return PTR_ERR(afe->base_addr);
  952. afe->regmap = devm_regmap_init_mmio(&pdev->dev, afe->base_addr,
  953. &mt8173_afe_regmap_config);
  954. if (IS_ERR(afe->regmap))
  955. return PTR_ERR(afe->regmap);
  956. /* initial audio related clock */
  957. ret = mt8173_afe_init_audio_clk(afe);
  958. if (ret) {
  959. dev_err(afe->dev, "mt8173_afe_init_audio_clk fail\n");
  960. return ret;
  961. }
  962. /* memif % irq initialize*/
  963. afe->memif_size = MT8173_AFE_MEMIF_NUM;
  964. afe->memif = devm_kcalloc(afe->dev, afe->memif_size,
  965. sizeof(*afe->memif), GFP_KERNEL);
  966. if (!afe->memif)
  967. return -ENOMEM;
  968. afe->irqs_size = MT8173_AFE_IRQ_NUM;
  969. afe->irqs = devm_kcalloc(afe->dev, afe->irqs_size,
  970. sizeof(*afe->irqs), GFP_KERNEL);
  971. if (!afe->irqs)
  972. return -ENOMEM;
  973. for (i = 0; i < afe->irqs_size; i++) {
  974. afe->memif[i].data = &memif_data[i];
  975. afe->irqs[i].irq_data = &irq_data[i];
  976. afe->irqs[i].irq_occupyed = true;
  977. afe->memif[i].irq_usage = i;
  978. afe->memif[i].const_irq = 1;
  979. }
  980. afe->mtk_afe_hardware = &mt8173_afe_hardware;
  981. afe->memif_fs = mt8173_memif_fs;
  982. afe->irq_fs = mt8173_irq_fs;
  983. platform_set_drvdata(pdev, afe);
  984. pm_runtime_enable(&pdev->dev);
  985. if (!pm_runtime_enabled(&pdev->dev)) {
  986. ret = mt8173_afe_runtime_resume(&pdev->dev);
  987. if (ret)
  988. goto err_pm_disable;
  989. }
  990. afe->reg_back_up_list = mt8173_afe_backup_list;
  991. afe->reg_back_up_list_num = ARRAY_SIZE(mt8173_afe_backup_list);
  992. afe->runtime_resume = mt8173_afe_runtime_resume;
  993. afe->runtime_suspend = mt8173_afe_runtime_suspend;
  994. ret = devm_snd_soc_register_component(&pdev->dev,
  995. &mtk_afe_pcm_platform,
  996. NULL, 0);
  997. if (ret)
  998. goto err_pm_disable;
  999. comp_pcm = devm_kzalloc(&pdev->dev, sizeof(*comp_pcm), GFP_KERNEL);
  1000. if (!comp_pcm) {
  1001. ret = -ENOMEM;
  1002. goto err_pm_disable;
  1003. }
  1004. ret = snd_soc_component_initialize(comp_pcm,
  1005. &mt8173_afe_pcm_dai_component,
  1006. &pdev->dev);
  1007. if (ret)
  1008. goto err_pm_disable;
  1009. #ifdef CONFIG_DEBUG_FS
  1010. comp_pcm->debugfs_prefix = "pcm";
  1011. #endif
  1012. ret = snd_soc_add_component(comp_pcm,
  1013. mt8173_afe_pcm_dais,
  1014. ARRAY_SIZE(mt8173_afe_pcm_dais));
  1015. if (ret)
  1016. goto err_pm_disable;
  1017. comp_hdmi = devm_kzalloc(&pdev->dev, sizeof(*comp_hdmi), GFP_KERNEL);
  1018. if (!comp_hdmi) {
  1019. ret = -ENOMEM;
  1020. goto err_cleanup_components;
  1021. }
  1022. ret = snd_soc_component_initialize(comp_hdmi,
  1023. &mt8173_afe_hdmi_dai_component,
  1024. &pdev->dev);
  1025. if (ret)
  1026. goto err_cleanup_components;
  1027. #ifdef CONFIG_DEBUG_FS
  1028. comp_hdmi->debugfs_prefix = "hdmi";
  1029. #endif
  1030. ret = snd_soc_add_component(comp_hdmi,
  1031. mt8173_afe_hdmi_dais,
  1032. ARRAY_SIZE(mt8173_afe_hdmi_dais));
  1033. if (ret)
  1034. goto err_cleanup_components;
  1035. ret = devm_request_irq(afe->dev, irq_id, mt8173_afe_irq_handler,
  1036. 0, "Afe_ISR_Handle", (void *)afe);
  1037. if (ret) {
  1038. dev_err(afe->dev, "could not request_irq\n");
  1039. goto err_cleanup_components;
  1040. }
  1041. dev_info(&pdev->dev, "MT8173 AFE driver initialized.\n");
  1042. return 0;
  1043. err_cleanup_components:
  1044. snd_soc_unregister_component(&pdev->dev);
  1045. err_pm_disable:
  1046. pm_runtime_disable(&pdev->dev);
  1047. return ret;
  1048. }
  1049. static int mt8173_afe_pcm_dev_remove(struct platform_device *pdev)
  1050. {
  1051. snd_soc_unregister_component(&pdev->dev);
  1052. pm_runtime_disable(&pdev->dev);
  1053. if (!pm_runtime_status_suspended(&pdev->dev))
  1054. mt8173_afe_runtime_suspend(&pdev->dev);
  1055. return 0;
  1056. }
  1057. static const struct of_device_id mt8173_afe_pcm_dt_match[] = {
  1058. { .compatible = "mediatek,mt8173-afe-pcm", },
  1059. { }
  1060. };
  1061. MODULE_DEVICE_TABLE(of, mt8173_afe_pcm_dt_match);
  1062. static const struct dev_pm_ops mt8173_afe_pm_ops = {
  1063. SET_RUNTIME_PM_OPS(mt8173_afe_runtime_suspend,
  1064. mt8173_afe_runtime_resume, NULL)
  1065. };
  1066. static struct platform_driver mt8173_afe_pcm_driver = {
  1067. .driver = {
  1068. .name = "mt8173-afe-pcm",
  1069. .of_match_table = mt8173_afe_pcm_dt_match,
  1070. .pm = &mt8173_afe_pm_ops,
  1071. },
  1072. .probe = mt8173_afe_pcm_dev_probe,
  1073. .remove = mt8173_afe_pcm_dev_remove,
  1074. };
  1075. module_platform_driver(mt8173_afe_pcm_driver);
  1076. MODULE_DESCRIPTION("Mediatek ALSA SoC AFE platform driver");
  1077. MODULE_AUTHOR("Koro Chen <[email protected]>");
  1078. MODULE_LICENSE("GPL v2");