rt5640.c 88 KB

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