wm8996.c 90 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015
  1. /*
  2. * wm8996.c - WM8996 audio codec interface
  3. *
  4. * Copyright 2011 Wolfson Microelectronics PLC.
  5. * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License as published by the
  9. * Free Software Foundation; either version 2 of the License, or (at your
  10. * option) any later version.
  11. */
  12. #include <linux/module.h>
  13. #include <linux/moduleparam.h>
  14. #include <linux/init.h>
  15. #include <linux/completion.h>
  16. #include <linux/delay.h>
  17. #include <linux/pm.h>
  18. #include <linux/gcd.h>
  19. #include <linux/gpio.h>
  20. #include <linux/i2c.h>
  21. #include <linux/regulator/consumer.h>
  22. #include <linux/slab.h>
  23. #include <linux/workqueue.h>
  24. #include <sound/core.h>
  25. #include <sound/jack.h>
  26. #include <sound/pcm.h>
  27. #include <sound/pcm_params.h>
  28. #include <sound/soc.h>
  29. #include <sound/initval.h>
  30. #include <sound/tlv.h>
  31. #include <trace/events/asoc.h>
  32. #include <sound/wm8996.h>
  33. #include "wm8996.h"
  34. #define WM8996_AIFS 2
  35. #define HPOUT1L 1
  36. #define HPOUT1R 2
  37. #define HPOUT2L 4
  38. #define HPOUT2R 8
  39. #define WM8996_NUM_SUPPLIES 4
  40. static const char *wm8996_supply_names[WM8996_NUM_SUPPLIES] = {
  41. "DBVDD",
  42. "AVDD1",
  43. "AVDD2",
  44. "CPVDD",
  45. };
  46. struct wm8996_priv {
  47. struct snd_soc_codec *codec;
  48. int ldo1ena;
  49. int sysclk;
  50. int sysclk_src;
  51. int fll_src;
  52. int fll_fref;
  53. int fll_fout;
  54. struct completion fll_lock;
  55. u16 dcs_pending;
  56. struct completion dcs_done;
  57. u16 hpout_ena;
  58. u16 hpout_pending;
  59. struct regulator_bulk_data supplies[WM8996_NUM_SUPPLIES];
  60. struct notifier_block disable_nb[WM8996_NUM_SUPPLIES];
  61. struct wm8996_pdata pdata;
  62. int rx_rate[WM8996_AIFS];
  63. int bclk_rate[WM8996_AIFS];
  64. /* Platform dependant ReTune mobile configuration */
  65. int num_retune_mobile_texts;
  66. const char **retune_mobile_texts;
  67. int retune_mobile_cfg[2];
  68. struct soc_enum retune_mobile_enum;
  69. struct snd_soc_jack *jack;
  70. bool detecting;
  71. bool jack_mic;
  72. wm8996_polarity_fn polarity_cb;
  73. #ifdef CONFIG_GPIOLIB
  74. struct gpio_chip gpio_chip;
  75. #endif
  76. };
  77. /* We can't use the same notifier block for more than one supply and
  78. * there's no way I can see to get from a callback to the caller
  79. * except container_of().
  80. */
  81. #define WM8996_REGULATOR_EVENT(n) \
  82. static int wm8996_regulator_event_##n(struct notifier_block *nb, \
  83. unsigned long event, void *data) \
  84. { \
  85. struct wm8996_priv *wm8996 = container_of(nb, struct wm8996_priv, \
  86. disable_nb[n]); \
  87. if (event & REGULATOR_EVENT_DISABLE) { \
  88. wm8996->codec->cache_sync = 1; \
  89. } \
  90. return 0; \
  91. }
  92. WM8996_REGULATOR_EVENT(0)
  93. WM8996_REGULATOR_EVENT(1)
  94. WM8996_REGULATOR_EVENT(2)
  95. WM8996_REGULATOR_EVENT(3)
  96. static const u16 wm8996_reg[WM8996_MAX_REGISTER] = {
  97. [WM8996_SOFTWARE_RESET] = 0x8996,
  98. [WM8996_POWER_MANAGEMENT_7] = 0x10,
  99. [WM8996_DAC1_HPOUT1_VOLUME] = 0x88,
  100. [WM8996_DAC2_HPOUT2_VOLUME] = 0x88,
  101. [WM8996_DAC1_LEFT_VOLUME] = 0x2c0,
  102. [WM8996_DAC1_RIGHT_VOLUME] = 0x2c0,
  103. [WM8996_DAC2_LEFT_VOLUME] = 0x2c0,
  104. [WM8996_DAC2_RIGHT_VOLUME] = 0x2c0,
  105. [WM8996_OUTPUT1_LEFT_VOLUME] = 0x80,
  106. [WM8996_OUTPUT1_RIGHT_VOLUME] = 0x80,
  107. [WM8996_OUTPUT2_LEFT_VOLUME] = 0x80,
  108. [WM8996_OUTPUT2_RIGHT_VOLUME] = 0x80,
  109. [WM8996_MICBIAS_1] = 0x39,
  110. [WM8996_MICBIAS_2] = 0x39,
  111. [WM8996_LDO_1] = 0x3,
  112. [WM8996_LDO_2] = 0x13,
  113. [WM8996_ACCESSORY_DETECT_MODE_1] = 0x4,
  114. [WM8996_HEADPHONE_DETECT_1] = 0x20,
  115. [WM8996_MIC_DETECT_1] = 0x7600,
  116. [WM8996_MIC_DETECT_2] = 0xbf,
  117. [WM8996_CHARGE_PUMP_1] = 0x1f25,
  118. [WM8996_CHARGE_PUMP_2] = 0xab19,
  119. [WM8996_DC_SERVO_5] = 0x2a2a,
  120. [WM8996_CONTROL_INTERFACE_1] = 0x8004,
  121. [WM8996_CLOCKING_1] = 0x10,
  122. [WM8996_AIF_RATE] = 0x83,
  123. [WM8996_FLL_CONTROL_4] = 0x5dc0,
  124. [WM8996_FLL_CONTROL_5] = 0xc84,
  125. [WM8996_FLL_EFS_2] = 0x2,
  126. [WM8996_AIF1_TX_LRCLK_1] = 0x80,
  127. [WM8996_AIF1_TX_LRCLK_2] = 0x8,
  128. [WM8996_AIF1_RX_LRCLK_1] = 0x80,
  129. [WM8996_AIF1TX_DATA_CONFIGURATION_1] = 0x1818,
  130. [WM8996_AIF1RX_DATA_CONFIGURATION] = 0x1818,
  131. [WM8996_AIF1TX_TEST] = 0x7,
  132. [WM8996_AIF2_TX_LRCLK_1] = 0x80,
  133. [WM8996_AIF2_TX_LRCLK_2] = 0x8,
  134. [WM8996_AIF2_RX_LRCLK_1] = 0x80,
  135. [WM8996_AIF2TX_DATA_CONFIGURATION_1] = 0x1818,
  136. [WM8996_AIF2RX_DATA_CONFIGURATION] = 0x1818,
  137. [WM8996_AIF2TX_TEST] = 0x1,
  138. [WM8996_DSP1_TX_LEFT_VOLUME] = 0xc0,
  139. [WM8996_DSP1_TX_RIGHT_VOLUME] = 0xc0,
  140. [WM8996_DSP1_RX_LEFT_VOLUME] = 0xc0,
  141. [WM8996_DSP1_RX_RIGHT_VOLUME] = 0xc0,
  142. [WM8996_DSP1_TX_FILTERS] = 0x2000,
  143. [WM8996_DSP1_RX_FILTERS_1] = 0x200,
  144. [WM8996_DSP1_RX_FILTERS_2] = 0x10,
  145. [WM8996_DSP1_DRC_1] = 0x98,
  146. [WM8996_DSP1_DRC_2] = 0x845,
  147. [WM8996_DSP1_RX_EQ_GAINS_1] = 0x6318,
  148. [WM8996_DSP1_RX_EQ_GAINS_2] = 0x6300,
  149. [WM8996_DSP1_RX_EQ_BAND_1_A] = 0xfca,
  150. [WM8996_DSP1_RX_EQ_BAND_1_B] = 0x400,
  151. [WM8996_DSP1_RX_EQ_BAND_1_PG] = 0xd8,
  152. [WM8996_DSP1_RX_EQ_BAND_2_A] = 0x1eb5,
  153. [WM8996_DSP1_RX_EQ_BAND_2_B] = 0xf145,
  154. [WM8996_DSP1_RX_EQ_BAND_2_C] = 0xb75,
  155. [WM8996_DSP1_RX_EQ_BAND_2_PG] = 0x1c5,
  156. [WM8996_DSP1_RX_EQ_BAND_3_A] = 0x1c58,
  157. [WM8996_DSP1_RX_EQ_BAND_3_B] = 0xf373,
  158. [WM8996_DSP1_RX_EQ_BAND_3_C] = 0xa54,
  159. [WM8996_DSP1_RX_EQ_BAND_3_PG] = 0x558,
  160. [WM8996_DSP1_RX_EQ_BAND_4_A] = 0x168e,
  161. [WM8996_DSP1_RX_EQ_BAND_4_B] = 0xf829,
  162. [WM8996_DSP1_RX_EQ_BAND_4_C] = 0x7ad,
  163. [WM8996_DSP1_RX_EQ_BAND_4_PG] = 0x1103,
  164. [WM8996_DSP1_RX_EQ_BAND_5_A] = 0x564,
  165. [WM8996_DSP1_RX_EQ_BAND_5_B] = 0x559,
  166. [WM8996_DSP1_RX_EQ_BAND_5_PG] = 0x4000,
  167. [WM8996_DSP2_TX_LEFT_VOLUME] = 0xc0,
  168. [WM8996_DSP2_TX_RIGHT_VOLUME] = 0xc0,
  169. [WM8996_DSP2_RX_LEFT_VOLUME] = 0xc0,
  170. [WM8996_DSP2_RX_RIGHT_VOLUME] = 0xc0,
  171. [WM8996_DSP2_TX_FILTERS] = 0x2000,
  172. [WM8996_DSP2_RX_FILTERS_1] = 0x200,
  173. [WM8996_DSP2_RX_FILTERS_2] = 0x10,
  174. [WM8996_DSP2_DRC_1] = 0x98,
  175. [WM8996_DSP2_DRC_2] = 0x845,
  176. [WM8996_DSP2_RX_EQ_GAINS_1] = 0x6318,
  177. [WM8996_DSP2_RX_EQ_GAINS_2] = 0x6300,
  178. [WM8996_DSP2_RX_EQ_BAND_1_A] = 0xfca,
  179. [WM8996_DSP2_RX_EQ_BAND_1_B] = 0x400,
  180. [WM8996_DSP2_RX_EQ_BAND_1_PG] = 0xd8,
  181. [WM8996_DSP2_RX_EQ_BAND_2_A] = 0x1eb5,
  182. [WM8996_DSP2_RX_EQ_BAND_2_B] = 0xf145,
  183. [WM8996_DSP2_RX_EQ_BAND_2_C] = 0xb75,
  184. [WM8996_DSP2_RX_EQ_BAND_2_PG] = 0x1c5,
  185. [WM8996_DSP2_RX_EQ_BAND_3_A] = 0x1c58,
  186. [WM8996_DSP2_RX_EQ_BAND_3_B] = 0xf373,
  187. [WM8996_DSP2_RX_EQ_BAND_3_C] = 0xa54,
  188. [WM8996_DSP2_RX_EQ_BAND_3_PG] = 0x558,
  189. [WM8996_DSP2_RX_EQ_BAND_4_A] = 0x168e,
  190. [WM8996_DSP2_RX_EQ_BAND_4_B] = 0xf829,
  191. [WM8996_DSP2_RX_EQ_BAND_4_C] = 0x7ad,
  192. [WM8996_DSP2_RX_EQ_BAND_4_PG] = 0x1103,
  193. [WM8996_DSP2_RX_EQ_BAND_5_A] = 0x564,
  194. [WM8996_DSP2_RX_EQ_BAND_5_B] = 0x559,
  195. [WM8996_DSP2_RX_EQ_BAND_5_PG] = 0x4000,
  196. [WM8996_OVERSAMPLING] = 0xd,
  197. [WM8996_SIDETONE] = 0x1040,
  198. [WM8996_GPIO_1] = 0xa101,
  199. [WM8996_GPIO_2] = 0xa101,
  200. [WM8996_GPIO_3] = 0xa101,
  201. [WM8996_GPIO_4] = 0xa101,
  202. [WM8996_GPIO_5] = 0xa101,
  203. [WM8996_PULL_CONTROL_2] = 0x140,
  204. [WM8996_INTERRUPT_STATUS_1_MASK] = 0x1f,
  205. [WM8996_INTERRUPT_STATUS_2_MASK] = 0x1ecf,
  206. [WM8996_RIGHT_PDM_SPEAKER] = 0x1,
  207. [WM8996_PDM_SPEAKER_MUTE_SEQUENCE] = 0x69,
  208. [WM8996_PDM_SPEAKER_VOLUME] = 0x66,
  209. [WM8996_WRITE_SEQUENCER_0] = 0x1,
  210. [WM8996_WRITE_SEQUENCER_1] = 0x1,
  211. [WM8996_WRITE_SEQUENCER_3] = 0x6,
  212. [WM8996_WRITE_SEQUENCER_4] = 0x40,
  213. [WM8996_WRITE_SEQUENCER_5] = 0x1,
  214. [WM8996_WRITE_SEQUENCER_6] = 0xf,
  215. [WM8996_WRITE_SEQUENCER_7] = 0x6,
  216. [WM8996_WRITE_SEQUENCER_8] = 0x1,
  217. [WM8996_WRITE_SEQUENCER_9] = 0x3,
  218. [WM8996_WRITE_SEQUENCER_10] = 0x104,
  219. [WM8996_WRITE_SEQUENCER_12] = 0x60,
  220. [WM8996_WRITE_SEQUENCER_13] = 0x11,
  221. [WM8996_WRITE_SEQUENCER_14] = 0x401,
  222. [WM8996_WRITE_SEQUENCER_16] = 0x50,
  223. [WM8996_WRITE_SEQUENCER_17] = 0x3,
  224. [WM8996_WRITE_SEQUENCER_18] = 0x100,
  225. [WM8996_WRITE_SEQUENCER_20] = 0x51,
  226. [WM8996_WRITE_SEQUENCER_21] = 0x3,
  227. [WM8996_WRITE_SEQUENCER_22] = 0x104,
  228. [WM8996_WRITE_SEQUENCER_23] = 0xa,
  229. [WM8996_WRITE_SEQUENCER_24] = 0x60,
  230. [WM8996_WRITE_SEQUENCER_25] = 0x3b,
  231. [WM8996_WRITE_SEQUENCER_26] = 0x502,
  232. [WM8996_WRITE_SEQUENCER_27] = 0x100,
  233. [WM8996_WRITE_SEQUENCER_28] = 0x2fff,
  234. [WM8996_WRITE_SEQUENCER_32] = 0x2fff,
  235. [WM8996_WRITE_SEQUENCER_36] = 0x2fff,
  236. [WM8996_WRITE_SEQUENCER_40] = 0x2fff,
  237. [WM8996_WRITE_SEQUENCER_44] = 0x2fff,
  238. [WM8996_WRITE_SEQUENCER_48] = 0x2fff,
  239. [WM8996_WRITE_SEQUENCER_52] = 0x2fff,
  240. [WM8996_WRITE_SEQUENCER_56] = 0x2fff,
  241. [WM8996_WRITE_SEQUENCER_60] = 0x2fff,
  242. [WM8996_WRITE_SEQUENCER_64] = 0x1,
  243. [WM8996_WRITE_SEQUENCER_65] = 0x1,
  244. [WM8996_WRITE_SEQUENCER_67] = 0x6,
  245. [WM8996_WRITE_SEQUENCER_68] = 0x40,
  246. [WM8996_WRITE_SEQUENCER_69] = 0x1,
  247. [WM8996_WRITE_SEQUENCER_70] = 0xf,
  248. [WM8996_WRITE_SEQUENCER_71] = 0x6,
  249. [WM8996_WRITE_SEQUENCER_72] = 0x1,
  250. [WM8996_WRITE_SEQUENCER_73] = 0x3,
  251. [WM8996_WRITE_SEQUENCER_74] = 0x104,
  252. [WM8996_WRITE_SEQUENCER_76] = 0x60,
  253. [WM8996_WRITE_SEQUENCER_77] = 0x11,
  254. [WM8996_WRITE_SEQUENCER_78] = 0x401,
  255. [WM8996_WRITE_SEQUENCER_80] = 0x50,
  256. [WM8996_WRITE_SEQUENCER_81] = 0x3,
  257. [WM8996_WRITE_SEQUENCER_82] = 0x100,
  258. [WM8996_WRITE_SEQUENCER_84] = 0x60,
  259. [WM8996_WRITE_SEQUENCER_85] = 0x3b,
  260. [WM8996_WRITE_SEQUENCER_86] = 0x502,
  261. [WM8996_WRITE_SEQUENCER_87] = 0x100,
  262. [WM8996_WRITE_SEQUENCER_88] = 0x2fff,
  263. [WM8996_WRITE_SEQUENCER_92] = 0x2fff,
  264. [WM8996_WRITE_SEQUENCER_96] = 0x2fff,
  265. [WM8996_WRITE_SEQUENCER_100] = 0x2fff,
  266. [WM8996_WRITE_SEQUENCER_104] = 0x2fff,
  267. [WM8996_WRITE_SEQUENCER_108] = 0x2fff,
  268. [WM8996_WRITE_SEQUENCER_112] = 0x2fff,
  269. [WM8996_WRITE_SEQUENCER_116] = 0x2fff,
  270. [WM8996_WRITE_SEQUENCER_120] = 0x2fff,
  271. [WM8996_WRITE_SEQUENCER_124] = 0x2fff,
  272. [WM8996_WRITE_SEQUENCER_128] = 0x1,
  273. [WM8996_WRITE_SEQUENCER_129] = 0x1,
  274. [WM8996_WRITE_SEQUENCER_131] = 0x6,
  275. [WM8996_WRITE_SEQUENCER_132] = 0x40,
  276. [WM8996_WRITE_SEQUENCER_133] = 0x1,
  277. [WM8996_WRITE_SEQUENCER_134] = 0xf,
  278. [WM8996_WRITE_SEQUENCER_135] = 0x6,
  279. [WM8996_WRITE_SEQUENCER_136] = 0x1,
  280. [WM8996_WRITE_SEQUENCER_137] = 0x3,
  281. [WM8996_WRITE_SEQUENCER_138] = 0x106,
  282. [WM8996_WRITE_SEQUENCER_140] = 0x61,
  283. [WM8996_WRITE_SEQUENCER_141] = 0x11,
  284. [WM8996_WRITE_SEQUENCER_142] = 0x401,
  285. [WM8996_WRITE_SEQUENCER_144] = 0x50,
  286. [WM8996_WRITE_SEQUENCER_145] = 0x3,
  287. [WM8996_WRITE_SEQUENCER_146] = 0x102,
  288. [WM8996_WRITE_SEQUENCER_148] = 0x51,
  289. [WM8996_WRITE_SEQUENCER_149] = 0x3,
  290. [WM8996_WRITE_SEQUENCER_150] = 0x106,
  291. [WM8996_WRITE_SEQUENCER_151] = 0xa,
  292. [WM8996_WRITE_SEQUENCER_152] = 0x61,
  293. [WM8996_WRITE_SEQUENCER_153] = 0x3b,
  294. [WM8996_WRITE_SEQUENCER_154] = 0x502,
  295. [WM8996_WRITE_SEQUENCER_155] = 0x100,
  296. [WM8996_WRITE_SEQUENCER_156] = 0x2fff,
  297. [WM8996_WRITE_SEQUENCER_160] = 0x2fff,
  298. [WM8996_WRITE_SEQUENCER_164] = 0x2fff,
  299. [WM8996_WRITE_SEQUENCER_168] = 0x2fff,
  300. [WM8996_WRITE_SEQUENCER_172] = 0x2fff,
  301. [WM8996_WRITE_SEQUENCER_176] = 0x2fff,
  302. [WM8996_WRITE_SEQUENCER_180] = 0x2fff,
  303. [WM8996_WRITE_SEQUENCER_184] = 0x2fff,
  304. [WM8996_WRITE_SEQUENCER_188] = 0x2fff,
  305. [WM8996_WRITE_SEQUENCER_192] = 0x1,
  306. [WM8996_WRITE_SEQUENCER_193] = 0x1,
  307. [WM8996_WRITE_SEQUENCER_195] = 0x6,
  308. [WM8996_WRITE_SEQUENCER_196] = 0x40,
  309. [WM8996_WRITE_SEQUENCER_197] = 0x1,
  310. [WM8996_WRITE_SEQUENCER_198] = 0xf,
  311. [WM8996_WRITE_SEQUENCER_199] = 0x6,
  312. [WM8996_WRITE_SEQUENCER_200] = 0x1,
  313. [WM8996_WRITE_SEQUENCER_201] = 0x3,
  314. [WM8996_WRITE_SEQUENCER_202] = 0x106,
  315. [WM8996_WRITE_SEQUENCER_204] = 0x61,
  316. [WM8996_WRITE_SEQUENCER_205] = 0x11,
  317. [WM8996_WRITE_SEQUENCER_206] = 0x401,
  318. [WM8996_WRITE_SEQUENCER_208] = 0x50,
  319. [WM8996_WRITE_SEQUENCER_209] = 0x3,
  320. [WM8996_WRITE_SEQUENCER_210] = 0x102,
  321. [WM8996_WRITE_SEQUENCER_212] = 0x61,
  322. [WM8996_WRITE_SEQUENCER_213] = 0x3b,
  323. [WM8996_WRITE_SEQUENCER_214] = 0x502,
  324. [WM8996_WRITE_SEQUENCER_215] = 0x100,
  325. [WM8996_WRITE_SEQUENCER_216] = 0x2fff,
  326. [WM8996_WRITE_SEQUENCER_220] = 0x2fff,
  327. [WM8996_WRITE_SEQUENCER_224] = 0x2fff,
  328. [WM8996_WRITE_SEQUENCER_228] = 0x2fff,
  329. [WM8996_WRITE_SEQUENCER_232] = 0x2fff,
  330. [WM8996_WRITE_SEQUENCER_236] = 0x2fff,
  331. [WM8996_WRITE_SEQUENCER_240] = 0x2fff,
  332. [WM8996_WRITE_SEQUENCER_244] = 0x2fff,
  333. [WM8996_WRITE_SEQUENCER_248] = 0x2fff,
  334. [WM8996_WRITE_SEQUENCER_252] = 0x2fff,
  335. [WM8996_WRITE_SEQUENCER_256] = 0x60,
  336. [WM8996_WRITE_SEQUENCER_258] = 0x601,
  337. [WM8996_WRITE_SEQUENCER_260] = 0x50,
  338. [WM8996_WRITE_SEQUENCER_262] = 0x100,
  339. [WM8996_WRITE_SEQUENCER_264] = 0x1,
  340. [WM8996_WRITE_SEQUENCER_266] = 0x104,
  341. [WM8996_WRITE_SEQUENCER_267] = 0x100,
  342. [WM8996_WRITE_SEQUENCER_268] = 0x2fff,
  343. [WM8996_WRITE_SEQUENCER_272] = 0x2fff,
  344. [WM8996_WRITE_SEQUENCER_276] = 0x2fff,
  345. [WM8996_WRITE_SEQUENCER_280] = 0x2fff,
  346. [WM8996_WRITE_SEQUENCER_284] = 0x2fff,
  347. [WM8996_WRITE_SEQUENCER_288] = 0x2fff,
  348. [WM8996_WRITE_SEQUENCER_292] = 0x2fff,
  349. [WM8996_WRITE_SEQUENCER_296] = 0x2fff,
  350. [WM8996_WRITE_SEQUENCER_300] = 0x2fff,
  351. [WM8996_WRITE_SEQUENCER_304] = 0x2fff,
  352. [WM8996_WRITE_SEQUENCER_308] = 0x2fff,
  353. [WM8996_WRITE_SEQUENCER_312] = 0x2fff,
  354. [WM8996_WRITE_SEQUENCER_316] = 0x2fff,
  355. [WM8996_WRITE_SEQUENCER_320] = 0x61,
  356. [WM8996_WRITE_SEQUENCER_322] = 0x601,
  357. [WM8996_WRITE_SEQUENCER_324] = 0x50,
  358. [WM8996_WRITE_SEQUENCER_326] = 0x102,
  359. [WM8996_WRITE_SEQUENCER_328] = 0x1,
  360. [WM8996_WRITE_SEQUENCER_330] = 0x106,
  361. [WM8996_WRITE_SEQUENCER_331] = 0x100,
  362. [WM8996_WRITE_SEQUENCER_332] = 0x2fff,
  363. [WM8996_WRITE_SEQUENCER_336] = 0x2fff,
  364. [WM8996_WRITE_SEQUENCER_340] = 0x2fff,
  365. [WM8996_WRITE_SEQUENCER_344] = 0x2fff,
  366. [WM8996_WRITE_SEQUENCER_348] = 0x2fff,
  367. [WM8996_WRITE_SEQUENCER_352] = 0x2fff,
  368. [WM8996_WRITE_SEQUENCER_356] = 0x2fff,
  369. [WM8996_WRITE_SEQUENCER_360] = 0x2fff,
  370. [WM8996_WRITE_SEQUENCER_364] = 0x2fff,
  371. [WM8996_WRITE_SEQUENCER_368] = 0x2fff,
  372. [WM8996_WRITE_SEQUENCER_372] = 0x2fff,
  373. [WM8996_WRITE_SEQUENCER_376] = 0x2fff,
  374. [WM8996_WRITE_SEQUENCER_380] = 0x2fff,
  375. [WM8996_WRITE_SEQUENCER_384] = 0x60,
  376. [WM8996_WRITE_SEQUENCER_386] = 0x601,
  377. [WM8996_WRITE_SEQUENCER_388] = 0x61,
  378. [WM8996_WRITE_SEQUENCER_390] = 0x601,
  379. [WM8996_WRITE_SEQUENCER_392] = 0x50,
  380. [WM8996_WRITE_SEQUENCER_394] = 0x300,
  381. [WM8996_WRITE_SEQUENCER_396] = 0x1,
  382. [WM8996_WRITE_SEQUENCER_398] = 0x304,
  383. [WM8996_WRITE_SEQUENCER_400] = 0x40,
  384. [WM8996_WRITE_SEQUENCER_402] = 0xf,
  385. [WM8996_WRITE_SEQUENCER_404] = 0x1,
  386. [WM8996_WRITE_SEQUENCER_407] = 0x100,
  387. };
  388. static const DECLARE_TLV_DB_SCALE(inpga_tlv, 0, 100, 0);
  389. static const DECLARE_TLV_DB_SCALE(sidetone_tlv, -3600, 150, 0);
  390. static const DECLARE_TLV_DB_SCALE(digital_tlv, -7200, 75, 1);
  391. static const DECLARE_TLV_DB_SCALE(out_digital_tlv, -1200, 150, 0);
  392. static const DECLARE_TLV_DB_SCALE(out_tlv, -900, 75, 0);
  393. static const DECLARE_TLV_DB_SCALE(spk_tlv, -900, 150, 0);
  394. static const DECLARE_TLV_DB_SCALE(eq_tlv, -1200, 100, 0);
  395. static const DECLARE_TLV_DB_SCALE(threedstereo_tlv, -1600, 183, 1);
  396. static const char *sidetone_hpf_text[] = {
  397. "2.9kHz", "1.5kHz", "735Hz", "403Hz", "196Hz", "98Hz", "49Hz"
  398. };
  399. static const struct soc_enum sidetone_hpf =
  400. SOC_ENUM_SINGLE(WM8996_SIDETONE, 7, 7, sidetone_hpf_text);
  401. static const char *hpf_mode_text[] = {
  402. "HiFi", "Custom", "Voice"
  403. };
  404. static const struct soc_enum dsp1tx_hpf_mode =
  405. SOC_ENUM_SINGLE(WM8996_DSP1_TX_FILTERS, 3, 3, hpf_mode_text);
  406. static const struct soc_enum dsp2tx_hpf_mode =
  407. SOC_ENUM_SINGLE(WM8996_DSP2_TX_FILTERS, 3, 3, hpf_mode_text);
  408. static const char *hpf_cutoff_text[] = {
  409. "50Hz", "75Hz", "100Hz", "150Hz", "200Hz", "300Hz", "400Hz"
  410. };
  411. static const struct soc_enum dsp1tx_hpf_cutoff =
  412. SOC_ENUM_SINGLE(WM8996_DSP1_TX_FILTERS, 0, 7, hpf_cutoff_text);
  413. static const struct soc_enum dsp2tx_hpf_cutoff =
  414. SOC_ENUM_SINGLE(WM8996_DSP2_TX_FILTERS, 0, 7, hpf_cutoff_text);
  415. static void wm8996_set_retune_mobile(struct snd_soc_codec *codec, int block)
  416. {
  417. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  418. struct wm8996_pdata *pdata = &wm8996->pdata;
  419. int base, best, best_val, save, i, cfg, iface;
  420. if (!wm8996->num_retune_mobile_texts)
  421. return;
  422. switch (block) {
  423. case 0:
  424. base = WM8996_DSP1_RX_EQ_GAINS_1;
  425. if (snd_soc_read(codec, WM8996_POWER_MANAGEMENT_8) &
  426. WM8996_DSP1RX_SRC)
  427. iface = 1;
  428. else
  429. iface = 0;
  430. break;
  431. case 1:
  432. base = WM8996_DSP1_RX_EQ_GAINS_2;
  433. if (snd_soc_read(codec, WM8996_POWER_MANAGEMENT_8) &
  434. WM8996_DSP2RX_SRC)
  435. iface = 1;
  436. else
  437. iface = 0;
  438. break;
  439. default:
  440. return;
  441. }
  442. /* Find the version of the currently selected configuration
  443. * with the nearest sample rate. */
  444. cfg = wm8996->retune_mobile_cfg[block];
  445. best = 0;
  446. best_val = INT_MAX;
  447. for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
  448. if (strcmp(pdata->retune_mobile_cfgs[i].name,
  449. wm8996->retune_mobile_texts[cfg]) == 0 &&
  450. abs(pdata->retune_mobile_cfgs[i].rate
  451. - wm8996->rx_rate[iface]) < best_val) {
  452. best = i;
  453. best_val = abs(pdata->retune_mobile_cfgs[i].rate
  454. - wm8996->rx_rate[iface]);
  455. }
  456. }
  457. dev_dbg(codec->dev, "ReTune Mobile %d %s/%dHz for %dHz sample rate\n",
  458. block,
  459. pdata->retune_mobile_cfgs[best].name,
  460. pdata->retune_mobile_cfgs[best].rate,
  461. wm8996->rx_rate[iface]);
  462. /* The EQ will be disabled while reconfiguring it, remember the
  463. * current configuration.
  464. */
  465. save = snd_soc_read(codec, base);
  466. save &= WM8996_DSP1RX_EQ_ENA;
  467. for (i = 0; i < ARRAY_SIZE(pdata->retune_mobile_cfgs[best].regs); i++)
  468. snd_soc_update_bits(codec, base + i, 0xffff,
  469. pdata->retune_mobile_cfgs[best].regs[i]);
  470. snd_soc_update_bits(codec, base, WM8996_DSP1RX_EQ_ENA, save);
  471. }
  472. /* Icky as hell but saves code duplication */
  473. static int wm8996_get_retune_mobile_block(const char *name)
  474. {
  475. if (strcmp(name, "DSP1 EQ Mode") == 0)
  476. return 0;
  477. if (strcmp(name, "DSP2 EQ Mode") == 0)
  478. return 1;
  479. return -EINVAL;
  480. }
  481. static int wm8996_put_retune_mobile_enum(struct snd_kcontrol *kcontrol,
  482. struct snd_ctl_elem_value *ucontrol)
  483. {
  484. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  485. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  486. struct wm8996_pdata *pdata = &wm8996->pdata;
  487. int block = wm8996_get_retune_mobile_block(kcontrol->id.name);
  488. int value = ucontrol->value.integer.value[0];
  489. if (block < 0)
  490. return block;
  491. if (value >= pdata->num_retune_mobile_cfgs)
  492. return -EINVAL;
  493. wm8996->retune_mobile_cfg[block] = value;
  494. wm8996_set_retune_mobile(codec, block);
  495. return 0;
  496. }
  497. static int wm8996_get_retune_mobile_enum(struct snd_kcontrol *kcontrol,
  498. struct snd_ctl_elem_value *ucontrol)
  499. {
  500. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  501. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  502. int block = wm8996_get_retune_mobile_block(kcontrol->id.name);
  503. ucontrol->value.enumerated.item[0] = wm8996->retune_mobile_cfg[block];
  504. return 0;
  505. }
  506. static const struct snd_kcontrol_new wm8996_snd_controls[] = {
  507. SOC_DOUBLE_R_TLV("Capture Volume", WM8996_LEFT_LINE_INPUT_VOLUME,
  508. WM8996_RIGHT_LINE_INPUT_VOLUME, 0, 31, 0, inpga_tlv),
  509. SOC_DOUBLE_R("Capture ZC Switch", WM8996_LEFT_LINE_INPUT_VOLUME,
  510. WM8996_RIGHT_LINE_INPUT_VOLUME, 5, 1, 0),
  511. SOC_DOUBLE_TLV("DAC1 Sidetone Volume", WM8996_DAC1_MIXER_VOLUMES,
  512. 0, 5, 24, 0, sidetone_tlv),
  513. SOC_DOUBLE_TLV("DAC2 Sidetone Volume", WM8996_DAC2_MIXER_VOLUMES,
  514. 0, 5, 24, 0, sidetone_tlv),
  515. SOC_SINGLE("Sidetone LPF Switch", WM8996_SIDETONE, 12, 1, 0),
  516. SOC_ENUM("Sidetone HPF Cut-off", sidetone_hpf),
  517. SOC_SINGLE("Sidetone HPF Switch", WM8996_SIDETONE, 6, 1, 0),
  518. SOC_DOUBLE_R_TLV("DSP1 Capture Volume", WM8996_DSP1_TX_LEFT_VOLUME,
  519. WM8996_DSP1_TX_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
  520. SOC_DOUBLE_R_TLV("DSP2 Capture Volume", WM8996_DSP2_TX_LEFT_VOLUME,
  521. WM8996_DSP2_TX_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
  522. SOC_SINGLE("DSP1 Capture Notch Filter Switch", WM8996_DSP1_TX_FILTERS,
  523. 13, 1, 0),
  524. SOC_DOUBLE("DSP1 Capture HPF Switch", WM8996_DSP1_TX_FILTERS, 12, 11, 1, 0),
  525. SOC_ENUM("DSP1 Capture HPF Mode", dsp1tx_hpf_mode),
  526. SOC_ENUM("DSP1 Capture HPF Cutoff", dsp1tx_hpf_cutoff),
  527. SOC_SINGLE("DSP2 Capture Notch Filter Switch", WM8996_DSP2_TX_FILTERS,
  528. 13, 1, 0),
  529. SOC_DOUBLE("DSP2 Capture HPF Switch", WM8996_DSP2_TX_FILTERS, 12, 11, 1, 0),
  530. SOC_ENUM("DSP2 Capture HPF Mode", dsp2tx_hpf_mode),
  531. SOC_ENUM("DSP2 Capture HPF Cutoff", dsp2tx_hpf_cutoff),
  532. SOC_DOUBLE_R_TLV("DSP1 Playback Volume", WM8996_DSP1_RX_LEFT_VOLUME,
  533. WM8996_DSP1_RX_RIGHT_VOLUME, 1, 112, 0, digital_tlv),
  534. SOC_SINGLE("DSP1 Playback Switch", WM8996_DSP1_RX_FILTERS_1, 9, 1, 1),
  535. SOC_DOUBLE_R_TLV("DSP2 Playback Volume", WM8996_DSP2_RX_LEFT_VOLUME,
  536. WM8996_DSP2_RX_RIGHT_VOLUME, 1, 112, 0, digital_tlv),
  537. SOC_SINGLE("DSP2 Playback Switch", WM8996_DSP2_RX_FILTERS_1, 9, 1, 1),
  538. SOC_DOUBLE_R_TLV("DAC1 Volume", WM8996_DAC1_LEFT_VOLUME,
  539. WM8996_DAC1_RIGHT_VOLUME, 1, 112, 0, digital_tlv),
  540. SOC_DOUBLE_R("DAC1 Switch", WM8996_DAC1_LEFT_VOLUME,
  541. WM8996_DAC1_RIGHT_VOLUME, 9, 1, 1),
  542. SOC_DOUBLE_R_TLV("DAC2 Volume", WM8996_DAC2_LEFT_VOLUME,
  543. WM8996_DAC2_RIGHT_VOLUME, 1, 112, 0, digital_tlv),
  544. SOC_DOUBLE_R("DAC2 Switch", WM8996_DAC2_LEFT_VOLUME,
  545. WM8996_DAC2_RIGHT_VOLUME, 9, 1, 1),
  546. SOC_SINGLE("Speaker High Performance Switch", WM8996_OVERSAMPLING, 3, 1, 0),
  547. SOC_SINGLE("DMIC High Performance Switch", WM8996_OVERSAMPLING, 2, 1, 0),
  548. SOC_SINGLE("ADC High Performance Switch", WM8996_OVERSAMPLING, 1, 1, 0),
  549. SOC_SINGLE("DAC High Performance Switch", WM8996_OVERSAMPLING, 0, 1, 0),
  550. SOC_SINGLE("DAC Soft Mute Switch", WM8996_DAC_SOFTMUTE, 1, 1, 0),
  551. SOC_SINGLE("DAC Slow Soft Mute Switch", WM8996_DAC_SOFTMUTE, 0, 1, 0),
  552. SOC_SINGLE("DSP1 3D Stereo Switch", WM8996_DSP1_RX_FILTERS_2, 8, 1, 0),
  553. SOC_SINGLE("DSP2 3D Stereo Switch", WM8996_DSP2_RX_FILTERS_2, 8, 1, 0),
  554. SOC_SINGLE_TLV("DSP1 3D Stereo Volume", WM8996_DSP1_RX_FILTERS_2, 10, 15,
  555. 0, threedstereo_tlv),
  556. SOC_SINGLE_TLV("DSP2 3D Stereo Volume", WM8996_DSP2_RX_FILTERS_2, 10, 15,
  557. 0, threedstereo_tlv),
  558. SOC_DOUBLE_TLV("Digital Output 1 Volume", WM8996_DAC1_HPOUT1_VOLUME, 0, 4,
  559. 8, 0, out_digital_tlv),
  560. SOC_DOUBLE_TLV("Digital Output 2 Volume", WM8996_DAC2_HPOUT2_VOLUME, 0, 4,
  561. 8, 0, out_digital_tlv),
  562. SOC_DOUBLE_R_TLV("Output 1 Volume", WM8996_OUTPUT1_LEFT_VOLUME,
  563. WM8996_OUTPUT1_RIGHT_VOLUME, 0, 12, 0, out_tlv),
  564. SOC_DOUBLE_R("Output 1 ZC Switch", WM8996_OUTPUT1_LEFT_VOLUME,
  565. WM8996_OUTPUT1_RIGHT_VOLUME, 7, 1, 0),
  566. SOC_DOUBLE_R_TLV("Output 2 Volume", WM8996_OUTPUT2_LEFT_VOLUME,
  567. WM8996_OUTPUT2_RIGHT_VOLUME, 0, 12, 0, out_tlv),
  568. SOC_DOUBLE_R("Output 2 ZC Switch", WM8996_OUTPUT2_LEFT_VOLUME,
  569. WM8996_OUTPUT2_RIGHT_VOLUME, 7, 1, 0),
  570. SOC_DOUBLE_TLV("Speaker Volume", WM8996_PDM_SPEAKER_VOLUME, 0, 4, 8, 0,
  571. spk_tlv),
  572. SOC_DOUBLE_R("Speaker Switch", WM8996_LEFT_PDM_SPEAKER,
  573. WM8996_RIGHT_PDM_SPEAKER, 3, 1, 1),
  574. SOC_DOUBLE_R("Speaker ZC Switch", WM8996_LEFT_PDM_SPEAKER,
  575. WM8996_RIGHT_PDM_SPEAKER, 2, 1, 0),
  576. SOC_SINGLE("DSP1 EQ Switch", WM8996_DSP1_RX_EQ_GAINS_1, 0, 1, 0),
  577. SOC_SINGLE("DSP2 EQ Switch", WM8996_DSP2_RX_EQ_GAINS_1, 0, 1, 0),
  578. };
  579. static const struct snd_kcontrol_new wm8996_eq_controls[] = {
  580. SOC_SINGLE_TLV("DSP1 EQ B1 Volume", WM8996_DSP1_RX_EQ_GAINS_1, 11, 31, 0,
  581. eq_tlv),
  582. SOC_SINGLE_TLV("DSP1 EQ B2 Volume", WM8996_DSP1_RX_EQ_GAINS_1, 6, 31, 0,
  583. eq_tlv),
  584. SOC_SINGLE_TLV("DSP1 EQ B3 Volume", WM8996_DSP1_RX_EQ_GAINS_1, 1, 31, 0,
  585. eq_tlv),
  586. SOC_SINGLE_TLV("DSP1 EQ B4 Volume", WM8996_DSP1_RX_EQ_GAINS_2, 11, 31, 0,
  587. eq_tlv),
  588. SOC_SINGLE_TLV("DSP1 EQ B5 Volume", WM8996_DSP1_RX_EQ_GAINS_2, 6, 31, 0,
  589. eq_tlv),
  590. SOC_SINGLE_TLV("DSP2 EQ B1 Volume", WM8996_DSP2_RX_EQ_GAINS_1, 11, 31, 0,
  591. eq_tlv),
  592. SOC_SINGLE_TLV("DSP2 EQ B2 Volume", WM8996_DSP2_RX_EQ_GAINS_1, 6, 31, 0,
  593. eq_tlv),
  594. SOC_SINGLE_TLV("DSP2 EQ B3 Volume", WM8996_DSP2_RX_EQ_GAINS_1, 1, 31, 0,
  595. eq_tlv),
  596. SOC_SINGLE_TLV("DSP2 EQ B4 Volume", WM8996_DSP2_RX_EQ_GAINS_2, 11, 31, 0,
  597. eq_tlv),
  598. SOC_SINGLE_TLV("DSP2 EQ B5 Volume", WM8996_DSP2_RX_EQ_GAINS_2, 6, 31, 0,
  599. eq_tlv),
  600. };
  601. static int cp_event(struct snd_soc_dapm_widget *w,
  602. struct snd_kcontrol *kcontrol, int event)
  603. {
  604. switch (event) {
  605. case SND_SOC_DAPM_POST_PMU:
  606. msleep(5);
  607. break;
  608. default:
  609. BUG();
  610. return -EINVAL;
  611. }
  612. return 0;
  613. }
  614. static int rmv_short_event(struct snd_soc_dapm_widget *w,
  615. struct snd_kcontrol *kcontrol, int event)
  616. {
  617. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(w->codec);
  618. /* Record which outputs we enabled */
  619. switch (event) {
  620. case SND_SOC_DAPM_PRE_PMD:
  621. wm8996->hpout_pending &= ~w->shift;
  622. break;
  623. case SND_SOC_DAPM_PRE_PMU:
  624. wm8996->hpout_pending |= w->shift;
  625. break;
  626. default:
  627. BUG();
  628. return -EINVAL;
  629. }
  630. return 0;
  631. }
  632. static void wait_for_dc_servo(struct snd_soc_codec *codec, u16 mask)
  633. {
  634. struct i2c_client *i2c = to_i2c_client(codec->dev);
  635. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  636. int i, ret;
  637. unsigned long timeout = 200;
  638. snd_soc_write(codec, WM8996_DC_SERVO_2, mask);
  639. /* Use the interrupt if possible */
  640. do {
  641. if (i2c->irq) {
  642. timeout = wait_for_completion_timeout(&wm8996->dcs_done,
  643. msecs_to_jiffies(200));
  644. if (timeout == 0)
  645. dev_err(codec->dev, "DC servo timed out\n");
  646. } else {
  647. msleep(1);
  648. if (--i) {
  649. timeout = 0;
  650. break;
  651. }
  652. }
  653. ret = snd_soc_read(codec, WM8996_DC_SERVO_2);
  654. dev_dbg(codec->dev, "DC servo state: %x\n", ret);
  655. } while (ret & mask);
  656. if (timeout == 0)
  657. dev_err(codec->dev, "DC servo timed out for %x\n", mask);
  658. else
  659. dev_dbg(codec->dev, "DC servo complete for %x\n", mask);
  660. }
  661. static void wm8996_seq_notifier(struct snd_soc_dapm_context *dapm,
  662. enum snd_soc_dapm_type event, int subseq)
  663. {
  664. struct snd_soc_codec *codec = container_of(dapm,
  665. struct snd_soc_codec, dapm);
  666. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  667. u16 val, mask;
  668. /* Complete any pending DC servo starts */
  669. if (wm8996->dcs_pending) {
  670. dev_dbg(codec->dev, "Starting DC servo for %x\n",
  671. wm8996->dcs_pending);
  672. /* Trigger a startup sequence */
  673. wait_for_dc_servo(codec, wm8996->dcs_pending
  674. << WM8996_DCS_TRIG_STARTUP_0_SHIFT);
  675. wm8996->dcs_pending = 0;
  676. }
  677. if (wm8996->hpout_pending != wm8996->hpout_ena) {
  678. dev_dbg(codec->dev, "Applying RMV_SHORTs %x->%x\n",
  679. wm8996->hpout_ena, wm8996->hpout_pending);
  680. val = 0;
  681. mask = 0;
  682. if (wm8996->hpout_pending & HPOUT1L) {
  683. val |= WM8996_HPOUT1L_RMV_SHORT;
  684. mask |= WM8996_HPOUT1L_RMV_SHORT;
  685. } else {
  686. mask |= WM8996_HPOUT1L_RMV_SHORT |
  687. WM8996_HPOUT1L_OUTP |
  688. WM8996_HPOUT1L_DLY;
  689. }
  690. if (wm8996->hpout_pending & HPOUT1R) {
  691. val |= WM8996_HPOUT1R_RMV_SHORT;
  692. mask |= WM8996_HPOUT1R_RMV_SHORT;
  693. } else {
  694. mask |= WM8996_HPOUT1R_RMV_SHORT |
  695. WM8996_HPOUT1R_OUTP |
  696. WM8996_HPOUT1R_DLY;
  697. }
  698. snd_soc_update_bits(codec, WM8996_ANALOGUE_HP_1, mask, val);
  699. val = 0;
  700. mask = 0;
  701. if (wm8996->hpout_pending & HPOUT2L) {
  702. val |= WM8996_HPOUT2L_RMV_SHORT;
  703. mask |= WM8996_HPOUT2L_RMV_SHORT;
  704. } else {
  705. mask |= WM8996_HPOUT2L_RMV_SHORT |
  706. WM8996_HPOUT2L_OUTP |
  707. WM8996_HPOUT2L_DLY;
  708. }
  709. if (wm8996->hpout_pending & HPOUT2R) {
  710. val |= WM8996_HPOUT2R_RMV_SHORT;
  711. mask |= WM8996_HPOUT2R_RMV_SHORT;
  712. } else {
  713. mask |= WM8996_HPOUT2R_RMV_SHORT |
  714. WM8996_HPOUT2R_OUTP |
  715. WM8996_HPOUT2R_DLY;
  716. }
  717. snd_soc_update_bits(codec, WM8996_ANALOGUE_HP_2, mask, val);
  718. wm8996->hpout_ena = wm8996->hpout_pending;
  719. }
  720. }
  721. static int dcs_start(struct snd_soc_dapm_widget *w,
  722. struct snd_kcontrol *kcontrol, int event)
  723. {
  724. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(w->codec);
  725. switch (event) {
  726. case SND_SOC_DAPM_POST_PMU:
  727. wm8996->dcs_pending |= 1 << w->shift;
  728. break;
  729. default:
  730. BUG();
  731. return -EINVAL;
  732. }
  733. return 0;
  734. }
  735. static const char *sidetone_text[] = {
  736. "IN1", "IN2",
  737. };
  738. static const struct soc_enum left_sidetone_enum =
  739. SOC_ENUM_SINGLE(WM8996_SIDETONE, 0, 2, sidetone_text);
  740. static const struct snd_kcontrol_new left_sidetone =
  741. SOC_DAPM_ENUM("Left Sidetone", left_sidetone_enum);
  742. static const struct soc_enum right_sidetone_enum =
  743. SOC_ENUM_SINGLE(WM8996_SIDETONE, 1, 2, sidetone_text);
  744. static const struct snd_kcontrol_new right_sidetone =
  745. SOC_DAPM_ENUM("Right Sidetone", right_sidetone_enum);
  746. static const char *spk_text[] = {
  747. "DAC1L", "DAC1R", "DAC2L", "DAC2R"
  748. };
  749. static const struct soc_enum spkl_enum =
  750. SOC_ENUM_SINGLE(WM8996_LEFT_PDM_SPEAKER, 0, 4, spk_text);
  751. static const struct snd_kcontrol_new spkl_mux =
  752. SOC_DAPM_ENUM("SPKL", spkl_enum);
  753. static const struct soc_enum spkr_enum =
  754. SOC_ENUM_SINGLE(WM8996_RIGHT_PDM_SPEAKER, 0, 4, spk_text);
  755. static const struct snd_kcontrol_new spkr_mux =
  756. SOC_DAPM_ENUM("SPKR", spkr_enum);
  757. static const char *dsp1rx_text[] = {
  758. "AIF1", "AIF2"
  759. };
  760. static const struct soc_enum dsp1rx_enum =
  761. SOC_ENUM_SINGLE(WM8996_POWER_MANAGEMENT_8, 0, 2, dsp1rx_text);
  762. static const struct snd_kcontrol_new dsp1rx =
  763. SOC_DAPM_ENUM("DSP1RX", dsp1rx_enum);
  764. static const char *dsp2rx_text[] = {
  765. "AIF2", "AIF1"
  766. };
  767. static const struct soc_enum dsp2rx_enum =
  768. SOC_ENUM_SINGLE(WM8996_POWER_MANAGEMENT_8, 4, 2, dsp2rx_text);
  769. static const struct snd_kcontrol_new dsp2rx =
  770. SOC_DAPM_ENUM("DSP2RX", dsp2rx_enum);
  771. static const char *aif2tx_text[] = {
  772. "DSP2", "DSP1", "AIF1"
  773. };
  774. static const struct soc_enum aif2tx_enum =
  775. SOC_ENUM_SINGLE(WM8996_POWER_MANAGEMENT_8, 6, 3, aif2tx_text);
  776. static const struct snd_kcontrol_new aif2tx =
  777. SOC_DAPM_ENUM("AIF2TX", aif2tx_enum);
  778. static const char *inmux_text[] = {
  779. "ADC", "DMIC1", "DMIC2"
  780. };
  781. static const struct soc_enum in1_enum =
  782. SOC_ENUM_SINGLE(WM8996_POWER_MANAGEMENT_7, 0, 3, inmux_text);
  783. static const struct snd_kcontrol_new in1_mux =
  784. SOC_DAPM_ENUM("IN1 Mux", in1_enum);
  785. static const struct soc_enum in2_enum =
  786. SOC_ENUM_SINGLE(WM8996_POWER_MANAGEMENT_7, 4, 3, inmux_text);
  787. static const struct snd_kcontrol_new in2_mux =
  788. SOC_DAPM_ENUM("IN2 Mux", in2_enum);
  789. static const struct snd_kcontrol_new dac2r_mix[] = {
  790. SOC_DAPM_SINGLE("Right Sidetone Switch", WM8996_DAC2_RIGHT_MIXER_ROUTING,
  791. 5, 1, 0),
  792. SOC_DAPM_SINGLE("Left Sidetone Switch", WM8996_DAC2_RIGHT_MIXER_ROUTING,
  793. 4, 1, 0),
  794. SOC_DAPM_SINGLE("DSP2 Switch", WM8996_DAC2_RIGHT_MIXER_ROUTING, 1, 1, 0),
  795. SOC_DAPM_SINGLE("DSP1 Switch", WM8996_DAC2_RIGHT_MIXER_ROUTING, 0, 1, 0),
  796. };
  797. static const struct snd_kcontrol_new dac2l_mix[] = {
  798. SOC_DAPM_SINGLE("Right Sidetone Switch", WM8996_DAC2_LEFT_MIXER_ROUTING,
  799. 5, 1, 0),
  800. SOC_DAPM_SINGLE("Left Sidetone Switch", WM8996_DAC2_LEFT_MIXER_ROUTING,
  801. 4, 1, 0),
  802. SOC_DAPM_SINGLE("DSP2 Switch", WM8996_DAC2_LEFT_MIXER_ROUTING, 1, 1, 0),
  803. SOC_DAPM_SINGLE("DSP1 Switch", WM8996_DAC2_LEFT_MIXER_ROUTING, 0, 1, 0),
  804. };
  805. static const struct snd_kcontrol_new dac1r_mix[] = {
  806. SOC_DAPM_SINGLE("Right Sidetone Switch", WM8996_DAC1_RIGHT_MIXER_ROUTING,
  807. 5, 1, 0),
  808. SOC_DAPM_SINGLE("Left Sidetone Switch", WM8996_DAC1_RIGHT_MIXER_ROUTING,
  809. 4, 1, 0),
  810. SOC_DAPM_SINGLE("DSP2 Switch", WM8996_DAC1_RIGHT_MIXER_ROUTING, 1, 1, 0),
  811. SOC_DAPM_SINGLE("DSP1 Switch", WM8996_DAC1_RIGHT_MIXER_ROUTING, 0, 1, 0),
  812. };
  813. static const struct snd_kcontrol_new dac1l_mix[] = {
  814. SOC_DAPM_SINGLE("Right Sidetone Switch", WM8996_DAC1_LEFT_MIXER_ROUTING,
  815. 5, 1, 0),
  816. SOC_DAPM_SINGLE("Left Sidetone Switch", WM8996_DAC1_LEFT_MIXER_ROUTING,
  817. 4, 1, 0),
  818. SOC_DAPM_SINGLE("DSP2 Switch", WM8996_DAC1_LEFT_MIXER_ROUTING, 1, 1, 0),
  819. SOC_DAPM_SINGLE("DSP1 Switch", WM8996_DAC1_LEFT_MIXER_ROUTING, 0, 1, 0),
  820. };
  821. static const struct snd_kcontrol_new dsp1txl[] = {
  822. SOC_DAPM_SINGLE("IN1 Switch", WM8996_DSP1_TX_LEFT_MIXER_ROUTING,
  823. 1, 1, 0),
  824. SOC_DAPM_SINGLE("DAC Switch", WM8996_DSP1_TX_LEFT_MIXER_ROUTING,
  825. 0, 1, 0),
  826. };
  827. static const struct snd_kcontrol_new dsp1txr[] = {
  828. SOC_DAPM_SINGLE("IN1 Switch", WM8996_DSP1_TX_RIGHT_MIXER_ROUTING,
  829. 1, 1, 0),
  830. SOC_DAPM_SINGLE("DAC Switch", WM8996_DSP1_TX_RIGHT_MIXER_ROUTING,
  831. 0, 1, 0),
  832. };
  833. static const struct snd_kcontrol_new dsp2txl[] = {
  834. SOC_DAPM_SINGLE("IN1 Switch", WM8996_DSP2_TX_LEFT_MIXER_ROUTING,
  835. 1, 1, 0),
  836. SOC_DAPM_SINGLE("DAC Switch", WM8996_DSP2_TX_LEFT_MIXER_ROUTING,
  837. 0, 1, 0),
  838. };
  839. static const struct snd_kcontrol_new dsp2txr[] = {
  840. SOC_DAPM_SINGLE("IN1 Switch", WM8996_DSP2_TX_RIGHT_MIXER_ROUTING,
  841. 1, 1, 0),
  842. SOC_DAPM_SINGLE("DAC Switch", WM8996_DSP2_TX_RIGHT_MIXER_ROUTING,
  843. 0, 1, 0),
  844. };
  845. static const struct snd_soc_dapm_widget wm8996_dapm_widgets[] = {
  846. SND_SOC_DAPM_INPUT("IN1LN"),
  847. SND_SOC_DAPM_INPUT("IN1LP"),
  848. SND_SOC_DAPM_INPUT("IN1RN"),
  849. SND_SOC_DAPM_INPUT("IN1RP"),
  850. SND_SOC_DAPM_INPUT("IN2LN"),
  851. SND_SOC_DAPM_INPUT("IN2LP"),
  852. SND_SOC_DAPM_INPUT("IN2RN"),
  853. SND_SOC_DAPM_INPUT("IN2RP"),
  854. SND_SOC_DAPM_INPUT("DMIC1DAT"),
  855. SND_SOC_DAPM_INPUT("DMIC2DAT"),
  856. SND_SOC_DAPM_SUPPLY_S("SYSCLK", 1, WM8996_AIF_CLOCKING_1, 0, 0, NULL, 0),
  857. SND_SOC_DAPM_SUPPLY_S("SYSDSPCLK", 2, WM8996_CLOCKING_1, 1, 0, NULL, 0),
  858. SND_SOC_DAPM_SUPPLY_S("AIFCLK", 2, WM8996_CLOCKING_1, 2, 0, NULL, 0),
  859. SND_SOC_DAPM_SUPPLY_S("Charge Pump", 2, WM8996_CHARGE_PUMP_1, 15, 0, cp_event,
  860. SND_SOC_DAPM_POST_PMU),
  861. SND_SOC_DAPM_SUPPLY("LDO2", WM8996_POWER_MANAGEMENT_2, 1, 0, NULL, 0),
  862. SND_SOC_DAPM_SUPPLY("MICB1 Audio", WM8996_MICBIAS_1, 4, 1, NULL, 0),
  863. SND_SOC_DAPM_SUPPLY("MICB2 Audio", WM8996_MICBIAS_2, 4, 1, NULL, 0),
  864. SND_SOC_DAPM_MICBIAS("MICB2", WM8996_POWER_MANAGEMENT_1, 9, 0),
  865. SND_SOC_DAPM_MICBIAS("MICB1", WM8996_POWER_MANAGEMENT_1, 8, 0),
  866. SND_SOC_DAPM_PGA("IN1L PGA", WM8996_POWER_MANAGEMENT_2, 5, 0, NULL, 0),
  867. SND_SOC_DAPM_PGA("IN1R PGA", WM8996_POWER_MANAGEMENT_2, 4, 0, NULL, 0),
  868. SND_SOC_DAPM_MUX("IN1L Mux", WM8996_POWER_MANAGEMENT_7, 2, 0, &in1_mux),
  869. SND_SOC_DAPM_MUX("IN1R Mux", WM8996_POWER_MANAGEMENT_7, 3, 0, &in1_mux),
  870. SND_SOC_DAPM_MUX("IN2L Mux", WM8996_POWER_MANAGEMENT_7, 6, 0, &in2_mux),
  871. SND_SOC_DAPM_MUX("IN2R Mux", WM8996_POWER_MANAGEMENT_7, 7, 0, &in2_mux),
  872. SND_SOC_DAPM_SUPPLY("DMIC2", WM8996_POWER_MANAGEMENT_7, 9, 0, NULL, 0),
  873. SND_SOC_DAPM_SUPPLY("DMIC1", WM8996_POWER_MANAGEMENT_7, 8, 0, NULL, 0),
  874. SND_SOC_DAPM_ADC("DMIC2L", NULL, WM8996_POWER_MANAGEMENT_3, 5, 0),
  875. SND_SOC_DAPM_ADC("DMIC2R", NULL, WM8996_POWER_MANAGEMENT_3, 4, 0),
  876. SND_SOC_DAPM_ADC("DMIC1L", NULL, WM8996_POWER_MANAGEMENT_3, 3, 0),
  877. SND_SOC_DAPM_ADC("DMIC1R", NULL, WM8996_POWER_MANAGEMENT_3, 2, 0),
  878. SND_SOC_DAPM_ADC("ADCL", NULL, WM8996_POWER_MANAGEMENT_3, 1, 0),
  879. SND_SOC_DAPM_ADC("ADCR", NULL, WM8996_POWER_MANAGEMENT_3, 0, 0),
  880. SND_SOC_DAPM_MUX("Left Sidetone", SND_SOC_NOPM, 0, 0, &left_sidetone),
  881. SND_SOC_DAPM_MUX("Right Sidetone", SND_SOC_NOPM, 0, 0, &right_sidetone),
  882. SND_SOC_DAPM_AIF_IN("DSP2RXL", NULL, 0, WM8996_POWER_MANAGEMENT_3, 11, 0),
  883. SND_SOC_DAPM_AIF_IN("DSP2RXR", NULL, 1, WM8996_POWER_MANAGEMENT_3, 10, 0),
  884. SND_SOC_DAPM_AIF_IN("DSP1RXL", NULL, 0, WM8996_POWER_MANAGEMENT_3, 9, 0),
  885. SND_SOC_DAPM_AIF_IN("DSP1RXR", NULL, 1, WM8996_POWER_MANAGEMENT_3, 8, 0),
  886. SND_SOC_DAPM_MIXER("DSP2TXL", WM8996_POWER_MANAGEMENT_5, 11, 0,
  887. dsp2txl, ARRAY_SIZE(dsp2txl)),
  888. SND_SOC_DAPM_MIXER("DSP2TXR", WM8996_POWER_MANAGEMENT_5, 10, 0,
  889. dsp2txr, ARRAY_SIZE(dsp2txr)),
  890. SND_SOC_DAPM_MIXER("DSP1TXL", WM8996_POWER_MANAGEMENT_5, 9, 0,
  891. dsp1txl, ARRAY_SIZE(dsp1txl)),
  892. SND_SOC_DAPM_MIXER("DSP1TXR", WM8996_POWER_MANAGEMENT_5, 8, 0,
  893. dsp1txr, ARRAY_SIZE(dsp1txr)),
  894. SND_SOC_DAPM_MIXER("DAC2L Mixer", SND_SOC_NOPM, 0, 0,
  895. dac2l_mix, ARRAY_SIZE(dac2l_mix)),
  896. SND_SOC_DAPM_MIXER("DAC2R Mixer", SND_SOC_NOPM, 0, 0,
  897. dac2r_mix, ARRAY_SIZE(dac2r_mix)),
  898. SND_SOC_DAPM_MIXER("DAC1L Mixer", SND_SOC_NOPM, 0, 0,
  899. dac1l_mix, ARRAY_SIZE(dac1l_mix)),
  900. SND_SOC_DAPM_MIXER("DAC1R Mixer", SND_SOC_NOPM, 0, 0,
  901. dac1r_mix, ARRAY_SIZE(dac1r_mix)),
  902. SND_SOC_DAPM_DAC("DAC2L", NULL, WM8996_POWER_MANAGEMENT_5, 3, 0),
  903. SND_SOC_DAPM_DAC("DAC2R", NULL, WM8996_POWER_MANAGEMENT_5, 2, 0),
  904. SND_SOC_DAPM_DAC("DAC1L", NULL, WM8996_POWER_MANAGEMENT_5, 1, 0),
  905. SND_SOC_DAPM_DAC("DAC1R", NULL, WM8996_POWER_MANAGEMENT_5, 0, 0),
  906. SND_SOC_DAPM_AIF_IN("AIF2RX1", "AIF2 Playback", 1,
  907. WM8996_POWER_MANAGEMENT_4, 9, 0),
  908. SND_SOC_DAPM_AIF_IN("AIF2RX0", "AIF2 Playback", 2,
  909. WM8996_POWER_MANAGEMENT_4, 8, 0),
  910. SND_SOC_DAPM_AIF_IN("AIF2TX1", "AIF2 Capture", 1,
  911. WM8996_POWER_MANAGEMENT_6, 9, 0),
  912. SND_SOC_DAPM_AIF_IN("AIF2TX0", "AIF2 Capture", 2,
  913. WM8996_POWER_MANAGEMENT_6, 8, 0),
  914. SND_SOC_DAPM_AIF_IN("AIF1RX5", "AIF1 Playback", 5,
  915. WM8996_POWER_MANAGEMENT_4, 5, 0),
  916. SND_SOC_DAPM_AIF_IN("AIF1RX4", "AIF1 Playback", 4,
  917. WM8996_POWER_MANAGEMENT_4, 4, 0),
  918. SND_SOC_DAPM_AIF_IN("AIF1RX3", "AIF1 Playback", 3,
  919. WM8996_POWER_MANAGEMENT_4, 3, 0),
  920. SND_SOC_DAPM_AIF_IN("AIF1RX2", "AIF1 Playback", 2,
  921. WM8996_POWER_MANAGEMENT_4, 2, 0),
  922. SND_SOC_DAPM_AIF_IN("AIF1RX1", "AIF1 Playback", 1,
  923. WM8996_POWER_MANAGEMENT_4, 1, 0),
  924. SND_SOC_DAPM_AIF_IN("AIF1RX0", "AIF1 Playback", 0,
  925. WM8996_POWER_MANAGEMENT_4, 0, 0),
  926. SND_SOC_DAPM_AIF_OUT("AIF1TX5", "AIF1 Capture", 5,
  927. WM8996_POWER_MANAGEMENT_6, 5, 0),
  928. SND_SOC_DAPM_AIF_OUT("AIF1TX4", "AIF1 Capture", 4,
  929. WM8996_POWER_MANAGEMENT_6, 4, 0),
  930. SND_SOC_DAPM_AIF_OUT("AIF1TX3", "AIF1 Capture", 3,
  931. WM8996_POWER_MANAGEMENT_6, 3, 0),
  932. SND_SOC_DAPM_AIF_OUT("AIF1TX2", "AIF1 Capture", 2,
  933. WM8996_POWER_MANAGEMENT_6, 2, 0),
  934. SND_SOC_DAPM_AIF_OUT("AIF1TX1", "AIF1 Capture", 1,
  935. WM8996_POWER_MANAGEMENT_6, 1, 0),
  936. SND_SOC_DAPM_AIF_OUT("AIF1TX0", "AIF1 Capture", 0,
  937. WM8996_POWER_MANAGEMENT_6, 0, 0),
  938. /* We route as stereo pairs so define some dummy widgets to squash
  939. * things down for now. RXA = 0,1, RXB = 2,3 and so on */
  940. SND_SOC_DAPM_PGA("AIF1RXA", SND_SOC_NOPM, 0, 0, NULL, 0),
  941. SND_SOC_DAPM_PGA("AIF1RXB", SND_SOC_NOPM, 0, 0, NULL, 0),
  942. SND_SOC_DAPM_PGA("AIF1RXC", SND_SOC_NOPM, 0, 0, NULL, 0),
  943. SND_SOC_DAPM_PGA("AIF2RX", SND_SOC_NOPM, 0, 0, NULL, 0),
  944. SND_SOC_DAPM_PGA("DSP2TX", SND_SOC_NOPM, 0, 0, NULL, 0),
  945. SND_SOC_DAPM_MUX("DSP1RX", SND_SOC_NOPM, 0, 0, &dsp1rx),
  946. SND_SOC_DAPM_MUX("DSP2RX", SND_SOC_NOPM, 0, 0, &dsp2rx),
  947. SND_SOC_DAPM_MUX("AIF2TX", SND_SOC_NOPM, 0, 0, &aif2tx),
  948. SND_SOC_DAPM_MUX("SPKL", SND_SOC_NOPM, 0, 0, &spkl_mux),
  949. SND_SOC_DAPM_MUX("SPKR", SND_SOC_NOPM, 0, 0, &spkr_mux),
  950. SND_SOC_DAPM_PGA("SPKL PGA", WM8996_LEFT_PDM_SPEAKER, 4, 0, NULL, 0),
  951. SND_SOC_DAPM_PGA("SPKR PGA", WM8996_RIGHT_PDM_SPEAKER, 4, 0, NULL, 0),
  952. SND_SOC_DAPM_PGA_S("HPOUT2L PGA", 0, WM8996_POWER_MANAGEMENT_1, 7, 0, NULL, 0),
  953. SND_SOC_DAPM_PGA_S("HPOUT2L_DLY", 1, WM8996_ANALOGUE_HP_2, 5, 0, NULL, 0),
  954. SND_SOC_DAPM_PGA_S("HPOUT2L_DCS", 2, WM8996_DC_SERVO_1, 2, 0, dcs_start,
  955. SND_SOC_DAPM_POST_PMU),
  956. SND_SOC_DAPM_PGA_S("HPOUT2L_OUTP", 3, WM8996_ANALOGUE_HP_2, 6, 0, NULL, 0),
  957. SND_SOC_DAPM_PGA_S("HPOUT2L_RMV_SHORT", 3, SND_SOC_NOPM, HPOUT2L, 0,
  958. rmv_short_event,
  959. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  960. SND_SOC_DAPM_PGA_S("HPOUT2R PGA", 0, WM8996_POWER_MANAGEMENT_1, 6, 0,NULL, 0),
  961. SND_SOC_DAPM_PGA_S("HPOUT2R_DLY", 1, WM8996_ANALOGUE_HP_2, 1, 0, NULL, 0),
  962. SND_SOC_DAPM_PGA_S("HPOUT2R_DCS", 2, WM8996_DC_SERVO_1, 3, 0, dcs_start,
  963. SND_SOC_DAPM_POST_PMU),
  964. SND_SOC_DAPM_PGA_S("HPOUT2R_OUTP", 3, WM8996_ANALOGUE_HP_2, 2, 0, NULL, 0),
  965. SND_SOC_DAPM_PGA_S("HPOUT2R_RMV_SHORT", 3, SND_SOC_NOPM, HPOUT2R, 0,
  966. rmv_short_event,
  967. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  968. SND_SOC_DAPM_PGA_S("HPOUT1L PGA", 0, WM8996_POWER_MANAGEMENT_1, 5, 0, NULL, 0),
  969. SND_SOC_DAPM_PGA_S("HPOUT1L_DLY", 1, WM8996_ANALOGUE_HP_1, 5, 0, NULL, 0),
  970. SND_SOC_DAPM_PGA_S("HPOUT1L_DCS", 2, WM8996_DC_SERVO_1, 0, 0, dcs_start,
  971. SND_SOC_DAPM_POST_PMU),
  972. SND_SOC_DAPM_PGA_S("HPOUT1L_OUTP", 3, WM8996_ANALOGUE_HP_1, 6, 0, NULL, 0),
  973. SND_SOC_DAPM_PGA_S("HPOUT1L_RMV_SHORT", 3, SND_SOC_NOPM, HPOUT1L, 0,
  974. rmv_short_event,
  975. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  976. SND_SOC_DAPM_PGA_S("HPOUT1R PGA", 0, WM8996_POWER_MANAGEMENT_1, 4, 0, NULL, 0),
  977. SND_SOC_DAPM_PGA_S("HPOUT1R_DLY", 1, WM8996_ANALOGUE_HP_1, 1, 0, NULL, 0),
  978. SND_SOC_DAPM_PGA_S("HPOUT1R_DCS", 2, WM8996_DC_SERVO_1, 1, 0, dcs_start,
  979. SND_SOC_DAPM_POST_PMU),
  980. SND_SOC_DAPM_PGA_S("HPOUT1R_OUTP", 3, WM8996_ANALOGUE_HP_1, 2, 0, NULL, 0),
  981. SND_SOC_DAPM_PGA_S("HPOUT1R_RMV_SHORT", 3, SND_SOC_NOPM, HPOUT1R, 0,
  982. rmv_short_event,
  983. SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
  984. SND_SOC_DAPM_OUTPUT("HPOUT1L"),
  985. SND_SOC_DAPM_OUTPUT("HPOUT1R"),
  986. SND_SOC_DAPM_OUTPUT("HPOUT2L"),
  987. SND_SOC_DAPM_OUTPUT("HPOUT2R"),
  988. SND_SOC_DAPM_OUTPUT("SPKDAT"),
  989. };
  990. static const struct snd_soc_dapm_route wm8996_dapm_routes[] = {
  991. { "AIFCLK", NULL, "SYSCLK" },
  992. { "SYSDSPCLK", NULL, "SYSCLK" },
  993. { "Charge Pump", NULL, "SYSCLK" },
  994. { "MICB1", NULL, "LDO2" },
  995. { "MICB1", NULL, "MICB1 Audio" },
  996. { "MICB2", NULL, "LDO2" },
  997. { "MICB2", NULL, "MICB2 Audio" },
  998. { "IN1L PGA", NULL, "IN2LN" },
  999. { "IN1L PGA", NULL, "IN2LP" },
  1000. { "IN1L PGA", NULL, "IN1LN" },
  1001. { "IN1L PGA", NULL, "IN1LP" },
  1002. { "IN1R PGA", NULL, "IN2RN" },
  1003. { "IN1R PGA", NULL, "IN2RP" },
  1004. { "IN1R PGA", NULL, "IN1RN" },
  1005. { "IN1R PGA", NULL, "IN1RP" },
  1006. { "ADCL", NULL, "IN1L PGA" },
  1007. { "ADCR", NULL, "IN1R PGA" },
  1008. { "DMIC1L", NULL, "DMIC1DAT" },
  1009. { "DMIC1R", NULL, "DMIC1DAT" },
  1010. { "DMIC2L", NULL, "DMIC2DAT" },
  1011. { "DMIC2R", NULL, "DMIC2DAT" },
  1012. { "DMIC2L", NULL, "DMIC2" },
  1013. { "DMIC2R", NULL, "DMIC2" },
  1014. { "DMIC1L", NULL, "DMIC1" },
  1015. { "DMIC1R", NULL, "DMIC1" },
  1016. { "IN1L Mux", "ADC", "ADCL" },
  1017. { "IN1L Mux", "DMIC1", "DMIC1L" },
  1018. { "IN1L Mux", "DMIC2", "DMIC2L" },
  1019. { "IN1R Mux", "ADC", "ADCR" },
  1020. { "IN1R Mux", "DMIC1", "DMIC1R" },
  1021. { "IN1R Mux", "DMIC2", "DMIC2R" },
  1022. { "IN2L Mux", "ADC", "ADCL" },
  1023. { "IN2L Mux", "DMIC1", "DMIC1L" },
  1024. { "IN2L Mux", "DMIC2", "DMIC2L" },
  1025. { "IN2R Mux", "ADC", "ADCR" },
  1026. { "IN2R Mux", "DMIC1", "DMIC1R" },
  1027. { "IN2R Mux", "DMIC2", "DMIC2R" },
  1028. { "Left Sidetone", "IN1", "IN1L Mux" },
  1029. { "Left Sidetone", "IN2", "IN2L Mux" },
  1030. { "Right Sidetone", "IN1", "IN1R Mux" },
  1031. { "Right Sidetone", "IN2", "IN2R Mux" },
  1032. { "DSP1TXL", "IN1 Switch", "IN1L Mux" },
  1033. { "DSP1TXR", "IN1 Switch", "IN1R Mux" },
  1034. { "DSP2TXL", "IN1 Switch", "IN2L Mux" },
  1035. { "DSP2TXR", "IN1 Switch", "IN2R Mux" },
  1036. { "AIF1TX0", NULL, "DSP1TXL" },
  1037. { "AIF1TX1", NULL, "DSP1TXR" },
  1038. { "AIF1TX2", NULL, "DSP2TXL" },
  1039. { "AIF1TX3", NULL, "DSP2TXR" },
  1040. { "AIF1TX4", NULL, "AIF2RX0" },
  1041. { "AIF1TX5", NULL, "AIF2RX1" },
  1042. { "AIF1RX0", NULL, "AIFCLK" },
  1043. { "AIF1RX1", NULL, "AIFCLK" },
  1044. { "AIF1RX2", NULL, "AIFCLK" },
  1045. { "AIF1RX3", NULL, "AIFCLK" },
  1046. { "AIF1RX4", NULL, "AIFCLK" },
  1047. { "AIF1RX5", NULL, "AIFCLK" },
  1048. { "AIF2RX0", NULL, "AIFCLK" },
  1049. { "AIF2RX1", NULL, "AIFCLK" },
  1050. { "AIF1TX0", NULL, "AIFCLK" },
  1051. { "AIF1TX1", NULL, "AIFCLK" },
  1052. { "AIF1TX2", NULL, "AIFCLK" },
  1053. { "AIF1TX3", NULL, "AIFCLK" },
  1054. { "AIF1TX4", NULL, "AIFCLK" },
  1055. { "AIF1TX5", NULL, "AIFCLK" },
  1056. { "AIF2TX0", NULL, "AIFCLK" },
  1057. { "AIF2TX1", NULL, "AIFCLK" },
  1058. { "DSP1RXL", NULL, "SYSDSPCLK" },
  1059. { "DSP1RXR", NULL, "SYSDSPCLK" },
  1060. { "DSP2RXL", NULL, "SYSDSPCLK" },
  1061. { "DSP2RXR", NULL, "SYSDSPCLK" },
  1062. { "DSP1TXL", NULL, "SYSDSPCLK" },
  1063. { "DSP1TXR", NULL, "SYSDSPCLK" },
  1064. { "DSP2TXL", NULL, "SYSDSPCLK" },
  1065. { "DSP2TXR", NULL, "SYSDSPCLK" },
  1066. { "AIF1RXA", NULL, "AIF1RX0" },
  1067. { "AIF1RXA", NULL, "AIF1RX1" },
  1068. { "AIF1RXB", NULL, "AIF1RX2" },
  1069. { "AIF1RXB", NULL, "AIF1RX3" },
  1070. { "AIF1RXC", NULL, "AIF1RX4" },
  1071. { "AIF1RXC", NULL, "AIF1RX5" },
  1072. { "AIF2RX", NULL, "AIF2RX0" },
  1073. { "AIF2RX", NULL, "AIF2RX1" },
  1074. { "AIF2TX", "DSP2", "DSP2TX" },
  1075. { "AIF2TX", "DSP1", "DSP1RX" },
  1076. { "AIF2TX", "AIF1", "AIF1RXC" },
  1077. { "DSP1RXL", NULL, "DSP1RX" },
  1078. { "DSP1RXR", NULL, "DSP1RX" },
  1079. { "DSP2RXL", NULL, "DSP2RX" },
  1080. { "DSP2RXR", NULL, "DSP2RX" },
  1081. { "DSP2TX", NULL, "DSP2TXL" },
  1082. { "DSP2TX", NULL, "DSP2TXR" },
  1083. { "DSP1RX", "AIF1", "AIF1RXA" },
  1084. { "DSP1RX", "AIF2", "AIF2RX" },
  1085. { "DSP2RX", "AIF1", "AIF1RXB" },
  1086. { "DSP2RX", "AIF2", "AIF2RX" },
  1087. { "DAC2L Mixer", "DSP2 Switch", "DSP2RXL" },
  1088. { "DAC2L Mixer", "DSP1 Switch", "DSP1RXL" },
  1089. { "DAC2L Mixer", "Right Sidetone Switch", "Right Sidetone" },
  1090. { "DAC2L Mixer", "Left Sidetone Switch", "Left Sidetone" },
  1091. { "DAC2R Mixer", "DSP2 Switch", "DSP2RXR" },
  1092. { "DAC2R Mixer", "DSP1 Switch", "DSP1RXR" },
  1093. { "DAC2R Mixer", "Right Sidetone Switch", "Right Sidetone" },
  1094. { "DAC2R Mixer", "Left Sidetone Switch", "Left Sidetone" },
  1095. { "DAC1L Mixer", "DSP2 Switch", "DSP2RXL" },
  1096. { "DAC1L Mixer", "DSP1 Switch", "DSP1RXL" },
  1097. { "DAC1L Mixer", "Right Sidetone Switch", "Right Sidetone" },
  1098. { "DAC1L Mixer", "Left Sidetone Switch", "Left Sidetone" },
  1099. { "DAC1R Mixer", "DSP2 Switch", "DSP2RXR" },
  1100. { "DAC1R Mixer", "DSP1 Switch", "DSP1RXR" },
  1101. { "DAC1R Mixer", "Right Sidetone Switch", "Right Sidetone" },
  1102. { "DAC1R Mixer", "Left Sidetone Switch", "Left Sidetone" },
  1103. { "DAC1L", NULL, "DAC1L Mixer" },
  1104. { "DAC1R", NULL, "DAC1R Mixer" },
  1105. { "DAC2L", NULL, "DAC2L Mixer" },
  1106. { "DAC2R", NULL, "DAC2R Mixer" },
  1107. { "HPOUT2L PGA", NULL, "Charge Pump" },
  1108. { "HPOUT2L PGA", NULL, "DAC2L" },
  1109. { "HPOUT2L_DLY", NULL, "HPOUT2L PGA" },
  1110. { "HPOUT2L_DCS", NULL, "HPOUT2L_DLY" },
  1111. { "HPOUT2L_OUTP", NULL, "HPOUT2L_DCS" },
  1112. { "HPOUT2L_RMV_SHORT", NULL, "HPOUT2L_OUTP" },
  1113. { "HPOUT2R PGA", NULL, "Charge Pump" },
  1114. { "HPOUT2R PGA", NULL, "DAC2R" },
  1115. { "HPOUT2R_DLY", NULL, "HPOUT2R PGA" },
  1116. { "HPOUT2R_DCS", NULL, "HPOUT2R_DLY" },
  1117. { "HPOUT2R_OUTP", NULL, "HPOUT2R_DCS" },
  1118. { "HPOUT2R_RMV_SHORT", NULL, "HPOUT2R_OUTP" },
  1119. { "HPOUT1L PGA", NULL, "Charge Pump" },
  1120. { "HPOUT1L PGA", NULL, "DAC1L" },
  1121. { "HPOUT1L_DLY", NULL, "HPOUT1L PGA" },
  1122. { "HPOUT1L_DCS", NULL, "HPOUT1L_DLY" },
  1123. { "HPOUT1L_OUTP", NULL, "HPOUT1L_DCS" },
  1124. { "HPOUT1L_RMV_SHORT", NULL, "HPOUT1L_OUTP" },
  1125. { "HPOUT1R PGA", NULL, "Charge Pump" },
  1126. { "HPOUT1R PGA", NULL, "DAC1R" },
  1127. { "HPOUT1R_DLY", NULL, "HPOUT1R PGA" },
  1128. { "HPOUT1R_DCS", NULL, "HPOUT1R_DLY" },
  1129. { "HPOUT1R_OUTP", NULL, "HPOUT1R_DCS" },
  1130. { "HPOUT1R_RMV_SHORT", NULL, "HPOUT1R_OUTP" },
  1131. { "HPOUT2L", NULL, "HPOUT2L_RMV_SHORT" },
  1132. { "HPOUT2R", NULL, "HPOUT2R_RMV_SHORT" },
  1133. { "HPOUT1L", NULL, "HPOUT1L_RMV_SHORT" },
  1134. { "HPOUT1R", NULL, "HPOUT1R_RMV_SHORT" },
  1135. { "SPKL", "DAC1L", "DAC1L" },
  1136. { "SPKL", "DAC1R", "DAC1R" },
  1137. { "SPKL", "DAC2L", "DAC2L" },
  1138. { "SPKL", "DAC2R", "DAC2R" },
  1139. { "SPKR", "DAC1L", "DAC1L" },
  1140. { "SPKR", "DAC1R", "DAC1R" },
  1141. { "SPKR", "DAC2L", "DAC2L" },
  1142. { "SPKR", "DAC2R", "DAC2R" },
  1143. { "SPKL PGA", NULL, "SPKL" },
  1144. { "SPKR PGA", NULL, "SPKR" },
  1145. { "SPKDAT", NULL, "SPKL PGA" },
  1146. { "SPKDAT", NULL, "SPKR PGA" },
  1147. };
  1148. static int wm8996_readable_register(struct snd_soc_codec *codec,
  1149. unsigned int reg)
  1150. {
  1151. /* Due to the sparseness of the register map the compiler
  1152. * output from an explicit switch statement ends up being much
  1153. * more efficient than a table.
  1154. */
  1155. switch (reg) {
  1156. case WM8996_SOFTWARE_RESET:
  1157. case WM8996_POWER_MANAGEMENT_1:
  1158. case WM8996_POWER_MANAGEMENT_2:
  1159. case WM8996_POWER_MANAGEMENT_3:
  1160. case WM8996_POWER_MANAGEMENT_4:
  1161. case WM8996_POWER_MANAGEMENT_5:
  1162. case WM8996_POWER_MANAGEMENT_6:
  1163. case WM8996_POWER_MANAGEMENT_7:
  1164. case WM8996_POWER_MANAGEMENT_8:
  1165. case WM8996_LEFT_LINE_INPUT_VOLUME:
  1166. case WM8996_RIGHT_LINE_INPUT_VOLUME:
  1167. case WM8996_LINE_INPUT_CONTROL:
  1168. case WM8996_DAC1_HPOUT1_VOLUME:
  1169. case WM8996_DAC2_HPOUT2_VOLUME:
  1170. case WM8996_DAC1_LEFT_VOLUME:
  1171. case WM8996_DAC1_RIGHT_VOLUME:
  1172. case WM8996_DAC2_LEFT_VOLUME:
  1173. case WM8996_DAC2_RIGHT_VOLUME:
  1174. case WM8996_OUTPUT1_LEFT_VOLUME:
  1175. case WM8996_OUTPUT1_RIGHT_VOLUME:
  1176. case WM8996_OUTPUT2_LEFT_VOLUME:
  1177. case WM8996_OUTPUT2_RIGHT_VOLUME:
  1178. case WM8996_MICBIAS_1:
  1179. case WM8996_MICBIAS_2:
  1180. case WM8996_LDO_1:
  1181. case WM8996_LDO_2:
  1182. case WM8996_ACCESSORY_DETECT_MODE_1:
  1183. case WM8996_ACCESSORY_DETECT_MODE_2:
  1184. case WM8996_HEADPHONE_DETECT_1:
  1185. case WM8996_HEADPHONE_DETECT_2:
  1186. case WM8996_MIC_DETECT_1:
  1187. case WM8996_MIC_DETECT_2:
  1188. case WM8996_MIC_DETECT_3:
  1189. case WM8996_CHARGE_PUMP_1:
  1190. case WM8996_CHARGE_PUMP_2:
  1191. case WM8996_DC_SERVO_1:
  1192. case WM8996_DC_SERVO_2:
  1193. case WM8996_DC_SERVO_3:
  1194. case WM8996_DC_SERVO_5:
  1195. case WM8996_DC_SERVO_6:
  1196. case WM8996_DC_SERVO_7:
  1197. case WM8996_DC_SERVO_READBACK_0:
  1198. case WM8996_ANALOGUE_HP_1:
  1199. case WM8996_ANALOGUE_HP_2:
  1200. case WM8996_CHIP_REVISION:
  1201. case WM8996_CONTROL_INTERFACE_1:
  1202. case WM8996_WRITE_SEQUENCER_CTRL_1:
  1203. case WM8996_WRITE_SEQUENCER_CTRL_2:
  1204. case WM8996_AIF_CLOCKING_1:
  1205. case WM8996_AIF_CLOCKING_2:
  1206. case WM8996_CLOCKING_1:
  1207. case WM8996_CLOCKING_2:
  1208. case WM8996_AIF_RATE:
  1209. case WM8996_FLL_CONTROL_1:
  1210. case WM8996_FLL_CONTROL_2:
  1211. case WM8996_FLL_CONTROL_3:
  1212. case WM8996_FLL_CONTROL_4:
  1213. case WM8996_FLL_CONTROL_5:
  1214. case WM8996_FLL_CONTROL_6:
  1215. case WM8996_FLL_EFS_1:
  1216. case WM8996_FLL_EFS_2:
  1217. case WM8996_AIF1_CONTROL:
  1218. case WM8996_AIF1_BCLK:
  1219. case WM8996_AIF1_TX_LRCLK_1:
  1220. case WM8996_AIF1_TX_LRCLK_2:
  1221. case WM8996_AIF1_RX_LRCLK_1:
  1222. case WM8996_AIF1_RX_LRCLK_2:
  1223. case WM8996_AIF1TX_DATA_CONFIGURATION_1:
  1224. case WM8996_AIF1TX_DATA_CONFIGURATION_2:
  1225. case WM8996_AIF1RX_DATA_CONFIGURATION:
  1226. case WM8996_AIF1TX_CHANNEL_0_CONFIGURATION:
  1227. case WM8996_AIF1TX_CHANNEL_1_CONFIGURATION:
  1228. case WM8996_AIF1TX_CHANNEL_2_CONFIGURATION:
  1229. case WM8996_AIF1TX_CHANNEL_3_CONFIGURATION:
  1230. case WM8996_AIF1TX_CHANNEL_4_CONFIGURATION:
  1231. case WM8996_AIF1TX_CHANNEL_5_CONFIGURATION:
  1232. case WM8996_AIF1RX_CHANNEL_0_CONFIGURATION:
  1233. case WM8996_AIF1RX_CHANNEL_1_CONFIGURATION:
  1234. case WM8996_AIF1RX_CHANNEL_2_CONFIGURATION:
  1235. case WM8996_AIF1RX_CHANNEL_3_CONFIGURATION:
  1236. case WM8996_AIF1RX_CHANNEL_4_CONFIGURATION:
  1237. case WM8996_AIF1RX_CHANNEL_5_CONFIGURATION:
  1238. case WM8996_AIF1RX_MONO_CONFIGURATION:
  1239. case WM8996_AIF1TX_TEST:
  1240. case WM8996_AIF2_CONTROL:
  1241. case WM8996_AIF2_BCLK:
  1242. case WM8996_AIF2_TX_LRCLK_1:
  1243. case WM8996_AIF2_TX_LRCLK_2:
  1244. case WM8996_AIF2_RX_LRCLK_1:
  1245. case WM8996_AIF2_RX_LRCLK_2:
  1246. case WM8996_AIF2TX_DATA_CONFIGURATION_1:
  1247. case WM8996_AIF2TX_DATA_CONFIGURATION_2:
  1248. case WM8996_AIF2RX_DATA_CONFIGURATION:
  1249. case WM8996_AIF2TX_CHANNEL_0_CONFIGURATION:
  1250. case WM8996_AIF2TX_CHANNEL_1_CONFIGURATION:
  1251. case WM8996_AIF2RX_CHANNEL_0_CONFIGURATION:
  1252. case WM8996_AIF2RX_CHANNEL_1_CONFIGURATION:
  1253. case WM8996_AIF2RX_MONO_CONFIGURATION:
  1254. case WM8996_AIF2TX_TEST:
  1255. case WM8996_DSP1_TX_LEFT_VOLUME:
  1256. case WM8996_DSP1_TX_RIGHT_VOLUME:
  1257. case WM8996_DSP1_RX_LEFT_VOLUME:
  1258. case WM8996_DSP1_RX_RIGHT_VOLUME:
  1259. case WM8996_DSP1_TX_FILTERS:
  1260. case WM8996_DSP1_RX_FILTERS_1:
  1261. case WM8996_DSP1_RX_FILTERS_2:
  1262. case WM8996_DSP1_DRC_1:
  1263. case WM8996_DSP1_DRC_2:
  1264. case WM8996_DSP1_DRC_3:
  1265. case WM8996_DSP1_DRC_4:
  1266. case WM8996_DSP1_DRC_5:
  1267. case WM8996_DSP1_RX_EQ_GAINS_1:
  1268. case WM8996_DSP1_RX_EQ_GAINS_2:
  1269. case WM8996_DSP1_RX_EQ_BAND_1_A:
  1270. case WM8996_DSP1_RX_EQ_BAND_1_B:
  1271. case WM8996_DSP1_RX_EQ_BAND_1_PG:
  1272. case WM8996_DSP1_RX_EQ_BAND_2_A:
  1273. case WM8996_DSP1_RX_EQ_BAND_2_B:
  1274. case WM8996_DSP1_RX_EQ_BAND_2_C:
  1275. case WM8996_DSP1_RX_EQ_BAND_2_PG:
  1276. case WM8996_DSP1_RX_EQ_BAND_3_A:
  1277. case WM8996_DSP1_RX_EQ_BAND_3_B:
  1278. case WM8996_DSP1_RX_EQ_BAND_3_C:
  1279. case WM8996_DSP1_RX_EQ_BAND_3_PG:
  1280. case WM8996_DSP1_RX_EQ_BAND_4_A:
  1281. case WM8996_DSP1_RX_EQ_BAND_4_B:
  1282. case WM8996_DSP1_RX_EQ_BAND_4_C:
  1283. case WM8996_DSP1_RX_EQ_BAND_4_PG:
  1284. case WM8996_DSP1_RX_EQ_BAND_5_A:
  1285. case WM8996_DSP1_RX_EQ_BAND_5_B:
  1286. case WM8996_DSP1_RX_EQ_BAND_5_PG:
  1287. case WM8996_DSP2_TX_LEFT_VOLUME:
  1288. case WM8996_DSP2_TX_RIGHT_VOLUME:
  1289. case WM8996_DSP2_RX_LEFT_VOLUME:
  1290. case WM8996_DSP2_RX_RIGHT_VOLUME:
  1291. case WM8996_DSP2_TX_FILTERS:
  1292. case WM8996_DSP2_RX_FILTERS_1:
  1293. case WM8996_DSP2_RX_FILTERS_2:
  1294. case WM8996_DSP2_DRC_1:
  1295. case WM8996_DSP2_DRC_2:
  1296. case WM8996_DSP2_DRC_3:
  1297. case WM8996_DSP2_DRC_4:
  1298. case WM8996_DSP2_DRC_5:
  1299. case WM8996_DSP2_RX_EQ_GAINS_1:
  1300. case WM8996_DSP2_RX_EQ_GAINS_2:
  1301. case WM8996_DSP2_RX_EQ_BAND_1_A:
  1302. case WM8996_DSP2_RX_EQ_BAND_1_B:
  1303. case WM8996_DSP2_RX_EQ_BAND_1_PG:
  1304. case WM8996_DSP2_RX_EQ_BAND_2_A:
  1305. case WM8996_DSP2_RX_EQ_BAND_2_B:
  1306. case WM8996_DSP2_RX_EQ_BAND_2_C:
  1307. case WM8996_DSP2_RX_EQ_BAND_2_PG:
  1308. case WM8996_DSP2_RX_EQ_BAND_3_A:
  1309. case WM8996_DSP2_RX_EQ_BAND_3_B:
  1310. case WM8996_DSP2_RX_EQ_BAND_3_C:
  1311. case WM8996_DSP2_RX_EQ_BAND_3_PG:
  1312. case WM8996_DSP2_RX_EQ_BAND_4_A:
  1313. case WM8996_DSP2_RX_EQ_BAND_4_B:
  1314. case WM8996_DSP2_RX_EQ_BAND_4_C:
  1315. case WM8996_DSP2_RX_EQ_BAND_4_PG:
  1316. case WM8996_DSP2_RX_EQ_BAND_5_A:
  1317. case WM8996_DSP2_RX_EQ_BAND_5_B:
  1318. case WM8996_DSP2_RX_EQ_BAND_5_PG:
  1319. case WM8996_DAC1_MIXER_VOLUMES:
  1320. case WM8996_DAC1_LEFT_MIXER_ROUTING:
  1321. case WM8996_DAC1_RIGHT_MIXER_ROUTING:
  1322. case WM8996_DAC2_MIXER_VOLUMES:
  1323. case WM8996_DAC2_LEFT_MIXER_ROUTING:
  1324. case WM8996_DAC2_RIGHT_MIXER_ROUTING:
  1325. case WM8996_DSP1_TX_LEFT_MIXER_ROUTING:
  1326. case WM8996_DSP1_TX_RIGHT_MIXER_ROUTING:
  1327. case WM8996_DSP2_TX_LEFT_MIXER_ROUTING:
  1328. case WM8996_DSP2_TX_RIGHT_MIXER_ROUTING:
  1329. case WM8996_DSP_TX_MIXER_SELECT:
  1330. case WM8996_DAC_SOFTMUTE:
  1331. case WM8996_OVERSAMPLING:
  1332. case WM8996_SIDETONE:
  1333. case WM8996_GPIO_1:
  1334. case WM8996_GPIO_2:
  1335. case WM8996_GPIO_3:
  1336. case WM8996_GPIO_4:
  1337. case WM8996_GPIO_5:
  1338. case WM8996_PULL_CONTROL_1:
  1339. case WM8996_PULL_CONTROL_2:
  1340. case WM8996_INTERRUPT_STATUS_1:
  1341. case WM8996_INTERRUPT_STATUS_2:
  1342. case WM8996_INTERRUPT_RAW_STATUS_2:
  1343. case WM8996_INTERRUPT_STATUS_1_MASK:
  1344. case WM8996_INTERRUPT_STATUS_2_MASK:
  1345. case WM8996_INTERRUPT_CONTROL:
  1346. case WM8996_LEFT_PDM_SPEAKER:
  1347. case WM8996_RIGHT_PDM_SPEAKER:
  1348. case WM8996_PDM_SPEAKER_MUTE_SEQUENCE:
  1349. case WM8996_PDM_SPEAKER_VOLUME:
  1350. return 1;
  1351. default:
  1352. return 0;
  1353. }
  1354. }
  1355. static int wm8996_volatile_register(struct snd_soc_codec *codec,
  1356. unsigned int reg)
  1357. {
  1358. switch (reg) {
  1359. case WM8996_SOFTWARE_RESET:
  1360. case WM8996_CHIP_REVISION:
  1361. case WM8996_LDO_1:
  1362. case WM8996_LDO_2:
  1363. case WM8996_INTERRUPT_STATUS_1:
  1364. case WM8996_INTERRUPT_STATUS_2:
  1365. case WM8996_INTERRUPT_RAW_STATUS_2:
  1366. case WM8996_DC_SERVO_READBACK_0:
  1367. case WM8996_DC_SERVO_2:
  1368. case WM8996_DC_SERVO_6:
  1369. case WM8996_DC_SERVO_7:
  1370. case WM8996_FLL_CONTROL_6:
  1371. case WM8996_MIC_DETECT_3:
  1372. case WM8996_HEADPHONE_DETECT_1:
  1373. case WM8996_HEADPHONE_DETECT_2:
  1374. return 1;
  1375. default:
  1376. return 0;
  1377. }
  1378. }
  1379. static int wm8996_reset(struct snd_soc_codec *codec)
  1380. {
  1381. return snd_soc_write(codec, WM8996_SOFTWARE_RESET, 0x8915);
  1382. }
  1383. static const int bclk_divs[] = {
  1384. 1, 2, 3, 4, 6, 8, 12, 16, 24, 32, 48, 64, 96
  1385. };
  1386. static void wm8996_update_bclk(struct snd_soc_codec *codec)
  1387. {
  1388. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1389. int aif, best, cur_val, bclk_rate, bclk_reg, i;
  1390. /* Don't bother if we're in a low frequency idle mode that
  1391. * can't support audio.
  1392. */
  1393. if (wm8996->sysclk < 64000)
  1394. return;
  1395. for (aif = 0; aif < WM8996_AIFS; aif++) {
  1396. switch (aif) {
  1397. case 0:
  1398. bclk_reg = WM8996_AIF1_BCLK;
  1399. break;
  1400. case 1:
  1401. bclk_reg = WM8996_AIF2_BCLK;
  1402. break;
  1403. }
  1404. bclk_rate = wm8996->bclk_rate[aif];
  1405. /* Pick a divisor for BCLK as close as we can get to ideal */
  1406. best = 0;
  1407. for (i = 0; i < ARRAY_SIZE(bclk_divs); i++) {
  1408. cur_val = (wm8996->sysclk / bclk_divs[i]) - bclk_rate;
  1409. if (cur_val < 0) /* BCLK table is sorted */
  1410. break;
  1411. best = i;
  1412. }
  1413. bclk_rate = wm8996->sysclk / bclk_divs[best];
  1414. dev_dbg(codec->dev, "Using BCLK_DIV %d for actual BCLK %dHz\n",
  1415. bclk_divs[best], bclk_rate);
  1416. snd_soc_update_bits(codec, bclk_reg,
  1417. WM8996_AIF1_BCLK_DIV_MASK, best);
  1418. }
  1419. }
  1420. static int wm8996_set_bias_level(struct snd_soc_codec *codec,
  1421. enum snd_soc_bias_level level)
  1422. {
  1423. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1424. int ret;
  1425. switch (level) {
  1426. case SND_SOC_BIAS_ON:
  1427. break;
  1428. case SND_SOC_BIAS_PREPARE:
  1429. if (codec->dapm.bias_level == SND_SOC_BIAS_STANDBY) {
  1430. snd_soc_update_bits(codec, WM8996_POWER_MANAGEMENT_1,
  1431. WM8996_BG_ENA, WM8996_BG_ENA);
  1432. msleep(2);
  1433. }
  1434. break;
  1435. case SND_SOC_BIAS_STANDBY:
  1436. if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
  1437. ret = regulator_bulk_enable(ARRAY_SIZE(wm8996->supplies),
  1438. wm8996->supplies);
  1439. if (ret != 0) {
  1440. dev_err(codec->dev,
  1441. "Failed to enable supplies: %d\n",
  1442. ret);
  1443. return ret;
  1444. }
  1445. if (wm8996->pdata.ldo_ena >= 0) {
  1446. gpio_set_value_cansleep(wm8996->pdata.ldo_ena,
  1447. 1);
  1448. msleep(5);
  1449. }
  1450. codec->cache_only = false;
  1451. snd_soc_cache_sync(codec);
  1452. }
  1453. snd_soc_update_bits(codec, WM8996_POWER_MANAGEMENT_1,
  1454. WM8996_BG_ENA, 0);
  1455. break;
  1456. case SND_SOC_BIAS_OFF:
  1457. codec->cache_only = true;
  1458. if (wm8996->pdata.ldo_ena >= 0)
  1459. gpio_set_value_cansleep(wm8996->pdata.ldo_ena, 0);
  1460. regulator_bulk_disable(ARRAY_SIZE(wm8996->supplies),
  1461. wm8996->supplies);
  1462. break;
  1463. }
  1464. codec->dapm.bias_level = level;
  1465. return 0;
  1466. }
  1467. static int wm8996_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
  1468. {
  1469. struct snd_soc_codec *codec = dai->codec;
  1470. int aifctrl = 0;
  1471. int bclk = 0;
  1472. int lrclk_tx = 0;
  1473. int lrclk_rx = 0;
  1474. int aifctrl_reg, bclk_reg, lrclk_tx_reg, lrclk_rx_reg;
  1475. switch (dai->id) {
  1476. case 0:
  1477. aifctrl_reg = WM8996_AIF1_CONTROL;
  1478. bclk_reg = WM8996_AIF1_BCLK;
  1479. lrclk_tx_reg = WM8996_AIF1_TX_LRCLK_2;
  1480. lrclk_rx_reg = WM8996_AIF1_RX_LRCLK_2;
  1481. break;
  1482. case 1:
  1483. aifctrl_reg = WM8996_AIF2_CONTROL;
  1484. bclk_reg = WM8996_AIF2_BCLK;
  1485. lrclk_tx_reg = WM8996_AIF2_TX_LRCLK_2;
  1486. lrclk_rx_reg = WM8996_AIF2_RX_LRCLK_2;
  1487. break;
  1488. default:
  1489. BUG();
  1490. return -EINVAL;
  1491. }
  1492. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  1493. case SND_SOC_DAIFMT_NB_NF:
  1494. break;
  1495. case SND_SOC_DAIFMT_IB_NF:
  1496. bclk |= WM8996_AIF1_BCLK_INV;
  1497. break;
  1498. case SND_SOC_DAIFMT_NB_IF:
  1499. lrclk_tx |= WM8996_AIF1TX_LRCLK_INV;
  1500. lrclk_rx |= WM8996_AIF1RX_LRCLK_INV;
  1501. break;
  1502. case SND_SOC_DAIFMT_IB_IF:
  1503. bclk |= WM8996_AIF1_BCLK_INV;
  1504. lrclk_tx |= WM8996_AIF1TX_LRCLK_INV;
  1505. lrclk_rx |= WM8996_AIF1RX_LRCLK_INV;
  1506. break;
  1507. }
  1508. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  1509. case SND_SOC_DAIFMT_CBS_CFS:
  1510. break;
  1511. case SND_SOC_DAIFMT_CBS_CFM:
  1512. lrclk_tx |= WM8996_AIF1TX_LRCLK_MSTR;
  1513. lrclk_rx |= WM8996_AIF1RX_LRCLK_MSTR;
  1514. break;
  1515. case SND_SOC_DAIFMT_CBM_CFS:
  1516. bclk |= WM8996_AIF1_BCLK_MSTR;
  1517. break;
  1518. case SND_SOC_DAIFMT_CBM_CFM:
  1519. bclk |= WM8996_AIF1_BCLK_MSTR;
  1520. lrclk_tx |= WM8996_AIF1TX_LRCLK_MSTR;
  1521. lrclk_rx |= WM8996_AIF1RX_LRCLK_MSTR;
  1522. break;
  1523. default:
  1524. return -EINVAL;
  1525. }
  1526. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  1527. case SND_SOC_DAIFMT_DSP_A:
  1528. break;
  1529. case SND_SOC_DAIFMT_DSP_B:
  1530. aifctrl |= 1;
  1531. break;
  1532. case SND_SOC_DAIFMT_I2S:
  1533. aifctrl |= 2;
  1534. break;
  1535. case SND_SOC_DAIFMT_LEFT_J:
  1536. aifctrl |= 3;
  1537. break;
  1538. default:
  1539. return -EINVAL;
  1540. }
  1541. snd_soc_update_bits(codec, aifctrl_reg, WM8996_AIF1_FMT_MASK, aifctrl);
  1542. snd_soc_update_bits(codec, bclk_reg,
  1543. WM8996_AIF1_BCLK_INV | WM8996_AIF1_BCLK_MSTR,
  1544. bclk);
  1545. snd_soc_update_bits(codec, lrclk_tx_reg,
  1546. WM8996_AIF1TX_LRCLK_INV |
  1547. WM8996_AIF1TX_LRCLK_MSTR,
  1548. lrclk_tx);
  1549. snd_soc_update_bits(codec, lrclk_rx_reg,
  1550. WM8996_AIF1RX_LRCLK_INV |
  1551. WM8996_AIF1RX_LRCLK_MSTR,
  1552. lrclk_rx);
  1553. return 0;
  1554. }
  1555. static const int dsp_divs[] = {
  1556. 48000, 32000, 16000, 8000
  1557. };
  1558. static int wm8996_hw_params(struct snd_pcm_substream *substream,
  1559. struct snd_pcm_hw_params *params,
  1560. struct snd_soc_dai *dai)
  1561. {
  1562. struct snd_soc_codec *codec = dai->codec;
  1563. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1564. int bits, i, bclk_rate;
  1565. int aifdata = 0;
  1566. int lrclk = 0;
  1567. int dsp = 0;
  1568. int aifdata_reg, lrclk_reg, dsp_shift;
  1569. switch (dai->id) {
  1570. case 0:
  1571. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
  1572. (snd_soc_read(codec, WM8996_GPIO_1)) & WM8996_GP1_FN_MASK) {
  1573. aifdata_reg = WM8996_AIF1RX_DATA_CONFIGURATION;
  1574. lrclk_reg = WM8996_AIF1_RX_LRCLK_1;
  1575. } else {
  1576. aifdata_reg = WM8996_AIF1TX_DATA_CONFIGURATION_1;
  1577. lrclk_reg = WM8996_AIF1_TX_LRCLK_1;
  1578. }
  1579. dsp_shift = 0;
  1580. break;
  1581. case 1:
  1582. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
  1583. (snd_soc_read(codec, WM8996_GPIO_2)) & WM8996_GP2_FN_MASK) {
  1584. aifdata_reg = WM8996_AIF2RX_DATA_CONFIGURATION;
  1585. lrclk_reg = WM8996_AIF2_RX_LRCLK_1;
  1586. } else {
  1587. aifdata_reg = WM8996_AIF2TX_DATA_CONFIGURATION_1;
  1588. lrclk_reg = WM8996_AIF2_TX_LRCLK_1;
  1589. }
  1590. dsp_shift = WM8996_DSP2_DIV_SHIFT;
  1591. break;
  1592. default:
  1593. BUG();
  1594. return -EINVAL;
  1595. }
  1596. bclk_rate = snd_soc_params_to_bclk(params);
  1597. if (bclk_rate < 0) {
  1598. dev_err(codec->dev, "Unsupported BCLK rate: %d\n", bclk_rate);
  1599. return bclk_rate;
  1600. }
  1601. wm8996->bclk_rate[dai->id] = bclk_rate;
  1602. wm8996->rx_rate[dai->id] = params_rate(params);
  1603. /* Needs looking at for TDM */
  1604. bits = snd_pcm_format_width(params_format(params));
  1605. if (bits < 0)
  1606. return bits;
  1607. aifdata |= (bits << WM8996_AIF1TX_WL_SHIFT) | bits;
  1608. for (i = 0; i < ARRAY_SIZE(dsp_divs); i++) {
  1609. if (dsp_divs[i] == params_rate(params))
  1610. break;
  1611. }
  1612. if (i == ARRAY_SIZE(dsp_divs)) {
  1613. dev_err(codec->dev, "Unsupported sample rate %dHz\n",
  1614. params_rate(params));
  1615. return -EINVAL;
  1616. }
  1617. dsp |= i << dsp_shift;
  1618. wm8996_update_bclk(codec);
  1619. lrclk = bclk_rate / params_rate(params);
  1620. dev_dbg(dai->dev, "Using LRCLK rate %d for actual LRCLK %dHz\n",
  1621. lrclk, bclk_rate / lrclk);
  1622. snd_soc_update_bits(codec, aifdata_reg,
  1623. WM8996_AIF1TX_WL_MASK |
  1624. WM8996_AIF1TX_SLOT_LEN_MASK,
  1625. aifdata);
  1626. snd_soc_update_bits(codec, lrclk_reg, WM8996_AIF1RX_RATE_MASK,
  1627. lrclk);
  1628. snd_soc_update_bits(codec, WM8996_AIF_CLOCKING_2,
  1629. WM8996_DSP1_DIV_SHIFT << dsp_shift, dsp);
  1630. return 0;
  1631. }
  1632. static int wm8996_set_sysclk(struct snd_soc_dai *dai,
  1633. int clk_id, unsigned int freq, int dir)
  1634. {
  1635. struct snd_soc_codec *codec = dai->codec;
  1636. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1637. int lfclk = 0;
  1638. int ratediv = 0;
  1639. int src;
  1640. int old;
  1641. if (freq == wm8996->sysclk && clk_id == wm8996->sysclk_src)
  1642. return 0;
  1643. /* Disable SYSCLK while we reconfigure */
  1644. old = snd_soc_read(codec, WM8996_AIF_CLOCKING_1) & WM8996_SYSCLK_ENA;
  1645. snd_soc_update_bits(codec, WM8996_AIF_CLOCKING_1,
  1646. WM8996_SYSCLK_ENA, 0);
  1647. switch (clk_id) {
  1648. case WM8996_SYSCLK_MCLK1:
  1649. wm8996->sysclk = freq;
  1650. src = 0;
  1651. break;
  1652. case WM8996_SYSCLK_MCLK2:
  1653. wm8996->sysclk = freq;
  1654. src = 1;
  1655. break;
  1656. case WM8996_SYSCLK_FLL:
  1657. wm8996->sysclk = freq;
  1658. src = 2;
  1659. break;
  1660. default:
  1661. dev_err(codec->dev, "Unsupported clock source %d\n", clk_id);
  1662. return -EINVAL;
  1663. }
  1664. switch (wm8996->sysclk) {
  1665. case 6144000:
  1666. snd_soc_update_bits(codec, WM8996_AIF_RATE,
  1667. WM8996_SYSCLK_RATE, 0);
  1668. break;
  1669. case 24576000:
  1670. ratediv = WM8996_SYSCLK_DIV;
  1671. case 12288000:
  1672. snd_soc_update_bits(codec, WM8996_AIF_RATE,
  1673. WM8996_SYSCLK_RATE, WM8996_SYSCLK_RATE);
  1674. break;
  1675. case 32000:
  1676. case 32768:
  1677. lfclk = WM8996_LFCLK_ENA;
  1678. break;
  1679. default:
  1680. dev_warn(codec->dev, "Unsupported clock rate %dHz\n",
  1681. wm8996->sysclk);
  1682. return -EINVAL;
  1683. }
  1684. wm8996_update_bclk(codec);
  1685. snd_soc_update_bits(codec, WM8996_AIF_CLOCKING_1,
  1686. WM8996_SYSCLK_SRC_MASK | WM8996_SYSCLK_DIV_MASK,
  1687. src << WM8996_SYSCLK_SRC_SHIFT | ratediv);
  1688. snd_soc_update_bits(codec, WM8996_CLOCKING_1, WM8996_LFCLK_ENA, lfclk);
  1689. snd_soc_update_bits(codec, WM8996_AIF_CLOCKING_1,
  1690. WM8996_SYSCLK_ENA, old);
  1691. wm8996->sysclk_src = clk_id;
  1692. return 0;
  1693. }
  1694. struct _fll_div {
  1695. u16 fll_fratio;
  1696. u16 fll_outdiv;
  1697. u16 fll_refclk_div;
  1698. u16 fll_loop_gain;
  1699. u16 fll_ref_freq;
  1700. u16 n;
  1701. u16 theta;
  1702. u16 lambda;
  1703. };
  1704. static struct {
  1705. unsigned int min;
  1706. unsigned int max;
  1707. u16 fll_fratio;
  1708. int ratio;
  1709. } fll_fratios[] = {
  1710. { 0, 64000, 4, 16 },
  1711. { 64000, 128000, 3, 8 },
  1712. { 128000, 256000, 2, 4 },
  1713. { 256000, 1000000, 1, 2 },
  1714. { 1000000, 13500000, 0, 1 },
  1715. };
  1716. static int fll_factors(struct _fll_div *fll_div, unsigned int Fref,
  1717. unsigned int Fout)
  1718. {
  1719. unsigned int target;
  1720. unsigned int div;
  1721. unsigned int fratio, gcd_fll;
  1722. int i;
  1723. /* Fref must be <=13.5MHz */
  1724. div = 1;
  1725. fll_div->fll_refclk_div = 0;
  1726. while ((Fref / div) > 13500000) {
  1727. div *= 2;
  1728. fll_div->fll_refclk_div++;
  1729. if (div > 8) {
  1730. pr_err("Can't scale %dMHz input down to <=13.5MHz\n",
  1731. Fref);
  1732. return -EINVAL;
  1733. }
  1734. }
  1735. pr_debug("FLL Fref=%u Fout=%u\n", Fref, Fout);
  1736. /* Apply the division for our remaining calculations */
  1737. Fref /= div;
  1738. if (Fref >= 3000000)
  1739. fll_div->fll_loop_gain = 5;
  1740. else
  1741. fll_div->fll_loop_gain = 0;
  1742. if (Fref >= 48000)
  1743. fll_div->fll_ref_freq = 0;
  1744. else
  1745. fll_div->fll_ref_freq = 1;
  1746. /* Fvco should be 90-100MHz; don't check the upper bound */
  1747. div = 2;
  1748. while (Fout * div < 90000000) {
  1749. div++;
  1750. if (div > 64) {
  1751. pr_err("Unable to find FLL_OUTDIV for Fout=%uHz\n",
  1752. Fout);
  1753. return -EINVAL;
  1754. }
  1755. }
  1756. target = Fout * div;
  1757. fll_div->fll_outdiv = div - 1;
  1758. pr_debug("FLL Fvco=%dHz\n", target);
  1759. /* Find an appropraite FLL_FRATIO and factor it out of the target */
  1760. for (i = 0; i < ARRAY_SIZE(fll_fratios); i++) {
  1761. if (fll_fratios[i].min <= Fref && Fref <= fll_fratios[i].max) {
  1762. fll_div->fll_fratio = fll_fratios[i].fll_fratio;
  1763. fratio = fll_fratios[i].ratio;
  1764. break;
  1765. }
  1766. }
  1767. if (i == ARRAY_SIZE(fll_fratios)) {
  1768. pr_err("Unable to find FLL_FRATIO for Fref=%uHz\n", Fref);
  1769. return -EINVAL;
  1770. }
  1771. fll_div->n = target / (fratio * Fref);
  1772. if (target % Fref == 0) {
  1773. fll_div->theta = 0;
  1774. fll_div->lambda = 0;
  1775. } else {
  1776. gcd_fll = gcd(target, fratio * Fref);
  1777. fll_div->theta = (target - (fll_div->n * fratio * Fref))
  1778. / gcd_fll;
  1779. fll_div->lambda = (fratio * Fref) / gcd_fll;
  1780. }
  1781. pr_debug("FLL N=%x THETA=%x LAMBDA=%x\n",
  1782. fll_div->n, fll_div->theta, fll_div->lambda);
  1783. pr_debug("FLL_FRATIO=%x FLL_OUTDIV=%x FLL_REFCLK_DIV=%x\n",
  1784. fll_div->fll_fratio, fll_div->fll_outdiv,
  1785. fll_div->fll_refclk_div);
  1786. return 0;
  1787. }
  1788. static int wm8996_set_fll(struct snd_soc_codec *codec, int fll_id, int source,
  1789. unsigned int Fref, unsigned int Fout)
  1790. {
  1791. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1792. struct i2c_client *i2c = to_i2c_client(codec->dev);
  1793. struct _fll_div fll_div;
  1794. unsigned long timeout;
  1795. int ret, reg;
  1796. /* Any change? */
  1797. if (source == wm8996->fll_src && Fref == wm8996->fll_fref &&
  1798. Fout == wm8996->fll_fout)
  1799. return 0;
  1800. if (Fout == 0) {
  1801. dev_dbg(codec->dev, "FLL disabled\n");
  1802. wm8996->fll_fref = 0;
  1803. wm8996->fll_fout = 0;
  1804. snd_soc_update_bits(codec, WM8996_FLL_CONTROL_1,
  1805. WM8996_FLL_ENA, 0);
  1806. return 0;
  1807. }
  1808. ret = fll_factors(&fll_div, Fref, Fout);
  1809. if (ret != 0)
  1810. return ret;
  1811. switch (source) {
  1812. case WM8996_FLL_MCLK1:
  1813. reg = 0;
  1814. break;
  1815. case WM8996_FLL_MCLK2:
  1816. reg = 1;
  1817. break;
  1818. case WM8996_FLL_DACLRCLK1:
  1819. reg = 2;
  1820. break;
  1821. case WM8996_FLL_BCLK1:
  1822. reg = 3;
  1823. break;
  1824. default:
  1825. dev_err(codec->dev, "Unknown FLL source %d\n", ret);
  1826. return -EINVAL;
  1827. }
  1828. reg |= fll_div.fll_refclk_div << WM8996_FLL_REFCLK_DIV_SHIFT;
  1829. reg |= fll_div.fll_ref_freq << WM8996_FLL_REF_FREQ_SHIFT;
  1830. snd_soc_update_bits(codec, WM8996_FLL_CONTROL_5,
  1831. WM8996_FLL_REFCLK_DIV_MASK | WM8996_FLL_REF_FREQ |
  1832. WM8996_FLL_REFCLK_SRC_MASK, reg);
  1833. reg = 0;
  1834. if (fll_div.theta || fll_div.lambda)
  1835. reg |= WM8996_FLL_EFS_ENA | (3 << WM8996_FLL_LFSR_SEL_SHIFT);
  1836. else
  1837. reg |= 1 << WM8996_FLL_LFSR_SEL_SHIFT;
  1838. snd_soc_write(codec, WM8996_FLL_EFS_2, reg);
  1839. snd_soc_update_bits(codec, WM8996_FLL_CONTROL_2,
  1840. WM8996_FLL_OUTDIV_MASK |
  1841. WM8996_FLL_FRATIO_MASK,
  1842. (fll_div.fll_outdiv << WM8996_FLL_OUTDIV_SHIFT) |
  1843. (fll_div.fll_fratio));
  1844. snd_soc_write(codec, WM8996_FLL_CONTROL_3, fll_div.theta);
  1845. snd_soc_update_bits(codec, WM8996_FLL_CONTROL_4,
  1846. WM8996_FLL_N_MASK | WM8996_FLL_LOOP_GAIN_MASK,
  1847. (fll_div.n << WM8996_FLL_N_SHIFT) |
  1848. fll_div.fll_loop_gain);
  1849. snd_soc_write(codec, WM8996_FLL_EFS_1, fll_div.lambda);
  1850. /* Clear any pending completions (eg, from failed startups) */
  1851. try_wait_for_completion(&wm8996->fll_lock);
  1852. snd_soc_update_bits(codec, WM8996_FLL_CONTROL_1,
  1853. WM8996_FLL_ENA, WM8996_FLL_ENA);
  1854. /* The FLL supports live reconfiguration - kick that in case we were
  1855. * already enabled.
  1856. */
  1857. snd_soc_write(codec, WM8996_FLL_CONTROL_6, WM8996_FLL_SWITCH_CLK);
  1858. /* Wait for the FLL to lock, using the interrupt if possible */
  1859. if (Fref > 1000000)
  1860. timeout = usecs_to_jiffies(300);
  1861. else
  1862. timeout = msecs_to_jiffies(2);
  1863. /* Allow substantially longer if we've actually got the IRQ */
  1864. if (i2c->irq)
  1865. timeout *= 1000;
  1866. ret = wait_for_completion_timeout(&wm8996->fll_lock, timeout);
  1867. if (ret == 0 && i2c->irq) {
  1868. dev_err(codec->dev, "Timed out waiting for FLL\n");
  1869. ret = -ETIMEDOUT;
  1870. } else {
  1871. ret = 0;
  1872. }
  1873. dev_dbg(codec->dev, "FLL configured for %dHz->%dHz\n", Fref, Fout);
  1874. wm8996->fll_fref = Fref;
  1875. wm8996->fll_fout = Fout;
  1876. wm8996->fll_src = source;
  1877. return ret;
  1878. }
  1879. #ifdef CONFIG_GPIOLIB
  1880. static inline struct wm8996_priv *gpio_to_wm8996(struct gpio_chip *chip)
  1881. {
  1882. return container_of(chip, struct wm8996_priv, gpio_chip);
  1883. }
  1884. static void wm8996_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
  1885. {
  1886. struct wm8996_priv *wm8996 = gpio_to_wm8996(chip);
  1887. struct snd_soc_codec *codec = wm8996->codec;
  1888. snd_soc_update_bits(codec, WM8996_GPIO_1 + offset,
  1889. WM8996_GP1_LVL, !!value << WM8996_GP1_LVL_SHIFT);
  1890. }
  1891. static int wm8996_gpio_direction_out(struct gpio_chip *chip,
  1892. unsigned offset, int value)
  1893. {
  1894. struct wm8996_priv *wm8996 = gpio_to_wm8996(chip);
  1895. struct snd_soc_codec *codec = wm8996->codec;
  1896. int val;
  1897. val = (1 << WM8996_GP1_FN_SHIFT) | (!!value << WM8996_GP1_LVL_SHIFT);
  1898. return snd_soc_update_bits(codec, WM8996_GPIO_1 + offset,
  1899. WM8996_GP1_FN_MASK | WM8996_GP1_DIR |
  1900. WM8996_GP1_LVL, val);
  1901. }
  1902. static int wm8996_gpio_get(struct gpio_chip *chip, unsigned offset)
  1903. {
  1904. struct wm8996_priv *wm8996 = gpio_to_wm8996(chip);
  1905. struct snd_soc_codec *codec = wm8996->codec;
  1906. int ret;
  1907. ret = snd_soc_read(codec, WM8996_GPIO_1 + offset);
  1908. if (ret < 0)
  1909. return ret;
  1910. return (ret & WM8996_GP1_LVL) != 0;
  1911. }
  1912. static int wm8996_gpio_direction_in(struct gpio_chip *chip, unsigned offset)
  1913. {
  1914. struct wm8996_priv *wm8996 = gpio_to_wm8996(chip);
  1915. struct snd_soc_codec *codec = wm8996->codec;
  1916. return snd_soc_update_bits(codec, WM8996_GPIO_1 + offset,
  1917. WM8996_GP1_FN_MASK | WM8996_GP1_DIR,
  1918. (1 << WM8996_GP1_FN_SHIFT) |
  1919. (1 << WM8996_GP1_DIR_SHIFT));
  1920. }
  1921. static struct gpio_chip wm8996_template_chip = {
  1922. .label = "wm8996",
  1923. .owner = THIS_MODULE,
  1924. .direction_output = wm8996_gpio_direction_out,
  1925. .set = wm8996_gpio_set,
  1926. .direction_input = wm8996_gpio_direction_in,
  1927. .get = wm8996_gpio_get,
  1928. .can_sleep = 1,
  1929. };
  1930. static void wm8996_init_gpio(struct snd_soc_codec *codec)
  1931. {
  1932. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1933. int ret;
  1934. wm8996->gpio_chip = wm8996_template_chip;
  1935. wm8996->gpio_chip.ngpio = 5;
  1936. wm8996->gpio_chip.dev = codec->dev;
  1937. if (wm8996->pdata.gpio_base)
  1938. wm8996->gpio_chip.base = wm8996->pdata.gpio_base;
  1939. else
  1940. wm8996->gpio_chip.base = -1;
  1941. ret = gpiochip_add(&wm8996->gpio_chip);
  1942. if (ret != 0)
  1943. dev_err(codec->dev, "Failed to add GPIOs: %d\n", ret);
  1944. }
  1945. static void wm8996_free_gpio(struct snd_soc_codec *codec)
  1946. {
  1947. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1948. int ret;
  1949. ret = gpiochip_remove(&wm8996->gpio_chip);
  1950. if (ret != 0)
  1951. dev_err(codec->dev, "Failed to remove GPIOs: %d\n", ret);
  1952. }
  1953. #else
  1954. static void wm8996_init_gpio(struct snd_soc_codec *codec)
  1955. {
  1956. }
  1957. static void wm8996_free_gpio(struct snd_soc_codec *codec)
  1958. {
  1959. }
  1960. #endif
  1961. /**
  1962. * wm8996_detect - Enable default WM8996 jack detection
  1963. *
  1964. * The WM8996 has advanced accessory detection support for headsets.
  1965. * This function provides a default implementation which integrates
  1966. * the majority of this functionality with minimal user configuration.
  1967. *
  1968. * This will detect headset, headphone and short circuit button and
  1969. * will also detect inverted microphone ground connections and update
  1970. * the polarity of the connections.
  1971. */
  1972. int wm8996_detect(struct snd_soc_codec *codec, struct snd_soc_jack *jack,
  1973. wm8996_polarity_fn polarity_cb)
  1974. {
  1975. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  1976. wm8996->jack = jack;
  1977. wm8996->detecting = true;
  1978. wm8996->polarity_cb = polarity_cb;
  1979. if (wm8996->polarity_cb)
  1980. wm8996->polarity_cb(codec, 0);
  1981. /* Clear discarge to avoid noise during detection */
  1982. snd_soc_update_bits(codec, WM8996_MICBIAS_1,
  1983. WM8996_MICB1_DISCH, 0);
  1984. snd_soc_update_bits(codec, WM8996_MICBIAS_2,
  1985. WM8996_MICB2_DISCH, 0);
  1986. /* LDO2 powers the microphones, SYSCLK clocks detection */
  1987. snd_soc_dapm_force_enable_pin(&codec->dapm, "LDO2");
  1988. snd_soc_dapm_force_enable_pin(&codec->dapm, "SYSCLK");
  1989. /* We start off just enabling microphone detection - even a
  1990. * plain headphone will trigger detection.
  1991. */
  1992. snd_soc_update_bits(codec, WM8996_MIC_DETECT_1,
  1993. WM8996_MICD_ENA, WM8996_MICD_ENA);
  1994. /* Slowest detection rate, gives debounce for initial detection */
  1995. snd_soc_update_bits(codec, WM8996_MIC_DETECT_1,
  1996. WM8996_MICD_RATE_MASK,
  1997. WM8996_MICD_RATE_MASK);
  1998. /* Enable interrupts and we're off */
  1999. snd_soc_update_bits(codec, WM8996_INTERRUPT_STATUS_2_MASK,
  2000. WM8996_IM_MICD_EINT, 0);
  2001. return 0;
  2002. }
  2003. EXPORT_SYMBOL_GPL(wm8996_detect);
  2004. static void wm8996_micd(struct snd_soc_codec *codec)
  2005. {
  2006. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  2007. int val, reg;
  2008. val = snd_soc_read(codec, WM8996_MIC_DETECT_3);
  2009. dev_dbg(codec->dev, "Microphone event: %x\n", val);
  2010. if (!(val & WM8996_MICD_VALID)) {
  2011. dev_warn(codec->dev, "Microphone detection state invalid\n");
  2012. return;
  2013. }
  2014. /* No accessory, reset everything and report removal */
  2015. if (!(val & WM8996_MICD_STS)) {
  2016. dev_dbg(codec->dev, "Jack removal detected\n");
  2017. wm8996->jack_mic = false;
  2018. wm8996->detecting = true;
  2019. snd_soc_jack_report(wm8996->jack, 0,
  2020. SND_JACK_HEADSET | SND_JACK_BTN_0);
  2021. snd_soc_update_bits(codec, WM8996_MIC_DETECT_1,
  2022. WM8996_MICD_RATE_MASK,
  2023. WM8996_MICD_RATE_MASK);
  2024. return;
  2025. }
  2026. /* If the measurement is very high we've got a microphone but
  2027. * do a little debounce to account for mechanical issues.
  2028. */
  2029. if (val & 0x400) {
  2030. dev_dbg(codec->dev, "Microphone detected\n");
  2031. snd_soc_jack_report(wm8996->jack, SND_JACK_HEADSET,
  2032. SND_JACK_HEADSET | SND_JACK_BTN_0);
  2033. wm8996->jack_mic = true;
  2034. wm8996->detecting = false;
  2035. /* Increase poll rate to give better responsiveness
  2036. * for buttons */
  2037. snd_soc_update_bits(codec, WM8996_MIC_DETECT_1,
  2038. WM8996_MICD_RATE_MASK,
  2039. 5 << WM8996_MICD_RATE_SHIFT);
  2040. }
  2041. /* If we detected a lower impedence during initial startup
  2042. * then we probably have the wrong polarity, flip it. Don't
  2043. * do this for the lowest impedences to speed up detection of
  2044. * plain headphones.
  2045. */
  2046. if (wm8996->detecting && (val & 0x3f0)) {
  2047. reg = snd_soc_read(codec, WM8996_ACCESSORY_DETECT_MODE_2);
  2048. reg ^= WM8996_HPOUT1FB_SRC | WM8996_MICD_SRC |
  2049. WM8996_MICD_BIAS_SRC;
  2050. snd_soc_update_bits(codec, WM8996_ACCESSORY_DETECT_MODE_2,
  2051. WM8996_HPOUT1FB_SRC | WM8996_MICD_SRC |
  2052. WM8996_MICD_BIAS_SRC, reg);
  2053. if (wm8996->polarity_cb)
  2054. wm8996->polarity_cb(codec,
  2055. (reg & WM8996_MICD_SRC) != 0);
  2056. dev_dbg(codec->dev, "Set microphone polarity to %d\n",
  2057. (reg & WM8996_MICD_SRC) != 0);
  2058. return;
  2059. }
  2060. /* Don't distinguish between buttons, just report any low
  2061. * impedence as BTN_0.
  2062. */
  2063. if (val & 0x3fc) {
  2064. if (wm8996->jack_mic) {
  2065. dev_dbg(codec->dev, "Mic button detected\n");
  2066. snd_soc_jack_report(wm8996->jack,
  2067. SND_JACK_HEADSET | SND_JACK_BTN_0,
  2068. SND_JACK_HEADSET | SND_JACK_BTN_0);
  2069. } else {
  2070. dev_dbg(codec->dev, "Headphone detected\n");
  2071. snd_soc_jack_report(wm8996->jack,
  2072. SND_JACK_HEADPHONE,
  2073. SND_JACK_HEADSET |
  2074. SND_JACK_BTN_0);
  2075. /* Increase the detection rate a bit for
  2076. * responsiveness.
  2077. */
  2078. snd_soc_update_bits(codec, WM8996_MIC_DETECT_1,
  2079. WM8996_MICD_RATE_MASK,
  2080. 7 << WM8996_MICD_RATE_SHIFT);
  2081. wm8996->detecting = false;
  2082. }
  2083. }
  2084. }
  2085. static irqreturn_t wm8996_irq(int irq, void *data)
  2086. {
  2087. struct snd_soc_codec *codec = data;
  2088. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  2089. int irq_val;
  2090. irq_val = snd_soc_read(codec, WM8996_INTERRUPT_STATUS_2);
  2091. if (irq_val < 0) {
  2092. dev_err(codec->dev, "Failed to read IRQ status: %d\n",
  2093. irq_val);
  2094. return IRQ_NONE;
  2095. }
  2096. irq_val &= ~snd_soc_read(codec, WM8996_INTERRUPT_STATUS_2_MASK);
  2097. if (!irq_val)
  2098. return IRQ_NONE;
  2099. snd_soc_write(codec, WM8996_INTERRUPT_STATUS_2, irq_val);
  2100. if (irq_val & (WM8996_DCS_DONE_01_EINT | WM8996_DCS_DONE_23_EINT)) {
  2101. dev_dbg(codec->dev, "DC servo IRQ\n");
  2102. complete(&wm8996->dcs_done);
  2103. }
  2104. if (irq_val & WM8996_FIFOS_ERR_EINT)
  2105. dev_err(codec->dev, "Digital core FIFO error\n");
  2106. if (irq_val & WM8996_FLL_LOCK_EINT) {
  2107. dev_dbg(codec->dev, "FLL locked\n");
  2108. complete(&wm8996->fll_lock);
  2109. }
  2110. if (irq_val & WM8996_MICD_EINT)
  2111. wm8996_micd(codec);
  2112. return IRQ_HANDLED;
  2113. }
  2114. static irqreturn_t wm8996_edge_irq(int irq, void *data)
  2115. {
  2116. irqreturn_t ret = IRQ_NONE;
  2117. irqreturn_t val;
  2118. do {
  2119. val = wm8996_irq(irq, data);
  2120. if (val != IRQ_NONE)
  2121. ret = val;
  2122. } while (val != IRQ_NONE);
  2123. return ret;
  2124. }
  2125. static void wm8996_retune_mobile_pdata(struct snd_soc_codec *codec)
  2126. {
  2127. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  2128. struct wm8996_pdata *pdata = &wm8996->pdata;
  2129. struct snd_kcontrol_new controls[] = {
  2130. SOC_ENUM_EXT("DSP1 EQ Mode",
  2131. wm8996->retune_mobile_enum,
  2132. wm8996_get_retune_mobile_enum,
  2133. wm8996_put_retune_mobile_enum),
  2134. SOC_ENUM_EXT("DSP2 EQ Mode",
  2135. wm8996->retune_mobile_enum,
  2136. wm8996_get_retune_mobile_enum,
  2137. wm8996_put_retune_mobile_enum),
  2138. };
  2139. int ret, i, j;
  2140. const char **t;
  2141. /* We need an array of texts for the enum API but the number
  2142. * of texts is likely to be less than the number of
  2143. * configurations due to the sample rate dependency of the
  2144. * configurations. */
  2145. wm8996->num_retune_mobile_texts = 0;
  2146. wm8996->retune_mobile_texts = NULL;
  2147. for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
  2148. for (j = 0; j < wm8996->num_retune_mobile_texts; j++) {
  2149. if (strcmp(pdata->retune_mobile_cfgs[i].name,
  2150. wm8996->retune_mobile_texts[j]) == 0)
  2151. break;
  2152. }
  2153. if (j != wm8996->num_retune_mobile_texts)
  2154. continue;
  2155. /* Expand the array... */
  2156. t = krealloc(wm8996->retune_mobile_texts,
  2157. sizeof(char *) *
  2158. (wm8996->num_retune_mobile_texts + 1),
  2159. GFP_KERNEL);
  2160. if (t == NULL)
  2161. continue;
  2162. /* ...store the new entry... */
  2163. t[wm8996->num_retune_mobile_texts] =
  2164. pdata->retune_mobile_cfgs[i].name;
  2165. /* ...and remember the new version. */
  2166. wm8996->num_retune_mobile_texts++;
  2167. wm8996->retune_mobile_texts = t;
  2168. }
  2169. dev_dbg(codec->dev, "Allocated %d unique ReTune Mobile names\n",
  2170. wm8996->num_retune_mobile_texts);
  2171. wm8996->retune_mobile_enum.max = wm8996->num_retune_mobile_texts;
  2172. wm8996->retune_mobile_enum.texts = wm8996->retune_mobile_texts;
  2173. ret = snd_soc_add_controls(codec, controls, ARRAY_SIZE(controls));
  2174. if (ret != 0)
  2175. dev_err(codec->dev,
  2176. "Failed to add ReTune Mobile controls: %d\n", ret);
  2177. }
  2178. static int wm8996_probe(struct snd_soc_codec *codec)
  2179. {
  2180. int ret;
  2181. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  2182. struct i2c_client *i2c = to_i2c_client(codec->dev);
  2183. struct snd_soc_dapm_context *dapm = &codec->dapm;
  2184. int i, irq_flags;
  2185. wm8996->codec = codec;
  2186. init_completion(&wm8996->dcs_done);
  2187. init_completion(&wm8996->fll_lock);
  2188. dapm->idle_bias_off = true;
  2189. dapm->bias_level = SND_SOC_BIAS_OFF;
  2190. ret = snd_soc_codec_set_cache_io(codec, 16, 16, SND_SOC_I2C);
  2191. if (ret != 0) {
  2192. dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
  2193. goto err;
  2194. }
  2195. for (i = 0; i < ARRAY_SIZE(wm8996->supplies); i++)
  2196. wm8996->supplies[i].supply = wm8996_supply_names[i];
  2197. ret = regulator_bulk_get(codec->dev, ARRAY_SIZE(wm8996->supplies),
  2198. wm8996->supplies);
  2199. if (ret != 0) {
  2200. dev_err(codec->dev, "Failed to request supplies: %d\n", ret);
  2201. goto err;
  2202. }
  2203. wm8996->disable_nb[0].notifier_call = wm8996_regulator_event_0;
  2204. wm8996->disable_nb[1].notifier_call = wm8996_regulator_event_1;
  2205. wm8996->disable_nb[2].notifier_call = wm8996_regulator_event_2;
  2206. wm8996->disable_nb[3].notifier_call = wm8996_regulator_event_3;
  2207. /* This should really be moved into the regulator core */
  2208. for (i = 0; i < ARRAY_SIZE(wm8996->supplies); i++) {
  2209. ret = regulator_register_notifier(wm8996->supplies[i].consumer,
  2210. &wm8996->disable_nb[i]);
  2211. if (ret != 0) {
  2212. dev_err(codec->dev,
  2213. "Failed to register regulator notifier: %d\n",
  2214. ret);
  2215. }
  2216. }
  2217. ret = regulator_bulk_enable(ARRAY_SIZE(wm8996->supplies),
  2218. wm8996->supplies);
  2219. if (ret != 0) {
  2220. dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
  2221. goto err_get;
  2222. }
  2223. if (wm8996->pdata.ldo_ena >= 0) {
  2224. gpio_set_value_cansleep(wm8996->pdata.ldo_ena, 1);
  2225. msleep(5);
  2226. }
  2227. ret = snd_soc_read(codec, WM8996_SOFTWARE_RESET);
  2228. if (ret < 0) {
  2229. dev_err(codec->dev, "Failed to read ID register: %d\n", ret);
  2230. goto err_enable;
  2231. }
  2232. if (ret != 0x8915) {
  2233. dev_err(codec->dev, "Device is not a WM8996, ID %x\n", ret);
  2234. ret = -EINVAL;
  2235. goto err_enable;
  2236. }
  2237. ret = snd_soc_read(codec, WM8996_CHIP_REVISION);
  2238. if (ret < 0) {
  2239. dev_err(codec->dev, "Failed to read device revision: %d\n",
  2240. ret);
  2241. goto err_enable;
  2242. }
  2243. dev_info(codec->dev, "revision %c\n",
  2244. (ret & WM8996_CHIP_REV_MASK) + 'A');
  2245. if (wm8996->pdata.ldo_ena >= 0) {
  2246. gpio_set_value_cansleep(wm8996->pdata.ldo_ena, 0);
  2247. } else {
  2248. ret = wm8996_reset(codec);
  2249. if (ret < 0) {
  2250. dev_err(codec->dev, "Failed to issue reset\n");
  2251. goto err_enable;
  2252. }
  2253. }
  2254. codec->cache_only = true;
  2255. /* Apply platform data settings */
  2256. snd_soc_update_bits(codec, WM8996_LINE_INPUT_CONTROL,
  2257. WM8996_INL_MODE_MASK | WM8996_INR_MODE_MASK,
  2258. wm8996->pdata.inl_mode << WM8996_INL_MODE_SHIFT |
  2259. wm8996->pdata.inr_mode);
  2260. for (i = 0; i < ARRAY_SIZE(wm8996->pdata.gpio_default); i++) {
  2261. if (!wm8996->pdata.gpio_default[i])
  2262. continue;
  2263. snd_soc_write(codec, WM8996_GPIO_1 + i,
  2264. wm8996->pdata.gpio_default[i] & 0xffff);
  2265. }
  2266. if (wm8996->pdata.spkmute_seq)
  2267. snd_soc_update_bits(codec, WM8996_PDM_SPEAKER_MUTE_SEQUENCE,
  2268. WM8996_SPK_MUTE_ENDIAN |
  2269. WM8996_SPK_MUTE_SEQ1_MASK,
  2270. wm8996->pdata.spkmute_seq);
  2271. snd_soc_update_bits(codec, WM8996_ACCESSORY_DETECT_MODE_2,
  2272. WM8996_MICD_BIAS_SRC | WM8996_HPOUT1FB_SRC |
  2273. WM8996_MICD_SRC, wm8996->pdata.micdet_def);
  2274. /* Latch volume update bits */
  2275. snd_soc_update_bits(codec, WM8996_LEFT_LINE_INPUT_VOLUME,
  2276. WM8996_IN1_VU, WM8996_IN1_VU);
  2277. snd_soc_update_bits(codec, WM8996_RIGHT_LINE_INPUT_VOLUME,
  2278. WM8996_IN1_VU, WM8996_IN1_VU);
  2279. snd_soc_update_bits(codec, WM8996_DAC1_LEFT_VOLUME,
  2280. WM8996_DAC1_VU, WM8996_DAC1_VU);
  2281. snd_soc_update_bits(codec, WM8996_DAC1_RIGHT_VOLUME,
  2282. WM8996_DAC1_VU, WM8996_DAC1_VU);
  2283. snd_soc_update_bits(codec, WM8996_DAC2_LEFT_VOLUME,
  2284. WM8996_DAC2_VU, WM8996_DAC2_VU);
  2285. snd_soc_update_bits(codec, WM8996_DAC2_RIGHT_VOLUME,
  2286. WM8996_DAC2_VU, WM8996_DAC2_VU);
  2287. snd_soc_update_bits(codec, WM8996_OUTPUT1_LEFT_VOLUME,
  2288. WM8996_DAC1_VU, WM8996_DAC1_VU);
  2289. snd_soc_update_bits(codec, WM8996_OUTPUT1_RIGHT_VOLUME,
  2290. WM8996_DAC1_VU, WM8996_DAC1_VU);
  2291. snd_soc_update_bits(codec, WM8996_OUTPUT2_LEFT_VOLUME,
  2292. WM8996_DAC2_VU, WM8996_DAC2_VU);
  2293. snd_soc_update_bits(codec, WM8996_OUTPUT2_RIGHT_VOLUME,
  2294. WM8996_DAC2_VU, WM8996_DAC2_VU);
  2295. snd_soc_update_bits(codec, WM8996_DSP1_TX_LEFT_VOLUME,
  2296. WM8996_DSP1TX_VU, WM8996_DSP1TX_VU);
  2297. snd_soc_update_bits(codec, WM8996_DSP1_TX_RIGHT_VOLUME,
  2298. WM8996_DSP1TX_VU, WM8996_DSP1TX_VU);
  2299. snd_soc_update_bits(codec, WM8996_DSP2_TX_LEFT_VOLUME,
  2300. WM8996_DSP2TX_VU, WM8996_DSP2TX_VU);
  2301. snd_soc_update_bits(codec, WM8996_DSP2_TX_RIGHT_VOLUME,
  2302. WM8996_DSP2TX_VU, WM8996_DSP2TX_VU);
  2303. snd_soc_update_bits(codec, WM8996_DSP1_RX_LEFT_VOLUME,
  2304. WM8996_DSP1RX_VU, WM8996_DSP1RX_VU);
  2305. snd_soc_update_bits(codec, WM8996_DSP1_RX_RIGHT_VOLUME,
  2306. WM8996_DSP1RX_VU, WM8996_DSP1RX_VU);
  2307. snd_soc_update_bits(codec, WM8996_DSP2_RX_LEFT_VOLUME,
  2308. WM8996_DSP2RX_VU, WM8996_DSP2RX_VU);
  2309. snd_soc_update_bits(codec, WM8996_DSP2_RX_RIGHT_VOLUME,
  2310. WM8996_DSP2RX_VU, WM8996_DSP2RX_VU);
  2311. /* No support currently for the underclocked TDM modes and
  2312. * pick a default TDM layout with each channel pair working with
  2313. * slots 0 and 1. */
  2314. snd_soc_update_bits(codec, WM8996_AIF1RX_CHANNEL_0_CONFIGURATION,
  2315. WM8996_AIF1RX_CHAN0_SLOTS_MASK |
  2316. WM8996_AIF1RX_CHAN0_START_SLOT_MASK,
  2317. 1 << WM8996_AIF1RX_CHAN0_SLOTS_SHIFT | 0);
  2318. snd_soc_update_bits(codec, WM8996_AIF1RX_CHANNEL_1_CONFIGURATION,
  2319. WM8996_AIF1RX_CHAN1_SLOTS_MASK |
  2320. WM8996_AIF1RX_CHAN1_START_SLOT_MASK,
  2321. 1 << WM8996_AIF1RX_CHAN1_SLOTS_SHIFT | 1);
  2322. snd_soc_update_bits(codec, WM8996_AIF1RX_CHANNEL_2_CONFIGURATION,
  2323. WM8996_AIF1RX_CHAN2_SLOTS_MASK |
  2324. WM8996_AIF1RX_CHAN2_START_SLOT_MASK,
  2325. 1 << WM8996_AIF1RX_CHAN2_SLOTS_SHIFT | 0);
  2326. snd_soc_update_bits(codec, WM8996_AIF1RX_CHANNEL_3_CONFIGURATION,
  2327. WM8996_AIF1RX_CHAN3_SLOTS_MASK |
  2328. WM8996_AIF1RX_CHAN0_START_SLOT_MASK,
  2329. 1 << WM8996_AIF1RX_CHAN3_SLOTS_SHIFT | 1);
  2330. snd_soc_update_bits(codec, WM8996_AIF1RX_CHANNEL_4_CONFIGURATION,
  2331. WM8996_AIF1RX_CHAN4_SLOTS_MASK |
  2332. WM8996_AIF1RX_CHAN0_START_SLOT_MASK,
  2333. 1 << WM8996_AIF1RX_CHAN4_SLOTS_SHIFT | 0);
  2334. snd_soc_update_bits(codec, WM8996_AIF1RX_CHANNEL_5_CONFIGURATION,
  2335. WM8996_AIF1RX_CHAN5_SLOTS_MASK |
  2336. WM8996_AIF1RX_CHAN0_START_SLOT_MASK,
  2337. 1 << WM8996_AIF1RX_CHAN5_SLOTS_SHIFT | 1);
  2338. snd_soc_update_bits(codec, WM8996_AIF2RX_CHANNEL_0_CONFIGURATION,
  2339. WM8996_AIF2RX_CHAN0_SLOTS_MASK |
  2340. WM8996_AIF2RX_CHAN0_START_SLOT_MASK,
  2341. 1 << WM8996_AIF2RX_CHAN0_SLOTS_SHIFT | 0);
  2342. snd_soc_update_bits(codec, WM8996_AIF2RX_CHANNEL_1_CONFIGURATION,
  2343. WM8996_AIF2RX_CHAN1_SLOTS_MASK |
  2344. WM8996_AIF2RX_CHAN1_START_SLOT_MASK,
  2345. 1 << WM8996_AIF2RX_CHAN1_SLOTS_SHIFT | 1);
  2346. snd_soc_update_bits(codec, WM8996_AIF1TX_CHANNEL_0_CONFIGURATION,
  2347. WM8996_AIF1TX_CHAN0_SLOTS_MASK |
  2348. WM8996_AIF1TX_CHAN0_START_SLOT_MASK,
  2349. 1 << WM8996_AIF1TX_CHAN0_SLOTS_SHIFT | 0);
  2350. snd_soc_update_bits(codec, WM8996_AIF1TX_CHANNEL_1_CONFIGURATION,
  2351. WM8996_AIF1TX_CHAN1_SLOTS_MASK |
  2352. WM8996_AIF1TX_CHAN0_START_SLOT_MASK,
  2353. 1 << WM8996_AIF1TX_CHAN1_SLOTS_SHIFT | 1);
  2354. snd_soc_update_bits(codec, WM8996_AIF1TX_CHANNEL_2_CONFIGURATION,
  2355. WM8996_AIF1TX_CHAN2_SLOTS_MASK |
  2356. WM8996_AIF1TX_CHAN0_START_SLOT_MASK,
  2357. 1 << WM8996_AIF1TX_CHAN2_SLOTS_SHIFT | 0);
  2358. snd_soc_update_bits(codec, WM8996_AIF1TX_CHANNEL_3_CONFIGURATION,
  2359. WM8996_AIF1TX_CHAN3_SLOTS_MASK |
  2360. WM8996_AIF1TX_CHAN0_START_SLOT_MASK,
  2361. 1 << WM8996_AIF1TX_CHAN3_SLOTS_SHIFT | 1);
  2362. snd_soc_update_bits(codec, WM8996_AIF1TX_CHANNEL_4_CONFIGURATION,
  2363. WM8996_AIF1TX_CHAN4_SLOTS_MASK |
  2364. WM8996_AIF1TX_CHAN0_START_SLOT_MASK,
  2365. 1 << WM8996_AIF1TX_CHAN4_SLOTS_SHIFT | 0);
  2366. snd_soc_update_bits(codec, WM8996_AIF1TX_CHANNEL_5_CONFIGURATION,
  2367. WM8996_AIF1TX_CHAN5_SLOTS_MASK |
  2368. WM8996_AIF1TX_CHAN0_START_SLOT_MASK,
  2369. 1 << WM8996_AIF1TX_CHAN5_SLOTS_SHIFT | 1);
  2370. snd_soc_update_bits(codec, WM8996_AIF2TX_CHANNEL_0_CONFIGURATION,
  2371. WM8996_AIF2TX_CHAN0_SLOTS_MASK |
  2372. WM8996_AIF2TX_CHAN0_START_SLOT_MASK,
  2373. 1 << WM8996_AIF2TX_CHAN0_SLOTS_SHIFT | 0);
  2374. snd_soc_update_bits(codec, WM8996_AIF1TX_CHANNEL_1_CONFIGURATION,
  2375. WM8996_AIF2TX_CHAN1_SLOTS_MASK |
  2376. WM8996_AIF2TX_CHAN1_START_SLOT_MASK,
  2377. 1 << WM8996_AIF1TX_CHAN1_SLOTS_SHIFT | 1);
  2378. if (wm8996->pdata.num_retune_mobile_cfgs)
  2379. wm8996_retune_mobile_pdata(codec);
  2380. else
  2381. snd_soc_add_controls(codec, wm8996_eq_controls,
  2382. ARRAY_SIZE(wm8996_eq_controls));
  2383. /* If the TX LRCLK pins are not in LRCLK mode configure the
  2384. * AIFs to source their clocks from the RX LRCLKs.
  2385. */
  2386. if ((snd_soc_read(codec, WM8996_GPIO_1)))
  2387. snd_soc_update_bits(codec, WM8996_AIF1_TX_LRCLK_2,
  2388. WM8996_AIF1TX_LRCLK_MODE,
  2389. WM8996_AIF1TX_LRCLK_MODE);
  2390. if ((snd_soc_read(codec, WM8996_GPIO_2)))
  2391. snd_soc_update_bits(codec, WM8996_AIF2_TX_LRCLK_2,
  2392. WM8996_AIF2TX_LRCLK_MODE,
  2393. WM8996_AIF2TX_LRCLK_MODE);
  2394. regulator_bulk_disable(ARRAY_SIZE(wm8996->supplies), wm8996->supplies);
  2395. wm8996_init_gpio(codec);
  2396. if (i2c->irq) {
  2397. if (wm8996->pdata.irq_flags)
  2398. irq_flags = wm8996->pdata.irq_flags;
  2399. else
  2400. irq_flags = IRQF_TRIGGER_LOW;
  2401. irq_flags |= IRQF_ONESHOT;
  2402. if (irq_flags & (IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING))
  2403. ret = request_threaded_irq(i2c->irq, NULL,
  2404. wm8996_edge_irq,
  2405. irq_flags, "wm8996", codec);
  2406. else
  2407. ret = request_threaded_irq(i2c->irq, NULL, wm8996_irq,
  2408. irq_flags, "wm8996", codec);
  2409. if (ret == 0) {
  2410. /* Unmask the interrupt */
  2411. snd_soc_update_bits(codec, WM8996_INTERRUPT_CONTROL,
  2412. WM8996_IM_IRQ, 0);
  2413. /* Enable error reporting and DC servo status */
  2414. snd_soc_update_bits(codec,
  2415. WM8996_INTERRUPT_STATUS_2_MASK,
  2416. WM8996_IM_DCS_DONE_23_EINT |
  2417. WM8996_IM_DCS_DONE_01_EINT |
  2418. WM8996_IM_FLL_LOCK_EINT |
  2419. WM8996_IM_FIFOS_ERR_EINT,
  2420. 0);
  2421. } else {
  2422. dev_err(codec->dev, "Failed to request IRQ: %d\n",
  2423. ret);
  2424. }
  2425. }
  2426. return 0;
  2427. err_enable:
  2428. if (wm8996->pdata.ldo_ena >= 0)
  2429. gpio_set_value_cansleep(wm8996->pdata.ldo_ena, 0);
  2430. regulator_bulk_disable(ARRAY_SIZE(wm8996->supplies), wm8996->supplies);
  2431. err_get:
  2432. regulator_bulk_free(ARRAY_SIZE(wm8996->supplies), wm8996->supplies);
  2433. err:
  2434. return ret;
  2435. }
  2436. static int wm8996_remove(struct snd_soc_codec *codec)
  2437. {
  2438. struct wm8996_priv *wm8996 = snd_soc_codec_get_drvdata(codec);
  2439. struct i2c_client *i2c = to_i2c_client(codec->dev);
  2440. int i;
  2441. snd_soc_update_bits(codec, WM8996_INTERRUPT_CONTROL,
  2442. WM8996_IM_IRQ, WM8996_IM_IRQ);
  2443. if (i2c->irq)
  2444. free_irq(i2c->irq, codec);
  2445. wm8996_free_gpio(codec);
  2446. for (i = 0; i < ARRAY_SIZE(wm8996->supplies); i++)
  2447. regulator_unregister_notifier(wm8996->supplies[i].consumer,
  2448. &wm8996->disable_nb[i]);
  2449. regulator_bulk_free(ARRAY_SIZE(wm8996->supplies), wm8996->supplies);
  2450. return 0;
  2451. }
  2452. static struct snd_soc_codec_driver soc_codec_dev_wm8996 = {
  2453. .probe = wm8996_probe,
  2454. .remove = wm8996_remove,
  2455. .set_bias_level = wm8996_set_bias_level,
  2456. .seq_notifier = wm8996_seq_notifier,
  2457. .reg_cache_size = WM8996_MAX_REGISTER + 1,
  2458. .reg_word_size = sizeof(u16),
  2459. .reg_cache_default = wm8996_reg,
  2460. .volatile_register = wm8996_volatile_register,
  2461. .readable_register = wm8996_readable_register,
  2462. .compress_type = SND_SOC_RBTREE_COMPRESSION,
  2463. .controls = wm8996_snd_controls,
  2464. .num_controls = ARRAY_SIZE(wm8996_snd_controls),
  2465. .dapm_widgets = wm8996_dapm_widgets,
  2466. .num_dapm_widgets = ARRAY_SIZE(wm8996_dapm_widgets),
  2467. .dapm_routes = wm8996_dapm_routes,
  2468. .num_dapm_routes = ARRAY_SIZE(wm8996_dapm_routes),
  2469. .set_pll = wm8996_set_fll,
  2470. };
  2471. #define WM8996_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
  2472. SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000)
  2473. #define WM8996_FORMATS (SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE |\
  2474. SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S24_LE |\
  2475. SNDRV_PCM_FMTBIT_S32_LE)
  2476. static struct snd_soc_dai_ops wm8996_dai_ops = {
  2477. .set_fmt = wm8996_set_fmt,
  2478. .hw_params = wm8996_hw_params,
  2479. .set_sysclk = wm8996_set_sysclk,
  2480. };
  2481. static struct snd_soc_dai_driver wm8996_dai[] = {
  2482. {
  2483. .name = "wm8996-aif1",
  2484. .playback = {
  2485. .stream_name = "AIF1 Playback",
  2486. .channels_min = 1,
  2487. .channels_max = 6,
  2488. .rates = WM8996_RATES,
  2489. .formats = WM8996_FORMATS,
  2490. },
  2491. .capture = {
  2492. .stream_name = "AIF1 Capture",
  2493. .channels_min = 1,
  2494. .channels_max = 6,
  2495. .rates = WM8996_RATES,
  2496. .formats = WM8996_FORMATS,
  2497. },
  2498. .ops = &wm8996_dai_ops,
  2499. },
  2500. {
  2501. .name = "wm8996-aif2",
  2502. .playback = {
  2503. .stream_name = "AIF2 Playback",
  2504. .channels_min = 1,
  2505. .channels_max = 2,
  2506. .rates = WM8996_RATES,
  2507. .formats = WM8996_FORMATS,
  2508. },
  2509. .capture = {
  2510. .stream_name = "AIF2 Capture",
  2511. .channels_min = 1,
  2512. .channels_max = 2,
  2513. .rates = WM8996_RATES,
  2514. .formats = WM8996_FORMATS,
  2515. },
  2516. .ops = &wm8996_dai_ops,
  2517. },
  2518. };
  2519. static __devinit int wm8996_i2c_probe(struct i2c_client *i2c,
  2520. const struct i2c_device_id *id)
  2521. {
  2522. struct wm8996_priv *wm8996;
  2523. int ret;
  2524. wm8996 = kzalloc(sizeof(struct wm8996_priv), GFP_KERNEL);
  2525. if (wm8996 == NULL)
  2526. return -ENOMEM;
  2527. i2c_set_clientdata(i2c, wm8996);
  2528. if (dev_get_platdata(&i2c->dev))
  2529. memcpy(&wm8996->pdata, dev_get_platdata(&i2c->dev),
  2530. sizeof(wm8996->pdata));
  2531. if (wm8996->pdata.ldo_ena > 0) {
  2532. ret = gpio_request_one(wm8996->pdata.ldo_ena,
  2533. GPIOF_OUT_INIT_LOW, "WM8996 ENA");
  2534. if (ret < 0) {
  2535. dev_err(&i2c->dev, "Failed to request GPIO %d: %d\n",
  2536. wm8996->pdata.ldo_ena, ret);
  2537. goto err;
  2538. }
  2539. }
  2540. ret = snd_soc_register_codec(&i2c->dev,
  2541. &soc_codec_dev_wm8996, wm8996_dai,
  2542. ARRAY_SIZE(wm8996_dai));
  2543. if (ret < 0)
  2544. goto err_gpio;
  2545. return ret;
  2546. err_gpio:
  2547. if (wm8996->pdata.ldo_ena > 0)
  2548. gpio_free(wm8996->pdata.ldo_ena);
  2549. err:
  2550. kfree(wm8996);
  2551. return ret;
  2552. }
  2553. static __devexit int wm8996_i2c_remove(struct i2c_client *client)
  2554. {
  2555. struct wm8996_priv *wm8996 = i2c_get_clientdata(client);
  2556. snd_soc_unregister_codec(&client->dev);
  2557. if (wm8996->pdata.ldo_ena > 0)
  2558. gpio_free(wm8996->pdata.ldo_ena);
  2559. kfree(i2c_get_clientdata(client));
  2560. return 0;
  2561. }
  2562. static const struct i2c_device_id wm8996_i2c_id[] = {
  2563. { "wm8996", 0 },
  2564. { }
  2565. };
  2566. MODULE_DEVICE_TABLE(i2c, wm8996_i2c_id);
  2567. static struct i2c_driver wm8996_i2c_driver = {
  2568. .driver = {
  2569. .name = "wm8996",
  2570. .owner = THIS_MODULE,
  2571. },
  2572. .probe = wm8996_i2c_probe,
  2573. .remove = __devexit_p(wm8996_i2c_remove),
  2574. .id_table = wm8996_i2c_id,
  2575. };
  2576. static int __init wm8996_modinit(void)
  2577. {
  2578. int ret;
  2579. ret = i2c_add_driver(&wm8996_i2c_driver);
  2580. if (ret != 0) {
  2581. printk(KERN_ERR "Failed to register WM8996 I2C driver: %d\n",
  2582. ret);
  2583. }
  2584. return ret;
  2585. }
  2586. module_init(wm8996_modinit);
  2587. static void __exit wm8996_exit(void)
  2588. {
  2589. i2c_del_driver(&wm8996_i2c_driver);
  2590. }
  2591. module_exit(wm8996_exit);
  2592. MODULE_DESCRIPTION("ASoC WM8996 driver");
  2593. MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
  2594. MODULE_LICENSE("GPL");