lpass-wsa-macro.c 81 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. // Copyright (c) 2018-2020, The Linux Foundation. All rights reserved.
  3. #include <linux/module.h>
  4. #include <linux/init.h>
  5. #include <linux/io.h>
  6. #include <linux/platform_device.h>
  7. #include <linux/clk.h>
  8. #include <linux/of_clk.h>
  9. #include <linux/clk-provider.h>
  10. #include <sound/soc.h>
  11. #include <sound/soc-dapm.h>
  12. #include <linux/pm_runtime.h>
  13. #include <linux/of_platform.h>
  14. #include <sound/tlv.h>
  15. #include "lpass-wsa-macro.h"
  16. #define CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL (0x0000)
  17. #define CDC_WSA_MCLK_EN_MASK BIT(0)
  18. #define CDC_WSA_MCLK_ENABLE BIT(0)
  19. #define CDC_WSA_MCLK_DISABLE 0
  20. #define CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL (0x0004)
  21. #define CDC_WSA_FS_CNT_EN_MASK BIT(0)
  22. #define CDC_WSA_FS_CNT_ENABLE BIT(0)
  23. #define CDC_WSA_FS_CNT_DISABLE 0
  24. #define CDC_WSA_CLK_RST_CTRL_SWR_CONTROL (0x0008)
  25. #define CDC_WSA_SWR_CLK_EN_MASK BIT(0)
  26. #define CDC_WSA_SWR_CLK_ENABLE BIT(0)
  27. #define CDC_WSA_SWR_RST_EN_MASK BIT(1)
  28. #define CDC_WSA_SWR_RST_ENABLE BIT(1)
  29. #define CDC_WSA_SWR_RST_DISABLE 0
  30. #define CDC_WSA_TOP_TOP_CFG0 (0x0080)
  31. #define CDC_WSA_TOP_TOP_CFG1 (0x0084)
  32. #define CDC_WSA_TOP_FREQ_MCLK (0x0088)
  33. #define CDC_WSA_TOP_DEBUG_BUS_SEL (0x008C)
  34. #define CDC_WSA_TOP_DEBUG_EN0 (0x0090)
  35. #define CDC_WSA_TOP_DEBUG_EN1 (0x0094)
  36. #define CDC_WSA_TOP_DEBUG_DSM_LB (0x0098)
  37. #define CDC_WSA_TOP_RX_I2S_CTL (0x009C)
  38. #define CDC_WSA_TOP_TX_I2S_CTL (0x00A0)
  39. #define CDC_WSA_TOP_I2S_CLK (0x00A4)
  40. #define CDC_WSA_TOP_I2S_RESET (0x00A8)
  41. #define CDC_WSA_RX_INP_MUX_RX_INT0_CFG0 (0x0100)
  42. #define CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK GENMASK(2, 0)
  43. #define CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK GENMASK(5, 3)
  44. #define CDC_WSA_RX_INP_MUX_RX_INT0_CFG1 (0x0104)
  45. #define CDC_WSA_RX_INTX_2_SEL_MASK GENMASK(2, 0)
  46. #define CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK GENMASK(5, 3)
  47. #define CDC_WSA_RX_INP_MUX_RX_INT1_CFG0 (0x0108)
  48. #define CDC_WSA_RX_INP_MUX_RX_INT1_CFG1 (0x010C)
  49. #define CDC_WSA_RX_INP_MUX_RX_MIX_CFG0 (0x0110)
  50. #define CDC_WSA_RX_MIX_TX1_SEL_MASK GENMASK(5, 3)
  51. #define CDC_WSA_RX_MIX_TX1_SEL_SHFT 3
  52. #define CDC_WSA_RX_MIX_TX0_SEL_MASK GENMASK(2, 0)
  53. #define CDC_WSA_RX_INP_MUX_RX_EC_CFG0 (0x0114)
  54. #define CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0 (0x0118)
  55. #define CDC_WSA_TX0_SPKR_PROT_PATH_CTL (0x0244)
  56. #define CDC_WSA_TX_SPKR_PROT_RESET_MASK BIT(5)
  57. #define CDC_WSA_TX_SPKR_PROT_RESET BIT(5)
  58. #define CDC_WSA_TX_SPKR_PROT_NO_RESET 0
  59. #define CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK BIT(4)
  60. #define CDC_WSA_TX_SPKR_PROT_CLK_ENABLE BIT(4)
  61. #define CDC_WSA_TX_SPKR_PROT_CLK_DISABLE 0
  62. #define CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK GENMASK(3, 0)
  63. #define CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K 0
  64. #define CDC_WSA_TX0_SPKR_PROT_PATH_CFG0 (0x0248)
  65. #define CDC_WSA_TX1_SPKR_PROT_PATH_CTL (0x0264)
  66. #define CDC_WSA_TX1_SPKR_PROT_PATH_CFG0 (0x0268)
  67. #define CDC_WSA_TX2_SPKR_PROT_PATH_CTL (0x0284)
  68. #define CDC_WSA_TX2_SPKR_PROT_PATH_CFG0 (0x0288)
  69. #define CDC_WSA_TX3_SPKR_PROT_PATH_CTL (0x02A4)
  70. #define CDC_WSA_TX3_SPKR_PROT_PATH_CFG0 (0x02A8)
  71. #define CDC_WSA_INTR_CTRL_CFG (0x0340)
  72. #define CDC_WSA_INTR_CTRL_CLR_COMMIT (0x0344)
  73. #define CDC_WSA_INTR_CTRL_PIN1_MASK0 (0x0360)
  74. #define CDC_WSA_INTR_CTRL_PIN1_STATUS0 (0x0368)
  75. #define CDC_WSA_INTR_CTRL_PIN1_CLEAR0 (0x0370)
  76. #define CDC_WSA_INTR_CTRL_PIN2_MASK0 (0x0380)
  77. #define CDC_WSA_INTR_CTRL_PIN2_STATUS0 (0x0388)
  78. #define CDC_WSA_INTR_CTRL_PIN2_CLEAR0 (0x0390)
  79. #define CDC_WSA_INTR_CTRL_LEVEL0 (0x03C0)
  80. #define CDC_WSA_INTR_CTRL_BYPASS0 (0x03C8)
  81. #define CDC_WSA_INTR_CTRL_SET0 (0x03D0)
  82. #define CDC_WSA_RX0_RX_PATH_CTL (0x0400)
  83. #define CDC_WSA_RX_PATH_CLK_EN_MASK BIT(5)
  84. #define CDC_WSA_RX_PATH_CLK_ENABLE BIT(5)
  85. #define CDC_WSA_RX_PATH_CLK_DISABLE 0
  86. #define CDC_WSA_RX_PATH_PGA_MUTE_EN_MASK BIT(4)
  87. #define CDC_WSA_RX_PATH_PGA_MUTE_ENABLE BIT(4)
  88. #define CDC_WSA_RX_PATH_PGA_MUTE_DISABLE 0
  89. #define CDC_WSA_RX0_RX_PATH_CFG0 (0x0404)
  90. #define CDC_WSA_RX_PATH_COMP_EN_MASK BIT(1)
  91. #define CDC_WSA_RX_PATH_COMP_ENABLE BIT(1)
  92. #define CDC_WSA_RX_PATH_HD2_EN_MASK BIT(2)
  93. #define CDC_WSA_RX_PATH_HD2_ENABLE BIT(2)
  94. #define CDC_WSA_RX_PATH_SPKR_RATE_MASK BIT(3)
  95. #define CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072 BIT(3)
  96. #define CDC_WSA_RX0_RX_PATH_CFG1 (0x0408)
  97. #define CDC_WSA_RX_PATH_SMART_BST_EN_MASK BIT(0)
  98. #define CDC_WSA_RX_PATH_SMART_BST_ENABLE BIT(0)
  99. #define CDC_WSA_RX_PATH_SMART_BST_DISABLE 0
  100. #define CDC_WSA_RX0_RX_PATH_CFG2 (0x040C)
  101. #define CDC_WSA_RX0_RX_PATH_CFG3 (0x0410)
  102. #define CDC_WSA_RX_DC_DCOEFF_MASK GENMASK(1, 0)
  103. #define CDC_WSA_RX0_RX_VOL_CTL (0x0414)
  104. #define CDC_WSA_RX0_RX_PATH_MIX_CTL (0x0418)
  105. #define CDC_WSA_RX_PATH_MIX_CLK_EN_MASK BIT(5)
  106. #define CDC_WSA_RX_PATH_MIX_CLK_ENABLE BIT(5)
  107. #define CDC_WSA_RX_PATH_MIX_CLK_DISABLE 0
  108. #define CDC_WSA_RX0_RX_PATH_MIX_CFG (0x041C)
  109. #define CDC_WSA_RX0_RX_VOL_MIX_CTL (0x0420)
  110. #define CDC_WSA_RX0_RX_PATH_SEC0 (0x0424)
  111. #define CDC_WSA_RX0_RX_PATH_SEC1 (0x0428)
  112. #define CDC_WSA_RX_PGA_HALF_DB_MASK BIT(0)
  113. #define CDC_WSA_RX_PGA_HALF_DB_ENABLE BIT(0)
  114. #define CDC_WSA_RX_PGA_HALF_DB_DISABLE 0
  115. #define CDC_WSA_RX0_RX_PATH_SEC2 (0x042C)
  116. #define CDC_WSA_RX0_RX_PATH_SEC3 (0x0430)
  117. #define CDC_WSA_RX_PATH_HD2_SCALE_MASK GENMASK(1, 0)
  118. #define CDC_WSA_RX_PATH_HD2_ALPHA_MASK GENMASK(5, 2)
  119. #define CDC_WSA_RX0_RX_PATH_SEC5 (0x0438)
  120. #define CDC_WSA_RX0_RX_PATH_SEC6 (0x043C)
  121. #define CDC_WSA_RX0_RX_PATH_SEC7 (0x0440)
  122. #define CDC_WSA_RX0_RX_PATH_MIX_SEC0 (0x0444)
  123. #define CDC_WSA_RX0_RX_PATH_MIX_SEC1 (0x0448)
  124. #define CDC_WSA_RX0_RX_PATH_DSMDEM_CTL (0x044C)
  125. #define CDC_WSA_RX_DSMDEM_CLK_EN_MASK BIT(0)
  126. #define CDC_WSA_RX_DSMDEM_CLK_ENABLE BIT(0)
  127. #define CDC_WSA_RX1_RX_PATH_CTL (0x0480)
  128. #define CDC_WSA_RX1_RX_PATH_CFG0 (0x0484)
  129. #define CDC_WSA_RX1_RX_PATH_CFG1 (0x0488)
  130. #define CDC_WSA_RX1_RX_PATH_CFG2 (0x048C)
  131. #define CDC_WSA_RX1_RX_PATH_CFG3 (0x0490)
  132. #define CDC_WSA_RX1_RX_VOL_CTL (0x0494)
  133. #define CDC_WSA_RX1_RX_PATH_MIX_CTL (0x0498)
  134. #define CDC_WSA_RX1_RX_PATH_MIX_CFG (0x049C)
  135. #define CDC_WSA_RX1_RX_VOL_MIX_CTL (0x04A0)
  136. #define CDC_WSA_RX1_RX_PATH_SEC0 (0x04A4)
  137. #define CDC_WSA_RX1_RX_PATH_SEC1 (0x04A8)
  138. #define CDC_WSA_RX1_RX_PATH_SEC2 (0x04AC)
  139. #define CDC_WSA_RX1_RX_PATH_SEC3 (0x04B0)
  140. #define CDC_WSA_RX1_RX_PATH_SEC5 (0x04B8)
  141. #define CDC_WSA_RX1_RX_PATH_SEC6 (0x04BC)
  142. #define CDC_WSA_RX1_RX_PATH_SEC7 (0x04C0)
  143. #define CDC_WSA_RX1_RX_PATH_MIX_SEC0 (0x04C4)
  144. #define CDC_WSA_RX1_RX_PATH_MIX_SEC1 (0x04C8)
  145. #define CDC_WSA_RX1_RX_PATH_DSMDEM_CTL (0x04CC)
  146. #define CDC_WSA_BOOST0_BOOST_PATH_CTL (0x0500)
  147. #define CDC_WSA_BOOST_PATH_CLK_EN_MASK BIT(4)
  148. #define CDC_WSA_BOOST_PATH_CLK_ENABLE BIT(4)
  149. #define CDC_WSA_BOOST_PATH_CLK_DISABLE 0
  150. #define CDC_WSA_BOOST0_BOOST_CTL (0x0504)
  151. #define CDC_WSA_BOOST0_BOOST_CFG1 (0x0508)
  152. #define CDC_WSA_BOOST0_BOOST_CFG2 (0x050C)
  153. #define CDC_WSA_BOOST1_BOOST_PATH_CTL (0x0540)
  154. #define CDC_WSA_BOOST1_BOOST_CTL (0x0544)
  155. #define CDC_WSA_BOOST1_BOOST_CFG1 (0x0548)
  156. #define CDC_WSA_BOOST1_BOOST_CFG2 (0x054C)
  157. #define CDC_WSA_COMPANDER0_CTL0 (0x0580)
  158. #define CDC_WSA_COMPANDER_CLK_EN_MASK BIT(0)
  159. #define CDC_WSA_COMPANDER_CLK_ENABLE BIT(0)
  160. #define CDC_WSA_COMPANDER_SOFT_RST_MASK BIT(1)
  161. #define CDC_WSA_COMPANDER_SOFT_RST_ENABLE BIT(1)
  162. #define CDC_WSA_COMPANDER_HALT_MASK BIT(2)
  163. #define CDC_WSA_COMPANDER_HALT BIT(2)
  164. #define CDC_WSA_COMPANDER0_CTL1 (0x0584)
  165. #define CDC_WSA_COMPANDER0_CTL2 (0x0588)
  166. #define CDC_WSA_COMPANDER0_CTL3 (0x058C)
  167. #define CDC_WSA_COMPANDER0_CTL4 (0x0590)
  168. #define CDC_WSA_COMPANDER0_CTL5 (0x0594)
  169. #define CDC_WSA_COMPANDER0_CTL6 (0x0598)
  170. #define CDC_WSA_COMPANDER0_CTL7 (0x059C)
  171. #define CDC_WSA_COMPANDER1_CTL0 (0x05C0)
  172. #define CDC_WSA_COMPANDER1_CTL1 (0x05C4)
  173. #define CDC_WSA_COMPANDER1_CTL2 (0x05C8)
  174. #define CDC_WSA_COMPANDER1_CTL3 (0x05CC)
  175. #define CDC_WSA_COMPANDER1_CTL4 (0x05D0)
  176. #define CDC_WSA_COMPANDER1_CTL5 (0x05D4)
  177. #define CDC_WSA_COMPANDER1_CTL6 (0x05D8)
  178. #define CDC_WSA_COMPANDER1_CTL7 (0x05DC)
  179. #define CDC_WSA_SOFTCLIP0_CRC (0x0600)
  180. #define CDC_WSA_SOFTCLIP_CLK_EN_MASK BIT(0)
  181. #define CDC_WSA_SOFTCLIP_CLK_ENABLE BIT(0)
  182. #define CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL (0x0604)
  183. #define CDC_WSA_SOFTCLIP_EN_MASK BIT(0)
  184. #define CDC_WSA_SOFTCLIP_ENABLE BIT(0)
  185. #define CDC_WSA_SOFTCLIP1_CRC (0x0640)
  186. #define CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL (0x0644)
  187. #define CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL (0x0680)
  188. #define CDC_WSA_EC_HQ_EC_CLK_EN_MASK BIT(0)
  189. #define CDC_WSA_EC_HQ_EC_CLK_ENABLE BIT(0)
  190. #define CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0 (0x0684)
  191. #define CDC_WSA_EC_HQ_EC_REF_PCM_RATE_MASK GENMASK(4, 1)
  192. #define CDC_WSA_EC_HQ_EC_REF_PCM_RATE_48K BIT(3)
  193. #define CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL (0x06C0)
  194. #define CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0 (0x06C4)
  195. #define CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL (0x0700)
  196. #define CDC_WSA_SPLINE_ASRC0_CTL0 (0x0704)
  197. #define CDC_WSA_SPLINE_ASRC0_CTL1 (0x0708)
  198. #define CDC_WSA_SPLINE_ASRC0_FIFO_CTL (0x070C)
  199. #define CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB (0x0710)
  200. #define CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB (0x0714)
  201. #define CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB (0x0718)
  202. #define CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB (0x071C)
  203. #define CDC_WSA_SPLINE_ASRC0_STATUS_FIFO (0x0720)
  204. #define CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL (0x0740)
  205. #define CDC_WSA_SPLINE_ASRC1_CTL0 (0x0744)
  206. #define CDC_WSA_SPLINE_ASRC1_CTL1 (0x0748)
  207. #define CDC_WSA_SPLINE_ASRC1_FIFO_CTL (0x074C)
  208. #define CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB (0x0750)
  209. #define CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB (0x0754)
  210. #define CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB (0x0758)
  211. #define CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB (0x075C)
  212. #define CDC_WSA_SPLINE_ASRC1_STATUS_FIFO (0x0760)
  213. #define WSA_MAX_OFFSET (0x0760)
  214. #define WSA_MACRO_RX_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
  215. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\
  216. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
  217. #define WSA_MACRO_RX_MIX_RATES (SNDRV_PCM_RATE_48000 |\
  218. SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
  219. #define WSA_MACRO_RX_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
  220. SNDRV_PCM_FMTBIT_S24_LE |\
  221. SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
  222. #define WSA_MACRO_ECHO_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
  223. SNDRV_PCM_RATE_48000)
  224. #define WSA_MACRO_ECHO_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
  225. SNDRV_PCM_FMTBIT_S24_LE |\
  226. SNDRV_PCM_FMTBIT_S24_3LE)
  227. #define NUM_INTERPOLATORS 2
  228. #define WSA_NUM_CLKS_MAX 5
  229. #define WSA_MACRO_MCLK_FREQ 19200000
  230. #define WSA_MACRO_MUX_INP_MASK2 0x38
  231. #define WSA_MACRO_MUX_CFG_OFFSET 0x8
  232. #define WSA_MACRO_MUX_CFG1_OFFSET 0x4
  233. #define WSA_MACRO_RX_COMP_OFFSET 0x40
  234. #define WSA_MACRO_RX_SOFTCLIP_OFFSET 0x40
  235. #define WSA_MACRO_RX_PATH_OFFSET 0x80
  236. #define WSA_MACRO_RX_PATH_CFG3_OFFSET 0x10
  237. #define WSA_MACRO_RX_PATH_DSMDEM_OFFSET 0x4C
  238. #define WSA_MACRO_FS_RATE_MASK 0x0F
  239. #define WSA_MACRO_EC_MIX_TX0_MASK 0x03
  240. #define WSA_MACRO_EC_MIX_TX1_MASK 0x18
  241. #define WSA_MACRO_MAX_DMA_CH_PER_PORT 0x2
  242. enum {
  243. WSA_MACRO_GAIN_OFFSET_M1P5_DB,
  244. WSA_MACRO_GAIN_OFFSET_0_DB,
  245. };
  246. enum {
  247. WSA_MACRO_RX0 = 0,
  248. WSA_MACRO_RX1,
  249. WSA_MACRO_RX_MIX,
  250. WSA_MACRO_RX_MIX0 = WSA_MACRO_RX_MIX,
  251. WSA_MACRO_RX_MIX1,
  252. WSA_MACRO_RX_MAX,
  253. };
  254. enum {
  255. WSA_MACRO_TX0 = 0,
  256. WSA_MACRO_TX1,
  257. WSA_MACRO_TX_MAX,
  258. };
  259. enum {
  260. WSA_MACRO_EC0_MUX = 0,
  261. WSA_MACRO_EC1_MUX,
  262. WSA_MACRO_EC_MUX_MAX,
  263. };
  264. enum {
  265. WSA_MACRO_COMP1, /* SPK_L */
  266. WSA_MACRO_COMP2, /* SPK_R */
  267. WSA_MACRO_COMP_MAX
  268. };
  269. enum {
  270. WSA_MACRO_SOFTCLIP0, /* RX0 */
  271. WSA_MACRO_SOFTCLIP1, /* RX1 */
  272. WSA_MACRO_SOFTCLIP_MAX
  273. };
  274. enum {
  275. INTn_1_INP_SEL_ZERO = 0,
  276. INTn_1_INP_SEL_RX0,
  277. INTn_1_INP_SEL_RX1,
  278. INTn_1_INP_SEL_RX2,
  279. INTn_1_INP_SEL_RX3,
  280. INTn_1_INP_SEL_DEC0,
  281. INTn_1_INP_SEL_DEC1,
  282. };
  283. enum {
  284. INTn_2_INP_SEL_ZERO = 0,
  285. INTn_2_INP_SEL_RX0,
  286. INTn_2_INP_SEL_RX1,
  287. INTn_2_INP_SEL_RX2,
  288. INTn_2_INP_SEL_RX3,
  289. };
  290. struct interp_sample_rate {
  291. int sample_rate;
  292. int rate_val;
  293. };
  294. static struct interp_sample_rate int_prim_sample_rate_val[] = {
  295. {8000, 0x0}, /* 8K */
  296. {16000, 0x1}, /* 16K */
  297. {24000, -EINVAL},/* 24K */
  298. {32000, 0x3}, /* 32K */
  299. {48000, 0x4}, /* 48K */
  300. {96000, 0x5}, /* 96K */
  301. {192000, 0x6}, /* 192K */
  302. {384000, 0x7}, /* 384K */
  303. {44100, 0x8}, /* 44.1K */
  304. };
  305. static struct interp_sample_rate int_mix_sample_rate_val[] = {
  306. {48000, 0x4}, /* 48K */
  307. {96000, 0x5}, /* 96K */
  308. {192000, 0x6}, /* 192K */
  309. };
  310. enum {
  311. WSA_MACRO_AIF_INVALID = 0,
  312. WSA_MACRO_AIF1_PB,
  313. WSA_MACRO_AIF_MIX1_PB,
  314. WSA_MACRO_AIF_VI,
  315. WSA_MACRO_AIF_ECHO,
  316. WSA_MACRO_MAX_DAIS,
  317. };
  318. struct wsa_macro {
  319. struct device *dev;
  320. int comp_enabled[WSA_MACRO_COMP_MAX];
  321. int ec_hq[WSA_MACRO_RX1 + 1];
  322. u16 prim_int_users[WSA_MACRO_RX1 + 1];
  323. u16 wsa_mclk_users;
  324. unsigned long active_ch_mask[WSA_MACRO_MAX_DAIS];
  325. unsigned long active_ch_cnt[WSA_MACRO_MAX_DAIS];
  326. int rx_port_value[WSA_MACRO_RX_MAX];
  327. int ear_spkr_gain;
  328. int spkr_gain_offset;
  329. int spkr_mode;
  330. int is_softclip_on[WSA_MACRO_SOFTCLIP_MAX];
  331. int softclip_clk_users[WSA_MACRO_SOFTCLIP_MAX];
  332. struct regmap *regmap;
  333. struct clk *mclk;
  334. struct clk *npl;
  335. struct clk *macro;
  336. struct clk *dcodec;
  337. struct clk *fsgen;
  338. struct clk_hw hw;
  339. };
  340. #define to_wsa_macro(_hw) container_of(_hw, struct wsa_macro, hw)
  341. static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400);
  342. static const char *const rx_text[] = {
  343. "ZERO", "RX0", "RX1", "RX_MIX0", "RX_MIX1", "DEC0", "DEC1"
  344. };
  345. static const char *const rx_mix_text[] = {
  346. "ZERO", "RX0", "RX1", "RX_MIX0", "RX_MIX1"
  347. };
  348. static const char *const rx_mix_ec_text[] = {
  349. "ZERO", "RX_MIX_TX0", "RX_MIX_TX1"
  350. };
  351. static const char *const rx_mux_text[] = {
  352. "ZERO", "AIF1_PB", "AIF_MIX1_PB"
  353. };
  354. static const char *const rx_sidetone_mix_text[] = {
  355. "ZERO", "SRC0"
  356. };
  357. static const char * const wsa_macro_ear_spkr_pa_gain_text[] = {
  358. "G_DEFAULT", "G_0_DB", "G_1_DB", "G_2_DB", "G_3_DB",
  359. "G_4_DB", "G_5_DB", "G_6_DB"
  360. };
  361. static SOC_ENUM_SINGLE_EXT_DECL(wsa_macro_ear_spkr_pa_gain_enum,
  362. wsa_macro_ear_spkr_pa_gain_text);
  363. /* RX INT0 */
  364. static const struct soc_enum rx0_prim_inp0_chain_enum =
  365. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG0,
  366. 0, 7, rx_text);
  367. static const struct soc_enum rx0_prim_inp1_chain_enum =
  368. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG0,
  369. 3, 7, rx_text);
  370. static const struct soc_enum rx0_prim_inp2_chain_enum =
  371. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG1,
  372. 3, 7, rx_text);
  373. static const struct soc_enum rx0_mix_chain_enum =
  374. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG1,
  375. 0, 5, rx_mix_text);
  376. static const struct soc_enum rx0_sidetone_mix_enum =
  377. SOC_ENUM_SINGLE(SND_SOC_NOPM, 0, 2, rx_sidetone_mix_text);
  378. static const struct snd_kcontrol_new rx0_prim_inp0_mux =
  379. SOC_DAPM_ENUM("WSA_RX0 INP0 Mux", rx0_prim_inp0_chain_enum);
  380. static const struct snd_kcontrol_new rx0_prim_inp1_mux =
  381. SOC_DAPM_ENUM("WSA_RX0 INP1 Mux", rx0_prim_inp1_chain_enum);
  382. static const struct snd_kcontrol_new rx0_prim_inp2_mux =
  383. SOC_DAPM_ENUM("WSA_RX0 INP2 Mux", rx0_prim_inp2_chain_enum);
  384. static const struct snd_kcontrol_new rx0_mix_mux =
  385. SOC_DAPM_ENUM("WSA_RX0 MIX Mux", rx0_mix_chain_enum);
  386. static const struct snd_kcontrol_new rx0_sidetone_mix_mux =
  387. SOC_DAPM_ENUM("WSA_RX0 SIDETONE MIX Mux", rx0_sidetone_mix_enum);
  388. /* RX INT1 */
  389. static const struct soc_enum rx1_prim_inp0_chain_enum =
  390. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG0,
  391. 0, 7, rx_text);
  392. static const struct soc_enum rx1_prim_inp1_chain_enum =
  393. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG0,
  394. 3, 7, rx_text);
  395. static const struct soc_enum rx1_prim_inp2_chain_enum =
  396. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG1,
  397. 3, 7, rx_text);
  398. static const struct soc_enum rx1_mix_chain_enum =
  399. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG1,
  400. 0, 5, rx_mix_text);
  401. static const struct snd_kcontrol_new rx1_prim_inp0_mux =
  402. SOC_DAPM_ENUM("WSA_RX1 INP0 Mux", rx1_prim_inp0_chain_enum);
  403. static const struct snd_kcontrol_new rx1_prim_inp1_mux =
  404. SOC_DAPM_ENUM("WSA_RX1 INP1 Mux", rx1_prim_inp1_chain_enum);
  405. static const struct snd_kcontrol_new rx1_prim_inp2_mux =
  406. SOC_DAPM_ENUM("WSA_RX1 INP2 Mux", rx1_prim_inp2_chain_enum);
  407. static const struct snd_kcontrol_new rx1_mix_mux =
  408. SOC_DAPM_ENUM("WSA_RX1 MIX Mux", rx1_mix_chain_enum);
  409. static const struct soc_enum rx_mix_ec0_enum =
  410. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_MIX_CFG0,
  411. 0, 3, rx_mix_ec_text);
  412. static const struct soc_enum rx_mix_ec1_enum =
  413. SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_MIX_CFG0,
  414. 3, 3, rx_mix_ec_text);
  415. static const struct snd_kcontrol_new rx_mix_ec0_mux =
  416. SOC_DAPM_ENUM("WSA RX_MIX EC0_Mux", rx_mix_ec0_enum);
  417. static const struct snd_kcontrol_new rx_mix_ec1_mux =
  418. SOC_DAPM_ENUM("WSA RX_MIX EC1_Mux", rx_mix_ec1_enum);
  419. static const struct reg_default wsa_defaults[] = {
  420. /* WSA Macro */
  421. { CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL, 0x00},
  422. { CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL, 0x00},
  423. { CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 0x00},
  424. { CDC_WSA_TOP_TOP_CFG0, 0x00},
  425. { CDC_WSA_TOP_TOP_CFG1, 0x00},
  426. { CDC_WSA_TOP_FREQ_MCLK, 0x00},
  427. { CDC_WSA_TOP_DEBUG_BUS_SEL, 0x00},
  428. { CDC_WSA_TOP_DEBUG_EN0, 0x00},
  429. { CDC_WSA_TOP_DEBUG_EN1, 0x00},
  430. { CDC_WSA_TOP_DEBUG_DSM_LB, 0x88},
  431. { CDC_WSA_TOP_RX_I2S_CTL, 0x0C},
  432. { CDC_WSA_TOP_TX_I2S_CTL, 0x0C},
  433. { CDC_WSA_TOP_I2S_CLK, 0x02},
  434. { CDC_WSA_TOP_I2S_RESET, 0x00},
  435. { CDC_WSA_RX_INP_MUX_RX_INT0_CFG0, 0x00},
  436. { CDC_WSA_RX_INP_MUX_RX_INT0_CFG1, 0x00},
  437. { CDC_WSA_RX_INP_MUX_RX_INT1_CFG0, 0x00},
  438. { CDC_WSA_RX_INP_MUX_RX_INT1_CFG1, 0x00},
  439. { CDC_WSA_RX_INP_MUX_RX_MIX_CFG0, 0x00},
  440. { CDC_WSA_RX_INP_MUX_RX_EC_CFG0, 0x00},
  441. { CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0, 0x00},
  442. { CDC_WSA_TX0_SPKR_PROT_PATH_CTL, 0x02},
  443. { CDC_WSA_TX0_SPKR_PROT_PATH_CFG0, 0x00},
  444. { CDC_WSA_TX1_SPKR_PROT_PATH_CTL, 0x02},
  445. { CDC_WSA_TX1_SPKR_PROT_PATH_CFG0, 0x00},
  446. { CDC_WSA_TX2_SPKR_PROT_PATH_CTL, 0x02},
  447. { CDC_WSA_TX2_SPKR_PROT_PATH_CFG0, 0x00},
  448. { CDC_WSA_TX3_SPKR_PROT_PATH_CTL, 0x02},
  449. { CDC_WSA_TX3_SPKR_PROT_PATH_CFG0, 0x00},
  450. { CDC_WSA_INTR_CTRL_CFG, 0x00},
  451. { CDC_WSA_INTR_CTRL_CLR_COMMIT, 0x00},
  452. { CDC_WSA_INTR_CTRL_PIN1_MASK0, 0xFF},
  453. { CDC_WSA_INTR_CTRL_PIN1_STATUS0, 0x00},
  454. { CDC_WSA_INTR_CTRL_PIN1_CLEAR0, 0x00},
  455. { CDC_WSA_INTR_CTRL_PIN2_MASK0, 0xFF},
  456. { CDC_WSA_INTR_CTRL_PIN2_STATUS0, 0x00},
  457. { CDC_WSA_INTR_CTRL_PIN2_CLEAR0, 0x00},
  458. { CDC_WSA_INTR_CTRL_LEVEL0, 0x00},
  459. { CDC_WSA_INTR_CTRL_BYPASS0, 0x00},
  460. { CDC_WSA_INTR_CTRL_SET0, 0x00},
  461. { CDC_WSA_RX0_RX_PATH_CTL, 0x04},
  462. { CDC_WSA_RX0_RX_PATH_CFG0, 0x00},
  463. { CDC_WSA_RX0_RX_PATH_CFG1, 0x64},
  464. { CDC_WSA_RX0_RX_PATH_CFG2, 0x8F},
  465. { CDC_WSA_RX0_RX_PATH_CFG3, 0x00},
  466. { CDC_WSA_RX0_RX_VOL_CTL, 0x00},
  467. { CDC_WSA_RX0_RX_PATH_MIX_CTL, 0x04},
  468. { CDC_WSA_RX0_RX_PATH_MIX_CFG, 0x7E},
  469. { CDC_WSA_RX0_RX_VOL_MIX_CTL, 0x00},
  470. { CDC_WSA_RX0_RX_PATH_SEC0, 0x04},
  471. { CDC_WSA_RX0_RX_PATH_SEC1, 0x08},
  472. { CDC_WSA_RX0_RX_PATH_SEC2, 0x00},
  473. { CDC_WSA_RX0_RX_PATH_SEC3, 0x00},
  474. { CDC_WSA_RX0_RX_PATH_SEC5, 0x00},
  475. { CDC_WSA_RX0_RX_PATH_SEC6, 0x00},
  476. { CDC_WSA_RX0_RX_PATH_SEC7, 0x00},
  477. { CDC_WSA_RX0_RX_PATH_MIX_SEC0, 0x08},
  478. { CDC_WSA_RX0_RX_PATH_MIX_SEC1, 0x00},
  479. { CDC_WSA_RX0_RX_PATH_DSMDEM_CTL, 0x00},
  480. { CDC_WSA_RX1_RX_PATH_CFG0, 0x00},
  481. { CDC_WSA_RX1_RX_PATH_CFG1, 0x64},
  482. { CDC_WSA_RX1_RX_PATH_CFG2, 0x8F},
  483. { CDC_WSA_RX1_RX_PATH_CFG3, 0x00},
  484. { CDC_WSA_RX1_RX_VOL_CTL, 0x00},
  485. { CDC_WSA_RX1_RX_PATH_MIX_CTL, 0x04},
  486. { CDC_WSA_RX1_RX_PATH_MIX_CFG, 0x7E},
  487. { CDC_WSA_RX1_RX_VOL_MIX_CTL, 0x00},
  488. { CDC_WSA_RX1_RX_PATH_SEC0, 0x04},
  489. { CDC_WSA_RX1_RX_PATH_SEC1, 0x08},
  490. { CDC_WSA_RX1_RX_PATH_SEC2, 0x00},
  491. { CDC_WSA_RX1_RX_PATH_SEC3, 0x00},
  492. { CDC_WSA_RX1_RX_PATH_SEC5, 0x00},
  493. { CDC_WSA_RX1_RX_PATH_SEC6, 0x00},
  494. { CDC_WSA_RX1_RX_PATH_SEC7, 0x00},
  495. { CDC_WSA_RX1_RX_PATH_MIX_SEC0, 0x08},
  496. { CDC_WSA_RX1_RX_PATH_MIX_SEC1, 0x00},
  497. { CDC_WSA_RX1_RX_PATH_DSMDEM_CTL, 0x00},
  498. { CDC_WSA_BOOST0_BOOST_PATH_CTL, 0x00},
  499. { CDC_WSA_BOOST0_BOOST_CTL, 0xD0},
  500. { CDC_WSA_BOOST0_BOOST_CFG1, 0x89},
  501. { CDC_WSA_BOOST0_BOOST_CFG2, 0x04},
  502. { CDC_WSA_BOOST1_BOOST_PATH_CTL, 0x00},
  503. { CDC_WSA_BOOST1_BOOST_CTL, 0xD0},
  504. { CDC_WSA_BOOST1_BOOST_CFG1, 0x89},
  505. { CDC_WSA_BOOST1_BOOST_CFG2, 0x04},
  506. { CDC_WSA_COMPANDER0_CTL0, 0x60},
  507. { CDC_WSA_COMPANDER0_CTL1, 0xDB},
  508. { CDC_WSA_COMPANDER0_CTL2, 0xFF},
  509. { CDC_WSA_COMPANDER0_CTL3, 0x35},
  510. { CDC_WSA_COMPANDER0_CTL4, 0xFF},
  511. { CDC_WSA_COMPANDER0_CTL5, 0x00},
  512. { CDC_WSA_COMPANDER0_CTL6, 0x01},
  513. { CDC_WSA_COMPANDER0_CTL7, 0x28},
  514. { CDC_WSA_COMPANDER1_CTL0, 0x60},
  515. { CDC_WSA_COMPANDER1_CTL1, 0xDB},
  516. { CDC_WSA_COMPANDER1_CTL2, 0xFF},
  517. { CDC_WSA_COMPANDER1_CTL3, 0x35},
  518. { CDC_WSA_COMPANDER1_CTL4, 0xFF},
  519. { CDC_WSA_COMPANDER1_CTL5, 0x00},
  520. { CDC_WSA_COMPANDER1_CTL6, 0x01},
  521. { CDC_WSA_COMPANDER1_CTL7, 0x28},
  522. { CDC_WSA_SOFTCLIP0_CRC, 0x00},
  523. { CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL, 0x38},
  524. { CDC_WSA_SOFTCLIP1_CRC, 0x00},
  525. { CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL, 0x38},
  526. { CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL, 0x00},
  527. { CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0, 0x01},
  528. { CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL, 0x00},
  529. { CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0, 0x01},
  530. { CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL, 0x00},
  531. { CDC_WSA_SPLINE_ASRC0_CTL0, 0x00},
  532. { CDC_WSA_SPLINE_ASRC0_CTL1, 0x00},
  533. { CDC_WSA_SPLINE_ASRC0_FIFO_CTL, 0xA8},
  534. { CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB, 0x00},
  535. { CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB, 0x00},
  536. { CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB, 0x00},
  537. { CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB, 0x00},
  538. { CDC_WSA_SPLINE_ASRC0_STATUS_FIFO, 0x00},
  539. { CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL, 0x00},
  540. { CDC_WSA_SPLINE_ASRC1_CTL0, 0x00},
  541. { CDC_WSA_SPLINE_ASRC1_CTL1, 0x00},
  542. { CDC_WSA_SPLINE_ASRC1_FIFO_CTL, 0xA8},
  543. { CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB, 0x00},
  544. { CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB, 0x00},
  545. { CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB, 0x00},
  546. { CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB, 0x00},
  547. { CDC_WSA_SPLINE_ASRC1_STATUS_FIFO, 0x00},
  548. };
  549. static bool wsa_is_wronly_register(struct device *dev,
  550. unsigned int reg)
  551. {
  552. switch (reg) {
  553. case CDC_WSA_INTR_CTRL_CLR_COMMIT:
  554. case CDC_WSA_INTR_CTRL_PIN1_CLEAR0:
  555. case CDC_WSA_INTR_CTRL_PIN2_CLEAR0:
  556. return true;
  557. }
  558. return false;
  559. }
  560. static bool wsa_is_rw_register(struct device *dev, unsigned int reg)
  561. {
  562. switch (reg) {
  563. case CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL:
  564. case CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL:
  565. case CDC_WSA_CLK_RST_CTRL_SWR_CONTROL:
  566. case CDC_WSA_TOP_TOP_CFG0:
  567. case CDC_WSA_TOP_TOP_CFG1:
  568. case CDC_WSA_TOP_FREQ_MCLK:
  569. case CDC_WSA_TOP_DEBUG_BUS_SEL:
  570. case CDC_WSA_TOP_DEBUG_EN0:
  571. case CDC_WSA_TOP_DEBUG_EN1:
  572. case CDC_WSA_TOP_DEBUG_DSM_LB:
  573. case CDC_WSA_TOP_RX_I2S_CTL:
  574. case CDC_WSA_TOP_TX_I2S_CTL:
  575. case CDC_WSA_TOP_I2S_CLK:
  576. case CDC_WSA_TOP_I2S_RESET:
  577. case CDC_WSA_RX_INP_MUX_RX_INT0_CFG0:
  578. case CDC_WSA_RX_INP_MUX_RX_INT0_CFG1:
  579. case CDC_WSA_RX_INP_MUX_RX_INT1_CFG0:
  580. case CDC_WSA_RX_INP_MUX_RX_INT1_CFG1:
  581. case CDC_WSA_RX_INP_MUX_RX_MIX_CFG0:
  582. case CDC_WSA_RX_INP_MUX_RX_EC_CFG0:
  583. case CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0:
  584. case CDC_WSA_TX0_SPKR_PROT_PATH_CTL:
  585. case CDC_WSA_TX0_SPKR_PROT_PATH_CFG0:
  586. case CDC_WSA_TX1_SPKR_PROT_PATH_CTL:
  587. case CDC_WSA_TX1_SPKR_PROT_PATH_CFG0:
  588. case CDC_WSA_TX2_SPKR_PROT_PATH_CTL:
  589. case CDC_WSA_TX2_SPKR_PROT_PATH_CFG0:
  590. case CDC_WSA_TX3_SPKR_PROT_PATH_CTL:
  591. case CDC_WSA_TX3_SPKR_PROT_PATH_CFG0:
  592. case CDC_WSA_INTR_CTRL_CFG:
  593. case CDC_WSA_INTR_CTRL_PIN1_MASK0:
  594. case CDC_WSA_INTR_CTRL_PIN2_MASK0:
  595. case CDC_WSA_INTR_CTRL_LEVEL0:
  596. case CDC_WSA_INTR_CTRL_BYPASS0:
  597. case CDC_WSA_INTR_CTRL_SET0:
  598. case CDC_WSA_RX0_RX_PATH_CTL:
  599. case CDC_WSA_RX0_RX_PATH_CFG0:
  600. case CDC_WSA_RX0_RX_PATH_CFG1:
  601. case CDC_WSA_RX0_RX_PATH_CFG2:
  602. case CDC_WSA_RX0_RX_PATH_CFG3:
  603. case CDC_WSA_RX0_RX_VOL_CTL:
  604. case CDC_WSA_RX0_RX_PATH_MIX_CTL:
  605. case CDC_WSA_RX0_RX_PATH_MIX_CFG:
  606. case CDC_WSA_RX0_RX_VOL_MIX_CTL:
  607. case CDC_WSA_RX0_RX_PATH_SEC0:
  608. case CDC_WSA_RX0_RX_PATH_SEC1:
  609. case CDC_WSA_RX0_RX_PATH_SEC2:
  610. case CDC_WSA_RX0_RX_PATH_SEC3:
  611. case CDC_WSA_RX0_RX_PATH_SEC5:
  612. case CDC_WSA_RX0_RX_PATH_SEC6:
  613. case CDC_WSA_RX0_RX_PATH_SEC7:
  614. case CDC_WSA_RX0_RX_PATH_MIX_SEC0:
  615. case CDC_WSA_RX0_RX_PATH_MIX_SEC1:
  616. case CDC_WSA_RX0_RX_PATH_DSMDEM_CTL:
  617. case CDC_WSA_RX1_RX_PATH_CTL:
  618. case CDC_WSA_RX1_RX_PATH_CFG0:
  619. case CDC_WSA_RX1_RX_PATH_CFG1:
  620. case CDC_WSA_RX1_RX_PATH_CFG2:
  621. case CDC_WSA_RX1_RX_PATH_CFG3:
  622. case CDC_WSA_RX1_RX_VOL_CTL:
  623. case CDC_WSA_RX1_RX_PATH_MIX_CTL:
  624. case CDC_WSA_RX1_RX_PATH_MIX_CFG:
  625. case CDC_WSA_RX1_RX_VOL_MIX_CTL:
  626. case CDC_WSA_RX1_RX_PATH_SEC0:
  627. case CDC_WSA_RX1_RX_PATH_SEC1:
  628. case CDC_WSA_RX1_RX_PATH_SEC2:
  629. case CDC_WSA_RX1_RX_PATH_SEC3:
  630. case CDC_WSA_RX1_RX_PATH_SEC5:
  631. case CDC_WSA_RX1_RX_PATH_SEC6:
  632. case CDC_WSA_RX1_RX_PATH_SEC7:
  633. case CDC_WSA_RX1_RX_PATH_MIX_SEC0:
  634. case CDC_WSA_RX1_RX_PATH_MIX_SEC1:
  635. case CDC_WSA_RX1_RX_PATH_DSMDEM_CTL:
  636. case CDC_WSA_BOOST0_BOOST_PATH_CTL:
  637. case CDC_WSA_BOOST0_BOOST_CTL:
  638. case CDC_WSA_BOOST0_BOOST_CFG1:
  639. case CDC_WSA_BOOST0_BOOST_CFG2:
  640. case CDC_WSA_BOOST1_BOOST_PATH_CTL:
  641. case CDC_WSA_BOOST1_BOOST_CTL:
  642. case CDC_WSA_BOOST1_BOOST_CFG1:
  643. case CDC_WSA_BOOST1_BOOST_CFG2:
  644. case CDC_WSA_COMPANDER0_CTL0:
  645. case CDC_WSA_COMPANDER0_CTL1:
  646. case CDC_WSA_COMPANDER0_CTL2:
  647. case CDC_WSA_COMPANDER0_CTL3:
  648. case CDC_WSA_COMPANDER0_CTL4:
  649. case CDC_WSA_COMPANDER0_CTL5:
  650. case CDC_WSA_COMPANDER0_CTL7:
  651. case CDC_WSA_COMPANDER1_CTL0:
  652. case CDC_WSA_COMPANDER1_CTL1:
  653. case CDC_WSA_COMPANDER1_CTL2:
  654. case CDC_WSA_COMPANDER1_CTL3:
  655. case CDC_WSA_COMPANDER1_CTL4:
  656. case CDC_WSA_COMPANDER1_CTL5:
  657. case CDC_WSA_COMPANDER1_CTL7:
  658. case CDC_WSA_SOFTCLIP0_CRC:
  659. case CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL:
  660. case CDC_WSA_SOFTCLIP1_CRC:
  661. case CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL:
  662. case CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL:
  663. case CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0:
  664. case CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL:
  665. case CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0:
  666. case CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL:
  667. case CDC_WSA_SPLINE_ASRC0_CTL0:
  668. case CDC_WSA_SPLINE_ASRC0_CTL1:
  669. case CDC_WSA_SPLINE_ASRC0_FIFO_CTL:
  670. case CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL:
  671. case CDC_WSA_SPLINE_ASRC1_CTL0:
  672. case CDC_WSA_SPLINE_ASRC1_CTL1:
  673. case CDC_WSA_SPLINE_ASRC1_FIFO_CTL:
  674. return true;
  675. }
  676. return false;
  677. }
  678. static bool wsa_is_writeable_register(struct device *dev, unsigned int reg)
  679. {
  680. bool ret;
  681. ret = wsa_is_rw_register(dev, reg);
  682. if (!ret)
  683. return wsa_is_wronly_register(dev, reg);
  684. return ret;
  685. }
  686. static bool wsa_is_readable_register(struct device *dev, unsigned int reg)
  687. {
  688. switch (reg) {
  689. case CDC_WSA_INTR_CTRL_CLR_COMMIT:
  690. case CDC_WSA_INTR_CTRL_PIN1_CLEAR0:
  691. case CDC_WSA_INTR_CTRL_PIN2_CLEAR0:
  692. case CDC_WSA_INTR_CTRL_PIN1_STATUS0:
  693. case CDC_WSA_INTR_CTRL_PIN2_STATUS0:
  694. case CDC_WSA_COMPANDER0_CTL6:
  695. case CDC_WSA_COMPANDER1_CTL6:
  696. case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB:
  697. case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB:
  698. case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB:
  699. case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB:
  700. case CDC_WSA_SPLINE_ASRC0_STATUS_FIFO:
  701. case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB:
  702. case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB:
  703. case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB:
  704. case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB:
  705. case CDC_WSA_SPLINE_ASRC1_STATUS_FIFO:
  706. return true;
  707. }
  708. return wsa_is_rw_register(dev, reg);
  709. }
  710. static bool wsa_is_volatile_register(struct device *dev, unsigned int reg)
  711. {
  712. /* Update volatile list for rx/tx macros */
  713. switch (reg) {
  714. case CDC_WSA_INTR_CTRL_PIN1_STATUS0:
  715. case CDC_WSA_INTR_CTRL_PIN2_STATUS0:
  716. case CDC_WSA_COMPANDER0_CTL6:
  717. case CDC_WSA_COMPANDER1_CTL6:
  718. case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB:
  719. case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB:
  720. case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB:
  721. case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB:
  722. case CDC_WSA_SPLINE_ASRC0_STATUS_FIFO:
  723. case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB:
  724. case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB:
  725. case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB:
  726. case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB:
  727. case CDC_WSA_SPLINE_ASRC1_STATUS_FIFO:
  728. return true;
  729. }
  730. return false;
  731. }
  732. static const struct regmap_config wsa_regmap_config = {
  733. .name = "wsa_macro",
  734. .reg_bits = 16,
  735. .val_bits = 32, /* 8 but with 32 bit read/write */
  736. .reg_stride = 4,
  737. .cache_type = REGCACHE_FLAT,
  738. .reg_defaults = wsa_defaults,
  739. .num_reg_defaults = ARRAY_SIZE(wsa_defaults),
  740. .max_register = WSA_MAX_OFFSET,
  741. .writeable_reg = wsa_is_writeable_register,
  742. .volatile_reg = wsa_is_volatile_register,
  743. .readable_reg = wsa_is_readable_register,
  744. };
  745. /**
  746. * wsa_macro_set_spkr_mode - Configures speaker compander and smartboost
  747. * settings based on speaker mode.
  748. *
  749. * @component: codec instance
  750. * @mode: Indicates speaker configuration mode.
  751. *
  752. * Returns 0 on success or -EINVAL on error.
  753. */
  754. int wsa_macro_set_spkr_mode(struct snd_soc_component *component, int mode)
  755. {
  756. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  757. wsa->spkr_mode = mode;
  758. switch (mode) {
  759. case WSA_MACRO_SPKR_MODE_1:
  760. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL3, 0x80, 0x00);
  761. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL3, 0x80, 0x00);
  762. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL7, 0x01, 0x00);
  763. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL7, 0x01, 0x00);
  764. snd_soc_component_update_bits(component, CDC_WSA_BOOST0_BOOST_CTL, 0x7C, 0x44);
  765. snd_soc_component_update_bits(component, CDC_WSA_BOOST1_BOOST_CTL, 0x7C, 0x44);
  766. break;
  767. default:
  768. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL3, 0x80, 0x80);
  769. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL3, 0x80, 0x80);
  770. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL7, 0x01, 0x01);
  771. snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL7, 0x01, 0x01);
  772. snd_soc_component_update_bits(component, CDC_WSA_BOOST0_BOOST_CTL, 0x7C, 0x58);
  773. snd_soc_component_update_bits(component, CDC_WSA_BOOST1_BOOST_CTL, 0x7C, 0x58);
  774. break;
  775. }
  776. return 0;
  777. }
  778. EXPORT_SYMBOL(wsa_macro_set_spkr_mode);
  779. static int wsa_macro_set_prim_interpolator_rate(struct snd_soc_dai *dai,
  780. u8 int_prim_fs_rate_reg_val,
  781. u32 sample_rate)
  782. {
  783. u8 int_1_mix1_inp;
  784. u32 j, port;
  785. u16 int_mux_cfg0, int_mux_cfg1;
  786. u16 int_fs_reg;
  787. u8 inp0_sel, inp1_sel, inp2_sel;
  788. struct snd_soc_component *component = dai->component;
  789. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  790. for_each_set_bit(port, &wsa->active_ch_mask[dai->id], WSA_MACRO_RX_MAX) {
  791. int_1_mix1_inp = port;
  792. if ((int_1_mix1_inp < WSA_MACRO_RX0) || (int_1_mix1_inp > WSA_MACRO_RX_MIX1)) {
  793. dev_err(component->dev, "%s: Invalid RX port, Dai ID is %d\n",
  794. __func__, dai->id);
  795. return -EINVAL;
  796. }
  797. int_mux_cfg0 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG0;
  798. /*
  799. * Loop through all interpolator MUX inputs and find out
  800. * to which interpolator input, the cdc_dma rx port
  801. * is connected
  802. */
  803. for (j = 0; j < NUM_INTERPOLATORS; j++) {
  804. int_mux_cfg1 = int_mux_cfg0 + WSA_MACRO_MUX_CFG1_OFFSET;
  805. inp0_sel = snd_soc_component_read_field(component, int_mux_cfg0,
  806. CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK);
  807. inp1_sel = snd_soc_component_read_field(component, int_mux_cfg0,
  808. CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK);
  809. inp2_sel = snd_soc_component_read_field(component, int_mux_cfg1,
  810. CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK);
  811. if ((inp0_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0) ||
  812. (inp1_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0) ||
  813. (inp2_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0)) {
  814. int_fs_reg = CDC_WSA_RX0_RX_PATH_CTL +
  815. WSA_MACRO_RX_PATH_OFFSET * j;
  816. /* sample_rate is in Hz */
  817. snd_soc_component_update_bits(component, int_fs_reg,
  818. WSA_MACRO_FS_RATE_MASK,
  819. int_prim_fs_rate_reg_val);
  820. }
  821. int_mux_cfg0 += WSA_MACRO_MUX_CFG_OFFSET;
  822. }
  823. }
  824. return 0;
  825. }
  826. static int wsa_macro_set_mix_interpolator_rate(struct snd_soc_dai *dai,
  827. u8 int_mix_fs_rate_reg_val,
  828. u32 sample_rate)
  829. {
  830. u8 int_2_inp;
  831. u32 j, port;
  832. u16 int_mux_cfg1, int_fs_reg;
  833. u8 int_mux_cfg1_val;
  834. struct snd_soc_component *component = dai->component;
  835. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  836. for_each_set_bit(port, &wsa->active_ch_mask[dai->id], WSA_MACRO_RX_MAX) {
  837. int_2_inp = port;
  838. if ((int_2_inp < WSA_MACRO_RX0) || (int_2_inp > WSA_MACRO_RX_MIX1)) {
  839. dev_err(component->dev, "%s: Invalid RX port, Dai ID is %d\n",
  840. __func__, dai->id);
  841. return -EINVAL;
  842. }
  843. int_mux_cfg1 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG1;
  844. for (j = 0; j < NUM_INTERPOLATORS; j++) {
  845. int_mux_cfg1_val = snd_soc_component_read_field(component, int_mux_cfg1,
  846. CDC_WSA_RX_INTX_2_SEL_MASK);
  847. if (int_mux_cfg1_val == int_2_inp + INTn_2_INP_SEL_RX0) {
  848. int_fs_reg = CDC_WSA_RX0_RX_PATH_MIX_CTL +
  849. WSA_MACRO_RX_PATH_OFFSET * j;
  850. snd_soc_component_update_bits(component,
  851. int_fs_reg,
  852. WSA_MACRO_FS_RATE_MASK,
  853. int_mix_fs_rate_reg_val);
  854. }
  855. int_mux_cfg1 += WSA_MACRO_MUX_CFG_OFFSET;
  856. }
  857. }
  858. return 0;
  859. }
  860. static int wsa_macro_set_interpolator_rate(struct snd_soc_dai *dai,
  861. u32 sample_rate)
  862. {
  863. int rate_val = 0;
  864. int i, ret;
  865. /* set mixing path rate */
  866. for (i = 0; i < ARRAY_SIZE(int_mix_sample_rate_val); i++) {
  867. if (sample_rate == int_mix_sample_rate_val[i].sample_rate) {
  868. rate_val = int_mix_sample_rate_val[i].rate_val;
  869. break;
  870. }
  871. }
  872. if ((i == ARRAY_SIZE(int_mix_sample_rate_val)) || (rate_val < 0))
  873. goto prim_rate;
  874. ret = wsa_macro_set_mix_interpolator_rate(dai, (u8) rate_val, sample_rate);
  875. if (ret < 0)
  876. return ret;
  877. prim_rate:
  878. /* set primary path sample rate */
  879. for (i = 0; i < ARRAY_SIZE(int_prim_sample_rate_val); i++) {
  880. if (sample_rate == int_prim_sample_rate_val[i].sample_rate) {
  881. rate_val = int_prim_sample_rate_val[i].rate_val;
  882. break;
  883. }
  884. }
  885. if ((i == ARRAY_SIZE(int_prim_sample_rate_val)) || (rate_val < 0))
  886. return -EINVAL;
  887. ret = wsa_macro_set_prim_interpolator_rate(dai, (u8) rate_val, sample_rate);
  888. return ret;
  889. }
  890. static int wsa_macro_hw_params(struct snd_pcm_substream *substream,
  891. struct snd_pcm_hw_params *params,
  892. struct snd_soc_dai *dai)
  893. {
  894. struct snd_soc_component *component = dai->component;
  895. int ret;
  896. switch (substream->stream) {
  897. case SNDRV_PCM_STREAM_PLAYBACK:
  898. ret = wsa_macro_set_interpolator_rate(dai, params_rate(params));
  899. if (ret) {
  900. dev_err(component->dev,
  901. "%s: cannot set sample rate: %u\n",
  902. __func__, params_rate(params));
  903. return ret;
  904. }
  905. break;
  906. default:
  907. break;
  908. }
  909. return 0;
  910. }
  911. static int wsa_macro_get_channel_map(struct snd_soc_dai *dai,
  912. unsigned int *tx_num, unsigned int *tx_slot,
  913. unsigned int *rx_num, unsigned int *rx_slot)
  914. {
  915. struct snd_soc_component *component = dai->component;
  916. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  917. u16 val, mask = 0, cnt = 0, temp;
  918. switch (dai->id) {
  919. case WSA_MACRO_AIF_VI:
  920. *tx_slot = wsa->active_ch_mask[dai->id];
  921. *tx_num = wsa->active_ch_cnt[dai->id];
  922. break;
  923. case WSA_MACRO_AIF1_PB:
  924. case WSA_MACRO_AIF_MIX1_PB:
  925. for_each_set_bit(temp, &wsa->active_ch_mask[dai->id],
  926. WSA_MACRO_RX_MAX) {
  927. mask |= (1 << temp);
  928. if (++cnt == WSA_MACRO_MAX_DMA_CH_PER_PORT)
  929. break;
  930. }
  931. if (mask & 0x0C)
  932. mask = mask >> 0x2;
  933. *rx_slot = mask;
  934. *rx_num = cnt;
  935. break;
  936. case WSA_MACRO_AIF_ECHO:
  937. val = snd_soc_component_read(component, CDC_WSA_RX_INP_MUX_RX_MIX_CFG0);
  938. if (val & WSA_MACRO_EC_MIX_TX1_MASK) {
  939. mask |= 0x2;
  940. cnt++;
  941. }
  942. if (val & WSA_MACRO_EC_MIX_TX0_MASK) {
  943. mask |= 0x1;
  944. cnt++;
  945. }
  946. *tx_slot = mask;
  947. *tx_num = cnt;
  948. break;
  949. default:
  950. dev_err(component->dev, "%s: Invalid AIF\n", __func__);
  951. break;
  952. }
  953. return 0;
  954. }
  955. static const struct snd_soc_dai_ops wsa_macro_dai_ops = {
  956. .hw_params = wsa_macro_hw_params,
  957. .get_channel_map = wsa_macro_get_channel_map,
  958. };
  959. static struct snd_soc_dai_driver wsa_macro_dai[] = {
  960. {
  961. .name = "wsa_macro_rx1",
  962. .id = WSA_MACRO_AIF1_PB,
  963. .playback = {
  964. .stream_name = "WSA_AIF1 Playback",
  965. .rates = WSA_MACRO_RX_RATES,
  966. .formats = WSA_MACRO_RX_FORMATS,
  967. .rate_max = 384000,
  968. .rate_min = 8000,
  969. .channels_min = 1,
  970. .channels_max = 2,
  971. },
  972. .ops = &wsa_macro_dai_ops,
  973. },
  974. {
  975. .name = "wsa_macro_rx_mix",
  976. .id = WSA_MACRO_AIF_MIX1_PB,
  977. .playback = {
  978. .stream_name = "WSA_AIF_MIX1 Playback",
  979. .rates = WSA_MACRO_RX_MIX_RATES,
  980. .formats = WSA_MACRO_RX_FORMATS,
  981. .rate_max = 192000,
  982. .rate_min = 48000,
  983. .channels_min = 1,
  984. .channels_max = 2,
  985. },
  986. .ops = &wsa_macro_dai_ops,
  987. },
  988. {
  989. .name = "wsa_macro_vifeedback",
  990. .id = WSA_MACRO_AIF_VI,
  991. .capture = {
  992. .stream_name = "WSA_AIF_VI Capture",
  993. .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_48000,
  994. .formats = WSA_MACRO_RX_FORMATS,
  995. .rate_max = 48000,
  996. .rate_min = 8000,
  997. .channels_min = 1,
  998. .channels_max = 4,
  999. },
  1000. .ops = &wsa_macro_dai_ops,
  1001. },
  1002. {
  1003. .name = "wsa_macro_echo",
  1004. .id = WSA_MACRO_AIF_ECHO,
  1005. .capture = {
  1006. .stream_name = "WSA_AIF_ECHO Capture",
  1007. .rates = WSA_MACRO_ECHO_RATES,
  1008. .formats = WSA_MACRO_ECHO_FORMATS,
  1009. .rate_max = 48000,
  1010. .rate_min = 8000,
  1011. .channels_min = 1,
  1012. .channels_max = 2,
  1013. },
  1014. .ops = &wsa_macro_dai_ops,
  1015. },
  1016. };
  1017. static void wsa_macro_mclk_enable(struct wsa_macro *wsa, bool mclk_enable)
  1018. {
  1019. struct regmap *regmap = wsa->regmap;
  1020. if (mclk_enable) {
  1021. if (wsa->wsa_mclk_users == 0) {
  1022. regcache_mark_dirty(regmap);
  1023. regcache_sync(regmap);
  1024. /* 9.6MHz MCLK, set value 0x00 if other frequency */
  1025. regmap_update_bits(regmap, CDC_WSA_TOP_FREQ_MCLK, 0x01, 0x01);
  1026. regmap_update_bits(regmap,
  1027. CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL,
  1028. CDC_WSA_MCLK_EN_MASK,
  1029. CDC_WSA_MCLK_ENABLE);
  1030. regmap_update_bits(regmap,
  1031. CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL,
  1032. CDC_WSA_FS_CNT_EN_MASK,
  1033. CDC_WSA_FS_CNT_ENABLE);
  1034. }
  1035. wsa->wsa_mclk_users++;
  1036. } else {
  1037. if (wsa->wsa_mclk_users <= 0) {
  1038. dev_err(wsa->dev, "clock already disabled\n");
  1039. wsa->wsa_mclk_users = 0;
  1040. return;
  1041. }
  1042. wsa->wsa_mclk_users--;
  1043. if (wsa->wsa_mclk_users == 0) {
  1044. regmap_update_bits(regmap,
  1045. CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL,
  1046. CDC_WSA_FS_CNT_EN_MASK,
  1047. CDC_WSA_FS_CNT_DISABLE);
  1048. regmap_update_bits(regmap,
  1049. CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL,
  1050. CDC_WSA_MCLK_EN_MASK,
  1051. CDC_WSA_MCLK_DISABLE);
  1052. }
  1053. }
  1054. }
  1055. static int wsa_macro_mclk_event(struct snd_soc_dapm_widget *w,
  1056. struct snd_kcontrol *kcontrol, int event)
  1057. {
  1058. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1059. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1060. wsa_macro_mclk_enable(wsa, event == SND_SOC_DAPM_PRE_PMU);
  1061. return 0;
  1062. }
  1063. static int wsa_macro_enable_vi_feedback(struct snd_soc_dapm_widget *w,
  1064. struct snd_kcontrol *kcontrol,
  1065. int event)
  1066. {
  1067. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1068. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1069. u32 tx_reg0, tx_reg1;
  1070. if (test_bit(WSA_MACRO_TX0, &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
  1071. tx_reg0 = CDC_WSA_TX0_SPKR_PROT_PATH_CTL;
  1072. tx_reg1 = CDC_WSA_TX1_SPKR_PROT_PATH_CTL;
  1073. } else if (test_bit(WSA_MACRO_TX1, &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
  1074. tx_reg0 = CDC_WSA_TX2_SPKR_PROT_PATH_CTL;
  1075. tx_reg1 = CDC_WSA_TX3_SPKR_PROT_PATH_CTL;
  1076. }
  1077. switch (event) {
  1078. case SND_SOC_DAPM_POST_PMU:
  1079. /* Enable V&I sensing */
  1080. snd_soc_component_update_bits(component, tx_reg0,
  1081. CDC_WSA_TX_SPKR_PROT_RESET_MASK,
  1082. CDC_WSA_TX_SPKR_PROT_RESET);
  1083. snd_soc_component_update_bits(component, tx_reg1,
  1084. CDC_WSA_TX_SPKR_PROT_RESET_MASK,
  1085. CDC_WSA_TX_SPKR_PROT_RESET);
  1086. snd_soc_component_update_bits(component, tx_reg0,
  1087. CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK,
  1088. CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K);
  1089. snd_soc_component_update_bits(component, tx_reg1,
  1090. CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK,
  1091. CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K);
  1092. snd_soc_component_update_bits(component, tx_reg0,
  1093. CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
  1094. CDC_WSA_TX_SPKR_PROT_CLK_ENABLE);
  1095. snd_soc_component_update_bits(component, tx_reg1,
  1096. CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
  1097. CDC_WSA_TX_SPKR_PROT_CLK_ENABLE);
  1098. snd_soc_component_update_bits(component, tx_reg0,
  1099. CDC_WSA_TX_SPKR_PROT_RESET_MASK,
  1100. CDC_WSA_TX_SPKR_PROT_NO_RESET);
  1101. snd_soc_component_update_bits(component, tx_reg1,
  1102. CDC_WSA_TX_SPKR_PROT_RESET_MASK,
  1103. CDC_WSA_TX_SPKR_PROT_NO_RESET);
  1104. break;
  1105. case SND_SOC_DAPM_POST_PMD:
  1106. /* Disable V&I sensing */
  1107. snd_soc_component_update_bits(component, tx_reg0,
  1108. CDC_WSA_TX_SPKR_PROT_RESET_MASK,
  1109. CDC_WSA_TX_SPKR_PROT_RESET);
  1110. snd_soc_component_update_bits(component, tx_reg1,
  1111. CDC_WSA_TX_SPKR_PROT_RESET_MASK,
  1112. CDC_WSA_TX_SPKR_PROT_RESET);
  1113. snd_soc_component_update_bits(component, tx_reg0,
  1114. CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
  1115. CDC_WSA_TX_SPKR_PROT_CLK_DISABLE);
  1116. snd_soc_component_update_bits(component, tx_reg1,
  1117. CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
  1118. CDC_WSA_TX_SPKR_PROT_CLK_DISABLE);
  1119. break;
  1120. }
  1121. return 0;
  1122. }
  1123. static int wsa_macro_enable_mix_path(struct snd_soc_dapm_widget *w,
  1124. struct snd_kcontrol *kcontrol, int event)
  1125. {
  1126. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1127. u16 path_reg, gain_reg;
  1128. int val;
  1129. switch (w->shift) {
  1130. case WSA_MACRO_RX_MIX0:
  1131. path_reg = CDC_WSA_RX0_RX_PATH_MIX_CTL;
  1132. gain_reg = CDC_WSA_RX0_RX_VOL_MIX_CTL;
  1133. break;
  1134. case WSA_MACRO_RX_MIX1:
  1135. path_reg = CDC_WSA_RX1_RX_PATH_MIX_CTL;
  1136. gain_reg = CDC_WSA_RX1_RX_VOL_MIX_CTL;
  1137. break;
  1138. default:
  1139. return 0;
  1140. }
  1141. switch (event) {
  1142. case SND_SOC_DAPM_POST_PMU:
  1143. val = snd_soc_component_read(component, gain_reg);
  1144. snd_soc_component_write(component, gain_reg, val);
  1145. break;
  1146. case SND_SOC_DAPM_POST_PMD:
  1147. snd_soc_component_update_bits(component, path_reg,
  1148. CDC_WSA_RX_PATH_MIX_CLK_EN_MASK,
  1149. CDC_WSA_RX_PATH_MIX_CLK_DISABLE);
  1150. break;
  1151. }
  1152. return 0;
  1153. }
  1154. static void wsa_macro_hd2_control(struct snd_soc_component *component,
  1155. u16 reg, int event)
  1156. {
  1157. u16 hd2_scale_reg;
  1158. u16 hd2_enable_reg;
  1159. if (reg == CDC_WSA_RX0_RX_PATH_CTL) {
  1160. hd2_scale_reg = CDC_WSA_RX0_RX_PATH_SEC3;
  1161. hd2_enable_reg = CDC_WSA_RX0_RX_PATH_CFG0;
  1162. }
  1163. if (reg == CDC_WSA_RX1_RX_PATH_CTL) {
  1164. hd2_scale_reg = CDC_WSA_RX1_RX_PATH_SEC3;
  1165. hd2_enable_reg = CDC_WSA_RX1_RX_PATH_CFG0;
  1166. }
  1167. if (hd2_enable_reg && SND_SOC_DAPM_EVENT_ON(event)) {
  1168. snd_soc_component_update_bits(component, hd2_scale_reg,
  1169. CDC_WSA_RX_PATH_HD2_ALPHA_MASK,
  1170. 0x10);
  1171. snd_soc_component_update_bits(component, hd2_scale_reg,
  1172. CDC_WSA_RX_PATH_HD2_SCALE_MASK,
  1173. 0x1);
  1174. snd_soc_component_update_bits(component, hd2_enable_reg,
  1175. CDC_WSA_RX_PATH_HD2_EN_MASK,
  1176. CDC_WSA_RX_PATH_HD2_ENABLE);
  1177. }
  1178. if (hd2_enable_reg && SND_SOC_DAPM_EVENT_OFF(event)) {
  1179. snd_soc_component_update_bits(component, hd2_enable_reg,
  1180. CDC_WSA_RX_PATH_HD2_EN_MASK, 0);
  1181. snd_soc_component_update_bits(component, hd2_scale_reg,
  1182. CDC_WSA_RX_PATH_HD2_SCALE_MASK,
  1183. 0);
  1184. snd_soc_component_update_bits(component, hd2_scale_reg,
  1185. CDC_WSA_RX_PATH_HD2_ALPHA_MASK,
  1186. 0);
  1187. }
  1188. }
  1189. static int wsa_macro_config_compander(struct snd_soc_component *component,
  1190. int comp, int event)
  1191. {
  1192. u16 comp_ctl0_reg, rx_path_cfg0_reg;
  1193. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1194. if (!wsa->comp_enabled[comp])
  1195. return 0;
  1196. comp_ctl0_reg = CDC_WSA_COMPANDER0_CTL0 +
  1197. (comp * WSA_MACRO_RX_COMP_OFFSET);
  1198. rx_path_cfg0_reg = CDC_WSA_RX0_RX_PATH_CFG0 +
  1199. (comp * WSA_MACRO_RX_PATH_OFFSET);
  1200. if (SND_SOC_DAPM_EVENT_ON(event)) {
  1201. /* Enable Compander Clock */
  1202. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1203. CDC_WSA_COMPANDER_CLK_EN_MASK,
  1204. CDC_WSA_COMPANDER_CLK_ENABLE);
  1205. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1206. CDC_WSA_COMPANDER_SOFT_RST_MASK,
  1207. CDC_WSA_COMPANDER_SOFT_RST_ENABLE);
  1208. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1209. CDC_WSA_COMPANDER_SOFT_RST_MASK,
  1210. 0);
  1211. snd_soc_component_update_bits(component, rx_path_cfg0_reg,
  1212. CDC_WSA_RX_PATH_COMP_EN_MASK,
  1213. CDC_WSA_RX_PATH_COMP_ENABLE);
  1214. }
  1215. if (SND_SOC_DAPM_EVENT_OFF(event)) {
  1216. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1217. CDC_WSA_COMPANDER_HALT_MASK,
  1218. CDC_WSA_COMPANDER_HALT);
  1219. snd_soc_component_update_bits(component, rx_path_cfg0_reg,
  1220. CDC_WSA_RX_PATH_COMP_EN_MASK, 0);
  1221. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1222. CDC_WSA_COMPANDER_SOFT_RST_MASK,
  1223. CDC_WSA_COMPANDER_SOFT_RST_ENABLE);
  1224. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1225. CDC_WSA_COMPANDER_SOFT_RST_MASK,
  1226. 0);
  1227. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1228. CDC_WSA_COMPANDER_CLK_EN_MASK, 0);
  1229. snd_soc_component_update_bits(component, comp_ctl0_reg,
  1230. CDC_WSA_COMPANDER_HALT_MASK, 0);
  1231. }
  1232. return 0;
  1233. }
  1234. static void wsa_macro_enable_softclip_clk(struct snd_soc_component *component,
  1235. struct wsa_macro *wsa,
  1236. int path,
  1237. bool enable)
  1238. {
  1239. u16 softclip_clk_reg = CDC_WSA_SOFTCLIP0_CRC +
  1240. (path * WSA_MACRO_RX_SOFTCLIP_OFFSET);
  1241. u8 softclip_mux_mask = (1 << path);
  1242. u8 softclip_mux_value = (1 << path);
  1243. if (enable) {
  1244. if (wsa->softclip_clk_users[path] == 0) {
  1245. snd_soc_component_update_bits(component,
  1246. softclip_clk_reg,
  1247. CDC_WSA_SOFTCLIP_CLK_EN_MASK,
  1248. CDC_WSA_SOFTCLIP_CLK_ENABLE);
  1249. snd_soc_component_update_bits(component,
  1250. CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0,
  1251. softclip_mux_mask, softclip_mux_value);
  1252. }
  1253. wsa->softclip_clk_users[path]++;
  1254. } else {
  1255. wsa->softclip_clk_users[path]--;
  1256. if (wsa->softclip_clk_users[path] == 0) {
  1257. snd_soc_component_update_bits(component,
  1258. softclip_clk_reg,
  1259. CDC_WSA_SOFTCLIP_CLK_EN_MASK,
  1260. 0);
  1261. snd_soc_component_update_bits(component,
  1262. CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0,
  1263. softclip_mux_mask, 0x00);
  1264. }
  1265. }
  1266. }
  1267. static int wsa_macro_config_softclip(struct snd_soc_component *component,
  1268. int path, int event)
  1269. {
  1270. u16 softclip_ctrl_reg;
  1271. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1272. int softclip_path = 0;
  1273. if (path == WSA_MACRO_COMP1)
  1274. softclip_path = WSA_MACRO_SOFTCLIP0;
  1275. else if (path == WSA_MACRO_COMP2)
  1276. softclip_path = WSA_MACRO_SOFTCLIP1;
  1277. if (!wsa->is_softclip_on[softclip_path])
  1278. return 0;
  1279. softclip_ctrl_reg = CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL +
  1280. (softclip_path * WSA_MACRO_RX_SOFTCLIP_OFFSET);
  1281. if (SND_SOC_DAPM_EVENT_ON(event)) {
  1282. /* Enable Softclip clock and mux */
  1283. wsa_macro_enable_softclip_clk(component, wsa, softclip_path,
  1284. true);
  1285. /* Enable Softclip control */
  1286. snd_soc_component_update_bits(component, softclip_ctrl_reg,
  1287. CDC_WSA_SOFTCLIP_EN_MASK,
  1288. CDC_WSA_SOFTCLIP_ENABLE);
  1289. }
  1290. if (SND_SOC_DAPM_EVENT_OFF(event)) {
  1291. snd_soc_component_update_bits(component, softclip_ctrl_reg,
  1292. CDC_WSA_SOFTCLIP_EN_MASK, 0);
  1293. wsa_macro_enable_softclip_clk(component, wsa, softclip_path,
  1294. false);
  1295. }
  1296. return 0;
  1297. }
  1298. static bool wsa_macro_adie_lb(struct snd_soc_component *component,
  1299. int interp_idx)
  1300. {
  1301. u16 int_mux_cfg0, int_mux_cfg1;
  1302. u8 int_n_inp0, int_n_inp1, int_n_inp2;
  1303. int_mux_cfg0 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG0 + interp_idx * 8;
  1304. int_mux_cfg1 = int_mux_cfg0 + 4;
  1305. int_n_inp0 = snd_soc_component_read_field(component, int_mux_cfg0,
  1306. CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK);
  1307. if (int_n_inp0 == INTn_1_INP_SEL_DEC0 ||
  1308. int_n_inp0 == INTn_1_INP_SEL_DEC1)
  1309. return true;
  1310. int_n_inp1 = snd_soc_component_read_field(component, int_mux_cfg0,
  1311. CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK);
  1312. if (int_n_inp1 == INTn_1_INP_SEL_DEC0 ||
  1313. int_n_inp1 == INTn_1_INP_SEL_DEC1)
  1314. return true;
  1315. int_n_inp2 = snd_soc_component_read_field(component, int_mux_cfg1,
  1316. CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK);
  1317. if (int_n_inp2 == INTn_1_INP_SEL_DEC0 ||
  1318. int_n_inp2 == INTn_1_INP_SEL_DEC1)
  1319. return true;
  1320. return false;
  1321. }
  1322. static int wsa_macro_enable_main_path(struct snd_soc_dapm_widget *w,
  1323. struct snd_kcontrol *kcontrol,
  1324. int event)
  1325. {
  1326. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1327. u16 reg;
  1328. reg = CDC_WSA_RX0_RX_PATH_CTL + WSA_MACRO_RX_PATH_OFFSET * w->shift;
  1329. switch (event) {
  1330. case SND_SOC_DAPM_PRE_PMU:
  1331. if (wsa_macro_adie_lb(component, w->shift)) {
  1332. snd_soc_component_update_bits(component, reg,
  1333. CDC_WSA_RX_PATH_CLK_EN_MASK,
  1334. CDC_WSA_RX_PATH_CLK_ENABLE);
  1335. }
  1336. break;
  1337. default:
  1338. break;
  1339. }
  1340. return 0;
  1341. }
  1342. static int wsa_macro_interp_get_primary_reg(u16 reg, u16 *ind)
  1343. {
  1344. u16 prim_int_reg = 0;
  1345. switch (reg) {
  1346. case CDC_WSA_RX0_RX_PATH_CTL:
  1347. case CDC_WSA_RX0_RX_PATH_MIX_CTL:
  1348. prim_int_reg = CDC_WSA_RX0_RX_PATH_CTL;
  1349. *ind = 0;
  1350. break;
  1351. case CDC_WSA_RX1_RX_PATH_CTL:
  1352. case CDC_WSA_RX1_RX_PATH_MIX_CTL:
  1353. prim_int_reg = CDC_WSA_RX1_RX_PATH_CTL;
  1354. *ind = 1;
  1355. break;
  1356. }
  1357. return prim_int_reg;
  1358. }
  1359. static int wsa_macro_enable_prim_interpolator(struct snd_soc_component *component,
  1360. u16 reg, int event)
  1361. {
  1362. u16 prim_int_reg;
  1363. u16 ind = 0;
  1364. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1365. prim_int_reg = wsa_macro_interp_get_primary_reg(reg, &ind);
  1366. switch (event) {
  1367. case SND_SOC_DAPM_PRE_PMU:
  1368. wsa->prim_int_users[ind]++;
  1369. if (wsa->prim_int_users[ind] == 1) {
  1370. snd_soc_component_update_bits(component,
  1371. prim_int_reg + WSA_MACRO_RX_PATH_CFG3_OFFSET,
  1372. CDC_WSA_RX_DC_DCOEFF_MASK,
  1373. 0x3);
  1374. snd_soc_component_update_bits(component, prim_int_reg,
  1375. CDC_WSA_RX_PATH_PGA_MUTE_EN_MASK,
  1376. CDC_WSA_RX_PATH_PGA_MUTE_ENABLE);
  1377. wsa_macro_hd2_control(component, prim_int_reg, event);
  1378. snd_soc_component_update_bits(component,
  1379. prim_int_reg + WSA_MACRO_RX_PATH_DSMDEM_OFFSET,
  1380. CDC_WSA_RX_DSMDEM_CLK_EN_MASK,
  1381. CDC_WSA_RX_DSMDEM_CLK_ENABLE);
  1382. }
  1383. if ((reg != prim_int_reg) &&
  1384. ((snd_soc_component_read(
  1385. component, prim_int_reg)) & 0x10))
  1386. snd_soc_component_update_bits(component, reg,
  1387. 0x10, 0x10);
  1388. break;
  1389. case SND_SOC_DAPM_POST_PMD:
  1390. wsa->prim_int_users[ind]--;
  1391. if (wsa->prim_int_users[ind] == 0) {
  1392. snd_soc_component_update_bits(component,
  1393. prim_int_reg + WSA_MACRO_RX_PATH_DSMDEM_OFFSET,
  1394. CDC_WSA_RX_DSMDEM_CLK_EN_MASK, 0);
  1395. wsa_macro_hd2_control(component, prim_int_reg, event);
  1396. }
  1397. break;
  1398. }
  1399. return 0;
  1400. }
  1401. static int wsa_macro_config_ear_spkr_gain(struct snd_soc_component *component,
  1402. struct wsa_macro *wsa,
  1403. int event, int gain_reg)
  1404. {
  1405. int comp_gain_offset, val;
  1406. switch (wsa->spkr_mode) {
  1407. /* Compander gain in WSA_MACRO_SPKR_MODE1 case is 12 dB */
  1408. case WSA_MACRO_SPKR_MODE_1:
  1409. comp_gain_offset = -12;
  1410. break;
  1411. /* Default case compander gain is 15 dB */
  1412. default:
  1413. comp_gain_offset = -15;
  1414. break;
  1415. }
  1416. switch (event) {
  1417. case SND_SOC_DAPM_POST_PMU:
  1418. /* Apply ear spkr gain only if compander is enabled */
  1419. if (wsa->comp_enabled[WSA_MACRO_COMP1] &&
  1420. (gain_reg == CDC_WSA_RX0_RX_VOL_CTL) &&
  1421. (wsa->ear_spkr_gain != 0)) {
  1422. /* For example, val is -8(-12+5-1) for 4dB of gain */
  1423. val = comp_gain_offset + wsa->ear_spkr_gain - 1;
  1424. snd_soc_component_write(component, gain_reg, val);
  1425. }
  1426. break;
  1427. case SND_SOC_DAPM_POST_PMD:
  1428. /*
  1429. * Reset RX0 volume to 0 dB if compander is enabled and
  1430. * ear_spkr_gain is non-zero.
  1431. */
  1432. if (wsa->comp_enabled[WSA_MACRO_COMP1] &&
  1433. (gain_reg == CDC_WSA_RX0_RX_VOL_CTL) &&
  1434. (wsa->ear_spkr_gain != 0)) {
  1435. snd_soc_component_write(component, gain_reg, 0x0);
  1436. }
  1437. break;
  1438. }
  1439. return 0;
  1440. }
  1441. static int wsa_macro_enable_interpolator(struct snd_soc_dapm_widget *w,
  1442. struct snd_kcontrol *kcontrol,
  1443. int event)
  1444. {
  1445. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1446. u16 gain_reg;
  1447. u16 reg;
  1448. int val;
  1449. int offset_val = 0;
  1450. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1451. if (w->shift == WSA_MACRO_COMP1) {
  1452. reg = CDC_WSA_RX0_RX_PATH_CTL;
  1453. gain_reg = CDC_WSA_RX0_RX_VOL_CTL;
  1454. } else if (w->shift == WSA_MACRO_COMP2) {
  1455. reg = CDC_WSA_RX1_RX_PATH_CTL;
  1456. gain_reg = CDC_WSA_RX1_RX_VOL_CTL;
  1457. }
  1458. switch (event) {
  1459. case SND_SOC_DAPM_PRE_PMU:
  1460. /* Reset if needed */
  1461. wsa_macro_enable_prim_interpolator(component, reg, event);
  1462. break;
  1463. case SND_SOC_DAPM_POST_PMU:
  1464. wsa_macro_config_compander(component, w->shift, event);
  1465. wsa_macro_config_softclip(component, w->shift, event);
  1466. /* apply gain after int clk is enabled */
  1467. if ((wsa->spkr_gain_offset == WSA_MACRO_GAIN_OFFSET_M1P5_DB) &&
  1468. (wsa->comp_enabled[WSA_MACRO_COMP1] ||
  1469. wsa->comp_enabled[WSA_MACRO_COMP2])) {
  1470. snd_soc_component_update_bits(component,
  1471. CDC_WSA_RX0_RX_PATH_SEC1,
  1472. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1473. CDC_WSA_RX_PGA_HALF_DB_ENABLE);
  1474. snd_soc_component_update_bits(component,
  1475. CDC_WSA_RX0_RX_PATH_MIX_SEC0,
  1476. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1477. CDC_WSA_RX_PGA_HALF_DB_ENABLE);
  1478. snd_soc_component_update_bits(component,
  1479. CDC_WSA_RX1_RX_PATH_SEC1,
  1480. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1481. CDC_WSA_RX_PGA_HALF_DB_ENABLE);
  1482. snd_soc_component_update_bits(component,
  1483. CDC_WSA_RX1_RX_PATH_MIX_SEC0,
  1484. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1485. CDC_WSA_RX_PGA_HALF_DB_ENABLE);
  1486. offset_val = -2;
  1487. }
  1488. val = snd_soc_component_read(component, gain_reg);
  1489. val += offset_val;
  1490. snd_soc_component_write(component, gain_reg, val);
  1491. wsa_macro_config_ear_spkr_gain(component, wsa,
  1492. event, gain_reg);
  1493. break;
  1494. case SND_SOC_DAPM_POST_PMD:
  1495. wsa_macro_config_compander(component, w->shift, event);
  1496. wsa_macro_config_softclip(component, w->shift, event);
  1497. wsa_macro_enable_prim_interpolator(component, reg, event);
  1498. if ((wsa->spkr_gain_offset == WSA_MACRO_GAIN_OFFSET_M1P5_DB) &&
  1499. (wsa->comp_enabled[WSA_MACRO_COMP1] ||
  1500. wsa->comp_enabled[WSA_MACRO_COMP2])) {
  1501. snd_soc_component_update_bits(component,
  1502. CDC_WSA_RX0_RX_PATH_SEC1,
  1503. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1504. CDC_WSA_RX_PGA_HALF_DB_DISABLE);
  1505. snd_soc_component_update_bits(component,
  1506. CDC_WSA_RX0_RX_PATH_MIX_SEC0,
  1507. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1508. CDC_WSA_RX_PGA_HALF_DB_DISABLE);
  1509. snd_soc_component_update_bits(component,
  1510. CDC_WSA_RX1_RX_PATH_SEC1,
  1511. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1512. CDC_WSA_RX_PGA_HALF_DB_DISABLE);
  1513. snd_soc_component_update_bits(component,
  1514. CDC_WSA_RX1_RX_PATH_MIX_SEC0,
  1515. CDC_WSA_RX_PGA_HALF_DB_MASK,
  1516. CDC_WSA_RX_PGA_HALF_DB_DISABLE);
  1517. offset_val = 2;
  1518. val = snd_soc_component_read(component, gain_reg);
  1519. val += offset_val;
  1520. snd_soc_component_write(component, gain_reg, val);
  1521. }
  1522. wsa_macro_config_ear_spkr_gain(component, wsa,
  1523. event, gain_reg);
  1524. break;
  1525. }
  1526. return 0;
  1527. }
  1528. static int wsa_macro_spk_boost_event(struct snd_soc_dapm_widget *w,
  1529. struct snd_kcontrol *kcontrol,
  1530. int event)
  1531. {
  1532. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1533. u16 boost_path_ctl, boost_path_cfg1;
  1534. u16 reg, reg_mix;
  1535. if (!strcmp(w->name, "WSA_RX INT0 CHAIN")) {
  1536. boost_path_ctl = CDC_WSA_BOOST0_BOOST_PATH_CTL;
  1537. boost_path_cfg1 = CDC_WSA_RX0_RX_PATH_CFG1;
  1538. reg = CDC_WSA_RX0_RX_PATH_CTL;
  1539. reg_mix = CDC_WSA_RX0_RX_PATH_MIX_CTL;
  1540. } else if (!strcmp(w->name, "WSA_RX INT1 CHAIN")) {
  1541. boost_path_ctl = CDC_WSA_BOOST1_BOOST_PATH_CTL;
  1542. boost_path_cfg1 = CDC_WSA_RX1_RX_PATH_CFG1;
  1543. reg = CDC_WSA_RX1_RX_PATH_CTL;
  1544. reg_mix = CDC_WSA_RX1_RX_PATH_MIX_CTL;
  1545. } else {
  1546. dev_warn(component->dev, "Incorrect widget name in the driver\n");
  1547. return -EINVAL;
  1548. }
  1549. switch (event) {
  1550. case SND_SOC_DAPM_PRE_PMU:
  1551. snd_soc_component_update_bits(component, boost_path_cfg1,
  1552. CDC_WSA_RX_PATH_SMART_BST_EN_MASK,
  1553. CDC_WSA_RX_PATH_SMART_BST_ENABLE);
  1554. snd_soc_component_update_bits(component, boost_path_ctl,
  1555. CDC_WSA_BOOST_PATH_CLK_EN_MASK,
  1556. CDC_WSA_BOOST_PATH_CLK_ENABLE);
  1557. if ((snd_soc_component_read(component, reg_mix)) & 0x10)
  1558. snd_soc_component_update_bits(component, reg_mix,
  1559. 0x10, 0x00);
  1560. break;
  1561. case SND_SOC_DAPM_POST_PMU:
  1562. snd_soc_component_update_bits(component, reg, 0x10, 0x00);
  1563. break;
  1564. case SND_SOC_DAPM_POST_PMD:
  1565. snd_soc_component_update_bits(component, boost_path_ctl,
  1566. CDC_WSA_BOOST_PATH_CLK_EN_MASK,
  1567. CDC_WSA_BOOST_PATH_CLK_DISABLE);
  1568. snd_soc_component_update_bits(component, boost_path_cfg1,
  1569. CDC_WSA_RX_PATH_SMART_BST_EN_MASK,
  1570. CDC_WSA_RX_PATH_SMART_BST_DISABLE);
  1571. break;
  1572. }
  1573. return 0;
  1574. }
  1575. static int wsa_macro_enable_echo(struct snd_soc_dapm_widget *w,
  1576. struct snd_kcontrol *kcontrol,
  1577. int event)
  1578. {
  1579. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1580. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1581. u16 val, ec_tx, ec_hq_reg;
  1582. val = snd_soc_component_read(component, CDC_WSA_RX_INP_MUX_RX_MIX_CFG0);
  1583. switch (w->shift) {
  1584. case WSA_MACRO_EC0_MUX:
  1585. val = val & CDC_WSA_RX_MIX_TX0_SEL_MASK;
  1586. ec_tx = val - 1;
  1587. break;
  1588. case WSA_MACRO_EC1_MUX:
  1589. val = val & CDC_WSA_RX_MIX_TX1_SEL_MASK;
  1590. ec_tx = (val >> CDC_WSA_RX_MIX_TX1_SEL_SHFT) - 1;
  1591. break;
  1592. default:
  1593. dev_err(component->dev, "%s: Invalid shift %u\n",
  1594. __func__, w->shift);
  1595. return -EINVAL;
  1596. }
  1597. if (wsa->ec_hq[ec_tx]) {
  1598. ec_hq_reg = CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL + 0x40 * ec_tx;
  1599. snd_soc_component_update_bits(component, ec_hq_reg,
  1600. CDC_WSA_EC_HQ_EC_CLK_EN_MASK,
  1601. CDC_WSA_EC_HQ_EC_CLK_ENABLE);
  1602. ec_hq_reg = CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0 + 0x40 * ec_tx;
  1603. /* default set to 48k */
  1604. snd_soc_component_update_bits(component, ec_hq_reg,
  1605. CDC_WSA_EC_HQ_EC_REF_PCM_RATE_MASK,
  1606. CDC_WSA_EC_HQ_EC_REF_PCM_RATE_48K);
  1607. }
  1608. return 0;
  1609. }
  1610. static int wsa_macro_get_ec_hq(struct snd_kcontrol *kcontrol,
  1611. struct snd_ctl_elem_value *ucontrol)
  1612. {
  1613. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1614. int ec_tx = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
  1615. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1616. ucontrol->value.integer.value[0] = wsa->ec_hq[ec_tx];
  1617. return 0;
  1618. }
  1619. static int wsa_macro_set_ec_hq(struct snd_kcontrol *kcontrol,
  1620. struct snd_ctl_elem_value *ucontrol)
  1621. {
  1622. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1623. int ec_tx = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
  1624. int value = ucontrol->value.integer.value[0];
  1625. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1626. wsa->ec_hq[ec_tx] = value;
  1627. return 0;
  1628. }
  1629. static int wsa_macro_get_compander(struct snd_kcontrol *kcontrol,
  1630. struct snd_ctl_elem_value *ucontrol)
  1631. {
  1632. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1633. int comp = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
  1634. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1635. ucontrol->value.integer.value[0] = wsa->comp_enabled[comp];
  1636. return 0;
  1637. }
  1638. static int wsa_macro_set_compander(struct snd_kcontrol *kcontrol,
  1639. struct snd_ctl_elem_value *ucontrol)
  1640. {
  1641. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1642. int comp = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
  1643. int value = ucontrol->value.integer.value[0];
  1644. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1645. wsa->comp_enabled[comp] = value;
  1646. return 0;
  1647. }
  1648. static int wsa_macro_ear_spkr_pa_gain_get(struct snd_kcontrol *kcontrol,
  1649. struct snd_ctl_elem_value *ucontrol)
  1650. {
  1651. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1652. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1653. ucontrol->value.integer.value[0] = wsa->ear_spkr_gain;
  1654. return 0;
  1655. }
  1656. static int wsa_macro_ear_spkr_pa_gain_put(struct snd_kcontrol *kcontrol,
  1657. struct snd_ctl_elem_value *ucontrol)
  1658. {
  1659. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1660. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1661. wsa->ear_spkr_gain = ucontrol->value.integer.value[0];
  1662. return 0;
  1663. }
  1664. static int wsa_macro_rx_mux_get(struct snd_kcontrol *kcontrol,
  1665. struct snd_ctl_elem_value *ucontrol)
  1666. {
  1667. struct snd_soc_dapm_widget *widget =
  1668. snd_soc_dapm_kcontrol_widget(kcontrol);
  1669. struct snd_soc_component *component =
  1670. snd_soc_dapm_to_component(widget->dapm);
  1671. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1672. ucontrol->value.integer.value[0] =
  1673. wsa->rx_port_value[widget->shift];
  1674. return 0;
  1675. }
  1676. static int wsa_macro_rx_mux_put(struct snd_kcontrol *kcontrol,
  1677. struct snd_ctl_elem_value *ucontrol)
  1678. {
  1679. struct snd_soc_dapm_widget *widget =
  1680. snd_soc_dapm_kcontrol_widget(kcontrol);
  1681. struct snd_soc_component *component =
  1682. snd_soc_dapm_to_component(widget->dapm);
  1683. struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
  1684. struct snd_soc_dapm_update *update = NULL;
  1685. u32 rx_port_value = ucontrol->value.integer.value[0];
  1686. u32 bit_input;
  1687. u32 aif_rst;
  1688. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1689. aif_rst = wsa->rx_port_value[widget->shift];
  1690. if (!rx_port_value) {
  1691. if (aif_rst == 0) {
  1692. dev_err(component->dev, "%s: AIF reset already\n", __func__);
  1693. return 0;
  1694. }
  1695. if (aif_rst >= WSA_MACRO_RX_MAX) {
  1696. dev_err(component->dev, "%s: Invalid AIF reset\n", __func__);
  1697. return 0;
  1698. }
  1699. }
  1700. wsa->rx_port_value[widget->shift] = rx_port_value;
  1701. bit_input = widget->shift;
  1702. switch (rx_port_value) {
  1703. case 0:
  1704. if (wsa->active_ch_cnt[aif_rst]) {
  1705. clear_bit(bit_input,
  1706. &wsa->active_ch_mask[aif_rst]);
  1707. wsa->active_ch_cnt[aif_rst]--;
  1708. }
  1709. break;
  1710. case 1:
  1711. case 2:
  1712. set_bit(bit_input,
  1713. &wsa->active_ch_mask[rx_port_value]);
  1714. wsa->active_ch_cnt[rx_port_value]++;
  1715. break;
  1716. default:
  1717. dev_err(component->dev,
  1718. "%s: Invalid AIF_ID for WSA RX MUX %d\n",
  1719. __func__, rx_port_value);
  1720. return -EINVAL;
  1721. }
  1722. snd_soc_dapm_mux_update_power(widget->dapm, kcontrol,
  1723. rx_port_value, e, update);
  1724. return 0;
  1725. }
  1726. static int wsa_macro_soft_clip_enable_get(struct snd_kcontrol *kcontrol,
  1727. struct snd_ctl_elem_value *ucontrol)
  1728. {
  1729. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1730. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1731. int path = ((struct soc_mixer_control *)kcontrol->private_value)->shift;
  1732. ucontrol->value.integer.value[0] = wsa->is_softclip_on[path];
  1733. return 0;
  1734. }
  1735. static int wsa_macro_soft_clip_enable_put(struct snd_kcontrol *kcontrol,
  1736. struct snd_ctl_elem_value *ucontrol)
  1737. {
  1738. struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
  1739. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1740. int path = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
  1741. wsa->is_softclip_on[path] = ucontrol->value.integer.value[0];
  1742. return 0;
  1743. }
  1744. static const struct snd_kcontrol_new wsa_macro_snd_controls[] = {
  1745. SOC_ENUM_EXT("EAR SPKR PA Gain", wsa_macro_ear_spkr_pa_gain_enum,
  1746. wsa_macro_ear_spkr_pa_gain_get,
  1747. wsa_macro_ear_spkr_pa_gain_put),
  1748. SOC_SINGLE_EXT("WSA_Softclip0 Enable", SND_SOC_NOPM,
  1749. WSA_MACRO_SOFTCLIP0, 1, 0,
  1750. wsa_macro_soft_clip_enable_get,
  1751. wsa_macro_soft_clip_enable_put),
  1752. SOC_SINGLE_EXT("WSA_Softclip1 Enable", SND_SOC_NOPM,
  1753. WSA_MACRO_SOFTCLIP1, 1, 0,
  1754. wsa_macro_soft_clip_enable_get,
  1755. wsa_macro_soft_clip_enable_put),
  1756. SOC_SINGLE_S8_TLV("WSA_RX0 Digital Volume", CDC_WSA_RX0_RX_VOL_CTL,
  1757. -84, 40, digital_gain),
  1758. SOC_SINGLE_S8_TLV("WSA_RX1 Digital Volume", CDC_WSA_RX1_RX_VOL_CTL,
  1759. -84, 40, digital_gain),
  1760. SOC_SINGLE("WSA_RX0 Digital Mute", CDC_WSA_RX0_RX_PATH_CTL, 4, 1, 0),
  1761. SOC_SINGLE("WSA_RX1 Digital Mute", CDC_WSA_RX1_RX_PATH_CTL, 4, 1, 0),
  1762. SOC_SINGLE("WSA_RX0_MIX Digital Mute", CDC_WSA_RX0_RX_PATH_MIX_CTL, 4,
  1763. 1, 0),
  1764. SOC_SINGLE("WSA_RX1_MIX Digital Mute", CDC_WSA_RX1_RX_PATH_MIX_CTL, 4,
  1765. 1, 0),
  1766. SOC_SINGLE_EXT("WSA_COMP1 Switch", SND_SOC_NOPM, WSA_MACRO_COMP1, 1, 0,
  1767. wsa_macro_get_compander, wsa_macro_set_compander),
  1768. SOC_SINGLE_EXT("WSA_COMP2 Switch", SND_SOC_NOPM, WSA_MACRO_COMP2, 1, 0,
  1769. wsa_macro_get_compander, wsa_macro_set_compander),
  1770. SOC_SINGLE_EXT("WSA_RX0 EC_HQ Switch", SND_SOC_NOPM, WSA_MACRO_RX0, 1, 0,
  1771. wsa_macro_get_ec_hq, wsa_macro_set_ec_hq),
  1772. SOC_SINGLE_EXT("WSA_RX1 EC_HQ Switch", SND_SOC_NOPM, WSA_MACRO_RX1, 1, 0,
  1773. wsa_macro_get_ec_hq, wsa_macro_set_ec_hq),
  1774. };
  1775. static const struct soc_enum rx_mux_enum =
  1776. SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(rx_mux_text), rx_mux_text);
  1777. static const struct snd_kcontrol_new rx_mux[WSA_MACRO_RX_MAX] = {
  1778. SOC_DAPM_ENUM_EXT("WSA RX0 Mux", rx_mux_enum,
  1779. wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
  1780. SOC_DAPM_ENUM_EXT("WSA RX1 Mux", rx_mux_enum,
  1781. wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
  1782. SOC_DAPM_ENUM_EXT("WSA RX_MIX0 Mux", rx_mux_enum,
  1783. wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
  1784. SOC_DAPM_ENUM_EXT("WSA RX_MIX1 Mux", rx_mux_enum,
  1785. wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
  1786. };
  1787. static int wsa_macro_vi_feed_mixer_get(struct snd_kcontrol *kcontrol,
  1788. struct snd_ctl_elem_value *ucontrol)
  1789. {
  1790. struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol);
  1791. struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm);
  1792. struct soc_mixer_control *mixer = (struct soc_mixer_control *)kcontrol->private_value;
  1793. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1794. u32 spk_tx_id = mixer->shift;
  1795. u32 dai_id = widget->shift;
  1796. if (test_bit(spk_tx_id, &wsa->active_ch_mask[dai_id]))
  1797. ucontrol->value.integer.value[0] = 1;
  1798. else
  1799. ucontrol->value.integer.value[0] = 0;
  1800. return 0;
  1801. }
  1802. static int wsa_macro_vi_feed_mixer_put(struct snd_kcontrol *kcontrol,
  1803. struct snd_ctl_elem_value *ucontrol)
  1804. {
  1805. struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol);
  1806. struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm);
  1807. struct soc_mixer_control *mixer = (struct soc_mixer_control *)kcontrol->private_value;
  1808. struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
  1809. u32 enable = ucontrol->value.integer.value[0];
  1810. u32 spk_tx_id = mixer->shift;
  1811. if (enable) {
  1812. if (spk_tx_id == WSA_MACRO_TX0 &&
  1813. !test_bit(WSA_MACRO_TX0,
  1814. &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
  1815. set_bit(WSA_MACRO_TX0,
  1816. &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
  1817. wsa->active_ch_cnt[WSA_MACRO_AIF_VI]++;
  1818. }
  1819. if (spk_tx_id == WSA_MACRO_TX1 &&
  1820. !test_bit(WSA_MACRO_TX1,
  1821. &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
  1822. set_bit(WSA_MACRO_TX1,
  1823. &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
  1824. wsa->active_ch_cnt[WSA_MACRO_AIF_VI]++;
  1825. }
  1826. } else {
  1827. if (spk_tx_id == WSA_MACRO_TX0 &&
  1828. test_bit(WSA_MACRO_TX0,
  1829. &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
  1830. clear_bit(WSA_MACRO_TX0,
  1831. &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
  1832. wsa->active_ch_cnt[WSA_MACRO_AIF_VI]--;
  1833. }
  1834. if (spk_tx_id == WSA_MACRO_TX1 &&
  1835. test_bit(WSA_MACRO_TX1,
  1836. &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
  1837. clear_bit(WSA_MACRO_TX1,
  1838. &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
  1839. wsa->active_ch_cnt[WSA_MACRO_AIF_VI]--;
  1840. }
  1841. }
  1842. snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, NULL);
  1843. return 0;
  1844. }
  1845. static const struct snd_kcontrol_new aif_vi_mixer[] = {
  1846. SOC_SINGLE_EXT("WSA_SPKR_VI_1", SND_SOC_NOPM, WSA_MACRO_TX0, 1, 0,
  1847. wsa_macro_vi_feed_mixer_get,
  1848. wsa_macro_vi_feed_mixer_put),
  1849. SOC_SINGLE_EXT("WSA_SPKR_VI_2", SND_SOC_NOPM, WSA_MACRO_TX1, 1, 0,
  1850. wsa_macro_vi_feed_mixer_get,
  1851. wsa_macro_vi_feed_mixer_put),
  1852. };
  1853. static const struct snd_soc_dapm_widget wsa_macro_dapm_widgets[] = {
  1854. SND_SOC_DAPM_AIF_IN("WSA AIF1 PB", "WSA_AIF1 Playback", 0,
  1855. SND_SOC_NOPM, 0, 0),
  1856. SND_SOC_DAPM_AIF_IN("WSA AIF_MIX1 PB", "WSA_AIF_MIX1 Playback", 0,
  1857. SND_SOC_NOPM, 0, 0),
  1858. SND_SOC_DAPM_AIF_OUT_E("WSA AIF_VI", "WSA_AIF_VI Capture", 0,
  1859. SND_SOC_NOPM, WSA_MACRO_AIF_VI, 0,
  1860. wsa_macro_enable_vi_feedback,
  1861. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1862. SND_SOC_DAPM_AIF_OUT("WSA AIF_ECHO", "WSA_AIF_ECHO Capture", 0,
  1863. SND_SOC_NOPM, 0, 0),
  1864. SND_SOC_DAPM_MIXER("WSA_AIF_VI Mixer", SND_SOC_NOPM, WSA_MACRO_AIF_VI,
  1865. 0, aif_vi_mixer, ARRAY_SIZE(aif_vi_mixer)),
  1866. SND_SOC_DAPM_MUX_E("WSA RX_MIX EC0_MUX", SND_SOC_NOPM,
  1867. WSA_MACRO_EC0_MUX, 0,
  1868. &rx_mix_ec0_mux, wsa_macro_enable_echo,
  1869. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1870. SND_SOC_DAPM_MUX_E("WSA RX_MIX EC1_MUX", SND_SOC_NOPM,
  1871. WSA_MACRO_EC1_MUX, 0,
  1872. &rx_mix_ec1_mux, wsa_macro_enable_echo,
  1873. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1874. SND_SOC_DAPM_MUX("WSA RX0 MUX", SND_SOC_NOPM, WSA_MACRO_RX0, 0,
  1875. &rx_mux[WSA_MACRO_RX0]),
  1876. SND_SOC_DAPM_MUX("WSA RX1 MUX", SND_SOC_NOPM, WSA_MACRO_RX1, 0,
  1877. &rx_mux[WSA_MACRO_RX1]),
  1878. SND_SOC_DAPM_MUX("WSA RX_MIX0 MUX", SND_SOC_NOPM, WSA_MACRO_RX_MIX0, 0,
  1879. &rx_mux[WSA_MACRO_RX_MIX0]),
  1880. SND_SOC_DAPM_MUX("WSA RX_MIX1 MUX", SND_SOC_NOPM, WSA_MACRO_RX_MIX1, 0,
  1881. &rx_mux[WSA_MACRO_RX_MIX1]),
  1882. SND_SOC_DAPM_MIXER("WSA RX0", SND_SOC_NOPM, 0, 0, NULL, 0),
  1883. SND_SOC_DAPM_MIXER("WSA RX1", SND_SOC_NOPM, 0, 0, NULL, 0),
  1884. SND_SOC_DAPM_MIXER("WSA RX_MIX0", SND_SOC_NOPM, 0, 0, NULL, 0),
  1885. SND_SOC_DAPM_MIXER("WSA RX_MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
  1886. SND_SOC_DAPM_MUX("WSA_RX0 INP0", SND_SOC_NOPM, 0, 0, &rx0_prim_inp0_mux),
  1887. SND_SOC_DAPM_MUX("WSA_RX0 INP1", SND_SOC_NOPM, 0, 0, &rx0_prim_inp1_mux),
  1888. SND_SOC_DAPM_MUX("WSA_RX0 INP2", SND_SOC_NOPM, 0, 0, &rx0_prim_inp2_mux),
  1889. SND_SOC_DAPM_MUX_E("WSA_RX0 MIX INP", SND_SOC_NOPM, WSA_MACRO_RX_MIX0,
  1890. 0, &rx0_mix_mux, wsa_macro_enable_mix_path,
  1891. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1892. SND_SOC_DAPM_MUX("WSA_RX1 INP0", SND_SOC_NOPM, 0, 0, &rx1_prim_inp0_mux),
  1893. SND_SOC_DAPM_MUX("WSA_RX1 INP1", SND_SOC_NOPM, 0, 0, &rx1_prim_inp1_mux),
  1894. SND_SOC_DAPM_MUX("WSA_RX1 INP2", SND_SOC_NOPM, 0, 0, &rx1_prim_inp2_mux),
  1895. SND_SOC_DAPM_MUX_E("WSA_RX1 MIX INP", SND_SOC_NOPM, WSA_MACRO_RX_MIX1,
  1896. 0, &rx1_mix_mux, wsa_macro_enable_mix_path,
  1897. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1898. SND_SOC_DAPM_MIXER_E("WSA_RX INT0 MIX", SND_SOC_NOPM, 0, 0, NULL, 0,
  1899. wsa_macro_enable_main_path, SND_SOC_DAPM_PRE_PMU),
  1900. SND_SOC_DAPM_MIXER_E("WSA_RX INT1 MIX", SND_SOC_NOPM, 1, 0, NULL, 0,
  1901. wsa_macro_enable_main_path, SND_SOC_DAPM_PRE_PMU),
  1902. SND_SOC_DAPM_MIXER("WSA_RX INT0 SEC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
  1903. SND_SOC_DAPM_MIXER("WSA_RX INT1 SEC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
  1904. SND_SOC_DAPM_MUX("WSA_RX0 INT0 SIDETONE MIX", CDC_WSA_RX0_RX_PATH_CFG1,
  1905. 4, 0, &rx0_sidetone_mix_mux),
  1906. SND_SOC_DAPM_INPUT("WSA SRC0_INP"),
  1907. SND_SOC_DAPM_INPUT("WSA_TX DEC0_INP"),
  1908. SND_SOC_DAPM_INPUT("WSA_TX DEC1_INP"),
  1909. SND_SOC_DAPM_MIXER_E("WSA_RX INT0 INTERP", SND_SOC_NOPM,
  1910. WSA_MACRO_COMP1, 0, NULL, 0,
  1911. wsa_macro_enable_interpolator,
  1912. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1913. SND_SOC_DAPM_POST_PMD),
  1914. SND_SOC_DAPM_MIXER_E("WSA_RX INT1 INTERP", SND_SOC_NOPM,
  1915. WSA_MACRO_COMP2, 0, NULL, 0,
  1916. wsa_macro_enable_interpolator,
  1917. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1918. SND_SOC_DAPM_POST_PMD),
  1919. SND_SOC_DAPM_MIXER_E("WSA_RX INT0 CHAIN", SND_SOC_NOPM, 0, 0,
  1920. NULL, 0, wsa_macro_spk_boost_event,
  1921. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1922. SND_SOC_DAPM_POST_PMD),
  1923. SND_SOC_DAPM_MIXER_E("WSA_RX INT1 CHAIN", SND_SOC_NOPM, 0, 0,
  1924. NULL, 0, wsa_macro_spk_boost_event,
  1925. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
  1926. SND_SOC_DAPM_POST_PMD),
  1927. SND_SOC_DAPM_INPUT("VIINPUT_WSA"),
  1928. SND_SOC_DAPM_OUTPUT("WSA_SPK1 OUT"),
  1929. SND_SOC_DAPM_OUTPUT("WSA_SPK2 OUT"),
  1930. SND_SOC_DAPM_SUPPLY("WSA_RX0_CLK", CDC_WSA_RX0_RX_PATH_CTL, 5, 0, NULL, 0),
  1931. SND_SOC_DAPM_SUPPLY("WSA_RX1_CLK", CDC_WSA_RX1_RX_PATH_CTL, 5, 0, NULL, 0),
  1932. SND_SOC_DAPM_SUPPLY("WSA_RX_MIX0_CLK", CDC_WSA_RX0_RX_PATH_MIX_CTL, 5, 0, NULL, 0),
  1933. SND_SOC_DAPM_SUPPLY("WSA_RX_MIX1_CLK", CDC_WSA_RX1_RX_PATH_MIX_CTL, 5, 0, NULL, 0),
  1934. SND_SOC_DAPM_SUPPLY_S("WSA_MCLK", 0, SND_SOC_NOPM, 0, 0,
  1935. wsa_macro_mclk_event,
  1936. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1937. };
  1938. static const struct snd_soc_dapm_route wsa_audio_map[] = {
  1939. /* VI Feedback */
  1940. {"WSA_AIF_VI Mixer", "WSA_SPKR_VI_1", "VIINPUT_WSA"},
  1941. {"WSA_AIF_VI Mixer", "WSA_SPKR_VI_2", "VIINPUT_WSA"},
  1942. {"WSA AIF_VI", NULL, "WSA_AIF_VI Mixer"},
  1943. {"WSA AIF_VI", NULL, "WSA_MCLK"},
  1944. {"WSA RX_MIX EC0_MUX", "RX_MIX_TX0", "WSA_RX INT0 SEC MIX"},
  1945. {"WSA RX_MIX EC1_MUX", "RX_MIX_TX0", "WSA_RX INT0 SEC MIX"},
  1946. {"WSA RX_MIX EC0_MUX", "RX_MIX_TX1", "WSA_RX INT1 SEC MIX"},
  1947. {"WSA RX_MIX EC1_MUX", "RX_MIX_TX1", "WSA_RX INT1 SEC MIX"},
  1948. {"WSA AIF_ECHO", NULL, "WSA RX_MIX EC0_MUX"},
  1949. {"WSA AIF_ECHO", NULL, "WSA RX_MIX EC1_MUX"},
  1950. {"WSA AIF_ECHO", NULL, "WSA_MCLK"},
  1951. {"WSA AIF1 PB", NULL, "WSA_MCLK"},
  1952. {"WSA AIF_MIX1 PB", NULL, "WSA_MCLK"},
  1953. {"WSA RX0 MUX", "AIF1_PB", "WSA AIF1 PB"},
  1954. {"WSA RX1 MUX", "AIF1_PB", "WSA AIF1 PB"},
  1955. {"WSA RX_MIX0 MUX", "AIF1_PB", "WSA AIF1 PB"},
  1956. {"WSA RX_MIX1 MUX", "AIF1_PB", "WSA AIF1 PB"},
  1957. {"WSA RX0 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
  1958. {"WSA RX1 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
  1959. {"WSA RX_MIX0 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
  1960. {"WSA RX_MIX1 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
  1961. {"WSA RX0", NULL, "WSA RX0 MUX"},
  1962. {"WSA RX1", NULL, "WSA RX1 MUX"},
  1963. {"WSA RX_MIX0", NULL, "WSA RX_MIX0 MUX"},
  1964. {"WSA RX_MIX1", NULL, "WSA RX_MIX1 MUX"},
  1965. {"WSA RX0", NULL, "WSA_RX0_CLK"},
  1966. {"WSA RX1", NULL, "WSA_RX1_CLK"},
  1967. {"WSA RX_MIX0", NULL, "WSA_RX_MIX0_CLK"},
  1968. {"WSA RX_MIX1", NULL, "WSA_RX_MIX1_CLK"},
  1969. {"WSA_RX0 INP0", "RX0", "WSA RX0"},
  1970. {"WSA_RX0 INP0", "RX1", "WSA RX1"},
  1971. {"WSA_RX0 INP0", "RX_MIX0", "WSA RX_MIX0"},
  1972. {"WSA_RX0 INP0", "RX_MIX1", "WSA RX_MIX1"},
  1973. {"WSA_RX0 INP0", "DEC0", "WSA_TX DEC0_INP"},
  1974. {"WSA_RX0 INP0", "DEC1", "WSA_TX DEC1_INP"},
  1975. {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP0"},
  1976. {"WSA_RX0 INP1", "RX0", "WSA RX0"},
  1977. {"WSA_RX0 INP1", "RX1", "WSA RX1"},
  1978. {"WSA_RX0 INP1", "RX_MIX0", "WSA RX_MIX0"},
  1979. {"WSA_RX0 INP1", "RX_MIX1", "WSA RX_MIX1"},
  1980. {"WSA_RX0 INP1", "DEC0", "WSA_TX DEC0_INP"},
  1981. {"WSA_RX0 INP1", "DEC1", "WSA_TX DEC1_INP"},
  1982. {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP1"},
  1983. {"WSA_RX0 INP2", "RX0", "WSA RX0"},
  1984. {"WSA_RX0 INP2", "RX1", "WSA RX1"},
  1985. {"WSA_RX0 INP2", "RX_MIX0", "WSA RX_MIX0"},
  1986. {"WSA_RX0 INP2", "RX_MIX1", "WSA RX_MIX1"},
  1987. {"WSA_RX0 INP2", "DEC0", "WSA_TX DEC0_INP"},
  1988. {"WSA_RX0 INP2", "DEC1", "WSA_TX DEC1_INP"},
  1989. {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP2"},
  1990. {"WSA_RX0 MIX INP", "RX0", "WSA RX0"},
  1991. {"WSA_RX0 MIX INP", "RX1", "WSA RX1"},
  1992. {"WSA_RX0 MIX INP", "RX_MIX0", "WSA RX_MIX0"},
  1993. {"WSA_RX0 MIX INP", "RX_MIX1", "WSA RX_MIX1"},
  1994. {"WSA_RX INT0 SEC MIX", NULL, "WSA_RX0 MIX INP"},
  1995. {"WSA_RX INT0 SEC MIX", NULL, "WSA_RX INT0 MIX"},
  1996. {"WSA_RX INT0 INTERP", NULL, "WSA_RX INT0 SEC MIX"},
  1997. {"WSA_RX0 INT0 SIDETONE MIX", "SRC0", "WSA SRC0_INP"},
  1998. {"WSA_RX INT0 INTERP", NULL, "WSA_RX0 INT0 SIDETONE MIX"},
  1999. {"WSA_RX INT0 CHAIN", NULL, "WSA_RX INT0 INTERP"},
  2000. {"WSA_SPK1 OUT", NULL, "WSA_RX INT0 CHAIN"},
  2001. {"WSA_SPK1 OUT", NULL, "WSA_MCLK"},
  2002. {"WSA_RX1 INP0", "RX0", "WSA RX0"},
  2003. {"WSA_RX1 INP0", "RX1", "WSA RX1"},
  2004. {"WSA_RX1 INP0", "RX_MIX0", "WSA RX_MIX0"},
  2005. {"WSA_RX1 INP0", "RX_MIX1", "WSA RX_MIX1"},
  2006. {"WSA_RX1 INP0", "DEC0", "WSA_TX DEC0_INP"},
  2007. {"WSA_RX1 INP0", "DEC1", "WSA_TX DEC1_INP"},
  2008. {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP0"},
  2009. {"WSA_RX1 INP1", "RX0", "WSA RX0"},
  2010. {"WSA_RX1 INP1", "RX1", "WSA RX1"},
  2011. {"WSA_RX1 INP1", "RX_MIX0", "WSA RX_MIX0"},
  2012. {"WSA_RX1 INP1", "RX_MIX1", "WSA RX_MIX1"},
  2013. {"WSA_RX1 INP1", "DEC0", "WSA_TX DEC0_INP"},
  2014. {"WSA_RX1 INP1", "DEC1", "WSA_TX DEC1_INP"},
  2015. {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP1"},
  2016. {"WSA_RX1 INP2", "RX0", "WSA RX0"},
  2017. {"WSA_RX1 INP2", "RX1", "WSA RX1"},
  2018. {"WSA_RX1 INP2", "RX_MIX0", "WSA RX_MIX0"},
  2019. {"WSA_RX1 INP2", "RX_MIX1", "WSA RX_MIX1"},
  2020. {"WSA_RX1 INP2", "DEC0", "WSA_TX DEC0_INP"},
  2021. {"WSA_RX1 INP2", "DEC1", "WSA_TX DEC1_INP"},
  2022. {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP2"},
  2023. {"WSA_RX1 MIX INP", "RX0", "WSA RX0"},
  2024. {"WSA_RX1 MIX INP", "RX1", "WSA RX1"},
  2025. {"WSA_RX1 MIX INP", "RX_MIX0", "WSA RX_MIX0"},
  2026. {"WSA_RX1 MIX INP", "RX_MIX1", "WSA RX_MIX1"},
  2027. {"WSA_RX INT1 SEC MIX", NULL, "WSA_RX1 MIX INP"},
  2028. {"WSA_RX INT1 SEC MIX", NULL, "WSA_RX INT1 MIX"},
  2029. {"WSA_RX INT1 INTERP", NULL, "WSA_RX INT1 SEC MIX"},
  2030. {"WSA_RX INT1 CHAIN", NULL, "WSA_RX INT1 INTERP"},
  2031. {"WSA_SPK2 OUT", NULL, "WSA_RX INT1 CHAIN"},
  2032. {"WSA_SPK2 OUT", NULL, "WSA_MCLK"},
  2033. };
  2034. static int wsa_swrm_clock(struct wsa_macro *wsa, bool enable)
  2035. {
  2036. struct regmap *regmap = wsa->regmap;
  2037. if (enable) {
  2038. int ret;
  2039. ret = clk_prepare_enable(wsa->mclk);
  2040. if (ret) {
  2041. dev_err(wsa->dev, "failed to enable mclk\n");
  2042. return ret;
  2043. }
  2044. wsa_macro_mclk_enable(wsa, true);
  2045. /* reset swr ip */
  2046. regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
  2047. CDC_WSA_SWR_RST_EN_MASK, CDC_WSA_SWR_RST_ENABLE);
  2048. regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
  2049. CDC_WSA_SWR_CLK_EN_MASK,
  2050. CDC_WSA_SWR_CLK_ENABLE);
  2051. /* Bring out of reset */
  2052. regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
  2053. CDC_WSA_SWR_RST_EN_MASK, CDC_WSA_SWR_RST_DISABLE);
  2054. } else {
  2055. regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
  2056. CDC_WSA_SWR_CLK_EN_MASK, 0);
  2057. wsa_macro_mclk_enable(wsa, false);
  2058. clk_disable_unprepare(wsa->mclk);
  2059. }
  2060. return 0;
  2061. }
  2062. static int wsa_macro_component_probe(struct snd_soc_component *comp)
  2063. {
  2064. struct wsa_macro *wsa = snd_soc_component_get_drvdata(comp);
  2065. snd_soc_component_init_regmap(comp, wsa->regmap);
  2066. wsa->spkr_gain_offset = WSA_MACRO_GAIN_OFFSET_M1P5_DB;
  2067. /* set SPKR rate to FS_2P4_3P072 */
  2068. snd_soc_component_update_bits(comp, CDC_WSA_RX0_RX_PATH_CFG1,
  2069. CDC_WSA_RX_PATH_SPKR_RATE_MASK,
  2070. CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072);
  2071. snd_soc_component_update_bits(comp, CDC_WSA_RX1_RX_PATH_CFG1,
  2072. CDC_WSA_RX_PATH_SPKR_RATE_MASK,
  2073. CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072);
  2074. wsa_macro_set_spkr_mode(comp, WSA_MACRO_SPKR_MODE_1);
  2075. return 0;
  2076. }
  2077. static int swclk_gate_enable(struct clk_hw *hw)
  2078. {
  2079. return wsa_swrm_clock(to_wsa_macro(hw), true);
  2080. }
  2081. static void swclk_gate_disable(struct clk_hw *hw)
  2082. {
  2083. wsa_swrm_clock(to_wsa_macro(hw), false);
  2084. }
  2085. static int swclk_gate_is_enabled(struct clk_hw *hw)
  2086. {
  2087. struct wsa_macro *wsa = to_wsa_macro(hw);
  2088. int ret, val;
  2089. regmap_read(wsa->regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, &val);
  2090. ret = val & BIT(0);
  2091. return ret;
  2092. }
  2093. static unsigned long swclk_recalc_rate(struct clk_hw *hw,
  2094. unsigned long parent_rate)
  2095. {
  2096. return parent_rate / 2;
  2097. }
  2098. static const struct clk_ops swclk_gate_ops = {
  2099. .prepare = swclk_gate_enable,
  2100. .unprepare = swclk_gate_disable,
  2101. .is_enabled = swclk_gate_is_enabled,
  2102. .recalc_rate = swclk_recalc_rate,
  2103. };
  2104. static int wsa_macro_register_mclk_output(struct wsa_macro *wsa)
  2105. {
  2106. struct device *dev = wsa->dev;
  2107. const char *parent_clk_name;
  2108. const char *clk_name = "mclk";
  2109. struct clk_hw *hw;
  2110. struct clk_init_data init;
  2111. int ret;
  2112. parent_clk_name = __clk_get_name(wsa->npl);
  2113. init.name = clk_name;
  2114. init.ops = &swclk_gate_ops;
  2115. init.flags = 0;
  2116. init.parent_names = &parent_clk_name;
  2117. init.num_parents = 1;
  2118. wsa->hw.init = &init;
  2119. hw = &wsa->hw;
  2120. ret = clk_hw_register(wsa->dev, hw);
  2121. if (ret)
  2122. return ret;
  2123. return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, hw);
  2124. }
  2125. static const struct snd_soc_component_driver wsa_macro_component_drv = {
  2126. .name = "WSA MACRO",
  2127. .probe = wsa_macro_component_probe,
  2128. .controls = wsa_macro_snd_controls,
  2129. .num_controls = ARRAY_SIZE(wsa_macro_snd_controls),
  2130. .dapm_widgets = wsa_macro_dapm_widgets,
  2131. .num_dapm_widgets = ARRAY_SIZE(wsa_macro_dapm_widgets),
  2132. .dapm_routes = wsa_audio_map,
  2133. .num_dapm_routes = ARRAY_SIZE(wsa_audio_map),
  2134. };
  2135. static int wsa_macro_probe(struct platform_device *pdev)
  2136. {
  2137. struct device *dev = &pdev->dev;
  2138. struct wsa_macro *wsa;
  2139. void __iomem *base;
  2140. int ret;
  2141. wsa = devm_kzalloc(dev, sizeof(*wsa), GFP_KERNEL);
  2142. if (!wsa)
  2143. return -ENOMEM;
  2144. wsa->macro = devm_clk_get_optional(dev, "macro");
  2145. if (IS_ERR(wsa->macro))
  2146. return PTR_ERR(wsa->macro);
  2147. wsa->dcodec = devm_clk_get_optional(dev, "dcodec");
  2148. if (IS_ERR(wsa->dcodec))
  2149. return PTR_ERR(wsa->dcodec);
  2150. wsa->mclk = devm_clk_get(dev, "mclk");
  2151. if (IS_ERR(wsa->mclk))
  2152. return PTR_ERR(wsa->mclk);
  2153. wsa->npl = devm_clk_get(dev, "npl");
  2154. if (IS_ERR(wsa->npl))
  2155. return PTR_ERR(wsa->npl);
  2156. wsa->fsgen = devm_clk_get(dev, "fsgen");
  2157. if (IS_ERR(wsa->fsgen))
  2158. return PTR_ERR(wsa->fsgen);
  2159. base = devm_platform_ioremap_resource(pdev, 0);
  2160. if (IS_ERR(base))
  2161. return PTR_ERR(base);
  2162. wsa->regmap = devm_regmap_init_mmio(dev, base, &wsa_regmap_config);
  2163. if (IS_ERR(wsa->regmap))
  2164. return PTR_ERR(wsa->regmap);
  2165. dev_set_drvdata(dev, wsa);
  2166. wsa->dev = dev;
  2167. /* set MCLK and NPL rates */
  2168. clk_set_rate(wsa->mclk, WSA_MACRO_MCLK_FREQ);
  2169. clk_set_rate(wsa->npl, WSA_MACRO_MCLK_FREQ);
  2170. ret = clk_prepare_enable(wsa->macro);
  2171. if (ret)
  2172. goto err;
  2173. ret = clk_prepare_enable(wsa->dcodec);
  2174. if (ret)
  2175. goto err_dcodec;
  2176. ret = clk_prepare_enable(wsa->mclk);
  2177. if (ret)
  2178. goto err_mclk;
  2179. ret = clk_prepare_enable(wsa->npl);
  2180. if (ret)
  2181. goto err_npl;
  2182. ret = clk_prepare_enable(wsa->fsgen);
  2183. if (ret)
  2184. goto err_fsgen;
  2185. ret = devm_snd_soc_register_component(dev, &wsa_macro_component_drv,
  2186. wsa_macro_dai,
  2187. ARRAY_SIZE(wsa_macro_dai));
  2188. if (ret)
  2189. goto err_clkout;
  2190. pm_runtime_set_autosuspend_delay(dev, 3000);
  2191. pm_runtime_use_autosuspend(dev);
  2192. pm_runtime_mark_last_busy(dev);
  2193. pm_runtime_set_active(dev);
  2194. pm_runtime_enable(dev);
  2195. ret = wsa_macro_register_mclk_output(wsa);
  2196. if (ret)
  2197. goto err_clkout;
  2198. return 0;
  2199. err_clkout:
  2200. clk_disable_unprepare(wsa->fsgen);
  2201. err_fsgen:
  2202. clk_disable_unprepare(wsa->npl);
  2203. err_npl:
  2204. clk_disable_unprepare(wsa->mclk);
  2205. err_mclk:
  2206. clk_disable_unprepare(wsa->dcodec);
  2207. err_dcodec:
  2208. clk_disable_unprepare(wsa->macro);
  2209. err:
  2210. return ret;
  2211. }
  2212. static int wsa_macro_remove(struct platform_device *pdev)
  2213. {
  2214. struct wsa_macro *wsa = dev_get_drvdata(&pdev->dev);
  2215. clk_disable_unprepare(wsa->macro);
  2216. clk_disable_unprepare(wsa->dcodec);
  2217. clk_disable_unprepare(wsa->mclk);
  2218. clk_disable_unprepare(wsa->npl);
  2219. clk_disable_unprepare(wsa->fsgen);
  2220. return 0;
  2221. }
  2222. static int __maybe_unused wsa_macro_runtime_suspend(struct device *dev)
  2223. {
  2224. struct wsa_macro *wsa = dev_get_drvdata(dev);
  2225. regcache_cache_only(wsa->regmap, true);
  2226. regcache_mark_dirty(wsa->regmap);
  2227. clk_disable_unprepare(wsa->fsgen);
  2228. clk_disable_unprepare(wsa->npl);
  2229. clk_disable_unprepare(wsa->mclk);
  2230. return 0;
  2231. }
  2232. static int __maybe_unused wsa_macro_runtime_resume(struct device *dev)
  2233. {
  2234. struct wsa_macro *wsa = dev_get_drvdata(dev);
  2235. int ret;
  2236. ret = clk_prepare_enable(wsa->mclk);
  2237. if (ret) {
  2238. dev_err(dev, "unable to prepare mclk\n");
  2239. return ret;
  2240. }
  2241. ret = clk_prepare_enable(wsa->npl);
  2242. if (ret) {
  2243. dev_err(dev, "unable to prepare mclkx2\n");
  2244. goto err_npl;
  2245. }
  2246. ret = clk_prepare_enable(wsa->fsgen);
  2247. if (ret) {
  2248. dev_err(dev, "unable to prepare fsgen\n");
  2249. goto err_fsgen;
  2250. }
  2251. regcache_cache_only(wsa->regmap, false);
  2252. regcache_sync(wsa->regmap);
  2253. return 0;
  2254. err_fsgen:
  2255. clk_disable_unprepare(wsa->npl);
  2256. err_npl:
  2257. clk_disable_unprepare(wsa->mclk);
  2258. return ret;
  2259. }
  2260. static const struct dev_pm_ops wsa_macro_pm_ops = {
  2261. SET_RUNTIME_PM_OPS(wsa_macro_runtime_suspend, wsa_macro_runtime_resume, NULL)
  2262. };
  2263. static const struct of_device_id wsa_macro_dt_match[] = {
  2264. {.compatible = "qcom,sc7280-lpass-wsa-macro"},
  2265. {.compatible = "qcom,sm8250-lpass-wsa-macro"},
  2266. {.compatible = "qcom,sm8450-lpass-wsa-macro"},
  2267. {.compatible = "qcom,sc8280xp-lpass-wsa-macro" },
  2268. {}
  2269. };
  2270. MODULE_DEVICE_TABLE(of, wsa_macro_dt_match);
  2271. static struct platform_driver wsa_macro_driver = {
  2272. .driver = {
  2273. .name = "wsa_macro",
  2274. .of_match_table = wsa_macro_dt_match,
  2275. .pm = &wsa_macro_pm_ops,
  2276. },
  2277. .probe = wsa_macro_probe,
  2278. .remove = wsa_macro_remove,
  2279. };
  2280. module_platform_driver(wsa_macro_driver);
  2281. MODULE_DESCRIPTION("WSA macro driver");
  2282. MODULE_LICENSE("GPL");