mt8173-afe-pcm.c 32 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222
  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 <koro.chen@mediatek.com>
  7. * Sascha Hauer <s.hauer@pengutronix.de>
  8. * Hidalgo Huang <hidalgo.huang@mediatek.com>
  9. * Ir Lian <ir.lian@mediatek.com>
  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. if (m_ck)
  248. clk_disable_unprepare(m_ck);
  249. if (b_ck)
  250. clk_disable_unprepare(b_ck);
  251. }
  252. static int mt8173_afe_i2s_startup(struct snd_pcm_substream *substream,
  253. struct snd_soc_dai *dai)
  254. {
  255. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  256. if (dai->active)
  257. return 0;
  258. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  259. AUD_TCON0_PDN_22M | AUD_TCON0_PDN_24M, 0);
  260. return 0;
  261. }
  262. static void mt8173_afe_i2s_shutdown(struct snd_pcm_substream *substream,
  263. struct snd_soc_dai *dai)
  264. {
  265. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  266. if (dai->active)
  267. return;
  268. mt8173_afe_set_i2s_enable(afe, false);
  269. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  270. AUD_TCON0_PDN_22M | AUD_TCON0_PDN_24M,
  271. AUD_TCON0_PDN_22M | AUD_TCON0_PDN_24M);
  272. }
  273. static int mt8173_afe_i2s_prepare(struct snd_pcm_substream *substream,
  274. struct snd_soc_dai *dai)
  275. {
  276. struct snd_pcm_runtime * const runtime = substream->runtime;
  277. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  278. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  279. int ret;
  280. mt8173_afe_dais_set_clks(afe, afe_priv->clocks[MT8173_CLK_I2S1_M],
  281. runtime->rate * 256, NULL, 0);
  282. mt8173_afe_dais_set_clks(afe, afe_priv->clocks[MT8173_CLK_I2S2_M],
  283. runtime->rate * 256, NULL, 0);
  284. /* config I2S */
  285. ret = mt8173_afe_set_i2s(afe, substream->runtime->rate);
  286. if (ret)
  287. return ret;
  288. mt8173_afe_set_i2s_enable(afe, true);
  289. return 0;
  290. }
  291. static int mt8173_afe_hdmi_startup(struct snd_pcm_substream *substream,
  292. struct snd_soc_dai *dai)
  293. {
  294. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  295. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  296. if (dai->active)
  297. return 0;
  298. mt8173_afe_dais_enable_clks(afe, afe_priv->clocks[MT8173_CLK_I2S3_M],
  299. afe_priv->clocks[MT8173_CLK_I2S3_B]);
  300. return 0;
  301. }
  302. static void mt8173_afe_hdmi_shutdown(struct snd_pcm_substream *substream,
  303. struct snd_soc_dai *dai)
  304. {
  305. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  306. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  307. if (dai->active)
  308. return;
  309. mt8173_afe_dais_disable_clks(afe, afe_priv->clocks[MT8173_CLK_I2S3_M],
  310. afe_priv->clocks[MT8173_CLK_I2S3_B]);
  311. }
  312. static int mt8173_afe_hdmi_prepare(struct snd_pcm_substream *substream,
  313. struct snd_soc_dai *dai)
  314. {
  315. struct snd_pcm_runtime * const runtime = substream->runtime;
  316. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  317. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  318. unsigned int val;
  319. mt8173_afe_dais_set_clks(afe, afe_priv->clocks[MT8173_CLK_I2S3_M],
  320. runtime->rate * 128,
  321. afe_priv->clocks[MT8173_CLK_I2S3_B],
  322. runtime->rate * runtime->channels * 32);
  323. val = AFE_TDM_CON1_BCK_INV |
  324. AFE_TDM_CON1_LRCK_INV |
  325. AFE_TDM_CON1_1_BCK_DELAY |
  326. AFE_TDM_CON1_MSB_ALIGNED | /* I2S mode */
  327. AFE_TDM_CON1_WLEN_32BIT |
  328. AFE_TDM_CON1_32_BCK_CYCLES |
  329. AFE_TDM_CON1_LRCK_WIDTH(32);
  330. regmap_update_bits(afe->regmap, AFE_TDM_CON1, ~AFE_TDM_CON1_EN, val);
  331. /* set tdm2 config */
  332. switch (runtime->channels) {
  333. case 1:
  334. case 2:
  335. val = AFE_TDM_CH_START_O30_O31;
  336. val |= (AFE_TDM_CH_ZERO << 4);
  337. val |= (AFE_TDM_CH_ZERO << 8);
  338. val |= (AFE_TDM_CH_ZERO << 12);
  339. break;
  340. case 3:
  341. case 4:
  342. val = AFE_TDM_CH_START_O30_O31;
  343. val |= (AFE_TDM_CH_START_O32_O33 << 4);
  344. val |= (AFE_TDM_CH_ZERO << 8);
  345. val |= (AFE_TDM_CH_ZERO << 12);
  346. break;
  347. case 5:
  348. case 6:
  349. val = AFE_TDM_CH_START_O30_O31;
  350. val |= (AFE_TDM_CH_START_O32_O33 << 4);
  351. val |= (AFE_TDM_CH_START_O34_O35 << 8);
  352. val |= (AFE_TDM_CH_ZERO << 12);
  353. break;
  354. case 7:
  355. case 8:
  356. val = AFE_TDM_CH_START_O30_O31;
  357. val |= (AFE_TDM_CH_START_O32_O33 << 4);
  358. val |= (AFE_TDM_CH_START_O34_O35 << 8);
  359. val |= (AFE_TDM_CH_START_O36_O37 << 12);
  360. break;
  361. default:
  362. val = 0;
  363. }
  364. regmap_update_bits(afe->regmap, AFE_TDM_CON2, 0x0000ffff, val);
  365. regmap_update_bits(afe->regmap, AFE_HDMI_OUT_CON0,
  366. 0x000000f0, runtime->channels << 4);
  367. return 0;
  368. }
  369. static int mt8173_afe_hdmi_trigger(struct snd_pcm_substream *substream, int cmd,
  370. struct snd_soc_dai *dai)
  371. {
  372. struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
  373. dev_info(afe->dev, "%s cmd=%d %s\n", __func__, cmd, dai->name);
  374. switch (cmd) {
  375. case SNDRV_PCM_TRIGGER_START:
  376. case SNDRV_PCM_TRIGGER_RESUME:
  377. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  378. AUD_TCON0_PDN_HDMI | AUD_TCON0_PDN_SPDF, 0);
  379. /* set connections: O30~O37: L/R/LS/RS/C/LFE/CH7/CH8 */
  380. regmap_write(afe->regmap, AFE_HDMI_CONN0,
  381. AFE_HDMI_CONN0_O30_I30 |
  382. AFE_HDMI_CONN0_O31_I31 |
  383. AFE_HDMI_CONN0_O32_I34 |
  384. AFE_HDMI_CONN0_O33_I35 |
  385. AFE_HDMI_CONN0_O34_I32 |
  386. AFE_HDMI_CONN0_O35_I33 |
  387. AFE_HDMI_CONN0_O36_I36 |
  388. AFE_HDMI_CONN0_O37_I37);
  389. /* enable Out control */
  390. regmap_update_bits(afe->regmap, AFE_HDMI_OUT_CON0, 0x1, 0x1);
  391. /* enable tdm */
  392. regmap_update_bits(afe->regmap, AFE_TDM_CON1, 0x1, 0x1);
  393. return 0;
  394. case SNDRV_PCM_TRIGGER_STOP:
  395. case SNDRV_PCM_TRIGGER_SUSPEND:
  396. /* disable tdm */
  397. regmap_update_bits(afe->regmap, AFE_TDM_CON1, 0x1, 0);
  398. /* disable Out control */
  399. regmap_update_bits(afe->regmap, AFE_HDMI_OUT_CON0, 0x1, 0);
  400. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  401. AUD_TCON0_PDN_HDMI | AUD_TCON0_PDN_SPDF,
  402. AUD_TCON0_PDN_HDMI | AUD_TCON0_PDN_SPDF);
  403. return 0;
  404. default:
  405. return -EINVAL;
  406. }
  407. }
  408. static int mt8173_memif_fs(struct snd_pcm_substream *substream,
  409. unsigned int rate)
  410. {
  411. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  412. struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, AFE_PCM_NAME);
  413. struct mtk_base_afe *afe = snd_soc_component_get_drvdata(component);
  414. struct mtk_base_afe_memif *memif = &afe->memif[rtd->cpu_dai->id];
  415. int fs;
  416. if (memif->data->id == MT8173_AFE_MEMIF_DAI ||
  417. memif->data->id == MT8173_AFE_MEMIF_MOD_DAI) {
  418. switch (rate) {
  419. case 8000:
  420. fs = 0;
  421. break;
  422. case 16000:
  423. fs = 1;
  424. break;
  425. case 32000:
  426. fs = 2;
  427. break;
  428. default:
  429. return -EINVAL;
  430. }
  431. } else {
  432. fs = mt8173_afe_i2s_fs(rate);
  433. }
  434. return fs;
  435. }
  436. static int mt8173_irq_fs(struct snd_pcm_substream *substream, unsigned int rate)
  437. {
  438. return mt8173_afe_i2s_fs(rate);
  439. }
  440. /* BE DAIs */
  441. static const struct snd_soc_dai_ops mt8173_afe_i2s_ops = {
  442. .startup = mt8173_afe_i2s_startup,
  443. .shutdown = mt8173_afe_i2s_shutdown,
  444. .prepare = mt8173_afe_i2s_prepare,
  445. };
  446. static const struct snd_soc_dai_ops mt8173_afe_hdmi_ops = {
  447. .startup = mt8173_afe_hdmi_startup,
  448. .shutdown = mt8173_afe_hdmi_shutdown,
  449. .prepare = mt8173_afe_hdmi_prepare,
  450. .trigger = mt8173_afe_hdmi_trigger,
  451. };
  452. static struct snd_soc_dai_driver mt8173_afe_pcm_dais[] = {
  453. /* FE DAIs: memory intefaces to CPU */
  454. {
  455. .name = "DL1", /* downlink 1 */
  456. .id = MT8173_AFE_MEMIF_DL1,
  457. .suspend = mtk_afe_dai_suspend,
  458. .resume = mtk_afe_dai_resume,
  459. .playback = {
  460. .stream_name = "DL1",
  461. .channels_min = 1,
  462. .channels_max = 2,
  463. .rates = SNDRV_PCM_RATE_8000_48000,
  464. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  465. },
  466. .ops = &mtk_afe_fe_ops,
  467. }, {
  468. .name = "VUL", /* voice uplink */
  469. .id = MT8173_AFE_MEMIF_VUL,
  470. .suspend = mtk_afe_dai_suspend,
  471. .resume = mtk_afe_dai_resume,
  472. .capture = {
  473. .stream_name = "VUL",
  474. .channels_min = 1,
  475. .channels_max = 2,
  476. .rates = SNDRV_PCM_RATE_8000_48000,
  477. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  478. },
  479. .ops = &mtk_afe_fe_ops,
  480. }, {
  481. /* BE DAIs */
  482. .name = "I2S",
  483. .id = MT8173_AFE_IO_I2S,
  484. .playback = {
  485. .stream_name = "I2S Playback",
  486. .channels_min = 1,
  487. .channels_max = 2,
  488. .rates = SNDRV_PCM_RATE_8000_48000,
  489. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  490. },
  491. .capture = {
  492. .stream_name = "I2S Capture",
  493. .channels_min = 1,
  494. .channels_max = 2,
  495. .rates = SNDRV_PCM_RATE_8000_48000,
  496. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  497. },
  498. .ops = &mt8173_afe_i2s_ops,
  499. .symmetric_rates = 1,
  500. },
  501. };
  502. static struct snd_soc_dai_driver mt8173_afe_hdmi_dais[] = {
  503. /* FE DAIs */
  504. {
  505. .name = "HDMI",
  506. .id = MT8173_AFE_MEMIF_HDMI,
  507. .suspend = mtk_afe_dai_suspend,
  508. .resume = mtk_afe_dai_resume,
  509. .playback = {
  510. .stream_name = "HDMI",
  511. .channels_min = 2,
  512. .channels_max = 8,
  513. .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  514. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  515. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  516. SNDRV_PCM_RATE_192000,
  517. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  518. },
  519. .ops = &mtk_afe_fe_ops,
  520. }, {
  521. /* BE DAIs */
  522. .name = "HDMIO",
  523. .id = MT8173_AFE_IO_HDMI,
  524. .playback = {
  525. .stream_name = "HDMIO Playback",
  526. .channels_min = 2,
  527. .channels_max = 8,
  528. .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |
  529. SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |
  530. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_176400 |
  531. SNDRV_PCM_RATE_192000,
  532. .formats = SNDRV_PCM_FMTBIT_S16_LE,
  533. },
  534. .ops = &mt8173_afe_hdmi_ops,
  535. },
  536. };
  537. static const struct snd_kcontrol_new mt8173_afe_o03_mix[] = {
  538. SOC_DAPM_SINGLE_AUTODISABLE("I05 Switch", AFE_CONN1, 21, 1, 0),
  539. };
  540. static const struct snd_kcontrol_new mt8173_afe_o04_mix[] = {
  541. SOC_DAPM_SINGLE_AUTODISABLE("I06 Switch", AFE_CONN2, 6, 1, 0),
  542. };
  543. static const struct snd_kcontrol_new mt8173_afe_o09_mix[] = {
  544. SOC_DAPM_SINGLE_AUTODISABLE("I03 Switch", AFE_CONN3, 0, 1, 0),
  545. SOC_DAPM_SINGLE_AUTODISABLE("I17 Switch", AFE_CONN7, 30, 1, 0),
  546. };
  547. static const struct snd_kcontrol_new mt8173_afe_o10_mix[] = {
  548. SOC_DAPM_SINGLE_AUTODISABLE("I04 Switch", AFE_CONN3, 3, 1, 0),
  549. SOC_DAPM_SINGLE_AUTODISABLE("I18 Switch", AFE_CONN8, 0, 1, 0),
  550. };
  551. static const struct snd_soc_dapm_widget mt8173_afe_pcm_widgets[] = {
  552. /* inter-connections */
  553. SND_SOC_DAPM_MIXER("I03", SND_SOC_NOPM, 0, 0, NULL, 0),
  554. SND_SOC_DAPM_MIXER("I04", SND_SOC_NOPM, 0, 0, NULL, 0),
  555. SND_SOC_DAPM_MIXER("I05", SND_SOC_NOPM, 0, 0, NULL, 0),
  556. SND_SOC_DAPM_MIXER("I06", SND_SOC_NOPM, 0, 0, NULL, 0),
  557. SND_SOC_DAPM_MIXER("I17", SND_SOC_NOPM, 0, 0, NULL, 0),
  558. SND_SOC_DAPM_MIXER("I18", SND_SOC_NOPM, 0, 0, NULL, 0),
  559. SND_SOC_DAPM_MIXER("O03", SND_SOC_NOPM, 0, 0,
  560. mt8173_afe_o03_mix, ARRAY_SIZE(mt8173_afe_o03_mix)),
  561. SND_SOC_DAPM_MIXER("O04", SND_SOC_NOPM, 0, 0,
  562. mt8173_afe_o04_mix, ARRAY_SIZE(mt8173_afe_o04_mix)),
  563. SND_SOC_DAPM_MIXER("O09", SND_SOC_NOPM, 0, 0,
  564. mt8173_afe_o09_mix, ARRAY_SIZE(mt8173_afe_o09_mix)),
  565. SND_SOC_DAPM_MIXER("O10", SND_SOC_NOPM, 0, 0,
  566. mt8173_afe_o10_mix, ARRAY_SIZE(mt8173_afe_o10_mix)),
  567. };
  568. static const struct snd_soc_dapm_route mt8173_afe_pcm_routes[] = {
  569. {"I05", NULL, "DL1"},
  570. {"I06", NULL, "DL1"},
  571. {"I2S Playback", NULL, "O03"},
  572. {"I2S Playback", NULL, "O04"},
  573. {"VUL", NULL, "O09"},
  574. {"VUL", NULL, "O10"},
  575. {"I03", NULL, "I2S Capture"},
  576. {"I04", NULL, "I2S Capture"},
  577. {"I17", NULL, "I2S Capture"},
  578. {"I18", NULL, "I2S Capture"},
  579. { "O03", "I05 Switch", "I05" },
  580. { "O04", "I06 Switch", "I06" },
  581. { "O09", "I17 Switch", "I17" },
  582. { "O09", "I03 Switch", "I03" },
  583. { "O10", "I18 Switch", "I18" },
  584. { "O10", "I04 Switch", "I04" },
  585. };
  586. static const struct snd_soc_dapm_route mt8173_afe_hdmi_routes[] = {
  587. {"HDMIO Playback", NULL, "HDMI"},
  588. };
  589. static const struct snd_soc_component_driver mt8173_afe_pcm_dai_component = {
  590. .name = "mt8173-afe-pcm-dai",
  591. .dapm_widgets = mt8173_afe_pcm_widgets,
  592. .num_dapm_widgets = ARRAY_SIZE(mt8173_afe_pcm_widgets),
  593. .dapm_routes = mt8173_afe_pcm_routes,
  594. .num_dapm_routes = ARRAY_SIZE(mt8173_afe_pcm_routes),
  595. };
  596. static const struct snd_soc_component_driver mt8173_afe_hdmi_dai_component = {
  597. .name = "mt8173-afe-hdmi-dai",
  598. .dapm_routes = mt8173_afe_hdmi_routes,
  599. .num_dapm_routes = ARRAY_SIZE(mt8173_afe_hdmi_routes),
  600. };
  601. static const char *aud_clks[MT8173_CLK_NUM] = {
  602. [MT8173_CLK_INFRASYS_AUD] = "infra_sys_audio_clk",
  603. [MT8173_CLK_TOP_PDN_AUD] = "top_pdn_audio",
  604. [MT8173_CLK_TOP_PDN_AUD_BUS] = "top_pdn_aud_intbus",
  605. [MT8173_CLK_I2S0_M] = "i2s0_m",
  606. [MT8173_CLK_I2S1_M] = "i2s1_m",
  607. [MT8173_CLK_I2S2_M] = "i2s2_m",
  608. [MT8173_CLK_I2S3_M] = "i2s3_m",
  609. [MT8173_CLK_I2S3_B] = "i2s3_b",
  610. [MT8173_CLK_BCK0] = "bck0",
  611. [MT8173_CLK_BCK1] = "bck1",
  612. };
  613. static const struct mtk_base_memif_data memif_data[MT8173_AFE_MEMIF_NUM] = {
  614. {
  615. .name = "DL1",
  616. .id = MT8173_AFE_MEMIF_DL1,
  617. .reg_ofs_base = AFE_DL1_BASE,
  618. .reg_ofs_cur = AFE_DL1_CUR,
  619. .fs_reg = AFE_DAC_CON1,
  620. .fs_shift = 0,
  621. .fs_maskbit = 0xf,
  622. .mono_reg = AFE_DAC_CON1,
  623. .mono_shift = 21,
  624. .hd_reg = -1,
  625. .hd_shift = -1,
  626. .enable_reg = AFE_DAC_CON0,
  627. .enable_shift = 1,
  628. .msb_reg = AFE_MEMIF_MSB,
  629. .msb_shift = 0,
  630. .agent_disable_reg = -1,
  631. .agent_disable_shift = -1,
  632. }, {
  633. .name = "DL2",
  634. .id = MT8173_AFE_MEMIF_DL2,
  635. .reg_ofs_base = AFE_DL2_BASE,
  636. .reg_ofs_cur = AFE_DL2_CUR,
  637. .fs_reg = AFE_DAC_CON1,
  638. .fs_shift = 4,
  639. .fs_maskbit = 0xf,
  640. .mono_reg = AFE_DAC_CON1,
  641. .mono_shift = 22,
  642. .hd_reg = -1,
  643. .hd_shift = -1,
  644. .enable_reg = AFE_DAC_CON0,
  645. .enable_shift = 2,
  646. .msb_reg = AFE_MEMIF_MSB,
  647. .msb_shift = 1,
  648. .agent_disable_reg = -1,
  649. .agent_disable_shift = -1,
  650. }, {
  651. .name = "VUL",
  652. .id = MT8173_AFE_MEMIF_VUL,
  653. .reg_ofs_base = AFE_VUL_BASE,
  654. .reg_ofs_cur = AFE_VUL_CUR,
  655. .fs_reg = AFE_DAC_CON1,
  656. .fs_shift = 16,
  657. .fs_maskbit = 0xf,
  658. .mono_reg = AFE_DAC_CON1,
  659. .mono_shift = 27,
  660. .hd_reg = -1,
  661. .hd_shift = -1,
  662. .enable_reg = AFE_DAC_CON0,
  663. .enable_shift = 3,
  664. .msb_reg = AFE_MEMIF_MSB,
  665. .msb_shift = 6,
  666. .agent_disable_reg = -1,
  667. .agent_disable_shift = -1,
  668. }, {
  669. .name = "DAI",
  670. .id = MT8173_AFE_MEMIF_DAI,
  671. .reg_ofs_base = AFE_DAI_BASE,
  672. .reg_ofs_cur = AFE_DAI_CUR,
  673. .fs_reg = AFE_DAC_CON0,
  674. .fs_shift = 24,
  675. .fs_maskbit = 0x3,
  676. .mono_reg = -1,
  677. .mono_shift = -1,
  678. .hd_reg = -1,
  679. .hd_shift = -1,
  680. .enable_reg = AFE_DAC_CON0,
  681. .enable_shift = 4,
  682. .msb_reg = AFE_MEMIF_MSB,
  683. .msb_shift = 5,
  684. .agent_disable_reg = -1,
  685. .agent_disable_shift = -1,
  686. }, {
  687. .name = "AWB",
  688. .id = MT8173_AFE_MEMIF_AWB,
  689. .reg_ofs_base = AFE_AWB_BASE,
  690. .reg_ofs_cur = AFE_AWB_CUR,
  691. .fs_reg = AFE_DAC_CON1,
  692. .fs_shift = 12,
  693. .fs_maskbit = 0xf,
  694. .mono_reg = AFE_DAC_CON1,
  695. .mono_shift = 24,
  696. .hd_reg = -1,
  697. .hd_shift = -1,
  698. .enable_reg = AFE_DAC_CON0,
  699. .enable_shift = 6,
  700. .msb_reg = AFE_MEMIF_MSB,
  701. .msb_shift = 3,
  702. .agent_disable_reg = -1,
  703. .agent_disable_shift = -1,
  704. }, {
  705. .name = "MOD_DAI",
  706. .id = MT8173_AFE_MEMIF_MOD_DAI,
  707. .reg_ofs_base = AFE_MOD_PCM_BASE,
  708. .reg_ofs_cur = AFE_MOD_PCM_CUR,
  709. .fs_reg = AFE_DAC_CON1,
  710. .fs_shift = 30,
  711. .fs_maskbit = 0x3,
  712. .mono_reg = AFE_DAC_CON1,
  713. .mono_shift = 30,
  714. .hd_reg = -1,
  715. .hd_shift = -1,
  716. .enable_reg = AFE_DAC_CON0,
  717. .enable_shift = 7,
  718. .msb_reg = AFE_MEMIF_MSB,
  719. .msb_shift = 4,
  720. .agent_disable_reg = -1,
  721. .agent_disable_shift = -1,
  722. }, {
  723. .name = "HDMI",
  724. .id = MT8173_AFE_MEMIF_HDMI,
  725. .reg_ofs_base = AFE_HDMI_OUT_BASE,
  726. .reg_ofs_cur = AFE_HDMI_OUT_CUR,
  727. .fs_reg = -1,
  728. .fs_shift = -1,
  729. .fs_maskbit = -1,
  730. .mono_reg = -1,
  731. .mono_shift = -1,
  732. .hd_reg = -1,
  733. .hd_shift = -1,
  734. .enable_reg = -1,
  735. .enable_shift = -1,
  736. .msb_reg = AFE_MEMIF_MSB,
  737. .msb_shift = 8,
  738. .agent_disable_reg = -1,
  739. .agent_disable_shift = -1,
  740. },
  741. };
  742. static const struct mtk_base_irq_data irq_data[MT8173_AFE_IRQ_NUM] = {
  743. {
  744. .id = MT8173_AFE_IRQ_DL1,
  745. .irq_cnt_reg = AFE_IRQ_CNT1,
  746. .irq_cnt_shift = 0,
  747. .irq_cnt_maskbit = 0x3ffff,
  748. .irq_en_reg = AFE_IRQ_MCU_CON,
  749. .irq_en_shift = 0,
  750. .irq_fs_reg = AFE_IRQ_MCU_CON,
  751. .irq_fs_shift = 4,
  752. .irq_fs_maskbit = 0xf,
  753. .irq_clr_reg = AFE_IRQ_CLR,
  754. .irq_clr_shift = 0,
  755. }, {
  756. .id = MT8173_AFE_IRQ_DL2,
  757. .irq_cnt_reg = AFE_IRQ_CNT1,
  758. .irq_cnt_shift = 20,
  759. .irq_cnt_maskbit = 0x3ffff,
  760. .irq_en_reg = AFE_IRQ_MCU_CON,
  761. .irq_en_shift = 2,
  762. .irq_fs_reg = AFE_IRQ_MCU_CON,
  763. .irq_fs_shift = 16,
  764. .irq_fs_maskbit = 0xf,
  765. .irq_clr_reg = AFE_IRQ_CLR,
  766. .irq_clr_shift = 2,
  767. }, {
  768. .id = MT8173_AFE_IRQ_VUL,
  769. .irq_cnt_reg = AFE_IRQ_CNT2,
  770. .irq_cnt_shift = 0,
  771. .irq_cnt_maskbit = 0x3ffff,
  772. .irq_en_reg = AFE_IRQ_MCU_CON,
  773. .irq_en_shift = 1,
  774. .irq_fs_reg = AFE_IRQ_MCU_CON,
  775. .irq_fs_shift = 8,
  776. .irq_fs_maskbit = 0xf,
  777. .irq_clr_reg = AFE_IRQ_CLR,
  778. .irq_clr_shift = 1,
  779. }, {
  780. .id = MT8173_AFE_IRQ_DAI,
  781. .irq_cnt_reg = AFE_IRQ_CNT2,
  782. .irq_cnt_shift = 20,
  783. .irq_cnt_maskbit = 0x3ffff,
  784. .irq_en_reg = AFE_IRQ_MCU_CON,
  785. .irq_en_shift = 3,
  786. .irq_fs_reg = AFE_IRQ_MCU_CON,
  787. .irq_fs_shift = 20,
  788. .irq_fs_maskbit = 0xf,
  789. .irq_clr_reg = AFE_IRQ_CLR,
  790. .irq_clr_shift = 3,
  791. }, {
  792. .id = MT8173_AFE_IRQ_AWB,
  793. .irq_cnt_reg = AFE_IRQ_CNT7,
  794. .irq_cnt_shift = 0,
  795. .irq_cnt_maskbit = 0x3ffff,
  796. .irq_en_reg = AFE_IRQ_MCU_CON,
  797. .irq_en_shift = 14,
  798. .irq_fs_reg = AFE_IRQ_MCU_CON,
  799. .irq_fs_shift = 24,
  800. .irq_fs_maskbit = 0xf,
  801. .irq_clr_reg = AFE_IRQ_CLR,
  802. .irq_clr_shift = 6,
  803. }, {
  804. .id = MT8173_AFE_IRQ_DAI,
  805. .irq_cnt_reg = AFE_IRQ_CNT2,
  806. .irq_cnt_shift = 20,
  807. .irq_cnt_maskbit = 0x3ffff,
  808. .irq_en_reg = AFE_IRQ_MCU_CON,
  809. .irq_en_shift = 3,
  810. .irq_fs_reg = AFE_IRQ_MCU_CON,
  811. .irq_fs_shift = 20,
  812. .irq_fs_maskbit = 0xf,
  813. .irq_clr_reg = AFE_IRQ_CLR,
  814. .irq_clr_shift = 3,
  815. }, {
  816. .id = MT8173_AFE_IRQ_HDMI,
  817. .irq_cnt_reg = AFE_IRQ_CNT5,
  818. .irq_cnt_shift = 0,
  819. .irq_cnt_maskbit = 0x3ffff,
  820. .irq_en_reg = AFE_IRQ_MCU_CON,
  821. .irq_en_shift = 12,
  822. .irq_fs_reg = -1,
  823. .irq_fs_shift = -1,
  824. .irq_fs_maskbit = -1,
  825. .irq_clr_reg = AFE_IRQ_CLR,
  826. .irq_clr_shift = 4,
  827. },
  828. };
  829. static const struct regmap_config mt8173_afe_regmap_config = {
  830. .reg_bits = 32,
  831. .reg_stride = 4,
  832. .val_bits = 32,
  833. .max_register = AFE_ADDA2_TOP_CON0,
  834. .cache_type = REGCACHE_NONE,
  835. };
  836. static irqreturn_t mt8173_afe_irq_handler(int irq, void *dev_id)
  837. {
  838. struct mtk_base_afe *afe = dev_id;
  839. unsigned int reg_value;
  840. int i, ret;
  841. ret = regmap_read(afe->regmap, AFE_IRQ_STATUS, &reg_value);
  842. if (ret) {
  843. dev_err(afe->dev, "%s irq status err\n", __func__);
  844. reg_value = AFE_IRQ_STATUS_BITS;
  845. goto err_irq;
  846. }
  847. for (i = 0; i < MT8173_AFE_MEMIF_NUM; i++) {
  848. struct mtk_base_afe_memif *memif = &afe->memif[i];
  849. struct mtk_base_afe_irq *irq;
  850. if (memif->irq_usage < 0)
  851. continue;
  852. irq = &afe->irqs[memif->irq_usage];
  853. if (!(reg_value & (1 << irq->irq_data->irq_clr_shift)))
  854. continue;
  855. snd_pcm_period_elapsed(memif->substream);
  856. }
  857. err_irq:
  858. /* clear irq */
  859. regmap_write(afe->regmap, AFE_IRQ_CLR,
  860. reg_value & AFE_IRQ_STATUS_BITS);
  861. return IRQ_HANDLED;
  862. }
  863. static int mt8173_afe_runtime_suspend(struct device *dev)
  864. {
  865. struct mtk_base_afe *afe = dev_get_drvdata(dev);
  866. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  867. /* disable AFE */
  868. regmap_update_bits(afe->regmap, AFE_DAC_CON0, 0x1, 0);
  869. /* disable AFE clk */
  870. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0,
  871. AUD_TCON0_PDN_AFE, AUD_TCON0_PDN_AFE);
  872. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S1_M]);
  873. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S2_M]);
  874. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_BCK0]);
  875. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_BCK1]);
  876. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD]);
  877. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD_BUS]);
  878. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_INFRASYS_AUD]);
  879. return 0;
  880. }
  881. static int mt8173_afe_runtime_resume(struct device *dev)
  882. {
  883. struct mtk_base_afe *afe = dev_get_drvdata(dev);
  884. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  885. int ret;
  886. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_INFRASYS_AUD]);
  887. if (ret)
  888. return ret;
  889. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD_BUS]);
  890. if (ret)
  891. goto err_infra;
  892. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD]);
  893. if (ret)
  894. goto err_top_aud_bus;
  895. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_BCK0]);
  896. if (ret)
  897. goto err_top_aud;
  898. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_BCK1]);
  899. if (ret)
  900. goto err_bck0;
  901. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_I2S1_M]);
  902. if (ret)
  903. goto err_i2s1_m;
  904. ret = clk_prepare_enable(afe_priv->clocks[MT8173_CLK_I2S2_M]);
  905. if (ret)
  906. goto err_i2s2_m;
  907. /* enable AFE clk */
  908. regmap_update_bits(afe->regmap, AUDIO_TOP_CON0, AUD_TCON0_PDN_AFE, 0);
  909. /* set O3/O4 16bits */
  910. regmap_update_bits(afe->regmap, AFE_CONN_24BIT,
  911. AFE_CONN_24BIT_O03 | AFE_CONN_24BIT_O04, 0);
  912. /* unmask all IRQs */
  913. regmap_update_bits(afe->regmap, AFE_IRQ_MCU_EN, 0xff, 0xff);
  914. /* enable AFE */
  915. regmap_update_bits(afe->regmap, AFE_DAC_CON0, 0x1, 0x1);
  916. return 0;
  917. err_i2s1_m:
  918. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S1_M]);
  919. err_i2s2_m:
  920. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_I2S2_M]);
  921. err_bck0:
  922. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_BCK0]);
  923. err_top_aud:
  924. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD]);
  925. err_top_aud_bus:
  926. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_TOP_PDN_AUD_BUS]);
  927. err_infra:
  928. clk_disable_unprepare(afe_priv->clocks[MT8173_CLK_INFRASYS_AUD]);
  929. return ret;
  930. }
  931. static int mt8173_afe_init_audio_clk(struct mtk_base_afe *afe)
  932. {
  933. size_t i;
  934. struct mt8173_afe_private *afe_priv = afe->platform_priv;
  935. for (i = 0; i < ARRAY_SIZE(aud_clks); i++) {
  936. afe_priv->clocks[i] = devm_clk_get(afe->dev, aud_clks[i]);
  937. if (IS_ERR(afe_priv->clocks[i])) {
  938. dev_err(afe->dev, "%s devm_clk_get %s fail\n",
  939. __func__, aud_clks[i]);
  940. return PTR_ERR(afe_priv->clocks[i]);
  941. }
  942. }
  943. clk_set_rate(afe_priv->clocks[MT8173_CLK_BCK0], 22579200); /* 22M */
  944. clk_set_rate(afe_priv->clocks[MT8173_CLK_BCK1], 24576000); /* 24M */
  945. return 0;
  946. }
  947. static int mt8173_afe_pcm_dev_probe(struct platform_device *pdev)
  948. {
  949. int ret, i;
  950. int irq_id;
  951. struct mtk_base_afe *afe;
  952. struct mt8173_afe_private *afe_priv;
  953. struct resource *res;
  954. ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(33));
  955. if (ret)
  956. return ret;
  957. afe = devm_kzalloc(&pdev->dev, sizeof(*afe), GFP_KERNEL);
  958. if (!afe)
  959. return -ENOMEM;
  960. afe->platform_priv = devm_kzalloc(&pdev->dev, sizeof(*afe_priv),
  961. GFP_KERNEL);
  962. afe_priv = afe->platform_priv;
  963. if (!afe_priv)
  964. return -ENOMEM;
  965. afe->dev = &pdev->dev;
  966. irq_id = platform_get_irq(pdev, 0);
  967. if (irq_id <= 0) {
  968. dev_err(afe->dev, "np %s no irq\n", afe->dev->of_node->name);
  969. return irq_id < 0 ? irq_id : -ENXIO;
  970. }
  971. ret = devm_request_irq(afe->dev, irq_id, mt8173_afe_irq_handler,
  972. 0, "Afe_ISR_Handle", (void *)afe);
  973. if (ret) {
  974. dev_err(afe->dev, "could not request_irq\n");
  975. return ret;
  976. }
  977. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  978. afe->base_addr = devm_ioremap_resource(&pdev->dev, res);
  979. if (IS_ERR(afe->base_addr))
  980. return PTR_ERR(afe->base_addr);
  981. afe->regmap = devm_regmap_init_mmio(&pdev->dev, afe->base_addr,
  982. &mt8173_afe_regmap_config);
  983. if (IS_ERR(afe->regmap))
  984. return PTR_ERR(afe->regmap);
  985. /* initial audio related clock */
  986. ret = mt8173_afe_init_audio_clk(afe);
  987. if (ret) {
  988. dev_err(afe->dev, "mt8173_afe_init_audio_clk fail\n");
  989. return ret;
  990. }
  991. /* memif % irq initialize*/
  992. afe->memif_size = MT8173_AFE_MEMIF_NUM;
  993. afe->memif = devm_kcalloc(afe->dev, afe->memif_size,
  994. sizeof(*afe->memif), GFP_KERNEL);
  995. if (!afe->memif)
  996. return -ENOMEM;
  997. afe->irqs_size = MT8173_AFE_IRQ_NUM;
  998. afe->irqs = devm_kcalloc(afe->dev, afe->irqs_size,
  999. sizeof(*afe->irqs), GFP_KERNEL);
  1000. if (!afe->irqs)
  1001. return -ENOMEM;
  1002. for (i = 0; i < afe->irqs_size; i++) {
  1003. afe->memif[i].data = &memif_data[i];
  1004. afe->irqs[i].irq_data = &irq_data[i];
  1005. afe->irqs[i].irq_occupyed = true;
  1006. afe->memif[i].irq_usage = i;
  1007. afe->memif[i].const_irq = 1;
  1008. }
  1009. afe->mtk_afe_hardware = &mt8173_afe_hardware;
  1010. afe->memif_fs = mt8173_memif_fs;
  1011. afe->irq_fs = mt8173_irq_fs;
  1012. platform_set_drvdata(pdev, afe);
  1013. pm_runtime_enable(&pdev->dev);
  1014. if (!pm_runtime_enabled(&pdev->dev)) {
  1015. ret = mt8173_afe_runtime_resume(&pdev->dev);
  1016. if (ret)
  1017. goto err_pm_disable;
  1018. }
  1019. afe->reg_back_up_list = mt8173_afe_backup_list;
  1020. afe->reg_back_up_list_num = ARRAY_SIZE(mt8173_afe_backup_list);
  1021. afe->runtime_resume = mt8173_afe_runtime_resume;
  1022. afe->runtime_suspend = mt8173_afe_runtime_suspend;
  1023. ret = devm_snd_soc_register_component(&pdev->dev,
  1024. &mtk_afe_pcm_platform,
  1025. NULL, 0);
  1026. if (ret)
  1027. goto err_pm_disable;
  1028. ret = devm_snd_soc_register_component(&pdev->dev,
  1029. &mt8173_afe_pcm_dai_component,
  1030. mt8173_afe_pcm_dais,
  1031. ARRAY_SIZE(mt8173_afe_pcm_dais));
  1032. if (ret)
  1033. goto err_pm_disable;
  1034. ret = devm_snd_soc_register_component(&pdev->dev,
  1035. &mt8173_afe_hdmi_dai_component,
  1036. mt8173_afe_hdmi_dais,
  1037. ARRAY_SIZE(mt8173_afe_hdmi_dais));
  1038. if (ret)
  1039. goto err_pm_disable;
  1040. dev_info(&pdev->dev, "MT8173 AFE driver initialized.\n");
  1041. return 0;
  1042. err_pm_disable:
  1043. pm_runtime_disable(&pdev->dev);
  1044. return ret;
  1045. }
  1046. static int mt8173_afe_pcm_dev_remove(struct platform_device *pdev)
  1047. {
  1048. pm_runtime_disable(&pdev->dev);
  1049. if (!pm_runtime_status_suspended(&pdev->dev))
  1050. mt8173_afe_runtime_suspend(&pdev->dev);
  1051. return 0;
  1052. }
  1053. static const struct of_device_id mt8173_afe_pcm_dt_match[] = {
  1054. { .compatible = "mediatek,mt8173-afe-pcm", },
  1055. { }
  1056. };
  1057. MODULE_DEVICE_TABLE(of, mt8173_afe_pcm_dt_match);
  1058. static const struct dev_pm_ops mt8173_afe_pm_ops = {
  1059. SET_RUNTIME_PM_OPS(mt8173_afe_runtime_suspend,
  1060. mt8173_afe_runtime_resume, NULL)
  1061. };
  1062. static struct platform_driver mt8173_afe_pcm_driver = {
  1063. .driver = {
  1064. .name = "mt8173-afe-pcm",
  1065. .of_match_table = mt8173_afe_pcm_dt_match,
  1066. .pm = &mt8173_afe_pm_ops,
  1067. },
  1068. .probe = mt8173_afe_pcm_dev_probe,
  1069. .remove = mt8173_afe_pcm_dev_remove,
  1070. };
  1071. module_platform_driver(mt8173_afe_pcm_driver);
  1072. MODULE_DESCRIPTION("Mediatek ALSA SoC AFE platform driver");
  1073. MODULE_AUTHOR("Koro Chen <koro.chen@mediatek.com>");
  1074. MODULE_LICENSE("GPL v2");