lpass-va-macro.c 48 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. // Copyright (c) 2018-2020, The Linux Foundation. All rights reserved.
  3. #include <linux/clk.h>
  4. #include <linux/clk-provider.h>
  5. #include <linux/init.h>
  6. #include <linux/io.h>
  7. #include <linux/module.h>
  8. #include <linux/of_clk.h>
  9. #include <linux/of_platform.h>
  10. #include <linux/platform_device.h>
  11. #include <linux/pm_runtime.h>
  12. #include <linux/regmap.h>
  13. #include <linux/regulator/consumer.h>
  14. #include <sound/soc.h>
  15. #include <sound/soc-dapm.h>
  16. #include <sound/tlv.h>
  17. #include "lpass-macro-common.h"
  18. /* VA macro registers */
  19. #define CDC_VA_CLK_RST_CTRL_MCLK_CONTROL (0x0000)
  20. #define CDC_VA_MCLK_CONTROL_EN BIT(0)
  21. #define CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL (0x0004)
  22. #define CDC_VA_FS_CONTROL_EN BIT(0)
  23. #define CDC_VA_FS_COUNTER_CLR BIT(1)
  24. #define CDC_VA_CLK_RST_CTRL_SWR_CONTROL (0x0008)
  25. #define CDC_VA_SWR_RESET_MASK BIT(1)
  26. #define CDC_VA_SWR_RESET_ENABLE BIT(1)
  27. #define CDC_VA_SWR_CLK_EN_MASK BIT(0)
  28. #define CDC_VA_SWR_CLK_ENABLE BIT(0)
  29. #define CDC_VA_TOP_CSR_TOP_CFG0 (0x0080)
  30. #define CDC_VA_FS_BROADCAST_EN BIT(1)
  31. #define CDC_VA_TOP_CSR_DMIC0_CTL (0x0084)
  32. #define CDC_VA_TOP_CSR_DMIC1_CTL (0x0088)
  33. #define CDC_VA_TOP_CSR_DMIC2_CTL (0x008C)
  34. #define CDC_VA_TOP_CSR_DMIC3_CTL (0x0090)
  35. #define CDC_VA_DMIC_EN_MASK BIT(0)
  36. #define CDC_VA_DMIC_ENABLE BIT(0)
  37. #define CDC_VA_DMIC_CLK_SEL_MASK GENMASK(3, 1)
  38. #define CDC_VA_DMIC_CLK_SEL_SHFT 1
  39. #define CDC_VA_DMIC_CLK_SEL_DIV0 0x0
  40. #define CDC_VA_DMIC_CLK_SEL_DIV1 0x2
  41. #define CDC_VA_DMIC_CLK_SEL_DIV2 0x4
  42. #define CDC_VA_DMIC_CLK_SEL_DIV3 0x6
  43. #define CDC_VA_DMIC_CLK_SEL_DIV4 0x8
  44. #define CDC_VA_DMIC_CLK_SEL_DIV5 0xa
  45. #define CDC_VA_TOP_CSR_DMIC_CFG (0x0094)
  46. #define CDC_VA_RESET_ALL_DMICS_MASK BIT(7)
  47. #define CDC_VA_RESET_ALL_DMICS_RESET BIT(7)
  48. #define CDC_VA_RESET_ALL_DMICS_DISABLE 0
  49. #define CDC_VA_DMIC3_FREQ_CHANGE_MASK BIT(3)
  50. #define CDC_VA_DMIC3_FREQ_CHANGE_EN BIT(3)
  51. #define CDC_VA_DMIC2_FREQ_CHANGE_MASK BIT(2)
  52. #define CDC_VA_DMIC2_FREQ_CHANGE_EN BIT(2)
  53. #define CDC_VA_DMIC1_FREQ_CHANGE_MASK BIT(1)
  54. #define CDC_VA_DMIC1_FREQ_CHANGE_EN BIT(1)
  55. #define CDC_VA_DMIC0_FREQ_CHANGE_MASK BIT(0)
  56. #define CDC_VA_DMIC0_FREQ_CHANGE_EN BIT(0)
  57. #define CDC_VA_DMIC_FREQ_CHANGE_DISABLE 0
  58. #define CDC_VA_TOP_CSR_DEBUG_BUS (0x009C)
  59. #define CDC_VA_TOP_CSR_DEBUG_EN (0x00A0)
  60. #define CDC_VA_TOP_CSR_TX_I2S_CTL (0x00A4)
  61. #define CDC_VA_TOP_CSR_I2S_CLK (0x00A8)
  62. #define CDC_VA_TOP_CSR_I2S_RESET (0x00AC)
  63. #define CDC_VA_TOP_CSR_CORE_ID_0 (0x00C0)
  64. #define CDC_VA_TOP_CSR_CORE_ID_1 (0x00C4)
  65. #define CDC_VA_TOP_CSR_CORE_ID_2 (0x00C8)
  66. #define CDC_VA_TOP_CSR_CORE_ID_3 (0x00CC)
  67. #define CDC_VA_TOP_CSR_SWR_MIC_CTL0 (0x00D0)
  68. #define CDC_VA_TOP_CSR_SWR_MIC_CTL1 (0x00D4)
  69. #define CDC_VA_TOP_CSR_SWR_MIC_CTL2 (0x00D8)
  70. #define CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK (0xEE)
  71. #define CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1 (0xCC)
  72. #define CDC_VA_TOP_CSR_SWR_CTRL (0x00DC)
  73. #define CDC_VA_INP_MUX_ADC_MUX0_CFG0 (0x0100)
  74. #define CDC_VA_INP_MUX_ADC_MUX0_CFG1 (0x0104)
  75. #define CDC_VA_INP_MUX_ADC_MUX1_CFG0 (0x0108)
  76. #define CDC_VA_INP_MUX_ADC_MUX1_CFG1 (0x010C)
  77. #define CDC_VA_INP_MUX_ADC_MUX2_CFG0 (0x0110)
  78. #define CDC_VA_INP_MUX_ADC_MUX2_CFG1 (0x0114)
  79. #define CDC_VA_INP_MUX_ADC_MUX3_CFG0 (0x0118)
  80. #define CDC_VA_INP_MUX_ADC_MUX3_CFG1 (0x011C)
  81. #define CDC_VA_TX0_TX_PATH_CTL (0x0400)
  82. #define CDC_VA_TX_PATH_CLK_EN_MASK BIT(5)
  83. #define CDC_VA_TX_PATH_CLK_EN BIT(5)
  84. #define CDC_VA_TX_PATH_CLK_DISABLE 0
  85. #define CDC_VA_TX_PATH_PGA_MUTE_EN_MASK BIT(4)
  86. #define CDC_VA_TX_PATH_PGA_MUTE_EN BIT(4)
  87. #define CDC_VA_TX_PATH_PGA_MUTE_DISABLE 0
  88. #define CDC_VA_TX0_TX_PATH_CFG0 (0x0404)
  89. #define CDC_VA_ADC_MODE_MASK GENMASK(2, 1)
  90. #define CDC_VA_ADC_MODE_SHIFT 1
  91. #define TX_HPF_CUT_OFF_FREQ_MASK GENMASK(6, 5)
  92. #define CF_MIN_3DB_4HZ 0x0
  93. #define CF_MIN_3DB_75HZ 0x1
  94. #define CF_MIN_3DB_150HZ 0x2
  95. #define CDC_VA_TX0_TX_PATH_CFG1 (0x0408)
  96. #define CDC_VA_TX0_TX_VOL_CTL (0x040C)
  97. #define CDC_VA_TX0_TX_PATH_SEC0 (0x0410)
  98. #define CDC_VA_TX0_TX_PATH_SEC1 (0x0414)
  99. #define CDC_VA_TX0_TX_PATH_SEC2 (0x0418)
  100. #define CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_MASK BIT(1)
  101. #define CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_REQ BIT(1)
  102. #define CDC_VA_TX_HPF_ZERO_GATE_MASK BIT(0)
  103. #define CDC_VA_TX_HPF_ZERO_NO_GATE BIT(0)
  104. #define CDC_VA_TX_HPF_ZERO_GATE 0
  105. #define CDC_VA_TX0_TX_PATH_SEC3 (0x041C)
  106. #define CDC_VA_TX0_TX_PATH_SEC4 (0x0420)
  107. #define CDC_VA_TX0_TX_PATH_SEC5 (0x0424)
  108. #define CDC_VA_TX0_TX_PATH_SEC6 (0x0428)
  109. #define CDC_VA_TX0_TX_PATH_SEC7 (0x042C)
  110. #define CDC_VA_TX1_TX_PATH_CTL (0x0480)
  111. #define CDC_VA_TX1_TX_PATH_CFG0 (0x0484)
  112. #define CDC_VA_TX1_TX_PATH_CFG1 (0x0488)
  113. #define CDC_VA_TX1_TX_VOL_CTL (0x048C)
  114. #define CDC_VA_TX1_TX_PATH_SEC0 (0x0490)
  115. #define CDC_VA_TX1_TX_PATH_SEC1 (0x0494)
  116. #define CDC_VA_TX1_TX_PATH_SEC2 (0x0498)
  117. #define CDC_VA_TX1_TX_PATH_SEC3 (0x049C)
  118. #define CDC_VA_TX1_TX_PATH_SEC4 (0x04A0)
  119. #define CDC_VA_TX1_TX_PATH_SEC5 (0x04A4)
  120. #define CDC_VA_TX1_TX_PATH_SEC6 (0x04A8)
  121. #define CDC_VA_TX2_TX_PATH_CTL (0x0500)
  122. #define CDC_VA_TX2_TX_PATH_CFG0 (0x0504)
  123. #define CDC_VA_TX2_TX_PATH_CFG1 (0x0508)
  124. #define CDC_VA_TX2_TX_VOL_CTL (0x050C)
  125. #define CDC_VA_TX2_TX_PATH_SEC0 (0x0510)
  126. #define CDC_VA_TX2_TX_PATH_SEC1 (0x0514)
  127. #define CDC_VA_TX2_TX_PATH_SEC2 (0x0518)
  128. #define CDC_VA_TX2_TX_PATH_SEC3 (0x051C)
  129. #define CDC_VA_TX2_TX_PATH_SEC4 (0x0520)
  130. #define CDC_VA_TX2_TX_PATH_SEC5 (0x0524)
  131. #define CDC_VA_TX2_TX_PATH_SEC6 (0x0528)
  132. #define CDC_VA_TX3_TX_PATH_CTL (0x0580)
  133. #define CDC_VA_TX3_TX_PATH_CFG0 (0x0584)
  134. #define CDC_VA_TX_PATH_ADC_DMIC_SEL_MASK BIT(7)
  135. #define CDC_VA_TX_PATH_ADC_DMIC_SEL_DMIC BIT(7)
  136. #define CDC_VA_TX_PATH_ADC_DMIC_SEL_ADC 0
  137. #define CDC_VA_TX3_TX_PATH_CFG1 (0x0588)
  138. #define CDC_VA_TX3_TX_VOL_CTL (0x058C)
  139. #define CDC_VA_TX3_TX_PATH_SEC0 (0x0590)
  140. #define CDC_VA_TX3_TX_PATH_SEC1 (0x0594)
  141. #define CDC_VA_TX3_TX_PATH_SEC2 (0x0598)
  142. #define CDC_VA_TX3_TX_PATH_SEC3 (0x059C)
  143. #define CDC_VA_TX3_TX_PATH_SEC4 (0x05A0)
  144. #define CDC_VA_TX3_TX_PATH_SEC5 (0x05A4)
  145. #define CDC_VA_TX3_TX_PATH_SEC6 (0x05A8)
  146. #define VA_MAX_OFFSET (0x07A8)
  147. #define VA_MACRO_NUM_DECIMATORS 4
  148. #define VA_MACRO_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
  149. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\
  150. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
  151. #define VA_MACRO_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
  152. SNDRV_PCM_FMTBIT_S24_LE |\
  153. SNDRV_PCM_FMTBIT_S24_3LE)
  154. #define VA_MACRO_MCLK_FREQ 9600000
  155. #define VA_MACRO_TX_PATH_OFFSET 0x80
  156. #define VA_MACRO_SWR_MIC_MUX_SEL_MASK 0xF
  157. #define VA_MACRO_ADC_MUX_CFG_OFFSET 0x8
  158. static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400);
  159. enum {
  160. VA_MACRO_AIF_INVALID = 0,
  161. VA_MACRO_AIF1_CAP,
  162. VA_MACRO_AIF2_CAP,
  163. VA_MACRO_AIF3_CAP,
  164. VA_MACRO_MAX_DAIS,
  165. };
  166. enum {
  167. VA_MACRO_DEC0,
  168. VA_MACRO_DEC1,
  169. VA_MACRO_DEC2,
  170. VA_MACRO_DEC3,
  171. VA_MACRO_DEC4,
  172. VA_MACRO_DEC5,
  173. VA_MACRO_DEC6,
  174. VA_MACRO_DEC7,
  175. VA_MACRO_DEC_MAX,
  176. };
  177. enum {
  178. VA_MACRO_CLK_DIV_2,
  179. VA_MACRO_CLK_DIV_3,
  180. VA_MACRO_CLK_DIV_4,
  181. VA_MACRO_CLK_DIV_6,
  182. VA_MACRO_CLK_DIV_8,
  183. VA_MACRO_CLK_DIV_16,
  184. };
  185. #define VA_NUM_CLKS_MAX 3
  186. struct va_macro {
  187. struct device *dev;
  188. unsigned long active_ch_mask[VA_MACRO_MAX_DAIS];
  189. unsigned long active_ch_cnt[VA_MACRO_MAX_DAIS];
  190. u16 dmic_clk_div;
  191. bool has_swr_master;
  192. int dec_mode[VA_MACRO_NUM_DECIMATORS];
  193. struct regmap *regmap;
  194. struct clk *mclk;
  195. struct clk *macro;
  196. struct clk *dcodec;
  197. struct clk *fsgen;
  198. struct clk_hw hw;
  199. struct lpass_macro *pds;
  200. s32 dmic_0_1_clk_cnt;
  201. s32 dmic_2_3_clk_cnt;
  202. s32 dmic_4_5_clk_cnt;
  203. s32 dmic_6_7_clk_cnt;
  204. u8 dmic_0_1_clk_div;
  205. u8 dmic_2_3_clk_div;
  206. u8 dmic_4_5_clk_div;
  207. u8 dmic_6_7_clk_div;
  208. };
  209. #define to_va_macro(_hw) container_of(_hw, struct va_macro, hw)
  210. struct va_macro_data {
  211. bool has_swr_master;
  212. };
  213. static const struct va_macro_data sm8250_va_data = {
  214. .has_swr_master = false,
  215. };
  216. static const struct va_macro_data sm8450_va_data = {
  217. .has_swr_master = true,
  218. };
  219. static bool va_is_volatile_register(struct device *dev, unsigned int reg)
  220. {
  221. switch (reg) {
  222. case CDC_VA_TOP_CSR_CORE_ID_0:
  223. case CDC_VA_TOP_CSR_CORE_ID_1:
  224. case CDC_VA_TOP_CSR_CORE_ID_2:
  225. case CDC_VA_TOP_CSR_CORE_ID_3:
  226. case CDC_VA_TOP_CSR_DMIC0_CTL:
  227. case CDC_VA_TOP_CSR_DMIC1_CTL:
  228. case CDC_VA_TOP_CSR_DMIC2_CTL:
  229. case CDC_VA_TOP_CSR_DMIC3_CTL:
  230. return true;
  231. }
  232. return false;
  233. }
  234. static const struct reg_default va_defaults[] = {
  235. /* VA macro */
  236. { CDC_VA_CLK_RST_CTRL_MCLK_CONTROL, 0x00},
  237. { CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL, 0x00},
  238. { CDC_VA_CLK_RST_CTRL_SWR_CONTROL, 0x00},
  239. { CDC_VA_TOP_CSR_TOP_CFG0, 0x00},
  240. { CDC_VA_TOP_CSR_DMIC0_CTL, 0x00},
  241. { CDC_VA_TOP_CSR_DMIC1_CTL, 0x00},
  242. { CDC_VA_TOP_CSR_DMIC2_CTL, 0x00},
  243. { CDC_VA_TOP_CSR_DMIC3_CTL, 0x00},
  244. { CDC_VA_TOP_CSR_DMIC_CFG, 0x80},
  245. { CDC_VA_TOP_CSR_DEBUG_BUS, 0x00},
  246. { CDC_VA_TOP_CSR_DEBUG_EN, 0x00},
  247. { CDC_VA_TOP_CSR_TX_I2S_CTL, 0x0C},
  248. { CDC_VA_TOP_CSR_I2S_CLK, 0x00},
  249. { CDC_VA_TOP_CSR_I2S_RESET, 0x00},
  250. { CDC_VA_TOP_CSR_CORE_ID_0, 0x00},
  251. { CDC_VA_TOP_CSR_CORE_ID_1, 0x00},
  252. { CDC_VA_TOP_CSR_CORE_ID_2, 0x00},
  253. { CDC_VA_TOP_CSR_CORE_ID_3, 0x00},
  254. { CDC_VA_TOP_CSR_SWR_MIC_CTL0, 0xEE},
  255. { CDC_VA_TOP_CSR_SWR_MIC_CTL1, 0xEE},
  256. { CDC_VA_TOP_CSR_SWR_MIC_CTL2, 0xEE},
  257. { CDC_VA_TOP_CSR_SWR_CTRL, 0x06},
  258. /* VA core */
  259. { CDC_VA_INP_MUX_ADC_MUX0_CFG0, 0x00},
  260. { CDC_VA_INP_MUX_ADC_MUX0_CFG1, 0x00},
  261. { CDC_VA_INP_MUX_ADC_MUX1_CFG0, 0x00},
  262. { CDC_VA_INP_MUX_ADC_MUX1_CFG1, 0x00},
  263. { CDC_VA_INP_MUX_ADC_MUX2_CFG0, 0x00},
  264. { CDC_VA_INP_MUX_ADC_MUX2_CFG1, 0x00},
  265. { CDC_VA_INP_MUX_ADC_MUX3_CFG0, 0x00},
  266. { CDC_VA_INP_MUX_ADC_MUX3_CFG1, 0x00},
  267. { CDC_VA_TX0_TX_PATH_CTL, 0x04},
  268. { CDC_VA_TX0_TX_PATH_CFG0, 0x10},
  269. { CDC_VA_TX0_TX_PATH_CFG1, 0x0B},
  270. { CDC_VA_TX0_TX_VOL_CTL, 0x00},
  271. { CDC_VA_TX0_TX_PATH_SEC0, 0x00},
  272. { CDC_VA_TX0_TX_PATH_SEC1, 0x00},
  273. { CDC_VA_TX0_TX_PATH_SEC2, 0x01},
  274. { CDC_VA_TX0_TX_PATH_SEC3, 0x3C},
  275. { CDC_VA_TX0_TX_PATH_SEC4, 0x20},
  276. { CDC_VA_TX0_TX_PATH_SEC5, 0x00},
  277. { CDC_VA_TX0_TX_PATH_SEC6, 0x00},
  278. { CDC_VA_TX0_TX_PATH_SEC7, 0x25},
  279. { CDC_VA_TX1_TX_PATH_CTL, 0x04},
  280. { CDC_VA_TX1_TX_PATH_CFG0, 0x10},
  281. { CDC_VA_TX1_TX_PATH_CFG1, 0x0B},
  282. { CDC_VA_TX1_TX_VOL_CTL, 0x00},
  283. { CDC_VA_TX1_TX_PATH_SEC0, 0x00},
  284. { CDC_VA_TX1_TX_PATH_SEC1, 0x00},
  285. { CDC_VA_TX1_TX_PATH_SEC2, 0x01},
  286. { CDC_VA_TX1_TX_PATH_SEC3, 0x3C},
  287. { CDC_VA_TX1_TX_PATH_SEC4, 0x20},
  288. { CDC_VA_TX1_TX_PATH_SEC5, 0x00},
  289. { CDC_VA_TX1_TX_PATH_SEC6, 0x00},
  290. { CDC_VA_TX2_TX_PATH_CTL, 0x04},
  291. { CDC_VA_TX2_TX_PATH_CFG0, 0x10},
  292. { CDC_VA_TX2_TX_PATH_CFG1, 0x0B},
  293. { CDC_VA_TX2_TX_VOL_CTL, 0x00},
  294. { CDC_VA_TX2_TX_PATH_SEC0, 0x00},
  295. { CDC_VA_TX2_TX_PATH_SEC1, 0x00},
  296. { CDC_VA_TX2_TX_PATH_SEC2, 0x01},
  297. { CDC_VA_TX2_TX_PATH_SEC3, 0x3C},
  298. { CDC_VA_TX2_TX_PATH_SEC4, 0x20},
  299. { CDC_VA_TX2_TX_PATH_SEC5, 0x00},
  300. { CDC_VA_TX2_TX_PATH_SEC6, 0x00},
  301. { CDC_VA_TX3_TX_PATH_CTL, 0x04},
  302. { CDC_VA_TX3_TX_PATH_CFG0, 0x10},
  303. { CDC_VA_TX3_TX_PATH_CFG1, 0x0B},
  304. { CDC_VA_TX3_TX_VOL_CTL, 0x00},
  305. { CDC_VA_TX3_TX_PATH_SEC0, 0x00},
  306. { CDC_VA_TX3_TX_PATH_SEC1, 0x00},
  307. { CDC_VA_TX3_TX_PATH_SEC2, 0x01},
  308. { CDC_VA_TX3_TX_PATH_SEC3, 0x3C},
  309. { CDC_VA_TX3_TX_PATH_SEC4, 0x20},
  310. { CDC_VA_TX3_TX_PATH_SEC5, 0x00},
  311. { CDC_VA_TX3_TX_PATH_SEC6, 0x00},
  312. };
  313. static bool va_is_rw_register(struct device *dev, unsigned int reg)
  314. {
  315. switch (reg) {
  316. case CDC_VA_CLK_RST_CTRL_MCLK_CONTROL:
  317. case CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL:
  318. case CDC_VA_CLK_RST_CTRL_SWR_CONTROL:
  319. case CDC_VA_TOP_CSR_TOP_CFG0:
  320. case CDC_VA_TOP_CSR_DMIC0_CTL:
  321. case CDC_VA_TOP_CSR_DMIC1_CTL:
  322. case CDC_VA_TOP_CSR_DMIC2_CTL:
  323. case CDC_VA_TOP_CSR_DMIC3_CTL:
  324. case CDC_VA_TOP_CSR_DMIC_CFG:
  325. case CDC_VA_TOP_CSR_SWR_MIC_CTL0:
  326. case CDC_VA_TOP_CSR_SWR_MIC_CTL1:
  327. case CDC_VA_TOP_CSR_SWR_MIC_CTL2:
  328. case CDC_VA_TOP_CSR_DEBUG_BUS:
  329. case CDC_VA_TOP_CSR_DEBUG_EN:
  330. case CDC_VA_TOP_CSR_TX_I2S_CTL:
  331. case CDC_VA_TOP_CSR_I2S_CLK:
  332. case CDC_VA_TOP_CSR_I2S_RESET:
  333. case CDC_VA_INP_MUX_ADC_MUX0_CFG0:
  334. case CDC_VA_INP_MUX_ADC_MUX0_CFG1:
  335. case CDC_VA_INP_MUX_ADC_MUX1_CFG0:
  336. case CDC_VA_INP_MUX_ADC_MUX1_CFG1:
  337. case CDC_VA_INP_MUX_ADC_MUX2_CFG0:
  338. case CDC_VA_INP_MUX_ADC_MUX2_CFG1:
  339. case CDC_VA_INP_MUX_ADC_MUX3_CFG0:
  340. case CDC_VA_INP_MUX_ADC_MUX3_CFG1:
  341. case CDC_VA_TX0_TX_PATH_CTL:
  342. case CDC_VA_TX0_TX_PATH_CFG0:
  343. case CDC_VA_TX0_TX_PATH_CFG1:
  344. case CDC_VA_TX0_TX_VOL_CTL:
  345. case CDC_VA_TX0_TX_PATH_SEC0:
  346. case CDC_VA_TX0_TX_PATH_SEC1:
  347. case CDC_VA_TX0_TX_PATH_SEC2:
  348. case CDC_VA_TX0_TX_PATH_SEC3:
  349. case CDC_VA_TX0_TX_PATH_SEC4:
  350. case CDC_VA_TX0_TX_PATH_SEC5:
  351. case CDC_VA_TX0_TX_PATH_SEC6:
  352. case CDC_VA_TX0_TX_PATH_SEC7:
  353. case CDC_VA_TX1_TX_PATH_CTL:
  354. case CDC_VA_TX1_TX_PATH_CFG0:
  355. case CDC_VA_TX1_TX_PATH_CFG1:
  356. case CDC_VA_TX1_TX_VOL_CTL:
  357. case CDC_VA_TX1_TX_PATH_SEC0:
  358. case CDC_VA_TX1_TX_PATH_SEC1:
  359. case CDC_VA_TX1_TX_PATH_SEC2:
  360. case CDC_VA_TX1_TX_PATH_SEC3:
  361. case CDC_VA_TX1_TX_PATH_SEC4:
  362. case CDC_VA_TX1_TX_PATH_SEC5:
  363. case CDC_VA_TX1_TX_PATH_SEC6:
  364. case CDC_VA_TX2_TX_PATH_CTL:
  365. case CDC_VA_TX2_TX_PATH_CFG0:
  366. case CDC_VA_TX2_TX_PATH_CFG1:
  367. case CDC_VA_TX2_TX_VOL_CTL:
  368. case CDC_VA_TX2_TX_PATH_SEC0:
  369. case CDC_VA_TX2_TX_PATH_SEC1:
  370. case CDC_VA_TX2_TX_PATH_SEC2:
  371. case CDC_VA_TX2_TX_PATH_SEC3:
  372. case CDC_VA_TX2_TX_PATH_SEC4:
  373. case CDC_VA_TX2_TX_PATH_SEC5:
  374. case CDC_VA_TX2_TX_PATH_SEC6:
  375. case CDC_VA_TX3_TX_PATH_CTL:
  376. case CDC_VA_TX3_TX_PATH_CFG0:
  377. case CDC_VA_TX3_TX_PATH_CFG1:
  378. case CDC_VA_TX3_TX_VOL_CTL:
  379. case CDC_VA_TX3_TX_PATH_SEC0:
  380. case CDC_VA_TX3_TX_PATH_SEC1:
  381. case CDC_VA_TX3_TX_PATH_SEC2:
  382. case CDC_VA_TX3_TX_PATH_SEC3:
  383. case CDC_VA_TX3_TX_PATH_SEC4:
  384. case CDC_VA_TX3_TX_PATH_SEC5:
  385. case CDC_VA_TX3_TX_PATH_SEC6:
  386. return true;
  387. }
  388. return false;
  389. }
  390. static bool va_is_readable_register(struct device *dev, unsigned int reg)
  391. {
  392. switch (reg) {
  393. case CDC_VA_TOP_CSR_CORE_ID_0:
  394. case CDC_VA_TOP_CSR_CORE_ID_1:
  395. case CDC_VA_TOP_CSR_CORE_ID_2:
  396. case CDC_VA_TOP_CSR_CORE_ID_3:
  397. return true;
  398. }
  399. return va_is_rw_register(dev, reg);
  400. }
  401. static const struct regmap_config va_regmap_config = {
  402. .name = "va_macro",
  403. .reg_bits = 32,
  404. .val_bits = 32,
  405. .reg_stride = 4,
  406. .cache_type = REGCACHE_FLAT,
  407. .reg_defaults = va_defaults,
  408. .num_reg_defaults = ARRAY_SIZE(va_defaults),
  409. .max_register = VA_MAX_OFFSET,
  410. .volatile_reg = va_is_volatile_register,
  411. .readable_reg = va_is_readable_register,
  412. .writeable_reg = va_is_rw_register,
  413. };
  414. static int va_clk_rsc_fs_gen_request(struct va_macro *va, bool enable)
  415. {
  416. struct regmap *regmap = va->regmap;
  417. if (enable) {
  418. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_MCLK_CONTROL,
  419. CDC_VA_MCLK_CONTROL_EN,
  420. CDC_VA_MCLK_CONTROL_EN);
  421. /* clear the fs counter */
  422. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL,
  423. CDC_VA_FS_CONTROL_EN | CDC_VA_FS_COUNTER_CLR,
  424. CDC_VA_FS_CONTROL_EN | CDC_VA_FS_COUNTER_CLR);
  425. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL,
  426. CDC_VA_FS_CONTROL_EN | CDC_VA_FS_COUNTER_CLR,
  427. CDC_VA_FS_CONTROL_EN);
  428. regmap_update_bits(regmap, CDC_VA_TOP_CSR_TOP_CFG0,
  429. CDC_VA_FS_BROADCAST_EN,
  430. CDC_VA_FS_BROADCAST_EN);
  431. } else {
  432. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_MCLK_CONTROL,
  433. CDC_VA_MCLK_CONTROL_EN, 0x0);
  434. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL,
  435. CDC_VA_FS_CONTROL_EN, 0x0);
  436. regmap_update_bits(regmap, CDC_VA_TOP_CSR_TOP_CFG0,
  437. CDC_VA_FS_BROADCAST_EN, 0x0);
  438. }
  439. return 0;
  440. }
  441. static int va_macro_mclk_enable(struct va_macro *va, bool mclk_enable)
  442. {
  443. struct regmap *regmap = va->regmap;
  444. if (mclk_enable) {
  445. va_clk_rsc_fs_gen_request(va, true);
  446. regcache_mark_dirty(regmap);
  447. regcache_sync_region(regmap, 0x0, VA_MAX_OFFSET);
  448. } else {
  449. va_clk_rsc_fs_gen_request(va, false);
  450. }
  451. return 0;
  452. }
  453. static int va_macro_mclk_event(struct snd_soc_dapm_widget *w,
  454. struct snd_kcontrol *kcontrol, int event)
  455. {
  456. struct snd_soc_component *comp = snd_soc_dapm_to_component(w->dapm);
  457. struct va_macro *va = snd_soc_component_get_drvdata(comp);
  458. switch (event) {
  459. case SND_SOC_DAPM_PRE_PMU:
  460. return clk_prepare_enable(va->fsgen);
  461. case SND_SOC_DAPM_POST_PMD:
  462. clk_disable_unprepare(va->fsgen);
  463. }
  464. return 0;
  465. }
  466. static int va_macro_put_dec_enum(struct snd_kcontrol *kcontrol,
  467. struct snd_ctl_elem_value *ucontrol)
  468. {
  469. struct snd_soc_dapm_widget *widget =
  470. snd_soc_dapm_kcontrol_widget(kcontrol);
  471. struct snd_soc_component *component =
  472. snd_soc_dapm_to_component(widget->dapm);
  473. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  474. unsigned int val;
  475. u16 mic_sel_reg;
  476. val = ucontrol->value.enumerated.item[0];
  477. switch (e->reg) {
  478. case CDC_VA_INP_MUX_ADC_MUX0_CFG0:
  479. mic_sel_reg = CDC_VA_TX0_TX_PATH_CFG0;
  480. break;
  481. case CDC_VA_INP_MUX_ADC_MUX1_CFG0:
  482. mic_sel_reg = CDC_VA_TX1_TX_PATH_CFG0;
  483. break;
  484. case CDC_VA_INP_MUX_ADC_MUX2_CFG0:
  485. mic_sel_reg = CDC_VA_TX2_TX_PATH_CFG0;
  486. break;
  487. case CDC_VA_INP_MUX_ADC_MUX3_CFG0:
  488. mic_sel_reg = CDC_VA_TX3_TX_PATH_CFG0;
  489. break;
  490. default:
  491. dev_err(component->dev, "%s: e->reg: 0x%x not expected\n",
  492. __func__, e->reg);
  493. return -EINVAL;
  494. }
  495. if (val != 0)
  496. snd_soc_component_update_bits(component, mic_sel_reg,
  497. CDC_VA_TX_PATH_ADC_DMIC_SEL_MASK,
  498. CDC_VA_TX_PATH_ADC_DMIC_SEL_DMIC);
  499. return snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
  500. }
  501. static int va_macro_tx_mixer_get(struct snd_kcontrol *kcontrol,
  502. struct snd_ctl_elem_value *ucontrol)
  503. {
  504. struct snd_soc_dapm_widget *widget =
  505. snd_soc_dapm_kcontrol_widget(kcontrol);
  506. struct snd_soc_component *component =
  507. snd_soc_dapm_to_component(widget->dapm);
  508. struct soc_mixer_control *mc =
  509. (struct soc_mixer_control *)kcontrol->private_value;
  510. u32 dai_id = widget->shift;
  511. u32 dec_id = mc->shift;
  512. struct va_macro *va = snd_soc_component_get_drvdata(component);
  513. if (test_bit(dec_id, &va->active_ch_mask[dai_id]))
  514. ucontrol->value.integer.value[0] = 1;
  515. else
  516. ucontrol->value.integer.value[0] = 0;
  517. return 0;
  518. }
  519. static int va_macro_tx_mixer_put(struct snd_kcontrol *kcontrol,
  520. struct snd_ctl_elem_value *ucontrol)
  521. {
  522. struct snd_soc_dapm_widget *widget =
  523. snd_soc_dapm_kcontrol_widget(kcontrol);
  524. struct snd_soc_component *component =
  525. snd_soc_dapm_to_component(widget->dapm);
  526. struct snd_soc_dapm_update *update = NULL;
  527. struct soc_mixer_control *mc =
  528. (struct soc_mixer_control *)kcontrol->private_value;
  529. u32 dai_id = widget->shift;
  530. u32 dec_id = mc->shift;
  531. u32 enable = ucontrol->value.integer.value[0];
  532. struct va_macro *va = snd_soc_component_get_drvdata(component);
  533. if (enable) {
  534. set_bit(dec_id, &va->active_ch_mask[dai_id]);
  535. va->active_ch_cnt[dai_id]++;
  536. } else {
  537. clear_bit(dec_id, &va->active_ch_mask[dai_id]);
  538. va->active_ch_cnt[dai_id]--;
  539. }
  540. snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, update);
  541. return 0;
  542. }
  543. static int va_dmic_clk_enable(struct snd_soc_component *component,
  544. u32 dmic, bool enable)
  545. {
  546. struct va_macro *va = snd_soc_component_get_drvdata(component);
  547. u16 dmic_clk_reg;
  548. s32 *dmic_clk_cnt;
  549. u8 *dmic_clk_div;
  550. u8 freq_change_mask;
  551. u8 clk_div;
  552. switch (dmic) {
  553. case 0:
  554. case 1:
  555. dmic_clk_cnt = &(va->dmic_0_1_clk_cnt);
  556. dmic_clk_div = &(va->dmic_0_1_clk_div);
  557. dmic_clk_reg = CDC_VA_TOP_CSR_DMIC0_CTL;
  558. freq_change_mask = CDC_VA_DMIC0_FREQ_CHANGE_MASK;
  559. break;
  560. case 2:
  561. case 3:
  562. dmic_clk_cnt = &(va->dmic_2_3_clk_cnt);
  563. dmic_clk_div = &(va->dmic_2_3_clk_div);
  564. dmic_clk_reg = CDC_VA_TOP_CSR_DMIC1_CTL;
  565. freq_change_mask = CDC_VA_DMIC1_FREQ_CHANGE_MASK;
  566. break;
  567. case 4:
  568. case 5:
  569. dmic_clk_cnt = &(va->dmic_4_5_clk_cnt);
  570. dmic_clk_div = &(va->dmic_4_5_clk_div);
  571. dmic_clk_reg = CDC_VA_TOP_CSR_DMIC2_CTL;
  572. freq_change_mask = CDC_VA_DMIC2_FREQ_CHANGE_MASK;
  573. break;
  574. case 6:
  575. case 7:
  576. dmic_clk_cnt = &(va->dmic_6_7_clk_cnt);
  577. dmic_clk_div = &(va->dmic_6_7_clk_div);
  578. dmic_clk_reg = CDC_VA_TOP_CSR_DMIC3_CTL;
  579. freq_change_mask = CDC_VA_DMIC3_FREQ_CHANGE_MASK;
  580. break;
  581. default:
  582. dev_err(component->dev, "%s: Invalid DMIC Selection\n",
  583. __func__);
  584. return -EINVAL;
  585. }
  586. if (enable) {
  587. clk_div = va->dmic_clk_div;
  588. (*dmic_clk_cnt)++;
  589. if (*dmic_clk_cnt == 1) {
  590. snd_soc_component_update_bits(component,
  591. CDC_VA_TOP_CSR_DMIC_CFG,
  592. CDC_VA_RESET_ALL_DMICS_MASK,
  593. CDC_VA_RESET_ALL_DMICS_DISABLE);
  594. snd_soc_component_update_bits(component, dmic_clk_reg,
  595. CDC_VA_DMIC_CLK_SEL_MASK,
  596. clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
  597. snd_soc_component_update_bits(component, dmic_clk_reg,
  598. CDC_VA_DMIC_EN_MASK,
  599. CDC_VA_DMIC_ENABLE);
  600. } else {
  601. if (*dmic_clk_div > clk_div) {
  602. snd_soc_component_update_bits(component,
  603. CDC_VA_TOP_CSR_DMIC_CFG,
  604. freq_change_mask,
  605. freq_change_mask);
  606. snd_soc_component_update_bits(component, dmic_clk_reg,
  607. CDC_VA_DMIC_CLK_SEL_MASK,
  608. clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
  609. snd_soc_component_update_bits(component,
  610. CDC_VA_TOP_CSR_DMIC_CFG,
  611. freq_change_mask,
  612. CDC_VA_DMIC_FREQ_CHANGE_DISABLE);
  613. } else {
  614. clk_div = *dmic_clk_div;
  615. }
  616. }
  617. *dmic_clk_div = clk_div;
  618. } else {
  619. (*dmic_clk_cnt)--;
  620. if (*dmic_clk_cnt == 0) {
  621. snd_soc_component_update_bits(component, dmic_clk_reg,
  622. CDC_VA_DMIC_EN_MASK, 0);
  623. clk_div = 0;
  624. snd_soc_component_update_bits(component, dmic_clk_reg,
  625. CDC_VA_DMIC_CLK_SEL_MASK,
  626. clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
  627. } else {
  628. clk_div = va->dmic_clk_div;
  629. if (*dmic_clk_div > clk_div) {
  630. clk_div = va->dmic_clk_div;
  631. snd_soc_component_update_bits(component,
  632. CDC_VA_TOP_CSR_DMIC_CFG,
  633. freq_change_mask,
  634. freq_change_mask);
  635. snd_soc_component_update_bits(component, dmic_clk_reg,
  636. CDC_VA_DMIC_CLK_SEL_MASK,
  637. clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
  638. snd_soc_component_update_bits(component,
  639. CDC_VA_TOP_CSR_DMIC_CFG,
  640. freq_change_mask,
  641. CDC_VA_DMIC_FREQ_CHANGE_DISABLE);
  642. } else {
  643. clk_div = *dmic_clk_div;
  644. }
  645. }
  646. *dmic_clk_div = clk_div;
  647. }
  648. return 0;
  649. }
  650. static int va_macro_enable_dmic(struct snd_soc_dapm_widget *w,
  651. struct snd_kcontrol *kcontrol, int event)
  652. {
  653. struct snd_soc_component *comp = snd_soc_dapm_to_component(w->dapm);
  654. unsigned int dmic = w->shift;
  655. switch (event) {
  656. case SND_SOC_DAPM_PRE_PMU:
  657. va_dmic_clk_enable(comp, dmic, true);
  658. break;
  659. case SND_SOC_DAPM_POST_PMD:
  660. va_dmic_clk_enable(comp, dmic, false);
  661. break;
  662. }
  663. return 0;
  664. }
  665. static int va_macro_enable_dec(struct snd_soc_dapm_widget *w,
  666. struct snd_kcontrol *kcontrol, int event)
  667. {
  668. struct snd_soc_component *comp = snd_soc_dapm_to_component(w->dapm);
  669. unsigned int decimator;
  670. u16 tx_vol_ctl_reg, dec_cfg_reg, hpf_gate_reg;
  671. u16 tx_gain_ctl_reg;
  672. u8 hpf_cut_off_freq;
  673. struct va_macro *va = snd_soc_component_get_drvdata(comp);
  674. decimator = w->shift;
  675. tx_vol_ctl_reg = CDC_VA_TX0_TX_PATH_CTL +
  676. VA_MACRO_TX_PATH_OFFSET * decimator;
  677. hpf_gate_reg = CDC_VA_TX0_TX_PATH_SEC2 +
  678. VA_MACRO_TX_PATH_OFFSET * decimator;
  679. dec_cfg_reg = CDC_VA_TX0_TX_PATH_CFG0 +
  680. VA_MACRO_TX_PATH_OFFSET * decimator;
  681. tx_gain_ctl_reg = CDC_VA_TX0_TX_VOL_CTL +
  682. VA_MACRO_TX_PATH_OFFSET * decimator;
  683. switch (event) {
  684. case SND_SOC_DAPM_PRE_PMU:
  685. snd_soc_component_update_bits(comp,
  686. dec_cfg_reg, CDC_VA_ADC_MODE_MASK,
  687. va->dec_mode[decimator] << CDC_VA_ADC_MODE_SHIFT);
  688. /* Enable TX PGA Mute */
  689. break;
  690. case SND_SOC_DAPM_POST_PMU:
  691. /* Enable TX CLK */
  692. snd_soc_component_update_bits(comp, tx_vol_ctl_reg,
  693. CDC_VA_TX_PATH_CLK_EN_MASK,
  694. CDC_VA_TX_PATH_CLK_EN);
  695. snd_soc_component_update_bits(comp, hpf_gate_reg,
  696. CDC_VA_TX_HPF_ZERO_GATE_MASK,
  697. CDC_VA_TX_HPF_ZERO_GATE);
  698. usleep_range(1000, 1010);
  699. hpf_cut_off_freq = (snd_soc_component_read(comp, dec_cfg_reg) &
  700. TX_HPF_CUT_OFF_FREQ_MASK) >> 5;
  701. if (hpf_cut_off_freq != CF_MIN_3DB_150HZ) {
  702. snd_soc_component_update_bits(comp, dec_cfg_reg,
  703. TX_HPF_CUT_OFF_FREQ_MASK,
  704. CF_MIN_3DB_150HZ << 5);
  705. snd_soc_component_update_bits(comp, hpf_gate_reg,
  706. CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_MASK,
  707. CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_REQ);
  708. /*
  709. * Minimum 1 clk cycle delay is required as per HW spec
  710. */
  711. usleep_range(1000, 1010);
  712. snd_soc_component_update_bits(comp,
  713. hpf_gate_reg,
  714. CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_MASK,
  715. 0x0);
  716. }
  717. usleep_range(1000, 1010);
  718. snd_soc_component_update_bits(comp, hpf_gate_reg,
  719. CDC_VA_TX_HPF_ZERO_GATE_MASK,
  720. CDC_VA_TX_HPF_ZERO_NO_GATE);
  721. /*
  722. * 6ms delay is required as per HW spec
  723. */
  724. usleep_range(6000, 6010);
  725. /* apply gain after decimator is enabled */
  726. snd_soc_component_write(comp, tx_gain_ctl_reg,
  727. snd_soc_component_read(comp, tx_gain_ctl_reg));
  728. break;
  729. case SND_SOC_DAPM_POST_PMD:
  730. /* Disable TX CLK */
  731. snd_soc_component_update_bits(comp, tx_vol_ctl_reg,
  732. CDC_VA_TX_PATH_CLK_EN_MASK,
  733. CDC_VA_TX_PATH_CLK_DISABLE);
  734. break;
  735. }
  736. return 0;
  737. }
  738. static int va_macro_dec_mode_get(struct snd_kcontrol *kcontrol,
  739. struct snd_ctl_elem_value *ucontrol)
  740. {
  741. struct snd_soc_component *comp = snd_soc_kcontrol_component(kcontrol);
  742. struct va_macro *va = snd_soc_component_get_drvdata(comp);
  743. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  744. int path = e->shift_l;
  745. ucontrol->value.enumerated.item[0] = va->dec_mode[path];
  746. return 0;
  747. }
  748. static int va_macro_dec_mode_put(struct snd_kcontrol *kcontrol,
  749. struct snd_ctl_elem_value *ucontrol)
  750. {
  751. struct snd_soc_component *comp = snd_soc_kcontrol_component(kcontrol);
  752. int value = ucontrol->value.enumerated.item[0];
  753. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  754. int path = e->shift_l;
  755. struct va_macro *va = snd_soc_component_get_drvdata(comp);
  756. va->dec_mode[path] = value;
  757. return 0;
  758. }
  759. static int va_macro_hw_params(struct snd_pcm_substream *substream,
  760. struct snd_pcm_hw_params *params,
  761. struct snd_soc_dai *dai)
  762. {
  763. int tx_fs_rate;
  764. struct snd_soc_component *component = dai->component;
  765. u32 decimator, sample_rate;
  766. u16 tx_fs_reg;
  767. struct device *va_dev = component->dev;
  768. struct va_macro *va = snd_soc_component_get_drvdata(component);
  769. sample_rate = params_rate(params);
  770. switch (sample_rate) {
  771. case 8000:
  772. tx_fs_rate = 0;
  773. break;
  774. case 16000:
  775. tx_fs_rate = 1;
  776. break;
  777. case 32000:
  778. tx_fs_rate = 3;
  779. break;
  780. case 48000:
  781. tx_fs_rate = 4;
  782. break;
  783. case 96000:
  784. tx_fs_rate = 5;
  785. break;
  786. case 192000:
  787. tx_fs_rate = 6;
  788. break;
  789. case 384000:
  790. tx_fs_rate = 7;
  791. break;
  792. default:
  793. dev_err(va_dev, "%s: Invalid TX sample rate: %d\n",
  794. __func__, params_rate(params));
  795. return -EINVAL;
  796. }
  797. for_each_set_bit(decimator, &va->active_ch_mask[dai->id],
  798. VA_MACRO_DEC_MAX) {
  799. tx_fs_reg = CDC_VA_TX0_TX_PATH_CTL +
  800. VA_MACRO_TX_PATH_OFFSET * decimator;
  801. snd_soc_component_update_bits(component, tx_fs_reg, 0x0F,
  802. tx_fs_rate);
  803. }
  804. return 0;
  805. }
  806. static int va_macro_get_channel_map(struct snd_soc_dai *dai,
  807. unsigned int *tx_num, unsigned int *tx_slot,
  808. unsigned int *rx_num, unsigned int *rx_slot)
  809. {
  810. struct snd_soc_component *component = dai->component;
  811. struct device *va_dev = component->dev;
  812. struct va_macro *va = snd_soc_component_get_drvdata(component);
  813. switch (dai->id) {
  814. case VA_MACRO_AIF1_CAP:
  815. case VA_MACRO_AIF2_CAP:
  816. case VA_MACRO_AIF3_CAP:
  817. *tx_slot = va->active_ch_mask[dai->id];
  818. *tx_num = va->active_ch_cnt[dai->id];
  819. break;
  820. default:
  821. dev_err(va_dev, "%s: Invalid AIF\n", __func__);
  822. break;
  823. }
  824. return 0;
  825. }
  826. static int va_macro_digital_mute(struct snd_soc_dai *dai, int mute, int stream)
  827. {
  828. struct snd_soc_component *component = dai->component;
  829. struct va_macro *va = snd_soc_component_get_drvdata(component);
  830. u16 tx_vol_ctl_reg, decimator;
  831. for_each_set_bit(decimator, &va->active_ch_mask[dai->id],
  832. VA_MACRO_DEC_MAX) {
  833. tx_vol_ctl_reg = CDC_VA_TX0_TX_PATH_CTL +
  834. VA_MACRO_TX_PATH_OFFSET * decimator;
  835. if (mute)
  836. snd_soc_component_update_bits(component, tx_vol_ctl_reg,
  837. CDC_VA_TX_PATH_PGA_MUTE_EN_MASK,
  838. CDC_VA_TX_PATH_PGA_MUTE_EN);
  839. else
  840. snd_soc_component_update_bits(component, tx_vol_ctl_reg,
  841. CDC_VA_TX_PATH_PGA_MUTE_EN_MASK,
  842. CDC_VA_TX_PATH_PGA_MUTE_DISABLE);
  843. }
  844. return 0;
  845. }
  846. static const struct snd_soc_dai_ops va_macro_dai_ops = {
  847. .hw_params = va_macro_hw_params,
  848. .get_channel_map = va_macro_get_channel_map,
  849. .mute_stream = va_macro_digital_mute,
  850. };
  851. static struct snd_soc_dai_driver va_macro_dais[] = {
  852. {
  853. .name = "va_macro_tx1",
  854. .id = VA_MACRO_AIF1_CAP,
  855. .capture = {
  856. .stream_name = "VA_AIF1 Capture",
  857. .rates = VA_MACRO_RATES,
  858. .formats = VA_MACRO_FORMATS,
  859. .rate_max = 192000,
  860. .rate_min = 8000,
  861. .channels_min = 1,
  862. .channels_max = 8,
  863. },
  864. .ops = &va_macro_dai_ops,
  865. },
  866. {
  867. .name = "va_macro_tx2",
  868. .id = VA_MACRO_AIF2_CAP,
  869. .capture = {
  870. .stream_name = "VA_AIF2 Capture",
  871. .rates = VA_MACRO_RATES,
  872. .formats = VA_MACRO_FORMATS,
  873. .rate_max = 192000,
  874. .rate_min = 8000,
  875. .channels_min = 1,
  876. .channels_max = 8,
  877. },
  878. .ops = &va_macro_dai_ops,
  879. },
  880. {
  881. .name = "va_macro_tx3",
  882. .id = VA_MACRO_AIF3_CAP,
  883. .capture = {
  884. .stream_name = "VA_AIF3 Capture",
  885. .rates = VA_MACRO_RATES,
  886. .formats = VA_MACRO_FORMATS,
  887. .rate_max = 192000,
  888. .rate_min = 8000,
  889. .channels_min = 1,
  890. .channels_max = 8,
  891. },
  892. .ops = &va_macro_dai_ops,
  893. },
  894. };
  895. static const char * const adc_mux_text[] = {
  896. "VA_DMIC", "SWR_MIC"
  897. };
  898. static SOC_ENUM_SINGLE_DECL(va_dec0_enum, CDC_VA_INP_MUX_ADC_MUX0_CFG1,
  899. 0, adc_mux_text);
  900. static SOC_ENUM_SINGLE_DECL(va_dec1_enum, CDC_VA_INP_MUX_ADC_MUX1_CFG1,
  901. 0, adc_mux_text);
  902. static SOC_ENUM_SINGLE_DECL(va_dec2_enum, CDC_VA_INP_MUX_ADC_MUX2_CFG1,
  903. 0, adc_mux_text);
  904. static SOC_ENUM_SINGLE_DECL(va_dec3_enum, CDC_VA_INP_MUX_ADC_MUX3_CFG1,
  905. 0, adc_mux_text);
  906. static const struct snd_kcontrol_new va_dec0_mux = SOC_DAPM_ENUM("va_dec0",
  907. va_dec0_enum);
  908. static const struct snd_kcontrol_new va_dec1_mux = SOC_DAPM_ENUM("va_dec1",
  909. va_dec1_enum);
  910. static const struct snd_kcontrol_new va_dec2_mux = SOC_DAPM_ENUM("va_dec2",
  911. va_dec2_enum);
  912. static const struct snd_kcontrol_new va_dec3_mux = SOC_DAPM_ENUM("va_dec3",
  913. va_dec3_enum);
  914. static const char * const dmic_mux_text[] = {
  915. "ZERO", "DMIC0", "DMIC1", "DMIC2", "DMIC3",
  916. "DMIC4", "DMIC5", "DMIC6", "DMIC7"
  917. };
  918. static SOC_ENUM_SINGLE_DECL(va_dmic0_enum, CDC_VA_INP_MUX_ADC_MUX0_CFG0,
  919. 4, dmic_mux_text);
  920. static SOC_ENUM_SINGLE_DECL(va_dmic1_enum, CDC_VA_INP_MUX_ADC_MUX1_CFG0,
  921. 4, dmic_mux_text);
  922. static SOC_ENUM_SINGLE_DECL(va_dmic2_enum, CDC_VA_INP_MUX_ADC_MUX2_CFG0,
  923. 4, dmic_mux_text);
  924. static SOC_ENUM_SINGLE_DECL(va_dmic3_enum, CDC_VA_INP_MUX_ADC_MUX3_CFG0,
  925. 4, dmic_mux_text);
  926. static const struct snd_kcontrol_new va_dmic0_mux = SOC_DAPM_ENUM_EXT("va_dmic0",
  927. va_dmic0_enum, snd_soc_dapm_get_enum_double,
  928. va_macro_put_dec_enum);
  929. static const struct snd_kcontrol_new va_dmic1_mux = SOC_DAPM_ENUM_EXT("va_dmic1",
  930. va_dmic1_enum, snd_soc_dapm_get_enum_double,
  931. va_macro_put_dec_enum);
  932. static const struct snd_kcontrol_new va_dmic2_mux = SOC_DAPM_ENUM_EXT("va_dmic2",
  933. va_dmic2_enum, snd_soc_dapm_get_enum_double,
  934. va_macro_put_dec_enum);
  935. static const struct snd_kcontrol_new va_dmic3_mux = SOC_DAPM_ENUM_EXT("va_dmic3",
  936. va_dmic3_enum, snd_soc_dapm_get_enum_double,
  937. va_macro_put_dec_enum);
  938. static const struct snd_kcontrol_new va_aif1_cap_mixer[] = {
  939. SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, VA_MACRO_DEC0, 1, 0,
  940. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  941. SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, VA_MACRO_DEC1, 1, 0,
  942. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  943. SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, VA_MACRO_DEC2, 1, 0,
  944. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  945. SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, VA_MACRO_DEC3, 1, 0,
  946. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  947. SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, VA_MACRO_DEC4, 1, 0,
  948. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  949. SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, VA_MACRO_DEC5, 1, 0,
  950. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  951. SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, VA_MACRO_DEC6, 1, 0,
  952. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  953. SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, VA_MACRO_DEC7, 1, 0,
  954. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  955. };
  956. static const struct snd_kcontrol_new va_aif2_cap_mixer[] = {
  957. SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, VA_MACRO_DEC0, 1, 0,
  958. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  959. SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, VA_MACRO_DEC1, 1, 0,
  960. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  961. SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, VA_MACRO_DEC2, 1, 0,
  962. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  963. SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, VA_MACRO_DEC3, 1, 0,
  964. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  965. SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, VA_MACRO_DEC4, 1, 0,
  966. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  967. SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, VA_MACRO_DEC5, 1, 0,
  968. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  969. SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, VA_MACRO_DEC6, 1, 0,
  970. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  971. SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, VA_MACRO_DEC7, 1, 0,
  972. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  973. };
  974. static const struct snd_kcontrol_new va_aif3_cap_mixer[] = {
  975. SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, VA_MACRO_DEC0, 1, 0,
  976. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  977. SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, VA_MACRO_DEC1, 1, 0,
  978. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  979. SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, VA_MACRO_DEC2, 1, 0,
  980. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  981. SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, VA_MACRO_DEC3, 1, 0,
  982. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  983. SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, VA_MACRO_DEC4, 1, 0,
  984. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  985. SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, VA_MACRO_DEC5, 1, 0,
  986. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  987. SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, VA_MACRO_DEC6, 1, 0,
  988. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  989. SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, VA_MACRO_DEC7, 1, 0,
  990. va_macro_tx_mixer_get, va_macro_tx_mixer_put),
  991. };
  992. static const struct snd_soc_dapm_widget va_macro_dapm_widgets[] = {
  993. SND_SOC_DAPM_AIF_OUT("VA_AIF1 CAP", "VA_AIF1 Capture", 0,
  994. SND_SOC_NOPM, VA_MACRO_AIF1_CAP, 0),
  995. SND_SOC_DAPM_AIF_OUT("VA_AIF2 CAP", "VA_AIF2 Capture", 0,
  996. SND_SOC_NOPM, VA_MACRO_AIF2_CAP, 0),
  997. SND_SOC_DAPM_AIF_OUT("VA_AIF3 CAP", "VA_AIF3 Capture", 0,
  998. SND_SOC_NOPM, VA_MACRO_AIF3_CAP, 0),
  999. SND_SOC_DAPM_MIXER("VA_AIF1_CAP Mixer", SND_SOC_NOPM,
  1000. VA_MACRO_AIF1_CAP, 0,
  1001. va_aif1_cap_mixer, ARRAY_SIZE(va_aif1_cap_mixer)),
  1002. SND_SOC_DAPM_MIXER("VA_AIF2_CAP Mixer", SND_SOC_NOPM,
  1003. VA_MACRO_AIF2_CAP, 0,
  1004. va_aif2_cap_mixer, ARRAY_SIZE(va_aif2_cap_mixer)),
  1005. SND_SOC_DAPM_MIXER("VA_AIF3_CAP Mixer", SND_SOC_NOPM,
  1006. VA_MACRO_AIF3_CAP, 0,
  1007. va_aif3_cap_mixer, ARRAY_SIZE(va_aif3_cap_mixer)),
  1008. SND_SOC_DAPM_MUX("VA DMIC MUX0", SND_SOC_NOPM, 0, 0, &va_dmic0_mux),
  1009. SND_SOC_DAPM_MUX("VA DMIC MUX1", SND_SOC_NOPM, 0, 0, &va_dmic1_mux),
  1010. SND_SOC_DAPM_MUX("VA DMIC MUX2", SND_SOC_NOPM, 0, 0, &va_dmic2_mux),
  1011. SND_SOC_DAPM_MUX("VA DMIC MUX3", SND_SOC_NOPM, 0, 0, &va_dmic3_mux),
  1012. SND_SOC_DAPM_REGULATOR_SUPPLY("vdd-micb", 0, 0),
  1013. SND_SOC_DAPM_INPUT("DMIC0 Pin"),
  1014. SND_SOC_DAPM_INPUT("DMIC1 Pin"),
  1015. SND_SOC_DAPM_INPUT("DMIC2 Pin"),
  1016. SND_SOC_DAPM_INPUT("DMIC3 Pin"),
  1017. SND_SOC_DAPM_INPUT("DMIC4 Pin"),
  1018. SND_SOC_DAPM_INPUT("DMIC5 Pin"),
  1019. SND_SOC_DAPM_INPUT("DMIC6 Pin"),
  1020. SND_SOC_DAPM_INPUT("DMIC7 Pin"),
  1021. SND_SOC_DAPM_ADC_E("VA DMIC0", NULL, SND_SOC_NOPM, 0, 0,
  1022. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1023. SND_SOC_DAPM_POST_PMD),
  1024. SND_SOC_DAPM_ADC_E("VA DMIC1", NULL, SND_SOC_NOPM, 1, 0,
  1025. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1026. SND_SOC_DAPM_POST_PMD),
  1027. SND_SOC_DAPM_ADC_E("VA DMIC2", NULL, SND_SOC_NOPM, 2, 0,
  1028. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1029. SND_SOC_DAPM_POST_PMD),
  1030. SND_SOC_DAPM_ADC_E("VA DMIC3", NULL, SND_SOC_NOPM, 3, 0,
  1031. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1032. SND_SOC_DAPM_POST_PMD),
  1033. SND_SOC_DAPM_ADC_E("VA DMIC4", NULL, SND_SOC_NOPM, 4, 0,
  1034. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1035. SND_SOC_DAPM_POST_PMD),
  1036. SND_SOC_DAPM_ADC_E("VA DMIC5", NULL, SND_SOC_NOPM, 5, 0,
  1037. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1038. SND_SOC_DAPM_POST_PMD),
  1039. SND_SOC_DAPM_ADC_E("VA DMIC6", NULL, SND_SOC_NOPM, 6, 0,
  1040. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1041. SND_SOC_DAPM_POST_PMD),
  1042. SND_SOC_DAPM_ADC_E("VA DMIC7", NULL, SND_SOC_NOPM, 7, 0,
  1043. va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
  1044. SND_SOC_DAPM_POST_PMD),
  1045. SND_SOC_DAPM_INPUT("VA SWR_ADC0"),
  1046. SND_SOC_DAPM_INPUT("VA SWR_ADC1"),
  1047. SND_SOC_DAPM_INPUT("VA SWR_ADC2"),
  1048. SND_SOC_DAPM_INPUT("VA SWR_ADC3"),
  1049. SND_SOC_DAPM_INPUT("VA SWR_MIC0"),
  1050. SND_SOC_DAPM_INPUT("VA SWR_MIC1"),
  1051. SND_SOC_DAPM_INPUT("VA SWR_MIC2"),
  1052. SND_SOC_DAPM_INPUT("VA SWR_MIC3"),
  1053. SND_SOC_DAPM_INPUT("VA SWR_MIC4"),
  1054. SND_SOC_DAPM_INPUT("VA SWR_MIC5"),
  1055. SND_SOC_DAPM_INPUT("VA SWR_MIC6"),
  1056. SND_SOC_DAPM_INPUT("VA SWR_MIC7"),
  1057. SND_SOC_DAPM_MUX_E("VA DEC0 MUX", SND_SOC_NOPM, VA_MACRO_DEC0, 0,
  1058. &va_dec0_mux, va_macro_enable_dec,
  1059. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1060. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1061. SND_SOC_DAPM_MUX_E("VA DEC1 MUX", SND_SOC_NOPM, VA_MACRO_DEC1, 0,
  1062. &va_dec1_mux, va_macro_enable_dec,
  1063. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1064. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1065. SND_SOC_DAPM_MUX_E("VA DEC2 MUX", SND_SOC_NOPM, VA_MACRO_DEC2, 0,
  1066. &va_dec2_mux, va_macro_enable_dec,
  1067. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1068. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1069. SND_SOC_DAPM_MUX_E("VA DEC3 MUX", SND_SOC_NOPM, VA_MACRO_DEC3, 0,
  1070. &va_dec3_mux, va_macro_enable_dec,
  1071. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1072. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
  1073. SND_SOC_DAPM_SUPPLY_S("VA_MCLK", -1, SND_SOC_NOPM, 0, 0,
  1074. va_macro_mclk_event,
  1075. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1076. };
  1077. static const struct snd_soc_dapm_route va_audio_map[] = {
  1078. {"VA_AIF1 CAP", NULL, "VA_MCLK"},
  1079. {"VA_AIF2 CAP", NULL, "VA_MCLK"},
  1080. {"VA_AIF3 CAP", NULL, "VA_MCLK"},
  1081. {"VA_AIF1 CAP", NULL, "VA_AIF1_CAP Mixer"},
  1082. {"VA_AIF2 CAP", NULL, "VA_AIF2_CAP Mixer"},
  1083. {"VA_AIF3 CAP", NULL, "VA_AIF3_CAP Mixer"},
  1084. {"VA_AIF1_CAP Mixer", "DEC0", "VA DEC0 MUX"},
  1085. {"VA_AIF1_CAP Mixer", "DEC1", "VA DEC1 MUX"},
  1086. {"VA_AIF1_CAP Mixer", "DEC2", "VA DEC2 MUX"},
  1087. {"VA_AIF1_CAP Mixer", "DEC3", "VA DEC3 MUX"},
  1088. {"VA_AIF2_CAP Mixer", "DEC0", "VA DEC0 MUX"},
  1089. {"VA_AIF2_CAP Mixer", "DEC1", "VA DEC1 MUX"},
  1090. {"VA_AIF2_CAP Mixer", "DEC2", "VA DEC2 MUX"},
  1091. {"VA_AIF2_CAP Mixer", "DEC3", "VA DEC3 MUX"},
  1092. {"VA_AIF3_CAP Mixer", "DEC0", "VA DEC0 MUX"},
  1093. {"VA_AIF3_CAP Mixer", "DEC1", "VA DEC1 MUX"},
  1094. {"VA_AIF3_CAP Mixer", "DEC2", "VA DEC2 MUX"},
  1095. {"VA_AIF3_CAP Mixer", "DEC3", "VA DEC3 MUX"},
  1096. {"VA DEC0 MUX", "VA_DMIC", "VA DMIC MUX0"},
  1097. {"VA DMIC MUX0", "DMIC0", "VA DMIC0"},
  1098. {"VA DMIC MUX0", "DMIC1", "VA DMIC1"},
  1099. {"VA DMIC MUX0", "DMIC2", "VA DMIC2"},
  1100. {"VA DMIC MUX0", "DMIC3", "VA DMIC3"},
  1101. {"VA DMIC MUX0", "DMIC4", "VA DMIC4"},
  1102. {"VA DMIC MUX0", "DMIC5", "VA DMIC5"},
  1103. {"VA DMIC MUX0", "DMIC6", "VA DMIC6"},
  1104. {"VA DMIC MUX0", "DMIC7", "VA DMIC7"},
  1105. {"VA DEC1 MUX", "VA_DMIC", "VA DMIC MUX1"},
  1106. {"VA DMIC MUX1", "DMIC0", "VA DMIC0"},
  1107. {"VA DMIC MUX1", "DMIC1", "VA DMIC1"},
  1108. {"VA DMIC MUX1", "DMIC2", "VA DMIC2"},
  1109. {"VA DMIC MUX1", "DMIC3", "VA DMIC3"},
  1110. {"VA DMIC MUX1", "DMIC4", "VA DMIC4"},
  1111. {"VA DMIC MUX1", "DMIC5", "VA DMIC5"},
  1112. {"VA DMIC MUX1", "DMIC6", "VA DMIC6"},
  1113. {"VA DMIC MUX1", "DMIC7", "VA DMIC7"},
  1114. {"VA DEC2 MUX", "VA_DMIC", "VA DMIC MUX2"},
  1115. {"VA DMIC MUX2", "DMIC0", "VA DMIC0"},
  1116. {"VA DMIC MUX2", "DMIC1", "VA DMIC1"},
  1117. {"VA DMIC MUX2", "DMIC2", "VA DMIC2"},
  1118. {"VA DMIC MUX2", "DMIC3", "VA DMIC3"},
  1119. {"VA DMIC MUX2", "DMIC4", "VA DMIC4"},
  1120. {"VA DMIC MUX2", "DMIC5", "VA DMIC5"},
  1121. {"VA DMIC MUX2", "DMIC6", "VA DMIC6"},
  1122. {"VA DMIC MUX2", "DMIC7", "VA DMIC7"},
  1123. {"VA DEC3 MUX", "VA_DMIC", "VA DMIC MUX3"},
  1124. {"VA DMIC MUX3", "DMIC0", "VA DMIC0"},
  1125. {"VA DMIC MUX3", "DMIC1", "VA DMIC1"},
  1126. {"VA DMIC MUX3", "DMIC2", "VA DMIC2"},
  1127. {"VA DMIC MUX3", "DMIC3", "VA DMIC3"},
  1128. {"VA DMIC MUX3", "DMIC4", "VA DMIC4"},
  1129. {"VA DMIC MUX3", "DMIC5", "VA DMIC5"},
  1130. {"VA DMIC MUX3", "DMIC6", "VA DMIC6"},
  1131. {"VA DMIC MUX3", "DMIC7", "VA DMIC7"},
  1132. { "VA DMIC0", NULL, "DMIC0 Pin" },
  1133. { "VA DMIC1", NULL, "DMIC1 Pin" },
  1134. { "VA DMIC2", NULL, "DMIC2 Pin" },
  1135. { "VA DMIC3", NULL, "DMIC3 Pin" },
  1136. { "VA DMIC4", NULL, "DMIC4 Pin" },
  1137. { "VA DMIC5", NULL, "DMIC5 Pin" },
  1138. { "VA DMIC6", NULL, "DMIC6 Pin" },
  1139. { "VA DMIC7", NULL, "DMIC7 Pin" },
  1140. };
  1141. static const char * const dec_mode_mux_text[] = {
  1142. "ADC_DEFAULT", "ADC_LOW_PWR", "ADC_HIGH_PERF",
  1143. };
  1144. static const struct soc_enum dec_mode_mux_enum[] = {
  1145. SOC_ENUM_SINGLE(SND_SOC_NOPM, 0, ARRAY_SIZE(dec_mode_mux_text),
  1146. dec_mode_mux_text),
  1147. SOC_ENUM_SINGLE(SND_SOC_NOPM, 1, ARRAY_SIZE(dec_mode_mux_text),
  1148. dec_mode_mux_text),
  1149. SOC_ENUM_SINGLE(SND_SOC_NOPM, 2, ARRAY_SIZE(dec_mode_mux_text),
  1150. dec_mode_mux_text),
  1151. SOC_ENUM_SINGLE(SND_SOC_NOPM, 3, ARRAY_SIZE(dec_mode_mux_text),
  1152. dec_mode_mux_text),
  1153. };
  1154. static const struct snd_kcontrol_new va_macro_snd_controls[] = {
  1155. SOC_SINGLE_S8_TLV("VA_DEC0 Volume", CDC_VA_TX0_TX_VOL_CTL,
  1156. -84, 40, digital_gain),
  1157. SOC_SINGLE_S8_TLV("VA_DEC1 Volume", CDC_VA_TX1_TX_VOL_CTL,
  1158. -84, 40, digital_gain),
  1159. SOC_SINGLE_S8_TLV("VA_DEC2 Volume", CDC_VA_TX2_TX_VOL_CTL,
  1160. -84, 40, digital_gain),
  1161. SOC_SINGLE_S8_TLV("VA_DEC3 Volume", CDC_VA_TX3_TX_VOL_CTL,
  1162. -84, 40, digital_gain),
  1163. SOC_ENUM_EXT("VA_DEC0 MODE", dec_mode_mux_enum[0],
  1164. va_macro_dec_mode_get, va_macro_dec_mode_put),
  1165. SOC_ENUM_EXT("VA_DEC1 MODE", dec_mode_mux_enum[1],
  1166. va_macro_dec_mode_get, va_macro_dec_mode_put),
  1167. SOC_ENUM_EXT("VA_DEC2 MODE", dec_mode_mux_enum[2],
  1168. va_macro_dec_mode_get, va_macro_dec_mode_put),
  1169. SOC_ENUM_EXT("VA_DEC3 MODE", dec_mode_mux_enum[3],
  1170. va_macro_dec_mode_get, va_macro_dec_mode_put),
  1171. };
  1172. static int va_macro_component_probe(struct snd_soc_component *component)
  1173. {
  1174. struct va_macro *va = snd_soc_component_get_drvdata(component);
  1175. snd_soc_component_init_regmap(component, va->regmap);
  1176. return 0;
  1177. }
  1178. static const struct snd_soc_component_driver va_macro_component_drv = {
  1179. .name = "VA MACRO",
  1180. .probe = va_macro_component_probe,
  1181. .controls = va_macro_snd_controls,
  1182. .num_controls = ARRAY_SIZE(va_macro_snd_controls),
  1183. .dapm_widgets = va_macro_dapm_widgets,
  1184. .num_dapm_widgets = ARRAY_SIZE(va_macro_dapm_widgets),
  1185. .dapm_routes = va_audio_map,
  1186. .num_dapm_routes = ARRAY_SIZE(va_audio_map),
  1187. };
  1188. static int fsgen_gate_enable(struct clk_hw *hw)
  1189. {
  1190. struct va_macro *va = to_va_macro(hw);
  1191. struct regmap *regmap = va->regmap;
  1192. int ret;
  1193. ret = va_macro_mclk_enable(va, true);
  1194. if (!va->has_swr_master)
  1195. return ret;
  1196. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
  1197. CDC_VA_SWR_RESET_MASK, CDC_VA_SWR_RESET_ENABLE);
  1198. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
  1199. CDC_VA_SWR_CLK_EN_MASK,
  1200. CDC_VA_SWR_CLK_ENABLE);
  1201. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
  1202. CDC_VA_SWR_RESET_MASK, 0x0);
  1203. return ret;
  1204. }
  1205. static void fsgen_gate_disable(struct clk_hw *hw)
  1206. {
  1207. struct va_macro *va = to_va_macro(hw);
  1208. struct regmap *regmap = va->regmap;
  1209. if (va->has_swr_master)
  1210. regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
  1211. CDC_VA_SWR_CLK_EN_MASK, 0x0);
  1212. va_macro_mclk_enable(va, false);
  1213. }
  1214. static int fsgen_gate_is_enabled(struct clk_hw *hw)
  1215. {
  1216. struct va_macro *va = to_va_macro(hw);
  1217. int val;
  1218. regmap_read(va->regmap, CDC_VA_TOP_CSR_TOP_CFG0, &val);
  1219. return !!(val & CDC_VA_FS_BROADCAST_EN);
  1220. }
  1221. static const struct clk_ops fsgen_gate_ops = {
  1222. .prepare = fsgen_gate_enable,
  1223. .unprepare = fsgen_gate_disable,
  1224. .is_enabled = fsgen_gate_is_enabled,
  1225. };
  1226. static int va_macro_register_fsgen_output(struct va_macro *va)
  1227. {
  1228. struct clk *parent = va->mclk;
  1229. struct device *dev = va->dev;
  1230. struct device_node *np = dev->of_node;
  1231. const char *parent_clk_name;
  1232. const char *clk_name = "fsgen";
  1233. struct clk_init_data init;
  1234. int ret;
  1235. parent_clk_name = __clk_get_name(parent);
  1236. of_property_read_string(np, "clock-output-names", &clk_name);
  1237. init.name = clk_name;
  1238. init.ops = &fsgen_gate_ops;
  1239. init.flags = 0;
  1240. init.parent_names = &parent_clk_name;
  1241. init.num_parents = 1;
  1242. va->hw.init = &init;
  1243. ret = devm_clk_hw_register(va->dev, &va->hw);
  1244. if (ret)
  1245. return ret;
  1246. return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, &va->hw);
  1247. }
  1248. static int va_macro_validate_dmic_sample_rate(u32 dmic_sample_rate,
  1249. struct va_macro *va)
  1250. {
  1251. u32 div_factor;
  1252. u32 mclk_rate = VA_MACRO_MCLK_FREQ;
  1253. if (!dmic_sample_rate || mclk_rate % dmic_sample_rate != 0)
  1254. goto undefined_rate;
  1255. div_factor = mclk_rate / dmic_sample_rate;
  1256. switch (div_factor) {
  1257. case 2:
  1258. va->dmic_clk_div = VA_MACRO_CLK_DIV_2;
  1259. break;
  1260. case 3:
  1261. va->dmic_clk_div = VA_MACRO_CLK_DIV_3;
  1262. break;
  1263. case 4:
  1264. va->dmic_clk_div = VA_MACRO_CLK_DIV_4;
  1265. break;
  1266. case 6:
  1267. va->dmic_clk_div = VA_MACRO_CLK_DIV_6;
  1268. break;
  1269. case 8:
  1270. va->dmic_clk_div = VA_MACRO_CLK_DIV_8;
  1271. break;
  1272. case 16:
  1273. va->dmic_clk_div = VA_MACRO_CLK_DIV_16;
  1274. break;
  1275. default:
  1276. /* Any other DIV factor is invalid */
  1277. goto undefined_rate;
  1278. }
  1279. return dmic_sample_rate;
  1280. undefined_rate:
  1281. dev_err(va->dev, "%s: Invalid rate %d, for mclk %d\n",
  1282. __func__, dmic_sample_rate, mclk_rate);
  1283. dmic_sample_rate = 0;
  1284. return dmic_sample_rate;
  1285. }
  1286. static int va_macro_probe(struct platform_device *pdev)
  1287. {
  1288. struct device *dev = &pdev->dev;
  1289. const struct va_macro_data *data;
  1290. struct va_macro *va;
  1291. void __iomem *base;
  1292. u32 sample_rate = 0;
  1293. int ret;
  1294. va = devm_kzalloc(dev, sizeof(*va), GFP_KERNEL);
  1295. if (!va)
  1296. return -ENOMEM;
  1297. va->dev = dev;
  1298. va->macro = devm_clk_get_optional(dev, "macro");
  1299. if (IS_ERR(va->macro))
  1300. return PTR_ERR(va->macro);
  1301. va->dcodec = devm_clk_get_optional(dev, "dcodec");
  1302. if (IS_ERR(va->dcodec))
  1303. return PTR_ERR(va->dcodec);
  1304. va->mclk = devm_clk_get(dev, "mclk");
  1305. if (IS_ERR(va->mclk))
  1306. return PTR_ERR(va->mclk);
  1307. va->pds = lpass_macro_pds_init(dev);
  1308. if (IS_ERR(va->pds))
  1309. return PTR_ERR(va->pds);
  1310. ret = of_property_read_u32(dev->of_node, "qcom,dmic-sample-rate",
  1311. &sample_rate);
  1312. if (ret) {
  1313. dev_err(dev, "qcom,dmic-sample-rate dt entry missing\n");
  1314. va->dmic_clk_div = VA_MACRO_CLK_DIV_2;
  1315. } else {
  1316. ret = va_macro_validate_dmic_sample_rate(sample_rate, va);
  1317. if (!ret) {
  1318. ret = -EINVAL;
  1319. goto err;
  1320. }
  1321. }
  1322. base = devm_platform_ioremap_resource(pdev, 0);
  1323. if (IS_ERR(base)) {
  1324. ret = PTR_ERR(base);
  1325. goto err;
  1326. }
  1327. va->regmap = devm_regmap_init_mmio(dev, base, &va_regmap_config);
  1328. if (IS_ERR(va->regmap)) {
  1329. ret = -EINVAL;
  1330. goto err;
  1331. }
  1332. dev_set_drvdata(dev, va);
  1333. data = of_device_get_match_data(dev);
  1334. va->has_swr_master = data->has_swr_master;
  1335. /* mclk rate */
  1336. clk_set_rate(va->mclk, 2 * VA_MACRO_MCLK_FREQ);
  1337. ret = clk_prepare_enable(va->macro);
  1338. if (ret)
  1339. goto err;
  1340. ret = clk_prepare_enable(va->dcodec);
  1341. if (ret)
  1342. goto err_dcodec;
  1343. ret = clk_prepare_enable(va->mclk);
  1344. if (ret)
  1345. goto err_mclk;
  1346. if (va->has_swr_master) {
  1347. /* Set default CLK div to 1 */
  1348. regmap_update_bits(va->regmap, CDC_VA_TOP_CSR_SWR_MIC_CTL0,
  1349. CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK,
  1350. CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1);
  1351. regmap_update_bits(va->regmap, CDC_VA_TOP_CSR_SWR_MIC_CTL1,
  1352. CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK,
  1353. CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1);
  1354. regmap_update_bits(va->regmap, CDC_VA_TOP_CSR_SWR_MIC_CTL2,
  1355. CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK,
  1356. CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1);
  1357. }
  1358. ret = devm_snd_soc_register_component(dev, &va_macro_component_drv,
  1359. va_macro_dais,
  1360. ARRAY_SIZE(va_macro_dais));
  1361. if (ret)
  1362. goto err_clkout;
  1363. pm_runtime_set_autosuspend_delay(dev, 3000);
  1364. pm_runtime_use_autosuspend(dev);
  1365. pm_runtime_mark_last_busy(dev);
  1366. pm_runtime_set_active(dev);
  1367. pm_runtime_enable(dev);
  1368. ret = va_macro_register_fsgen_output(va);
  1369. if (ret)
  1370. goto err_clkout;
  1371. va->fsgen = clk_hw_get_clk(&va->hw, "fsgen");
  1372. if (IS_ERR(va->fsgen)) {
  1373. ret = PTR_ERR(va->fsgen);
  1374. goto err_clkout;
  1375. }
  1376. return 0;
  1377. err_clkout:
  1378. clk_disable_unprepare(va->mclk);
  1379. err_mclk:
  1380. clk_disable_unprepare(va->dcodec);
  1381. err_dcodec:
  1382. clk_disable_unprepare(va->macro);
  1383. err:
  1384. lpass_macro_pds_exit(va->pds);
  1385. return ret;
  1386. }
  1387. static int va_macro_remove(struct platform_device *pdev)
  1388. {
  1389. struct va_macro *va = dev_get_drvdata(&pdev->dev);
  1390. clk_disable_unprepare(va->mclk);
  1391. clk_disable_unprepare(va->dcodec);
  1392. clk_disable_unprepare(va->macro);
  1393. lpass_macro_pds_exit(va->pds);
  1394. return 0;
  1395. }
  1396. static int __maybe_unused va_macro_runtime_suspend(struct device *dev)
  1397. {
  1398. struct va_macro *va = dev_get_drvdata(dev);
  1399. regcache_cache_only(va->regmap, true);
  1400. regcache_mark_dirty(va->regmap);
  1401. clk_disable_unprepare(va->mclk);
  1402. return 0;
  1403. }
  1404. static int __maybe_unused va_macro_runtime_resume(struct device *dev)
  1405. {
  1406. struct va_macro *va = dev_get_drvdata(dev);
  1407. int ret;
  1408. ret = clk_prepare_enable(va->mclk);
  1409. if (ret) {
  1410. dev_err(va->dev, "unable to prepare mclk\n");
  1411. return ret;
  1412. }
  1413. regcache_cache_only(va->regmap, false);
  1414. regcache_sync(va->regmap);
  1415. return 0;
  1416. }
  1417. static const struct dev_pm_ops va_macro_pm_ops = {
  1418. SET_RUNTIME_PM_OPS(va_macro_runtime_suspend, va_macro_runtime_resume, NULL)
  1419. };
  1420. static const struct of_device_id va_macro_dt_match[] = {
  1421. { .compatible = "qcom,sc7280-lpass-va-macro", .data = &sm8250_va_data },
  1422. { .compatible = "qcom,sm8250-lpass-va-macro", .data = &sm8250_va_data },
  1423. { .compatible = "qcom,sm8450-lpass-va-macro", .data = &sm8450_va_data },
  1424. { .compatible = "qcom,sc8280xp-lpass-va-macro", .data = &sm8450_va_data },
  1425. {}
  1426. };
  1427. MODULE_DEVICE_TABLE(of, va_macro_dt_match);
  1428. static struct platform_driver va_macro_driver = {
  1429. .driver = {
  1430. .name = "va_macro",
  1431. .of_match_table = va_macro_dt_match,
  1432. .suppress_bind_attrs = true,
  1433. .pm = &va_macro_pm_ops,
  1434. },
  1435. .probe = va_macro_probe,
  1436. .remove = va_macro_remove,
  1437. };
  1438. module_platform_driver(va_macro_driver);
  1439. MODULE_DESCRIPTION("VA macro driver");
  1440. MODULE_LICENSE("GPL");