rt5682s.c 98 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. //
  3. // rt5682s.c -- RT5682I-VS ALSA SoC audio component driver
  4. //
  5. // Copyright 2021 Realtek Semiconductor Corp.
  6. // Author: Derek Fang <[email protected]>
  7. //
  8. #include <linux/module.h>
  9. #include <linux/moduleparam.h>
  10. #include <linux/init.h>
  11. #include <linux/delay.h>
  12. #include <linux/pm.h>
  13. #include <linux/pm_runtime.h>
  14. #include <linux/i2c.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/spi/spi.h>
  17. #include <linux/acpi.h>
  18. #include <linux/gpio.h>
  19. #include <linux/of_gpio.h>
  20. #include <linux/mutex.h>
  21. #include <sound/core.h>
  22. #include <sound/pcm.h>
  23. #include <sound/pcm_params.h>
  24. #include <sound/jack.h>
  25. #include <sound/soc.h>
  26. #include <sound/soc-dapm.h>
  27. #include <sound/initval.h>
  28. #include <sound/tlv.h>
  29. #include <sound/rt5682s.h>
  30. #include "rt5682s.h"
  31. #define DEVICE_ID 0x6749
  32. static const struct rt5682s_platform_data i2s_default_platform_data = {
  33. .dmic1_data_pin = RT5682S_DMIC1_DATA_GPIO2,
  34. .dmic1_clk_pin = RT5682S_DMIC1_CLK_GPIO3,
  35. .jd_src = RT5682S_JD1,
  36. .dai_clk_names[RT5682S_DAI_WCLK_IDX] = "rt5682-dai-wclk",
  37. .dai_clk_names[RT5682S_DAI_BCLK_IDX] = "rt5682-dai-bclk",
  38. };
  39. static const char *rt5682s_supply_names[RT5682S_NUM_SUPPLIES] = {
  40. [RT5682S_SUPPLY_AVDD] = "AVDD",
  41. [RT5682S_SUPPLY_MICVDD] = "MICVDD",
  42. };
  43. static const struct reg_sequence patch_list[] = {
  44. {RT5682S_I2C_CTRL, 0x0007},
  45. {RT5682S_DIG_IN_CTRL_1, 0x0000},
  46. {RT5682S_CHOP_DAC_2, 0x2020},
  47. {RT5682S_VREF_REC_OP_FB_CAP_CTRL_2, 0x0101},
  48. {RT5682S_VREF_REC_OP_FB_CAP_CTRL_1, 0x80c0},
  49. {RT5682S_HP_CALIB_CTRL_9, 0x0002},
  50. {RT5682S_DEPOP_1, 0x0000},
  51. {RT5682S_HP_CHARGE_PUMP_2, 0x3c15},
  52. {RT5682S_DAC1_DIG_VOL, 0xfefe},
  53. {RT5682S_SAR_IL_CMD_2, 0xac00},
  54. {RT5682S_SAR_IL_CMD_3, 0x024c},
  55. {RT5682S_CBJ_CTRL_6, 0x0804},
  56. };
  57. static void rt5682s_apply_patch_list(struct rt5682s_priv *rt5682s,
  58. struct device *dev)
  59. {
  60. int ret;
  61. ret = regmap_multi_reg_write(rt5682s->regmap, patch_list, ARRAY_SIZE(patch_list));
  62. if (ret)
  63. dev_warn(dev, "Failed to apply regmap patch: %d\n", ret);
  64. }
  65. static const struct reg_default rt5682s_reg[] = {
  66. {0x0002, 0x8080},
  67. {0x0003, 0x0001},
  68. {0x0005, 0x0000},
  69. {0x0006, 0x0000},
  70. {0x0008, 0x8007},
  71. {0x000b, 0x0000},
  72. {0x000f, 0x4000},
  73. {0x0010, 0x4040},
  74. {0x0011, 0x0000},
  75. {0x0012, 0x0000},
  76. {0x0013, 0x1200},
  77. {0x0014, 0x200a},
  78. {0x0015, 0x0404},
  79. {0x0016, 0x0404},
  80. {0x0017, 0x05a4},
  81. {0x0019, 0xffff},
  82. {0x001c, 0x2f2f},
  83. {0x001f, 0x0000},
  84. {0x0022, 0x5757},
  85. {0x0023, 0x0039},
  86. {0x0024, 0x000b},
  87. {0x0026, 0xc0c4},
  88. {0x0029, 0x8080},
  89. {0x002a, 0xa0a0},
  90. {0x002b, 0x0300},
  91. {0x0030, 0x0000},
  92. {0x003c, 0x08c0},
  93. {0x0044, 0x1818},
  94. {0x004b, 0x00c0},
  95. {0x004c, 0x0000},
  96. {0x004d, 0x0000},
  97. {0x0061, 0x00c0},
  98. {0x0062, 0x008a},
  99. {0x0063, 0x0800},
  100. {0x0064, 0x0000},
  101. {0x0065, 0x0000},
  102. {0x0066, 0x0030},
  103. {0x0067, 0x000c},
  104. {0x0068, 0x0000},
  105. {0x0069, 0x0000},
  106. {0x006a, 0x0000},
  107. {0x006b, 0x0000},
  108. {0x006c, 0x0000},
  109. {0x006d, 0x2200},
  110. {0x006e, 0x0810},
  111. {0x006f, 0xe4de},
  112. {0x0070, 0x3320},
  113. {0x0071, 0x0000},
  114. {0x0073, 0x0000},
  115. {0x0074, 0x0000},
  116. {0x0075, 0x0002},
  117. {0x0076, 0x0001},
  118. {0x0079, 0x0000},
  119. {0x007a, 0x0000},
  120. {0x007b, 0x0000},
  121. {0x007c, 0x0100},
  122. {0x007e, 0x0000},
  123. {0x007f, 0x0000},
  124. {0x0080, 0x0000},
  125. {0x0083, 0x0000},
  126. {0x0084, 0x0000},
  127. {0x0085, 0x0000},
  128. {0x0086, 0x0005},
  129. {0x0087, 0x0000},
  130. {0x0088, 0x0000},
  131. {0x008c, 0x0003},
  132. {0x008e, 0x0060},
  133. {0x008f, 0x4da1},
  134. {0x0091, 0x1c15},
  135. {0x0092, 0x0425},
  136. {0x0093, 0x0000},
  137. {0x0094, 0x0080},
  138. {0x0095, 0x008f},
  139. {0x0096, 0x0000},
  140. {0x0097, 0x0000},
  141. {0x0098, 0x0000},
  142. {0x0099, 0x0000},
  143. {0x009a, 0x0000},
  144. {0x009b, 0x0000},
  145. {0x009c, 0x0000},
  146. {0x009d, 0x0000},
  147. {0x009e, 0x0000},
  148. {0x009f, 0x0009},
  149. {0x00a0, 0x0000},
  150. {0x00a3, 0x0002},
  151. {0x00a4, 0x0001},
  152. {0x00b6, 0x0000},
  153. {0x00b7, 0x0000},
  154. {0x00b8, 0x0000},
  155. {0x00b9, 0x0002},
  156. {0x00be, 0x0000},
  157. {0x00c0, 0x0160},
  158. {0x00c1, 0x82a0},
  159. {0x00c2, 0x0000},
  160. {0x00d0, 0x0000},
  161. {0x00d2, 0x3300},
  162. {0x00d3, 0x2200},
  163. {0x00d4, 0x0000},
  164. {0x00d9, 0x0000},
  165. {0x00da, 0x0000},
  166. {0x00db, 0x0000},
  167. {0x00dc, 0x00c0},
  168. {0x00dd, 0x2220},
  169. {0x00de, 0x3131},
  170. {0x00df, 0x3131},
  171. {0x00e0, 0x3131},
  172. {0x00e2, 0x0000},
  173. {0x00e3, 0x4000},
  174. {0x00e4, 0x0aa0},
  175. {0x00e5, 0x3131},
  176. {0x00e6, 0x3131},
  177. {0x00e7, 0x3131},
  178. {0x00e8, 0x3131},
  179. {0x00ea, 0xb320},
  180. {0x00eb, 0x0000},
  181. {0x00f0, 0x0000},
  182. {0x00f6, 0x0000},
  183. {0x00fa, 0x0000},
  184. {0x00fb, 0x0000},
  185. {0x00fc, 0x0000},
  186. {0x00fd, 0x0000},
  187. {0x00fe, 0x10ec},
  188. {0x00ff, 0x6749},
  189. {0x0100, 0xa000},
  190. {0x010b, 0x0066},
  191. {0x010c, 0x6666},
  192. {0x010d, 0x2202},
  193. {0x010e, 0x6666},
  194. {0x010f, 0xa800},
  195. {0x0110, 0x0006},
  196. {0x0111, 0x0460},
  197. {0x0112, 0x2000},
  198. {0x0113, 0x0200},
  199. {0x0117, 0x8000},
  200. {0x0118, 0x0303},
  201. {0x0125, 0x0020},
  202. {0x0132, 0x5026},
  203. {0x0136, 0x8000},
  204. {0x0139, 0x0005},
  205. {0x013a, 0x3030},
  206. {0x013b, 0xa000},
  207. {0x013c, 0x4110},
  208. {0x013f, 0x0000},
  209. {0x0145, 0x0022},
  210. {0x0146, 0x0000},
  211. {0x0147, 0x0000},
  212. {0x0148, 0x0000},
  213. {0x0156, 0x0022},
  214. {0x0157, 0x0303},
  215. {0x0158, 0x2222},
  216. {0x0159, 0x0000},
  217. {0x0160, 0x4ec0},
  218. {0x0161, 0x0080},
  219. {0x0162, 0x0200},
  220. {0x0163, 0x0800},
  221. {0x0164, 0x0000},
  222. {0x0165, 0x0000},
  223. {0x0166, 0x0000},
  224. {0x0167, 0x000f},
  225. {0x0168, 0x000f},
  226. {0x0169, 0x0001},
  227. {0x0190, 0x4131},
  228. {0x0194, 0x0000},
  229. {0x0195, 0x0000},
  230. {0x0197, 0x0022},
  231. {0x0198, 0x0000},
  232. {0x0199, 0x0000},
  233. {0x01ac, 0x0000},
  234. {0x01ad, 0x0000},
  235. {0x01ae, 0x0000},
  236. {0x01af, 0x2000},
  237. {0x01b0, 0x0000},
  238. {0x01b1, 0x0000},
  239. {0x01b2, 0x0000},
  240. {0x01b3, 0x0017},
  241. {0x01b4, 0x004b},
  242. {0x01b5, 0x0000},
  243. {0x01b6, 0x03e8},
  244. {0x01b7, 0x0000},
  245. {0x01b8, 0x0000},
  246. {0x01b9, 0x0400},
  247. {0x01ba, 0xb5b6},
  248. {0x01bb, 0x9124},
  249. {0x01bc, 0x4924},
  250. {0x01bd, 0x0009},
  251. {0x01be, 0x0018},
  252. {0x01bf, 0x002a},
  253. {0x01c0, 0x004c},
  254. {0x01c1, 0x0097},
  255. {0x01c2, 0x01c3},
  256. {0x01c3, 0x03e9},
  257. {0x01c4, 0x1389},
  258. {0x01c5, 0xc351},
  259. {0x01c6, 0x02a0},
  260. {0x01c7, 0x0b0f},
  261. {0x01c8, 0x402f},
  262. {0x01c9, 0x0702},
  263. {0x01ca, 0x0000},
  264. {0x01cb, 0x0000},
  265. {0x01cc, 0x5757},
  266. {0x01cd, 0x5757},
  267. {0x01ce, 0x5757},
  268. {0x01cf, 0x5757},
  269. {0x01d0, 0x5757},
  270. {0x01d1, 0x5757},
  271. {0x01d2, 0x5757},
  272. {0x01d3, 0x5757},
  273. {0x01d4, 0x5757},
  274. {0x01d5, 0x5757},
  275. {0x01d6, 0x0000},
  276. {0x01d7, 0x0000},
  277. {0x01d8, 0x0162},
  278. {0x01d9, 0x0007},
  279. {0x01da, 0x0000},
  280. {0x01db, 0x0004},
  281. {0x01dc, 0x0000},
  282. {0x01de, 0x7c00},
  283. {0x01df, 0x0020},
  284. {0x01e0, 0x04c1},
  285. {0x01e1, 0x0000},
  286. {0x01e2, 0x0000},
  287. {0x01e3, 0x0000},
  288. {0x01e4, 0x0000},
  289. {0x01e5, 0x0000},
  290. {0x01e6, 0x0001},
  291. {0x01e7, 0x0000},
  292. {0x01e8, 0x0000},
  293. {0x01eb, 0x0000},
  294. {0x01ec, 0x0000},
  295. {0x01ed, 0x0000},
  296. {0x01ee, 0x0000},
  297. {0x01ef, 0x0000},
  298. {0x01f0, 0x0000},
  299. {0x01f1, 0x0000},
  300. {0x01f2, 0x0000},
  301. {0x01f3, 0x0000},
  302. {0x01f4, 0x0000},
  303. {0x0210, 0x6297},
  304. {0x0211, 0xa004},
  305. {0x0212, 0x0365},
  306. {0x0213, 0xf7ff},
  307. {0x0214, 0xf24c},
  308. {0x0215, 0x0102},
  309. {0x0216, 0x00a3},
  310. {0x0217, 0x0048},
  311. {0x0218, 0xa2c0},
  312. {0x0219, 0x0400},
  313. {0x021a, 0x00c8},
  314. {0x021b, 0x00c0},
  315. {0x021c, 0x0000},
  316. {0x021d, 0x024c},
  317. {0x02fa, 0x0000},
  318. {0x02fb, 0x0000},
  319. {0x02fc, 0x0000},
  320. {0x03fe, 0x0000},
  321. {0x03ff, 0x0000},
  322. {0x0500, 0x0000},
  323. {0x0600, 0x0000},
  324. {0x0610, 0x6666},
  325. {0x0611, 0xa9aa},
  326. {0x0620, 0x6666},
  327. {0x0621, 0xa9aa},
  328. {0x0630, 0x6666},
  329. {0x0631, 0xa9aa},
  330. {0x0640, 0x6666},
  331. {0x0641, 0xa9aa},
  332. {0x07fa, 0x0000},
  333. {0x08fa, 0x0000},
  334. {0x08fb, 0x0000},
  335. {0x0d00, 0x0000},
  336. {0x1100, 0x0000},
  337. {0x1101, 0x0000},
  338. {0x1102, 0x0000},
  339. {0x1103, 0x0000},
  340. {0x1104, 0x0000},
  341. {0x1105, 0x0000},
  342. {0x1106, 0x0000},
  343. {0x1107, 0x0000},
  344. {0x1108, 0x0000},
  345. {0x1109, 0x0000},
  346. {0x110a, 0x0000},
  347. {0x110b, 0x0000},
  348. {0x110c, 0x0000},
  349. {0x1111, 0x0000},
  350. {0x1112, 0x0000},
  351. {0x1113, 0x0000},
  352. {0x1114, 0x0000},
  353. {0x1115, 0x0000},
  354. {0x1116, 0x0000},
  355. {0x1117, 0x0000},
  356. {0x1118, 0x0000},
  357. {0x1119, 0x0000},
  358. {0x111a, 0x0000},
  359. {0x111b, 0x0000},
  360. {0x111c, 0x0000},
  361. {0x1401, 0x0404},
  362. {0x1402, 0x0007},
  363. {0x1403, 0x0365},
  364. {0x1404, 0x0210},
  365. {0x1405, 0x0365},
  366. {0x1406, 0x0210},
  367. {0x1407, 0x0000},
  368. {0x1408, 0x0000},
  369. {0x1409, 0x0000},
  370. {0x140a, 0x0000},
  371. {0x140b, 0x0000},
  372. {0x140c, 0x0000},
  373. {0x140d, 0x0000},
  374. {0x140e, 0x0000},
  375. {0x140f, 0x0000},
  376. {0x1410, 0x0000},
  377. {0x1411, 0x0000},
  378. {0x1801, 0x0004},
  379. {0x1802, 0x0000},
  380. {0x1803, 0x0000},
  381. {0x1804, 0x0000},
  382. {0x1805, 0x00ff},
  383. {0x2c00, 0x0000},
  384. {0x3400, 0x0200},
  385. {0x3404, 0x0000},
  386. {0x3405, 0x0000},
  387. {0x3406, 0x0000},
  388. {0x3407, 0x0000},
  389. {0x3408, 0x0000},
  390. {0x3409, 0x0000},
  391. {0x340a, 0x0000},
  392. {0x340b, 0x0000},
  393. {0x340c, 0x0000},
  394. {0x340d, 0x0000},
  395. {0x340e, 0x0000},
  396. {0x340f, 0x0000},
  397. {0x3410, 0x0000},
  398. {0x3411, 0x0000},
  399. {0x3412, 0x0000},
  400. {0x3413, 0x0000},
  401. {0x3414, 0x0000},
  402. {0x3415, 0x0000},
  403. {0x3424, 0x0000},
  404. {0x3425, 0x0000},
  405. {0x3426, 0x0000},
  406. {0x3427, 0x0000},
  407. {0x3428, 0x0000},
  408. {0x3429, 0x0000},
  409. {0x342a, 0x0000},
  410. {0x342b, 0x0000},
  411. {0x342c, 0x0000},
  412. {0x342d, 0x0000},
  413. {0x342e, 0x0000},
  414. {0x342f, 0x0000},
  415. {0x3430, 0x0000},
  416. {0x3431, 0x0000},
  417. {0x3432, 0x0000},
  418. {0x3433, 0x0000},
  419. {0x3434, 0x0000},
  420. {0x3435, 0x0000},
  421. {0x3440, 0x6319},
  422. {0x3441, 0x3771},
  423. {0x3500, 0x0002},
  424. {0x3501, 0x5728},
  425. {0x3b00, 0x3010},
  426. {0x3b01, 0x3300},
  427. {0x3b02, 0x2200},
  428. {0x3b03, 0x0100},
  429. };
  430. static bool rt5682s_volatile_register(struct device *dev, unsigned int reg)
  431. {
  432. switch (reg) {
  433. case RT5682S_RESET:
  434. case RT5682S_CBJ_CTRL_2:
  435. case RT5682S_I2S1_F_DIV_CTRL_2:
  436. case RT5682S_I2S2_F_DIV_CTRL_2:
  437. case RT5682S_INT_ST_1:
  438. case RT5682S_GPIO_ST:
  439. case RT5682S_IL_CMD_1:
  440. case RT5682S_4BTN_IL_CMD_1:
  441. case RT5682S_AJD1_CTRL:
  442. case RT5682S_VERSION_ID...RT5682S_DEVICE_ID:
  443. case RT5682S_STO_NG2_CTRL_1:
  444. case RT5682S_STO_NG2_CTRL_5...RT5682S_STO_NG2_CTRL_7:
  445. case RT5682S_STO1_DAC_SIL_DET:
  446. case RT5682S_HP_IMP_SENS_CTRL_1...RT5682S_HP_IMP_SENS_CTRL_4:
  447. case RT5682S_HP_IMP_SENS_CTRL_13:
  448. case RT5682S_HP_IMP_SENS_CTRL_14:
  449. case RT5682S_HP_IMP_SENS_CTRL_43...RT5682S_HP_IMP_SENS_CTRL_46:
  450. case RT5682S_HP_CALIB_CTRL_1:
  451. case RT5682S_HP_CALIB_CTRL_10:
  452. case RT5682S_HP_CALIB_ST_1...RT5682S_HP_CALIB_ST_11:
  453. case RT5682S_SAR_IL_CMD_2...RT5682S_SAR_IL_CMD_5:
  454. case RT5682S_SAR_IL_CMD_10:
  455. case RT5682S_SAR_IL_CMD_11:
  456. case RT5682S_VERSION_ID_HIDE:
  457. case RT5682S_VERSION_ID_CUS:
  458. case RT5682S_I2C_TRANS_CTRL:
  459. case RT5682S_DMIC_FLOAT_DET:
  460. case RT5682S_HA_CMP_OP_1:
  461. case RT5682S_NEW_CBJ_DET_CTL_10...RT5682S_NEW_CBJ_DET_CTL_16:
  462. case RT5682S_CLK_SW_TEST_1:
  463. case RT5682S_CLK_SW_TEST_2:
  464. case RT5682S_EFUSE_READ_1...RT5682S_EFUSE_READ_18:
  465. case RT5682S_PILOT_DIG_CTL_1:
  466. return true;
  467. default:
  468. return false;
  469. }
  470. }
  471. static bool rt5682s_readable_register(struct device *dev, unsigned int reg)
  472. {
  473. switch (reg) {
  474. case RT5682S_RESET:
  475. case RT5682S_VERSION_ID:
  476. case RT5682S_VENDOR_ID:
  477. case RT5682S_DEVICE_ID:
  478. case RT5682S_HP_CTRL_1:
  479. case RT5682S_HP_CTRL_2:
  480. case RT5682S_HPL_GAIN:
  481. case RT5682S_HPR_GAIN:
  482. case RT5682S_I2C_CTRL:
  483. case RT5682S_CBJ_BST_CTRL:
  484. case RT5682S_CBJ_DET_CTRL:
  485. case RT5682S_CBJ_CTRL_1...RT5682S_CBJ_CTRL_8:
  486. case RT5682S_DAC1_DIG_VOL:
  487. case RT5682S_STO1_ADC_DIG_VOL:
  488. case RT5682S_STO1_ADC_BOOST:
  489. case RT5682S_HP_IMP_GAIN_1:
  490. case RT5682S_HP_IMP_GAIN_2:
  491. case RT5682S_SIDETONE_CTRL:
  492. case RT5682S_STO1_ADC_MIXER:
  493. case RT5682S_AD_DA_MIXER:
  494. case RT5682S_STO1_DAC_MIXER:
  495. case RT5682S_A_DAC1_MUX:
  496. case RT5682S_DIG_INF2_DATA:
  497. case RT5682S_REC_MIXER:
  498. case RT5682S_CAL_REC:
  499. case RT5682S_HP_ANA_OST_CTRL_1...RT5682S_HP_ANA_OST_CTRL_3:
  500. case RT5682S_PWR_DIG_1...RT5682S_PWR_MIXER:
  501. case RT5682S_MB_CTRL:
  502. case RT5682S_CLK_GATE_TCON_1...RT5682S_CLK_GATE_TCON_3:
  503. case RT5682S_CLK_DET...RT5682S_LPF_AD_DMIC:
  504. case RT5682S_I2S1_SDP:
  505. case RT5682S_I2S2_SDP:
  506. case RT5682S_ADDA_CLK_1:
  507. case RT5682S_ADDA_CLK_2:
  508. case RT5682S_I2S1_F_DIV_CTRL_1:
  509. case RT5682S_I2S1_F_DIV_CTRL_2:
  510. case RT5682S_TDM_CTRL:
  511. case RT5682S_TDM_ADDA_CTRL_1:
  512. case RT5682S_TDM_ADDA_CTRL_2:
  513. case RT5682S_DATA_SEL_CTRL_1:
  514. case RT5682S_TDM_TCON_CTRL_1:
  515. case RT5682S_TDM_TCON_CTRL_2:
  516. case RT5682S_GLB_CLK:
  517. case RT5682S_PLL_TRACK_1...RT5682S_PLL_TRACK_6:
  518. case RT5682S_PLL_TRACK_11:
  519. case RT5682S_DEPOP_1:
  520. case RT5682S_HP_CHARGE_PUMP_1:
  521. case RT5682S_HP_CHARGE_PUMP_2:
  522. case RT5682S_HP_CHARGE_PUMP_3:
  523. case RT5682S_MICBIAS_1...RT5682S_MICBIAS_3:
  524. case RT5682S_PLL_TRACK_12...RT5682S_PLL_CTRL_7:
  525. case RT5682S_RC_CLK_CTRL:
  526. case RT5682S_I2S2_M_CLK_CTRL_1:
  527. case RT5682S_I2S2_F_DIV_CTRL_1:
  528. case RT5682S_I2S2_F_DIV_CTRL_2:
  529. case RT5682S_IRQ_CTRL_1...RT5682S_IRQ_CTRL_4:
  530. case RT5682S_INT_ST_1:
  531. case RT5682S_GPIO_CTRL_1:
  532. case RT5682S_GPIO_CTRL_2:
  533. case RT5682S_GPIO_ST:
  534. case RT5682S_HP_AMP_DET_CTRL_1:
  535. case RT5682S_MID_HP_AMP_DET:
  536. case RT5682S_LOW_HP_AMP_DET:
  537. case RT5682S_DELAY_BUF_CTRL:
  538. case RT5682S_SV_ZCD_1:
  539. case RT5682S_SV_ZCD_2:
  540. case RT5682S_IL_CMD_1...RT5682S_IL_CMD_6:
  541. case RT5682S_4BTN_IL_CMD_1...RT5682S_4BTN_IL_CMD_7:
  542. case RT5682S_ADC_STO1_HP_CTRL_1:
  543. case RT5682S_ADC_STO1_HP_CTRL_2:
  544. case RT5682S_AJD1_CTRL:
  545. case RT5682S_JD_CTRL_1:
  546. case RT5682S_DUMMY_1...RT5682S_DUMMY_3:
  547. case RT5682S_DAC_ADC_DIG_VOL1:
  548. case RT5682S_BIAS_CUR_CTRL_2...RT5682S_BIAS_CUR_CTRL_10:
  549. case RT5682S_VREF_REC_OP_FB_CAP_CTRL_1:
  550. case RT5682S_VREF_REC_OP_FB_CAP_CTRL_2:
  551. case RT5682S_CHARGE_PUMP_1:
  552. case RT5682S_DIG_IN_CTRL_1:
  553. case RT5682S_PAD_DRIVING_CTRL:
  554. case RT5682S_CHOP_DAC_1:
  555. case RT5682S_CHOP_DAC_2:
  556. case RT5682S_CHOP_ADC:
  557. case RT5682S_CALIB_ADC_CTRL:
  558. case RT5682S_VOL_TEST:
  559. case RT5682S_SPKVDD_DET_ST:
  560. case RT5682S_TEST_MODE_CTRL_1...RT5682S_TEST_MODE_CTRL_4:
  561. case RT5682S_PLL_INTERNAL_1...RT5682S_PLL_INTERNAL_4:
  562. case RT5682S_STO_NG2_CTRL_1...RT5682S_STO_NG2_CTRL_10:
  563. case RT5682S_STO1_DAC_SIL_DET:
  564. case RT5682S_SIL_PSV_CTRL1:
  565. case RT5682S_SIL_PSV_CTRL2:
  566. case RT5682S_SIL_PSV_CTRL3:
  567. case RT5682S_SIL_PSV_CTRL4:
  568. case RT5682S_SIL_PSV_CTRL5:
  569. case RT5682S_HP_IMP_SENS_CTRL_1...RT5682S_HP_IMP_SENS_CTRL_46:
  570. case RT5682S_HP_LOGIC_CTRL_1...RT5682S_HP_LOGIC_CTRL_3:
  571. case RT5682S_HP_CALIB_CTRL_1...RT5682S_HP_CALIB_CTRL_11:
  572. case RT5682S_HP_CALIB_ST_1...RT5682S_HP_CALIB_ST_11:
  573. case RT5682S_SAR_IL_CMD_1...RT5682S_SAR_IL_CMD_14:
  574. case RT5682S_DUMMY_4...RT5682S_DUMMY_6:
  575. case RT5682S_VERSION_ID_HIDE:
  576. case RT5682S_VERSION_ID_CUS:
  577. case RT5682S_SCAN_CTL:
  578. case RT5682S_HP_AMP_DET:
  579. case RT5682S_BIAS_CUR_CTRL_11:
  580. case RT5682S_BIAS_CUR_CTRL_12:
  581. case RT5682S_BIAS_CUR_CTRL_13:
  582. case RT5682S_BIAS_CUR_CTRL_14:
  583. case RT5682S_BIAS_CUR_CTRL_15:
  584. case RT5682S_BIAS_CUR_CTRL_16:
  585. case RT5682S_BIAS_CUR_CTRL_17:
  586. case RT5682S_BIAS_CUR_CTRL_18:
  587. case RT5682S_I2C_TRANS_CTRL:
  588. case RT5682S_DUMMY_7:
  589. case RT5682S_DUMMY_8:
  590. case RT5682S_DMIC_FLOAT_DET:
  591. case RT5682S_HA_CMP_OP_1...RT5682S_HA_CMP_OP_13:
  592. case RT5682S_HA_CMP_OP_14...RT5682S_HA_CMP_OP_25:
  593. case RT5682S_NEW_CBJ_DET_CTL_1...RT5682S_NEW_CBJ_DET_CTL_16:
  594. case RT5682S_DA_FILTER_1...RT5682S_DA_FILTER_5:
  595. case RT5682S_CLK_SW_TEST_1:
  596. case RT5682S_CLK_SW_TEST_2:
  597. case RT5682S_CLK_SW_TEST_3...RT5682S_CLK_SW_TEST_14:
  598. case RT5682S_EFUSE_MANU_WRITE_1...RT5682S_EFUSE_MANU_WRITE_6:
  599. case RT5682S_EFUSE_READ_1...RT5682S_EFUSE_READ_18:
  600. case RT5682S_EFUSE_TIMING_CTL_1:
  601. case RT5682S_EFUSE_TIMING_CTL_2:
  602. case RT5682S_PILOT_DIG_CTL_1:
  603. case RT5682S_PILOT_DIG_CTL_2:
  604. case RT5682S_HP_AMP_DET_CTL_1...RT5682S_HP_AMP_DET_CTL_4:
  605. return true;
  606. default:
  607. return false;
  608. }
  609. }
  610. static void rt5682s_reset(struct rt5682s_priv *rt5682s)
  611. {
  612. regmap_write(rt5682s->regmap, RT5682S_RESET, 0);
  613. }
  614. static int rt5682s_button_detect(struct snd_soc_component *component)
  615. {
  616. int btn_type, val;
  617. val = snd_soc_component_read(component, RT5682S_4BTN_IL_CMD_1);
  618. btn_type = val & 0xfff0;
  619. snd_soc_component_write(component, RT5682S_4BTN_IL_CMD_1, val);
  620. dev_dbg(component->dev, "%s btn_type=%x\n", __func__, btn_type);
  621. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_2,
  622. RT5682S_SAR_ADC_PSV_MASK, RT5682S_SAR_ADC_PSV_ENTRY);
  623. return btn_type;
  624. }
  625. enum {
  626. SAR_PWR_OFF,
  627. SAR_PWR_NORMAL,
  628. SAR_PWR_SAVING,
  629. };
  630. static void rt5682s_sar_power_mode(struct snd_soc_component *component, int mode)
  631. {
  632. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  633. mutex_lock(&rt5682s->sar_mutex);
  634. switch (mode) {
  635. case SAR_PWR_SAVING:
  636. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_3,
  637. RT5682S_CBJ_IN_BUF_MASK, RT5682S_CBJ_IN_BUF_DIS);
  638. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  639. RT5682S_MB1_PATH_MASK | RT5682S_MB2_PATH_MASK,
  640. RT5682S_CTRL_MB1_REG | RT5682S_CTRL_MB2_REG);
  641. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  642. RT5682S_SAR_BUTDET_MASK | RT5682S_SAR_BUTDET_POW_MASK |
  643. RT5682S_SAR_SEL_MB1_2_CTL_MASK, RT5682S_SAR_BUTDET_DIS |
  644. RT5682S_SAR_BUTDET_POW_SAV | RT5682S_SAR_SEL_MB1_2_MANU);
  645. usleep_range(5000, 5500);
  646. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  647. RT5682S_SAR_BUTDET_MASK, RT5682S_SAR_BUTDET_EN);
  648. usleep_range(5000, 5500);
  649. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_2,
  650. RT5682S_SAR_ADC_PSV_MASK, RT5682S_SAR_ADC_PSV_ENTRY);
  651. break;
  652. case SAR_PWR_NORMAL:
  653. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_3,
  654. RT5682S_CBJ_IN_BUF_MASK, RT5682S_CBJ_IN_BUF_EN);
  655. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  656. RT5682S_MB1_PATH_MASK | RT5682S_MB2_PATH_MASK,
  657. RT5682S_CTRL_MB1_FSM | RT5682S_CTRL_MB2_FSM);
  658. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  659. RT5682S_SAR_SEL_MB1_2_CTL_MASK, RT5682S_SAR_SEL_MB1_2_AUTO);
  660. usleep_range(5000, 5500);
  661. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  662. RT5682S_SAR_BUTDET_MASK | RT5682S_SAR_BUTDET_POW_MASK,
  663. RT5682S_SAR_BUTDET_EN | RT5682S_SAR_BUTDET_POW_NORM);
  664. break;
  665. case SAR_PWR_OFF:
  666. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  667. RT5682S_MB1_PATH_MASK | RT5682S_MB2_PATH_MASK,
  668. RT5682S_CTRL_MB1_FSM | RT5682S_CTRL_MB2_FSM);
  669. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  670. RT5682S_SAR_BUTDET_MASK | RT5682S_SAR_BUTDET_POW_MASK |
  671. RT5682S_SAR_SEL_MB1_2_CTL_MASK, RT5682S_SAR_BUTDET_DIS |
  672. RT5682S_SAR_BUTDET_POW_SAV | RT5682S_SAR_SEL_MB1_2_MANU);
  673. break;
  674. default:
  675. dev_err(component->dev, "Invalid SAR Power mode: %d\n", mode);
  676. break;
  677. }
  678. mutex_unlock(&rt5682s->sar_mutex);
  679. }
  680. static void rt5682s_enable_push_button_irq(struct snd_soc_component *component)
  681. {
  682. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_13,
  683. RT5682S_SAR_SOUR_MASK, RT5682S_SAR_SOUR_BTN);
  684. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  685. RT5682S_SAR_BUTDET_MASK | RT5682S_SAR_BUTDET_POW_MASK |
  686. RT5682S_SAR_SEL_MB1_2_CTL_MASK, RT5682S_SAR_BUTDET_EN |
  687. RT5682S_SAR_BUTDET_POW_NORM | RT5682S_SAR_SEL_MB1_2_AUTO);
  688. snd_soc_component_write(component, RT5682S_IL_CMD_1, 0x0040);
  689. snd_soc_component_update_bits(component, RT5682S_4BTN_IL_CMD_2,
  690. RT5682S_4BTN_IL_MASK | RT5682S_4BTN_IL_RST_MASK,
  691. RT5682S_4BTN_IL_EN | RT5682S_4BTN_IL_NOR);
  692. snd_soc_component_update_bits(component, RT5682S_IRQ_CTRL_3,
  693. RT5682S_IL_IRQ_MASK, RT5682S_IL_IRQ_EN);
  694. }
  695. static void rt5682s_disable_push_button_irq(struct snd_soc_component *component)
  696. {
  697. snd_soc_component_update_bits(component, RT5682S_IRQ_CTRL_3,
  698. RT5682S_IL_IRQ_MASK, RT5682S_IL_IRQ_DIS);
  699. snd_soc_component_update_bits(component, RT5682S_4BTN_IL_CMD_2,
  700. RT5682S_4BTN_IL_MASK, RT5682S_4BTN_IL_DIS);
  701. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_13,
  702. RT5682S_SAR_SOUR_MASK, RT5682S_SAR_SOUR_TYPE);
  703. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  704. RT5682S_SAR_BUTDET_MASK | RT5682S_SAR_BUTDET_POW_MASK |
  705. RT5682S_SAR_SEL_MB1_2_CTL_MASK, RT5682S_SAR_BUTDET_DIS |
  706. RT5682S_SAR_BUTDET_POW_SAV | RT5682S_SAR_SEL_MB1_2_MANU);
  707. }
  708. /**
  709. * rt5682s_headset_detect - Detect headset.
  710. * @component: SoC audio component device.
  711. * @jack_insert: Jack insert or not.
  712. *
  713. * Detect whether is headset or not when jack inserted.
  714. *
  715. * Returns detect status.
  716. */
  717. static int rt5682s_headset_detect(struct snd_soc_component *component, int jack_insert)
  718. {
  719. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  720. unsigned int val, count;
  721. int jack_type = 0;
  722. if (jack_insert) {
  723. rt5682s_disable_push_button_irq(component);
  724. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  725. RT5682S_PWR_VREF1 | RT5682S_PWR_VREF2 | RT5682S_PWR_MB,
  726. RT5682S_PWR_VREF1 | RT5682S_PWR_VREF2 | RT5682S_PWR_MB);
  727. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  728. RT5682S_PWR_FV1 | RT5682S_PWR_FV2, 0);
  729. usleep_range(15000, 20000);
  730. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  731. RT5682S_PWR_FV1 | RT5682S_PWR_FV2,
  732. RT5682S_PWR_FV1 | RT5682S_PWR_FV2);
  733. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_3,
  734. RT5682S_PWR_CBJ, RT5682S_PWR_CBJ);
  735. snd_soc_component_write(component, RT5682S_SAR_IL_CMD_3, 0x0365);
  736. snd_soc_component_update_bits(component, RT5682S_HP_CHARGE_PUMP_2,
  737. RT5682S_OSW_L_MASK | RT5682S_OSW_R_MASK,
  738. RT5682S_OSW_L_DIS | RT5682S_OSW_R_DIS);
  739. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_13,
  740. RT5682S_SAR_SOUR_MASK, RT5682S_SAR_SOUR_TYPE);
  741. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_3,
  742. RT5682S_CBJ_IN_BUF_MASK, RT5682S_CBJ_IN_BUF_EN);
  743. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  744. RT5682S_TRIG_JD_MASK, RT5682S_TRIG_JD_LOW);
  745. usleep_range(45000, 50000);
  746. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  747. RT5682S_TRIG_JD_MASK, RT5682S_TRIG_JD_HIGH);
  748. count = 0;
  749. do {
  750. usleep_range(10000, 15000);
  751. val = snd_soc_component_read(component, RT5682S_CBJ_CTRL_2)
  752. & RT5682S_JACK_TYPE_MASK;
  753. count++;
  754. } while (val == 0 && count < 50);
  755. dev_dbg(component->dev, "%s, val=%d, count=%d\n", __func__, val, count);
  756. switch (val) {
  757. case 0x1:
  758. case 0x2:
  759. jack_type = SND_JACK_HEADSET;
  760. snd_soc_component_write(component, RT5682S_SAR_IL_CMD_3, 0x024c);
  761. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  762. RT5682S_FAST_OFF_MASK, RT5682S_FAST_OFF_EN);
  763. snd_soc_component_update_bits(component, RT5682S_SAR_IL_CMD_1,
  764. RT5682S_SAR_SEL_MB1_2_MASK, val << RT5682S_SAR_SEL_MB1_2_SFT);
  765. rt5682s_enable_push_button_irq(component);
  766. rt5682s_sar_power_mode(component, SAR_PWR_SAVING);
  767. break;
  768. default:
  769. jack_type = SND_JACK_HEADPHONE;
  770. break;
  771. }
  772. snd_soc_component_update_bits(component, RT5682S_HP_CHARGE_PUMP_2,
  773. RT5682S_OSW_L_MASK | RT5682S_OSW_R_MASK,
  774. RT5682S_OSW_L_EN | RT5682S_OSW_R_EN);
  775. usleep_range(35000, 40000);
  776. } else {
  777. rt5682s_sar_power_mode(component, SAR_PWR_OFF);
  778. rt5682s_disable_push_button_irq(component);
  779. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  780. RT5682S_TRIG_JD_MASK, RT5682S_TRIG_JD_LOW);
  781. if (!rt5682s->wclk_enabled) {
  782. snd_soc_component_update_bits(component,
  783. RT5682S_PWR_ANLG_1, RT5682S_PWR_VREF2 | RT5682S_PWR_MB, 0);
  784. }
  785. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_3,
  786. RT5682S_PWR_CBJ, 0);
  787. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_1,
  788. RT5682S_FAST_OFF_MASK, RT5682S_FAST_OFF_DIS);
  789. snd_soc_component_update_bits(component, RT5682S_CBJ_CTRL_3,
  790. RT5682S_CBJ_IN_BUF_MASK, RT5682S_CBJ_IN_BUF_DIS);
  791. jack_type = 0;
  792. }
  793. dev_dbg(component->dev, "jack_type = %d\n", jack_type);
  794. return jack_type;
  795. }
  796. static void rt5682s_jack_detect_handler(struct work_struct *work)
  797. {
  798. struct rt5682s_priv *rt5682s =
  799. container_of(work, struct rt5682s_priv, jack_detect_work.work);
  800. struct snd_soc_dapm_context *dapm;
  801. int val, btn_type;
  802. if (!rt5682s->component || !rt5682s->component->card ||
  803. !rt5682s->component->card->instantiated) {
  804. /* card not yet ready, try later */
  805. mod_delayed_work(system_power_efficient_wq,
  806. &rt5682s->jack_detect_work, msecs_to_jiffies(15));
  807. return;
  808. }
  809. dapm = snd_soc_component_get_dapm(rt5682s->component);
  810. snd_soc_dapm_mutex_lock(dapm);
  811. mutex_lock(&rt5682s->calibrate_mutex);
  812. mutex_lock(&rt5682s->wclk_mutex);
  813. val = snd_soc_component_read(rt5682s->component, RT5682S_AJD1_CTRL)
  814. & RT5682S_JDH_RS_MASK;
  815. if (!val) {
  816. /* jack in */
  817. if (rt5682s->jack_type == 0) {
  818. /* jack was out, report jack type */
  819. rt5682s->jack_type = rt5682s_headset_detect(rt5682s->component, 1);
  820. rt5682s->irq_work_delay_time = 0;
  821. } else if ((rt5682s->jack_type & SND_JACK_HEADSET) == SND_JACK_HEADSET) {
  822. /* jack is already in, report button event */
  823. rt5682s->jack_type = SND_JACK_HEADSET;
  824. btn_type = rt5682s_button_detect(rt5682s->component);
  825. /**
  826. * rt5682s can report three kinds of button behavior,
  827. * one click, double click and hold. However,
  828. * currently we will report button pressed/released
  829. * event. So all the three button behaviors are
  830. * treated as button pressed.
  831. */
  832. switch (btn_type) {
  833. case 0x8000:
  834. case 0x4000:
  835. case 0x2000:
  836. rt5682s->jack_type |= SND_JACK_BTN_0;
  837. break;
  838. case 0x1000:
  839. case 0x0800:
  840. case 0x0400:
  841. rt5682s->jack_type |= SND_JACK_BTN_1;
  842. break;
  843. case 0x0200:
  844. case 0x0100:
  845. case 0x0080:
  846. rt5682s->jack_type |= SND_JACK_BTN_2;
  847. break;
  848. case 0x0040:
  849. case 0x0020:
  850. case 0x0010:
  851. rt5682s->jack_type |= SND_JACK_BTN_3;
  852. break;
  853. case 0x0000: /* unpressed */
  854. break;
  855. default:
  856. dev_err(rt5682s->component->dev,
  857. "Unexpected button code 0x%04x\n", btn_type);
  858. break;
  859. }
  860. }
  861. } else {
  862. /* jack out */
  863. rt5682s->jack_type = rt5682s_headset_detect(rt5682s->component, 0);
  864. rt5682s->irq_work_delay_time = 50;
  865. }
  866. mutex_unlock(&rt5682s->wclk_mutex);
  867. mutex_unlock(&rt5682s->calibrate_mutex);
  868. snd_soc_dapm_mutex_unlock(dapm);
  869. snd_soc_jack_report(rt5682s->hs_jack, rt5682s->jack_type,
  870. SND_JACK_HEADSET | SND_JACK_BTN_0 | SND_JACK_BTN_1 |
  871. SND_JACK_BTN_2 | SND_JACK_BTN_3);
  872. if (rt5682s->jack_type & (SND_JACK_BTN_0 | SND_JACK_BTN_1 |
  873. SND_JACK_BTN_2 | SND_JACK_BTN_3))
  874. schedule_delayed_work(&rt5682s->jd_check_work, 0);
  875. else
  876. cancel_delayed_work_sync(&rt5682s->jd_check_work);
  877. }
  878. static void rt5682s_jd_check_handler(struct work_struct *work)
  879. {
  880. struct rt5682s_priv *rt5682s =
  881. container_of(work, struct rt5682s_priv, jd_check_work.work);
  882. if (snd_soc_component_read(rt5682s->component, RT5682S_AJD1_CTRL) & RT5682S_JDH_RS_MASK) {
  883. /* jack out */
  884. schedule_delayed_work(&rt5682s->jack_detect_work, 0);
  885. } else {
  886. schedule_delayed_work(&rt5682s->jd_check_work, 500);
  887. }
  888. }
  889. static irqreturn_t rt5682s_irq(int irq, void *data)
  890. {
  891. struct rt5682s_priv *rt5682s = data;
  892. mod_delayed_work(system_power_efficient_wq, &rt5682s->jack_detect_work,
  893. msecs_to_jiffies(rt5682s->irq_work_delay_time));
  894. return IRQ_HANDLED;
  895. }
  896. static int rt5682s_set_jack_detect(struct snd_soc_component *component,
  897. struct snd_soc_jack *hs_jack, void *data)
  898. {
  899. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  900. int btndet_delay = 16;
  901. rt5682s->hs_jack = hs_jack;
  902. if (!hs_jack) {
  903. regmap_update_bits(rt5682s->regmap, RT5682S_IRQ_CTRL_2,
  904. RT5682S_JD1_EN_MASK, RT5682S_JD1_DIS);
  905. regmap_update_bits(rt5682s->regmap, RT5682S_RC_CLK_CTRL,
  906. RT5682S_POW_JDH, 0);
  907. cancel_delayed_work_sync(&rt5682s->jack_detect_work);
  908. return 0;
  909. }
  910. switch (rt5682s->pdata.jd_src) {
  911. case RT5682S_JD1:
  912. regmap_update_bits(rt5682s->regmap, RT5682S_CBJ_CTRL_5,
  913. RT5682S_JD_FAST_OFF_SRC_MASK, RT5682S_JD_FAST_OFF_SRC_JDH);
  914. regmap_update_bits(rt5682s->regmap, RT5682S_CBJ_CTRL_2,
  915. RT5682S_EXT_JD_SRC, RT5682S_EXT_JD_SRC_MANUAL);
  916. regmap_update_bits(rt5682s->regmap, RT5682S_CBJ_CTRL_1,
  917. RT5682S_EMB_JD_MASK | RT5682S_DET_TYPE |
  918. RT5682S_POL_FAST_OFF_MASK | RT5682S_MIC_CAP_MASK,
  919. RT5682S_EMB_JD_EN | RT5682S_DET_TYPE |
  920. RT5682S_POL_FAST_OFF_HIGH | RT5682S_MIC_CAP_HS);
  921. regmap_update_bits(rt5682s->regmap, RT5682S_SAR_IL_CMD_1,
  922. RT5682S_SAR_POW_MASK, RT5682S_SAR_POW_EN);
  923. regmap_update_bits(rt5682s->regmap, RT5682S_GPIO_CTRL_1,
  924. RT5682S_GP1_PIN_MASK, RT5682S_GP1_PIN_IRQ);
  925. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_ANLG_3,
  926. RT5682S_PWR_BGLDO, RT5682S_PWR_BGLDO);
  927. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_ANLG_2,
  928. RT5682S_PWR_JD_MASK, RT5682S_PWR_JD_ENABLE);
  929. regmap_update_bits(rt5682s->regmap, RT5682S_RC_CLK_CTRL,
  930. RT5682S_POW_IRQ | RT5682S_POW_JDH, RT5682S_POW_IRQ | RT5682S_POW_JDH);
  931. regmap_update_bits(rt5682s->regmap, RT5682S_IRQ_CTRL_2,
  932. RT5682S_JD1_EN_MASK | RT5682S_JD1_POL_MASK,
  933. RT5682S_JD1_EN | RT5682S_JD1_POL_NOR);
  934. regmap_update_bits(rt5682s->regmap, RT5682S_4BTN_IL_CMD_4,
  935. RT5682S_4BTN_IL_HOLD_WIN_MASK | RT5682S_4BTN_IL_CLICK_WIN_MASK,
  936. (btndet_delay << RT5682S_4BTN_IL_HOLD_WIN_SFT | btndet_delay));
  937. regmap_update_bits(rt5682s->regmap, RT5682S_4BTN_IL_CMD_5,
  938. RT5682S_4BTN_IL_HOLD_WIN_MASK | RT5682S_4BTN_IL_CLICK_WIN_MASK,
  939. (btndet_delay << RT5682S_4BTN_IL_HOLD_WIN_SFT | btndet_delay));
  940. regmap_update_bits(rt5682s->regmap, RT5682S_4BTN_IL_CMD_6,
  941. RT5682S_4BTN_IL_HOLD_WIN_MASK | RT5682S_4BTN_IL_CLICK_WIN_MASK,
  942. (btndet_delay << RT5682S_4BTN_IL_HOLD_WIN_SFT | btndet_delay));
  943. regmap_update_bits(rt5682s->regmap, RT5682S_4BTN_IL_CMD_7,
  944. RT5682S_4BTN_IL_HOLD_WIN_MASK | RT5682S_4BTN_IL_CLICK_WIN_MASK,
  945. (btndet_delay << RT5682S_4BTN_IL_HOLD_WIN_SFT | btndet_delay));
  946. mod_delayed_work(system_power_efficient_wq,
  947. &rt5682s->jack_detect_work, msecs_to_jiffies(250));
  948. break;
  949. case RT5682S_JD_NULL:
  950. regmap_update_bits(rt5682s->regmap, RT5682S_IRQ_CTRL_2,
  951. RT5682S_JD1_EN_MASK, RT5682S_JD1_DIS);
  952. regmap_update_bits(rt5682s->regmap, RT5682S_RC_CLK_CTRL,
  953. RT5682S_POW_JDH, 0);
  954. break;
  955. default:
  956. dev_warn(component->dev, "Wrong JD source\n");
  957. break;
  958. }
  959. return 0;
  960. }
  961. static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -9562, 75, 0);
  962. static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -1725, 75, 0);
  963. static const DECLARE_TLV_DB_SCALE(adc_bst_tlv, 0, 1200, 0);
  964. static const DECLARE_TLV_DB_SCALE(cbj_bst_tlv, -1200, 150, 0);
  965. static const struct snd_kcontrol_new rt5682s_snd_controls[] = {
  966. /* DAC Digital Volume */
  967. SOC_DOUBLE_TLV("DAC1 Playback Volume", RT5682S_DAC1_DIG_VOL,
  968. RT5682S_L_VOL_SFT + 1, RT5682S_R_VOL_SFT + 1, 127, 0, dac_vol_tlv),
  969. /* CBJ Boost Volume */
  970. SOC_SINGLE_TLV("CBJ Boost Volume", RT5682S_REC_MIXER,
  971. RT5682S_BST_CBJ_SFT, 35, 0, cbj_bst_tlv),
  972. /* ADC Digital Volume Control */
  973. SOC_DOUBLE("STO1 ADC Capture Switch", RT5682S_STO1_ADC_DIG_VOL,
  974. RT5682S_L_MUTE_SFT, RT5682S_R_MUTE_SFT, 1, 1),
  975. SOC_DOUBLE_TLV("STO1 ADC Capture Volume", RT5682S_STO1_ADC_DIG_VOL,
  976. RT5682S_L_VOL_SFT + 1, RT5682S_R_VOL_SFT + 1, 63, 0, adc_vol_tlv),
  977. /* ADC Boost Volume Control */
  978. SOC_DOUBLE_TLV("STO1 ADC Boost Gain Volume", RT5682S_STO1_ADC_BOOST,
  979. RT5682S_STO1_ADC_L_BST_SFT, RT5682S_STO1_ADC_R_BST_SFT, 3, 0, adc_bst_tlv),
  980. };
  981. /**
  982. * rt5682s_sel_asrc_clk_src - select ASRC clock source for a set of filters
  983. * @component: SoC audio component device.
  984. * @filter_mask: mask of filters.
  985. * @clk_src: clock source
  986. *
  987. * The ASRC function is for asynchronous MCLK and LRCK. Also, since RT5682S can
  988. * only support standard 32fs or 64fs i2s format, ASRC should be enabled to
  989. * support special i2s clock format such as Intel's 100fs(100 * sampling rate).
  990. * ASRC function will track i2s clock and generate a corresponding system clock
  991. * for codec. This function provides an API to select the clock source for a
  992. * set of filters specified by the mask. And the component driver will turn on
  993. * ASRC for these filters if ASRC is selected as their clock source.
  994. */
  995. int rt5682s_sel_asrc_clk_src(struct snd_soc_component *component,
  996. unsigned int filter_mask, unsigned int clk_src)
  997. {
  998. switch (clk_src) {
  999. case RT5682S_CLK_SEL_SYS:
  1000. case RT5682S_CLK_SEL_I2S1_ASRC:
  1001. case RT5682S_CLK_SEL_I2S2_ASRC:
  1002. break;
  1003. default:
  1004. return -EINVAL;
  1005. }
  1006. if (filter_mask & RT5682S_DA_STEREO1_FILTER) {
  1007. snd_soc_component_update_bits(component, RT5682S_PLL_TRACK_2,
  1008. RT5682S_FILTER_CLK_SEL_MASK, clk_src << RT5682S_FILTER_CLK_SEL_SFT);
  1009. }
  1010. if (filter_mask & RT5682S_AD_STEREO1_FILTER) {
  1011. snd_soc_component_update_bits(component, RT5682S_PLL_TRACK_3,
  1012. RT5682S_FILTER_CLK_SEL_MASK, clk_src << RT5682S_FILTER_CLK_SEL_SFT);
  1013. }
  1014. snd_soc_component_update_bits(component, RT5682S_PLL_TRACK_11,
  1015. RT5682S_ASRCIN_AUTO_CLKOUT_MASK, RT5682S_ASRCIN_AUTO_CLKOUT_EN);
  1016. return 0;
  1017. }
  1018. EXPORT_SYMBOL_GPL(rt5682s_sel_asrc_clk_src);
  1019. static int rt5682s_div_sel(struct rt5682s_priv *rt5682s,
  1020. int target, const int div[], int size)
  1021. {
  1022. int i;
  1023. if (rt5682s->sysclk < target) {
  1024. dev_err(rt5682s->component->dev,
  1025. "sysclk rate %d is too low\n", rt5682s->sysclk);
  1026. return 0;
  1027. }
  1028. for (i = 0; i < size - 1; i++) {
  1029. dev_dbg(rt5682s->component->dev, "div[%d]=%d\n", i, div[i]);
  1030. if (target * div[i] == rt5682s->sysclk)
  1031. return i;
  1032. if (target * div[i + 1] > rt5682s->sysclk) {
  1033. dev_dbg(rt5682s->component->dev,
  1034. "can't find div for sysclk %d\n", rt5682s->sysclk);
  1035. return i;
  1036. }
  1037. }
  1038. if (target * div[i] < rt5682s->sysclk)
  1039. dev_err(rt5682s->component->dev,
  1040. "sysclk rate %d is too high\n", rt5682s->sysclk);
  1041. return size - 1;
  1042. }
  1043. static int get_clk_info(int sclk, int rate)
  1044. {
  1045. int i;
  1046. static const int pd[] = {1, 2, 3, 4, 6, 8, 12, 16, 24, 32, 48};
  1047. if (sclk <= 0 || rate <= 0)
  1048. return -EINVAL;
  1049. rate = rate << 8;
  1050. for (i = 0; i < ARRAY_SIZE(pd); i++)
  1051. if (sclk == rate * pd[i])
  1052. return i;
  1053. return -EINVAL;
  1054. }
  1055. /**
  1056. * set_dmic_clk - Set parameter of dmic.
  1057. *
  1058. * @w: DAPM widget.
  1059. * @kcontrol: The kcontrol of this widget.
  1060. * @event: Event id.
  1061. *
  1062. * Choose dmic clock between 1MHz and 3MHz.
  1063. * It is better for clock to approximate 3MHz.
  1064. */
  1065. static int set_dmic_clk(struct snd_soc_dapm_widget *w,
  1066. struct snd_kcontrol *kcontrol, int event)
  1067. {
  1068. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1069. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1070. int idx, dmic_clk_rate = 3072000;
  1071. static const int div[] = {2, 4, 6, 8, 12, 16, 24, 32, 48, 64, 96, 128};
  1072. if (rt5682s->pdata.dmic_clk_rate)
  1073. dmic_clk_rate = rt5682s->pdata.dmic_clk_rate;
  1074. idx = rt5682s_div_sel(rt5682s, dmic_clk_rate, div, ARRAY_SIZE(div));
  1075. snd_soc_component_update_bits(component, RT5682S_DMIC_CTRL_1,
  1076. RT5682S_DMIC_CLK_MASK, idx << RT5682S_DMIC_CLK_SFT);
  1077. return 0;
  1078. }
  1079. static int rt5682s_set_pllb_power(struct rt5682s_priv *rt5682s, int on)
  1080. {
  1081. struct snd_soc_component *component = rt5682s->component;
  1082. if (on) {
  1083. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_3,
  1084. RT5682S_PWR_LDO_PLLB | RT5682S_PWR_BIAS_PLLB | RT5682S_PWR_PLLB,
  1085. RT5682S_PWR_LDO_PLLB | RT5682S_PWR_BIAS_PLLB | RT5682S_PWR_PLLB);
  1086. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_3,
  1087. RT5682S_RSTB_PLLB, RT5682S_RSTB_PLLB);
  1088. } else {
  1089. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_3,
  1090. RT5682S_PWR_LDO_PLLB | RT5682S_PWR_BIAS_PLLB |
  1091. RT5682S_RSTB_PLLB | RT5682S_PWR_PLLB, 0);
  1092. }
  1093. return 0;
  1094. }
  1095. static int set_pllb_event(struct snd_soc_dapm_widget *w,
  1096. struct snd_kcontrol *kcontrol, int event)
  1097. {
  1098. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1099. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1100. int on = 0;
  1101. if (rt5682s->wclk_enabled)
  1102. return 0;
  1103. if (SND_SOC_DAPM_EVENT_ON(event))
  1104. on = 1;
  1105. rt5682s_set_pllb_power(rt5682s, on);
  1106. return 0;
  1107. }
  1108. static void rt5682s_set_filter_clk(struct rt5682s_priv *rt5682s, int reg, int ref)
  1109. {
  1110. struct snd_soc_component *component = rt5682s->component;
  1111. int idx;
  1112. static const int div_f[] = {1, 2, 3, 4, 6, 8, 12, 16, 24, 32, 48};
  1113. static const int div_o[] = {1, 2, 4, 6, 8, 12, 16, 24, 32, 48};
  1114. idx = rt5682s_div_sel(rt5682s, ref, div_f, ARRAY_SIZE(div_f));
  1115. snd_soc_component_update_bits(component, reg,
  1116. RT5682S_FILTER_CLK_DIV_MASK, idx << RT5682S_FILTER_CLK_DIV_SFT);
  1117. /* select over sample rate */
  1118. for (idx = 0; idx < ARRAY_SIZE(div_o); idx++) {
  1119. if (rt5682s->sysclk <= 12288000 * div_o[idx])
  1120. break;
  1121. }
  1122. snd_soc_component_update_bits(component, RT5682S_ADDA_CLK_1,
  1123. RT5682S_ADC_OSR_MASK | RT5682S_DAC_OSR_MASK,
  1124. (idx << RT5682S_ADC_OSR_SFT) | (idx << RT5682S_DAC_OSR_SFT));
  1125. }
  1126. static int set_filter_clk(struct snd_soc_dapm_widget *w,
  1127. struct snd_kcontrol *kcontrol, int event)
  1128. {
  1129. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1130. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1131. int ref, reg, val;
  1132. val = snd_soc_component_read(component, RT5682S_GPIO_CTRL_1)
  1133. & RT5682S_GP4_PIN_MASK;
  1134. if (w->shift == RT5682S_PWR_ADC_S1F_BIT && val == RT5682S_GP4_PIN_ADCDAT2)
  1135. ref = 256 * rt5682s->lrck[RT5682S_AIF2];
  1136. else
  1137. ref = 256 * rt5682s->lrck[RT5682S_AIF1];
  1138. if (w->shift == RT5682S_PWR_ADC_S1F_BIT)
  1139. reg = RT5682S_PLL_TRACK_3;
  1140. else
  1141. reg = RT5682S_PLL_TRACK_2;
  1142. rt5682s_set_filter_clk(rt5682s, reg, ref);
  1143. return 0;
  1144. }
  1145. static int set_dmic_power(struct snd_soc_dapm_widget *w,
  1146. struct snd_kcontrol *kcontrol, int event)
  1147. {
  1148. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1149. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1150. unsigned int delay = 50, val;
  1151. if (rt5682s->pdata.dmic_delay)
  1152. delay = rt5682s->pdata.dmic_delay;
  1153. switch (event) {
  1154. case SND_SOC_DAPM_POST_PMU:
  1155. val = (snd_soc_component_read(component, RT5682S_GLB_CLK)
  1156. & RT5682S_SCLK_SRC_MASK) >> RT5682S_SCLK_SRC_SFT;
  1157. if (val == RT5682S_CLK_SRC_PLL1 || val == RT5682S_CLK_SRC_PLL2)
  1158. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  1159. RT5682S_PWR_VREF2 | RT5682S_PWR_MB,
  1160. RT5682S_PWR_VREF2 | RT5682S_PWR_MB);
  1161. /*Add delay to avoid pop noise*/
  1162. msleep(delay);
  1163. break;
  1164. case SND_SOC_DAPM_POST_PMD:
  1165. if (!rt5682s->jack_type && !rt5682s->wclk_enabled) {
  1166. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  1167. RT5682S_PWR_VREF2 | RT5682S_PWR_MB, 0);
  1168. }
  1169. break;
  1170. }
  1171. return 0;
  1172. }
  1173. static void rt5682s_set_i2s(struct rt5682s_priv *rt5682s, int id, int on)
  1174. {
  1175. struct snd_soc_component *component = rt5682s->component;
  1176. int pre_div;
  1177. unsigned int p_reg, p_mask, p_sft;
  1178. unsigned int c_reg, c_mask, c_sft;
  1179. if (id == RT5682S_AIF1) {
  1180. c_reg = RT5682S_ADDA_CLK_1;
  1181. c_mask = RT5682S_I2S_M_D_MASK;
  1182. c_sft = RT5682S_I2S_M_D_SFT;
  1183. p_reg = RT5682S_PWR_DIG_1;
  1184. p_mask = RT5682S_PWR_I2S1;
  1185. p_sft = RT5682S_PWR_I2S1_BIT;
  1186. } else {
  1187. c_reg = RT5682S_I2S2_M_CLK_CTRL_1;
  1188. c_mask = RT5682S_I2S2_M_D_MASK;
  1189. c_sft = RT5682S_I2S2_M_D_SFT;
  1190. p_reg = RT5682S_PWR_DIG_1;
  1191. p_mask = RT5682S_PWR_I2S2;
  1192. p_sft = RT5682S_PWR_I2S2_BIT;
  1193. }
  1194. if (on && rt5682s->master[id]) {
  1195. pre_div = get_clk_info(rt5682s->sysclk, rt5682s->lrck[id]);
  1196. if (pre_div < 0) {
  1197. dev_err(component->dev, "get pre_div failed\n");
  1198. return;
  1199. }
  1200. dev_dbg(component->dev, "lrck is %dHz and pre_div is %d for iis %d master\n",
  1201. rt5682s->lrck[id], pre_div, id);
  1202. snd_soc_component_update_bits(component, c_reg, c_mask, pre_div << c_sft);
  1203. }
  1204. snd_soc_component_update_bits(component, p_reg, p_mask, on << p_sft);
  1205. }
  1206. static int set_i2s_event(struct snd_soc_dapm_widget *w,
  1207. struct snd_kcontrol *kcontrol, int event)
  1208. {
  1209. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1210. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1211. int on = 0;
  1212. if (SND_SOC_DAPM_EVENT_ON(event))
  1213. on = 1;
  1214. if (!strcmp(w->name, "I2S1") && !rt5682s->wclk_enabled)
  1215. rt5682s_set_i2s(rt5682s, RT5682S_AIF1, on);
  1216. else if (!strcmp(w->name, "I2S2"))
  1217. rt5682s_set_i2s(rt5682s, RT5682S_AIF2, on);
  1218. return 0;
  1219. }
  1220. static int is_sys_clk_from_plla(struct snd_soc_dapm_widget *w,
  1221. struct snd_soc_dapm_widget *sink)
  1222. {
  1223. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1224. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1225. if ((rt5682s->sysclk_src == RT5682S_CLK_SRC_PLL1) ||
  1226. (rt5682s->sysclk_src == RT5682S_CLK_SRC_PLL2 && rt5682s->pll_comb == USE_PLLAB))
  1227. return 1;
  1228. return 0;
  1229. }
  1230. static int is_sys_clk_from_pllb(struct snd_soc_dapm_widget *w,
  1231. struct snd_soc_dapm_widget *sink)
  1232. {
  1233. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1234. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1235. if (rt5682s->sysclk_src == RT5682S_CLK_SRC_PLL2)
  1236. return 1;
  1237. return 0;
  1238. }
  1239. static int is_using_asrc(struct snd_soc_dapm_widget *w,
  1240. struct snd_soc_dapm_widget *sink)
  1241. {
  1242. unsigned int reg, sft, val;
  1243. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1244. switch (w->shift) {
  1245. case RT5682S_ADC_STO1_ASRC_SFT:
  1246. reg = RT5682S_PLL_TRACK_3;
  1247. sft = RT5682S_FILTER_CLK_SEL_SFT;
  1248. break;
  1249. case RT5682S_DAC_STO1_ASRC_SFT:
  1250. reg = RT5682S_PLL_TRACK_2;
  1251. sft = RT5682S_FILTER_CLK_SEL_SFT;
  1252. break;
  1253. default:
  1254. return 0;
  1255. }
  1256. val = (snd_soc_component_read(component, reg) >> sft) & 0xf;
  1257. switch (val) {
  1258. case RT5682S_CLK_SEL_I2S1_ASRC:
  1259. case RT5682S_CLK_SEL_I2S2_ASRC:
  1260. return 1;
  1261. default:
  1262. return 0;
  1263. }
  1264. }
  1265. static int rt5682s_hp_amp_event(struct snd_soc_dapm_widget *w,
  1266. struct snd_kcontrol *kcontrol, int event)
  1267. {
  1268. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1269. switch (event) {
  1270. case SND_SOC_DAPM_POST_PMU:
  1271. snd_soc_component_update_bits(component, RT5682S_DEPOP_1,
  1272. RT5682S_OUT_HP_L_EN | RT5682S_OUT_HP_R_EN,
  1273. RT5682S_OUT_HP_L_EN | RT5682S_OUT_HP_R_EN);
  1274. usleep_range(15000, 20000);
  1275. snd_soc_component_update_bits(component, RT5682S_DEPOP_1,
  1276. RT5682S_LDO_PUMP_EN | RT5682S_PUMP_EN |
  1277. RT5682S_CAPLESS_L_EN | RT5682S_CAPLESS_R_EN,
  1278. RT5682S_LDO_PUMP_EN | RT5682S_PUMP_EN |
  1279. RT5682S_CAPLESS_L_EN | RT5682S_CAPLESS_R_EN);
  1280. snd_soc_component_write(component, RT5682S_BIAS_CUR_CTRL_11, 0x6666);
  1281. snd_soc_component_write(component, RT5682S_BIAS_CUR_CTRL_12, 0xa82a);
  1282. snd_soc_component_update_bits(component, RT5682S_HP_CTRL_2,
  1283. RT5682S_HPO_L_PATH_MASK | RT5682S_HPO_R_PATH_MASK |
  1284. RT5682S_HPO_SEL_IP_EN_SW, RT5682S_HPO_L_PATH_EN |
  1285. RT5682S_HPO_R_PATH_EN | RT5682S_HPO_IP_EN_GATING);
  1286. usleep_range(5000, 10000);
  1287. snd_soc_component_update_bits(component, RT5682S_HP_AMP_DET_CTL_1,
  1288. RT5682S_CP_SW_SIZE_MASK, RT5682S_CP_SW_SIZE_L | RT5682S_CP_SW_SIZE_S);
  1289. break;
  1290. case SND_SOC_DAPM_POST_PMD:
  1291. snd_soc_component_update_bits(component, RT5682S_HP_CTRL_2,
  1292. RT5682S_HPO_L_PATH_MASK | RT5682S_HPO_R_PATH_MASK |
  1293. RT5682S_HPO_SEL_IP_EN_SW, 0);
  1294. snd_soc_component_update_bits(component, RT5682S_HP_AMP_DET_CTL_1,
  1295. RT5682S_CP_SW_SIZE_MASK, RT5682S_CP_SW_SIZE_M);
  1296. snd_soc_component_update_bits(component, RT5682S_DEPOP_1,
  1297. RT5682S_LDO_PUMP_EN | RT5682S_PUMP_EN |
  1298. RT5682S_CAPLESS_L_EN | RT5682S_CAPLESS_R_EN, 0);
  1299. snd_soc_component_update_bits(component, RT5682S_DEPOP_1,
  1300. RT5682S_OUT_HP_L_EN | RT5682S_OUT_HP_R_EN, 0);
  1301. break;
  1302. }
  1303. return 0;
  1304. }
  1305. static int rt5682s_stereo1_adc_mixl_event(struct snd_soc_dapm_widget *w,
  1306. struct snd_kcontrol *kcontrol, int event)
  1307. {
  1308. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1309. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1310. unsigned int delay = 0;
  1311. if (rt5682s->pdata.amic_delay)
  1312. delay = rt5682s->pdata.amic_delay;
  1313. switch (event) {
  1314. case SND_SOC_DAPM_POST_PMU:
  1315. msleep(delay);
  1316. snd_soc_component_update_bits(component, RT5682S_STO1_ADC_DIG_VOL,
  1317. RT5682S_L_MUTE, 0);
  1318. break;
  1319. case SND_SOC_DAPM_PRE_PMD:
  1320. snd_soc_component_update_bits(component, RT5682S_STO1_ADC_DIG_VOL,
  1321. RT5682S_L_MUTE, RT5682S_L_MUTE);
  1322. break;
  1323. }
  1324. return 0;
  1325. }
  1326. static int sar_power_event(struct snd_soc_dapm_widget *w,
  1327. struct snd_kcontrol *kcontrol, int event)
  1328. {
  1329. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  1330. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1331. if ((rt5682s->jack_type & SND_JACK_HEADSET) != SND_JACK_HEADSET)
  1332. return 0;
  1333. switch (event) {
  1334. case SND_SOC_DAPM_PRE_PMU:
  1335. rt5682s_sar_power_mode(component, SAR_PWR_NORMAL);
  1336. break;
  1337. case SND_SOC_DAPM_POST_PMD:
  1338. rt5682s_sar_power_mode(component, SAR_PWR_SAVING);
  1339. break;
  1340. }
  1341. return 0;
  1342. }
  1343. /* Interface data select */
  1344. static const char * const rt5682s_data_select[] = {
  1345. "L/R", "R/L", "L/L", "R/R"
  1346. };
  1347. static SOC_ENUM_SINGLE_DECL(rt5682s_if2_adc_enum, RT5682S_DIG_INF2_DATA,
  1348. RT5682S_IF2_ADC_SEL_SFT, rt5682s_data_select);
  1349. static SOC_ENUM_SINGLE_DECL(rt5682s_if1_01_adc_enum, RT5682S_TDM_ADDA_CTRL_1,
  1350. RT5682S_IF1_ADC1_SEL_SFT, rt5682s_data_select);
  1351. static SOC_ENUM_SINGLE_DECL(rt5682s_if1_23_adc_enum, RT5682S_TDM_ADDA_CTRL_1,
  1352. RT5682S_IF1_ADC2_SEL_SFT, rt5682s_data_select);
  1353. static SOC_ENUM_SINGLE_DECL(rt5682s_if1_45_adc_enum, RT5682S_TDM_ADDA_CTRL_1,
  1354. RT5682S_IF1_ADC3_SEL_SFT, rt5682s_data_select);
  1355. static SOC_ENUM_SINGLE_DECL(rt5682s_if1_67_adc_enum, RT5682S_TDM_ADDA_CTRL_1,
  1356. RT5682S_IF1_ADC4_SEL_SFT, rt5682s_data_select);
  1357. static const struct snd_kcontrol_new rt5682s_if2_adc_swap_mux =
  1358. SOC_DAPM_ENUM("IF2 ADC Swap Mux", rt5682s_if2_adc_enum);
  1359. static const struct snd_kcontrol_new rt5682s_if1_01_adc_swap_mux =
  1360. SOC_DAPM_ENUM("IF1 01 ADC Swap Mux", rt5682s_if1_01_adc_enum);
  1361. static const struct snd_kcontrol_new rt5682s_if1_23_adc_swap_mux =
  1362. SOC_DAPM_ENUM("IF1 23 ADC Swap Mux", rt5682s_if1_23_adc_enum);
  1363. static const struct snd_kcontrol_new rt5682s_if1_45_adc_swap_mux =
  1364. SOC_DAPM_ENUM("IF1 45 ADC Swap Mux", rt5682s_if1_45_adc_enum);
  1365. static const struct snd_kcontrol_new rt5682s_if1_67_adc_swap_mux =
  1366. SOC_DAPM_ENUM("IF1 67 ADC Swap Mux", rt5682s_if1_67_adc_enum);
  1367. /* Digital Mixer */
  1368. static const struct snd_kcontrol_new rt5682s_sto1_adc_l_mix[] = {
  1369. SOC_DAPM_SINGLE("ADC1 Switch", RT5682S_STO1_ADC_MIXER,
  1370. RT5682S_M_STO1_ADC_L1_SFT, 1, 1),
  1371. SOC_DAPM_SINGLE("ADC2 Switch", RT5682S_STO1_ADC_MIXER,
  1372. RT5682S_M_STO1_ADC_L2_SFT, 1, 1),
  1373. };
  1374. static const struct snd_kcontrol_new rt5682s_sto1_adc_r_mix[] = {
  1375. SOC_DAPM_SINGLE("ADC1 Switch", RT5682S_STO1_ADC_MIXER,
  1376. RT5682S_M_STO1_ADC_R1_SFT, 1, 1),
  1377. SOC_DAPM_SINGLE("ADC2 Switch", RT5682S_STO1_ADC_MIXER,
  1378. RT5682S_M_STO1_ADC_R2_SFT, 1, 1),
  1379. };
  1380. static const struct snd_kcontrol_new rt5682s_dac_l_mix[] = {
  1381. SOC_DAPM_SINGLE("Stereo ADC Switch", RT5682S_AD_DA_MIXER,
  1382. RT5682S_M_ADCMIX_L_SFT, 1, 1),
  1383. SOC_DAPM_SINGLE("DAC1 Switch", RT5682S_AD_DA_MIXER,
  1384. RT5682S_M_DAC1_L_SFT, 1, 1),
  1385. };
  1386. static const struct snd_kcontrol_new rt5682s_dac_r_mix[] = {
  1387. SOC_DAPM_SINGLE("Stereo ADC Switch", RT5682S_AD_DA_MIXER,
  1388. RT5682S_M_ADCMIX_R_SFT, 1, 1),
  1389. SOC_DAPM_SINGLE("DAC1 Switch", RT5682S_AD_DA_MIXER,
  1390. RT5682S_M_DAC1_R_SFT, 1, 1),
  1391. };
  1392. static const struct snd_kcontrol_new rt5682s_sto1_dac_l_mix[] = {
  1393. SOC_DAPM_SINGLE("DAC L1 Switch", RT5682S_STO1_DAC_MIXER,
  1394. RT5682S_M_DAC_L1_STO_L_SFT, 1, 1),
  1395. SOC_DAPM_SINGLE("DAC R1 Switch", RT5682S_STO1_DAC_MIXER,
  1396. RT5682S_M_DAC_R1_STO_L_SFT, 1, 1),
  1397. };
  1398. static const struct snd_kcontrol_new rt5682s_sto1_dac_r_mix[] = {
  1399. SOC_DAPM_SINGLE("DAC L1 Switch", RT5682S_STO1_DAC_MIXER,
  1400. RT5682S_M_DAC_L1_STO_R_SFT, 1, 1),
  1401. SOC_DAPM_SINGLE("DAC R1 Switch", RT5682S_STO1_DAC_MIXER,
  1402. RT5682S_M_DAC_R1_STO_R_SFT, 1, 1),
  1403. };
  1404. /* Analog Input Mixer */
  1405. static const struct snd_kcontrol_new rt5682s_rec1_l_mix[] = {
  1406. SOC_DAPM_SINGLE("CBJ Switch", RT5682S_REC_MIXER,
  1407. RT5682S_M_CBJ_RM1_L_SFT, 1, 1),
  1408. };
  1409. static const struct snd_kcontrol_new rt5682s_rec1_r_mix[] = {
  1410. SOC_DAPM_SINGLE("CBJ Switch", RT5682S_REC_MIXER,
  1411. RT5682S_M_CBJ_RM1_R_SFT, 1, 1),
  1412. };
  1413. /* STO1 ADC1 Source */
  1414. /* MX-26 [13] [5] */
  1415. static const char * const rt5682s_sto1_adc1_src[] = {
  1416. "DAC MIX", "ADC"
  1417. };
  1418. static SOC_ENUM_SINGLE_DECL(rt5682s_sto1_adc1l_enum, RT5682S_STO1_ADC_MIXER,
  1419. RT5682S_STO1_ADC1L_SRC_SFT, rt5682s_sto1_adc1_src);
  1420. static const struct snd_kcontrol_new rt5682s_sto1_adc1l_mux =
  1421. SOC_DAPM_ENUM("Stereo1 ADC1L Source", rt5682s_sto1_adc1l_enum);
  1422. static SOC_ENUM_SINGLE_DECL(rt5682s_sto1_adc1r_enum, RT5682S_STO1_ADC_MIXER,
  1423. RT5682S_STO1_ADC1R_SRC_SFT, rt5682s_sto1_adc1_src);
  1424. static const struct snd_kcontrol_new rt5682s_sto1_adc1r_mux =
  1425. SOC_DAPM_ENUM("Stereo1 ADC1L Source", rt5682s_sto1_adc1r_enum);
  1426. /* STO1 ADC Source */
  1427. /* MX-26 [11:10] [3:2] */
  1428. static const char * const rt5682s_sto1_adc_src[] = {
  1429. "ADC1 L", "ADC1 R"
  1430. };
  1431. static SOC_ENUM_SINGLE_DECL(rt5682s_sto1_adcl_enum, RT5682S_STO1_ADC_MIXER,
  1432. RT5682S_STO1_ADCL_SRC_SFT, rt5682s_sto1_adc_src);
  1433. static const struct snd_kcontrol_new rt5682s_sto1_adcl_mux =
  1434. SOC_DAPM_ENUM("Stereo1 ADCL Source", rt5682s_sto1_adcl_enum);
  1435. static SOC_ENUM_SINGLE_DECL(rt5682s_sto1_adcr_enum, RT5682S_STO1_ADC_MIXER,
  1436. RT5682S_STO1_ADCR_SRC_SFT, rt5682s_sto1_adc_src);
  1437. static const struct snd_kcontrol_new rt5682s_sto1_adcr_mux =
  1438. SOC_DAPM_ENUM("Stereo1 ADCR Source", rt5682s_sto1_adcr_enum);
  1439. /* STO1 ADC2 Source */
  1440. /* MX-26 [12] [4] */
  1441. static const char * const rt5682s_sto1_adc2_src[] = {
  1442. "DAC MIX", "DMIC"
  1443. };
  1444. static SOC_ENUM_SINGLE_DECL(rt5682s_sto1_adc2l_enum, RT5682S_STO1_ADC_MIXER,
  1445. RT5682S_STO1_ADC2L_SRC_SFT, rt5682s_sto1_adc2_src);
  1446. static const struct snd_kcontrol_new rt5682s_sto1_adc2l_mux =
  1447. SOC_DAPM_ENUM("Stereo1 ADC2L Source", rt5682s_sto1_adc2l_enum);
  1448. static SOC_ENUM_SINGLE_DECL(rt5682s_sto1_adc2r_enum, RT5682S_STO1_ADC_MIXER,
  1449. RT5682S_STO1_ADC2R_SRC_SFT, rt5682s_sto1_adc2_src);
  1450. static const struct snd_kcontrol_new rt5682s_sto1_adc2r_mux =
  1451. SOC_DAPM_ENUM("Stereo1 ADC2R Source", rt5682s_sto1_adc2r_enum);
  1452. /* MX-79 [6:4] I2S1 ADC data location */
  1453. static const unsigned int rt5682s_if1_adc_slot_values[] = {
  1454. 0, 2, 4, 6,
  1455. };
  1456. static const char * const rt5682s_if1_adc_slot_src[] = {
  1457. "Slot 0", "Slot 2", "Slot 4", "Slot 6"
  1458. };
  1459. static SOC_VALUE_ENUM_SINGLE_DECL(rt5682s_if1_adc_slot_enum,
  1460. RT5682S_TDM_CTRL, RT5682S_TDM_ADC_LCA_SFT, RT5682S_TDM_ADC_LCA_MASK,
  1461. rt5682s_if1_adc_slot_src, rt5682s_if1_adc_slot_values);
  1462. static const struct snd_kcontrol_new rt5682s_if1_adc_slot_mux =
  1463. SOC_DAPM_ENUM("IF1 ADC Slot location", rt5682s_if1_adc_slot_enum);
  1464. /* Analog DAC L1 Source, Analog DAC R1 Source*/
  1465. /* MX-2B [4], MX-2B [0]*/
  1466. static const char * const rt5682s_alg_dac1_src[] = {
  1467. "Stereo1 DAC Mixer", "DAC1"
  1468. };
  1469. static SOC_ENUM_SINGLE_DECL(rt5682s_alg_dac_l1_enum, RT5682S_A_DAC1_MUX,
  1470. RT5682S_A_DACL1_SFT, rt5682s_alg_dac1_src);
  1471. static const struct snd_kcontrol_new rt5682s_alg_dac_l1_mux =
  1472. SOC_DAPM_ENUM("Analog DAC L1 Source", rt5682s_alg_dac_l1_enum);
  1473. static SOC_ENUM_SINGLE_DECL(rt5682s_alg_dac_r1_enum, RT5682S_A_DAC1_MUX,
  1474. RT5682S_A_DACR1_SFT, rt5682s_alg_dac1_src);
  1475. static const struct snd_kcontrol_new rt5682s_alg_dac_r1_mux =
  1476. SOC_DAPM_ENUM("Analog DAC R1 Source", rt5682s_alg_dac_r1_enum);
  1477. static const unsigned int rt5682s_adcdat_pin_values[] = {
  1478. 1, 3,
  1479. };
  1480. static const char * const rt5682s_adcdat_pin_select[] = {
  1481. "ADCDAT1", "ADCDAT2",
  1482. };
  1483. static SOC_VALUE_ENUM_SINGLE_DECL(rt5682s_adcdat_pin_enum,
  1484. RT5682S_GPIO_CTRL_1, RT5682S_GP4_PIN_SFT, RT5682S_GP4_PIN_MASK,
  1485. rt5682s_adcdat_pin_select, rt5682s_adcdat_pin_values);
  1486. static const struct snd_kcontrol_new rt5682s_adcdat_pin_ctrl =
  1487. SOC_DAPM_ENUM("ADCDAT", rt5682s_adcdat_pin_enum);
  1488. static const struct snd_soc_dapm_widget rt5682s_dapm_widgets[] = {
  1489. SND_SOC_DAPM_SUPPLY("LDO MB1", RT5682S_PWR_ANLG_3,
  1490. RT5682S_PWR_LDO_MB1_BIT, 0, NULL, 0),
  1491. SND_SOC_DAPM_SUPPLY("LDO MB2", RT5682S_PWR_ANLG_3,
  1492. RT5682S_PWR_LDO_MB2_BIT, 0, NULL, 0),
  1493. SND_SOC_DAPM_SUPPLY("LDO", RT5682S_PWR_ANLG_3,
  1494. RT5682S_PWR_LDO_BIT, 0, NULL, 0),
  1495. /* PLL Powers */
  1496. SND_SOC_DAPM_SUPPLY_S("PLLA_LDO", 0, RT5682S_PWR_ANLG_3,
  1497. RT5682S_PWR_LDO_PLLA_BIT, 0, NULL, 0),
  1498. SND_SOC_DAPM_SUPPLY_S("PLLA_BIAS", 0, RT5682S_PWR_ANLG_3,
  1499. RT5682S_PWR_BIAS_PLLA_BIT, 0, NULL, 0),
  1500. SND_SOC_DAPM_SUPPLY_S("PLLA", 0, RT5682S_PWR_ANLG_3,
  1501. RT5682S_PWR_PLLA_BIT, 0, NULL, 0),
  1502. SND_SOC_DAPM_SUPPLY_S("PLLA_RST", 1, RT5682S_PWR_ANLG_3,
  1503. RT5682S_RSTB_PLLA_BIT, 0, NULL, 0),
  1504. SND_SOC_DAPM_SUPPLY("PLLB", SND_SOC_NOPM, 0, 0,
  1505. set_pllb_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1506. /* ASRC */
  1507. SND_SOC_DAPM_SUPPLY_S("DAC STO1 ASRC", 1, RT5682S_PLL_TRACK_1,
  1508. RT5682S_DAC_STO1_ASRC_SFT, 0, NULL, 0),
  1509. SND_SOC_DAPM_SUPPLY_S("ADC STO1 ASRC", 1, RT5682S_PLL_TRACK_1,
  1510. RT5682S_ADC_STO1_ASRC_SFT, 0, NULL, 0),
  1511. SND_SOC_DAPM_SUPPLY_S("AD ASRC", 1, RT5682S_PLL_TRACK_1,
  1512. RT5682S_AD_ASRC_SFT, 0, NULL, 0),
  1513. SND_SOC_DAPM_SUPPLY_S("DA ASRC", 1, RT5682S_PLL_TRACK_1,
  1514. RT5682S_DA_ASRC_SFT, 0, NULL, 0),
  1515. SND_SOC_DAPM_SUPPLY_S("DMIC ASRC", 1, RT5682S_PLL_TRACK_1,
  1516. RT5682S_DMIC_ASRC_SFT, 0, NULL, 0),
  1517. /* Input Side */
  1518. SND_SOC_DAPM_SUPPLY("MICBIAS1", RT5682S_PWR_ANLG_2,
  1519. RT5682S_PWR_MB1_BIT, 0, NULL, 0),
  1520. SND_SOC_DAPM_SUPPLY("MICBIAS2", RT5682S_PWR_ANLG_2,
  1521. RT5682S_PWR_MB2_BIT, 0, NULL, 0),
  1522. /* Input Lines */
  1523. SND_SOC_DAPM_INPUT("DMIC L1"),
  1524. SND_SOC_DAPM_INPUT("DMIC R1"),
  1525. SND_SOC_DAPM_INPUT("IN1P"),
  1526. SND_SOC_DAPM_SUPPLY("DMIC CLK", SND_SOC_NOPM, 0, 0,
  1527. set_dmic_clk, SND_SOC_DAPM_PRE_PMU),
  1528. SND_SOC_DAPM_SUPPLY("DMIC1 Power", RT5682S_DMIC_CTRL_1, RT5682S_DMIC_1_EN_SFT, 0,
  1529. set_dmic_power, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1530. /* Boost */
  1531. SND_SOC_DAPM_PGA("BST1 CBJ", SND_SOC_NOPM, 0, 0, NULL, 0),
  1532. /* REC Mixer */
  1533. SND_SOC_DAPM_MIXER("RECMIX1L", SND_SOC_NOPM, 0, 0, rt5682s_rec1_l_mix,
  1534. ARRAY_SIZE(rt5682s_rec1_l_mix)),
  1535. SND_SOC_DAPM_MIXER("RECMIX1R", SND_SOC_NOPM, 0, 0, rt5682s_rec1_r_mix,
  1536. ARRAY_SIZE(rt5682s_rec1_r_mix)),
  1537. SND_SOC_DAPM_SUPPLY("RECMIX1L Power", RT5682S_CAL_REC,
  1538. RT5682S_PWR_RM1_L_BIT, 0, NULL, 0),
  1539. SND_SOC_DAPM_SUPPLY("RECMIX1R Power", RT5682S_CAL_REC,
  1540. RT5682S_PWR_RM1_R_BIT, 0, NULL, 0),
  1541. /* ADCs */
  1542. SND_SOC_DAPM_ADC("ADC1 L", NULL, SND_SOC_NOPM, 0, 0),
  1543. SND_SOC_DAPM_ADC("ADC1 R", NULL, SND_SOC_NOPM, 0, 0),
  1544. SND_SOC_DAPM_SUPPLY("ADC1 L Power", RT5682S_PWR_DIG_1,
  1545. RT5682S_PWR_ADC_L1_BIT, 0, NULL, 0),
  1546. SND_SOC_DAPM_SUPPLY("ADC1 R Power", RT5682S_PWR_DIG_1,
  1547. RT5682S_PWR_ADC_R1_BIT, 0, NULL, 0),
  1548. SND_SOC_DAPM_SUPPLY("ADC1 clock", RT5682S_CHOP_ADC,
  1549. RT5682S_CKGEN_ADC1_SFT, 0, NULL, 0),
  1550. /* ADC Mux */
  1551. SND_SOC_DAPM_MUX("Stereo1 ADC L1 Mux", SND_SOC_NOPM, 0, 0,
  1552. &rt5682s_sto1_adc1l_mux),
  1553. SND_SOC_DAPM_MUX("Stereo1 ADC R1 Mux", SND_SOC_NOPM, 0, 0,
  1554. &rt5682s_sto1_adc1r_mux),
  1555. SND_SOC_DAPM_MUX("Stereo1 ADC L2 Mux", SND_SOC_NOPM, 0, 0,
  1556. &rt5682s_sto1_adc2l_mux),
  1557. SND_SOC_DAPM_MUX("Stereo1 ADC R2 Mux", SND_SOC_NOPM, 0, 0,
  1558. &rt5682s_sto1_adc2r_mux),
  1559. SND_SOC_DAPM_MUX("Stereo1 ADC L Mux", SND_SOC_NOPM, 0, 0,
  1560. &rt5682s_sto1_adcl_mux),
  1561. SND_SOC_DAPM_MUX("Stereo1 ADC R Mux", SND_SOC_NOPM, 0, 0,
  1562. &rt5682s_sto1_adcr_mux),
  1563. SND_SOC_DAPM_MUX("IF1_ADC Mux", SND_SOC_NOPM, 0, 0,
  1564. &rt5682s_if1_adc_slot_mux),
  1565. /* ADC Mixer */
  1566. SND_SOC_DAPM_SUPPLY("ADC Stereo1 Filter", RT5682S_PWR_DIG_2,
  1567. RT5682S_PWR_ADC_S1F_BIT, 0, set_filter_clk, SND_SOC_DAPM_PRE_PMU),
  1568. SND_SOC_DAPM_MIXER_E("Stereo1 ADC MIXL", SND_SOC_NOPM, 0, 0,
  1569. rt5682s_sto1_adc_l_mix, ARRAY_SIZE(rt5682s_sto1_adc_l_mix),
  1570. rt5682s_stereo1_adc_mixl_event,
  1571. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
  1572. SND_SOC_DAPM_MIXER("Stereo1 ADC MIXR", RT5682S_STO1_ADC_DIG_VOL,
  1573. RT5682S_R_MUTE_SFT, 1, rt5682s_sto1_adc_r_mix,
  1574. ARRAY_SIZE(rt5682s_sto1_adc_r_mix)),
  1575. /* ADC PGA */
  1576. SND_SOC_DAPM_PGA("Stereo1 ADC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
  1577. /* Digital Interface */
  1578. SND_SOC_DAPM_SUPPLY("I2S1", SND_SOC_NOPM, 0, 0,
  1579. set_i2s_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1580. SND_SOC_DAPM_SUPPLY("I2S2", SND_SOC_NOPM, 0, 0,
  1581. set_i2s_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1582. SND_SOC_DAPM_PGA("IF1 DAC1 L", SND_SOC_NOPM, 0, 0, NULL, 0),
  1583. SND_SOC_DAPM_PGA("IF1 DAC1 R", SND_SOC_NOPM, 0, 0, NULL, 0),
  1584. /* Digital Interface Select */
  1585. SND_SOC_DAPM_MUX("IF1 01 ADC Swap Mux", SND_SOC_NOPM, 0, 0,
  1586. &rt5682s_if1_01_adc_swap_mux),
  1587. SND_SOC_DAPM_MUX("IF1 23 ADC Swap Mux", SND_SOC_NOPM, 0, 0,
  1588. &rt5682s_if1_23_adc_swap_mux),
  1589. SND_SOC_DAPM_MUX("IF1 45 ADC Swap Mux", SND_SOC_NOPM, 0, 0,
  1590. &rt5682s_if1_45_adc_swap_mux),
  1591. SND_SOC_DAPM_MUX("IF1 67 ADC Swap Mux", SND_SOC_NOPM, 0, 0,
  1592. &rt5682s_if1_67_adc_swap_mux),
  1593. SND_SOC_DAPM_MUX("IF2 ADC Swap Mux", SND_SOC_NOPM, 0, 0,
  1594. &rt5682s_if2_adc_swap_mux),
  1595. SND_SOC_DAPM_MUX("ADCDAT Mux", SND_SOC_NOPM, 0, 0, &rt5682s_adcdat_pin_ctrl),
  1596. /* Audio Interface */
  1597. SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, RT5682S_I2S1_SDP,
  1598. RT5682S_SEL_ADCDAT_SFT, 1),
  1599. SND_SOC_DAPM_AIF_OUT("AIF2TX", "AIF2 Capture", 0, RT5682S_I2S2_SDP,
  1600. RT5682S_I2S2_PIN_CFG_SFT, 1),
  1601. SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
  1602. /* Output Side */
  1603. /* DAC mixer before sound effect */
  1604. SND_SOC_DAPM_MIXER("DAC1 MIXL", SND_SOC_NOPM, 0, 0,
  1605. rt5682s_dac_l_mix, ARRAY_SIZE(rt5682s_dac_l_mix)),
  1606. SND_SOC_DAPM_MIXER("DAC1 MIXR", SND_SOC_NOPM, 0, 0,
  1607. rt5682s_dac_r_mix, ARRAY_SIZE(rt5682s_dac_r_mix)),
  1608. /* DAC channel Mux */
  1609. SND_SOC_DAPM_MUX("DAC L1 Source", SND_SOC_NOPM, 0, 0, &rt5682s_alg_dac_l1_mux),
  1610. SND_SOC_DAPM_MUX("DAC R1 Source", SND_SOC_NOPM, 0, 0, &rt5682s_alg_dac_r1_mux),
  1611. /* DAC Mixer */
  1612. SND_SOC_DAPM_SUPPLY("DAC Stereo1 Filter", RT5682S_PWR_DIG_2,
  1613. RT5682S_PWR_DAC_S1F_BIT, 0, set_filter_clk, SND_SOC_DAPM_PRE_PMU),
  1614. SND_SOC_DAPM_MIXER("Stereo1 DAC MIXL", SND_SOC_NOPM, 0, 0,
  1615. rt5682s_sto1_dac_l_mix, ARRAY_SIZE(rt5682s_sto1_dac_l_mix)),
  1616. SND_SOC_DAPM_MIXER("Stereo1 DAC MIXR", SND_SOC_NOPM, 0, 0,
  1617. rt5682s_sto1_dac_r_mix, ARRAY_SIZE(rt5682s_sto1_dac_r_mix)),
  1618. /* DACs */
  1619. SND_SOC_DAPM_DAC("DAC L1", NULL, RT5682S_PWR_DIG_1, RT5682S_PWR_DAC_L1_BIT, 0),
  1620. SND_SOC_DAPM_DAC("DAC R1", NULL, RT5682S_PWR_DIG_1, RT5682S_PWR_DAC_R1_BIT, 0),
  1621. /* HPO */
  1622. SND_SOC_DAPM_PGA_S("HP Amp", 1, SND_SOC_NOPM, 0, 0, rt5682s_hp_amp_event,
  1623. SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),
  1624. /* CLK DET */
  1625. SND_SOC_DAPM_SUPPLY("CLKDET SYS", RT5682S_CLK_DET,
  1626. RT5682S_SYS_CLK_DET_SFT, 0, NULL, 0),
  1627. SND_SOC_DAPM_SUPPLY("CLKDET PLL1", RT5682S_CLK_DET,
  1628. RT5682S_PLL1_CLK_DET_SFT, 0, NULL, 0),
  1629. SND_SOC_DAPM_SUPPLY("MCLK0 DET PWR", RT5682S_PWR_ANLG_2,
  1630. RT5682S_PWR_MCLK0_WD_BIT, 0, NULL, 0),
  1631. /* SAR */
  1632. SND_SOC_DAPM_SUPPLY("SAR", SND_SOC_NOPM, 0, 0, sar_power_event,
  1633. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
  1634. /* Output Lines */
  1635. SND_SOC_DAPM_OUTPUT("HPOL"),
  1636. SND_SOC_DAPM_OUTPUT("HPOR"),
  1637. };
  1638. static const struct snd_soc_dapm_route rt5682s_dapm_routes[] = {
  1639. /*PLL*/
  1640. {"ADC Stereo1 Filter", NULL, "PLLA", is_sys_clk_from_plla},
  1641. {"ADC Stereo1 Filter", NULL, "PLLB", is_sys_clk_from_pllb},
  1642. {"DAC Stereo1 Filter", NULL, "PLLA", is_sys_clk_from_plla},
  1643. {"DAC Stereo1 Filter", NULL, "PLLB", is_sys_clk_from_pllb},
  1644. {"PLLA", NULL, "PLLA_LDO"},
  1645. {"PLLA", NULL, "PLLA_BIAS"},
  1646. {"PLLA", NULL, "PLLA_RST"},
  1647. /*ASRC*/
  1648. {"ADC Stereo1 Filter", NULL, "ADC STO1 ASRC", is_using_asrc},
  1649. {"DAC Stereo1 Filter", NULL, "DAC STO1 ASRC", is_using_asrc},
  1650. {"ADC STO1 ASRC", NULL, "AD ASRC"},
  1651. {"ADC STO1 ASRC", NULL, "DA ASRC"},
  1652. {"DAC STO1 ASRC", NULL, "AD ASRC"},
  1653. {"DAC STO1 ASRC", NULL, "DA ASRC"},
  1654. {"CLKDET SYS", NULL, "MCLK0 DET PWR"},
  1655. {"BST1 CBJ", NULL, "IN1P"},
  1656. {"BST1 CBJ", NULL, "SAR"},
  1657. {"RECMIX1L", "CBJ Switch", "BST1 CBJ"},
  1658. {"RECMIX1L", NULL, "RECMIX1L Power"},
  1659. {"RECMIX1R", "CBJ Switch", "BST1 CBJ"},
  1660. {"RECMIX1R", NULL, "RECMIX1R Power"},
  1661. {"ADC1 L", NULL, "RECMIX1L"},
  1662. {"ADC1 L", NULL, "ADC1 L Power"},
  1663. {"ADC1 L", NULL, "ADC1 clock"},
  1664. {"ADC1 R", NULL, "RECMIX1R"},
  1665. {"ADC1 R", NULL, "ADC1 R Power"},
  1666. {"ADC1 R", NULL, "ADC1 clock"},
  1667. {"DMIC L1", NULL, "DMIC CLK"},
  1668. {"DMIC L1", NULL, "DMIC1 Power"},
  1669. {"DMIC R1", NULL, "DMIC CLK"},
  1670. {"DMIC R1", NULL, "DMIC1 Power"},
  1671. {"DMIC CLK", NULL, "DMIC ASRC"},
  1672. {"Stereo1 ADC L Mux", "ADC1 L", "ADC1 L"},
  1673. {"Stereo1 ADC L Mux", "ADC1 R", "ADC1 R"},
  1674. {"Stereo1 ADC R Mux", "ADC1 L", "ADC1 L"},
  1675. {"Stereo1 ADC R Mux", "ADC1 R", "ADC1 R"},
  1676. {"Stereo1 ADC L1 Mux", "ADC", "Stereo1 ADC L Mux"},
  1677. {"Stereo1 ADC L1 Mux", "DAC MIX", "Stereo1 DAC MIXL"},
  1678. {"Stereo1 ADC L2 Mux", "DMIC", "DMIC L1"},
  1679. {"Stereo1 ADC L2 Mux", "DAC MIX", "Stereo1 DAC MIXL"},
  1680. {"Stereo1 ADC R1 Mux", "ADC", "Stereo1 ADC R Mux"},
  1681. {"Stereo1 ADC R1 Mux", "DAC MIX", "Stereo1 DAC MIXR"},
  1682. {"Stereo1 ADC R2 Mux", "DMIC", "DMIC R1"},
  1683. {"Stereo1 ADC R2 Mux", "DAC MIX", "Stereo1 DAC MIXR"},
  1684. {"Stereo1 ADC MIXL", "ADC1 Switch", "Stereo1 ADC L1 Mux"},
  1685. {"Stereo1 ADC MIXL", "ADC2 Switch", "Stereo1 ADC L2 Mux"},
  1686. {"Stereo1 ADC MIXL", NULL, "ADC Stereo1 Filter"},
  1687. {"Stereo1 ADC MIXR", "ADC1 Switch", "Stereo1 ADC R1 Mux"},
  1688. {"Stereo1 ADC MIXR", "ADC2 Switch", "Stereo1 ADC R2 Mux"},
  1689. {"Stereo1 ADC MIXR", NULL, "ADC Stereo1 Filter"},
  1690. {"Stereo1 ADC MIX", NULL, "Stereo1 ADC MIXL"},
  1691. {"Stereo1 ADC MIX", NULL, "Stereo1 ADC MIXR"},
  1692. {"IF1 01 ADC Swap Mux", "L/R", "Stereo1 ADC MIX"},
  1693. {"IF1 01 ADC Swap Mux", "L/L", "Stereo1 ADC MIX"},
  1694. {"IF1 01 ADC Swap Mux", "R/L", "Stereo1 ADC MIX"},
  1695. {"IF1 01 ADC Swap Mux", "R/R", "Stereo1 ADC MIX"},
  1696. {"IF1 23 ADC Swap Mux", "L/R", "Stereo1 ADC MIX"},
  1697. {"IF1 23 ADC Swap Mux", "R/L", "Stereo1 ADC MIX"},
  1698. {"IF1 23 ADC Swap Mux", "L/L", "Stereo1 ADC MIX"},
  1699. {"IF1 23 ADC Swap Mux", "R/R", "Stereo1 ADC MIX"},
  1700. {"IF1 45 ADC Swap Mux", "L/R", "Stereo1 ADC MIX"},
  1701. {"IF1 45 ADC Swap Mux", "R/L", "Stereo1 ADC MIX"},
  1702. {"IF1 45 ADC Swap Mux", "L/L", "Stereo1 ADC MIX"},
  1703. {"IF1 45 ADC Swap Mux", "R/R", "Stereo1 ADC MIX"},
  1704. {"IF1 67 ADC Swap Mux", "L/R", "Stereo1 ADC MIX"},
  1705. {"IF1 67 ADC Swap Mux", "R/L", "Stereo1 ADC MIX"},
  1706. {"IF1 67 ADC Swap Mux", "L/L", "Stereo1 ADC MIX"},
  1707. {"IF1 67 ADC Swap Mux", "R/R", "Stereo1 ADC MIX"},
  1708. {"IF1_ADC Mux", "Slot 0", "IF1 01 ADC Swap Mux"},
  1709. {"IF1_ADC Mux", "Slot 2", "IF1 23 ADC Swap Mux"},
  1710. {"IF1_ADC Mux", "Slot 4", "IF1 45 ADC Swap Mux"},
  1711. {"IF1_ADC Mux", "Slot 6", "IF1 67 ADC Swap Mux"},
  1712. {"ADCDAT Mux", "ADCDAT1", "IF1_ADC Mux"},
  1713. {"AIF1TX", NULL, "I2S1"},
  1714. {"AIF1TX", NULL, "ADCDAT Mux"},
  1715. {"IF2 ADC Swap Mux", "L/R", "Stereo1 ADC MIX"},
  1716. {"IF2 ADC Swap Mux", "R/L", "Stereo1 ADC MIX"},
  1717. {"IF2 ADC Swap Mux", "L/L", "Stereo1 ADC MIX"},
  1718. {"IF2 ADC Swap Mux", "R/R", "Stereo1 ADC MIX"},
  1719. {"ADCDAT Mux", "ADCDAT2", "IF2 ADC Swap Mux"},
  1720. {"AIF2TX", NULL, "ADCDAT Mux"},
  1721. {"IF1 DAC1 L", NULL, "AIF1RX"},
  1722. {"IF1 DAC1 L", NULL, "I2S1"},
  1723. {"IF1 DAC1 L", NULL, "DAC Stereo1 Filter"},
  1724. {"IF1 DAC1 R", NULL, "AIF1RX"},
  1725. {"IF1 DAC1 R", NULL, "I2S1"},
  1726. {"IF1 DAC1 R", NULL, "DAC Stereo1 Filter"},
  1727. {"DAC1 MIXL", "Stereo ADC Switch", "Stereo1 ADC MIXL"},
  1728. {"DAC1 MIXL", "DAC1 Switch", "IF1 DAC1 L"},
  1729. {"DAC1 MIXR", "Stereo ADC Switch", "Stereo1 ADC MIXR"},
  1730. {"DAC1 MIXR", "DAC1 Switch", "IF1 DAC1 R"},
  1731. {"Stereo1 DAC MIXL", "DAC L1 Switch", "DAC1 MIXL"},
  1732. {"Stereo1 DAC MIXL", "DAC R1 Switch", "DAC1 MIXR"},
  1733. {"Stereo1 DAC MIXR", "DAC R1 Switch", "DAC1 MIXR"},
  1734. {"Stereo1 DAC MIXR", "DAC L1 Switch", "DAC1 MIXL"},
  1735. {"DAC L1 Source", "DAC1", "DAC1 MIXL"},
  1736. {"DAC L1 Source", "Stereo1 DAC Mixer", "Stereo1 DAC MIXL"},
  1737. {"DAC R1 Source", "DAC1", "DAC1 MIXR"},
  1738. {"DAC R1 Source", "Stereo1 DAC Mixer", "Stereo1 DAC MIXR"},
  1739. {"DAC L1", NULL, "DAC L1 Source"},
  1740. {"DAC R1", NULL, "DAC R1 Source"},
  1741. {"HP Amp", NULL, "DAC L1"},
  1742. {"HP Amp", NULL, "DAC R1"},
  1743. {"HP Amp", NULL, "CLKDET SYS"},
  1744. {"HP Amp", NULL, "SAR"},
  1745. {"HPOL", NULL, "HP Amp"},
  1746. {"HPOR", NULL, "HP Amp"},
  1747. };
  1748. static int rt5682s_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
  1749. unsigned int rx_mask, int slots, int slot_width)
  1750. {
  1751. struct snd_soc_component *component = dai->component;
  1752. unsigned int cl, val = 0, tx_slotnum;
  1753. if (tx_mask || rx_mask)
  1754. snd_soc_component_update_bits(component,
  1755. RT5682S_TDM_ADDA_CTRL_2, RT5682S_TDM_EN, RT5682S_TDM_EN);
  1756. else
  1757. snd_soc_component_update_bits(component,
  1758. RT5682S_TDM_ADDA_CTRL_2, RT5682S_TDM_EN, 0);
  1759. /* Tx slot configuration */
  1760. tx_slotnum = hweight_long(tx_mask);
  1761. if (tx_slotnum) {
  1762. if (tx_slotnum > slots) {
  1763. dev_err(component->dev, "Invalid or oversized Tx slots.\n");
  1764. return -EINVAL;
  1765. }
  1766. val |= (tx_slotnum - 1) << RT5682S_TDM_ADC_DL_SFT;
  1767. }
  1768. switch (slots) {
  1769. case 4:
  1770. val |= RT5682S_TDM_TX_CH_4;
  1771. val |= RT5682S_TDM_RX_CH_4;
  1772. break;
  1773. case 6:
  1774. val |= RT5682S_TDM_TX_CH_6;
  1775. val |= RT5682S_TDM_RX_CH_6;
  1776. break;
  1777. case 8:
  1778. val |= RT5682S_TDM_TX_CH_8;
  1779. val |= RT5682S_TDM_RX_CH_8;
  1780. break;
  1781. case 2:
  1782. break;
  1783. default:
  1784. return -EINVAL;
  1785. }
  1786. snd_soc_component_update_bits(component, RT5682S_TDM_CTRL,
  1787. RT5682S_TDM_TX_CH_MASK | RT5682S_TDM_RX_CH_MASK |
  1788. RT5682S_TDM_ADC_DL_MASK, val);
  1789. switch (slot_width) {
  1790. case 8:
  1791. if (tx_mask || rx_mask)
  1792. return -EINVAL;
  1793. cl = RT5682S_I2S1_TX_CHL_8 | RT5682S_I2S1_RX_CHL_8;
  1794. break;
  1795. case 16:
  1796. val = RT5682S_TDM_CL_16;
  1797. cl = RT5682S_I2S1_TX_CHL_16 | RT5682S_I2S1_RX_CHL_16;
  1798. break;
  1799. case 20:
  1800. val = RT5682S_TDM_CL_20;
  1801. cl = RT5682S_I2S1_TX_CHL_20 | RT5682S_I2S1_RX_CHL_20;
  1802. break;
  1803. case 24:
  1804. val = RT5682S_TDM_CL_24;
  1805. cl = RT5682S_I2S1_TX_CHL_24 | RT5682S_I2S1_RX_CHL_24;
  1806. break;
  1807. case 32:
  1808. val = RT5682S_TDM_CL_32;
  1809. cl = RT5682S_I2S1_TX_CHL_32 | RT5682S_I2S1_RX_CHL_32;
  1810. break;
  1811. default:
  1812. return -EINVAL;
  1813. }
  1814. snd_soc_component_update_bits(component, RT5682S_TDM_TCON_CTRL_1,
  1815. RT5682S_TDM_CL_MASK, val);
  1816. snd_soc_component_update_bits(component, RT5682S_I2S1_SDP,
  1817. RT5682S_I2S1_TX_CHL_MASK | RT5682S_I2S1_RX_CHL_MASK, cl);
  1818. return 0;
  1819. }
  1820. static int rt5682s_hw_params(struct snd_pcm_substream *substream,
  1821. struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
  1822. {
  1823. struct snd_soc_component *component = dai->component;
  1824. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1825. unsigned int len_1 = 0, len_2 = 0;
  1826. int frame_size;
  1827. rt5682s->lrck[dai->id] = params_rate(params);
  1828. frame_size = snd_soc_params_to_frame_size(params);
  1829. if (frame_size < 0) {
  1830. dev_err(component->dev, "Unsupported frame size: %d\n", frame_size);
  1831. return -EINVAL;
  1832. }
  1833. switch (params_width(params)) {
  1834. case 16:
  1835. break;
  1836. case 20:
  1837. len_1 |= RT5682S_I2S1_DL_20;
  1838. len_2 |= RT5682S_I2S2_DL_20;
  1839. break;
  1840. case 24:
  1841. len_1 |= RT5682S_I2S1_DL_24;
  1842. len_2 |= RT5682S_I2S2_DL_24;
  1843. break;
  1844. case 32:
  1845. len_1 |= RT5682S_I2S1_DL_32;
  1846. len_2 |= RT5682S_I2S2_DL_24;
  1847. break;
  1848. case 8:
  1849. len_1 |= RT5682S_I2S2_DL_8;
  1850. len_2 |= RT5682S_I2S2_DL_8;
  1851. break;
  1852. default:
  1853. return -EINVAL;
  1854. }
  1855. switch (dai->id) {
  1856. case RT5682S_AIF1:
  1857. snd_soc_component_update_bits(component, RT5682S_I2S1_SDP,
  1858. RT5682S_I2S1_DL_MASK, len_1);
  1859. if (params_channels(params) == 1) /* mono mode */
  1860. snd_soc_component_update_bits(component, RT5682S_I2S1_SDP,
  1861. RT5682S_I2S1_MONO_MASK, RT5682S_I2S1_MONO_EN);
  1862. else
  1863. snd_soc_component_update_bits(component, RT5682S_I2S1_SDP,
  1864. RT5682S_I2S1_MONO_MASK, RT5682S_I2S1_MONO_DIS);
  1865. break;
  1866. case RT5682S_AIF2:
  1867. snd_soc_component_update_bits(component, RT5682S_I2S2_SDP,
  1868. RT5682S_I2S2_DL_MASK, len_2);
  1869. if (params_channels(params) == 1) /* mono mode */
  1870. snd_soc_component_update_bits(component, RT5682S_I2S2_SDP,
  1871. RT5682S_I2S2_MONO_MASK, RT5682S_I2S2_MONO_EN);
  1872. else
  1873. snd_soc_component_update_bits(component, RT5682S_I2S2_SDP,
  1874. RT5682S_I2S2_MONO_MASK, RT5682S_I2S2_MONO_DIS);
  1875. break;
  1876. default:
  1877. dev_err(component->dev, "Invalid dai->id: %d\n", dai->id);
  1878. return -EINVAL;
  1879. }
  1880. return 0;
  1881. }
  1882. static int rt5682s_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
  1883. {
  1884. struct snd_soc_component *component = dai->component;
  1885. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1886. unsigned int reg_val = 0, tdm_ctrl = 0;
  1887. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  1888. case SND_SOC_DAIFMT_CBM_CFM:
  1889. rt5682s->master[dai->id] = 1;
  1890. break;
  1891. case SND_SOC_DAIFMT_CBS_CFS:
  1892. rt5682s->master[dai->id] = 0;
  1893. break;
  1894. default:
  1895. return -EINVAL;
  1896. }
  1897. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  1898. case SND_SOC_DAIFMT_NB_NF:
  1899. break;
  1900. case SND_SOC_DAIFMT_IB_NF:
  1901. reg_val |= RT5682S_I2S_BP_INV;
  1902. tdm_ctrl |= RT5682S_TDM_S_BP_INV;
  1903. break;
  1904. case SND_SOC_DAIFMT_NB_IF:
  1905. if (dai->id == RT5682S_AIF1)
  1906. tdm_ctrl |= RT5682S_TDM_S_LP_INV | RT5682S_TDM_M_BP_INV;
  1907. else
  1908. return -EINVAL;
  1909. break;
  1910. case SND_SOC_DAIFMT_IB_IF:
  1911. if (dai->id == RT5682S_AIF1)
  1912. tdm_ctrl |= RT5682S_TDM_S_BP_INV | RT5682S_TDM_S_LP_INV |
  1913. RT5682S_TDM_M_BP_INV | RT5682S_TDM_M_LP_INV;
  1914. else
  1915. return -EINVAL;
  1916. break;
  1917. default:
  1918. return -EINVAL;
  1919. }
  1920. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  1921. case SND_SOC_DAIFMT_I2S:
  1922. break;
  1923. case SND_SOC_DAIFMT_LEFT_J:
  1924. reg_val |= RT5682S_I2S_DF_LEFT;
  1925. tdm_ctrl |= RT5682S_TDM_DF_LEFT;
  1926. break;
  1927. case SND_SOC_DAIFMT_DSP_A:
  1928. reg_val |= RT5682S_I2S_DF_PCM_A;
  1929. tdm_ctrl |= RT5682S_TDM_DF_PCM_A;
  1930. break;
  1931. case SND_SOC_DAIFMT_DSP_B:
  1932. reg_val |= RT5682S_I2S_DF_PCM_B;
  1933. tdm_ctrl |= RT5682S_TDM_DF_PCM_B;
  1934. break;
  1935. default:
  1936. return -EINVAL;
  1937. }
  1938. switch (dai->id) {
  1939. case RT5682S_AIF1:
  1940. snd_soc_component_update_bits(component, RT5682S_I2S1_SDP,
  1941. RT5682S_I2S_DF_MASK, reg_val);
  1942. snd_soc_component_update_bits(component, RT5682S_TDM_TCON_CTRL_1,
  1943. RT5682S_TDM_MS_MASK | RT5682S_TDM_S_BP_MASK |
  1944. RT5682S_TDM_DF_MASK | RT5682S_TDM_M_BP_MASK |
  1945. RT5682S_TDM_M_LP_MASK | RT5682S_TDM_S_LP_MASK,
  1946. tdm_ctrl | rt5682s->master[dai->id]);
  1947. break;
  1948. case RT5682S_AIF2:
  1949. if (rt5682s->master[dai->id] == 0)
  1950. reg_val |= RT5682S_I2S2_MS_S;
  1951. snd_soc_component_update_bits(component, RT5682S_I2S2_SDP,
  1952. RT5682S_I2S2_MS_MASK | RT5682S_I2S_BP_MASK |
  1953. RT5682S_I2S_DF_MASK, reg_val);
  1954. break;
  1955. default:
  1956. dev_err(component->dev, "Invalid dai->id: %d\n", dai->id);
  1957. return -EINVAL;
  1958. }
  1959. return 0;
  1960. }
  1961. static int rt5682s_set_component_sysclk(struct snd_soc_component *component,
  1962. int clk_id, int source, unsigned int freq, int dir)
  1963. {
  1964. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  1965. unsigned int src = 0;
  1966. if (freq == rt5682s->sysclk && clk_id == rt5682s->sysclk_src)
  1967. return 0;
  1968. switch (clk_id) {
  1969. case RT5682S_SCLK_S_MCLK:
  1970. src = RT5682S_CLK_SRC_MCLK;
  1971. break;
  1972. case RT5682S_SCLK_S_PLL1:
  1973. src = RT5682S_CLK_SRC_PLL1;
  1974. break;
  1975. case RT5682S_SCLK_S_PLL2:
  1976. src = RT5682S_CLK_SRC_PLL2;
  1977. break;
  1978. case RT5682S_SCLK_S_RCCLK:
  1979. src = RT5682S_CLK_SRC_RCCLK;
  1980. break;
  1981. default:
  1982. dev_err(component->dev, "Invalid clock id (%d)\n", clk_id);
  1983. return -EINVAL;
  1984. }
  1985. snd_soc_component_update_bits(component, RT5682S_GLB_CLK,
  1986. RT5682S_SCLK_SRC_MASK, src << RT5682S_SCLK_SRC_SFT);
  1987. snd_soc_component_update_bits(component, RT5682S_ADDA_CLK_1,
  1988. RT5682S_I2S_M_CLK_SRC_MASK, src << RT5682S_I2S_M_CLK_SRC_SFT);
  1989. snd_soc_component_update_bits(component, RT5682S_I2S2_M_CLK_CTRL_1,
  1990. RT5682S_I2S2_M_CLK_SRC_MASK, src << RT5682S_I2S2_M_CLK_SRC_SFT);
  1991. rt5682s->sysclk = freq;
  1992. rt5682s->sysclk_src = clk_id;
  1993. dev_dbg(component->dev, "Sysclk is %dHz and clock id is %d\n",
  1994. freq, clk_id);
  1995. return 0;
  1996. }
  1997. static const struct pll_calc_map plla_table[] = {
  1998. {2048000, 24576000, 0, 46, 2, true, false, false, false},
  1999. {256000, 24576000, 0, 382, 2, true, false, false, false},
  2000. {512000, 24576000, 0, 190, 2, true, false, false, false},
  2001. {4096000, 24576000, 0, 22, 2, true, false, false, false},
  2002. {1024000, 24576000, 0, 94, 2, true, false, false, false},
  2003. {11289600, 22579200, 1, 22, 2, false, false, false, false},
  2004. {1411200, 22579200, 0, 62, 2, true, false, false, false},
  2005. {2822400, 22579200, 0, 30, 2, true, false, false, false},
  2006. {12288000, 24576000, 1, 22, 2, false, false, false, false},
  2007. {1536000, 24576000, 0, 62, 2, true, false, false, false},
  2008. {3072000, 24576000, 0, 30, 2, true, false, false, false},
  2009. {24576000, 49152000, 4, 22, 0, false, false, false, false},
  2010. {3072000, 49152000, 0, 30, 0, true, false, false, false},
  2011. {6144000, 49152000, 0, 30, 0, false, false, false, false},
  2012. {49152000, 98304000, 10, 22, 0, false, true, false, false},
  2013. {6144000, 98304000, 0, 30, 0, false, true, false, false},
  2014. {12288000, 98304000, 1, 22, 0, false, true, false, false},
  2015. {48000000, 3840000, 10, 22, 23, false, false, false, false},
  2016. {24000000, 3840000, 4, 22, 23, false, false, false, false},
  2017. {19200000, 3840000, 3, 23, 23, false, false, false, false},
  2018. {38400000, 3840000, 8, 23, 23, false, false, false, false},
  2019. };
  2020. static const struct pll_calc_map pllb_table[] = {
  2021. {48000000, 24576000, 8, 6, 3, false, false, false, false},
  2022. {48000000, 22579200, 23, 12, 3, false, false, false, true},
  2023. {24000000, 24576000, 3, 6, 3, false, false, false, false},
  2024. {24000000, 22579200, 23, 26, 3, false, false, false, true},
  2025. {19200000, 24576000, 2, 6, 3, false, false, false, false},
  2026. {19200000, 22579200, 3, 5, 3, false, false, false, true},
  2027. {38400000, 24576000, 6, 6, 3, false, false, false, false},
  2028. {38400000, 22579200, 8, 5, 3, false, false, false, true},
  2029. {3840000, 49152000, 0, 6, 0, true, false, false, false},
  2030. };
  2031. static int find_pll_inter_combination(unsigned int f_in, unsigned int f_out,
  2032. struct pll_calc_map *a, struct pll_calc_map *b)
  2033. {
  2034. int i, j;
  2035. /* Look at PLLA table */
  2036. for (i = 0; i < ARRAY_SIZE(plla_table); i++) {
  2037. if (plla_table[i].freq_in == f_in && plla_table[i].freq_out == f_out) {
  2038. memcpy(a, plla_table + i, sizeof(*a));
  2039. return USE_PLLA;
  2040. }
  2041. }
  2042. /* Look at PLLB table */
  2043. for (i = 0; i < ARRAY_SIZE(pllb_table); i++) {
  2044. if (pllb_table[i].freq_in == f_in && pllb_table[i].freq_out == f_out) {
  2045. memcpy(b, pllb_table + i, sizeof(*b));
  2046. return USE_PLLB;
  2047. }
  2048. }
  2049. /* Find a combination of PLLA & PLLB */
  2050. for (i = ARRAY_SIZE(plla_table) - 1; i >= 0; i--) {
  2051. if (plla_table[i].freq_in == f_in && plla_table[i].freq_out == 3840000) {
  2052. for (j = ARRAY_SIZE(pllb_table) - 1; j >= 0; j--) {
  2053. if (pllb_table[j].freq_in == 3840000 &&
  2054. pllb_table[j].freq_out == f_out) {
  2055. memcpy(a, plla_table + i, sizeof(*a));
  2056. memcpy(b, pllb_table + j, sizeof(*b));
  2057. return USE_PLLAB;
  2058. }
  2059. }
  2060. }
  2061. }
  2062. return -EINVAL;
  2063. }
  2064. static int rt5682s_set_component_pll(struct snd_soc_component *component,
  2065. int pll_id, int source, unsigned int freq_in,
  2066. unsigned int freq_out)
  2067. {
  2068. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2069. struct pll_calc_map a_map, b_map;
  2070. if (source == rt5682s->pll_src[pll_id] && freq_in == rt5682s->pll_in[pll_id] &&
  2071. freq_out == rt5682s->pll_out[pll_id])
  2072. return 0;
  2073. if (!freq_in || !freq_out) {
  2074. dev_dbg(component->dev, "PLL disabled\n");
  2075. rt5682s->pll_in[pll_id] = 0;
  2076. rt5682s->pll_out[pll_id] = 0;
  2077. snd_soc_component_update_bits(component, RT5682S_GLB_CLK,
  2078. RT5682S_SCLK_SRC_MASK, RT5682S_CLK_SRC_MCLK << RT5682S_SCLK_SRC_SFT);
  2079. return 0;
  2080. }
  2081. switch (source) {
  2082. case RT5682S_PLL_S_MCLK:
  2083. snd_soc_component_update_bits(component, RT5682S_GLB_CLK,
  2084. RT5682S_PLL_SRC_MASK, RT5682S_PLL_SRC_MCLK);
  2085. break;
  2086. case RT5682S_PLL_S_BCLK1:
  2087. snd_soc_component_update_bits(component, RT5682S_GLB_CLK,
  2088. RT5682S_PLL_SRC_MASK, RT5682S_PLL_SRC_BCLK1);
  2089. break;
  2090. default:
  2091. dev_err(component->dev, "Unknown PLL Source %d\n", source);
  2092. return -EINVAL;
  2093. }
  2094. rt5682s->pll_comb = find_pll_inter_combination(freq_in, freq_out,
  2095. &a_map, &b_map);
  2096. if ((pll_id == RT5682S_PLL1 && rt5682s->pll_comb == USE_PLLA) ||
  2097. (pll_id == RT5682S_PLL2 && (rt5682s->pll_comb == USE_PLLB ||
  2098. rt5682s->pll_comb == USE_PLLAB))) {
  2099. dev_dbg(component->dev,
  2100. "Supported freq conversion for PLL%d:(%d->%d): %d\n",
  2101. pll_id + 1, freq_in, freq_out, rt5682s->pll_comb);
  2102. } else {
  2103. dev_err(component->dev,
  2104. "Unsupported freq conversion for PLL%d:(%d->%d): %d\n",
  2105. pll_id + 1, freq_in, freq_out, rt5682s->pll_comb);
  2106. return -EINVAL;
  2107. }
  2108. if (rt5682s->pll_comb == USE_PLLA || rt5682s->pll_comb == USE_PLLAB) {
  2109. dev_dbg(component->dev,
  2110. "PLLA: fin=%d fout=%d m_bp=%d k_bp=%d m=%d n=%d k=%d\n",
  2111. a_map.freq_in, a_map.freq_out, a_map.m_bp, a_map.k_bp,
  2112. (a_map.m_bp ? 0 : a_map.m), a_map.n, (a_map.k_bp ? 0 : a_map.k));
  2113. snd_soc_component_update_bits(component, RT5682S_PLL_CTRL_1,
  2114. RT5682S_PLLA_N_MASK, a_map.n);
  2115. snd_soc_component_update_bits(component, RT5682S_PLL_CTRL_2,
  2116. RT5682S_PLLA_M_MASK | RT5682S_PLLA_K_MASK,
  2117. a_map.m << RT5682S_PLLA_M_SFT | a_map.k);
  2118. snd_soc_component_update_bits(component, RT5682S_PLL_CTRL_6,
  2119. RT5682S_PLLA_M_BP_MASK | RT5682S_PLLA_K_BP_MASK,
  2120. a_map.m_bp << RT5682S_PLLA_M_BP_SFT |
  2121. a_map.k_bp << RT5682S_PLLA_K_BP_SFT);
  2122. }
  2123. if (rt5682s->pll_comb == USE_PLLB || rt5682s->pll_comb == USE_PLLAB) {
  2124. dev_dbg(component->dev,
  2125. "PLLB: fin=%d fout=%d m_bp=%d k_bp=%d m=%d n=%d k=%d byp_ps=%d sel_ps=%d\n",
  2126. b_map.freq_in, b_map.freq_out, b_map.m_bp, b_map.k_bp,
  2127. (b_map.m_bp ? 0 : b_map.m), b_map.n, (b_map.k_bp ? 0 : b_map.k),
  2128. b_map.byp_ps, b_map.sel_ps);
  2129. snd_soc_component_update_bits(component, RT5682S_PLL_CTRL_3,
  2130. RT5682S_PLLB_N_MASK, b_map.n);
  2131. snd_soc_component_update_bits(component, RT5682S_PLL_CTRL_4,
  2132. RT5682S_PLLB_M_MASK | RT5682S_PLLB_K_MASK,
  2133. b_map.m << RT5682S_PLLB_M_SFT | b_map.k);
  2134. snd_soc_component_update_bits(component, RT5682S_PLL_CTRL_6,
  2135. RT5682S_PLLB_SEL_PS_MASK | RT5682S_PLLB_BYP_PS_MASK |
  2136. RT5682S_PLLB_M_BP_MASK | RT5682S_PLLB_K_BP_MASK,
  2137. b_map.sel_ps << RT5682S_PLLB_SEL_PS_SFT |
  2138. b_map.byp_ps << RT5682S_PLLB_BYP_PS_SFT |
  2139. b_map.m_bp << RT5682S_PLLB_M_BP_SFT |
  2140. b_map.k_bp << RT5682S_PLLB_K_BP_SFT);
  2141. }
  2142. if (rt5682s->pll_comb == USE_PLLB)
  2143. snd_soc_component_update_bits(component, RT5682S_PLL_CTRL_7,
  2144. RT5682S_PLLB_SRC_MASK, RT5682S_PLLB_SRC_DFIN);
  2145. rt5682s->pll_in[pll_id] = freq_in;
  2146. rt5682s->pll_out[pll_id] = freq_out;
  2147. rt5682s->pll_src[pll_id] = source;
  2148. return 0;
  2149. }
  2150. static int rt5682s_set_bclk1_ratio(struct snd_soc_dai *dai,
  2151. unsigned int ratio)
  2152. {
  2153. struct snd_soc_component *component = dai->component;
  2154. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2155. rt5682s->bclk[dai->id] = ratio;
  2156. switch (ratio) {
  2157. case 256:
  2158. snd_soc_component_update_bits(component, RT5682S_TDM_TCON_CTRL_1,
  2159. RT5682S_TDM_BCLK_MS1_MASK, RT5682S_TDM_BCLK_MS1_256);
  2160. break;
  2161. case 128:
  2162. snd_soc_component_update_bits(component, RT5682S_TDM_TCON_CTRL_1,
  2163. RT5682S_TDM_BCLK_MS1_MASK, RT5682S_TDM_BCLK_MS1_128);
  2164. break;
  2165. case 64:
  2166. snd_soc_component_update_bits(component, RT5682S_TDM_TCON_CTRL_1,
  2167. RT5682S_TDM_BCLK_MS1_MASK, RT5682S_TDM_BCLK_MS1_64);
  2168. break;
  2169. case 32:
  2170. snd_soc_component_update_bits(component, RT5682S_TDM_TCON_CTRL_1,
  2171. RT5682S_TDM_BCLK_MS1_MASK, RT5682S_TDM_BCLK_MS1_32);
  2172. break;
  2173. default:
  2174. dev_err(dai->dev, "Invalid bclk1 ratio %d\n", ratio);
  2175. return -EINVAL;
  2176. }
  2177. return 0;
  2178. }
  2179. static int rt5682s_set_bclk2_ratio(struct snd_soc_dai *dai, unsigned int ratio)
  2180. {
  2181. struct snd_soc_component *component = dai->component;
  2182. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2183. rt5682s->bclk[dai->id] = ratio;
  2184. switch (ratio) {
  2185. case 64:
  2186. snd_soc_component_update_bits(component, RT5682S_ADDA_CLK_2,
  2187. RT5682S_I2S2_BCLK_MS2_MASK, RT5682S_I2S2_BCLK_MS2_64);
  2188. break;
  2189. case 32:
  2190. snd_soc_component_update_bits(component, RT5682S_ADDA_CLK_2,
  2191. RT5682S_I2S2_BCLK_MS2_MASK, RT5682S_I2S2_BCLK_MS2_32);
  2192. break;
  2193. default:
  2194. dev_err(dai->dev, "Invalid bclk2 ratio %d\n", ratio);
  2195. return -EINVAL;
  2196. }
  2197. return 0;
  2198. }
  2199. static int rt5682s_set_bias_level(struct snd_soc_component *component,
  2200. enum snd_soc_bias_level level)
  2201. {
  2202. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2203. switch (level) {
  2204. case SND_SOC_BIAS_PREPARE:
  2205. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_DIG_1,
  2206. RT5682S_PWR_LDO, RT5682S_PWR_LDO);
  2207. break;
  2208. case SND_SOC_BIAS_STANDBY:
  2209. if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF)
  2210. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_DIG_1,
  2211. RT5682S_DIG_GATE_CTRL, RT5682S_DIG_GATE_CTRL);
  2212. break;
  2213. case SND_SOC_BIAS_OFF:
  2214. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_DIG_1, RT5682S_PWR_LDO, 0);
  2215. if (!rt5682s->wclk_enabled)
  2216. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_DIG_1,
  2217. RT5682S_DIG_GATE_CTRL, 0);
  2218. break;
  2219. case SND_SOC_BIAS_ON:
  2220. break;
  2221. }
  2222. return 0;
  2223. }
  2224. #ifdef CONFIG_COMMON_CLK
  2225. #define CLK_PLL2_FIN 48000000
  2226. #define CLK_48 48000
  2227. #define CLK_44 44100
  2228. static bool rt5682s_clk_check(struct rt5682s_priv *rt5682s)
  2229. {
  2230. if (!rt5682s->master[RT5682S_AIF1]) {
  2231. dev_dbg(rt5682s->component->dev, "dai clk fmt not set correctly\n");
  2232. return false;
  2233. }
  2234. return true;
  2235. }
  2236. static int rt5682s_wclk_prepare(struct clk_hw *hw)
  2237. {
  2238. struct rt5682s_priv *rt5682s =
  2239. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_WCLK_IDX]);
  2240. struct snd_soc_component *component = rt5682s->component;
  2241. int ref, reg;
  2242. if (!rt5682s_clk_check(rt5682s))
  2243. return -EINVAL;
  2244. mutex_lock(&rt5682s->wclk_mutex);
  2245. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  2246. RT5682S_PWR_VREF2 | RT5682S_PWR_FV2 | RT5682S_PWR_MB,
  2247. RT5682S_PWR_VREF2 | RT5682S_PWR_MB);
  2248. usleep_range(15000, 20000);
  2249. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  2250. RT5682S_PWR_FV2, RT5682S_PWR_FV2);
  2251. /* Set and power on I2S1 */
  2252. snd_soc_component_update_bits(component, RT5682S_PWR_DIG_1,
  2253. RT5682S_DIG_GATE_CTRL, RT5682S_DIG_GATE_CTRL);
  2254. rt5682s_set_i2s(rt5682s, RT5682S_AIF1, 1);
  2255. /* Only need to power on PLLB due to the rate set restriction */
  2256. reg = RT5682S_PLL_TRACK_2;
  2257. ref = 256 * rt5682s->lrck[RT5682S_AIF1];
  2258. rt5682s_set_filter_clk(rt5682s, reg, ref);
  2259. rt5682s_set_pllb_power(rt5682s, 1);
  2260. rt5682s->wclk_enabled = 1;
  2261. mutex_unlock(&rt5682s->wclk_mutex);
  2262. return 0;
  2263. }
  2264. static void rt5682s_wclk_unprepare(struct clk_hw *hw)
  2265. {
  2266. struct rt5682s_priv *rt5682s =
  2267. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_WCLK_IDX]);
  2268. struct snd_soc_component *component = rt5682s->component;
  2269. if (!rt5682s_clk_check(rt5682s))
  2270. return;
  2271. mutex_lock(&rt5682s->wclk_mutex);
  2272. if (!rt5682s->jack_type)
  2273. snd_soc_component_update_bits(component, RT5682S_PWR_ANLG_1,
  2274. RT5682S_PWR_VREF2 | RT5682S_PWR_FV2 | RT5682S_PWR_MB, 0);
  2275. /* Power down I2S1 */
  2276. rt5682s_set_i2s(rt5682s, RT5682S_AIF1, 0);
  2277. snd_soc_component_update_bits(component, RT5682S_PWR_DIG_1,
  2278. RT5682S_DIG_GATE_CTRL, 0);
  2279. /* Power down PLLB */
  2280. rt5682s_set_pllb_power(rt5682s, 0);
  2281. rt5682s->wclk_enabled = 0;
  2282. mutex_unlock(&rt5682s->wclk_mutex);
  2283. }
  2284. static unsigned long rt5682s_wclk_recalc_rate(struct clk_hw *hw,
  2285. unsigned long parent_rate)
  2286. {
  2287. struct rt5682s_priv *rt5682s =
  2288. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_WCLK_IDX]);
  2289. struct snd_soc_component *component = rt5682s->component;
  2290. const char * const clk_name = clk_hw_get_name(hw);
  2291. if (!rt5682s_clk_check(rt5682s))
  2292. return 0;
  2293. /*
  2294. * Only accept to set wclk rate to 44.1k or 48kHz.
  2295. */
  2296. if (rt5682s->lrck[RT5682S_AIF1] != CLK_48 &&
  2297. rt5682s->lrck[RT5682S_AIF1] != CLK_44) {
  2298. dev_warn(component->dev, "%s: clk %s only support %d or %d Hz output\n",
  2299. __func__, clk_name, CLK_44, CLK_48);
  2300. return 0;
  2301. }
  2302. return rt5682s->lrck[RT5682S_AIF1];
  2303. }
  2304. static long rt5682s_wclk_round_rate(struct clk_hw *hw, unsigned long rate,
  2305. unsigned long *parent_rate)
  2306. {
  2307. struct rt5682s_priv *rt5682s =
  2308. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_WCLK_IDX]);
  2309. struct snd_soc_component *component = rt5682s->component;
  2310. const char * const clk_name = clk_hw_get_name(hw);
  2311. if (!rt5682s_clk_check(rt5682s))
  2312. return -EINVAL;
  2313. /*
  2314. * Only accept to set wclk rate to 44.1k or 48kHz.
  2315. * It will force to 48kHz if not both.
  2316. */
  2317. if (rate != CLK_48 && rate != CLK_44) {
  2318. dev_warn(component->dev, "%s: clk %s only support %d or %d Hz output\n",
  2319. __func__, clk_name, CLK_44, CLK_48);
  2320. rate = CLK_48;
  2321. }
  2322. return rate;
  2323. }
  2324. static int rt5682s_wclk_set_rate(struct clk_hw *hw, unsigned long rate,
  2325. unsigned long parent_rate)
  2326. {
  2327. struct rt5682s_priv *rt5682s =
  2328. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_WCLK_IDX]);
  2329. struct snd_soc_component *component = rt5682s->component;
  2330. struct clk *parent_clk;
  2331. const char * const clk_name = clk_hw_get_name(hw);
  2332. unsigned int clk_pll2_fout;
  2333. if (!rt5682s_clk_check(rt5682s))
  2334. return -EINVAL;
  2335. /*
  2336. * Whether the wclk's parent clk (mclk) exists or not, please ensure
  2337. * it is fixed or set to 48MHz before setting wclk rate. It's a
  2338. * temporary limitation. Only accept 48MHz clk as the clk provider.
  2339. *
  2340. * It will set the codec anyway by assuming mclk is 48MHz.
  2341. */
  2342. parent_clk = clk_get_parent(hw->clk);
  2343. if (!parent_clk)
  2344. dev_warn(component->dev,
  2345. "Parent mclk of wclk not acquired in driver. Please ensure mclk was provided as %d Hz.\n",
  2346. CLK_PLL2_FIN);
  2347. if (parent_rate != CLK_PLL2_FIN)
  2348. dev_warn(component->dev, "clk %s only support %d Hz input\n",
  2349. clk_name, CLK_PLL2_FIN);
  2350. /*
  2351. * To achieve the rate conversion from 48MHz to 44.1k or 48kHz,
  2352. * PLL2 is needed.
  2353. */
  2354. clk_pll2_fout = rate * 512;
  2355. rt5682s_set_component_pll(component, RT5682S_PLL2, RT5682S_PLL_S_MCLK,
  2356. CLK_PLL2_FIN, clk_pll2_fout);
  2357. rt5682s_set_component_sysclk(component, RT5682S_SCLK_S_PLL2, 0,
  2358. clk_pll2_fout, SND_SOC_CLOCK_IN);
  2359. rt5682s->lrck[RT5682S_AIF1] = rate;
  2360. return 0;
  2361. }
  2362. static unsigned long rt5682s_bclk_recalc_rate(struct clk_hw *hw,
  2363. unsigned long parent_rate)
  2364. {
  2365. struct rt5682s_priv *rt5682s =
  2366. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_BCLK_IDX]);
  2367. struct snd_soc_component *component = rt5682s->component;
  2368. unsigned int bclks_per_wclk;
  2369. bclks_per_wclk = snd_soc_component_read(component, RT5682S_TDM_TCON_CTRL_1);
  2370. switch (bclks_per_wclk & RT5682S_TDM_BCLK_MS1_MASK) {
  2371. case RT5682S_TDM_BCLK_MS1_256:
  2372. return parent_rate * 256;
  2373. case RT5682S_TDM_BCLK_MS1_128:
  2374. return parent_rate * 128;
  2375. case RT5682S_TDM_BCLK_MS1_64:
  2376. return parent_rate * 64;
  2377. case RT5682S_TDM_BCLK_MS1_32:
  2378. return parent_rate * 32;
  2379. default:
  2380. return 0;
  2381. }
  2382. }
  2383. static unsigned long rt5682s_bclk_get_factor(unsigned long rate,
  2384. unsigned long parent_rate)
  2385. {
  2386. unsigned long factor;
  2387. factor = rate / parent_rate;
  2388. if (factor < 64)
  2389. return 32;
  2390. else if (factor < 128)
  2391. return 64;
  2392. else if (factor < 256)
  2393. return 128;
  2394. else
  2395. return 256;
  2396. }
  2397. static long rt5682s_bclk_round_rate(struct clk_hw *hw, unsigned long rate,
  2398. unsigned long *parent_rate)
  2399. {
  2400. struct rt5682s_priv *rt5682s =
  2401. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_BCLK_IDX]);
  2402. unsigned long factor;
  2403. if (!*parent_rate || !rt5682s_clk_check(rt5682s))
  2404. return -EINVAL;
  2405. /*
  2406. * BCLK rates are set as a multiplier of WCLK in HW.
  2407. * We don't allow changing the parent WCLK. We just do
  2408. * some rounding down based on the parent WCLK rate
  2409. * and find the appropriate multiplier of BCLK to
  2410. * get the rounded down BCLK value.
  2411. */
  2412. factor = rt5682s_bclk_get_factor(rate, *parent_rate);
  2413. return *parent_rate * factor;
  2414. }
  2415. static int rt5682s_bclk_set_rate(struct clk_hw *hw, unsigned long rate,
  2416. unsigned long parent_rate)
  2417. {
  2418. struct rt5682s_priv *rt5682s =
  2419. container_of(hw, struct rt5682s_priv, dai_clks_hw[RT5682S_DAI_BCLK_IDX]);
  2420. struct snd_soc_component *component = rt5682s->component;
  2421. struct snd_soc_dai *dai;
  2422. unsigned long factor;
  2423. if (!rt5682s_clk_check(rt5682s))
  2424. return -EINVAL;
  2425. factor = rt5682s_bclk_get_factor(rate, parent_rate);
  2426. for_each_component_dais(component, dai)
  2427. if (dai->id == RT5682S_AIF1)
  2428. return rt5682s_set_bclk1_ratio(dai, factor);
  2429. dev_err(component->dev, "dai %d not found in component\n",
  2430. RT5682S_AIF1);
  2431. return -ENODEV;
  2432. }
  2433. static const struct clk_ops rt5682s_dai_clk_ops[RT5682S_DAI_NUM_CLKS] = {
  2434. [RT5682S_DAI_WCLK_IDX] = {
  2435. .prepare = rt5682s_wclk_prepare,
  2436. .unprepare = rt5682s_wclk_unprepare,
  2437. .recalc_rate = rt5682s_wclk_recalc_rate,
  2438. .round_rate = rt5682s_wclk_round_rate,
  2439. .set_rate = rt5682s_wclk_set_rate,
  2440. },
  2441. [RT5682S_DAI_BCLK_IDX] = {
  2442. .recalc_rate = rt5682s_bclk_recalc_rate,
  2443. .round_rate = rt5682s_bclk_round_rate,
  2444. .set_rate = rt5682s_bclk_set_rate,
  2445. },
  2446. };
  2447. static int rt5682s_register_dai_clks(struct snd_soc_component *component)
  2448. {
  2449. struct device *dev = component->dev;
  2450. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2451. struct rt5682s_platform_data *pdata = &rt5682s->pdata;
  2452. struct clk_hw *dai_clk_hw;
  2453. int i, ret;
  2454. for (i = 0; i < RT5682S_DAI_NUM_CLKS; ++i) {
  2455. struct clk_init_data init = { };
  2456. struct clk_parent_data parent_data;
  2457. const struct clk_hw *parent;
  2458. dai_clk_hw = &rt5682s->dai_clks_hw[i];
  2459. switch (i) {
  2460. case RT5682S_DAI_WCLK_IDX:
  2461. /* Make MCLK the parent of WCLK */
  2462. if (rt5682s->mclk) {
  2463. parent_data = (struct clk_parent_data){
  2464. .fw_name = "mclk",
  2465. };
  2466. init.parent_data = &parent_data;
  2467. init.num_parents = 1;
  2468. }
  2469. break;
  2470. case RT5682S_DAI_BCLK_IDX:
  2471. /* Make WCLK the parent of BCLK */
  2472. parent = &rt5682s->dai_clks_hw[RT5682S_DAI_WCLK_IDX];
  2473. init.parent_hws = &parent;
  2474. init.num_parents = 1;
  2475. break;
  2476. default:
  2477. dev_err(dev, "Invalid clock index\n");
  2478. return -EINVAL;
  2479. }
  2480. init.name = pdata->dai_clk_names[i];
  2481. init.ops = &rt5682s_dai_clk_ops[i];
  2482. init.flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_GATE;
  2483. dai_clk_hw->init = &init;
  2484. ret = devm_clk_hw_register(dev, dai_clk_hw);
  2485. if (ret) {
  2486. dev_warn(dev, "Failed to register %s: %d\n", init.name, ret);
  2487. return ret;
  2488. }
  2489. if (dev->of_node) {
  2490. devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, dai_clk_hw);
  2491. } else {
  2492. ret = devm_clk_hw_register_clkdev(dev, dai_clk_hw,
  2493. init.name, dev_name(dev));
  2494. if (ret)
  2495. return ret;
  2496. }
  2497. }
  2498. return 0;
  2499. }
  2500. static int rt5682s_dai_probe_clks(struct snd_soc_component *component)
  2501. {
  2502. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2503. int ret;
  2504. /* Check if MCLK provided */
  2505. rt5682s->mclk = devm_clk_get(component->dev, "mclk");
  2506. if (IS_ERR(rt5682s->mclk)) {
  2507. if (PTR_ERR(rt5682s->mclk) != -ENOENT) {
  2508. ret = PTR_ERR(rt5682s->mclk);
  2509. return ret;
  2510. }
  2511. rt5682s->mclk = NULL;
  2512. }
  2513. /* Register CCF DAI clock control */
  2514. ret = rt5682s_register_dai_clks(component);
  2515. if (ret)
  2516. return ret;
  2517. /* Initial setup for CCF */
  2518. rt5682s->lrck[RT5682S_AIF1] = CLK_48;
  2519. return 0;
  2520. }
  2521. #else
  2522. static inline int rt5682s_dai_probe_clks(struct snd_soc_component *component)
  2523. {
  2524. return 0;
  2525. }
  2526. #endif /* CONFIG_COMMON_CLK */
  2527. static int rt5682s_probe(struct snd_soc_component *component)
  2528. {
  2529. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2530. rt5682s->component = component;
  2531. return rt5682s_dai_probe_clks(component);
  2532. }
  2533. static void rt5682s_remove(struct snd_soc_component *component)
  2534. {
  2535. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2536. rt5682s_reset(rt5682s);
  2537. }
  2538. #ifdef CONFIG_PM
  2539. static int rt5682s_suspend(struct snd_soc_component *component)
  2540. {
  2541. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2542. cancel_delayed_work_sync(&rt5682s->jack_detect_work);
  2543. cancel_delayed_work_sync(&rt5682s->jd_check_work);
  2544. if (rt5682s->hs_jack)
  2545. rt5682s->jack_type = rt5682s_headset_detect(component, 0);
  2546. regcache_cache_only(rt5682s->regmap, true);
  2547. regcache_mark_dirty(rt5682s->regmap);
  2548. return 0;
  2549. }
  2550. static int rt5682s_resume(struct snd_soc_component *component)
  2551. {
  2552. struct rt5682s_priv *rt5682s = snd_soc_component_get_drvdata(component);
  2553. regcache_cache_only(rt5682s->regmap, false);
  2554. regcache_sync(rt5682s->regmap);
  2555. if (rt5682s->hs_jack) {
  2556. mod_delayed_work(system_power_efficient_wq,
  2557. &rt5682s->jack_detect_work, msecs_to_jiffies(0));
  2558. }
  2559. return 0;
  2560. }
  2561. #else
  2562. #define rt5682s_suspend NULL
  2563. #define rt5682s_resume NULL
  2564. #endif
  2565. static const struct snd_soc_dai_ops rt5682s_aif1_dai_ops = {
  2566. .hw_params = rt5682s_hw_params,
  2567. .set_fmt = rt5682s_set_dai_fmt,
  2568. .set_tdm_slot = rt5682s_set_tdm_slot,
  2569. .set_bclk_ratio = rt5682s_set_bclk1_ratio,
  2570. };
  2571. static const struct snd_soc_dai_ops rt5682s_aif2_dai_ops = {
  2572. .hw_params = rt5682s_hw_params,
  2573. .set_fmt = rt5682s_set_dai_fmt,
  2574. .set_bclk_ratio = rt5682s_set_bclk2_ratio,
  2575. };
  2576. static const struct snd_soc_component_driver rt5682s_soc_component_dev = {
  2577. .probe = rt5682s_probe,
  2578. .remove = rt5682s_remove,
  2579. .suspend = rt5682s_suspend,
  2580. .resume = rt5682s_resume,
  2581. .set_bias_level = rt5682s_set_bias_level,
  2582. .controls = rt5682s_snd_controls,
  2583. .num_controls = ARRAY_SIZE(rt5682s_snd_controls),
  2584. .dapm_widgets = rt5682s_dapm_widgets,
  2585. .num_dapm_widgets = ARRAY_SIZE(rt5682s_dapm_widgets),
  2586. .dapm_routes = rt5682s_dapm_routes,
  2587. .num_dapm_routes = ARRAY_SIZE(rt5682s_dapm_routes),
  2588. .set_sysclk = rt5682s_set_component_sysclk,
  2589. .set_pll = rt5682s_set_component_pll,
  2590. .set_jack = rt5682s_set_jack_detect,
  2591. .use_pmdown_time = 1,
  2592. .endianness = 1,
  2593. };
  2594. static int rt5682s_parse_dt(struct rt5682s_priv *rt5682s, struct device *dev)
  2595. {
  2596. device_property_read_u32(dev, "realtek,dmic1-data-pin",
  2597. &rt5682s->pdata.dmic1_data_pin);
  2598. device_property_read_u32(dev, "realtek,dmic1-clk-pin",
  2599. &rt5682s->pdata.dmic1_clk_pin);
  2600. device_property_read_u32(dev, "realtek,jd-src",
  2601. &rt5682s->pdata.jd_src);
  2602. device_property_read_u32(dev, "realtek,dmic-clk-rate-hz",
  2603. &rt5682s->pdata.dmic_clk_rate);
  2604. device_property_read_u32(dev, "realtek,dmic-delay-ms",
  2605. &rt5682s->pdata.dmic_delay);
  2606. device_property_read_u32(dev, "realtek,amic-delay-ms",
  2607. &rt5682s->pdata.amic_delay);
  2608. rt5682s->pdata.ldo1_en = of_get_named_gpio(dev->of_node,
  2609. "realtek,ldo1-en-gpios", 0);
  2610. if (device_property_read_string_array(dev, "clock-output-names",
  2611. rt5682s->pdata.dai_clk_names,
  2612. RT5682S_DAI_NUM_CLKS) < 0)
  2613. dev_warn(dev, "Using default DAI clk names: %s, %s\n",
  2614. rt5682s->pdata.dai_clk_names[RT5682S_DAI_WCLK_IDX],
  2615. rt5682s->pdata.dai_clk_names[RT5682S_DAI_BCLK_IDX]);
  2616. rt5682s->pdata.dmic_clk_driving_high = device_property_read_bool(dev,
  2617. "realtek,dmic-clk-driving-high");
  2618. return 0;
  2619. }
  2620. static void rt5682s_calibrate(struct rt5682s_priv *rt5682s)
  2621. {
  2622. unsigned int count, value;
  2623. mutex_lock(&rt5682s->calibrate_mutex);
  2624. regmap_write(rt5682s->regmap, RT5682S_PWR_ANLG_1, 0xaa80);
  2625. usleep_range(15000, 20000);
  2626. regmap_write(rt5682s->regmap, RT5682S_PWR_ANLG_1, 0xfa80);
  2627. regmap_write(rt5682s->regmap, RT5682S_PWR_DIG_1, 0x01c0);
  2628. regmap_write(rt5682s->regmap, RT5682S_MICBIAS_2, 0x0380);
  2629. regmap_write(rt5682s->regmap, RT5682S_GLB_CLK, 0x8000);
  2630. regmap_write(rt5682s->regmap, RT5682S_ADDA_CLK_1, 0x1001);
  2631. regmap_write(rt5682s->regmap, RT5682S_CHOP_DAC_2, 0x3030);
  2632. regmap_write(rt5682s->regmap, RT5682S_CHOP_ADC, 0xb000);
  2633. regmap_write(rt5682s->regmap, RT5682S_STO1_ADC_MIXER, 0x686c);
  2634. regmap_write(rt5682s->regmap, RT5682S_CAL_REC, 0x5151);
  2635. regmap_write(rt5682s->regmap, RT5682S_HP_CALIB_CTRL_2, 0x0321);
  2636. regmap_write(rt5682s->regmap, RT5682S_HP_LOGIC_CTRL_2, 0x0004);
  2637. regmap_write(rt5682s->regmap, RT5682S_HP_CALIB_CTRL_1, 0x7c00);
  2638. regmap_write(rt5682s->regmap, RT5682S_HP_CALIB_CTRL_1, 0xfc00);
  2639. for (count = 0; count < 60; count++) {
  2640. regmap_read(rt5682s->regmap, RT5682S_HP_CALIB_ST_1, &value);
  2641. if (!(value & 0x8000))
  2642. break;
  2643. usleep_range(10000, 10005);
  2644. }
  2645. if (count >= 60)
  2646. dev_err(rt5682s->component->dev, "HP Calibration Failure\n");
  2647. /* restore settings */
  2648. regmap_write(rt5682s->regmap, RT5682S_MICBIAS_2, 0x0180);
  2649. regmap_write(rt5682s->regmap, RT5682S_CAL_REC, 0x5858);
  2650. regmap_write(rt5682s->regmap, RT5682S_STO1_ADC_MIXER, 0xc0c4);
  2651. regmap_write(rt5682s->regmap, RT5682S_HP_CALIB_CTRL_2, 0x0320);
  2652. regmap_write(rt5682s->regmap, RT5682S_PWR_DIG_1, 0x00c0);
  2653. regmap_write(rt5682s->regmap, RT5682S_PWR_ANLG_1, 0x0800);
  2654. regmap_write(rt5682s->regmap, RT5682S_GLB_CLK, 0x0000);
  2655. mutex_unlock(&rt5682s->calibrate_mutex);
  2656. }
  2657. static const struct regmap_config rt5682s_regmap = {
  2658. .reg_bits = 16,
  2659. .val_bits = 16,
  2660. .max_register = RT5682S_MAX_REG,
  2661. .volatile_reg = rt5682s_volatile_register,
  2662. .readable_reg = rt5682s_readable_register,
  2663. .cache_type = REGCACHE_RBTREE,
  2664. .reg_defaults = rt5682s_reg,
  2665. .num_reg_defaults = ARRAY_SIZE(rt5682s_reg),
  2666. .use_single_read = true,
  2667. .use_single_write = true,
  2668. };
  2669. static struct snd_soc_dai_driver rt5682s_dai[] = {
  2670. {
  2671. .name = "rt5682s-aif1",
  2672. .id = RT5682S_AIF1,
  2673. .playback = {
  2674. .stream_name = "AIF1 Playback",
  2675. .channels_min = 1,
  2676. .channels_max = 2,
  2677. .rates = RT5682S_STEREO_RATES,
  2678. .formats = RT5682S_FORMATS,
  2679. },
  2680. .capture = {
  2681. .stream_name = "AIF1 Capture",
  2682. .channels_min = 1,
  2683. .channels_max = 2,
  2684. .rates = RT5682S_STEREO_RATES,
  2685. .formats = RT5682S_FORMATS,
  2686. },
  2687. .ops = &rt5682s_aif1_dai_ops,
  2688. },
  2689. {
  2690. .name = "rt5682s-aif2",
  2691. .id = RT5682S_AIF2,
  2692. .capture = {
  2693. .stream_name = "AIF2 Capture",
  2694. .channels_min = 1,
  2695. .channels_max = 2,
  2696. .rates = RT5682S_STEREO_RATES,
  2697. .formats = RT5682S_FORMATS,
  2698. },
  2699. .ops = &rt5682s_aif2_dai_ops,
  2700. },
  2701. };
  2702. static void rt5682s_i2c_disable_regulators(void *data)
  2703. {
  2704. struct rt5682s_priv *rt5682s = data;
  2705. struct device *dev = regmap_get_device(rt5682s->regmap);
  2706. int ret;
  2707. ret = regulator_disable(rt5682s->supplies[RT5682S_SUPPLY_AVDD].consumer);
  2708. if (ret)
  2709. dev_err(dev, "Failed to disable supply AVDD: %d\n", ret);
  2710. usleep_range(1000, 1500);
  2711. ret = regulator_disable(rt5682s->supplies[RT5682S_SUPPLY_MICVDD].consumer);
  2712. if (ret)
  2713. dev_err(dev, "Failed to disable supply MICVDD: %d\n", ret);
  2714. }
  2715. static int rt5682s_i2c_probe(struct i2c_client *i2c)
  2716. {
  2717. struct rt5682s_platform_data *pdata = dev_get_platdata(&i2c->dev);
  2718. struct rt5682s_priv *rt5682s;
  2719. int i, ret;
  2720. unsigned int val;
  2721. rt5682s = devm_kzalloc(&i2c->dev, sizeof(struct rt5682s_priv), GFP_KERNEL);
  2722. if (!rt5682s)
  2723. return -ENOMEM;
  2724. i2c_set_clientdata(i2c, rt5682s);
  2725. rt5682s->pdata = i2s_default_platform_data;
  2726. if (pdata)
  2727. rt5682s->pdata = *pdata;
  2728. else
  2729. rt5682s_parse_dt(rt5682s, &i2c->dev);
  2730. rt5682s->regmap = devm_regmap_init_i2c(i2c, &rt5682s_regmap);
  2731. if (IS_ERR(rt5682s->regmap)) {
  2732. ret = PTR_ERR(rt5682s->regmap);
  2733. dev_err(&i2c->dev, "Failed to allocate register map: %d\n", ret);
  2734. return ret;
  2735. }
  2736. for (i = 0; i < ARRAY_SIZE(rt5682s->supplies); i++)
  2737. rt5682s->supplies[i].supply = rt5682s_supply_names[i];
  2738. ret = devm_regulator_bulk_get(&i2c->dev,
  2739. ARRAY_SIZE(rt5682s->supplies), rt5682s->supplies);
  2740. if (ret) {
  2741. dev_err(&i2c->dev, "Failed to request supplies: %d\n", ret);
  2742. return ret;
  2743. }
  2744. ret = devm_add_action_or_reset(&i2c->dev, rt5682s_i2c_disable_regulators, rt5682s);
  2745. if (ret)
  2746. return ret;
  2747. ret = regulator_enable(rt5682s->supplies[RT5682S_SUPPLY_MICVDD].consumer);
  2748. if (ret) {
  2749. dev_err(&i2c->dev, "Failed to enable supply MICVDD: %d\n", ret);
  2750. return ret;
  2751. }
  2752. usleep_range(1000, 1500);
  2753. ret = regulator_enable(rt5682s->supplies[RT5682S_SUPPLY_AVDD].consumer);
  2754. if (ret) {
  2755. dev_err(&i2c->dev, "Failed to enable supply AVDD: %d\n", ret);
  2756. return ret;
  2757. }
  2758. if (gpio_is_valid(rt5682s->pdata.ldo1_en)) {
  2759. if (devm_gpio_request_one(&i2c->dev, rt5682s->pdata.ldo1_en,
  2760. GPIOF_OUT_INIT_HIGH, "rt5682s"))
  2761. dev_err(&i2c->dev, "Fail gpio_request gpio_ldo\n");
  2762. }
  2763. /* Sleep for 50 ms minimum */
  2764. usleep_range(50000, 55000);
  2765. regmap_read(rt5682s->regmap, RT5682S_DEVICE_ID, &val);
  2766. if (val != DEVICE_ID) {
  2767. dev_err(&i2c->dev, "Device with ID register %x is not rt5682s\n", val);
  2768. return -ENODEV;
  2769. }
  2770. rt5682s_reset(rt5682s);
  2771. rt5682s_apply_patch_list(rt5682s, &i2c->dev);
  2772. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_DIG_2,
  2773. RT5682S_DLDO_I_LIMIT_MASK, RT5682S_DLDO_I_LIMIT_DIS);
  2774. usleep_range(20000, 25000);
  2775. mutex_init(&rt5682s->calibrate_mutex);
  2776. mutex_init(&rt5682s->sar_mutex);
  2777. mutex_init(&rt5682s->wclk_mutex);
  2778. rt5682s_calibrate(rt5682s);
  2779. regmap_update_bits(rt5682s->regmap, RT5682S_MICBIAS_2,
  2780. RT5682S_PWR_CLK25M_MASK | RT5682S_PWR_CLK1M_MASK,
  2781. RT5682S_PWR_CLK25M_PD | RT5682S_PWR_CLK1M_PU);
  2782. regmap_update_bits(rt5682s->regmap, RT5682S_PWR_ANLG_1,
  2783. RT5682S_PWR_BG, RT5682S_PWR_BG);
  2784. regmap_update_bits(rt5682s->regmap, RT5682S_HP_LOGIC_CTRL_2,
  2785. RT5682S_HP_SIG_SRC_MASK, RT5682S_HP_SIG_SRC_1BIT_CTL);
  2786. regmap_update_bits(rt5682s->regmap, RT5682S_HP_CHARGE_PUMP_2,
  2787. RT5682S_PM_HP_MASK, RT5682S_PM_HP_HV);
  2788. regmap_update_bits(rt5682s->regmap, RT5682S_HP_AMP_DET_CTL_1,
  2789. RT5682S_CP_SW_SIZE_MASK, RT5682S_CP_SW_SIZE_M);
  2790. /* DMIC data pin */
  2791. switch (rt5682s->pdata.dmic1_data_pin) {
  2792. case RT5682S_DMIC1_DATA_NULL:
  2793. break;
  2794. case RT5682S_DMIC1_DATA_GPIO2: /* share with LRCK2 */
  2795. regmap_update_bits(rt5682s->regmap, RT5682S_DMIC_CTRL_1,
  2796. RT5682S_DMIC_1_DP_MASK, RT5682S_DMIC_1_DP_GPIO2);
  2797. regmap_update_bits(rt5682s->regmap, RT5682S_GPIO_CTRL_1,
  2798. RT5682S_GP2_PIN_MASK, RT5682S_GP2_PIN_DMIC_SDA);
  2799. break;
  2800. case RT5682S_DMIC1_DATA_GPIO5: /* share with DACDAT1 */
  2801. regmap_update_bits(rt5682s->regmap, RT5682S_DMIC_CTRL_1,
  2802. RT5682S_DMIC_1_DP_MASK, RT5682S_DMIC_1_DP_GPIO5);
  2803. regmap_update_bits(rt5682s->regmap, RT5682S_GPIO_CTRL_1,
  2804. RT5682S_GP5_PIN_MASK, RT5682S_GP5_PIN_DMIC_SDA);
  2805. break;
  2806. default:
  2807. dev_warn(&i2c->dev, "invalid DMIC_DAT pin\n");
  2808. break;
  2809. }
  2810. /* DMIC clk pin */
  2811. switch (rt5682s->pdata.dmic1_clk_pin) {
  2812. case RT5682S_DMIC1_CLK_NULL:
  2813. break;
  2814. case RT5682S_DMIC1_CLK_GPIO1: /* share with IRQ */
  2815. regmap_update_bits(rt5682s->regmap, RT5682S_GPIO_CTRL_1,
  2816. RT5682S_GP1_PIN_MASK, RT5682S_GP1_PIN_DMIC_CLK);
  2817. break;
  2818. case RT5682S_DMIC1_CLK_GPIO3: /* share with BCLK2 */
  2819. regmap_update_bits(rt5682s->regmap, RT5682S_GPIO_CTRL_1,
  2820. RT5682S_GP3_PIN_MASK, RT5682S_GP3_PIN_DMIC_CLK);
  2821. if (rt5682s->pdata.dmic_clk_driving_high)
  2822. regmap_update_bits(rt5682s->regmap, RT5682S_PAD_DRIVING_CTRL,
  2823. RT5682S_PAD_DRV_GP3_MASK, RT5682S_PAD_DRV_GP3_HIGH);
  2824. break;
  2825. default:
  2826. dev_warn(&i2c->dev, "invalid DMIC_CLK pin\n");
  2827. break;
  2828. }
  2829. INIT_DELAYED_WORK(&rt5682s->jack_detect_work, rt5682s_jack_detect_handler);
  2830. INIT_DELAYED_WORK(&rt5682s->jd_check_work, rt5682s_jd_check_handler);
  2831. if (i2c->irq) {
  2832. ret = devm_request_threaded_irq(&i2c->dev, i2c->irq, NULL, rt5682s_irq,
  2833. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
  2834. "rt5682s", rt5682s);
  2835. if (ret)
  2836. dev_err(&i2c->dev, "Failed to reguest IRQ: %d\n", ret);
  2837. }
  2838. return devm_snd_soc_register_component(&i2c->dev, &rt5682s_soc_component_dev,
  2839. rt5682s_dai, ARRAY_SIZE(rt5682s_dai));
  2840. }
  2841. static void rt5682s_i2c_shutdown(struct i2c_client *client)
  2842. {
  2843. struct rt5682s_priv *rt5682s = i2c_get_clientdata(client);
  2844. disable_irq(client->irq);
  2845. cancel_delayed_work_sync(&rt5682s->jack_detect_work);
  2846. cancel_delayed_work_sync(&rt5682s->jd_check_work);
  2847. rt5682s_reset(rt5682s);
  2848. }
  2849. static void rt5682s_i2c_remove(struct i2c_client *client)
  2850. {
  2851. rt5682s_i2c_shutdown(client);
  2852. }
  2853. static const struct of_device_id rt5682s_of_match[] = {
  2854. {.compatible = "realtek,rt5682s"},
  2855. {},
  2856. };
  2857. MODULE_DEVICE_TABLE(of, rt5682s_of_match);
  2858. static const struct acpi_device_id rt5682s_acpi_match[] = {
  2859. {"RTL5682", 0,},
  2860. {},
  2861. };
  2862. MODULE_DEVICE_TABLE(acpi, rt5682s_acpi_match);
  2863. static const struct i2c_device_id rt5682s_i2c_id[] = {
  2864. {"rt5682s", 0},
  2865. {}
  2866. };
  2867. MODULE_DEVICE_TABLE(i2c, rt5682s_i2c_id);
  2868. static struct i2c_driver rt5682s_i2c_driver = {
  2869. .driver = {
  2870. .name = "rt5682s",
  2871. .of_match_table = rt5682s_of_match,
  2872. .acpi_match_table = rt5682s_acpi_match,
  2873. .probe_type = PROBE_PREFER_ASYNCHRONOUS,
  2874. },
  2875. .probe_new = rt5682s_i2c_probe,
  2876. .remove = rt5682s_i2c_remove,
  2877. .shutdown = rt5682s_i2c_shutdown,
  2878. .id_table = rt5682s_i2c_id,
  2879. };
  2880. module_i2c_driver(rt5682s_i2c_driver);
  2881. MODULE_DESCRIPTION("ASoC RT5682I-VS driver");
  2882. MODULE_AUTHOR("Derek Fang <[email protected]>");
  2883. MODULE_LICENSE("GPL v2");