rt5640.c 94 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * rt5640.c -- RT5640/RT5639 ALSA SoC audio codec driver
  4. *
  5. * Copyright 2011 Realtek Semiconductor Corp.
  6. * Author: Johnny Hsu <[email protected]>
  7. * Copyright (c) 2013, NVIDIA CORPORATION. All rights reserved.
  8. */
  9. #include <linux/module.h>
  10. #include <linux/moduleparam.h>
  11. #include <linux/init.h>
  12. #include <linux/delay.h>
  13. #include <linux/pm.h>
  14. #include <linux/gpio.h>
  15. #include <linux/i2c.h>
  16. #include <linux/regmap.h>
  17. #include <linux/of.h>
  18. #include <linux/of_gpio.h>
  19. #include <linux/platform_device.h>
  20. #include <linux/spi/spi.h>
  21. #include <linux/acpi.h>
  22. #include <sound/core.h>
  23. #include <sound/jack.h>
  24. #include <sound/pcm.h>
  25. #include <sound/pcm_params.h>
  26. #include <sound/soc.h>
  27. #include <sound/soc-dapm.h>
  28. #include <sound/initval.h>
  29. #include <sound/tlv.h>
  30. #include "rl6231.h"
  31. #include "rt5640.h"
  32. #define RT5640_DEVICE_ID 0x6231
  33. #define RT5640_PR_RANGE_BASE (0xff + 1)
  34. #define RT5640_PR_SPACING 0x100
  35. #define RT5640_PR_BASE (RT5640_PR_RANGE_BASE + (0 * RT5640_PR_SPACING))
  36. static const struct regmap_range_cfg rt5640_ranges[] = {
  37. { .name = "PR", .range_min = RT5640_PR_BASE,
  38. .range_max = RT5640_PR_BASE + 0xb4,
  39. .selector_reg = RT5640_PRIV_INDEX,
  40. .selector_mask = 0xff,
  41. .selector_shift = 0x0,
  42. .window_start = RT5640_PRIV_DATA,
  43. .window_len = 0x1, },
  44. };
  45. static const struct reg_sequence init_list[] = {
  46. {RT5640_PR_BASE + 0x3d, 0x3600},
  47. {RT5640_PR_BASE + 0x12, 0x0aa8},
  48. {RT5640_PR_BASE + 0x14, 0x0aaa},
  49. {RT5640_PR_BASE + 0x20, 0x6110},
  50. {RT5640_PR_BASE + 0x21, 0xe0e0},
  51. {RT5640_PR_BASE + 0x23, 0x1804},
  52. };
  53. static const struct reg_default rt5640_reg[] = {
  54. { 0x00, 0x000e },
  55. { 0x01, 0xc8c8 },
  56. { 0x02, 0xc8c8 },
  57. { 0x03, 0xc8c8 },
  58. { 0x04, 0x8000 },
  59. { 0x0d, 0x0000 },
  60. { 0x0e, 0x0000 },
  61. { 0x0f, 0x0808 },
  62. { 0x19, 0xafaf },
  63. { 0x1a, 0xafaf },
  64. { 0x1b, 0x0000 },
  65. { 0x1c, 0x2f2f },
  66. { 0x1d, 0x2f2f },
  67. { 0x1e, 0x0000 },
  68. { 0x27, 0x7060 },
  69. { 0x28, 0x7070 },
  70. { 0x29, 0x8080 },
  71. { 0x2a, 0x5454 },
  72. { 0x2b, 0x5454 },
  73. { 0x2c, 0xaa00 },
  74. { 0x2d, 0x0000 },
  75. { 0x2e, 0xa000 },
  76. { 0x2f, 0x0000 },
  77. { 0x3b, 0x0000 },
  78. { 0x3c, 0x007f },
  79. { 0x3d, 0x0000 },
  80. { 0x3e, 0x007f },
  81. { 0x45, 0xe000 },
  82. { 0x46, 0x003e },
  83. { 0x47, 0x003e },
  84. { 0x48, 0xf800 },
  85. { 0x49, 0x3800 },
  86. { 0x4a, 0x0004 },
  87. { 0x4c, 0xfc00 },
  88. { 0x4d, 0x0000 },
  89. { 0x4f, 0x01ff },
  90. { 0x50, 0x0000 },
  91. { 0x51, 0x0000 },
  92. { 0x52, 0x01ff },
  93. { 0x53, 0xf000 },
  94. { 0x61, 0x0000 },
  95. { 0x62, 0x0000 },
  96. { 0x63, 0x00c0 },
  97. { 0x64, 0x0000 },
  98. { 0x65, 0x0000 },
  99. { 0x66, 0x0000 },
  100. { 0x6a, 0x0000 },
  101. { 0x6c, 0x0000 },
  102. { 0x70, 0x8000 },
  103. { 0x71, 0x8000 },
  104. { 0x72, 0x8000 },
  105. { 0x73, 0x1114 },
  106. { 0x74, 0x0c00 },
  107. { 0x75, 0x1d00 },
  108. { 0x80, 0x0000 },
  109. { 0x81, 0x0000 },
  110. { 0x82, 0x0000 },
  111. { 0x83, 0x0000 },
  112. { 0x84, 0x0000 },
  113. { 0x85, 0x0008 },
  114. { 0x89, 0x0000 },
  115. { 0x8a, 0x0000 },
  116. { 0x8b, 0x0600 },
  117. { 0x8c, 0x0228 },
  118. { 0x8d, 0xa000 },
  119. { 0x8e, 0x0004 },
  120. { 0x8f, 0x1100 },
  121. { 0x90, 0x0646 },
  122. { 0x91, 0x0c00 },
  123. { 0x92, 0x0000 },
  124. { 0x93, 0x3000 },
  125. { 0xb0, 0x2080 },
  126. { 0xb1, 0x0000 },
  127. { 0xb4, 0x2206 },
  128. { 0xb5, 0x1f00 },
  129. { 0xb6, 0x0000 },
  130. { 0xb8, 0x034b },
  131. { 0xb9, 0x0066 },
  132. { 0xba, 0x000b },
  133. { 0xbb, 0x0000 },
  134. { 0xbc, 0x0000 },
  135. { 0xbd, 0x0000 },
  136. { 0xbe, 0x0000 },
  137. { 0xbf, 0x0000 },
  138. { 0xc0, 0x0400 },
  139. { 0xc2, 0x0000 },
  140. { 0xc4, 0x0000 },
  141. { 0xc5, 0x0000 },
  142. { 0xc6, 0x2000 },
  143. { 0xc8, 0x0000 },
  144. { 0xc9, 0x0000 },
  145. { 0xca, 0x0000 },
  146. { 0xcb, 0x0000 },
  147. { 0xcc, 0x0000 },
  148. { 0xcf, 0x0013 },
  149. { 0xd0, 0x0680 },
  150. { 0xd1, 0x1c17 },
  151. { 0xd2, 0x8c00 },
  152. { 0xd3, 0xaa20 },
  153. { 0xd6, 0x0400 },
  154. { 0xd9, 0x0809 },
  155. { 0xfe, 0x10ec },
  156. { 0xff, 0x6231 },
  157. };
  158. static int rt5640_reset(struct snd_soc_component *component)
  159. {
  160. return snd_soc_component_write(component, RT5640_RESET, 0);
  161. }
  162. static bool rt5640_volatile_register(struct device *dev, unsigned int reg)
  163. {
  164. int i;
  165. for (i = 0; i < ARRAY_SIZE(rt5640_ranges); i++)
  166. if ((reg >= rt5640_ranges[i].window_start &&
  167. reg <= rt5640_ranges[i].window_start +
  168. rt5640_ranges[i].window_len) ||
  169. (reg >= rt5640_ranges[i].range_min &&
  170. reg <= rt5640_ranges[i].range_max))
  171. return true;
  172. switch (reg) {
  173. case RT5640_RESET:
  174. case RT5640_ASRC_5:
  175. case RT5640_EQ_CTRL1:
  176. case RT5640_DRC_AGC_1:
  177. case RT5640_ANC_CTRL1:
  178. case RT5640_IRQ_CTRL2:
  179. case RT5640_INT_IRQ_ST:
  180. case RT5640_DSP_CTRL2:
  181. case RT5640_DSP_CTRL3:
  182. case RT5640_PRIV_INDEX:
  183. case RT5640_PRIV_DATA:
  184. case RT5640_PGM_REG_ARR1:
  185. case RT5640_PGM_REG_ARR3:
  186. case RT5640_DUMMY2:
  187. case RT5640_VENDOR_ID:
  188. case RT5640_VENDOR_ID1:
  189. case RT5640_VENDOR_ID2:
  190. return true;
  191. default:
  192. return false;
  193. }
  194. }
  195. static bool rt5640_readable_register(struct device *dev, unsigned int reg)
  196. {
  197. int i;
  198. for (i = 0; i < ARRAY_SIZE(rt5640_ranges); i++)
  199. if ((reg >= rt5640_ranges[i].window_start &&
  200. reg <= rt5640_ranges[i].window_start +
  201. rt5640_ranges[i].window_len) ||
  202. (reg >= rt5640_ranges[i].range_min &&
  203. reg <= rt5640_ranges[i].range_max))
  204. return true;
  205. switch (reg) {
  206. case RT5640_RESET:
  207. case RT5640_SPK_VOL:
  208. case RT5640_HP_VOL:
  209. case RT5640_OUTPUT:
  210. case RT5640_MONO_OUT:
  211. case RT5640_IN1_IN2:
  212. case RT5640_IN3_IN4:
  213. case RT5640_INL_INR_VOL:
  214. case RT5640_DAC1_DIG_VOL:
  215. case RT5640_DAC2_DIG_VOL:
  216. case RT5640_DAC2_CTRL:
  217. case RT5640_ADC_DIG_VOL:
  218. case RT5640_ADC_DATA:
  219. case RT5640_ADC_BST_VOL:
  220. case RT5640_STO_ADC_MIXER:
  221. case RT5640_MONO_ADC_MIXER:
  222. case RT5640_AD_DA_MIXER:
  223. case RT5640_STO_DAC_MIXER:
  224. case RT5640_MONO_DAC_MIXER:
  225. case RT5640_DIG_MIXER:
  226. case RT5640_DSP_PATH1:
  227. case RT5640_DSP_PATH2:
  228. case RT5640_DIG_INF_DATA:
  229. case RT5640_REC_L1_MIXER:
  230. case RT5640_REC_L2_MIXER:
  231. case RT5640_REC_R1_MIXER:
  232. case RT5640_REC_R2_MIXER:
  233. case RT5640_HPO_MIXER:
  234. case RT5640_SPK_L_MIXER:
  235. case RT5640_SPK_R_MIXER:
  236. case RT5640_SPO_L_MIXER:
  237. case RT5640_SPO_R_MIXER:
  238. case RT5640_SPO_CLSD_RATIO:
  239. case RT5640_MONO_MIXER:
  240. case RT5640_OUT_L1_MIXER:
  241. case RT5640_OUT_L2_MIXER:
  242. case RT5640_OUT_L3_MIXER:
  243. case RT5640_OUT_R1_MIXER:
  244. case RT5640_OUT_R2_MIXER:
  245. case RT5640_OUT_R3_MIXER:
  246. case RT5640_LOUT_MIXER:
  247. case RT5640_PWR_DIG1:
  248. case RT5640_PWR_DIG2:
  249. case RT5640_PWR_ANLG1:
  250. case RT5640_PWR_ANLG2:
  251. case RT5640_PWR_MIXER:
  252. case RT5640_PWR_VOL:
  253. case RT5640_PRIV_INDEX:
  254. case RT5640_PRIV_DATA:
  255. case RT5640_I2S1_SDP:
  256. case RT5640_I2S2_SDP:
  257. case RT5640_ADDA_CLK1:
  258. case RT5640_ADDA_CLK2:
  259. case RT5640_DMIC:
  260. case RT5640_GLB_CLK:
  261. case RT5640_PLL_CTRL1:
  262. case RT5640_PLL_CTRL2:
  263. case RT5640_ASRC_1:
  264. case RT5640_ASRC_2:
  265. case RT5640_ASRC_3:
  266. case RT5640_ASRC_4:
  267. case RT5640_ASRC_5:
  268. case RT5640_HP_OVCD:
  269. case RT5640_CLS_D_OVCD:
  270. case RT5640_CLS_D_OUT:
  271. case RT5640_DEPOP_M1:
  272. case RT5640_DEPOP_M2:
  273. case RT5640_DEPOP_M3:
  274. case RT5640_CHARGE_PUMP:
  275. case RT5640_PV_DET_SPK_G:
  276. case RT5640_MICBIAS:
  277. case RT5640_EQ_CTRL1:
  278. case RT5640_EQ_CTRL2:
  279. case RT5640_WIND_FILTER:
  280. case RT5640_DRC_AGC_1:
  281. case RT5640_DRC_AGC_2:
  282. case RT5640_DRC_AGC_3:
  283. case RT5640_SVOL_ZC:
  284. case RT5640_ANC_CTRL1:
  285. case RT5640_ANC_CTRL2:
  286. case RT5640_ANC_CTRL3:
  287. case RT5640_JD_CTRL:
  288. case RT5640_ANC_JD:
  289. case RT5640_IRQ_CTRL1:
  290. case RT5640_IRQ_CTRL2:
  291. case RT5640_INT_IRQ_ST:
  292. case RT5640_GPIO_CTRL1:
  293. case RT5640_GPIO_CTRL2:
  294. case RT5640_GPIO_CTRL3:
  295. case RT5640_DSP_CTRL1:
  296. case RT5640_DSP_CTRL2:
  297. case RT5640_DSP_CTRL3:
  298. case RT5640_DSP_CTRL4:
  299. case RT5640_PGM_REG_ARR1:
  300. case RT5640_PGM_REG_ARR2:
  301. case RT5640_PGM_REG_ARR3:
  302. case RT5640_PGM_REG_ARR4:
  303. case RT5640_PGM_REG_ARR5:
  304. case RT5640_SCB_FUNC:
  305. case RT5640_SCB_CTRL:
  306. case RT5640_BASE_BACK:
  307. case RT5640_MP3_PLUS1:
  308. case RT5640_MP3_PLUS2:
  309. case RT5640_3D_HP:
  310. case RT5640_ADJ_HPF:
  311. case RT5640_HP_CALIB_AMP_DET:
  312. case RT5640_HP_CALIB2:
  313. case RT5640_SV_ZCD1:
  314. case RT5640_SV_ZCD2:
  315. case RT5640_DUMMY1:
  316. case RT5640_DUMMY2:
  317. case RT5640_DUMMY3:
  318. case RT5640_VENDOR_ID:
  319. case RT5640_VENDOR_ID1:
  320. case RT5640_VENDOR_ID2:
  321. return true;
  322. default:
  323. return false;
  324. }
  325. }
  326. static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -4650, 150, 0);
  327. static const DECLARE_TLV_DB_MINMAX(dac_vol_tlv, -6562, 0);
  328. static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -3450, 150, 0);
  329. static const DECLARE_TLV_DB_MINMAX(adc_vol_tlv, -1762, 3000);
  330. static const DECLARE_TLV_DB_SCALE(adc_bst_tlv, 0, 1200, 0);
  331. /* {0, +20, +24, +30, +35, +40, +44, +50, +52} dB */
  332. static const DECLARE_TLV_DB_RANGE(bst_tlv,
  333. 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0),
  334. 1, 1, TLV_DB_SCALE_ITEM(2000, 0, 0),
  335. 2, 2, TLV_DB_SCALE_ITEM(2400, 0, 0),
  336. 3, 5, TLV_DB_SCALE_ITEM(3000, 500, 0),
  337. 6, 6, TLV_DB_SCALE_ITEM(4400, 0, 0),
  338. 7, 7, TLV_DB_SCALE_ITEM(5000, 0, 0),
  339. 8, 8, TLV_DB_SCALE_ITEM(5200, 0, 0)
  340. );
  341. /* Interface data select */
  342. static const char * const rt5640_data_select[] = {
  343. "Normal", "Swap", "left copy to right", "right copy to left"};
  344. static SOC_ENUM_SINGLE_DECL(rt5640_if1_dac_enum, RT5640_DIG_INF_DATA,
  345. RT5640_IF1_DAC_SEL_SFT, rt5640_data_select);
  346. static SOC_ENUM_SINGLE_DECL(rt5640_if1_adc_enum, RT5640_DIG_INF_DATA,
  347. RT5640_IF1_ADC_SEL_SFT, rt5640_data_select);
  348. static SOC_ENUM_SINGLE_DECL(rt5640_if2_dac_enum, RT5640_DIG_INF_DATA,
  349. RT5640_IF2_DAC_SEL_SFT, rt5640_data_select);
  350. static SOC_ENUM_SINGLE_DECL(rt5640_if2_adc_enum, RT5640_DIG_INF_DATA,
  351. RT5640_IF2_ADC_SEL_SFT, rt5640_data_select);
  352. /* Class D speaker gain ratio */
  353. static const char * const rt5640_clsd_spk_ratio[] = {"1.66x", "1.83x", "1.94x",
  354. "2x", "2.11x", "2.22x", "2.33x", "2.44x", "2.55x", "2.66x", "2.77x"};
  355. static SOC_ENUM_SINGLE_DECL(rt5640_clsd_spk_ratio_enum, RT5640_CLS_D_OUT,
  356. RT5640_CLSD_RATIO_SFT, rt5640_clsd_spk_ratio);
  357. static const struct snd_kcontrol_new rt5640_snd_controls[] = {
  358. /* Speaker Output Volume */
  359. SOC_DOUBLE("Speaker Channel Switch", RT5640_SPK_VOL,
  360. RT5640_VOL_L_SFT, RT5640_VOL_R_SFT, 1, 1),
  361. SOC_DOUBLE_TLV("Speaker Playback Volume", RT5640_SPK_VOL,
  362. RT5640_L_VOL_SFT, RT5640_R_VOL_SFT, 39, 1, out_vol_tlv),
  363. /* Headphone Output Volume */
  364. SOC_DOUBLE("HP Channel Switch", RT5640_HP_VOL,
  365. RT5640_VOL_L_SFT, RT5640_VOL_R_SFT, 1, 1),
  366. SOC_DOUBLE_TLV("HP Playback Volume", RT5640_HP_VOL,
  367. RT5640_L_VOL_SFT, RT5640_R_VOL_SFT, 39, 1, out_vol_tlv),
  368. /* OUTPUT Control */
  369. SOC_DOUBLE("OUT Playback Switch", RT5640_OUTPUT,
  370. RT5640_L_MUTE_SFT, RT5640_R_MUTE_SFT, 1, 1),
  371. SOC_DOUBLE("OUT Channel Switch", RT5640_OUTPUT,
  372. RT5640_VOL_L_SFT, RT5640_VOL_R_SFT, 1, 1),
  373. SOC_DOUBLE_TLV("OUT Playback Volume", RT5640_OUTPUT,
  374. RT5640_L_VOL_SFT, RT5640_R_VOL_SFT, 39, 1, out_vol_tlv),
  375. /* DAC Digital Volume */
  376. SOC_DOUBLE("DAC2 Playback Switch", RT5640_DAC2_CTRL,
  377. RT5640_M_DAC_L2_VOL_SFT, RT5640_M_DAC_R2_VOL_SFT, 1, 1),
  378. SOC_DOUBLE_TLV("DAC2 Playback Volume", RT5640_DAC2_DIG_VOL,
  379. RT5640_L_VOL_SFT, RT5640_R_VOL_SFT,
  380. 175, 0, dac_vol_tlv),
  381. SOC_DOUBLE_TLV("DAC1 Playback Volume", RT5640_DAC1_DIG_VOL,
  382. RT5640_L_VOL_SFT, RT5640_R_VOL_SFT,
  383. 175, 0, dac_vol_tlv),
  384. /* IN1/IN2/IN3 Control */
  385. SOC_SINGLE_TLV("IN1 Boost", RT5640_IN1_IN2,
  386. RT5640_BST_SFT1, 8, 0, bst_tlv),
  387. SOC_SINGLE_TLV("IN2 Boost", RT5640_IN3_IN4,
  388. RT5640_BST_SFT2, 8, 0, bst_tlv),
  389. SOC_SINGLE_TLV("IN3 Boost", RT5640_IN1_IN2,
  390. RT5640_BST_SFT2, 8, 0, bst_tlv),
  391. /* INL/INR Volume Control */
  392. SOC_DOUBLE_TLV("IN Capture Volume", RT5640_INL_INR_VOL,
  393. RT5640_INL_VOL_SFT, RT5640_INR_VOL_SFT,
  394. 31, 1, in_vol_tlv),
  395. /* ADC Digital Volume Control */
  396. SOC_DOUBLE("ADC Capture Switch", RT5640_ADC_DIG_VOL,
  397. RT5640_L_MUTE_SFT, RT5640_R_MUTE_SFT, 1, 1),
  398. SOC_DOUBLE_TLV("ADC Capture Volume", RT5640_ADC_DIG_VOL,
  399. RT5640_L_VOL_SFT, RT5640_R_VOL_SFT,
  400. 127, 0, adc_vol_tlv),
  401. SOC_DOUBLE("Mono ADC Capture Switch", RT5640_DUMMY1,
  402. RT5640_M_MONO_ADC_L_SFT, RT5640_M_MONO_ADC_R_SFT, 1, 1),
  403. SOC_DOUBLE_TLV("Mono ADC Capture Volume", RT5640_ADC_DATA,
  404. RT5640_L_VOL_SFT, RT5640_R_VOL_SFT,
  405. 127, 0, adc_vol_tlv),
  406. /* ADC Boost Volume Control */
  407. SOC_DOUBLE_TLV("ADC Boost Gain", RT5640_ADC_BST_VOL,
  408. RT5640_ADC_L_BST_SFT, RT5640_ADC_R_BST_SFT,
  409. 3, 0, adc_bst_tlv),
  410. /* Class D speaker gain ratio */
  411. SOC_ENUM("Class D SPK Ratio Control", rt5640_clsd_spk_ratio_enum),
  412. SOC_ENUM("ADC IF1 Data Switch", rt5640_if1_adc_enum),
  413. SOC_ENUM("DAC IF1 Data Switch", rt5640_if1_dac_enum),
  414. SOC_ENUM("ADC IF2 Data Switch", rt5640_if2_adc_enum),
  415. SOC_ENUM("DAC IF2 Data Switch", rt5640_if2_dac_enum),
  416. };
  417. static const struct snd_kcontrol_new rt5640_specific_snd_controls[] = {
  418. /* MONO Output Control */
  419. SOC_SINGLE("Mono Playback Switch", RT5640_MONO_OUT, RT5640_L_MUTE_SFT,
  420. 1, 1),
  421. };
  422. /**
  423. * set_dmic_clk - Set parameter of dmic.
  424. *
  425. * @w: DAPM widget.
  426. * @kcontrol: The kcontrol of this widget.
  427. * @event: Event id.
  428. *
  429. */
  430. static int set_dmic_clk(struct snd_soc_dapm_widget *w,
  431. struct snd_kcontrol *kcontrol, int event)
  432. {
  433. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  434. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  435. int idx, rate;
  436. rate = rt5640->sysclk / rl6231_get_pre_div(rt5640->regmap,
  437. RT5640_ADDA_CLK1, RT5640_I2S_PD1_SFT);
  438. idx = rl6231_calc_dmic_clk(rate);
  439. if (idx < 0)
  440. dev_err(component->dev, "Failed to set DMIC clock\n");
  441. else
  442. snd_soc_component_update_bits(component, RT5640_DMIC, RT5640_DMIC_CLK_MASK,
  443. idx << RT5640_DMIC_CLK_SFT);
  444. return idx;
  445. }
  446. static int is_using_asrc(struct snd_soc_dapm_widget *source,
  447. struct snd_soc_dapm_widget *sink)
  448. {
  449. struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);
  450. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  451. if (!rt5640->asrc_en)
  452. return 0;
  453. return 1;
  454. }
  455. /* Digital Mixer */
  456. static const struct snd_kcontrol_new rt5640_sto_adc_l_mix[] = {
  457. SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER,
  458. RT5640_M_ADC_L1_SFT, 1, 1),
  459. SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER,
  460. RT5640_M_ADC_L2_SFT, 1, 1),
  461. };
  462. static const struct snd_kcontrol_new rt5640_sto_adc_r_mix[] = {
  463. SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER,
  464. RT5640_M_ADC_R1_SFT, 1, 1),
  465. SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER,
  466. RT5640_M_ADC_R2_SFT, 1, 1),
  467. };
  468. static const struct snd_kcontrol_new rt5640_mono_adc_l_mix[] = {
  469. SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER,
  470. RT5640_M_MONO_ADC_L1_SFT, 1, 1),
  471. SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER,
  472. RT5640_M_MONO_ADC_L2_SFT, 1, 1),
  473. };
  474. static const struct snd_kcontrol_new rt5640_mono_adc_r_mix[] = {
  475. SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER,
  476. RT5640_M_MONO_ADC_R1_SFT, 1, 1),
  477. SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER,
  478. RT5640_M_MONO_ADC_R2_SFT, 1, 1),
  479. };
  480. static const struct snd_kcontrol_new rt5640_dac_l_mix[] = {
  481. SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER,
  482. RT5640_M_ADCMIX_L_SFT, 1, 1),
  483. SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER,
  484. RT5640_M_IF1_DAC_L_SFT, 1, 1),
  485. };
  486. static const struct snd_kcontrol_new rt5640_dac_r_mix[] = {
  487. SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER,
  488. RT5640_M_ADCMIX_R_SFT, 1, 1),
  489. SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER,
  490. RT5640_M_IF1_DAC_R_SFT, 1, 1),
  491. };
  492. static const struct snd_kcontrol_new rt5640_sto_dac_l_mix[] = {
  493. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER,
  494. RT5640_M_DAC_L1_SFT, 1, 1),
  495. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER,
  496. RT5640_M_DAC_L2_SFT, 1, 1),
  497. SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER,
  498. RT5640_M_ANC_DAC_L_SFT, 1, 1),
  499. };
  500. static const struct snd_kcontrol_new rt5640_sto_dac_r_mix[] = {
  501. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER,
  502. RT5640_M_DAC_R1_SFT, 1, 1),
  503. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER,
  504. RT5640_M_DAC_R2_SFT, 1, 1),
  505. SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER,
  506. RT5640_M_ANC_DAC_R_SFT, 1, 1),
  507. };
  508. static const struct snd_kcontrol_new rt5639_sto_dac_l_mix[] = {
  509. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER,
  510. RT5640_M_DAC_L1_SFT, 1, 1),
  511. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER,
  512. RT5640_M_DAC_L2_SFT, 1, 1),
  513. };
  514. static const struct snd_kcontrol_new rt5639_sto_dac_r_mix[] = {
  515. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER,
  516. RT5640_M_DAC_R1_SFT, 1, 1),
  517. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER,
  518. RT5640_M_DAC_R2_SFT, 1, 1),
  519. };
  520. static const struct snd_kcontrol_new rt5640_mono_dac_l_mix[] = {
  521. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_MONO_DAC_MIXER,
  522. RT5640_M_DAC_L1_MONO_L_SFT, 1, 1),
  523. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER,
  524. RT5640_M_DAC_L2_MONO_L_SFT, 1, 1),
  525. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER,
  526. RT5640_M_DAC_R2_MONO_L_SFT, 1, 1),
  527. };
  528. static const struct snd_kcontrol_new rt5640_mono_dac_r_mix[] = {
  529. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_MONO_DAC_MIXER,
  530. RT5640_M_DAC_R1_MONO_R_SFT, 1, 1),
  531. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER,
  532. RT5640_M_DAC_R2_MONO_R_SFT, 1, 1),
  533. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER,
  534. RT5640_M_DAC_L2_MONO_R_SFT, 1, 1),
  535. };
  536. static const struct snd_kcontrol_new rt5640_dig_l_mix[] = {
  537. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_DIG_MIXER,
  538. RT5640_M_STO_L_DAC_L_SFT, 1, 1),
  539. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_DIG_MIXER,
  540. RT5640_M_DAC_L2_DAC_L_SFT, 1, 1),
  541. };
  542. static const struct snd_kcontrol_new rt5640_dig_r_mix[] = {
  543. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_DIG_MIXER,
  544. RT5640_M_STO_R_DAC_R_SFT, 1, 1),
  545. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_DIG_MIXER,
  546. RT5640_M_DAC_R2_DAC_R_SFT, 1, 1),
  547. };
  548. /* Analog Input Mixer */
  549. static const struct snd_kcontrol_new rt5640_rec_l_mix[] = {
  550. SOC_DAPM_SINGLE("HPOL Switch", RT5640_REC_L2_MIXER,
  551. RT5640_M_HP_L_RM_L_SFT, 1, 1),
  552. SOC_DAPM_SINGLE("INL Switch", RT5640_REC_L2_MIXER,
  553. RT5640_M_IN_L_RM_L_SFT, 1, 1),
  554. SOC_DAPM_SINGLE("BST3 Switch", RT5640_REC_L2_MIXER,
  555. RT5640_M_BST2_RM_L_SFT, 1, 1),
  556. SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_L2_MIXER,
  557. RT5640_M_BST4_RM_L_SFT, 1, 1),
  558. SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_L2_MIXER,
  559. RT5640_M_BST1_RM_L_SFT, 1, 1),
  560. SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_REC_L2_MIXER,
  561. RT5640_M_OM_L_RM_L_SFT, 1, 1),
  562. };
  563. static const struct snd_kcontrol_new rt5640_rec_r_mix[] = {
  564. SOC_DAPM_SINGLE("HPOR Switch", RT5640_REC_R2_MIXER,
  565. RT5640_M_HP_R_RM_R_SFT, 1, 1),
  566. SOC_DAPM_SINGLE("INR Switch", RT5640_REC_R2_MIXER,
  567. RT5640_M_IN_R_RM_R_SFT, 1, 1),
  568. SOC_DAPM_SINGLE("BST3 Switch", RT5640_REC_R2_MIXER,
  569. RT5640_M_BST2_RM_R_SFT, 1, 1),
  570. SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_R2_MIXER,
  571. RT5640_M_BST4_RM_R_SFT, 1, 1),
  572. SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_R2_MIXER,
  573. RT5640_M_BST1_RM_R_SFT, 1, 1),
  574. SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_REC_R2_MIXER,
  575. RT5640_M_OM_R_RM_R_SFT, 1, 1),
  576. };
  577. /* Analog Output Mixer */
  578. static const struct snd_kcontrol_new rt5640_spk_l_mix[] = {
  579. SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_SPK_L_MIXER,
  580. RT5640_M_RM_L_SM_L_SFT, 1, 1),
  581. SOC_DAPM_SINGLE("INL Switch", RT5640_SPK_L_MIXER,
  582. RT5640_M_IN_L_SM_L_SFT, 1, 1),
  583. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPK_L_MIXER,
  584. RT5640_M_DAC_L1_SM_L_SFT, 1, 1),
  585. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_SPK_L_MIXER,
  586. RT5640_M_DAC_L2_SM_L_SFT, 1, 1),
  587. SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_SPK_L_MIXER,
  588. RT5640_M_OM_L_SM_L_SFT, 1, 1),
  589. };
  590. static const struct snd_kcontrol_new rt5640_spk_r_mix[] = {
  591. SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_SPK_R_MIXER,
  592. RT5640_M_RM_R_SM_R_SFT, 1, 1),
  593. SOC_DAPM_SINGLE("INR Switch", RT5640_SPK_R_MIXER,
  594. RT5640_M_IN_R_SM_R_SFT, 1, 1),
  595. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPK_R_MIXER,
  596. RT5640_M_DAC_R1_SM_R_SFT, 1, 1),
  597. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_SPK_R_MIXER,
  598. RT5640_M_DAC_R2_SM_R_SFT, 1, 1),
  599. SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_SPK_R_MIXER,
  600. RT5640_M_OM_R_SM_R_SFT, 1, 1),
  601. };
  602. static const struct snd_kcontrol_new rt5640_out_l_mix[] = {
  603. SOC_DAPM_SINGLE("SPK MIXL Switch", RT5640_OUT_L3_MIXER,
  604. RT5640_M_SM_L_OM_L_SFT, 1, 1),
  605. SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER,
  606. RT5640_M_BST1_OM_L_SFT, 1, 1),
  607. SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER,
  608. RT5640_M_IN_L_OM_L_SFT, 1, 1),
  609. SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER,
  610. RT5640_M_RM_L_OM_L_SFT, 1, 1),
  611. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_L3_MIXER,
  612. RT5640_M_DAC_R2_OM_L_SFT, 1, 1),
  613. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_L3_MIXER,
  614. RT5640_M_DAC_L2_OM_L_SFT, 1, 1),
  615. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER,
  616. RT5640_M_DAC_L1_OM_L_SFT, 1, 1),
  617. };
  618. static const struct snd_kcontrol_new rt5640_out_r_mix[] = {
  619. SOC_DAPM_SINGLE("SPK MIXR Switch", RT5640_OUT_R3_MIXER,
  620. RT5640_M_SM_L_OM_R_SFT, 1, 1),
  621. SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER,
  622. RT5640_M_BST4_OM_R_SFT, 1, 1),
  623. SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER,
  624. RT5640_M_BST1_OM_R_SFT, 1, 1),
  625. SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER,
  626. RT5640_M_IN_R_OM_R_SFT, 1, 1),
  627. SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER,
  628. RT5640_M_RM_R_OM_R_SFT, 1, 1),
  629. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_R3_MIXER,
  630. RT5640_M_DAC_L2_OM_R_SFT, 1, 1),
  631. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_R3_MIXER,
  632. RT5640_M_DAC_R2_OM_R_SFT, 1, 1),
  633. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER,
  634. RT5640_M_DAC_R1_OM_R_SFT, 1, 1),
  635. };
  636. static const struct snd_kcontrol_new rt5639_out_l_mix[] = {
  637. SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER,
  638. RT5640_M_BST1_OM_L_SFT, 1, 1),
  639. SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER,
  640. RT5640_M_IN_L_OM_L_SFT, 1, 1),
  641. SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER,
  642. RT5640_M_RM_L_OM_L_SFT, 1, 1),
  643. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER,
  644. RT5640_M_DAC_L1_OM_L_SFT, 1, 1),
  645. };
  646. static const struct snd_kcontrol_new rt5639_out_r_mix[] = {
  647. SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER,
  648. RT5640_M_BST4_OM_R_SFT, 1, 1),
  649. SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER,
  650. RT5640_M_BST1_OM_R_SFT, 1, 1),
  651. SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER,
  652. RT5640_M_IN_R_OM_R_SFT, 1, 1),
  653. SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER,
  654. RT5640_M_RM_R_OM_R_SFT, 1, 1),
  655. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER,
  656. RT5640_M_DAC_R1_OM_R_SFT, 1, 1),
  657. };
  658. static const struct snd_kcontrol_new rt5640_spo_l_mix[] = {
  659. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_L_MIXER,
  660. RT5640_M_DAC_R1_SPM_L_SFT, 1, 1),
  661. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPO_L_MIXER,
  662. RT5640_M_DAC_L1_SPM_L_SFT, 1, 1),
  663. SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_L_MIXER,
  664. RT5640_M_SV_R_SPM_L_SFT, 1, 1),
  665. SOC_DAPM_SINGLE("SPKVOL L Switch", RT5640_SPO_L_MIXER,
  666. RT5640_M_SV_L_SPM_L_SFT, 1, 1),
  667. SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_L_MIXER,
  668. RT5640_M_BST1_SPM_L_SFT, 1, 1),
  669. };
  670. static const struct snd_kcontrol_new rt5640_spo_r_mix[] = {
  671. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_R_MIXER,
  672. RT5640_M_DAC_R1_SPM_R_SFT, 1, 1),
  673. SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_R_MIXER,
  674. RT5640_M_SV_R_SPM_R_SFT, 1, 1),
  675. SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_R_MIXER,
  676. RT5640_M_BST1_SPM_R_SFT, 1, 1),
  677. };
  678. static const struct snd_kcontrol_new rt5640_hpo_mix[] = {
  679. SOC_DAPM_SINGLE("HPO MIX DAC2 Switch", RT5640_HPO_MIXER,
  680. RT5640_M_DAC2_HM_SFT, 1, 1),
  681. SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER,
  682. RT5640_M_DAC1_HM_SFT, 1, 1),
  683. SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER,
  684. RT5640_M_HPVOL_HM_SFT, 1, 1),
  685. };
  686. static const struct snd_kcontrol_new rt5639_hpo_mix[] = {
  687. SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER,
  688. RT5640_M_DAC1_HM_SFT, 1, 1),
  689. SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER,
  690. RT5640_M_HPVOL_HM_SFT, 1, 1),
  691. };
  692. static const struct snd_kcontrol_new rt5640_lout_mix[] = {
  693. SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_LOUT_MIXER,
  694. RT5640_M_DAC_L1_LM_SFT, 1, 1),
  695. SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_LOUT_MIXER,
  696. RT5640_M_DAC_R1_LM_SFT, 1, 1),
  697. SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_LOUT_MIXER,
  698. RT5640_M_OV_L_LM_SFT, 1, 1),
  699. SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_LOUT_MIXER,
  700. RT5640_M_OV_R_LM_SFT, 1, 1),
  701. };
  702. static const struct snd_kcontrol_new rt5640_mono_mix[] = {
  703. SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_MIXER,
  704. RT5640_M_DAC_R2_MM_SFT, 1, 1),
  705. SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_MIXER,
  706. RT5640_M_DAC_L2_MM_SFT, 1, 1),
  707. SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_MONO_MIXER,
  708. RT5640_M_OV_R_MM_SFT, 1, 1),
  709. SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_MONO_MIXER,
  710. RT5640_M_OV_L_MM_SFT, 1, 1),
  711. SOC_DAPM_SINGLE("BST1 Switch", RT5640_MONO_MIXER,
  712. RT5640_M_BST1_MM_SFT, 1, 1),
  713. };
  714. static const struct snd_kcontrol_new spk_l_enable_control =
  715. SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL,
  716. RT5640_L_MUTE_SFT, 1, 1);
  717. static const struct snd_kcontrol_new spk_r_enable_control =
  718. SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL,
  719. RT5640_R_MUTE_SFT, 1, 1);
  720. static const struct snd_kcontrol_new hp_l_enable_control =
  721. SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL,
  722. RT5640_L_MUTE_SFT, 1, 1);
  723. static const struct snd_kcontrol_new hp_r_enable_control =
  724. SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL,
  725. RT5640_R_MUTE_SFT, 1, 1);
  726. /* Stereo ADC source */
  727. static const char * const rt5640_stereo_adc1_src[] = {
  728. "DIG MIX", "ADC"
  729. };
  730. static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc1_enum, RT5640_STO_ADC_MIXER,
  731. RT5640_ADC_1_SRC_SFT, rt5640_stereo_adc1_src);
  732. static const struct snd_kcontrol_new rt5640_sto_adc_1_mux =
  733. SOC_DAPM_ENUM("Stereo ADC1 Mux", rt5640_stereo_adc1_enum);
  734. static const char * const rt5640_stereo_adc2_src[] = {
  735. "DMIC1", "DMIC2", "DIG MIX"
  736. };
  737. static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc2_enum, RT5640_STO_ADC_MIXER,
  738. RT5640_ADC_2_SRC_SFT, rt5640_stereo_adc2_src);
  739. static const struct snd_kcontrol_new rt5640_sto_adc_2_mux =
  740. SOC_DAPM_ENUM("Stereo ADC2 Mux", rt5640_stereo_adc2_enum);
  741. /* Mono ADC source */
  742. static const char * const rt5640_mono_adc_l1_src[] = {
  743. "Mono DAC MIXL", "ADCL"
  744. };
  745. static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l1_enum, RT5640_MONO_ADC_MIXER,
  746. RT5640_MONO_ADC_L1_SRC_SFT, rt5640_mono_adc_l1_src);
  747. static const struct snd_kcontrol_new rt5640_mono_adc_l1_mux =
  748. SOC_DAPM_ENUM("Mono ADC1 left source", rt5640_mono_adc_l1_enum);
  749. static const char * const rt5640_mono_adc_l2_src[] = {
  750. "DMIC L1", "DMIC L2", "Mono DAC MIXL"
  751. };
  752. static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l2_enum, RT5640_MONO_ADC_MIXER,
  753. RT5640_MONO_ADC_L2_SRC_SFT, rt5640_mono_adc_l2_src);
  754. static const struct snd_kcontrol_new rt5640_mono_adc_l2_mux =
  755. SOC_DAPM_ENUM("Mono ADC2 left source", rt5640_mono_adc_l2_enum);
  756. static const char * const rt5640_mono_adc_r1_src[] = {
  757. "Mono DAC MIXR", "ADCR"
  758. };
  759. static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r1_enum, RT5640_MONO_ADC_MIXER,
  760. RT5640_MONO_ADC_R1_SRC_SFT, rt5640_mono_adc_r1_src);
  761. static const struct snd_kcontrol_new rt5640_mono_adc_r1_mux =
  762. SOC_DAPM_ENUM("Mono ADC1 right source", rt5640_mono_adc_r1_enum);
  763. static const char * const rt5640_mono_adc_r2_src[] = {
  764. "DMIC R1", "DMIC R2", "Mono DAC MIXR"
  765. };
  766. static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r2_enum, RT5640_MONO_ADC_MIXER,
  767. RT5640_MONO_ADC_R2_SRC_SFT, rt5640_mono_adc_r2_src);
  768. static const struct snd_kcontrol_new rt5640_mono_adc_r2_mux =
  769. SOC_DAPM_ENUM("Mono ADC2 right source", rt5640_mono_adc_r2_enum);
  770. /* DAC2 channel source */
  771. static const char * const rt5640_dac_l2_src[] = {
  772. "IF2", "Base L/R"
  773. };
  774. static int rt5640_dac_l2_values[] = {
  775. 0,
  776. 3,
  777. };
  778. static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_l2_enum,
  779. RT5640_DSP_PATH2, RT5640_DAC_L2_SEL_SFT,
  780. 0x3, rt5640_dac_l2_src, rt5640_dac_l2_values);
  781. static const struct snd_kcontrol_new rt5640_dac_l2_mux =
  782. SOC_DAPM_ENUM("DAC2 left channel source", rt5640_dac_l2_enum);
  783. static const char * const rt5640_dac_r2_src[] = {
  784. "IF2",
  785. };
  786. static int rt5640_dac_r2_values[] = {
  787. 0,
  788. };
  789. static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_r2_enum,
  790. RT5640_DSP_PATH2, RT5640_DAC_R2_SEL_SFT,
  791. 0x3, rt5640_dac_r2_src, rt5640_dac_r2_values);
  792. static const struct snd_kcontrol_new rt5640_dac_r2_mux =
  793. SOC_DAPM_ENUM("DAC2 right channel source", rt5640_dac_r2_enum);
  794. /* digital interface and iis interface map */
  795. static const char * const rt5640_dai_iis_map[] = {
  796. "1:1|2:2", "1:2|2:1", "1:1|2:1", "1:2|2:2"
  797. };
  798. static int rt5640_dai_iis_map_values[] = {
  799. 0,
  800. 5,
  801. 6,
  802. 7,
  803. };
  804. static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dai_iis_map_enum,
  805. RT5640_I2S1_SDP, RT5640_I2S_IF_SFT,
  806. 0x7, rt5640_dai_iis_map,
  807. rt5640_dai_iis_map_values);
  808. static const struct snd_kcontrol_new rt5640_dai_mux =
  809. SOC_DAPM_ENUM("DAI select", rt5640_dai_iis_map_enum);
  810. /* SDI select */
  811. static const char * const rt5640_sdi_sel[] = {
  812. "IF1", "IF2"
  813. };
  814. static SOC_ENUM_SINGLE_DECL(rt5640_sdi_sel_enum, RT5640_I2S2_SDP,
  815. RT5640_I2S2_SDI_SFT, rt5640_sdi_sel);
  816. static const struct snd_kcontrol_new rt5640_sdi_mux =
  817. SOC_DAPM_ENUM("SDI select", rt5640_sdi_sel_enum);
  818. static void hp_amp_power_on(struct snd_soc_component *component)
  819. {
  820. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  821. /* depop parameters */
  822. regmap_update_bits(rt5640->regmap, RT5640_PR_BASE +
  823. RT5640_CHPUMP_INT_REG1, 0x0700, 0x0200);
  824. regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M2,
  825. RT5640_DEPOP_MASK, RT5640_DEPOP_MAN);
  826. regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M1,
  827. RT5640_HP_CP_MASK | RT5640_HP_SG_MASK | RT5640_HP_CB_MASK,
  828. RT5640_HP_CP_PU | RT5640_HP_SG_DIS | RT5640_HP_CB_PU);
  829. regmap_write(rt5640->regmap, RT5640_PR_BASE + RT5640_HP_DCC_INT1,
  830. 0x9f00);
  831. /* headphone amp power on */
  832. regmap_update_bits(rt5640->regmap, RT5640_PWR_ANLG1,
  833. RT5640_PWR_FV1 | RT5640_PWR_FV2, 0);
  834. regmap_update_bits(rt5640->regmap, RT5640_PWR_ANLG1,
  835. RT5640_PWR_HA,
  836. RT5640_PWR_HA);
  837. usleep_range(10000, 15000);
  838. regmap_update_bits(rt5640->regmap, RT5640_PWR_ANLG1,
  839. RT5640_PWR_FV1 | RT5640_PWR_FV2 ,
  840. RT5640_PWR_FV1 | RT5640_PWR_FV2);
  841. }
  842. static void rt5640_pmu_depop(struct snd_soc_component *component)
  843. {
  844. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  845. regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M2,
  846. RT5640_DEPOP_MASK | RT5640_DIG_DP_MASK,
  847. RT5640_DEPOP_AUTO | RT5640_DIG_DP_EN);
  848. regmap_update_bits(rt5640->regmap, RT5640_CHARGE_PUMP,
  849. RT5640_PM_HP_MASK, RT5640_PM_HP_HV);
  850. regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M3,
  851. RT5640_CP_FQ1_MASK | RT5640_CP_FQ2_MASK | RT5640_CP_FQ3_MASK,
  852. (RT5640_CP_FQ_192_KHZ << RT5640_CP_FQ1_SFT) |
  853. (RT5640_CP_FQ_12_KHZ << RT5640_CP_FQ2_SFT) |
  854. (RT5640_CP_FQ_192_KHZ << RT5640_CP_FQ3_SFT));
  855. regmap_write(rt5640->regmap, RT5640_PR_BASE +
  856. RT5640_MAMP_INT_REG2, 0x1c00);
  857. regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M1,
  858. RT5640_HP_CP_MASK | RT5640_HP_SG_MASK,
  859. RT5640_HP_CP_PD | RT5640_HP_SG_EN);
  860. regmap_update_bits(rt5640->regmap, RT5640_PR_BASE +
  861. RT5640_CHPUMP_INT_REG1, 0x0700, 0x0400);
  862. }
  863. static int rt5640_hp_event(struct snd_soc_dapm_widget *w,
  864. struct snd_kcontrol *kcontrol, int event)
  865. {
  866. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  867. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  868. switch (event) {
  869. case SND_SOC_DAPM_POST_PMU:
  870. rt5640_pmu_depop(component);
  871. rt5640->hp_mute = false;
  872. break;
  873. case SND_SOC_DAPM_PRE_PMD:
  874. rt5640->hp_mute = true;
  875. msleep(70);
  876. break;
  877. default:
  878. return 0;
  879. }
  880. return 0;
  881. }
  882. static int rt5640_lout_event(struct snd_soc_dapm_widget *w,
  883. struct snd_kcontrol *kcontrol, int event)
  884. {
  885. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  886. switch (event) {
  887. case SND_SOC_DAPM_POST_PMU:
  888. hp_amp_power_on(component);
  889. snd_soc_component_update_bits(component, RT5640_PWR_ANLG1,
  890. RT5640_PWR_LM, RT5640_PWR_LM);
  891. snd_soc_component_update_bits(component, RT5640_OUTPUT,
  892. RT5640_L_MUTE | RT5640_R_MUTE, 0);
  893. break;
  894. case SND_SOC_DAPM_PRE_PMD:
  895. snd_soc_component_update_bits(component, RT5640_OUTPUT,
  896. RT5640_L_MUTE | RT5640_R_MUTE,
  897. RT5640_L_MUTE | RT5640_R_MUTE);
  898. snd_soc_component_update_bits(component, RT5640_PWR_ANLG1,
  899. RT5640_PWR_LM, 0);
  900. break;
  901. default:
  902. return 0;
  903. }
  904. return 0;
  905. }
  906. static int rt5640_hp_power_event(struct snd_soc_dapm_widget *w,
  907. struct snd_kcontrol *kcontrol, int event)
  908. {
  909. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  910. switch (event) {
  911. case SND_SOC_DAPM_POST_PMU:
  912. hp_amp_power_on(component);
  913. break;
  914. default:
  915. return 0;
  916. }
  917. return 0;
  918. }
  919. static int rt5640_hp_post_event(struct snd_soc_dapm_widget *w,
  920. struct snd_kcontrol *kcontrol, int event)
  921. {
  922. struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
  923. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  924. switch (event) {
  925. case SND_SOC_DAPM_POST_PMU:
  926. if (!rt5640->hp_mute)
  927. msleep(80);
  928. break;
  929. default:
  930. return 0;
  931. }
  932. return 0;
  933. }
  934. static const struct snd_soc_dapm_widget rt5640_dapm_widgets[] = {
  935. /* ASRC */
  936. SND_SOC_DAPM_SUPPLY_S("Stereo Filter ASRC", 1, RT5640_ASRC_1,
  937. 15, 0, NULL, 0),
  938. SND_SOC_DAPM_SUPPLY_S("I2S2 Filter ASRC", 1, RT5640_ASRC_1,
  939. 12, 0, NULL, 0),
  940. SND_SOC_DAPM_SUPPLY_S("I2S2 ASRC", 1, RT5640_ASRC_1,
  941. 11, 0, NULL, 0),
  942. SND_SOC_DAPM_SUPPLY_S("DMIC1 ASRC", 1, RT5640_ASRC_1,
  943. 9, 0, NULL, 0),
  944. SND_SOC_DAPM_SUPPLY_S("DMIC2 ASRC", 1, RT5640_ASRC_1,
  945. 8, 0, NULL, 0),
  946. /* Input Side */
  947. /* micbias */
  948. SND_SOC_DAPM_SUPPLY("LDO2", RT5640_PWR_ANLG1,
  949. RT5640_PWR_LDO2_BIT, 0, NULL, 0),
  950. SND_SOC_DAPM_SUPPLY("MICBIAS1", RT5640_PWR_ANLG2,
  951. RT5640_PWR_MB1_BIT, 0, NULL, 0),
  952. /* Input Lines */
  953. SND_SOC_DAPM_INPUT("DMIC1"),
  954. SND_SOC_DAPM_INPUT("DMIC2"),
  955. SND_SOC_DAPM_INPUT("IN1P"),
  956. SND_SOC_DAPM_INPUT("IN1N"),
  957. SND_SOC_DAPM_INPUT("IN2P"),
  958. SND_SOC_DAPM_INPUT("IN2N"),
  959. SND_SOC_DAPM_INPUT("IN3P"),
  960. SND_SOC_DAPM_INPUT("IN3N"),
  961. SND_SOC_DAPM_PGA("DMIC L1", SND_SOC_NOPM, 0, 0, NULL, 0),
  962. SND_SOC_DAPM_PGA("DMIC R1", SND_SOC_NOPM, 0, 0, NULL, 0),
  963. SND_SOC_DAPM_PGA("DMIC L2", SND_SOC_NOPM, 0, 0, NULL, 0),
  964. SND_SOC_DAPM_PGA("DMIC R2", SND_SOC_NOPM, 0, 0, NULL, 0),
  965. SND_SOC_DAPM_SUPPLY("DMIC CLK", SND_SOC_NOPM, 0, 0,
  966. set_dmic_clk, SND_SOC_DAPM_PRE_PMU),
  967. SND_SOC_DAPM_SUPPLY("DMIC1 Power", RT5640_DMIC, RT5640_DMIC_1_EN_SFT, 0,
  968. NULL, 0),
  969. SND_SOC_DAPM_SUPPLY("DMIC2 Power", RT5640_DMIC, RT5640_DMIC_2_EN_SFT, 0,
  970. NULL, 0),
  971. /* Boost */
  972. SND_SOC_DAPM_PGA("BST1", RT5640_PWR_ANLG2,
  973. RT5640_PWR_BST1_BIT, 0, NULL, 0),
  974. SND_SOC_DAPM_PGA("BST2", RT5640_PWR_ANLG2,
  975. RT5640_PWR_BST4_BIT, 0, NULL, 0),
  976. SND_SOC_DAPM_PGA("BST3", RT5640_PWR_ANLG2,
  977. RT5640_PWR_BST2_BIT, 0, NULL, 0),
  978. /* Input Volume */
  979. SND_SOC_DAPM_PGA("INL VOL", RT5640_PWR_VOL,
  980. RT5640_PWR_IN_L_BIT, 0, NULL, 0),
  981. SND_SOC_DAPM_PGA("INR VOL", RT5640_PWR_VOL,
  982. RT5640_PWR_IN_R_BIT, 0, NULL, 0),
  983. /* REC Mixer */
  984. SND_SOC_DAPM_MIXER("RECMIXL", RT5640_PWR_MIXER, RT5640_PWR_RM_L_BIT, 0,
  985. rt5640_rec_l_mix, ARRAY_SIZE(rt5640_rec_l_mix)),
  986. SND_SOC_DAPM_MIXER("RECMIXR", RT5640_PWR_MIXER, RT5640_PWR_RM_R_BIT, 0,
  987. rt5640_rec_r_mix, ARRAY_SIZE(rt5640_rec_r_mix)),
  988. /* ADCs */
  989. SND_SOC_DAPM_ADC("ADC L", NULL, RT5640_PWR_DIG1,
  990. RT5640_PWR_ADC_L_BIT, 0),
  991. SND_SOC_DAPM_ADC("ADC R", NULL, RT5640_PWR_DIG1,
  992. RT5640_PWR_ADC_R_BIT, 0),
  993. /* ADC Mux */
  994. SND_SOC_DAPM_MUX("Stereo ADC L2 Mux", SND_SOC_NOPM, 0, 0,
  995. &rt5640_sto_adc_2_mux),
  996. SND_SOC_DAPM_MUX("Stereo ADC R2 Mux", SND_SOC_NOPM, 0, 0,
  997. &rt5640_sto_adc_2_mux),
  998. SND_SOC_DAPM_MUX("Stereo ADC L1 Mux", SND_SOC_NOPM, 0, 0,
  999. &rt5640_sto_adc_1_mux),
  1000. SND_SOC_DAPM_MUX("Stereo ADC R1 Mux", SND_SOC_NOPM, 0, 0,
  1001. &rt5640_sto_adc_1_mux),
  1002. SND_SOC_DAPM_MUX("Mono ADC L2 Mux", SND_SOC_NOPM, 0, 0,
  1003. &rt5640_mono_adc_l2_mux),
  1004. SND_SOC_DAPM_MUX("Mono ADC L1 Mux", SND_SOC_NOPM, 0, 0,
  1005. &rt5640_mono_adc_l1_mux),
  1006. SND_SOC_DAPM_MUX("Mono ADC R1 Mux", SND_SOC_NOPM, 0, 0,
  1007. &rt5640_mono_adc_r1_mux),
  1008. SND_SOC_DAPM_MUX("Mono ADC R2 Mux", SND_SOC_NOPM, 0, 0,
  1009. &rt5640_mono_adc_r2_mux),
  1010. /* ADC Mixer */
  1011. SND_SOC_DAPM_SUPPLY("Stereo Filter", RT5640_PWR_DIG2,
  1012. RT5640_PWR_ADC_SF_BIT, 0, NULL, 0),
  1013. SND_SOC_DAPM_MIXER("Stereo ADC MIXL", SND_SOC_NOPM, 0, 0,
  1014. rt5640_sto_adc_l_mix, ARRAY_SIZE(rt5640_sto_adc_l_mix)),
  1015. SND_SOC_DAPM_MIXER("Stereo ADC MIXR", SND_SOC_NOPM, 0, 0,
  1016. rt5640_sto_adc_r_mix, ARRAY_SIZE(rt5640_sto_adc_r_mix)),
  1017. SND_SOC_DAPM_SUPPLY("Mono Left Filter", RT5640_PWR_DIG2,
  1018. RT5640_PWR_ADC_MF_L_BIT, 0, NULL, 0),
  1019. SND_SOC_DAPM_MIXER("Mono ADC MIXL", SND_SOC_NOPM, 0, 0,
  1020. rt5640_mono_adc_l_mix, ARRAY_SIZE(rt5640_mono_adc_l_mix)),
  1021. SND_SOC_DAPM_SUPPLY("Mono Right Filter", RT5640_PWR_DIG2,
  1022. RT5640_PWR_ADC_MF_R_BIT, 0, NULL, 0),
  1023. SND_SOC_DAPM_MIXER("Mono ADC MIXR", SND_SOC_NOPM, 0, 0,
  1024. rt5640_mono_adc_r_mix, ARRAY_SIZE(rt5640_mono_adc_r_mix)),
  1025. /* Digital Interface */
  1026. SND_SOC_DAPM_SUPPLY("I2S1", RT5640_PWR_DIG1,
  1027. RT5640_PWR_I2S1_BIT, 0, NULL, 0),
  1028. SND_SOC_DAPM_PGA("IF1 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
  1029. SND_SOC_DAPM_PGA("IF1 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
  1030. SND_SOC_DAPM_PGA("IF1 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
  1031. SND_SOC_DAPM_PGA("IF1 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
  1032. SND_SOC_DAPM_PGA("IF1 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
  1033. SND_SOC_DAPM_PGA("IF1 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
  1034. SND_SOC_DAPM_SUPPLY("I2S2", RT5640_PWR_DIG1,
  1035. RT5640_PWR_I2S2_BIT, 0, NULL, 0),
  1036. SND_SOC_DAPM_PGA("IF2 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
  1037. SND_SOC_DAPM_PGA("IF2 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
  1038. SND_SOC_DAPM_PGA("IF2 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
  1039. SND_SOC_DAPM_PGA("IF2 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
  1040. SND_SOC_DAPM_PGA("IF2 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
  1041. SND_SOC_DAPM_PGA("IF2 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
  1042. /* Digital Interface Select */
  1043. SND_SOC_DAPM_MUX("DAI1 RX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1044. SND_SOC_DAPM_MUX("DAI1 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1045. SND_SOC_DAPM_MUX("DAI1 IF1 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1046. SND_SOC_DAPM_MUX("DAI1 IF2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1047. SND_SOC_DAPM_MUX("SDI1 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_sdi_mux),
  1048. SND_SOC_DAPM_MUX("DAI2 RX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1049. SND_SOC_DAPM_MUX("DAI2 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1050. SND_SOC_DAPM_MUX("DAI2 IF1 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1051. SND_SOC_DAPM_MUX("DAI2 IF2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
  1052. SND_SOC_DAPM_MUX("SDI2 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_sdi_mux),
  1053. /* Audio Interface */
  1054. SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
  1055. SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
  1056. SND_SOC_DAPM_AIF_IN("AIF2RX", "AIF2 Playback", 0, SND_SOC_NOPM, 0, 0),
  1057. SND_SOC_DAPM_AIF_OUT("AIF2TX", "AIF2 Capture", 0, SND_SOC_NOPM, 0, 0),
  1058. /* Output Side */
  1059. /* DAC mixer before sound effect */
  1060. SND_SOC_DAPM_MIXER("DAC MIXL", SND_SOC_NOPM, 0, 0,
  1061. rt5640_dac_l_mix, ARRAY_SIZE(rt5640_dac_l_mix)),
  1062. SND_SOC_DAPM_MIXER("DAC MIXR", SND_SOC_NOPM, 0, 0,
  1063. rt5640_dac_r_mix, ARRAY_SIZE(rt5640_dac_r_mix)),
  1064. /* DAC Mixer */
  1065. SND_SOC_DAPM_MIXER("Mono DAC MIXL", SND_SOC_NOPM, 0, 0,
  1066. rt5640_mono_dac_l_mix, ARRAY_SIZE(rt5640_mono_dac_l_mix)),
  1067. SND_SOC_DAPM_MIXER("Mono DAC MIXR", SND_SOC_NOPM, 0, 0,
  1068. rt5640_mono_dac_r_mix, ARRAY_SIZE(rt5640_mono_dac_r_mix)),
  1069. SND_SOC_DAPM_MIXER("DIG MIXL", SND_SOC_NOPM, 0, 0,
  1070. rt5640_dig_l_mix, ARRAY_SIZE(rt5640_dig_l_mix)),
  1071. SND_SOC_DAPM_MIXER("DIG MIXR", SND_SOC_NOPM, 0, 0,
  1072. rt5640_dig_r_mix, ARRAY_SIZE(rt5640_dig_r_mix)),
  1073. /* DACs */
  1074. SND_SOC_DAPM_DAC("DAC L1", NULL, SND_SOC_NOPM,
  1075. 0, 0),
  1076. SND_SOC_DAPM_DAC("DAC R1", NULL, SND_SOC_NOPM,
  1077. 0, 0),
  1078. SND_SOC_DAPM_SUPPLY("DAC L1 Power", RT5640_PWR_DIG1,
  1079. RT5640_PWR_DAC_L1_BIT, 0, NULL, 0),
  1080. SND_SOC_DAPM_SUPPLY("DAC R1 Power", RT5640_PWR_DIG1,
  1081. RT5640_PWR_DAC_R1_BIT, 0, NULL, 0),
  1082. SND_SOC_DAPM_SUPPLY("DAC L2 Power", RT5640_PWR_DIG1,
  1083. RT5640_PWR_DAC_L2_BIT, 0, NULL, 0),
  1084. SND_SOC_DAPM_SUPPLY("DAC R2 Power", RT5640_PWR_DIG1,
  1085. RT5640_PWR_DAC_R2_BIT, 0, NULL, 0),
  1086. /* SPK/OUT Mixer */
  1087. SND_SOC_DAPM_MIXER("SPK MIXL", RT5640_PWR_MIXER, RT5640_PWR_SM_L_BIT,
  1088. 0, rt5640_spk_l_mix, ARRAY_SIZE(rt5640_spk_l_mix)),
  1089. SND_SOC_DAPM_MIXER("SPK MIXR", RT5640_PWR_MIXER, RT5640_PWR_SM_R_BIT,
  1090. 0, rt5640_spk_r_mix, ARRAY_SIZE(rt5640_spk_r_mix)),
  1091. /* Ouput Volume */
  1092. SND_SOC_DAPM_PGA("SPKVOL L", RT5640_PWR_VOL,
  1093. RT5640_PWR_SV_L_BIT, 0, NULL, 0),
  1094. SND_SOC_DAPM_PGA("SPKVOL R", RT5640_PWR_VOL,
  1095. RT5640_PWR_SV_R_BIT, 0, NULL, 0),
  1096. SND_SOC_DAPM_PGA("OUTVOL L", RT5640_PWR_VOL,
  1097. RT5640_PWR_OV_L_BIT, 0, NULL, 0),
  1098. SND_SOC_DAPM_PGA("OUTVOL R", RT5640_PWR_VOL,
  1099. RT5640_PWR_OV_R_BIT, 0, NULL, 0),
  1100. SND_SOC_DAPM_PGA("HPOVOL L", RT5640_PWR_VOL,
  1101. RT5640_PWR_HV_L_BIT, 0, NULL, 0),
  1102. SND_SOC_DAPM_PGA("HPOVOL R", RT5640_PWR_VOL,
  1103. RT5640_PWR_HV_R_BIT, 0, NULL, 0),
  1104. /* SPO/HPO/LOUT/Mono Mixer */
  1105. SND_SOC_DAPM_MIXER("SPOL MIX", SND_SOC_NOPM, 0,
  1106. 0, rt5640_spo_l_mix, ARRAY_SIZE(rt5640_spo_l_mix)),
  1107. SND_SOC_DAPM_MIXER("SPOR MIX", SND_SOC_NOPM, 0,
  1108. 0, rt5640_spo_r_mix, ARRAY_SIZE(rt5640_spo_r_mix)),
  1109. SND_SOC_DAPM_MIXER("LOUT MIX", SND_SOC_NOPM, 0, 0,
  1110. rt5640_lout_mix, ARRAY_SIZE(rt5640_lout_mix)),
  1111. SND_SOC_DAPM_SUPPLY_S("Improve HP Amp Drv", 1, SND_SOC_NOPM,
  1112. 0, 0, rt5640_hp_power_event, SND_SOC_DAPM_POST_PMU),
  1113. SND_SOC_DAPM_PGA_S("HP Amp", 1, SND_SOC_NOPM, 0, 0,
  1114. rt5640_hp_event,
  1115. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
  1116. SND_SOC_DAPM_PGA_S("LOUT amp", 1, SND_SOC_NOPM, 0, 0,
  1117. rt5640_lout_event,
  1118. SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
  1119. SND_SOC_DAPM_SUPPLY("HP L Amp", RT5640_PWR_ANLG1,
  1120. RT5640_PWR_HP_L_BIT, 0, NULL, 0),
  1121. SND_SOC_DAPM_SUPPLY("HP R Amp", RT5640_PWR_ANLG1,
  1122. RT5640_PWR_HP_R_BIT, 0, NULL, 0),
  1123. SND_SOC_DAPM_SUPPLY("Improve SPK Amp Drv", RT5640_PWR_DIG1,
  1124. RT5640_PWR_CLS_D_BIT, 0, NULL, 0),
  1125. /* Output Switch */
  1126. SND_SOC_DAPM_SWITCH("Speaker L Playback", SND_SOC_NOPM, 0, 0,
  1127. &spk_l_enable_control),
  1128. SND_SOC_DAPM_SWITCH("Speaker R Playback", SND_SOC_NOPM, 0, 0,
  1129. &spk_r_enable_control),
  1130. SND_SOC_DAPM_SWITCH("HP L Playback", SND_SOC_NOPM, 0, 0,
  1131. &hp_l_enable_control),
  1132. SND_SOC_DAPM_SWITCH("HP R Playback", SND_SOC_NOPM, 0, 0,
  1133. &hp_r_enable_control),
  1134. SND_SOC_DAPM_POST("HP Post", rt5640_hp_post_event),
  1135. /* Output Lines */
  1136. SND_SOC_DAPM_OUTPUT("SPOLP"),
  1137. SND_SOC_DAPM_OUTPUT("SPOLN"),
  1138. SND_SOC_DAPM_OUTPUT("SPORP"),
  1139. SND_SOC_DAPM_OUTPUT("SPORN"),
  1140. SND_SOC_DAPM_OUTPUT("HPOL"),
  1141. SND_SOC_DAPM_OUTPUT("HPOR"),
  1142. SND_SOC_DAPM_OUTPUT("LOUTL"),
  1143. SND_SOC_DAPM_OUTPUT("LOUTR"),
  1144. };
  1145. static const struct snd_soc_dapm_widget rt5640_specific_dapm_widgets[] = {
  1146. /* Audio DSP */
  1147. SND_SOC_DAPM_PGA("Audio DSP", SND_SOC_NOPM, 0, 0, NULL, 0),
  1148. /* ANC */
  1149. SND_SOC_DAPM_PGA("ANC", SND_SOC_NOPM, 0, 0, NULL, 0),
  1150. /* DAC2 channel Mux */
  1151. SND_SOC_DAPM_MUX("DAC L2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dac_l2_mux),
  1152. SND_SOC_DAPM_MUX("DAC R2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dac_r2_mux),
  1153. SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM, 0, 0,
  1154. rt5640_sto_dac_l_mix, ARRAY_SIZE(rt5640_sto_dac_l_mix)),
  1155. SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM, 0, 0,
  1156. rt5640_sto_dac_r_mix, ARRAY_SIZE(rt5640_sto_dac_r_mix)),
  1157. SND_SOC_DAPM_DAC("DAC R2", NULL, SND_SOC_NOPM, 0,
  1158. 0),
  1159. SND_SOC_DAPM_DAC("DAC L2", NULL, SND_SOC_NOPM, 0,
  1160. 0),
  1161. SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER, RT5640_PWR_OM_L_BIT,
  1162. 0, rt5640_out_l_mix, ARRAY_SIZE(rt5640_out_l_mix)),
  1163. SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER, RT5640_PWR_OM_R_BIT,
  1164. 0, rt5640_out_r_mix, ARRAY_SIZE(rt5640_out_r_mix)),
  1165. SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM, 0, 0,
  1166. rt5640_hpo_mix, ARRAY_SIZE(rt5640_hpo_mix)),
  1167. SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM, 0, 0,
  1168. rt5640_hpo_mix, ARRAY_SIZE(rt5640_hpo_mix)),
  1169. SND_SOC_DAPM_MIXER("Mono MIX", RT5640_PWR_ANLG1, RT5640_PWR_MM_BIT, 0,
  1170. rt5640_mono_mix, ARRAY_SIZE(rt5640_mono_mix)),
  1171. SND_SOC_DAPM_SUPPLY("Improve MONO Amp Drv", RT5640_PWR_ANLG1,
  1172. RT5640_PWR_MA_BIT, 0, NULL, 0),
  1173. SND_SOC_DAPM_OUTPUT("MONOP"),
  1174. SND_SOC_DAPM_OUTPUT("MONON"),
  1175. };
  1176. static const struct snd_soc_dapm_widget rt5639_specific_dapm_widgets[] = {
  1177. SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM, 0, 0,
  1178. rt5639_sto_dac_l_mix, ARRAY_SIZE(rt5639_sto_dac_l_mix)),
  1179. SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM, 0, 0,
  1180. rt5639_sto_dac_r_mix, ARRAY_SIZE(rt5639_sto_dac_r_mix)),
  1181. SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER, RT5640_PWR_OM_L_BIT,
  1182. 0, rt5639_out_l_mix, ARRAY_SIZE(rt5639_out_l_mix)),
  1183. SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER, RT5640_PWR_OM_R_BIT,
  1184. 0, rt5639_out_r_mix, ARRAY_SIZE(rt5639_out_r_mix)),
  1185. SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM, 0, 0,
  1186. rt5639_hpo_mix, ARRAY_SIZE(rt5639_hpo_mix)),
  1187. SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM, 0, 0,
  1188. rt5639_hpo_mix, ARRAY_SIZE(rt5639_hpo_mix)),
  1189. };
  1190. static const struct snd_soc_dapm_route rt5640_dapm_routes[] = {
  1191. { "I2S1", NULL, "Stereo Filter ASRC", is_using_asrc },
  1192. { "I2S2", NULL, "I2S2 ASRC", is_using_asrc },
  1193. { "I2S2", NULL, "I2S2 Filter ASRC", is_using_asrc },
  1194. { "DMIC1", NULL, "DMIC1 ASRC", is_using_asrc },
  1195. { "DMIC2", NULL, "DMIC2 ASRC", is_using_asrc },
  1196. {"IN1P", NULL, "LDO2"},
  1197. {"IN2P", NULL, "LDO2"},
  1198. {"IN3P", NULL, "LDO2"},
  1199. {"DMIC L1", NULL, "DMIC1"},
  1200. {"DMIC R1", NULL, "DMIC1"},
  1201. {"DMIC L2", NULL, "DMIC2"},
  1202. {"DMIC R2", NULL, "DMIC2"},
  1203. {"BST1", NULL, "IN1P"},
  1204. {"BST1", NULL, "IN1N"},
  1205. {"BST2", NULL, "IN2P"},
  1206. {"BST2", NULL, "IN2N"},
  1207. {"BST3", NULL, "IN3P"},
  1208. {"BST3", NULL, "IN3N"},
  1209. {"INL VOL", NULL, "IN2P"},
  1210. {"INR VOL", NULL, "IN2N"},
  1211. {"RECMIXL", "HPOL Switch", "HPOL"},
  1212. {"RECMIXL", "INL Switch", "INL VOL"},
  1213. {"RECMIXL", "BST3 Switch", "BST3"},
  1214. {"RECMIXL", "BST2 Switch", "BST2"},
  1215. {"RECMIXL", "BST1 Switch", "BST1"},
  1216. {"RECMIXL", "OUT MIXL Switch", "OUT MIXL"},
  1217. {"RECMIXR", "HPOR Switch", "HPOR"},
  1218. {"RECMIXR", "INR Switch", "INR VOL"},
  1219. {"RECMIXR", "BST3 Switch", "BST3"},
  1220. {"RECMIXR", "BST2 Switch", "BST2"},
  1221. {"RECMIXR", "BST1 Switch", "BST1"},
  1222. {"RECMIXR", "OUT MIXR Switch", "OUT MIXR"},
  1223. {"ADC L", NULL, "RECMIXL"},
  1224. {"ADC R", NULL, "RECMIXR"},
  1225. {"DMIC L1", NULL, "DMIC CLK"},
  1226. {"DMIC L1", NULL, "DMIC1 Power"},
  1227. {"DMIC R1", NULL, "DMIC CLK"},
  1228. {"DMIC R1", NULL, "DMIC1 Power"},
  1229. {"DMIC L2", NULL, "DMIC CLK"},
  1230. {"DMIC L2", NULL, "DMIC2 Power"},
  1231. {"DMIC R2", NULL, "DMIC CLK"},
  1232. {"DMIC R2", NULL, "DMIC2 Power"},
  1233. {"Stereo ADC L2 Mux", "DMIC1", "DMIC L1"},
  1234. {"Stereo ADC L2 Mux", "DMIC2", "DMIC L2"},
  1235. {"Stereo ADC L2 Mux", "DIG MIX", "DIG MIXL"},
  1236. {"Stereo ADC L1 Mux", "ADC", "ADC L"},
  1237. {"Stereo ADC L1 Mux", "DIG MIX", "DIG MIXL"},
  1238. {"Stereo ADC R1 Mux", "ADC", "ADC R"},
  1239. {"Stereo ADC R1 Mux", "DIG MIX", "DIG MIXR"},
  1240. {"Stereo ADC R2 Mux", "DMIC1", "DMIC R1"},
  1241. {"Stereo ADC R2 Mux", "DMIC2", "DMIC R2"},
  1242. {"Stereo ADC R2 Mux", "DIG MIX", "DIG MIXR"},
  1243. {"Mono ADC L2 Mux", "DMIC L1", "DMIC L1"},
  1244. {"Mono ADC L2 Mux", "DMIC L2", "DMIC L2"},
  1245. {"Mono ADC L2 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
  1246. {"Mono ADC L1 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
  1247. {"Mono ADC L1 Mux", "ADCL", "ADC L"},
  1248. {"Mono ADC R1 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
  1249. {"Mono ADC R1 Mux", "ADCR", "ADC R"},
  1250. {"Mono ADC R2 Mux", "DMIC R1", "DMIC R1"},
  1251. {"Mono ADC R2 Mux", "DMIC R2", "DMIC R2"},
  1252. {"Mono ADC R2 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
  1253. {"Stereo ADC MIXL", "ADC1 Switch", "Stereo ADC L1 Mux"},
  1254. {"Stereo ADC MIXL", "ADC2 Switch", "Stereo ADC L2 Mux"},
  1255. {"Stereo ADC MIXL", NULL, "Stereo Filter"},
  1256. {"Stereo ADC MIXR", "ADC1 Switch", "Stereo ADC R1 Mux"},
  1257. {"Stereo ADC MIXR", "ADC2 Switch", "Stereo ADC R2 Mux"},
  1258. {"Stereo ADC MIXR", NULL, "Stereo Filter"},
  1259. {"Mono ADC MIXL", "ADC1 Switch", "Mono ADC L1 Mux"},
  1260. {"Mono ADC MIXL", "ADC2 Switch", "Mono ADC L2 Mux"},
  1261. {"Mono ADC MIXL", NULL, "Mono Left Filter"},
  1262. {"Mono ADC MIXR", "ADC1 Switch", "Mono ADC R1 Mux"},
  1263. {"Mono ADC MIXR", "ADC2 Switch", "Mono ADC R2 Mux"},
  1264. {"Mono ADC MIXR", NULL, "Mono Right Filter"},
  1265. {"IF2 ADC L", NULL, "Mono ADC MIXL"},
  1266. {"IF2 ADC R", NULL, "Mono ADC MIXR"},
  1267. {"IF1 ADC L", NULL, "Stereo ADC MIXL"},
  1268. {"IF1 ADC R", NULL, "Stereo ADC MIXR"},
  1269. {"IF1 ADC", NULL, "I2S1"},
  1270. {"IF1 ADC", NULL, "IF1 ADC L"},
  1271. {"IF1 ADC", NULL, "IF1 ADC R"},
  1272. {"IF2 ADC", NULL, "I2S2"},
  1273. {"IF2 ADC", NULL, "IF2 ADC L"},
  1274. {"IF2 ADC", NULL, "IF2 ADC R"},
  1275. {"DAI1 TX Mux", "1:1|2:2", "IF1 ADC"},
  1276. {"DAI1 TX Mux", "1:2|2:1", "IF2 ADC"},
  1277. {"DAI1 IF1 Mux", "1:1|2:1", "IF1 ADC"},
  1278. {"DAI1 IF2 Mux", "1:1|2:1", "IF2 ADC"},
  1279. {"SDI1 TX Mux", "IF1", "DAI1 IF1 Mux"},
  1280. {"SDI1 TX Mux", "IF2", "DAI1 IF2 Mux"},
  1281. {"DAI2 TX Mux", "1:2|2:1", "IF1 ADC"},
  1282. {"DAI2 TX Mux", "1:1|2:2", "IF2 ADC"},
  1283. {"DAI2 IF1 Mux", "1:2|2:2", "IF1 ADC"},
  1284. {"DAI2 IF2 Mux", "1:2|2:2", "IF2 ADC"},
  1285. {"SDI2 TX Mux", "IF1", "DAI2 IF1 Mux"},
  1286. {"SDI2 TX Mux", "IF2", "DAI2 IF2 Mux"},
  1287. {"AIF1TX", NULL, "DAI1 TX Mux"},
  1288. {"AIF1TX", NULL, "SDI1 TX Mux"},
  1289. {"AIF2TX", NULL, "DAI2 TX Mux"},
  1290. {"AIF2TX", NULL, "SDI2 TX Mux"},
  1291. {"DAI1 RX Mux", "1:1|2:2", "AIF1RX"},
  1292. {"DAI1 RX Mux", "1:1|2:1", "AIF1RX"},
  1293. {"DAI1 RX Mux", "1:2|2:1", "AIF2RX"},
  1294. {"DAI1 RX Mux", "1:2|2:2", "AIF2RX"},
  1295. {"DAI2 RX Mux", "1:2|2:1", "AIF1RX"},
  1296. {"DAI2 RX Mux", "1:1|2:1", "AIF1RX"},
  1297. {"DAI2 RX Mux", "1:1|2:2", "AIF2RX"},
  1298. {"DAI2 RX Mux", "1:2|2:2", "AIF2RX"},
  1299. {"IF1 DAC", NULL, "I2S1"},
  1300. {"IF1 DAC", NULL, "DAI1 RX Mux"},
  1301. {"IF2 DAC", NULL, "I2S2"},
  1302. {"IF2 DAC", NULL, "DAI2 RX Mux"},
  1303. {"IF1 DAC L", NULL, "IF1 DAC"},
  1304. {"IF1 DAC R", NULL, "IF1 DAC"},
  1305. {"IF2 DAC L", NULL, "IF2 DAC"},
  1306. {"IF2 DAC R", NULL, "IF2 DAC"},
  1307. {"DAC MIXL", "Stereo ADC Switch", "Stereo ADC MIXL"},
  1308. {"DAC MIXL", "INF1 Switch", "IF1 DAC L"},
  1309. {"DAC MIXL", NULL, "DAC L1 Power"},
  1310. {"DAC MIXR", "Stereo ADC Switch", "Stereo ADC MIXR"},
  1311. {"DAC MIXR", "INF1 Switch", "IF1 DAC R"},
  1312. {"DAC MIXR", NULL, "DAC R1 Power"},
  1313. {"Stereo DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
  1314. {"Stereo DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
  1315. {"Mono DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
  1316. {"Mono DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
  1317. {"DIG MIXL", "DAC L1 Switch", "DAC MIXL"},
  1318. {"DIG MIXR", "DAC R1 Switch", "DAC MIXR"},
  1319. {"DAC L1", NULL, "Stereo DAC MIXL"},
  1320. {"DAC L1", NULL, "DAC L1 Power"},
  1321. {"DAC R1", NULL, "Stereo DAC MIXR"},
  1322. {"DAC R1", NULL, "DAC R1 Power"},
  1323. {"SPK MIXL", "REC MIXL Switch", "RECMIXL"},
  1324. {"SPK MIXL", "INL Switch", "INL VOL"},
  1325. {"SPK MIXL", "DAC L1 Switch", "DAC L1"},
  1326. {"SPK MIXL", "OUT MIXL Switch", "OUT MIXL"},
  1327. {"SPK MIXR", "REC MIXR Switch", "RECMIXR"},
  1328. {"SPK MIXR", "INR Switch", "INR VOL"},
  1329. {"SPK MIXR", "DAC R1 Switch", "DAC R1"},
  1330. {"SPK MIXR", "OUT MIXR Switch", "OUT MIXR"},
  1331. {"OUT MIXL", "BST1 Switch", "BST1"},
  1332. {"OUT MIXL", "INL Switch", "INL VOL"},
  1333. {"OUT MIXL", "REC MIXL Switch", "RECMIXL"},
  1334. {"OUT MIXL", "DAC L1 Switch", "DAC L1"},
  1335. {"OUT MIXR", "BST2 Switch", "BST2"},
  1336. {"OUT MIXR", "BST1 Switch", "BST1"},
  1337. {"OUT MIXR", "INR Switch", "INR VOL"},
  1338. {"OUT MIXR", "REC MIXR Switch", "RECMIXR"},
  1339. {"OUT MIXR", "DAC R1 Switch", "DAC R1"},
  1340. {"SPKVOL L", NULL, "SPK MIXL"},
  1341. {"SPKVOL R", NULL, "SPK MIXR"},
  1342. {"HPOVOL L", NULL, "OUT MIXL"},
  1343. {"HPOVOL R", NULL, "OUT MIXR"},
  1344. {"OUTVOL L", NULL, "OUT MIXL"},
  1345. {"OUTVOL R", NULL, "OUT MIXR"},
  1346. {"SPOL MIX", "DAC R1 Switch", "DAC R1"},
  1347. {"SPOL MIX", "DAC L1 Switch", "DAC L1"},
  1348. {"SPOL MIX", "SPKVOL R Switch", "SPKVOL R"},
  1349. {"SPOL MIX", "SPKVOL L Switch", "SPKVOL L"},
  1350. {"SPOL MIX", "BST1 Switch", "BST1"},
  1351. {"SPOR MIX", "DAC R1 Switch", "DAC R1"},
  1352. {"SPOR MIX", "SPKVOL R Switch", "SPKVOL R"},
  1353. {"SPOR MIX", "BST1 Switch", "BST1"},
  1354. {"HPO MIX L", "HPO MIX DAC1 Switch", "DAC L1"},
  1355. {"HPO MIX L", "HPO MIX HPVOL Switch", "HPOVOL L"},
  1356. {"HPO MIX L", NULL, "HP L Amp"},
  1357. {"HPO MIX R", "HPO MIX DAC1 Switch", "DAC R1"},
  1358. {"HPO MIX R", "HPO MIX HPVOL Switch", "HPOVOL R"},
  1359. {"HPO MIX R", NULL, "HP R Amp"},
  1360. {"LOUT MIX", "DAC L1 Switch", "DAC L1"},
  1361. {"LOUT MIX", "DAC R1 Switch", "DAC R1"},
  1362. {"LOUT MIX", "OUTVOL L Switch", "OUTVOL L"},
  1363. {"LOUT MIX", "OUTVOL R Switch", "OUTVOL R"},
  1364. {"HP Amp", NULL, "HPO MIX L"},
  1365. {"HP Amp", NULL, "HPO MIX R"},
  1366. {"Speaker L Playback", "Switch", "SPOL MIX"},
  1367. {"Speaker R Playback", "Switch", "SPOR MIX"},
  1368. {"SPOLP", NULL, "Speaker L Playback"},
  1369. {"SPOLN", NULL, "Speaker L Playback"},
  1370. {"SPORP", NULL, "Speaker R Playback"},
  1371. {"SPORN", NULL, "Speaker R Playback"},
  1372. {"SPOLP", NULL, "Improve SPK Amp Drv"},
  1373. {"SPOLN", NULL, "Improve SPK Amp Drv"},
  1374. {"SPORP", NULL, "Improve SPK Amp Drv"},
  1375. {"SPORN", NULL, "Improve SPK Amp Drv"},
  1376. {"HPOL", NULL, "Improve HP Amp Drv"},
  1377. {"HPOR", NULL, "Improve HP Amp Drv"},
  1378. {"HP L Playback", "Switch", "HP Amp"},
  1379. {"HP R Playback", "Switch", "HP Amp"},
  1380. {"HPOL", NULL, "HP L Playback"},
  1381. {"HPOR", NULL, "HP R Playback"},
  1382. {"LOUT amp", NULL, "LOUT MIX"},
  1383. {"LOUTL", NULL, "LOUT amp"},
  1384. {"LOUTR", NULL, "LOUT amp"},
  1385. };
  1386. static const struct snd_soc_dapm_route rt5640_specific_dapm_routes[] = {
  1387. {"ANC", NULL, "Stereo ADC MIXL"},
  1388. {"ANC", NULL, "Stereo ADC MIXR"},
  1389. {"Audio DSP", NULL, "DAC MIXL"},
  1390. {"Audio DSP", NULL, "DAC MIXR"},
  1391. {"DAC L2 Mux", "IF2", "IF2 DAC L"},
  1392. {"DAC L2 Mux", "Base L/R", "Audio DSP"},
  1393. {"DAC L2 Mux", NULL, "DAC L2 Power"},
  1394. {"DAC R2 Mux", "IF2", "IF2 DAC R"},
  1395. {"DAC R2 Mux", NULL, "DAC R2 Power"},
  1396. {"Stereo DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
  1397. {"Stereo DAC MIXL", "ANC Switch", "ANC"},
  1398. {"Stereo DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
  1399. {"Stereo DAC MIXR", "ANC Switch", "ANC"},
  1400. {"Mono DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
  1401. {"Mono DAC MIXL", "DAC R2 Switch", "DAC R2 Mux"},
  1402. {"Mono DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
  1403. {"Mono DAC MIXR", "DAC L2 Switch", "DAC L2 Mux"},
  1404. {"DIG MIXR", "DAC R2 Switch", "DAC R2 Mux"},
  1405. {"DIG MIXL", "DAC L2 Switch", "DAC L2 Mux"},
  1406. {"DAC L2", NULL, "Mono DAC MIXL"},
  1407. {"DAC L2", NULL, "DAC L2 Power"},
  1408. {"DAC R2", NULL, "Mono DAC MIXR"},
  1409. {"DAC R2", NULL, "DAC R2 Power"},
  1410. {"SPK MIXL", "DAC L2 Switch", "DAC L2"},
  1411. {"SPK MIXR", "DAC R2 Switch", "DAC R2"},
  1412. {"OUT MIXL", "SPK MIXL Switch", "SPK MIXL"},
  1413. {"OUT MIXR", "SPK MIXR Switch", "SPK MIXR"},
  1414. {"OUT MIXL", "DAC R2 Switch", "DAC R2"},
  1415. {"OUT MIXL", "DAC L2 Switch", "DAC L2"},
  1416. {"OUT MIXR", "DAC L2 Switch", "DAC L2"},
  1417. {"OUT MIXR", "DAC R2 Switch", "DAC R2"},
  1418. {"HPO MIX L", "HPO MIX DAC2 Switch", "DAC L2"},
  1419. {"HPO MIX R", "HPO MIX DAC2 Switch", "DAC R2"},
  1420. {"Mono MIX", "DAC R2 Switch", "DAC R2"},
  1421. {"Mono MIX", "DAC L2 Switch", "DAC L2"},
  1422. {"Mono MIX", "OUTVOL R Switch", "OUTVOL R"},
  1423. {"Mono MIX", "OUTVOL L Switch", "OUTVOL L"},
  1424. {"Mono MIX", "BST1 Switch", "BST1"},
  1425. {"MONOP", NULL, "Mono MIX"},
  1426. {"MONON", NULL, "Mono MIX"},
  1427. {"MONOP", NULL, "Improve MONO Amp Drv"},
  1428. };
  1429. static const struct snd_soc_dapm_route rt5639_specific_dapm_routes[] = {
  1430. {"Stereo DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
  1431. {"Stereo DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
  1432. {"Mono DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
  1433. {"Mono DAC MIXL", "DAC R2 Switch", "IF2 DAC R"},
  1434. {"Mono DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
  1435. {"Mono DAC MIXR", "DAC L2 Switch", "IF2 DAC L"},
  1436. {"DIG MIXL", "DAC L2 Switch", "IF2 DAC L"},
  1437. {"DIG MIXR", "DAC R2 Switch", "IF2 DAC R"},
  1438. {"IF2 DAC L", NULL, "DAC L2 Power"},
  1439. {"IF2 DAC R", NULL, "DAC R2 Power"},
  1440. };
  1441. static int get_sdp_info(struct snd_soc_component *component, int dai_id)
  1442. {
  1443. int ret = 0, val;
  1444. if (component == NULL)
  1445. return -EINVAL;
  1446. val = snd_soc_component_read(component, RT5640_I2S1_SDP);
  1447. val = (val & RT5640_I2S_IF_MASK) >> RT5640_I2S_IF_SFT;
  1448. switch (dai_id) {
  1449. case RT5640_AIF1:
  1450. switch (val) {
  1451. case RT5640_IF_123:
  1452. case RT5640_IF_132:
  1453. ret |= RT5640_U_IF1;
  1454. break;
  1455. case RT5640_IF_113:
  1456. ret |= RT5640_U_IF1;
  1457. fallthrough;
  1458. case RT5640_IF_312:
  1459. case RT5640_IF_213:
  1460. ret |= RT5640_U_IF2;
  1461. break;
  1462. }
  1463. break;
  1464. case RT5640_AIF2:
  1465. switch (val) {
  1466. case RT5640_IF_231:
  1467. case RT5640_IF_213:
  1468. ret |= RT5640_U_IF1;
  1469. break;
  1470. case RT5640_IF_223:
  1471. ret |= RT5640_U_IF1;
  1472. fallthrough;
  1473. case RT5640_IF_123:
  1474. case RT5640_IF_321:
  1475. ret |= RT5640_U_IF2;
  1476. break;
  1477. }
  1478. break;
  1479. default:
  1480. ret = -EINVAL;
  1481. break;
  1482. }
  1483. return ret;
  1484. }
  1485. static int rt5640_hw_params(struct snd_pcm_substream *substream,
  1486. struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
  1487. {
  1488. struct snd_soc_component *component = dai->component;
  1489. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1490. unsigned int val_len = 0, val_clk, mask_clk;
  1491. int dai_sel, pre_div, bclk_ms, frame_size;
  1492. rt5640->lrck[dai->id] = params_rate(params);
  1493. pre_div = rl6231_get_clk_info(rt5640->sysclk, rt5640->lrck[dai->id]);
  1494. if (pre_div < 0) {
  1495. dev_err(component->dev, "Unsupported clock setting %d for DAI %d\n",
  1496. rt5640->lrck[dai->id], dai->id);
  1497. return -EINVAL;
  1498. }
  1499. frame_size = snd_soc_params_to_frame_size(params);
  1500. if (frame_size < 0) {
  1501. dev_err(component->dev, "Unsupported frame size: %d\n", frame_size);
  1502. return frame_size;
  1503. }
  1504. if (frame_size > 32)
  1505. bclk_ms = 1;
  1506. else
  1507. bclk_ms = 0;
  1508. rt5640->bclk[dai->id] = rt5640->lrck[dai->id] * (32 << bclk_ms);
  1509. dev_dbg(dai->dev, "bclk is %dHz and lrck is %dHz\n",
  1510. rt5640->bclk[dai->id], rt5640->lrck[dai->id]);
  1511. dev_dbg(dai->dev, "bclk_ms is %d and pre_div is %d for iis %d\n",
  1512. bclk_ms, pre_div, dai->id);
  1513. switch (params_width(params)) {
  1514. case 16:
  1515. break;
  1516. case 20:
  1517. val_len |= RT5640_I2S_DL_20;
  1518. break;
  1519. case 24:
  1520. val_len |= RT5640_I2S_DL_24;
  1521. break;
  1522. case 8:
  1523. val_len |= RT5640_I2S_DL_8;
  1524. break;
  1525. default:
  1526. return -EINVAL;
  1527. }
  1528. dai_sel = get_sdp_info(component, dai->id);
  1529. if (dai_sel < 0) {
  1530. dev_err(component->dev, "Failed to get sdp info: %d\n", dai_sel);
  1531. return -EINVAL;
  1532. }
  1533. if (dai_sel & RT5640_U_IF1) {
  1534. mask_clk = RT5640_I2S_BCLK_MS1_MASK | RT5640_I2S_PD1_MASK;
  1535. val_clk = bclk_ms << RT5640_I2S_BCLK_MS1_SFT |
  1536. pre_div << RT5640_I2S_PD1_SFT;
  1537. snd_soc_component_update_bits(component, RT5640_I2S1_SDP,
  1538. RT5640_I2S_DL_MASK, val_len);
  1539. snd_soc_component_update_bits(component, RT5640_ADDA_CLK1, mask_clk, val_clk);
  1540. }
  1541. if (dai_sel & RT5640_U_IF2) {
  1542. mask_clk = RT5640_I2S_BCLK_MS2_MASK | RT5640_I2S_PD2_MASK;
  1543. val_clk = bclk_ms << RT5640_I2S_BCLK_MS2_SFT |
  1544. pre_div << RT5640_I2S_PD2_SFT;
  1545. snd_soc_component_update_bits(component, RT5640_I2S2_SDP,
  1546. RT5640_I2S_DL_MASK, val_len);
  1547. snd_soc_component_update_bits(component, RT5640_ADDA_CLK1, mask_clk, val_clk);
  1548. }
  1549. return 0;
  1550. }
  1551. static int rt5640_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
  1552. {
  1553. struct snd_soc_component *component = dai->component;
  1554. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1555. unsigned int reg_val = 0;
  1556. int dai_sel;
  1557. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  1558. case SND_SOC_DAIFMT_CBM_CFM:
  1559. rt5640->master[dai->id] = 1;
  1560. break;
  1561. case SND_SOC_DAIFMT_CBS_CFS:
  1562. reg_val |= RT5640_I2S_MS_S;
  1563. rt5640->master[dai->id] = 0;
  1564. break;
  1565. default:
  1566. return -EINVAL;
  1567. }
  1568. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  1569. case SND_SOC_DAIFMT_NB_NF:
  1570. break;
  1571. case SND_SOC_DAIFMT_IB_NF:
  1572. reg_val |= RT5640_I2S_BP_INV;
  1573. break;
  1574. default:
  1575. return -EINVAL;
  1576. }
  1577. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  1578. case SND_SOC_DAIFMT_I2S:
  1579. break;
  1580. case SND_SOC_DAIFMT_LEFT_J:
  1581. reg_val |= RT5640_I2S_DF_LEFT;
  1582. break;
  1583. case SND_SOC_DAIFMT_DSP_A:
  1584. reg_val |= RT5640_I2S_DF_PCM_A;
  1585. break;
  1586. case SND_SOC_DAIFMT_DSP_B:
  1587. reg_val |= RT5640_I2S_DF_PCM_B;
  1588. break;
  1589. default:
  1590. return -EINVAL;
  1591. }
  1592. dai_sel = get_sdp_info(component, dai->id);
  1593. if (dai_sel < 0) {
  1594. dev_err(component->dev, "Failed to get sdp info: %d\n", dai_sel);
  1595. return -EINVAL;
  1596. }
  1597. if (dai_sel & RT5640_U_IF1) {
  1598. snd_soc_component_update_bits(component, RT5640_I2S1_SDP,
  1599. RT5640_I2S_MS_MASK | RT5640_I2S_BP_MASK |
  1600. RT5640_I2S_DF_MASK, reg_val);
  1601. }
  1602. if (dai_sel & RT5640_U_IF2) {
  1603. snd_soc_component_update_bits(component, RT5640_I2S2_SDP,
  1604. RT5640_I2S_MS_MASK | RT5640_I2S_BP_MASK |
  1605. RT5640_I2S_DF_MASK, reg_val);
  1606. }
  1607. return 0;
  1608. }
  1609. static int rt5640_set_dai_sysclk(struct snd_soc_dai *dai,
  1610. int clk_id, unsigned int freq, int dir)
  1611. {
  1612. struct snd_soc_component *component = dai->component;
  1613. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1614. unsigned int reg_val = 0;
  1615. unsigned int pll_bit = 0;
  1616. switch (clk_id) {
  1617. case RT5640_SCLK_S_MCLK:
  1618. reg_val |= RT5640_SCLK_SRC_MCLK;
  1619. break;
  1620. case RT5640_SCLK_S_PLL1:
  1621. reg_val |= RT5640_SCLK_SRC_PLL1;
  1622. pll_bit |= RT5640_PWR_PLL;
  1623. break;
  1624. case RT5640_SCLK_S_RCCLK:
  1625. reg_val |= RT5640_SCLK_SRC_RCCLK;
  1626. break;
  1627. default:
  1628. dev_err(component->dev, "Invalid clock id (%d)\n", clk_id);
  1629. return -EINVAL;
  1630. }
  1631. snd_soc_component_update_bits(component, RT5640_PWR_ANLG2,
  1632. RT5640_PWR_PLL, pll_bit);
  1633. snd_soc_component_update_bits(component, RT5640_GLB_CLK,
  1634. RT5640_SCLK_SRC_MASK, reg_val);
  1635. rt5640->sysclk = freq;
  1636. rt5640->sysclk_src = clk_id;
  1637. dev_dbg(dai->dev, "Sysclk is %dHz and clock id is %d\n", freq, clk_id);
  1638. return 0;
  1639. }
  1640. static int rt5640_set_dai_pll(struct snd_soc_dai *dai, int pll_id, int source,
  1641. unsigned int freq_in, unsigned int freq_out)
  1642. {
  1643. struct snd_soc_component *component = dai->component;
  1644. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1645. struct rl6231_pll_code pll_code;
  1646. int ret;
  1647. if (source == rt5640->pll_src && freq_in == rt5640->pll_in &&
  1648. freq_out == rt5640->pll_out)
  1649. return 0;
  1650. if (!freq_in || !freq_out) {
  1651. dev_dbg(component->dev, "PLL disabled\n");
  1652. rt5640->pll_in = 0;
  1653. rt5640->pll_out = 0;
  1654. snd_soc_component_update_bits(component, RT5640_GLB_CLK,
  1655. RT5640_SCLK_SRC_MASK, RT5640_SCLK_SRC_MCLK);
  1656. return 0;
  1657. }
  1658. switch (source) {
  1659. case RT5640_PLL1_S_MCLK:
  1660. snd_soc_component_update_bits(component, RT5640_GLB_CLK,
  1661. RT5640_PLL1_SRC_MASK, RT5640_PLL1_SRC_MCLK);
  1662. break;
  1663. case RT5640_PLL1_S_BCLK1:
  1664. snd_soc_component_update_bits(component, RT5640_GLB_CLK,
  1665. RT5640_PLL1_SRC_MASK, RT5640_PLL1_SRC_BCLK1);
  1666. break;
  1667. case RT5640_PLL1_S_BCLK2:
  1668. snd_soc_component_update_bits(component, RT5640_GLB_CLK,
  1669. RT5640_PLL1_SRC_MASK, RT5640_PLL1_SRC_BCLK2);
  1670. break;
  1671. default:
  1672. dev_err(component->dev, "Unknown PLL source %d\n", source);
  1673. return -EINVAL;
  1674. }
  1675. ret = rl6231_pll_calc(freq_in, freq_out, &pll_code);
  1676. if (ret < 0) {
  1677. dev_err(component->dev, "Unsupported input clock %d\n", freq_in);
  1678. return ret;
  1679. }
  1680. dev_dbg(component->dev, "bypass=%d m=%d n=%d k=%d\n",
  1681. pll_code.m_bp, (pll_code.m_bp ? 0 : pll_code.m_code),
  1682. pll_code.n_code, pll_code.k_code);
  1683. snd_soc_component_write(component, RT5640_PLL_CTRL1,
  1684. (pll_code.n_code << RT5640_PLL_N_SFT) | pll_code.k_code);
  1685. snd_soc_component_write(component, RT5640_PLL_CTRL2,
  1686. ((pll_code.m_bp ? 0 : pll_code.m_code) << RT5640_PLL_M_SFT) |
  1687. (pll_code.m_bp << RT5640_PLL_M_BP_SFT));
  1688. rt5640->pll_in = freq_in;
  1689. rt5640->pll_out = freq_out;
  1690. rt5640->pll_src = source;
  1691. return 0;
  1692. }
  1693. static int rt5640_set_bias_level(struct snd_soc_component *component,
  1694. enum snd_soc_bias_level level)
  1695. {
  1696. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1697. int ret;
  1698. switch (level) {
  1699. case SND_SOC_BIAS_ON:
  1700. break;
  1701. case SND_SOC_BIAS_PREPARE:
  1702. /*
  1703. * SND_SOC_BIAS_PREPARE is called while preparing for a
  1704. * transition to ON or away from ON. If current bias_level
  1705. * is SND_SOC_BIAS_ON, then it is preparing for a transition
  1706. * away from ON. Disable the clock in that case, otherwise
  1707. * enable it.
  1708. */
  1709. if (IS_ERR(rt5640->mclk))
  1710. break;
  1711. if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_ON) {
  1712. clk_disable_unprepare(rt5640->mclk);
  1713. } else {
  1714. ret = clk_prepare_enable(rt5640->mclk);
  1715. if (ret)
  1716. return ret;
  1717. }
  1718. break;
  1719. case SND_SOC_BIAS_STANDBY:
  1720. if (SND_SOC_BIAS_OFF == snd_soc_component_get_bias_level(component)) {
  1721. snd_soc_component_update_bits(component, RT5640_PWR_ANLG1,
  1722. RT5640_PWR_VREF1 | RT5640_PWR_MB |
  1723. RT5640_PWR_BG | RT5640_PWR_VREF2,
  1724. RT5640_PWR_VREF1 | RT5640_PWR_MB |
  1725. RT5640_PWR_BG | RT5640_PWR_VREF2);
  1726. usleep_range(10000, 15000);
  1727. snd_soc_component_update_bits(component, RT5640_PWR_ANLG1,
  1728. RT5640_PWR_FV1 | RT5640_PWR_FV2,
  1729. RT5640_PWR_FV1 | RT5640_PWR_FV2);
  1730. snd_soc_component_update_bits(component, RT5640_DUMMY1,
  1731. 0x1, 0x1);
  1732. snd_soc_component_update_bits(component, RT5640_MICBIAS,
  1733. 0x0030, 0x0030);
  1734. }
  1735. break;
  1736. case SND_SOC_BIAS_OFF:
  1737. snd_soc_component_write(component, RT5640_DEPOP_M1, 0x0004);
  1738. snd_soc_component_write(component, RT5640_DEPOP_M2, 0x1100);
  1739. snd_soc_component_update_bits(component, RT5640_DUMMY1, 0x1, 0);
  1740. snd_soc_component_write(component, RT5640_PWR_DIG1, 0x0000);
  1741. snd_soc_component_write(component, RT5640_PWR_DIG2, 0x0000);
  1742. snd_soc_component_write(component, RT5640_PWR_VOL, 0x0000);
  1743. snd_soc_component_write(component, RT5640_PWR_MIXER, 0x0000);
  1744. if (rt5640->jd_src == RT5640_JD_SRC_HDA_HEADER)
  1745. snd_soc_component_write(component, RT5640_PWR_ANLG1,
  1746. 0x2818);
  1747. else
  1748. snd_soc_component_write(component, RT5640_PWR_ANLG1,
  1749. 0x0000);
  1750. snd_soc_component_write(component, RT5640_PWR_ANLG2, 0x0000);
  1751. break;
  1752. default:
  1753. break;
  1754. }
  1755. return 0;
  1756. }
  1757. int rt5640_dmic_enable(struct snd_soc_component *component,
  1758. bool dmic1_data_pin, bool dmic2_data_pin)
  1759. {
  1760. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1761. regmap_update_bits(rt5640->regmap, RT5640_GPIO_CTRL1,
  1762. RT5640_GP2_PIN_MASK, RT5640_GP2_PIN_DMIC1_SCL);
  1763. if (dmic1_data_pin) {
  1764. regmap_update_bits(rt5640->regmap, RT5640_DMIC,
  1765. RT5640_DMIC_1_DP_MASK, RT5640_DMIC_1_DP_GPIO3);
  1766. regmap_update_bits(rt5640->regmap, RT5640_GPIO_CTRL1,
  1767. RT5640_GP3_PIN_MASK, RT5640_GP3_PIN_DMIC1_SDA);
  1768. }
  1769. if (dmic2_data_pin) {
  1770. regmap_update_bits(rt5640->regmap, RT5640_DMIC,
  1771. RT5640_DMIC_2_DP_MASK, RT5640_DMIC_2_DP_GPIO4);
  1772. regmap_update_bits(rt5640->regmap, RT5640_GPIO_CTRL1,
  1773. RT5640_GP4_PIN_MASK, RT5640_GP4_PIN_DMIC2_SDA);
  1774. }
  1775. return 0;
  1776. }
  1777. EXPORT_SYMBOL_GPL(rt5640_dmic_enable);
  1778. int rt5640_sel_asrc_clk_src(struct snd_soc_component *component,
  1779. unsigned int filter_mask, unsigned int clk_src)
  1780. {
  1781. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1782. unsigned int asrc2_mask = 0;
  1783. unsigned int asrc2_value = 0;
  1784. switch (clk_src) {
  1785. case RT5640_CLK_SEL_SYS:
  1786. case RT5640_CLK_SEL_ASRC:
  1787. break;
  1788. default:
  1789. return -EINVAL;
  1790. }
  1791. if (!filter_mask)
  1792. return -EINVAL;
  1793. if (filter_mask & RT5640_DA_STEREO_FILTER) {
  1794. asrc2_mask |= RT5640_STO_DAC_M_MASK;
  1795. asrc2_value = (asrc2_value & ~RT5640_STO_DAC_M_MASK)
  1796. | (clk_src << RT5640_STO_DAC_M_SFT);
  1797. }
  1798. if (filter_mask & RT5640_DA_MONO_L_FILTER) {
  1799. asrc2_mask |= RT5640_MDA_L_M_MASK;
  1800. asrc2_value = (asrc2_value & ~RT5640_MDA_L_M_MASK)
  1801. | (clk_src << RT5640_MDA_L_M_SFT);
  1802. }
  1803. if (filter_mask & RT5640_DA_MONO_R_FILTER) {
  1804. asrc2_mask |= RT5640_MDA_R_M_MASK;
  1805. asrc2_value = (asrc2_value & ~RT5640_MDA_R_M_MASK)
  1806. | (clk_src << RT5640_MDA_R_M_SFT);
  1807. }
  1808. if (filter_mask & RT5640_AD_STEREO_FILTER) {
  1809. asrc2_mask |= RT5640_ADC_M_MASK;
  1810. asrc2_value = (asrc2_value & ~RT5640_ADC_M_MASK)
  1811. | (clk_src << RT5640_ADC_M_SFT);
  1812. }
  1813. if (filter_mask & RT5640_AD_MONO_L_FILTER) {
  1814. asrc2_mask |= RT5640_MAD_L_M_MASK;
  1815. asrc2_value = (asrc2_value & ~RT5640_MAD_L_M_MASK)
  1816. | (clk_src << RT5640_MAD_L_M_SFT);
  1817. }
  1818. if (filter_mask & RT5640_AD_MONO_R_FILTER) {
  1819. asrc2_mask |= RT5640_MAD_R_M_MASK;
  1820. asrc2_value = (asrc2_value & ~RT5640_MAD_R_M_MASK)
  1821. | (clk_src << RT5640_MAD_R_M_SFT);
  1822. }
  1823. snd_soc_component_update_bits(component, RT5640_ASRC_2,
  1824. asrc2_mask, asrc2_value);
  1825. if (snd_soc_component_read(component, RT5640_ASRC_2)) {
  1826. rt5640->asrc_en = true;
  1827. snd_soc_component_update_bits(component, RT5640_JD_CTRL, 0x3, 0x3);
  1828. } else {
  1829. rt5640->asrc_en = false;
  1830. snd_soc_component_update_bits(component, RT5640_JD_CTRL, 0x3, 0x0);
  1831. }
  1832. return 0;
  1833. }
  1834. EXPORT_SYMBOL_GPL(rt5640_sel_asrc_clk_src);
  1835. void rt5640_enable_micbias1_for_ovcd(struct snd_soc_component *component)
  1836. {
  1837. struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
  1838. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1839. snd_soc_dapm_mutex_lock(dapm);
  1840. snd_soc_dapm_force_enable_pin_unlocked(dapm, "LDO2");
  1841. snd_soc_dapm_force_enable_pin_unlocked(dapm, "MICBIAS1");
  1842. /* OVCD is unreliable when used with RCCLK as sysclk-source */
  1843. if (rt5640->use_platform_clock)
  1844. snd_soc_dapm_force_enable_pin_unlocked(dapm, "Platform Clock");
  1845. snd_soc_dapm_sync_unlocked(dapm);
  1846. snd_soc_dapm_mutex_unlock(dapm);
  1847. }
  1848. EXPORT_SYMBOL_GPL(rt5640_enable_micbias1_for_ovcd);
  1849. void rt5640_disable_micbias1_for_ovcd(struct snd_soc_component *component)
  1850. {
  1851. struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
  1852. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1853. snd_soc_dapm_mutex_lock(dapm);
  1854. if (rt5640->use_platform_clock)
  1855. snd_soc_dapm_disable_pin_unlocked(dapm, "Platform Clock");
  1856. snd_soc_dapm_disable_pin_unlocked(dapm, "MICBIAS1");
  1857. snd_soc_dapm_disable_pin_unlocked(dapm, "LDO2");
  1858. snd_soc_dapm_sync_unlocked(dapm);
  1859. snd_soc_dapm_mutex_unlock(dapm);
  1860. }
  1861. EXPORT_SYMBOL_GPL(rt5640_disable_micbias1_for_ovcd);
  1862. static void rt5640_enable_micbias1_ovcd_irq(struct snd_soc_component *component)
  1863. {
  1864. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1865. snd_soc_component_update_bits(component, RT5640_IRQ_CTRL2,
  1866. RT5640_IRQ_MB1_OC_MASK, RT5640_IRQ_MB1_OC_NOR);
  1867. rt5640->ovcd_irq_enabled = true;
  1868. }
  1869. static void rt5640_disable_micbias1_ovcd_irq(struct snd_soc_component *component)
  1870. {
  1871. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1872. snd_soc_component_update_bits(component, RT5640_IRQ_CTRL2,
  1873. RT5640_IRQ_MB1_OC_MASK, RT5640_IRQ_MB1_OC_BP);
  1874. rt5640->ovcd_irq_enabled = false;
  1875. }
  1876. static void rt5640_clear_micbias1_ovcd(struct snd_soc_component *component)
  1877. {
  1878. snd_soc_component_update_bits(component, RT5640_IRQ_CTRL2,
  1879. RT5640_MB1_OC_STATUS, 0);
  1880. }
  1881. static bool rt5640_micbias1_ovcd(struct snd_soc_component *component)
  1882. {
  1883. int val;
  1884. val = snd_soc_component_read(component, RT5640_IRQ_CTRL2);
  1885. dev_dbg(component->dev, "irq ctrl2 %#04x\n", val);
  1886. return (val & RT5640_MB1_OC_STATUS);
  1887. }
  1888. static bool rt5640_jack_inserted(struct snd_soc_component *component)
  1889. {
  1890. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1891. int val;
  1892. if (rt5640->jd_gpio)
  1893. val = gpiod_get_value(rt5640->jd_gpio) ? RT5640_JD_STATUS : 0;
  1894. else
  1895. val = snd_soc_component_read(component, RT5640_INT_IRQ_ST);
  1896. dev_dbg(component->dev, "irq status %#04x\n", val);
  1897. if (rt5640->jd_inverted)
  1898. return !(val & RT5640_JD_STATUS);
  1899. else
  1900. return (val & RT5640_JD_STATUS);
  1901. }
  1902. /* Jack detect and button-press timings */
  1903. #define JACK_SETTLE_TIME 100 /* milli seconds */
  1904. #define JACK_DETECT_COUNT 5
  1905. #define JACK_DETECT_MAXCOUNT 20 /* Aprox. 2 seconds worth of tries */
  1906. #define JACK_UNPLUG_TIME 80 /* milli seconds */
  1907. #define BP_POLL_TIME 10 /* milli seconds */
  1908. #define BP_POLL_MAXCOUNT 200 /* assume something is wrong after this */
  1909. #define BP_THRESHOLD 3
  1910. static void rt5640_start_button_press_work(struct snd_soc_component *component)
  1911. {
  1912. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  1913. rt5640->poll_count = 0;
  1914. rt5640->press_count = 0;
  1915. rt5640->release_count = 0;
  1916. rt5640->pressed = false;
  1917. rt5640->press_reported = false;
  1918. rt5640_clear_micbias1_ovcd(component);
  1919. schedule_delayed_work(&rt5640->bp_work, msecs_to_jiffies(BP_POLL_TIME));
  1920. }
  1921. static void rt5640_button_press_work(struct work_struct *work)
  1922. {
  1923. struct rt5640_priv *rt5640 =
  1924. container_of(work, struct rt5640_priv, bp_work.work);
  1925. struct snd_soc_component *component = rt5640->component;
  1926. /* Check the jack was not removed underneath us */
  1927. if (!rt5640_jack_inserted(component))
  1928. return;
  1929. if (rt5640_micbias1_ovcd(component)) {
  1930. rt5640->release_count = 0;
  1931. rt5640->press_count++;
  1932. /* Remember till after JACK_UNPLUG_TIME wait */
  1933. if (rt5640->press_count >= BP_THRESHOLD)
  1934. rt5640->pressed = true;
  1935. rt5640_clear_micbias1_ovcd(component);
  1936. } else {
  1937. rt5640->press_count = 0;
  1938. rt5640->release_count++;
  1939. }
  1940. /*
  1941. * The pins get temporarily shorted on jack unplug, so we poll for
  1942. * at least JACK_UNPLUG_TIME milli-seconds before reporting a press.
  1943. */
  1944. rt5640->poll_count++;
  1945. if (rt5640->poll_count < (JACK_UNPLUG_TIME / BP_POLL_TIME)) {
  1946. schedule_delayed_work(&rt5640->bp_work,
  1947. msecs_to_jiffies(BP_POLL_TIME));
  1948. return;
  1949. }
  1950. if (rt5640->pressed && !rt5640->press_reported) {
  1951. dev_dbg(component->dev, "headset button press\n");
  1952. snd_soc_jack_report(rt5640->jack, SND_JACK_BTN_0,
  1953. SND_JACK_BTN_0);
  1954. rt5640->press_reported = true;
  1955. }
  1956. if (rt5640->release_count >= BP_THRESHOLD) {
  1957. if (rt5640->press_reported) {
  1958. dev_dbg(component->dev, "headset button release\n");
  1959. snd_soc_jack_report(rt5640->jack, 0, SND_JACK_BTN_0);
  1960. }
  1961. /* Re-enable OVCD IRQ to detect next press */
  1962. rt5640_enable_micbias1_ovcd_irq(component);
  1963. return; /* Stop polling */
  1964. }
  1965. schedule_delayed_work(&rt5640->bp_work, msecs_to_jiffies(BP_POLL_TIME));
  1966. }
  1967. int rt5640_detect_headset(struct snd_soc_component *component, struct gpio_desc *hp_det_gpio)
  1968. {
  1969. int i, headset_count = 0, headphone_count = 0;
  1970. /*
  1971. * We get the insertion event before the jack is fully inserted at which
  1972. * point the second ring on a TRRS connector may short the 2nd ring and
  1973. * sleeve contacts, also the overcurrent detection is not entirely
  1974. * reliable. So we try several times with a wait in between until we
  1975. * detect the same type JACK_DETECT_COUNT times in a row.
  1976. */
  1977. for (i = 0; i < JACK_DETECT_MAXCOUNT; i++) {
  1978. /* Clear any previous over-current status flag */
  1979. rt5640_clear_micbias1_ovcd(component);
  1980. msleep(JACK_SETTLE_TIME);
  1981. /* Check the jack is still connected before checking ovcd */
  1982. if (hp_det_gpio) {
  1983. if (gpiod_get_value_cansleep(hp_det_gpio))
  1984. return 0;
  1985. } else {
  1986. if (!rt5640_jack_inserted(component))
  1987. return 0;
  1988. }
  1989. if (rt5640_micbias1_ovcd(component)) {
  1990. /*
  1991. * Over current detected, there is a short between the
  1992. * 2nd ring contact and the ground, so a TRS connector
  1993. * without a mic contact and thus plain headphones.
  1994. */
  1995. dev_dbg(component->dev, "jack mic-gnd shorted\n");
  1996. headset_count = 0;
  1997. headphone_count++;
  1998. if (headphone_count == JACK_DETECT_COUNT)
  1999. return SND_JACK_HEADPHONE;
  2000. } else {
  2001. dev_dbg(component->dev, "jack mic-gnd open\n");
  2002. headphone_count = 0;
  2003. headset_count++;
  2004. if (headset_count == JACK_DETECT_COUNT)
  2005. return SND_JACK_HEADSET;
  2006. }
  2007. }
  2008. dev_err(component->dev, "Error detecting headset vs headphones, bad contact?, assuming headphones\n");
  2009. return SND_JACK_HEADPHONE;
  2010. }
  2011. EXPORT_SYMBOL_GPL(rt5640_detect_headset);
  2012. static void rt5640_jack_work(struct work_struct *work)
  2013. {
  2014. struct rt5640_priv *rt5640 =
  2015. container_of(work, struct rt5640_priv, jack_work.work);
  2016. struct snd_soc_component *component = rt5640->component;
  2017. int status;
  2018. if (rt5640->jd_src == RT5640_JD_SRC_HDA_HEADER) {
  2019. int val, jack_type = 0, hda_mic_plugged, hda_hp_plugged;
  2020. /* mic jack */
  2021. val = snd_soc_component_read(component, RT5640_INT_IRQ_ST);
  2022. hda_mic_plugged = !(val & RT5640_JD_STATUS);
  2023. dev_dbg(component->dev, "mic jack status %d\n",
  2024. hda_mic_plugged);
  2025. snd_soc_component_update_bits(component, RT5640_IRQ_CTRL1,
  2026. RT5640_JD_P_MASK, !hda_mic_plugged << RT5640_JD_P_SFT);
  2027. if (hda_mic_plugged)
  2028. jack_type |= SND_JACK_MICROPHONE;
  2029. /* headphone jack */
  2030. val = snd_soc_component_read(component, RT5640_DUMMY2);
  2031. hda_hp_plugged = !(val & (0x1 << 11));
  2032. dev_dbg(component->dev, "headphone jack status %d\n",
  2033. hda_hp_plugged);
  2034. snd_soc_component_update_bits(component, RT5640_DUMMY2,
  2035. (0x1 << 10), !hda_hp_plugged << 10);
  2036. if (hda_hp_plugged)
  2037. jack_type |= SND_JACK_HEADPHONE;
  2038. snd_soc_jack_report(rt5640->jack, jack_type, SND_JACK_HEADSET);
  2039. return;
  2040. }
  2041. if (!rt5640_jack_inserted(component)) {
  2042. /* Jack removed, or spurious IRQ? */
  2043. if (rt5640->jack->status & SND_JACK_HEADPHONE) {
  2044. if (rt5640->jack->status & SND_JACK_MICROPHONE) {
  2045. cancel_delayed_work_sync(&rt5640->bp_work);
  2046. rt5640_disable_micbias1_ovcd_irq(component);
  2047. rt5640_disable_micbias1_for_ovcd(component);
  2048. }
  2049. snd_soc_jack_report(rt5640->jack, 0,
  2050. SND_JACK_HEADSET | SND_JACK_BTN_0);
  2051. dev_dbg(component->dev, "jack unplugged\n");
  2052. }
  2053. } else if (!(rt5640->jack->status & SND_JACK_HEADPHONE)) {
  2054. /* Jack inserted */
  2055. WARN_ON(rt5640->ovcd_irq_enabled);
  2056. rt5640_enable_micbias1_for_ovcd(component);
  2057. status = rt5640_detect_headset(component, NULL);
  2058. if (status == SND_JACK_HEADSET) {
  2059. /* Enable ovcd IRQ for button press detect. */
  2060. rt5640_enable_micbias1_ovcd_irq(component);
  2061. } else {
  2062. /* No more need for overcurrent detect. */
  2063. rt5640_disable_micbias1_for_ovcd(component);
  2064. }
  2065. dev_dbg(component->dev, "detect status %#02x\n", status);
  2066. snd_soc_jack_report(rt5640->jack, status, SND_JACK_HEADSET);
  2067. } else if (rt5640->ovcd_irq_enabled && rt5640_micbias1_ovcd(component)) {
  2068. dev_dbg(component->dev, "OVCD IRQ\n");
  2069. /*
  2070. * The ovcd IRQ keeps firing while the button is pressed, so
  2071. * we disable it and start polling the button until released.
  2072. *
  2073. * The disable will make the IRQ pin 0 again and since we get
  2074. * IRQs on both edges (so as to detect both jack plugin and
  2075. * unplug) this means we will immediately get another IRQ.
  2076. * The ovcd_irq_enabled check above makes the 2ND IRQ a NOP.
  2077. */
  2078. rt5640_disable_micbias1_ovcd_irq(component);
  2079. rt5640_start_button_press_work(component);
  2080. /*
  2081. * If the jack-detect IRQ flag goes high (unplug) after our
  2082. * above rt5640_jack_inserted() check and before we have
  2083. * disabled the OVCD IRQ, the IRQ pin will stay high and as
  2084. * we react to edges, we miss the unplug event -> recheck.
  2085. */
  2086. queue_delayed_work(system_long_wq, &rt5640->jack_work, 0);
  2087. }
  2088. }
  2089. static irqreturn_t rt5640_irq(int irq, void *data)
  2090. {
  2091. struct rt5640_priv *rt5640 = data;
  2092. int delay = 0;
  2093. if (rt5640->jd_src == RT5640_JD_SRC_HDA_HEADER) {
  2094. cancel_delayed_work_sync(&rt5640->jack_work);
  2095. delay = 100;
  2096. }
  2097. if (rt5640->jack)
  2098. queue_delayed_work(system_long_wq, &rt5640->jack_work, delay);
  2099. return IRQ_HANDLED;
  2100. }
  2101. static irqreturn_t rt5640_jd_gpio_irq(int irq, void *data)
  2102. {
  2103. struct rt5640_priv *rt5640 = data;
  2104. queue_delayed_work(system_long_wq, &rt5640->jack_work,
  2105. msecs_to_jiffies(JACK_SETTLE_TIME));
  2106. return IRQ_HANDLED;
  2107. }
  2108. static void rt5640_cancel_work(void *data)
  2109. {
  2110. struct rt5640_priv *rt5640 = data;
  2111. cancel_delayed_work_sync(&rt5640->jack_work);
  2112. cancel_delayed_work_sync(&rt5640->bp_work);
  2113. }
  2114. void rt5640_set_ovcd_params(struct snd_soc_component *component)
  2115. {
  2116. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2117. snd_soc_component_write(component, RT5640_PR_BASE + RT5640_BIAS_CUR4,
  2118. 0xa800 | rt5640->ovcd_sf);
  2119. snd_soc_component_update_bits(component, RT5640_MICBIAS,
  2120. RT5640_MIC1_OVTH_MASK | RT5640_MIC1_OVCD_MASK,
  2121. rt5640->ovcd_th | RT5640_MIC1_OVCD_EN);
  2122. /*
  2123. * The over-current-detect is only reliable in detecting the absence
  2124. * of over-current, when the mic-contact in the jack is short-circuited,
  2125. * the hardware periodically retries if it can apply the bias-current
  2126. * leading to the ovcd status flip-flopping 1-0-1 with it being 0 about
  2127. * 10% of the time, as we poll the ovcd status bit we might hit that
  2128. * 10%, so we enable sticky mode and when checking OVCD we clear the
  2129. * status, msleep() a bit and then check to get a reliable reading.
  2130. */
  2131. snd_soc_component_update_bits(component, RT5640_IRQ_CTRL2,
  2132. RT5640_MB1_OC_STKY_MASK, RT5640_MB1_OC_STKY_EN);
  2133. }
  2134. EXPORT_SYMBOL_GPL(rt5640_set_ovcd_params);
  2135. static void rt5640_disable_jack_detect(struct snd_soc_component *component)
  2136. {
  2137. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2138. /*
  2139. * soc_remove_component() force-disables jack and thus rt5640->jack
  2140. * could be NULL at the time of driver's module unloading.
  2141. */
  2142. if (!rt5640->jack)
  2143. return;
  2144. if (rt5640->jd_gpio_irq_requested)
  2145. free_irq(rt5640->jd_gpio_irq, rt5640);
  2146. if (rt5640->irq_requested)
  2147. free_irq(rt5640->irq, rt5640);
  2148. rt5640_cancel_work(rt5640);
  2149. if (rt5640->jack->status & SND_JACK_MICROPHONE) {
  2150. rt5640_disable_micbias1_ovcd_irq(component);
  2151. rt5640_disable_micbias1_for_ovcd(component);
  2152. snd_soc_jack_report(rt5640->jack, 0, SND_JACK_BTN_0);
  2153. }
  2154. rt5640->jd_gpio_irq_requested = false;
  2155. rt5640->irq_requested = false;
  2156. rt5640->jd_gpio = NULL;
  2157. rt5640->jack = NULL;
  2158. }
  2159. static void rt5640_enable_jack_detect(struct snd_soc_component *component,
  2160. struct snd_soc_jack *jack,
  2161. struct rt5640_set_jack_data *jack_data)
  2162. {
  2163. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2164. int ret;
  2165. /* Select JD-source */
  2166. snd_soc_component_update_bits(component, RT5640_JD_CTRL,
  2167. RT5640_JD_MASK, rt5640->jd_src << RT5640_JD_SFT);
  2168. /* Selecting GPIO01 as an interrupt */
  2169. snd_soc_component_update_bits(component, RT5640_GPIO_CTRL1,
  2170. RT5640_GP1_PIN_MASK, RT5640_GP1_PIN_IRQ);
  2171. /* Set GPIO1 output */
  2172. snd_soc_component_update_bits(component, RT5640_GPIO_CTRL3,
  2173. RT5640_GP1_PF_MASK, RT5640_GP1_PF_OUT);
  2174. snd_soc_component_write(component, RT5640_DUMMY1, 0x3f41);
  2175. rt5640_set_ovcd_params(component);
  2176. /*
  2177. * All IRQs get or-ed together, so we need the jack IRQ to report 0
  2178. * when a jack is inserted so that the OVCD IRQ then toggles the IRQ
  2179. * pin 0/1 instead of it being stuck to 1. So we invert the JD polarity
  2180. * on systems where the hardware does not already do this.
  2181. */
  2182. if (rt5640->jd_inverted) {
  2183. if (rt5640->jd_src == RT5640_JD_SRC_JD1_IN4P)
  2184. snd_soc_component_write(component, RT5640_IRQ_CTRL1,
  2185. RT5640_IRQ_JD_NOR);
  2186. else if (rt5640->jd_src == RT5640_JD_SRC_JD2_IN4N)
  2187. snd_soc_component_update_bits(component, RT5640_DUMMY2,
  2188. RT5640_IRQ_JD2_MASK | RT5640_JD2_MASK,
  2189. RT5640_IRQ_JD2_NOR | RT5640_JD2_EN);
  2190. } else {
  2191. if (rt5640->jd_src == RT5640_JD_SRC_JD1_IN4P)
  2192. snd_soc_component_write(component, RT5640_IRQ_CTRL1,
  2193. RT5640_IRQ_JD_NOR | RT5640_JD_P_INV);
  2194. else if (rt5640->jd_src == RT5640_JD_SRC_JD2_IN4N)
  2195. snd_soc_component_update_bits(component, RT5640_DUMMY2,
  2196. RT5640_IRQ_JD2_MASK | RT5640_JD2_P_MASK |
  2197. RT5640_JD2_MASK,
  2198. RT5640_IRQ_JD2_NOR | RT5640_JD2_P_INV |
  2199. RT5640_JD2_EN);
  2200. }
  2201. rt5640->jack = jack;
  2202. if (rt5640->jack->status & SND_JACK_MICROPHONE) {
  2203. rt5640_enable_micbias1_for_ovcd(component);
  2204. rt5640_enable_micbias1_ovcd_irq(component);
  2205. }
  2206. if (jack_data && jack_data->codec_irq_override)
  2207. rt5640->irq = jack_data->codec_irq_override;
  2208. if (jack_data && jack_data->jd_gpio) {
  2209. rt5640->jd_gpio = jack_data->jd_gpio;
  2210. rt5640->jd_gpio_irq = gpiod_to_irq(rt5640->jd_gpio);
  2211. ret = request_irq(rt5640->jd_gpio_irq, rt5640_jd_gpio_irq,
  2212. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  2213. "rt5640-jd-gpio", rt5640);
  2214. if (ret) {
  2215. dev_warn(component->dev, "Failed to request jd GPIO IRQ %d: %d\n",
  2216. rt5640->jd_gpio_irq, ret);
  2217. rt5640_disable_jack_detect(component);
  2218. return;
  2219. }
  2220. rt5640->jd_gpio_irq_requested = true;
  2221. }
  2222. if (jack_data && jack_data->use_platform_clock)
  2223. rt5640->use_platform_clock = jack_data->use_platform_clock;
  2224. ret = request_irq(rt5640->irq, rt5640_irq,
  2225. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
  2226. "rt5640", rt5640);
  2227. if (ret) {
  2228. dev_warn(component->dev, "Failed to reguest IRQ %d: %d\n", rt5640->irq, ret);
  2229. rt5640_disable_jack_detect(component);
  2230. return;
  2231. }
  2232. rt5640->irq_requested = true;
  2233. /* sync initial jack state */
  2234. queue_delayed_work(system_long_wq, &rt5640->jack_work, 0);
  2235. }
  2236. static const struct snd_soc_dapm_route rt5640_hda_jack_dapm_routes[] = {
  2237. {"IN1P", NULL, "MICBIAS1"},
  2238. {"IN2P", NULL, "MICBIAS1"},
  2239. {"IN3P", NULL, "MICBIAS1"},
  2240. };
  2241. static void rt5640_enable_hda_jack_detect(
  2242. struct snd_soc_component *component, struct snd_soc_jack *jack)
  2243. {
  2244. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2245. struct snd_soc_dapm_context *dapm =
  2246. snd_soc_component_get_dapm(component);
  2247. int ret;
  2248. /* Select JD1 for Mic */
  2249. snd_soc_component_update_bits(component, RT5640_JD_CTRL,
  2250. RT5640_JD_MASK, RT5640_JD_JD1_IN4P);
  2251. snd_soc_component_write(component, RT5640_IRQ_CTRL1, RT5640_IRQ_JD_NOR);
  2252. /* Select JD2 for Headphone */
  2253. snd_soc_component_update_bits(component, RT5640_DUMMY2, 0x1100, 0x1100);
  2254. /* Selecting GPIO01 as an interrupt */
  2255. snd_soc_component_update_bits(component, RT5640_GPIO_CTRL1,
  2256. RT5640_GP1_PIN_MASK, RT5640_GP1_PIN_IRQ);
  2257. /* Set GPIO1 output */
  2258. snd_soc_component_update_bits(component, RT5640_GPIO_CTRL3,
  2259. RT5640_GP1_PF_MASK, RT5640_GP1_PF_OUT);
  2260. snd_soc_component_update_bits(component, RT5640_DUMMY1, 0x400, 0x0);
  2261. snd_soc_component_update_bits(component, RT5640_PWR_ANLG1,
  2262. RT5640_PWR_VREF2 | RT5640_PWR_MB | RT5640_PWR_BG,
  2263. RT5640_PWR_VREF2 | RT5640_PWR_MB | RT5640_PWR_BG);
  2264. usleep_range(10000, 15000);
  2265. snd_soc_component_update_bits(component, RT5640_PWR_ANLG1,
  2266. RT5640_PWR_FV2, RT5640_PWR_FV2);
  2267. rt5640->jack = jack;
  2268. ret = request_irq(rt5640->irq, rt5640_irq,
  2269. IRQF_TRIGGER_RISING | IRQF_ONESHOT, "rt5640", rt5640);
  2270. if (ret) {
  2271. dev_warn(component->dev, "Failed to reguest IRQ %d: %d\n", rt5640->irq, ret);
  2272. rt5640->irq = -ENXIO;
  2273. return;
  2274. }
  2275. rt5640->irq_requested = true;
  2276. /* sync initial jack state */
  2277. queue_delayed_work(system_long_wq, &rt5640->jack_work, 0);
  2278. snd_soc_dapm_add_routes(dapm, rt5640_hda_jack_dapm_routes,
  2279. ARRAY_SIZE(rt5640_hda_jack_dapm_routes));
  2280. }
  2281. static int rt5640_set_jack(struct snd_soc_component *component,
  2282. struct snd_soc_jack *jack, void *data)
  2283. {
  2284. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2285. if (jack) {
  2286. if (rt5640->jd_src == RT5640_JD_SRC_HDA_HEADER)
  2287. rt5640_enable_hda_jack_detect(component, jack);
  2288. else
  2289. rt5640_enable_jack_detect(component, jack, data);
  2290. } else {
  2291. rt5640_disable_jack_detect(component);
  2292. }
  2293. return 0;
  2294. }
  2295. static int rt5640_probe(struct snd_soc_component *component)
  2296. {
  2297. struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
  2298. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2299. u32 dmic1_data_pin = 0;
  2300. u32 dmic2_data_pin = 0;
  2301. bool dmic_en = false;
  2302. u32 val;
  2303. /* Check if MCLK provided */
  2304. rt5640->mclk = devm_clk_get(component->dev, "mclk");
  2305. if (PTR_ERR(rt5640->mclk) == -EPROBE_DEFER)
  2306. return -EPROBE_DEFER;
  2307. rt5640->component = component;
  2308. snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
  2309. snd_soc_component_update_bits(component, RT5640_DUMMY1, 0x0301, 0x0301);
  2310. snd_soc_component_update_bits(component, RT5640_MICBIAS, 0x0030, 0x0030);
  2311. snd_soc_component_update_bits(component, RT5640_DSP_PATH2, 0xfc00, 0x0c00);
  2312. switch (snd_soc_component_read(component, RT5640_RESET) & RT5640_ID_MASK) {
  2313. case RT5640_ID_5640:
  2314. case RT5640_ID_5642:
  2315. snd_soc_add_component_controls(component,
  2316. rt5640_specific_snd_controls,
  2317. ARRAY_SIZE(rt5640_specific_snd_controls));
  2318. snd_soc_dapm_new_controls(dapm,
  2319. rt5640_specific_dapm_widgets,
  2320. ARRAY_SIZE(rt5640_specific_dapm_widgets));
  2321. snd_soc_dapm_add_routes(dapm,
  2322. rt5640_specific_dapm_routes,
  2323. ARRAY_SIZE(rt5640_specific_dapm_routes));
  2324. break;
  2325. case RT5640_ID_5639:
  2326. snd_soc_dapm_new_controls(dapm,
  2327. rt5639_specific_dapm_widgets,
  2328. ARRAY_SIZE(rt5639_specific_dapm_widgets));
  2329. snd_soc_dapm_add_routes(dapm,
  2330. rt5639_specific_dapm_routes,
  2331. ARRAY_SIZE(rt5639_specific_dapm_routes));
  2332. break;
  2333. default:
  2334. dev_err(component->dev,
  2335. "The driver is for RT5639 RT5640 or RT5642 only\n");
  2336. return -ENODEV;
  2337. }
  2338. /*
  2339. * Note on some platforms the platform code may need to add device-props
  2340. * rather then relying only on properties set by the firmware.
  2341. * Therefor the property parsing MUST be done here, rather then from
  2342. * rt5640_i2c_probe(), so that the platform-code can attach extra
  2343. * properties before calling snd_soc_register_card().
  2344. */
  2345. if (device_property_read_bool(component->dev, "realtek,in1-differential"))
  2346. snd_soc_component_update_bits(component, RT5640_IN1_IN2,
  2347. RT5640_IN_DF1, RT5640_IN_DF1);
  2348. if (device_property_read_bool(component->dev, "realtek,in2-differential"))
  2349. snd_soc_component_update_bits(component, RT5640_IN3_IN4,
  2350. RT5640_IN_DF2, RT5640_IN_DF2);
  2351. if (device_property_read_bool(component->dev, "realtek,in3-differential"))
  2352. snd_soc_component_update_bits(component, RT5640_IN1_IN2,
  2353. RT5640_IN_DF2, RT5640_IN_DF2);
  2354. if (device_property_read_u32(component->dev, "realtek,dmic1-data-pin",
  2355. &val) == 0 && val) {
  2356. dmic1_data_pin = val - 1;
  2357. dmic_en = true;
  2358. }
  2359. if (device_property_read_u32(component->dev, "realtek,dmic2-data-pin",
  2360. &val) == 0 && val) {
  2361. dmic2_data_pin = val - 1;
  2362. dmic_en = true;
  2363. }
  2364. if (dmic_en)
  2365. rt5640_dmic_enable(component, dmic1_data_pin, dmic2_data_pin);
  2366. if (device_property_read_u32(component->dev,
  2367. "realtek,jack-detect-source", &val) == 0) {
  2368. if (val <= RT5640_JD_SRC_HDA_HEADER)
  2369. rt5640->jd_src = val;
  2370. else
  2371. dev_warn(component->dev, "Warning: Invalid jack-detect-source value: %d, leaving jack-detect disabled\n",
  2372. val);
  2373. }
  2374. if (!device_property_read_bool(component->dev, "realtek,jack-detect-not-inverted"))
  2375. rt5640->jd_inverted = true;
  2376. /*
  2377. * Testing on various boards has shown that good defaults for the OVCD
  2378. * threshold and scale-factor are 2000µA and 0.75. For an effective
  2379. * limit of 1500µA, this seems to be more reliable then 1500µA and 1.0.
  2380. */
  2381. rt5640->ovcd_th = RT5640_MIC1_OVTH_2000UA;
  2382. rt5640->ovcd_sf = RT5640_MIC_OVCD_SF_0P75;
  2383. if (device_property_read_u32(component->dev,
  2384. "realtek,over-current-threshold-microamp", &val) == 0) {
  2385. switch (val) {
  2386. case 600:
  2387. rt5640->ovcd_th = RT5640_MIC1_OVTH_600UA;
  2388. break;
  2389. case 1500:
  2390. rt5640->ovcd_th = RT5640_MIC1_OVTH_1500UA;
  2391. break;
  2392. case 2000:
  2393. rt5640->ovcd_th = RT5640_MIC1_OVTH_2000UA;
  2394. break;
  2395. default:
  2396. dev_warn(component->dev, "Warning: Invalid over-current-threshold-microamp value: %d, defaulting to 2000uA\n",
  2397. val);
  2398. }
  2399. }
  2400. if (device_property_read_u32(component->dev,
  2401. "realtek,over-current-scale-factor", &val) == 0) {
  2402. if (val <= RT5640_OVCD_SF_1P5)
  2403. rt5640->ovcd_sf = val << RT5640_MIC_OVCD_SF_SFT;
  2404. else
  2405. dev_warn(component->dev, "Warning: Invalid over-current-scale-factor value: %d, defaulting to 0.75\n",
  2406. val);
  2407. }
  2408. return 0;
  2409. }
  2410. static void rt5640_remove(struct snd_soc_component *component)
  2411. {
  2412. rt5640_reset(component);
  2413. }
  2414. #ifdef CONFIG_PM
  2415. static int rt5640_suspend(struct snd_soc_component *component)
  2416. {
  2417. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2418. rt5640_cancel_work(rt5640);
  2419. snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
  2420. rt5640_reset(component);
  2421. regcache_cache_only(rt5640->regmap, true);
  2422. regcache_mark_dirty(rt5640->regmap);
  2423. if (gpio_is_valid(rt5640->ldo1_en))
  2424. gpio_set_value_cansleep(rt5640->ldo1_en, 0);
  2425. return 0;
  2426. }
  2427. static int rt5640_resume(struct snd_soc_component *component)
  2428. {
  2429. struct rt5640_priv *rt5640 = snd_soc_component_get_drvdata(component);
  2430. if (gpio_is_valid(rt5640->ldo1_en)) {
  2431. gpio_set_value_cansleep(rt5640->ldo1_en, 1);
  2432. msleep(400);
  2433. }
  2434. regcache_cache_only(rt5640->regmap, false);
  2435. regcache_sync(rt5640->regmap);
  2436. if (rt5640->jack) {
  2437. if (rt5640->jd_src == RT5640_JD_SRC_HDA_HEADER) {
  2438. snd_soc_component_update_bits(component,
  2439. RT5640_DUMMY2, 0x1100, 0x1100);
  2440. } else {
  2441. if (rt5640->jd_inverted) {
  2442. if (rt5640->jd_src == RT5640_JD_SRC_JD2_IN4N)
  2443. snd_soc_component_update_bits(
  2444. component, RT5640_DUMMY2,
  2445. RT5640_IRQ_JD2_MASK |
  2446. RT5640_JD2_MASK,
  2447. RT5640_IRQ_JD2_NOR |
  2448. RT5640_JD2_EN);
  2449. } else {
  2450. if (rt5640->jd_src == RT5640_JD_SRC_JD2_IN4N)
  2451. snd_soc_component_update_bits(
  2452. component, RT5640_DUMMY2,
  2453. RT5640_IRQ_JD2_MASK |
  2454. RT5640_JD2_P_MASK |
  2455. RT5640_JD2_MASK,
  2456. RT5640_IRQ_JD2_NOR |
  2457. RT5640_JD2_P_INV |
  2458. RT5640_JD2_EN);
  2459. }
  2460. }
  2461. queue_delayed_work(system_long_wq, &rt5640->jack_work, 0);
  2462. }
  2463. return 0;
  2464. }
  2465. #else
  2466. #define rt5640_suspend NULL
  2467. #define rt5640_resume NULL
  2468. #endif
  2469. #define RT5640_STEREO_RATES SNDRV_PCM_RATE_8000_96000
  2470. #define RT5640_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
  2471. SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8)
  2472. static const struct snd_soc_dai_ops rt5640_aif_dai_ops = {
  2473. .hw_params = rt5640_hw_params,
  2474. .set_fmt = rt5640_set_dai_fmt,
  2475. .set_sysclk = rt5640_set_dai_sysclk,
  2476. .set_pll = rt5640_set_dai_pll,
  2477. };
  2478. static struct snd_soc_dai_driver rt5640_dai[] = {
  2479. {
  2480. .name = "rt5640-aif1",
  2481. .id = RT5640_AIF1,
  2482. .playback = {
  2483. .stream_name = "AIF1 Playback",
  2484. .channels_min = 1,
  2485. .channels_max = 2,
  2486. .rates = RT5640_STEREO_RATES,
  2487. .formats = RT5640_FORMATS,
  2488. },
  2489. .capture = {
  2490. .stream_name = "AIF1 Capture",
  2491. .channels_min = 1,
  2492. .channels_max = 2,
  2493. .rates = RT5640_STEREO_RATES,
  2494. .formats = RT5640_FORMATS,
  2495. },
  2496. .ops = &rt5640_aif_dai_ops,
  2497. },
  2498. {
  2499. .name = "rt5640-aif2",
  2500. .id = RT5640_AIF2,
  2501. .playback = {
  2502. .stream_name = "AIF2 Playback",
  2503. .channels_min = 1,
  2504. .channels_max = 2,
  2505. .rates = RT5640_STEREO_RATES,
  2506. .formats = RT5640_FORMATS,
  2507. },
  2508. .capture = {
  2509. .stream_name = "AIF2 Capture",
  2510. .channels_min = 1,
  2511. .channels_max = 2,
  2512. .rates = RT5640_STEREO_RATES,
  2513. .formats = RT5640_FORMATS,
  2514. },
  2515. .ops = &rt5640_aif_dai_ops,
  2516. },
  2517. };
  2518. static const struct snd_soc_component_driver soc_component_dev_rt5640 = {
  2519. .probe = rt5640_probe,
  2520. .remove = rt5640_remove,
  2521. .suspend = rt5640_suspend,
  2522. .resume = rt5640_resume,
  2523. .set_bias_level = rt5640_set_bias_level,
  2524. .set_jack = rt5640_set_jack,
  2525. .controls = rt5640_snd_controls,
  2526. .num_controls = ARRAY_SIZE(rt5640_snd_controls),
  2527. .dapm_widgets = rt5640_dapm_widgets,
  2528. .num_dapm_widgets = ARRAY_SIZE(rt5640_dapm_widgets),
  2529. .dapm_routes = rt5640_dapm_routes,
  2530. .num_dapm_routes = ARRAY_SIZE(rt5640_dapm_routes),
  2531. .use_pmdown_time = 1,
  2532. .endianness = 1,
  2533. };
  2534. static const struct regmap_config rt5640_regmap = {
  2535. .reg_bits = 8,
  2536. .val_bits = 16,
  2537. .use_single_read = true,
  2538. .use_single_write = true,
  2539. .max_register = RT5640_VENDOR_ID2 + 1 + (ARRAY_SIZE(rt5640_ranges) *
  2540. RT5640_PR_SPACING),
  2541. .volatile_reg = rt5640_volatile_register,
  2542. .readable_reg = rt5640_readable_register,
  2543. .cache_type = REGCACHE_RBTREE,
  2544. .reg_defaults = rt5640_reg,
  2545. .num_reg_defaults = ARRAY_SIZE(rt5640_reg),
  2546. .ranges = rt5640_ranges,
  2547. .num_ranges = ARRAY_SIZE(rt5640_ranges),
  2548. };
  2549. static const struct i2c_device_id rt5640_i2c_id[] = {
  2550. { "rt5640", 0 },
  2551. { "rt5639", 0 },
  2552. { "rt5642", 0 },
  2553. { }
  2554. };
  2555. MODULE_DEVICE_TABLE(i2c, rt5640_i2c_id);
  2556. #if defined(CONFIG_OF)
  2557. static const struct of_device_id rt5640_of_match[] = {
  2558. { .compatible = "realtek,rt5639", },
  2559. { .compatible = "realtek,rt5640", },
  2560. {},
  2561. };
  2562. MODULE_DEVICE_TABLE(of, rt5640_of_match);
  2563. #endif
  2564. #ifdef CONFIG_ACPI
  2565. static const struct acpi_device_id rt5640_acpi_match[] = {
  2566. { "INT33CA", 0 },
  2567. { "10EC3276", 0 },
  2568. { "10EC5640", 0 },
  2569. { "10EC5642", 0 },
  2570. { "INTCCFFD", 0 },
  2571. { },
  2572. };
  2573. MODULE_DEVICE_TABLE(acpi, rt5640_acpi_match);
  2574. #endif
  2575. static int rt5640_parse_dt(struct rt5640_priv *rt5640, struct device_node *np)
  2576. {
  2577. rt5640->ldo1_en = of_get_named_gpio(np, "realtek,ldo1-en-gpios", 0);
  2578. /*
  2579. * LDO1_EN is optional (it may be statically tied on the board).
  2580. * -ENOENT means that the property doesn't exist, i.e. there is no
  2581. * GPIO, so is not an error. Any other error code means the property
  2582. * exists, but could not be parsed.
  2583. */
  2584. if (!gpio_is_valid(rt5640->ldo1_en) &&
  2585. (rt5640->ldo1_en != -ENOENT))
  2586. return rt5640->ldo1_en;
  2587. return 0;
  2588. }
  2589. static int rt5640_i2c_probe(struct i2c_client *i2c)
  2590. {
  2591. struct rt5640_priv *rt5640;
  2592. int ret;
  2593. unsigned int val;
  2594. rt5640 = devm_kzalloc(&i2c->dev,
  2595. sizeof(struct rt5640_priv),
  2596. GFP_KERNEL);
  2597. if (NULL == rt5640)
  2598. return -ENOMEM;
  2599. i2c_set_clientdata(i2c, rt5640);
  2600. if (i2c->dev.of_node) {
  2601. ret = rt5640_parse_dt(rt5640, i2c->dev.of_node);
  2602. if (ret)
  2603. return ret;
  2604. } else
  2605. rt5640->ldo1_en = -EINVAL;
  2606. rt5640->regmap = devm_regmap_init_i2c(i2c, &rt5640_regmap);
  2607. if (IS_ERR(rt5640->regmap)) {
  2608. ret = PTR_ERR(rt5640->regmap);
  2609. dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
  2610. ret);
  2611. return ret;
  2612. }
  2613. if (gpio_is_valid(rt5640->ldo1_en)) {
  2614. ret = devm_gpio_request_one(&i2c->dev, rt5640->ldo1_en,
  2615. GPIOF_OUT_INIT_HIGH,
  2616. "RT5640 LDO1_EN");
  2617. if (ret < 0) {
  2618. dev_err(&i2c->dev, "Failed to request LDO1_EN %d: %d\n",
  2619. rt5640->ldo1_en, ret);
  2620. return ret;
  2621. }
  2622. msleep(400);
  2623. }
  2624. regmap_read(rt5640->regmap, RT5640_VENDOR_ID2, &val);
  2625. if (val != RT5640_DEVICE_ID) {
  2626. dev_err(&i2c->dev,
  2627. "Device with ID register %#x is not rt5640/39\n", val);
  2628. return -ENODEV;
  2629. }
  2630. regmap_write(rt5640->regmap, RT5640_RESET, 0);
  2631. ret = regmap_register_patch(rt5640->regmap, init_list,
  2632. ARRAY_SIZE(init_list));
  2633. if (ret != 0)
  2634. dev_warn(&i2c->dev, "Failed to apply regmap patch: %d\n", ret);
  2635. regmap_update_bits(rt5640->regmap, RT5640_DUMMY1,
  2636. RT5640_MCLK_DET, RT5640_MCLK_DET);
  2637. rt5640->hp_mute = true;
  2638. rt5640->irq = i2c->irq;
  2639. INIT_DELAYED_WORK(&rt5640->bp_work, rt5640_button_press_work);
  2640. INIT_DELAYED_WORK(&rt5640->jack_work, rt5640_jack_work);
  2641. /* Make sure work is stopped on probe-error / remove */
  2642. ret = devm_add_action_or_reset(&i2c->dev, rt5640_cancel_work, rt5640);
  2643. if (ret)
  2644. return ret;
  2645. return devm_snd_soc_register_component(&i2c->dev,
  2646. &soc_component_dev_rt5640,
  2647. rt5640_dai, ARRAY_SIZE(rt5640_dai));
  2648. }
  2649. static struct i2c_driver rt5640_i2c_driver = {
  2650. .driver = {
  2651. .name = "rt5640",
  2652. .acpi_match_table = ACPI_PTR(rt5640_acpi_match),
  2653. .of_match_table = of_match_ptr(rt5640_of_match),
  2654. },
  2655. .probe_new = rt5640_i2c_probe,
  2656. .id_table = rt5640_i2c_id,
  2657. };
  2658. module_i2c_driver(rt5640_i2c_driver);
  2659. MODULE_DESCRIPTION("ASoC RT5640/RT5639 driver");
  2660. MODULE_AUTHOR("Johnny Hsu <[email protected]>");
  2661. MODULE_LICENSE("GPL v2");