max98095.c 63 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397
  1. /*
  2. * max98095.c -- MAX98095 ALSA SoC Audio driver
  3. *
  4. * Copyright 2011 Maxim Integrated Products
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. */
  10. #include <linux/module.h>
  11. #include <linux/moduleparam.h>
  12. #include <linux/kernel.h>
  13. #include <linux/init.h>
  14. #include <linux/delay.h>
  15. #include <linux/pm.h>
  16. #include <linux/i2c.h>
  17. #include <linux/platform_device.h>
  18. #include <sound/core.h>
  19. #include <sound/pcm.h>
  20. #include <sound/pcm_params.h>
  21. #include <sound/soc.h>
  22. #include <sound/initval.h>
  23. #include <sound/tlv.h>
  24. #include <linux/slab.h>
  25. #include <asm/div64.h>
  26. #include <sound/max98095.h>
  27. #include "max98095.h"
  28. enum max98095_type {
  29. MAX98095,
  30. };
  31. struct max98095_cdata {
  32. unsigned int rate;
  33. unsigned int fmt;
  34. int eq_sel;
  35. int bq_sel;
  36. };
  37. struct max98095_priv {
  38. enum max98095_type devtype;
  39. void *control_data;
  40. struct max98095_pdata *pdata;
  41. unsigned int sysclk;
  42. struct max98095_cdata dai[3];
  43. const char **eq_texts;
  44. const char **bq_texts;
  45. struct soc_enum eq_enum;
  46. struct soc_enum bq_enum;
  47. int eq_textcnt;
  48. int bq_textcnt;
  49. u8 lin_state;
  50. unsigned int mic1pre;
  51. unsigned int mic2pre;
  52. };
  53. static const u8 max98095_reg_def[M98095_REG_CNT] = {
  54. 0x00, /* 00 */
  55. 0x00, /* 01 */
  56. 0x00, /* 02 */
  57. 0x00, /* 03 */
  58. 0x00, /* 04 */
  59. 0x00, /* 05 */
  60. 0x00, /* 06 */
  61. 0x00, /* 07 */
  62. 0x00, /* 08 */
  63. 0x00, /* 09 */
  64. 0x00, /* 0A */
  65. 0x00, /* 0B */
  66. 0x00, /* 0C */
  67. 0x00, /* 0D */
  68. 0x00, /* 0E */
  69. 0x00, /* 0F */
  70. 0x00, /* 10 */
  71. 0x00, /* 11 */
  72. 0x00, /* 12 */
  73. 0x00, /* 13 */
  74. 0x00, /* 14 */
  75. 0x00, /* 15 */
  76. 0x00, /* 16 */
  77. 0x00, /* 17 */
  78. 0x00, /* 18 */
  79. 0x00, /* 19 */
  80. 0x00, /* 1A */
  81. 0x00, /* 1B */
  82. 0x00, /* 1C */
  83. 0x00, /* 1D */
  84. 0x00, /* 1E */
  85. 0x00, /* 1F */
  86. 0x00, /* 20 */
  87. 0x00, /* 21 */
  88. 0x00, /* 22 */
  89. 0x00, /* 23 */
  90. 0x00, /* 24 */
  91. 0x00, /* 25 */
  92. 0x00, /* 26 */
  93. 0x00, /* 27 */
  94. 0x00, /* 28 */
  95. 0x00, /* 29 */
  96. 0x00, /* 2A */
  97. 0x00, /* 2B */
  98. 0x00, /* 2C */
  99. 0x00, /* 2D */
  100. 0x00, /* 2E */
  101. 0x00, /* 2F */
  102. 0x00, /* 30 */
  103. 0x00, /* 31 */
  104. 0x00, /* 32 */
  105. 0x00, /* 33 */
  106. 0x00, /* 34 */
  107. 0x00, /* 35 */
  108. 0x00, /* 36 */
  109. 0x00, /* 37 */
  110. 0x00, /* 38 */
  111. 0x00, /* 39 */
  112. 0x00, /* 3A */
  113. 0x00, /* 3B */
  114. 0x00, /* 3C */
  115. 0x00, /* 3D */
  116. 0x00, /* 3E */
  117. 0x00, /* 3F */
  118. 0x00, /* 40 */
  119. 0x00, /* 41 */
  120. 0x00, /* 42 */
  121. 0x00, /* 43 */
  122. 0x00, /* 44 */
  123. 0x00, /* 45 */
  124. 0x00, /* 46 */
  125. 0x00, /* 47 */
  126. 0x00, /* 48 */
  127. 0x00, /* 49 */
  128. 0x00, /* 4A */
  129. 0x00, /* 4B */
  130. 0x00, /* 4C */
  131. 0x00, /* 4D */
  132. 0x00, /* 4E */
  133. 0x00, /* 4F */
  134. 0x00, /* 50 */
  135. 0x00, /* 51 */
  136. 0x00, /* 52 */
  137. 0x00, /* 53 */
  138. 0x00, /* 54 */
  139. 0x00, /* 55 */
  140. 0x00, /* 56 */
  141. 0x00, /* 57 */
  142. 0x00, /* 58 */
  143. 0x00, /* 59 */
  144. 0x00, /* 5A */
  145. 0x00, /* 5B */
  146. 0x00, /* 5C */
  147. 0x00, /* 5D */
  148. 0x00, /* 5E */
  149. 0x00, /* 5F */
  150. 0x00, /* 60 */
  151. 0x00, /* 61 */
  152. 0x00, /* 62 */
  153. 0x00, /* 63 */
  154. 0x00, /* 64 */
  155. 0x00, /* 65 */
  156. 0x00, /* 66 */
  157. 0x00, /* 67 */
  158. 0x00, /* 68 */
  159. 0x00, /* 69 */
  160. 0x00, /* 6A */
  161. 0x00, /* 6B */
  162. 0x00, /* 6C */
  163. 0x00, /* 6D */
  164. 0x00, /* 6E */
  165. 0x00, /* 6F */
  166. 0x00, /* 70 */
  167. 0x00, /* 71 */
  168. 0x00, /* 72 */
  169. 0x00, /* 73 */
  170. 0x00, /* 74 */
  171. 0x00, /* 75 */
  172. 0x00, /* 76 */
  173. 0x00, /* 77 */
  174. 0x00, /* 78 */
  175. 0x00, /* 79 */
  176. 0x00, /* 7A */
  177. 0x00, /* 7B */
  178. 0x00, /* 7C */
  179. 0x00, /* 7D */
  180. 0x00, /* 7E */
  181. 0x00, /* 7F */
  182. 0x00, /* 80 */
  183. 0x00, /* 81 */
  184. 0x00, /* 82 */
  185. 0x00, /* 83 */
  186. 0x00, /* 84 */
  187. 0x00, /* 85 */
  188. 0x00, /* 86 */
  189. 0x00, /* 87 */
  190. 0x00, /* 88 */
  191. 0x00, /* 89 */
  192. 0x00, /* 8A */
  193. 0x00, /* 8B */
  194. 0x00, /* 8C */
  195. 0x00, /* 8D */
  196. 0x00, /* 8E */
  197. 0x00, /* 8F */
  198. 0x00, /* 90 */
  199. 0x00, /* 91 */
  200. 0x30, /* 92 */
  201. 0xF0, /* 93 */
  202. 0x00, /* 94 */
  203. 0x00, /* 95 */
  204. 0x3F, /* 96 */
  205. 0x00, /* 97 */
  206. 0x00, /* 98 */
  207. 0x00, /* 99 */
  208. 0x00, /* 9A */
  209. 0x00, /* 9B */
  210. 0x00, /* 9C */
  211. 0x00, /* 9D */
  212. 0x00, /* 9E */
  213. 0x00, /* 9F */
  214. 0x00, /* A0 */
  215. 0x00, /* A1 */
  216. 0x00, /* A2 */
  217. 0x00, /* A3 */
  218. 0x00, /* A4 */
  219. 0x00, /* A5 */
  220. 0x00, /* A6 */
  221. 0x00, /* A7 */
  222. 0x00, /* A8 */
  223. 0x00, /* A9 */
  224. 0x00, /* AA */
  225. 0x00, /* AB */
  226. 0x00, /* AC */
  227. 0x00, /* AD */
  228. 0x00, /* AE */
  229. 0x00, /* AF */
  230. 0x00, /* B0 */
  231. 0x00, /* B1 */
  232. 0x00, /* B2 */
  233. 0x00, /* B3 */
  234. 0x00, /* B4 */
  235. 0x00, /* B5 */
  236. 0x00, /* B6 */
  237. 0x00, /* B7 */
  238. 0x00, /* B8 */
  239. 0x00, /* B9 */
  240. 0x00, /* BA */
  241. 0x00, /* BB */
  242. 0x00, /* BC */
  243. 0x00, /* BD */
  244. 0x00, /* BE */
  245. 0x00, /* BF */
  246. 0x00, /* C0 */
  247. 0x00, /* C1 */
  248. 0x00, /* C2 */
  249. 0x00, /* C3 */
  250. 0x00, /* C4 */
  251. 0x00, /* C5 */
  252. 0x00, /* C6 */
  253. 0x00, /* C7 */
  254. 0x00, /* C8 */
  255. 0x00, /* C9 */
  256. 0x00, /* CA */
  257. 0x00, /* CB */
  258. 0x00, /* CC */
  259. 0x00, /* CD */
  260. 0x00, /* CE */
  261. 0x00, /* CF */
  262. 0x00, /* D0 */
  263. 0x00, /* D1 */
  264. 0x00, /* D2 */
  265. 0x00, /* D3 */
  266. 0x00, /* D4 */
  267. 0x00, /* D5 */
  268. 0x00, /* D6 */
  269. 0x00, /* D7 */
  270. 0x00, /* D8 */
  271. 0x00, /* D9 */
  272. 0x00, /* DA */
  273. 0x00, /* DB */
  274. 0x00, /* DC */
  275. 0x00, /* DD */
  276. 0x00, /* DE */
  277. 0x00, /* DF */
  278. 0x00, /* E0 */
  279. 0x00, /* E1 */
  280. 0x00, /* E2 */
  281. 0x00, /* E3 */
  282. 0x00, /* E4 */
  283. 0x00, /* E5 */
  284. 0x00, /* E6 */
  285. 0x00, /* E7 */
  286. 0x00, /* E8 */
  287. 0x00, /* E9 */
  288. 0x00, /* EA */
  289. 0x00, /* EB */
  290. 0x00, /* EC */
  291. 0x00, /* ED */
  292. 0x00, /* EE */
  293. 0x00, /* EF */
  294. 0x00, /* F0 */
  295. 0x00, /* F1 */
  296. 0x00, /* F2 */
  297. 0x00, /* F3 */
  298. 0x00, /* F4 */
  299. 0x00, /* F5 */
  300. 0x00, /* F6 */
  301. 0x00, /* F7 */
  302. 0x00, /* F8 */
  303. 0x00, /* F9 */
  304. 0x00, /* FA */
  305. 0x00, /* FB */
  306. 0x00, /* FC */
  307. 0x00, /* FD */
  308. 0x00, /* FE */
  309. 0x00, /* FF */
  310. };
  311. static struct {
  312. int readable;
  313. int writable;
  314. } max98095_access[M98095_REG_CNT] = {
  315. { 0x00, 0x00 }, /* 00 */
  316. { 0xFF, 0x00 }, /* 01 */
  317. { 0xFF, 0x00 }, /* 02 */
  318. { 0xFF, 0x00 }, /* 03 */
  319. { 0xFF, 0x00 }, /* 04 */
  320. { 0xFF, 0x00 }, /* 05 */
  321. { 0xFF, 0x00 }, /* 06 */
  322. { 0xFF, 0x00 }, /* 07 */
  323. { 0xFF, 0x00 }, /* 08 */
  324. { 0xFF, 0x00 }, /* 09 */
  325. { 0xFF, 0x00 }, /* 0A */
  326. { 0xFF, 0x00 }, /* 0B */
  327. { 0xFF, 0x00 }, /* 0C */
  328. { 0xFF, 0x00 }, /* 0D */
  329. { 0xFF, 0x00 }, /* 0E */
  330. { 0xFF, 0x9F }, /* 0F */
  331. { 0xFF, 0xFF }, /* 10 */
  332. { 0xFF, 0xFF }, /* 11 */
  333. { 0xFF, 0xFF }, /* 12 */
  334. { 0xFF, 0xFF }, /* 13 */
  335. { 0xFF, 0xFF }, /* 14 */
  336. { 0xFF, 0xFF }, /* 15 */
  337. { 0xFF, 0xFF }, /* 16 */
  338. { 0xFF, 0xFF }, /* 17 */
  339. { 0xFF, 0xFF }, /* 18 */
  340. { 0xFF, 0xFF }, /* 19 */
  341. { 0xFF, 0xFF }, /* 1A */
  342. { 0xFF, 0xFF }, /* 1B */
  343. { 0xFF, 0xFF }, /* 1C */
  344. { 0xFF, 0xFF }, /* 1D */
  345. { 0xFF, 0x77 }, /* 1E */
  346. { 0xFF, 0x77 }, /* 1F */
  347. { 0xFF, 0x77 }, /* 20 */
  348. { 0xFF, 0x77 }, /* 21 */
  349. { 0xFF, 0x77 }, /* 22 */
  350. { 0xFF, 0x77 }, /* 23 */
  351. { 0xFF, 0xFF }, /* 24 */
  352. { 0xFF, 0x7F }, /* 25 */
  353. { 0xFF, 0x31 }, /* 26 */
  354. { 0xFF, 0xFF }, /* 27 */
  355. { 0xFF, 0xFF }, /* 28 */
  356. { 0xFF, 0xFF }, /* 29 */
  357. { 0xFF, 0xF7 }, /* 2A */
  358. { 0xFF, 0x2F }, /* 2B */
  359. { 0xFF, 0xEF }, /* 2C */
  360. { 0xFF, 0xFF }, /* 2D */
  361. { 0xFF, 0xFF }, /* 2E */
  362. { 0xFF, 0xFF }, /* 2F */
  363. { 0xFF, 0xFF }, /* 30 */
  364. { 0xFF, 0xFF }, /* 31 */
  365. { 0xFF, 0xFF }, /* 32 */
  366. { 0xFF, 0xFF }, /* 33 */
  367. { 0xFF, 0xF7 }, /* 34 */
  368. { 0xFF, 0x2F }, /* 35 */
  369. { 0xFF, 0xCF }, /* 36 */
  370. { 0xFF, 0xFF }, /* 37 */
  371. { 0xFF, 0xFF }, /* 38 */
  372. { 0xFF, 0xFF }, /* 39 */
  373. { 0xFF, 0xFF }, /* 3A */
  374. { 0xFF, 0xFF }, /* 3B */
  375. { 0xFF, 0xFF }, /* 3C */
  376. { 0xFF, 0xFF }, /* 3D */
  377. { 0xFF, 0xF7 }, /* 3E */
  378. { 0xFF, 0x2F }, /* 3F */
  379. { 0xFF, 0xCF }, /* 40 */
  380. { 0xFF, 0xFF }, /* 41 */
  381. { 0xFF, 0x77 }, /* 42 */
  382. { 0xFF, 0xFF }, /* 43 */
  383. { 0xFF, 0xFF }, /* 44 */
  384. { 0xFF, 0xFF }, /* 45 */
  385. { 0xFF, 0xFF }, /* 46 */
  386. { 0xFF, 0xFF }, /* 47 */
  387. { 0xFF, 0xFF }, /* 48 */
  388. { 0xFF, 0x0F }, /* 49 */
  389. { 0xFF, 0xFF }, /* 4A */
  390. { 0xFF, 0xFF }, /* 4B */
  391. { 0xFF, 0x3F }, /* 4C */
  392. { 0xFF, 0x3F }, /* 4D */
  393. { 0xFF, 0x3F }, /* 4E */
  394. { 0xFF, 0xFF }, /* 4F */
  395. { 0xFF, 0x7F }, /* 50 */
  396. { 0xFF, 0x7F }, /* 51 */
  397. { 0xFF, 0x0F }, /* 52 */
  398. { 0xFF, 0x3F }, /* 53 */
  399. { 0xFF, 0x3F }, /* 54 */
  400. { 0xFF, 0x3F }, /* 55 */
  401. { 0xFF, 0xFF }, /* 56 */
  402. { 0xFF, 0xFF }, /* 57 */
  403. { 0xFF, 0xBF }, /* 58 */
  404. { 0xFF, 0x1F }, /* 59 */
  405. { 0xFF, 0xBF }, /* 5A */
  406. { 0xFF, 0x1F }, /* 5B */
  407. { 0xFF, 0xBF }, /* 5C */
  408. { 0xFF, 0x3F }, /* 5D */
  409. { 0xFF, 0x3F }, /* 5E */
  410. { 0xFF, 0x7F }, /* 5F */
  411. { 0xFF, 0x7F }, /* 60 */
  412. { 0xFF, 0x47 }, /* 61 */
  413. { 0xFF, 0x9F }, /* 62 */
  414. { 0xFF, 0x9F }, /* 63 */
  415. { 0xFF, 0x9F }, /* 64 */
  416. { 0xFF, 0x9F }, /* 65 */
  417. { 0xFF, 0x9F }, /* 66 */
  418. { 0xFF, 0xBF }, /* 67 */
  419. { 0xFF, 0xBF }, /* 68 */
  420. { 0xFF, 0xFF }, /* 69 */
  421. { 0xFF, 0xFF }, /* 6A */
  422. { 0xFF, 0x7F }, /* 6B */
  423. { 0xFF, 0xF7 }, /* 6C */
  424. { 0xFF, 0xFF }, /* 6D */
  425. { 0xFF, 0xFF }, /* 6E */
  426. { 0xFF, 0x1F }, /* 6F */
  427. { 0xFF, 0xF7 }, /* 70 */
  428. { 0xFF, 0xFF }, /* 71 */
  429. { 0xFF, 0xFF }, /* 72 */
  430. { 0xFF, 0x1F }, /* 73 */
  431. { 0xFF, 0xF7 }, /* 74 */
  432. { 0xFF, 0xFF }, /* 75 */
  433. { 0xFF, 0xFF }, /* 76 */
  434. { 0xFF, 0x1F }, /* 77 */
  435. { 0xFF, 0xF7 }, /* 78 */
  436. { 0xFF, 0xFF }, /* 79 */
  437. { 0xFF, 0xFF }, /* 7A */
  438. { 0xFF, 0x1F }, /* 7B */
  439. { 0xFF, 0xF7 }, /* 7C */
  440. { 0xFF, 0xFF }, /* 7D */
  441. { 0xFF, 0xFF }, /* 7E */
  442. { 0xFF, 0x1F }, /* 7F */
  443. { 0xFF, 0xF7 }, /* 80 */
  444. { 0xFF, 0xFF }, /* 81 */
  445. { 0xFF, 0xFF }, /* 82 */
  446. { 0xFF, 0x1F }, /* 83 */
  447. { 0xFF, 0x7F }, /* 84 */
  448. { 0xFF, 0x0F }, /* 85 */
  449. { 0xFF, 0xD8 }, /* 86 */
  450. { 0xFF, 0xFF }, /* 87 */
  451. { 0xFF, 0xEF }, /* 88 */
  452. { 0xFF, 0xFE }, /* 89 */
  453. { 0xFF, 0xFE }, /* 8A */
  454. { 0xFF, 0xFF }, /* 8B */
  455. { 0xFF, 0xFF }, /* 8C */
  456. { 0xFF, 0x3F }, /* 8D */
  457. { 0xFF, 0xFF }, /* 8E */
  458. { 0xFF, 0x3F }, /* 8F */
  459. { 0xFF, 0x8F }, /* 90 */
  460. { 0xFF, 0xFF }, /* 91 */
  461. { 0xFF, 0x3F }, /* 92 */
  462. { 0xFF, 0xFF }, /* 93 */
  463. { 0xFF, 0xFF }, /* 94 */
  464. { 0xFF, 0x0F }, /* 95 */
  465. { 0xFF, 0x3F }, /* 96 */
  466. { 0xFF, 0x8C }, /* 97 */
  467. { 0x00, 0x00 }, /* 98 */
  468. { 0x00, 0x00 }, /* 99 */
  469. { 0x00, 0x00 }, /* 9A */
  470. { 0x00, 0x00 }, /* 9B */
  471. { 0x00, 0x00 }, /* 9C */
  472. { 0x00, 0x00 }, /* 9D */
  473. { 0x00, 0x00 }, /* 9E */
  474. { 0x00, 0x00 }, /* 9F */
  475. { 0x00, 0x00 }, /* A0 */
  476. { 0x00, 0x00 }, /* A1 */
  477. { 0x00, 0x00 }, /* A2 */
  478. { 0x00, 0x00 }, /* A3 */
  479. { 0x00, 0x00 }, /* A4 */
  480. { 0x00, 0x00 }, /* A5 */
  481. { 0x00, 0x00 }, /* A6 */
  482. { 0x00, 0x00 }, /* A7 */
  483. { 0x00, 0x00 }, /* A8 */
  484. { 0x00, 0x00 }, /* A9 */
  485. { 0x00, 0x00 }, /* AA */
  486. { 0x00, 0x00 }, /* AB */
  487. { 0x00, 0x00 }, /* AC */
  488. { 0x00, 0x00 }, /* AD */
  489. { 0x00, 0x00 }, /* AE */
  490. { 0x00, 0x00 }, /* AF */
  491. { 0x00, 0x00 }, /* B0 */
  492. { 0x00, 0x00 }, /* B1 */
  493. { 0x00, 0x00 }, /* B2 */
  494. { 0x00, 0x00 }, /* B3 */
  495. { 0x00, 0x00 }, /* B4 */
  496. { 0x00, 0x00 }, /* B5 */
  497. { 0x00, 0x00 }, /* B6 */
  498. { 0x00, 0x00 }, /* B7 */
  499. { 0x00, 0x00 }, /* B8 */
  500. { 0x00, 0x00 }, /* B9 */
  501. { 0x00, 0x00 }, /* BA */
  502. { 0x00, 0x00 }, /* BB */
  503. { 0x00, 0x00 }, /* BC */
  504. { 0x00, 0x00 }, /* BD */
  505. { 0x00, 0x00 }, /* BE */
  506. { 0x00, 0x00 }, /* BF */
  507. { 0x00, 0x00 }, /* C0 */
  508. { 0x00, 0x00 }, /* C1 */
  509. { 0x00, 0x00 }, /* C2 */
  510. { 0x00, 0x00 }, /* C3 */
  511. { 0x00, 0x00 }, /* C4 */
  512. { 0x00, 0x00 }, /* C5 */
  513. { 0x00, 0x00 }, /* C6 */
  514. { 0x00, 0x00 }, /* C7 */
  515. { 0x00, 0x00 }, /* C8 */
  516. { 0x00, 0x00 }, /* C9 */
  517. { 0x00, 0x00 }, /* CA */
  518. { 0x00, 0x00 }, /* CB */
  519. { 0x00, 0x00 }, /* CC */
  520. { 0x00, 0x00 }, /* CD */
  521. { 0x00, 0x00 }, /* CE */
  522. { 0x00, 0x00 }, /* CF */
  523. { 0x00, 0x00 }, /* D0 */
  524. { 0x00, 0x00 }, /* D1 */
  525. { 0x00, 0x00 }, /* D2 */
  526. { 0x00, 0x00 }, /* D3 */
  527. { 0x00, 0x00 }, /* D4 */
  528. { 0x00, 0x00 }, /* D5 */
  529. { 0x00, 0x00 }, /* D6 */
  530. { 0x00, 0x00 }, /* D7 */
  531. { 0x00, 0x00 }, /* D8 */
  532. { 0x00, 0x00 }, /* D9 */
  533. { 0x00, 0x00 }, /* DA */
  534. { 0x00, 0x00 }, /* DB */
  535. { 0x00, 0x00 }, /* DC */
  536. { 0x00, 0x00 }, /* DD */
  537. { 0x00, 0x00 }, /* DE */
  538. { 0x00, 0x00 }, /* DF */
  539. { 0x00, 0x00 }, /* E0 */
  540. { 0x00, 0x00 }, /* E1 */
  541. { 0x00, 0x00 }, /* E2 */
  542. { 0x00, 0x00 }, /* E3 */
  543. { 0x00, 0x00 }, /* E4 */
  544. { 0x00, 0x00 }, /* E5 */
  545. { 0x00, 0x00 }, /* E6 */
  546. { 0x00, 0x00 }, /* E7 */
  547. { 0x00, 0x00 }, /* E8 */
  548. { 0x00, 0x00 }, /* E9 */
  549. { 0x00, 0x00 }, /* EA */
  550. { 0x00, 0x00 }, /* EB */
  551. { 0x00, 0x00 }, /* EC */
  552. { 0x00, 0x00 }, /* ED */
  553. { 0x00, 0x00 }, /* EE */
  554. { 0x00, 0x00 }, /* EF */
  555. { 0x00, 0x00 }, /* F0 */
  556. { 0x00, 0x00 }, /* F1 */
  557. { 0x00, 0x00 }, /* F2 */
  558. { 0x00, 0x00 }, /* F3 */
  559. { 0x00, 0x00 }, /* F4 */
  560. { 0x00, 0x00 }, /* F5 */
  561. { 0x00, 0x00 }, /* F6 */
  562. { 0x00, 0x00 }, /* F7 */
  563. { 0x00, 0x00 }, /* F8 */
  564. { 0x00, 0x00 }, /* F9 */
  565. { 0x00, 0x00 }, /* FA */
  566. { 0x00, 0x00 }, /* FB */
  567. { 0x00, 0x00 }, /* FC */
  568. { 0x00, 0x00 }, /* FD */
  569. { 0x00, 0x00 }, /* FE */
  570. { 0xFF, 0x00 }, /* FF */
  571. };
  572. static int max98095_readable(struct snd_soc_codec *codec, unsigned int reg)
  573. {
  574. if (reg >= M98095_REG_CNT)
  575. return 0;
  576. return max98095_access[reg].readable != 0;
  577. }
  578. static int max98095_volatile(struct snd_soc_codec *codec, unsigned int reg)
  579. {
  580. if (reg > M98095_REG_MAX_CACHED)
  581. return 1;
  582. switch (reg) {
  583. case M98095_000_HOST_DATA:
  584. case M98095_001_HOST_INT_STS:
  585. case M98095_002_HOST_RSP_STS:
  586. case M98095_003_HOST_CMD_STS:
  587. case M98095_004_CODEC_STS:
  588. case M98095_005_DAI1_ALC_STS:
  589. case M98095_006_DAI2_ALC_STS:
  590. case M98095_007_JACK_AUTO_STS:
  591. case M98095_008_JACK_MANUAL_STS:
  592. case M98095_009_JACK_VBAT_STS:
  593. case M98095_00A_ACC_ADC_STS:
  594. case M98095_00B_MIC_NG_AGC_STS:
  595. case M98095_00C_SPK_L_VOLT_STS:
  596. case M98095_00D_SPK_R_VOLT_STS:
  597. case M98095_00E_TEMP_SENSOR_STS:
  598. return 1;
  599. }
  600. return 0;
  601. }
  602. /*
  603. * Filter coefficients are in a separate register segment
  604. * and they share the address space of the normal registers.
  605. * The coefficient registers do not need or share the cache.
  606. */
  607. static int max98095_hw_write(struct snd_soc_codec *codec, unsigned int reg,
  608. unsigned int value)
  609. {
  610. u8 data[2];
  611. data[0] = reg;
  612. data[1] = value;
  613. if (codec->hw_write(codec->control_data, data, 2) == 2)
  614. return 0;
  615. else
  616. return -EIO;
  617. }
  618. /*
  619. * Load equalizer DSP coefficient configurations registers
  620. */
  621. static void m98095_eq_band(struct snd_soc_codec *codec, unsigned int dai,
  622. unsigned int band, u16 *coefs)
  623. {
  624. unsigned int eq_reg;
  625. unsigned int i;
  626. BUG_ON(band > 4);
  627. BUG_ON(dai > 1);
  628. /* Load the base register address */
  629. eq_reg = dai ? M98095_142_DAI2_EQ_BASE : M98095_110_DAI1_EQ_BASE;
  630. /* Add the band address offset, note adjustment for word address */
  631. eq_reg += band * (M98095_COEFS_PER_BAND << 1);
  632. /* Step through the registers and coefs */
  633. for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
  634. max98095_hw_write(codec, eq_reg++, M98095_BYTE1(coefs[i]));
  635. max98095_hw_write(codec, eq_reg++, M98095_BYTE0(coefs[i]));
  636. }
  637. }
  638. /*
  639. * Load biquad filter coefficient configurations registers
  640. */
  641. static void m98095_biquad_band(struct snd_soc_codec *codec, unsigned int dai,
  642. unsigned int band, u16 *coefs)
  643. {
  644. unsigned int bq_reg;
  645. unsigned int i;
  646. BUG_ON(band > 1);
  647. BUG_ON(dai > 1);
  648. /* Load the base register address */
  649. bq_reg = dai ? M98095_17E_DAI2_BQ_BASE : M98095_174_DAI1_BQ_BASE;
  650. /* Add the band address offset, note adjustment for word address */
  651. bq_reg += band * (M98095_COEFS_PER_BAND << 1);
  652. /* Step through the registers and coefs */
  653. for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
  654. max98095_hw_write(codec, bq_reg++, M98095_BYTE1(coefs[i]));
  655. max98095_hw_write(codec, bq_reg++, M98095_BYTE0(coefs[i]));
  656. }
  657. }
  658. static const char * const max98095_fltr_mode[] = { "Voice", "Music" };
  659. static const struct soc_enum max98095_dai1_filter_mode_enum[] = {
  660. SOC_ENUM_SINGLE(M98095_02E_DAI1_FILTERS, 7, 2, max98095_fltr_mode),
  661. };
  662. static const struct soc_enum max98095_dai2_filter_mode_enum[] = {
  663. SOC_ENUM_SINGLE(M98095_038_DAI2_FILTERS, 7, 2, max98095_fltr_mode),
  664. };
  665. static const char * const max98095_extmic_text[] = { "None", "MIC1", "MIC2" };
  666. static const struct soc_enum max98095_extmic_enum =
  667. SOC_ENUM_SINGLE(M98095_087_CFG_MIC, 0, 3, max98095_extmic_text);
  668. static const struct snd_kcontrol_new max98095_extmic_mux =
  669. SOC_DAPM_ENUM("External MIC Mux", max98095_extmic_enum);
  670. static const char * const max98095_linein_text[] = { "INA", "INB" };
  671. static const struct soc_enum max98095_linein_enum =
  672. SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 6, 2, max98095_linein_text);
  673. static const struct snd_kcontrol_new max98095_linein_mux =
  674. SOC_DAPM_ENUM("Linein Input Mux", max98095_linein_enum);
  675. static const char * const max98095_line_mode_text[] = {
  676. "Stereo", "Differential"};
  677. static const struct soc_enum max98095_linein_mode_enum =
  678. SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 7, 2, max98095_line_mode_text);
  679. static const struct soc_enum max98095_lineout_mode_enum =
  680. SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 4, 2, max98095_line_mode_text);
  681. static const char * const max98095_dai_fltr[] = {
  682. "Off", "Elliptical-HPF-16k", "Butterworth-HPF-16k",
  683. "Elliptical-HPF-8k", "Butterworth-HPF-8k", "Butterworth-HPF-Fs/240"};
  684. static const struct soc_enum max98095_dai1_dac_filter_enum[] = {
  685. SOC_ENUM_SINGLE(M98095_02E_DAI1_FILTERS, 0, 6, max98095_dai_fltr),
  686. };
  687. static const struct soc_enum max98095_dai2_dac_filter_enum[] = {
  688. SOC_ENUM_SINGLE(M98095_038_DAI2_FILTERS, 0, 6, max98095_dai_fltr),
  689. };
  690. static const struct soc_enum max98095_dai3_dac_filter_enum[] = {
  691. SOC_ENUM_SINGLE(M98095_042_DAI3_FILTERS, 0, 6, max98095_dai_fltr),
  692. };
  693. static int max98095_mic1pre_set(struct snd_kcontrol *kcontrol,
  694. struct snd_ctl_elem_value *ucontrol)
  695. {
  696. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  697. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  698. unsigned int sel = ucontrol->value.integer.value[0];
  699. max98095->mic1pre = sel;
  700. snd_soc_update_bits(codec, M98095_05F_LVL_MIC1, M98095_MICPRE_MASK,
  701. (1+sel)<<M98095_MICPRE_SHIFT);
  702. return 0;
  703. }
  704. static int max98095_mic1pre_get(struct snd_kcontrol *kcontrol,
  705. struct snd_ctl_elem_value *ucontrol)
  706. {
  707. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  708. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  709. ucontrol->value.integer.value[0] = max98095->mic1pre;
  710. return 0;
  711. }
  712. static int max98095_mic2pre_set(struct snd_kcontrol *kcontrol,
  713. struct snd_ctl_elem_value *ucontrol)
  714. {
  715. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  716. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  717. unsigned int sel = ucontrol->value.integer.value[0];
  718. max98095->mic2pre = sel;
  719. snd_soc_update_bits(codec, M98095_060_LVL_MIC2, M98095_MICPRE_MASK,
  720. (1+sel)<<M98095_MICPRE_SHIFT);
  721. return 0;
  722. }
  723. static int max98095_mic2pre_get(struct snd_kcontrol *kcontrol,
  724. struct snd_ctl_elem_value *ucontrol)
  725. {
  726. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  727. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  728. ucontrol->value.integer.value[0] = max98095->mic2pre;
  729. return 0;
  730. }
  731. static const unsigned int max98095_micboost_tlv[] = {
  732. TLV_DB_RANGE_HEAD(2),
  733. 0, 1, TLV_DB_SCALE_ITEM(0, 2000, 0),
  734. 2, 2, TLV_DB_SCALE_ITEM(3000, 0, 0),
  735. };
  736. static const DECLARE_TLV_DB_SCALE(max98095_mic_tlv, 0, 100, 0);
  737. static const DECLARE_TLV_DB_SCALE(max98095_adc_tlv, -1200, 100, 0);
  738. static const DECLARE_TLV_DB_SCALE(max98095_adcboost_tlv, 0, 600, 0);
  739. static const unsigned int max98095_hp_tlv[] = {
  740. TLV_DB_RANGE_HEAD(5),
  741. 0, 6, TLV_DB_SCALE_ITEM(-6700, 400, 0),
  742. 7, 14, TLV_DB_SCALE_ITEM(-4000, 300, 0),
  743. 15, 21, TLV_DB_SCALE_ITEM(-1700, 200, 0),
  744. 22, 27, TLV_DB_SCALE_ITEM(-400, 100, 0),
  745. 28, 31, TLV_DB_SCALE_ITEM(150, 50, 0),
  746. };
  747. static const unsigned int max98095_spk_tlv[] = {
  748. TLV_DB_RANGE_HEAD(4),
  749. 0, 10, TLV_DB_SCALE_ITEM(-5900, 400, 0),
  750. 11, 18, TLV_DB_SCALE_ITEM(-1700, 200, 0),
  751. 19, 27, TLV_DB_SCALE_ITEM(-200, 100, 0),
  752. 28, 39, TLV_DB_SCALE_ITEM(650, 50, 0),
  753. };
  754. static const unsigned int max98095_rcv_lout_tlv[] = {
  755. TLV_DB_RANGE_HEAD(5),
  756. 0, 6, TLV_DB_SCALE_ITEM(-6200, 400, 0),
  757. 7, 14, TLV_DB_SCALE_ITEM(-3500, 300, 0),
  758. 15, 21, TLV_DB_SCALE_ITEM(-1200, 200, 0),
  759. 22, 27, TLV_DB_SCALE_ITEM(100, 100, 0),
  760. 28, 31, TLV_DB_SCALE_ITEM(650, 50, 0),
  761. };
  762. static const unsigned int max98095_lin_tlv[] = {
  763. TLV_DB_RANGE_HEAD(3),
  764. 0, 2, TLV_DB_SCALE_ITEM(-600, 300, 0),
  765. 3, 3, TLV_DB_SCALE_ITEM(300, 1100, 0),
  766. 4, 5, TLV_DB_SCALE_ITEM(1400, 600, 0),
  767. };
  768. static const struct snd_kcontrol_new max98095_snd_controls[] = {
  769. SOC_DOUBLE_R_TLV("Headphone Volume", M98095_064_LVL_HP_L,
  770. M98095_065_LVL_HP_R, 0, 31, 0, max98095_hp_tlv),
  771. SOC_DOUBLE_R_TLV("Speaker Volume", M98095_067_LVL_SPK_L,
  772. M98095_068_LVL_SPK_R, 0, 39, 0, max98095_spk_tlv),
  773. SOC_SINGLE_TLV("Receiver Volume", M98095_066_LVL_RCV,
  774. 0, 31, 0, max98095_rcv_lout_tlv),
  775. SOC_DOUBLE_R_TLV("Lineout Volume", M98095_062_LVL_LINEOUT1,
  776. M98095_063_LVL_LINEOUT2, 0, 31, 0, max98095_rcv_lout_tlv),
  777. SOC_DOUBLE_R("Headphone Switch", M98095_064_LVL_HP_L,
  778. M98095_065_LVL_HP_R, 7, 1, 1),
  779. SOC_DOUBLE_R("Speaker Switch", M98095_067_LVL_SPK_L,
  780. M98095_068_LVL_SPK_R, 7, 1, 1),
  781. SOC_SINGLE("Receiver Switch", M98095_066_LVL_RCV, 7, 1, 1),
  782. SOC_DOUBLE_R("Lineout Switch", M98095_062_LVL_LINEOUT1,
  783. M98095_063_LVL_LINEOUT2, 7, 1, 1),
  784. SOC_SINGLE_TLV("MIC1 Volume", M98095_05F_LVL_MIC1, 0, 20, 1,
  785. max98095_mic_tlv),
  786. SOC_SINGLE_TLV("MIC2 Volume", M98095_060_LVL_MIC2, 0, 20, 1,
  787. max98095_mic_tlv),
  788. SOC_SINGLE_EXT_TLV("MIC1 Boost Volume",
  789. M98095_05F_LVL_MIC1, 5, 2, 0,
  790. max98095_mic1pre_get, max98095_mic1pre_set,
  791. max98095_micboost_tlv),
  792. SOC_SINGLE_EXT_TLV("MIC2 Boost Volume",
  793. M98095_060_LVL_MIC2, 5, 2, 0,
  794. max98095_mic2pre_get, max98095_mic2pre_set,
  795. max98095_micboost_tlv),
  796. SOC_SINGLE_TLV("Linein Volume", M98095_061_LVL_LINEIN, 0, 5, 1,
  797. max98095_lin_tlv),
  798. SOC_SINGLE_TLV("ADCL Volume", M98095_05D_LVL_ADC_L, 0, 15, 1,
  799. max98095_adc_tlv),
  800. SOC_SINGLE_TLV("ADCR Volume", M98095_05E_LVL_ADC_R, 0, 15, 1,
  801. max98095_adc_tlv),
  802. SOC_SINGLE_TLV("ADCL Boost Volume", M98095_05D_LVL_ADC_L, 4, 3, 0,
  803. max98095_adcboost_tlv),
  804. SOC_SINGLE_TLV("ADCR Boost Volume", M98095_05E_LVL_ADC_R, 4, 3, 0,
  805. max98095_adcboost_tlv),
  806. SOC_SINGLE("EQ1 Switch", M98095_088_CFG_LEVEL, 0, 1, 0),
  807. SOC_SINGLE("EQ2 Switch", M98095_088_CFG_LEVEL, 1, 1, 0),
  808. SOC_SINGLE("Biquad1 Switch", M98095_088_CFG_LEVEL, 2, 1, 0),
  809. SOC_SINGLE("Biquad2 Switch", M98095_088_CFG_LEVEL, 3, 1, 0),
  810. SOC_ENUM("DAI1 Filter Mode", max98095_dai1_filter_mode_enum),
  811. SOC_ENUM("DAI2 Filter Mode", max98095_dai2_filter_mode_enum),
  812. SOC_ENUM("DAI1 DAC Filter", max98095_dai1_dac_filter_enum),
  813. SOC_ENUM("DAI2 DAC Filter", max98095_dai2_dac_filter_enum),
  814. SOC_ENUM("DAI3 DAC Filter", max98095_dai3_dac_filter_enum),
  815. SOC_ENUM("Linein Mode", max98095_linein_mode_enum),
  816. SOC_ENUM("Lineout Mode", max98095_lineout_mode_enum),
  817. };
  818. /* Left speaker mixer switch */
  819. static const struct snd_kcontrol_new max98095_left_speaker_mixer_controls[] = {
  820. SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_050_MIX_SPK_LEFT, 0, 1, 0),
  821. SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_050_MIX_SPK_LEFT, 6, 1, 0),
  822. SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
  823. SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
  824. SOC_DAPM_SINGLE("MIC1 Switch", M98095_050_MIX_SPK_LEFT, 4, 1, 0),
  825. SOC_DAPM_SINGLE("MIC2 Switch", M98095_050_MIX_SPK_LEFT, 5, 1, 0),
  826. SOC_DAPM_SINGLE("IN1 Switch", M98095_050_MIX_SPK_LEFT, 1, 1, 0),
  827. SOC_DAPM_SINGLE("IN2 Switch", M98095_050_MIX_SPK_LEFT, 2, 1, 0),
  828. };
  829. /* Right speaker mixer switch */
  830. static const struct snd_kcontrol_new max98095_right_speaker_mixer_controls[] = {
  831. SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 6, 1, 0),
  832. SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 0, 1, 0),
  833. SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
  834. SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
  835. SOC_DAPM_SINGLE("MIC1 Switch", M98095_051_MIX_SPK_RIGHT, 5, 1, 0),
  836. SOC_DAPM_SINGLE("MIC2 Switch", M98095_051_MIX_SPK_RIGHT, 4, 1, 0),
  837. SOC_DAPM_SINGLE("IN1 Switch", M98095_051_MIX_SPK_RIGHT, 1, 1, 0),
  838. SOC_DAPM_SINGLE("IN2 Switch", M98095_051_MIX_SPK_RIGHT, 2, 1, 0),
  839. };
  840. /* Left headphone mixer switch */
  841. static const struct snd_kcontrol_new max98095_left_hp_mixer_controls[] = {
  842. SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04C_MIX_HP_LEFT, 0, 1, 0),
  843. SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04C_MIX_HP_LEFT, 5, 1, 0),
  844. SOC_DAPM_SINGLE("MIC1 Switch", M98095_04C_MIX_HP_LEFT, 3, 1, 0),
  845. SOC_DAPM_SINGLE("MIC2 Switch", M98095_04C_MIX_HP_LEFT, 4, 1, 0),
  846. SOC_DAPM_SINGLE("IN1 Switch", M98095_04C_MIX_HP_LEFT, 1, 1, 0),
  847. SOC_DAPM_SINGLE("IN2 Switch", M98095_04C_MIX_HP_LEFT, 2, 1, 0),
  848. };
  849. /* Right headphone mixer switch */
  850. static const struct snd_kcontrol_new max98095_right_hp_mixer_controls[] = {
  851. SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 5, 1, 0),
  852. SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 0, 1, 0),
  853. SOC_DAPM_SINGLE("MIC1 Switch", M98095_04D_MIX_HP_RIGHT, 3, 1, 0),
  854. SOC_DAPM_SINGLE("MIC2 Switch", M98095_04D_MIX_HP_RIGHT, 4, 1, 0),
  855. SOC_DAPM_SINGLE("IN1 Switch", M98095_04D_MIX_HP_RIGHT, 1, 1, 0),
  856. SOC_DAPM_SINGLE("IN2 Switch", M98095_04D_MIX_HP_RIGHT, 2, 1, 0),
  857. };
  858. /* Receiver earpiece mixer switch */
  859. static const struct snd_kcontrol_new max98095_mono_rcv_mixer_controls[] = {
  860. SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04F_MIX_RCV, 0, 1, 0),
  861. SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04F_MIX_RCV, 5, 1, 0),
  862. SOC_DAPM_SINGLE("MIC1 Switch", M98095_04F_MIX_RCV, 3, 1, 0),
  863. SOC_DAPM_SINGLE("MIC2 Switch", M98095_04F_MIX_RCV, 4, 1, 0),
  864. SOC_DAPM_SINGLE("IN1 Switch", M98095_04F_MIX_RCV, 1, 1, 0),
  865. SOC_DAPM_SINGLE("IN2 Switch", M98095_04F_MIX_RCV, 2, 1, 0),
  866. };
  867. /* Left lineout mixer switch */
  868. static const struct snd_kcontrol_new max98095_left_lineout_mixer_controls[] = {
  869. SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_053_MIX_LINEOUT1, 5, 1, 0),
  870. SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_053_MIX_LINEOUT1, 0, 1, 0),
  871. SOC_DAPM_SINGLE("MIC1 Switch", M98095_053_MIX_LINEOUT1, 3, 1, 0),
  872. SOC_DAPM_SINGLE("MIC2 Switch", M98095_053_MIX_LINEOUT1, 4, 1, 0),
  873. SOC_DAPM_SINGLE("IN1 Switch", M98095_053_MIX_LINEOUT1, 1, 1, 0),
  874. SOC_DAPM_SINGLE("IN2 Switch", M98095_053_MIX_LINEOUT1, 2, 1, 0),
  875. };
  876. /* Right lineout mixer switch */
  877. static const struct snd_kcontrol_new max98095_right_lineout_mixer_controls[] = {
  878. SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_054_MIX_LINEOUT2, 0, 1, 0),
  879. SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_054_MIX_LINEOUT2, 5, 1, 0),
  880. SOC_DAPM_SINGLE("MIC1 Switch", M98095_054_MIX_LINEOUT2, 3, 1, 0),
  881. SOC_DAPM_SINGLE("MIC2 Switch", M98095_054_MIX_LINEOUT2, 4, 1, 0),
  882. SOC_DAPM_SINGLE("IN1 Switch", M98095_054_MIX_LINEOUT2, 1, 1, 0),
  883. SOC_DAPM_SINGLE("IN2 Switch", M98095_054_MIX_LINEOUT2, 2, 1, 0),
  884. };
  885. /* Left ADC mixer switch */
  886. static const struct snd_kcontrol_new max98095_left_ADC_mixer_controls[] = {
  887. SOC_DAPM_SINGLE("MIC1 Switch", M98095_04A_MIX_ADC_LEFT, 7, 1, 0),
  888. SOC_DAPM_SINGLE("MIC2 Switch", M98095_04A_MIX_ADC_LEFT, 6, 1, 0),
  889. SOC_DAPM_SINGLE("IN1 Switch", M98095_04A_MIX_ADC_LEFT, 3, 1, 0),
  890. SOC_DAPM_SINGLE("IN2 Switch", M98095_04A_MIX_ADC_LEFT, 2, 1, 0),
  891. };
  892. /* Right ADC mixer switch */
  893. static const struct snd_kcontrol_new max98095_right_ADC_mixer_controls[] = {
  894. SOC_DAPM_SINGLE("MIC1 Switch", M98095_04B_MIX_ADC_RIGHT, 7, 1, 0),
  895. SOC_DAPM_SINGLE("MIC2 Switch", M98095_04B_MIX_ADC_RIGHT, 6, 1, 0),
  896. SOC_DAPM_SINGLE("IN1 Switch", M98095_04B_MIX_ADC_RIGHT, 3, 1, 0),
  897. SOC_DAPM_SINGLE("IN2 Switch", M98095_04B_MIX_ADC_RIGHT, 2, 1, 0),
  898. };
  899. static int max98095_mic_event(struct snd_soc_dapm_widget *w,
  900. struct snd_kcontrol *kcontrol, int event)
  901. {
  902. struct snd_soc_codec *codec = w->codec;
  903. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  904. switch (event) {
  905. case SND_SOC_DAPM_POST_PMU:
  906. if (w->reg == M98095_05F_LVL_MIC1) {
  907. snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK,
  908. (1+max98095->mic1pre)<<M98095_MICPRE_SHIFT);
  909. } else {
  910. snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK,
  911. (1+max98095->mic2pre)<<M98095_MICPRE_SHIFT);
  912. }
  913. break;
  914. case SND_SOC_DAPM_POST_PMD:
  915. snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK, 0);
  916. break;
  917. default:
  918. return -EINVAL;
  919. }
  920. return 0;
  921. }
  922. /*
  923. * The line inputs are stereo inputs with the left and right
  924. * channels sharing a common PGA power control signal.
  925. */
  926. static int max98095_line_pga(struct snd_soc_dapm_widget *w,
  927. int event, u8 channel)
  928. {
  929. struct snd_soc_codec *codec = w->codec;
  930. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  931. u8 *state;
  932. BUG_ON(!((channel == 1) || (channel == 2)));
  933. state = &max98095->lin_state;
  934. switch (event) {
  935. case SND_SOC_DAPM_POST_PMU:
  936. *state |= channel;
  937. snd_soc_update_bits(codec, w->reg,
  938. (1 << w->shift), (1 << w->shift));
  939. break;
  940. case SND_SOC_DAPM_POST_PMD:
  941. *state &= ~channel;
  942. if (*state == 0) {
  943. snd_soc_update_bits(codec, w->reg,
  944. (1 << w->shift), 0);
  945. }
  946. break;
  947. default:
  948. return -EINVAL;
  949. }
  950. return 0;
  951. }
  952. static int max98095_pga_in1_event(struct snd_soc_dapm_widget *w,
  953. struct snd_kcontrol *k, int event)
  954. {
  955. return max98095_line_pga(w, event, 1);
  956. }
  957. static int max98095_pga_in2_event(struct snd_soc_dapm_widget *w,
  958. struct snd_kcontrol *k, int event)
  959. {
  960. return max98095_line_pga(w, event, 2);
  961. }
  962. /*
  963. * The stereo line out mixer outputs to two stereo line outs.
  964. * The 2nd pair has a separate set of enables.
  965. */
  966. static int max98095_lineout_event(struct snd_soc_dapm_widget *w,
  967. struct snd_kcontrol *kcontrol, int event)
  968. {
  969. struct snd_soc_codec *codec = w->codec;
  970. switch (event) {
  971. case SND_SOC_DAPM_POST_PMU:
  972. snd_soc_update_bits(codec, w->reg,
  973. (1 << (w->shift+2)), (1 << (w->shift+2)));
  974. break;
  975. case SND_SOC_DAPM_POST_PMD:
  976. snd_soc_update_bits(codec, w->reg,
  977. (1 << (w->shift+2)), 0);
  978. break;
  979. default:
  980. return -EINVAL;
  981. }
  982. return 0;
  983. }
  984. static const struct snd_soc_dapm_widget max98095_dapm_widgets[] = {
  985. SND_SOC_DAPM_ADC("ADCL", "HiFi Capture", M98095_090_PWR_EN_IN, 0, 0),
  986. SND_SOC_DAPM_ADC("ADCR", "HiFi Capture", M98095_090_PWR_EN_IN, 1, 0),
  987. SND_SOC_DAPM_DAC("DACL1", "HiFi Playback",
  988. M98095_091_PWR_EN_OUT, 0, 0),
  989. SND_SOC_DAPM_DAC("DACR1", "HiFi Playback",
  990. M98095_091_PWR_EN_OUT, 1, 0),
  991. SND_SOC_DAPM_DAC("DACM2", "Aux Playback",
  992. M98095_091_PWR_EN_OUT, 2, 0),
  993. SND_SOC_DAPM_DAC("DACM3", "Voice Playback",
  994. M98095_091_PWR_EN_OUT, 2, 0),
  995. SND_SOC_DAPM_PGA("HP Left Out", M98095_091_PWR_EN_OUT,
  996. 6, 0, NULL, 0),
  997. SND_SOC_DAPM_PGA("HP Right Out", M98095_091_PWR_EN_OUT,
  998. 7, 0, NULL, 0),
  999. SND_SOC_DAPM_PGA("SPK Left Out", M98095_091_PWR_EN_OUT,
  1000. 4, 0, NULL, 0),
  1001. SND_SOC_DAPM_PGA("SPK Right Out", M98095_091_PWR_EN_OUT,
  1002. 5, 0, NULL, 0),
  1003. SND_SOC_DAPM_PGA("RCV Mono Out", M98095_091_PWR_EN_OUT,
  1004. 3, 0, NULL, 0),
  1005. SND_SOC_DAPM_PGA_E("LINE Left Out", M98095_092_PWR_EN_OUT,
  1006. 0, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
  1007. SND_SOC_DAPM_PGA_E("LINE Right Out", M98095_092_PWR_EN_OUT,
  1008. 1, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
  1009. SND_SOC_DAPM_MUX("External MIC", SND_SOC_NOPM, 0, 0,
  1010. &max98095_extmic_mux),
  1011. SND_SOC_DAPM_MUX("Linein Mux", SND_SOC_NOPM, 0, 0,
  1012. &max98095_linein_mux),
  1013. SND_SOC_DAPM_MIXER("Left Headphone Mixer", SND_SOC_NOPM, 0, 0,
  1014. &max98095_left_hp_mixer_controls[0],
  1015. ARRAY_SIZE(max98095_left_hp_mixer_controls)),
  1016. SND_SOC_DAPM_MIXER("Right Headphone Mixer", SND_SOC_NOPM, 0, 0,
  1017. &max98095_right_hp_mixer_controls[0],
  1018. ARRAY_SIZE(max98095_right_hp_mixer_controls)),
  1019. SND_SOC_DAPM_MIXER("Left Speaker Mixer", SND_SOC_NOPM, 0, 0,
  1020. &max98095_left_speaker_mixer_controls[0],
  1021. ARRAY_SIZE(max98095_left_speaker_mixer_controls)),
  1022. SND_SOC_DAPM_MIXER("Right Speaker Mixer", SND_SOC_NOPM, 0, 0,
  1023. &max98095_right_speaker_mixer_controls[0],
  1024. ARRAY_SIZE(max98095_right_speaker_mixer_controls)),
  1025. SND_SOC_DAPM_MIXER("Receiver Mixer", SND_SOC_NOPM, 0, 0,
  1026. &max98095_mono_rcv_mixer_controls[0],
  1027. ARRAY_SIZE(max98095_mono_rcv_mixer_controls)),
  1028. SND_SOC_DAPM_MIXER("Left Lineout Mixer", SND_SOC_NOPM, 0, 0,
  1029. &max98095_left_lineout_mixer_controls[0],
  1030. ARRAY_SIZE(max98095_left_lineout_mixer_controls)),
  1031. SND_SOC_DAPM_MIXER("Right Lineout Mixer", SND_SOC_NOPM, 0, 0,
  1032. &max98095_right_lineout_mixer_controls[0],
  1033. ARRAY_SIZE(max98095_right_lineout_mixer_controls)),
  1034. SND_SOC_DAPM_MIXER("Left ADC Mixer", SND_SOC_NOPM, 0, 0,
  1035. &max98095_left_ADC_mixer_controls[0],
  1036. ARRAY_SIZE(max98095_left_ADC_mixer_controls)),
  1037. SND_SOC_DAPM_MIXER("Right ADC Mixer", SND_SOC_NOPM, 0, 0,
  1038. &max98095_right_ADC_mixer_controls[0],
  1039. ARRAY_SIZE(max98095_right_ADC_mixer_controls)),
  1040. SND_SOC_DAPM_PGA_E("MIC1 Input", M98095_05F_LVL_MIC1,
  1041. 5, 0, NULL, 0, max98095_mic_event,
  1042. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1043. SND_SOC_DAPM_PGA_E("MIC2 Input", M98095_060_LVL_MIC2,
  1044. 5, 0, NULL, 0, max98095_mic_event,
  1045. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1046. SND_SOC_DAPM_PGA_E("IN1 Input", M98095_090_PWR_EN_IN,
  1047. 7, 0, NULL, 0, max98095_pga_in1_event,
  1048. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1049. SND_SOC_DAPM_PGA_E("IN2 Input", M98095_090_PWR_EN_IN,
  1050. 7, 0, NULL, 0, max98095_pga_in2_event,
  1051. SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
  1052. SND_SOC_DAPM_MICBIAS("MICBIAS1", M98095_090_PWR_EN_IN, 2, 0),
  1053. SND_SOC_DAPM_MICBIAS("MICBIAS2", M98095_090_PWR_EN_IN, 3, 0),
  1054. SND_SOC_DAPM_OUTPUT("HPL"),
  1055. SND_SOC_DAPM_OUTPUT("HPR"),
  1056. SND_SOC_DAPM_OUTPUT("SPKL"),
  1057. SND_SOC_DAPM_OUTPUT("SPKR"),
  1058. SND_SOC_DAPM_OUTPUT("RCV"),
  1059. SND_SOC_DAPM_OUTPUT("OUT1"),
  1060. SND_SOC_DAPM_OUTPUT("OUT2"),
  1061. SND_SOC_DAPM_OUTPUT("OUT3"),
  1062. SND_SOC_DAPM_OUTPUT("OUT4"),
  1063. SND_SOC_DAPM_INPUT("MIC1"),
  1064. SND_SOC_DAPM_INPUT("MIC2"),
  1065. SND_SOC_DAPM_INPUT("INA1"),
  1066. SND_SOC_DAPM_INPUT("INA2"),
  1067. SND_SOC_DAPM_INPUT("INB1"),
  1068. SND_SOC_DAPM_INPUT("INB2"),
  1069. };
  1070. static const struct snd_soc_dapm_route max98095_audio_map[] = {
  1071. /* Left headphone output mixer */
  1072. {"Left Headphone Mixer", "Left DAC1 Switch", "DACL1"},
  1073. {"Left Headphone Mixer", "Right DAC1 Switch", "DACR1"},
  1074. {"Left Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
  1075. {"Left Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
  1076. {"Left Headphone Mixer", "IN1 Switch", "IN1 Input"},
  1077. {"Left Headphone Mixer", "IN2 Switch", "IN2 Input"},
  1078. /* Right headphone output mixer */
  1079. {"Right Headphone Mixer", "Left DAC1 Switch", "DACL1"},
  1080. {"Right Headphone Mixer", "Right DAC1 Switch", "DACR1"},
  1081. {"Right Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
  1082. {"Right Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
  1083. {"Right Headphone Mixer", "IN1 Switch", "IN1 Input"},
  1084. {"Right Headphone Mixer", "IN2 Switch", "IN2 Input"},
  1085. /* Left speaker output mixer */
  1086. {"Left Speaker Mixer", "Left DAC1 Switch", "DACL1"},
  1087. {"Left Speaker Mixer", "Right DAC1 Switch", "DACR1"},
  1088. {"Left Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
  1089. {"Left Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
  1090. {"Left Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
  1091. {"Left Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
  1092. {"Left Speaker Mixer", "IN1 Switch", "IN1 Input"},
  1093. {"Left Speaker Mixer", "IN2 Switch", "IN2 Input"},
  1094. /* Right speaker output mixer */
  1095. {"Right Speaker Mixer", "Left DAC1 Switch", "DACL1"},
  1096. {"Right Speaker Mixer", "Right DAC1 Switch", "DACR1"},
  1097. {"Right Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
  1098. {"Right Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
  1099. {"Right Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
  1100. {"Right Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
  1101. {"Right Speaker Mixer", "IN1 Switch", "IN1 Input"},
  1102. {"Right Speaker Mixer", "IN2 Switch", "IN2 Input"},
  1103. /* Earpiece/Receiver output mixer */
  1104. {"Receiver Mixer", "Left DAC1 Switch", "DACL1"},
  1105. {"Receiver Mixer", "Right DAC1 Switch", "DACR1"},
  1106. {"Receiver Mixer", "MIC1 Switch", "MIC1 Input"},
  1107. {"Receiver Mixer", "MIC2 Switch", "MIC2 Input"},
  1108. {"Receiver Mixer", "IN1 Switch", "IN1 Input"},
  1109. {"Receiver Mixer", "IN2 Switch", "IN2 Input"},
  1110. /* Left Lineout output mixer */
  1111. {"Left Lineout Mixer", "Left DAC1 Switch", "DACL1"},
  1112. {"Left Lineout Mixer", "Right DAC1 Switch", "DACR1"},
  1113. {"Left Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
  1114. {"Left Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
  1115. {"Left Lineout Mixer", "IN1 Switch", "IN1 Input"},
  1116. {"Left Lineout Mixer", "IN2 Switch", "IN2 Input"},
  1117. /* Right lineout output mixer */
  1118. {"Right Lineout Mixer", "Left DAC1 Switch", "DACL1"},
  1119. {"Right Lineout Mixer", "Right DAC1 Switch", "DACR1"},
  1120. {"Right Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
  1121. {"Right Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
  1122. {"Right Lineout Mixer", "IN1 Switch", "IN1 Input"},
  1123. {"Right Lineout Mixer", "IN2 Switch", "IN2 Input"},
  1124. {"HP Left Out", NULL, "Left Headphone Mixer"},
  1125. {"HP Right Out", NULL, "Right Headphone Mixer"},
  1126. {"SPK Left Out", NULL, "Left Speaker Mixer"},
  1127. {"SPK Right Out", NULL, "Right Speaker Mixer"},
  1128. {"RCV Mono Out", NULL, "Receiver Mixer"},
  1129. {"LINE Left Out", NULL, "Left Lineout Mixer"},
  1130. {"LINE Right Out", NULL, "Right Lineout Mixer"},
  1131. {"HPL", NULL, "HP Left Out"},
  1132. {"HPR", NULL, "HP Right Out"},
  1133. {"SPKL", NULL, "SPK Left Out"},
  1134. {"SPKR", NULL, "SPK Right Out"},
  1135. {"RCV", NULL, "RCV Mono Out"},
  1136. {"OUT1", NULL, "LINE Left Out"},
  1137. {"OUT2", NULL, "LINE Right Out"},
  1138. {"OUT3", NULL, "LINE Left Out"},
  1139. {"OUT4", NULL, "LINE Right Out"},
  1140. /* Left ADC input mixer */
  1141. {"Left ADC Mixer", "MIC1 Switch", "MIC1 Input"},
  1142. {"Left ADC Mixer", "MIC2 Switch", "MIC2 Input"},
  1143. {"Left ADC Mixer", "IN1 Switch", "IN1 Input"},
  1144. {"Left ADC Mixer", "IN2 Switch", "IN2 Input"},
  1145. /* Right ADC input mixer */
  1146. {"Right ADC Mixer", "MIC1 Switch", "MIC1 Input"},
  1147. {"Right ADC Mixer", "MIC2 Switch", "MIC2 Input"},
  1148. {"Right ADC Mixer", "IN1 Switch", "IN1 Input"},
  1149. {"Right ADC Mixer", "IN2 Switch", "IN2 Input"},
  1150. /* Inputs */
  1151. {"ADCL", NULL, "Left ADC Mixer"},
  1152. {"ADCR", NULL, "Right ADC Mixer"},
  1153. {"IN1 Input", NULL, "INA1"},
  1154. {"IN2 Input", NULL, "INA2"},
  1155. {"MIC1 Input", NULL, "MIC1"},
  1156. {"MIC2 Input", NULL, "MIC2"},
  1157. };
  1158. static int max98095_add_widgets(struct snd_soc_codec *codec)
  1159. {
  1160. snd_soc_add_controls(codec, max98095_snd_controls,
  1161. ARRAY_SIZE(max98095_snd_controls));
  1162. return 0;
  1163. }
  1164. /* codec mclk clock divider coefficients */
  1165. static const struct {
  1166. u32 rate;
  1167. u8 sr;
  1168. } rate_table[] = {
  1169. {8000, 0x01},
  1170. {11025, 0x02},
  1171. {16000, 0x03},
  1172. {22050, 0x04},
  1173. {24000, 0x05},
  1174. {32000, 0x06},
  1175. {44100, 0x07},
  1176. {48000, 0x08},
  1177. {88200, 0x09},
  1178. {96000, 0x0A},
  1179. };
  1180. static int rate_value(int rate, u8 *value)
  1181. {
  1182. int i;
  1183. for (i = 0; i < ARRAY_SIZE(rate_table); i++) {
  1184. if (rate_table[i].rate >= rate) {
  1185. *value = rate_table[i].sr;
  1186. return 0;
  1187. }
  1188. }
  1189. *value = rate_table[0].sr;
  1190. return -EINVAL;
  1191. }
  1192. static int max98095_dai1_hw_params(struct snd_pcm_substream *substream,
  1193. struct snd_pcm_hw_params *params,
  1194. struct snd_soc_dai *dai)
  1195. {
  1196. struct snd_soc_codec *codec = dai->codec;
  1197. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1198. struct max98095_cdata *cdata;
  1199. unsigned long long ni;
  1200. unsigned int rate;
  1201. u8 regval;
  1202. cdata = &max98095->dai[0];
  1203. rate = params_rate(params);
  1204. switch (params_format(params)) {
  1205. case SNDRV_PCM_FORMAT_S16_LE:
  1206. snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
  1207. M98095_DAI_WS, 0);
  1208. break;
  1209. case SNDRV_PCM_FORMAT_S24_LE:
  1210. snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
  1211. M98095_DAI_WS, M98095_DAI_WS);
  1212. break;
  1213. default:
  1214. return -EINVAL;
  1215. }
  1216. if (rate_value(rate, &regval))
  1217. return -EINVAL;
  1218. snd_soc_update_bits(codec, M98095_027_DAI1_CLKMODE,
  1219. M98095_CLKMODE_MASK, regval);
  1220. cdata->rate = rate;
  1221. /* Configure NI when operating as master */
  1222. if (snd_soc_read(codec, M98095_02A_DAI1_FORMAT) & M98095_DAI_MAS) {
  1223. if (max98095->sysclk == 0) {
  1224. dev_err(codec->dev, "Invalid system clock frequency\n");
  1225. return -EINVAL;
  1226. }
  1227. ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
  1228. * (unsigned long long int)rate;
  1229. do_div(ni, (unsigned long long int)max98095->sysclk);
  1230. snd_soc_write(codec, M98095_028_DAI1_CLKCFG_HI,
  1231. (ni >> 8) & 0x7F);
  1232. snd_soc_write(codec, M98095_029_DAI1_CLKCFG_LO,
  1233. ni & 0xFF);
  1234. }
  1235. /* Update sample rate mode */
  1236. if (rate < 50000)
  1237. snd_soc_update_bits(codec, M98095_02E_DAI1_FILTERS,
  1238. M98095_DAI_DHF, 0);
  1239. else
  1240. snd_soc_update_bits(codec, M98095_02E_DAI1_FILTERS,
  1241. M98095_DAI_DHF, M98095_DAI_DHF);
  1242. return 0;
  1243. }
  1244. static int max98095_dai2_hw_params(struct snd_pcm_substream *substream,
  1245. struct snd_pcm_hw_params *params,
  1246. struct snd_soc_dai *dai)
  1247. {
  1248. struct snd_soc_codec *codec = dai->codec;
  1249. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1250. struct max98095_cdata *cdata;
  1251. unsigned long long ni;
  1252. unsigned int rate;
  1253. u8 regval;
  1254. cdata = &max98095->dai[1];
  1255. rate = params_rate(params);
  1256. switch (params_format(params)) {
  1257. case SNDRV_PCM_FORMAT_S16_LE:
  1258. snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
  1259. M98095_DAI_WS, 0);
  1260. break;
  1261. case SNDRV_PCM_FORMAT_S24_LE:
  1262. snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
  1263. M98095_DAI_WS, M98095_DAI_WS);
  1264. break;
  1265. default:
  1266. return -EINVAL;
  1267. }
  1268. if (rate_value(rate, &regval))
  1269. return -EINVAL;
  1270. snd_soc_update_bits(codec, M98095_031_DAI2_CLKMODE,
  1271. M98095_CLKMODE_MASK, regval);
  1272. cdata->rate = rate;
  1273. /* Configure NI when operating as master */
  1274. if (snd_soc_read(codec, M98095_034_DAI2_FORMAT) & M98095_DAI_MAS) {
  1275. if (max98095->sysclk == 0) {
  1276. dev_err(codec->dev, "Invalid system clock frequency\n");
  1277. return -EINVAL;
  1278. }
  1279. ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
  1280. * (unsigned long long int)rate;
  1281. do_div(ni, (unsigned long long int)max98095->sysclk);
  1282. snd_soc_write(codec, M98095_032_DAI2_CLKCFG_HI,
  1283. (ni >> 8) & 0x7F);
  1284. snd_soc_write(codec, M98095_033_DAI2_CLKCFG_LO,
  1285. ni & 0xFF);
  1286. }
  1287. /* Update sample rate mode */
  1288. if (rate < 50000)
  1289. snd_soc_update_bits(codec, M98095_038_DAI2_FILTERS,
  1290. M98095_DAI_DHF, 0);
  1291. else
  1292. snd_soc_update_bits(codec, M98095_038_DAI2_FILTERS,
  1293. M98095_DAI_DHF, M98095_DAI_DHF);
  1294. return 0;
  1295. }
  1296. static int max98095_dai3_hw_params(struct snd_pcm_substream *substream,
  1297. struct snd_pcm_hw_params *params,
  1298. struct snd_soc_dai *dai)
  1299. {
  1300. struct snd_soc_codec *codec = dai->codec;
  1301. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1302. struct max98095_cdata *cdata;
  1303. unsigned long long ni;
  1304. unsigned int rate;
  1305. u8 regval;
  1306. cdata = &max98095->dai[2];
  1307. rate = params_rate(params);
  1308. switch (params_format(params)) {
  1309. case SNDRV_PCM_FORMAT_S16_LE:
  1310. snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
  1311. M98095_DAI_WS, 0);
  1312. break;
  1313. case SNDRV_PCM_FORMAT_S24_LE:
  1314. snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
  1315. M98095_DAI_WS, M98095_DAI_WS);
  1316. break;
  1317. default:
  1318. return -EINVAL;
  1319. }
  1320. if (rate_value(rate, &regval))
  1321. return -EINVAL;
  1322. snd_soc_update_bits(codec, M98095_03B_DAI3_CLKMODE,
  1323. M98095_CLKMODE_MASK, regval);
  1324. cdata->rate = rate;
  1325. /* Configure NI when operating as master */
  1326. if (snd_soc_read(codec, M98095_03E_DAI3_FORMAT) & M98095_DAI_MAS) {
  1327. if (max98095->sysclk == 0) {
  1328. dev_err(codec->dev, "Invalid system clock frequency\n");
  1329. return -EINVAL;
  1330. }
  1331. ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
  1332. * (unsigned long long int)rate;
  1333. do_div(ni, (unsigned long long int)max98095->sysclk);
  1334. snd_soc_write(codec, M98095_03C_DAI3_CLKCFG_HI,
  1335. (ni >> 8) & 0x7F);
  1336. snd_soc_write(codec, M98095_03D_DAI3_CLKCFG_LO,
  1337. ni & 0xFF);
  1338. }
  1339. /* Update sample rate mode */
  1340. if (rate < 50000)
  1341. snd_soc_update_bits(codec, M98095_042_DAI3_FILTERS,
  1342. M98095_DAI_DHF, 0);
  1343. else
  1344. snd_soc_update_bits(codec, M98095_042_DAI3_FILTERS,
  1345. M98095_DAI_DHF, M98095_DAI_DHF);
  1346. return 0;
  1347. }
  1348. static int max98095_dai_set_sysclk(struct snd_soc_dai *dai,
  1349. int clk_id, unsigned int freq, int dir)
  1350. {
  1351. struct snd_soc_codec *codec = dai->codec;
  1352. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1353. /* Requested clock frequency is already setup */
  1354. if (freq == max98095->sysclk)
  1355. return 0;
  1356. max98095->sysclk = freq; /* remember current sysclk */
  1357. /* Setup clocks for slave mode, and using the PLL
  1358. * PSCLK = 0x01 (when master clk is 10MHz to 20MHz)
  1359. * 0x02 (when master clk is 20MHz to 40MHz)..
  1360. * 0x03 (when master clk is 40MHz to 60MHz)..
  1361. */
  1362. if ((freq >= 10000000) && (freq < 20000000)) {
  1363. snd_soc_write(codec, M98095_026_SYS_CLK, 0x10);
  1364. } else if ((freq >= 20000000) && (freq < 40000000)) {
  1365. snd_soc_write(codec, M98095_026_SYS_CLK, 0x20);
  1366. } else if ((freq >= 40000000) && (freq < 60000000)) {
  1367. snd_soc_write(codec, M98095_026_SYS_CLK, 0x30);
  1368. } else {
  1369. dev_err(codec->dev, "Invalid master clock frequency\n");
  1370. return -EINVAL;
  1371. }
  1372. dev_dbg(dai->dev, "Clock source is %d at %uHz\n", clk_id, freq);
  1373. max98095->sysclk = freq;
  1374. return 0;
  1375. }
  1376. static int max98095_dai1_set_fmt(struct snd_soc_dai *codec_dai,
  1377. unsigned int fmt)
  1378. {
  1379. struct snd_soc_codec *codec = codec_dai->codec;
  1380. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1381. struct max98095_cdata *cdata;
  1382. u8 regval = 0;
  1383. cdata = &max98095->dai[0];
  1384. if (fmt != cdata->fmt) {
  1385. cdata->fmt = fmt;
  1386. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  1387. case SND_SOC_DAIFMT_CBS_CFS:
  1388. /* Slave mode PLL */
  1389. snd_soc_write(codec, M98095_028_DAI1_CLKCFG_HI,
  1390. 0x80);
  1391. snd_soc_write(codec, M98095_029_DAI1_CLKCFG_LO,
  1392. 0x00);
  1393. break;
  1394. case SND_SOC_DAIFMT_CBM_CFM:
  1395. /* Set to master mode */
  1396. regval |= M98095_DAI_MAS;
  1397. break;
  1398. case SND_SOC_DAIFMT_CBS_CFM:
  1399. case SND_SOC_DAIFMT_CBM_CFS:
  1400. default:
  1401. dev_err(codec->dev, "Clock mode unsupported");
  1402. return -EINVAL;
  1403. }
  1404. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  1405. case SND_SOC_DAIFMT_I2S:
  1406. regval |= M98095_DAI_DLY;
  1407. break;
  1408. case SND_SOC_DAIFMT_LEFT_J:
  1409. break;
  1410. default:
  1411. return -EINVAL;
  1412. }
  1413. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  1414. case SND_SOC_DAIFMT_NB_NF:
  1415. break;
  1416. case SND_SOC_DAIFMT_NB_IF:
  1417. regval |= M98095_DAI_WCI;
  1418. break;
  1419. case SND_SOC_DAIFMT_IB_NF:
  1420. regval |= M98095_DAI_BCI;
  1421. break;
  1422. case SND_SOC_DAIFMT_IB_IF:
  1423. regval |= M98095_DAI_BCI|M98095_DAI_WCI;
  1424. break;
  1425. default:
  1426. return -EINVAL;
  1427. }
  1428. snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
  1429. M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
  1430. M98095_DAI_WCI, regval);
  1431. snd_soc_write(codec, M98095_02B_DAI1_CLOCK, M98095_DAI_BSEL64);
  1432. }
  1433. return 0;
  1434. }
  1435. static int max98095_dai2_set_fmt(struct snd_soc_dai *codec_dai,
  1436. unsigned int fmt)
  1437. {
  1438. struct snd_soc_codec *codec = codec_dai->codec;
  1439. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1440. struct max98095_cdata *cdata;
  1441. u8 regval = 0;
  1442. cdata = &max98095->dai[1];
  1443. if (fmt != cdata->fmt) {
  1444. cdata->fmt = fmt;
  1445. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  1446. case SND_SOC_DAIFMT_CBS_CFS:
  1447. /* Slave mode PLL */
  1448. snd_soc_write(codec, M98095_032_DAI2_CLKCFG_HI,
  1449. 0x80);
  1450. snd_soc_write(codec, M98095_033_DAI2_CLKCFG_LO,
  1451. 0x00);
  1452. break;
  1453. case SND_SOC_DAIFMT_CBM_CFM:
  1454. /* Set to master mode */
  1455. regval |= M98095_DAI_MAS;
  1456. break;
  1457. case SND_SOC_DAIFMT_CBS_CFM:
  1458. case SND_SOC_DAIFMT_CBM_CFS:
  1459. default:
  1460. dev_err(codec->dev, "Clock mode unsupported");
  1461. return -EINVAL;
  1462. }
  1463. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  1464. case SND_SOC_DAIFMT_I2S:
  1465. regval |= M98095_DAI_DLY;
  1466. break;
  1467. case SND_SOC_DAIFMT_LEFT_J:
  1468. break;
  1469. default:
  1470. return -EINVAL;
  1471. }
  1472. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  1473. case SND_SOC_DAIFMT_NB_NF:
  1474. break;
  1475. case SND_SOC_DAIFMT_NB_IF:
  1476. regval |= M98095_DAI_WCI;
  1477. break;
  1478. case SND_SOC_DAIFMT_IB_NF:
  1479. regval |= M98095_DAI_BCI;
  1480. break;
  1481. case SND_SOC_DAIFMT_IB_IF:
  1482. regval |= M98095_DAI_BCI|M98095_DAI_WCI;
  1483. break;
  1484. default:
  1485. return -EINVAL;
  1486. }
  1487. snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
  1488. M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
  1489. M98095_DAI_WCI, regval);
  1490. snd_soc_write(codec, M98095_035_DAI2_CLOCK,
  1491. M98095_DAI_BSEL64);
  1492. }
  1493. return 0;
  1494. }
  1495. static int max98095_dai3_set_fmt(struct snd_soc_dai *codec_dai,
  1496. unsigned int fmt)
  1497. {
  1498. struct snd_soc_codec *codec = codec_dai->codec;
  1499. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1500. struct max98095_cdata *cdata;
  1501. u8 regval = 0;
  1502. cdata = &max98095->dai[2];
  1503. if (fmt != cdata->fmt) {
  1504. cdata->fmt = fmt;
  1505. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  1506. case SND_SOC_DAIFMT_CBS_CFS:
  1507. /* Slave mode PLL */
  1508. snd_soc_write(codec, M98095_03C_DAI3_CLKCFG_HI,
  1509. 0x80);
  1510. snd_soc_write(codec, M98095_03D_DAI3_CLKCFG_LO,
  1511. 0x00);
  1512. break;
  1513. case SND_SOC_DAIFMT_CBM_CFM:
  1514. /* Set to master mode */
  1515. regval |= M98095_DAI_MAS;
  1516. break;
  1517. case SND_SOC_DAIFMT_CBS_CFM:
  1518. case SND_SOC_DAIFMT_CBM_CFS:
  1519. default:
  1520. dev_err(codec->dev, "Clock mode unsupported");
  1521. return -EINVAL;
  1522. }
  1523. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  1524. case SND_SOC_DAIFMT_I2S:
  1525. regval |= M98095_DAI_DLY;
  1526. break;
  1527. case SND_SOC_DAIFMT_LEFT_J:
  1528. break;
  1529. default:
  1530. return -EINVAL;
  1531. }
  1532. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  1533. case SND_SOC_DAIFMT_NB_NF:
  1534. break;
  1535. case SND_SOC_DAIFMT_NB_IF:
  1536. regval |= M98095_DAI_WCI;
  1537. break;
  1538. case SND_SOC_DAIFMT_IB_NF:
  1539. regval |= M98095_DAI_BCI;
  1540. break;
  1541. case SND_SOC_DAIFMT_IB_IF:
  1542. regval |= M98095_DAI_BCI|M98095_DAI_WCI;
  1543. break;
  1544. default:
  1545. return -EINVAL;
  1546. }
  1547. snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
  1548. M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
  1549. M98095_DAI_WCI, regval);
  1550. snd_soc_write(codec, M98095_03F_DAI3_CLOCK,
  1551. M98095_DAI_BSEL64);
  1552. }
  1553. return 0;
  1554. }
  1555. static int max98095_set_bias_level(struct snd_soc_codec *codec,
  1556. enum snd_soc_bias_level level)
  1557. {
  1558. int ret;
  1559. switch (level) {
  1560. case SND_SOC_BIAS_ON:
  1561. break;
  1562. case SND_SOC_BIAS_PREPARE:
  1563. break;
  1564. case SND_SOC_BIAS_STANDBY:
  1565. if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
  1566. ret = snd_soc_cache_sync(codec);
  1567. if (ret != 0) {
  1568. dev_err(codec->dev, "Failed to sync cache: %d\n", ret);
  1569. return ret;
  1570. }
  1571. }
  1572. snd_soc_update_bits(codec, M98095_090_PWR_EN_IN,
  1573. M98095_MBEN, M98095_MBEN);
  1574. break;
  1575. case SND_SOC_BIAS_OFF:
  1576. snd_soc_update_bits(codec, M98095_090_PWR_EN_IN,
  1577. M98095_MBEN, 0);
  1578. codec->cache_sync = 1;
  1579. break;
  1580. }
  1581. codec->dapm.bias_level = level;
  1582. return 0;
  1583. }
  1584. #define MAX98095_RATES SNDRV_PCM_RATE_8000_96000
  1585. #define MAX98095_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE)
  1586. static struct snd_soc_dai_ops max98095_dai1_ops = {
  1587. .set_sysclk = max98095_dai_set_sysclk,
  1588. .set_fmt = max98095_dai1_set_fmt,
  1589. .hw_params = max98095_dai1_hw_params,
  1590. };
  1591. static struct snd_soc_dai_ops max98095_dai2_ops = {
  1592. .set_sysclk = max98095_dai_set_sysclk,
  1593. .set_fmt = max98095_dai2_set_fmt,
  1594. .hw_params = max98095_dai2_hw_params,
  1595. };
  1596. static struct snd_soc_dai_ops max98095_dai3_ops = {
  1597. .set_sysclk = max98095_dai_set_sysclk,
  1598. .set_fmt = max98095_dai3_set_fmt,
  1599. .hw_params = max98095_dai3_hw_params,
  1600. };
  1601. static struct snd_soc_dai_driver max98095_dai[] = {
  1602. {
  1603. .name = "HiFi",
  1604. .playback = {
  1605. .stream_name = "HiFi Playback",
  1606. .channels_min = 1,
  1607. .channels_max = 2,
  1608. .rates = MAX98095_RATES,
  1609. .formats = MAX98095_FORMATS,
  1610. },
  1611. .capture = {
  1612. .stream_name = "HiFi Capture",
  1613. .channels_min = 1,
  1614. .channels_max = 2,
  1615. .rates = MAX98095_RATES,
  1616. .formats = MAX98095_FORMATS,
  1617. },
  1618. .ops = &max98095_dai1_ops,
  1619. },
  1620. {
  1621. .name = "Aux",
  1622. .playback = {
  1623. .stream_name = "Aux Playback",
  1624. .channels_min = 1,
  1625. .channels_max = 1,
  1626. .rates = MAX98095_RATES,
  1627. .formats = MAX98095_FORMATS,
  1628. },
  1629. .ops = &max98095_dai2_ops,
  1630. },
  1631. {
  1632. .name = "Voice",
  1633. .playback = {
  1634. .stream_name = "Voice Playback",
  1635. .channels_min = 1,
  1636. .channels_max = 1,
  1637. .rates = MAX98095_RATES,
  1638. .formats = MAX98095_FORMATS,
  1639. },
  1640. .ops = &max98095_dai3_ops,
  1641. }
  1642. };
  1643. static int max98095_get_eq_channel(const char *name)
  1644. {
  1645. if (strcmp(name, "EQ1 Mode") == 0)
  1646. return 0;
  1647. if (strcmp(name, "EQ2 Mode") == 0)
  1648. return 1;
  1649. return -EINVAL;
  1650. }
  1651. static int max98095_put_eq_enum(struct snd_kcontrol *kcontrol,
  1652. struct snd_ctl_elem_value *ucontrol)
  1653. {
  1654. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  1655. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1656. struct max98095_pdata *pdata = max98095->pdata;
  1657. int channel = max98095_get_eq_channel(kcontrol->id.name);
  1658. struct max98095_cdata *cdata;
  1659. int sel = ucontrol->value.integer.value[0];
  1660. struct max98095_eq_cfg *coef_set;
  1661. int fs, best, best_val, i;
  1662. int regmask, regsave;
  1663. BUG_ON(channel > 1);
  1664. if (!pdata || !max98095->eq_textcnt)
  1665. return 0;
  1666. if (sel >= pdata->eq_cfgcnt)
  1667. return -EINVAL;
  1668. cdata = &max98095->dai[channel];
  1669. cdata->eq_sel = sel;
  1670. fs = cdata->rate;
  1671. /* Find the selected configuration with nearest sample rate */
  1672. best = 0;
  1673. best_val = INT_MAX;
  1674. for (i = 0; i < pdata->eq_cfgcnt; i++) {
  1675. if (strcmp(pdata->eq_cfg[i].name, max98095->eq_texts[sel]) == 0 &&
  1676. abs(pdata->eq_cfg[i].rate - fs) < best_val) {
  1677. best = i;
  1678. best_val = abs(pdata->eq_cfg[i].rate - fs);
  1679. }
  1680. }
  1681. dev_dbg(codec->dev, "Selected %s/%dHz for %dHz sample rate\n",
  1682. pdata->eq_cfg[best].name,
  1683. pdata->eq_cfg[best].rate, fs);
  1684. coef_set = &pdata->eq_cfg[best];
  1685. regmask = (channel == 0) ? M98095_EQ1EN : M98095_EQ2EN;
  1686. /* Disable filter while configuring, and save current on/off state */
  1687. regsave = snd_soc_read(codec, M98095_088_CFG_LEVEL);
  1688. snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, 0);
  1689. mutex_lock(&codec->mutex);
  1690. snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
  1691. m98095_eq_band(codec, channel, 0, coef_set->band1);
  1692. m98095_eq_band(codec, channel, 1, coef_set->band2);
  1693. m98095_eq_band(codec, channel, 2, coef_set->band3);
  1694. m98095_eq_band(codec, channel, 3, coef_set->band4);
  1695. m98095_eq_band(codec, channel, 4, coef_set->band5);
  1696. snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, 0);
  1697. mutex_unlock(&codec->mutex);
  1698. /* Restore the original on/off state */
  1699. snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, regsave);
  1700. return 0;
  1701. }
  1702. static int max98095_get_eq_enum(struct snd_kcontrol *kcontrol,
  1703. struct snd_ctl_elem_value *ucontrol)
  1704. {
  1705. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  1706. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1707. int channel = max98095_get_eq_channel(kcontrol->id.name);
  1708. struct max98095_cdata *cdata;
  1709. cdata = &max98095->dai[channel];
  1710. ucontrol->value.enumerated.item[0] = cdata->eq_sel;
  1711. return 0;
  1712. }
  1713. static void max98095_handle_eq_pdata(struct snd_soc_codec *codec)
  1714. {
  1715. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1716. struct max98095_pdata *pdata = max98095->pdata;
  1717. struct max98095_eq_cfg *cfg;
  1718. unsigned int cfgcnt;
  1719. int i, j;
  1720. const char **t;
  1721. int ret;
  1722. struct snd_kcontrol_new controls[] = {
  1723. SOC_ENUM_EXT("EQ1 Mode",
  1724. max98095->eq_enum,
  1725. max98095_get_eq_enum,
  1726. max98095_put_eq_enum),
  1727. SOC_ENUM_EXT("EQ2 Mode",
  1728. max98095->eq_enum,
  1729. max98095_get_eq_enum,
  1730. max98095_put_eq_enum),
  1731. };
  1732. cfg = pdata->eq_cfg;
  1733. cfgcnt = pdata->eq_cfgcnt;
  1734. /* Setup an array of texts for the equalizer enum.
  1735. * This is based on Mark Brown's equalizer driver code.
  1736. */
  1737. max98095->eq_textcnt = 0;
  1738. max98095->eq_texts = NULL;
  1739. for (i = 0; i < cfgcnt; i++) {
  1740. for (j = 0; j < max98095->eq_textcnt; j++) {
  1741. if (strcmp(cfg[i].name, max98095->eq_texts[j]) == 0)
  1742. break;
  1743. }
  1744. if (j != max98095->eq_textcnt)
  1745. continue;
  1746. /* Expand the array */
  1747. t = krealloc(max98095->eq_texts,
  1748. sizeof(char *) * (max98095->eq_textcnt + 1),
  1749. GFP_KERNEL);
  1750. if (t == NULL)
  1751. continue;
  1752. /* Store the new entry */
  1753. t[max98095->eq_textcnt] = cfg[i].name;
  1754. max98095->eq_textcnt++;
  1755. max98095->eq_texts = t;
  1756. }
  1757. /* Now point the soc_enum to .texts array items */
  1758. max98095->eq_enum.texts = max98095->eq_texts;
  1759. max98095->eq_enum.max = max98095->eq_textcnt;
  1760. ret = snd_soc_add_controls(codec, controls, ARRAY_SIZE(controls));
  1761. if (ret != 0)
  1762. dev_err(codec->dev, "Failed to add EQ control: %d\n", ret);
  1763. }
  1764. static int max98095_get_bq_channel(const char *name)
  1765. {
  1766. if (strcmp(name, "Biquad1 Mode") == 0)
  1767. return 0;
  1768. if (strcmp(name, "Biquad2 Mode") == 0)
  1769. return 1;
  1770. return -EINVAL;
  1771. }
  1772. static int max98095_put_bq_enum(struct snd_kcontrol *kcontrol,
  1773. struct snd_ctl_elem_value *ucontrol)
  1774. {
  1775. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  1776. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1777. struct max98095_pdata *pdata = max98095->pdata;
  1778. int channel = max98095_get_bq_channel(kcontrol->id.name);
  1779. struct max98095_cdata *cdata;
  1780. int sel = ucontrol->value.integer.value[0];
  1781. struct max98095_biquad_cfg *coef_set;
  1782. int fs, best, best_val, i;
  1783. int regmask, regsave;
  1784. BUG_ON(channel > 1);
  1785. if (!pdata || !max98095->bq_textcnt)
  1786. return 0;
  1787. if (sel >= pdata->bq_cfgcnt)
  1788. return -EINVAL;
  1789. cdata = &max98095->dai[channel];
  1790. cdata->bq_sel = sel;
  1791. fs = cdata->rate;
  1792. /* Find the selected configuration with nearest sample rate */
  1793. best = 0;
  1794. best_val = INT_MAX;
  1795. for (i = 0; i < pdata->bq_cfgcnt; i++) {
  1796. if (strcmp(pdata->bq_cfg[i].name, max98095->bq_texts[sel]) == 0 &&
  1797. abs(pdata->bq_cfg[i].rate - fs) < best_val) {
  1798. best = i;
  1799. best_val = abs(pdata->bq_cfg[i].rate - fs);
  1800. }
  1801. }
  1802. dev_dbg(codec->dev, "Selected %s/%dHz for %dHz sample rate\n",
  1803. pdata->bq_cfg[best].name,
  1804. pdata->bq_cfg[best].rate, fs);
  1805. coef_set = &pdata->bq_cfg[best];
  1806. regmask = (channel == 0) ? M98095_BQ1EN : M98095_BQ2EN;
  1807. /* Disable filter while configuring, and save current on/off state */
  1808. regsave = snd_soc_read(codec, M98095_088_CFG_LEVEL);
  1809. snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, 0);
  1810. mutex_lock(&codec->mutex);
  1811. snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
  1812. m98095_biquad_band(codec, channel, 0, coef_set->band1);
  1813. m98095_biquad_band(codec, channel, 1, coef_set->band2);
  1814. snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, 0);
  1815. mutex_unlock(&codec->mutex);
  1816. /* Restore the original on/off state */
  1817. snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, regsave);
  1818. return 0;
  1819. }
  1820. static int max98095_get_bq_enum(struct snd_kcontrol *kcontrol,
  1821. struct snd_ctl_elem_value *ucontrol)
  1822. {
  1823. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  1824. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1825. int channel = max98095_get_bq_channel(kcontrol->id.name);
  1826. struct max98095_cdata *cdata;
  1827. cdata = &max98095->dai[channel];
  1828. ucontrol->value.enumerated.item[0] = cdata->bq_sel;
  1829. return 0;
  1830. }
  1831. static void max98095_handle_bq_pdata(struct snd_soc_codec *codec)
  1832. {
  1833. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1834. struct max98095_pdata *pdata = max98095->pdata;
  1835. struct max98095_biquad_cfg *cfg;
  1836. unsigned int cfgcnt;
  1837. int i, j;
  1838. const char **t;
  1839. int ret;
  1840. struct snd_kcontrol_new controls[] = {
  1841. SOC_ENUM_EXT("Biquad1 Mode",
  1842. max98095->bq_enum,
  1843. max98095_get_bq_enum,
  1844. max98095_put_bq_enum),
  1845. SOC_ENUM_EXT("Biquad2 Mode",
  1846. max98095->bq_enum,
  1847. max98095_get_bq_enum,
  1848. max98095_put_bq_enum),
  1849. };
  1850. cfg = pdata->bq_cfg;
  1851. cfgcnt = pdata->bq_cfgcnt;
  1852. /* Setup an array of texts for the biquad enum.
  1853. * This is based on Mark Brown's equalizer driver code.
  1854. */
  1855. max98095->bq_textcnt = 0;
  1856. max98095->bq_texts = NULL;
  1857. for (i = 0; i < cfgcnt; i++) {
  1858. for (j = 0; j < max98095->bq_textcnt; j++) {
  1859. if (strcmp(cfg[i].name, max98095->bq_texts[j]) == 0)
  1860. break;
  1861. }
  1862. if (j != max98095->bq_textcnt)
  1863. continue;
  1864. /* Expand the array */
  1865. t = krealloc(max98095->bq_texts,
  1866. sizeof(char *) * (max98095->bq_textcnt + 1),
  1867. GFP_KERNEL);
  1868. if (t == NULL)
  1869. continue;
  1870. /* Store the new entry */
  1871. t[max98095->bq_textcnt] = cfg[i].name;
  1872. max98095->bq_textcnt++;
  1873. max98095->bq_texts = t;
  1874. }
  1875. /* Now point the soc_enum to .texts array items */
  1876. max98095->bq_enum.texts = max98095->bq_texts;
  1877. max98095->bq_enum.max = max98095->bq_textcnt;
  1878. ret = snd_soc_add_controls(codec, controls, ARRAY_SIZE(controls));
  1879. if (ret != 0)
  1880. dev_err(codec->dev, "Failed to add Biquad control: %d\n", ret);
  1881. }
  1882. static void max98095_handle_pdata(struct snd_soc_codec *codec)
  1883. {
  1884. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1885. struct max98095_pdata *pdata = max98095->pdata;
  1886. u8 regval = 0;
  1887. if (!pdata) {
  1888. dev_dbg(codec->dev, "No platform data\n");
  1889. return;
  1890. }
  1891. /* Configure mic for analog/digital mic mode */
  1892. if (pdata->digmic_left_mode)
  1893. regval |= M98095_DIGMIC_L;
  1894. if (pdata->digmic_right_mode)
  1895. regval |= M98095_DIGMIC_R;
  1896. snd_soc_write(codec, M98095_087_CFG_MIC, regval);
  1897. /* Configure equalizers */
  1898. if (pdata->eq_cfgcnt)
  1899. max98095_handle_eq_pdata(codec);
  1900. /* Configure bi-quad filters */
  1901. if (pdata->bq_cfgcnt)
  1902. max98095_handle_bq_pdata(codec);
  1903. }
  1904. #ifdef CONFIG_PM
  1905. static int max98095_suspend(struct snd_soc_codec *codec, pm_message_t state)
  1906. {
  1907. max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1908. return 0;
  1909. }
  1910. static int max98095_resume(struct snd_soc_codec *codec)
  1911. {
  1912. max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1913. return 0;
  1914. }
  1915. #else
  1916. #define max98095_suspend NULL
  1917. #define max98095_resume NULL
  1918. #endif
  1919. static int max98095_reset(struct snd_soc_codec *codec)
  1920. {
  1921. int i, ret;
  1922. /* Gracefully reset the DSP core and the codec hardware
  1923. * in a proper sequence */
  1924. ret = snd_soc_write(codec, M98095_00F_HOST_CFG, 0);
  1925. if (ret < 0) {
  1926. dev_err(codec->dev, "Failed to reset DSP: %d\n", ret);
  1927. return ret;
  1928. }
  1929. ret = snd_soc_write(codec, M98095_097_PWR_SYS, 0);
  1930. if (ret < 0) {
  1931. dev_err(codec->dev, "Failed to reset codec: %d\n", ret);
  1932. return ret;
  1933. }
  1934. /* Reset to hardware default for registers, as there is not
  1935. * a soft reset hardware control register */
  1936. for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
  1937. ret = snd_soc_write(codec, i, max98095_reg_def[i]);
  1938. if (ret < 0) {
  1939. dev_err(codec->dev, "Failed to reset: %d\n", ret);
  1940. return ret;
  1941. }
  1942. }
  1943. return ret;
  1944. }
  1945. static int max98095_probe(struct snd_soc_codec *codec)
  1946. {
  1947. struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
  1948. struct max98095_cdata *cdata;
  1949. int ret = 0;
  1950. ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);
  1951. if (ret != 0) {
  1952. dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
  1953. return ret;
  1954. }
  1955. /* reset the codec, the DSP core, and disable all interrupts */
  1956. max98095_reset(codec);
  1957. /* initialize private data */
  1958. max98095->sysclk = (unsigned)-1;
  1959. max98095->eq_textcnt = 0;
  1960. max98095->bq_textcnt = 0;
  1961. cdata = &max98095->dai[0];
  1962. cdata->rate = (unsigned)-1;
  1963. cdata->fmt = (unsigned)-1;
  1964. cdata->eq_sel = 0;
  1965. cdata->bq_sel = 0;
  1966. cdata = &max98095->dai[1];
  1967. cdata->rate = (unsigned)-1;
  1968. cdata->fmt = (unsigned)-1;
  1969. cdata->eq_sel = 0;
  1970. cdata->bq_sel = 0;
  1971. cdata = &max98095->dai[2];
  1972. cdata->rate = (unsigned)-1;
  1973. cdata->fmt = (unsigned)-1;
  1974. cdata->eq_sel = 0;
  1975. cdata->bq_sel = 0;
  1976. max98095->lin_state = 0;
  1977. max98095->mic1pre = 0;
  1978. max98095->mic2pre = 0;
  1979. ret = snd_soc_read(codec, M98095_0FF_REV_ID);
  1980. if (ret < 0) {
  1981. dev_err(codec->dev, "Failed to read device revision: %d\n",
  1982. ret);
  1983. goto err_access;
  1984. }
  1985. dev_info(codec->dev, "revision %c\n", ret + 'A');
  1986. snd_soc_write(codec, M98095_097_PWR_SYS, M98095_PWRSV);
  1987. /* initialize registers cache to hardware default */
  1988. max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1989. snd_soc_write(codec, M98095_048_MIX_DAC_LR,
  1990. M98095_DAI1L_TO_DACL|M98095_DAI1R_TO_DACR);
  1991. snd_soc_write(codec, M98095_049_MIX_DAC_M,
  1992. M98095_DAI2M_TO_DACM|M98095_DAI3M_TO_DACM);
  1993. snd_soc_write(codec, M98095_092_PWR_EN_OUT, M98095_SPK_SPREADSPECTRUM);
  1994. snd_soc_write(codec, M98095_045_CFG_DSP, M98095_DSPNORMAL);
  1995. snd_soc_write(codec, M98095_04E_CFG_HP, M98095_HPNORMAL);
  1996. snd_soc_write(codec, M98095_02C_DAI1_IOCFG,
  1997. M98095_S1NORMAL|M98095_SDATA);
  1998. snd_soc_write(codec, M98095_036_DAI2_IOCFG,
  1999. M98095_S2NORMAL|M98095_SDATA);
  2000. snd_soc_write(codec, M98095_040_DAI3_IOCFG,
  2001. M98095_S3NORMAL|M98095_SDATA);
  2002. max98095_handle_pdata(codec);
  2003. /* take the codec out of the shut down */
  2004. snd_soc_update_bits(codec, M98095_097_PWR_SYS, M98095_SHDNRUN,
  2005. M98095_SHDNRUN);
  2006. max98095_add_widgets(codec);
  2007. err_access:
  2008. return ret;
  2009. }
  2010. static int max98095_remove(struct snd_soc_codec *codec)
  2011. {
  2012. max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
  2013. return 0;
  2014. }
  2015. static struct snd_soc_codec_driver soc_codec_dev_max98095 = {
  2016. .probe = max98095_probe,
  2017. .remove = max98095_remove,
  2018. .suspend = max98095_suspend,
  2019. .resume = max98095_resume,
  2020. .set_bias_level = max98095_set_bias_level,
  2021. .reg_cache_size = ARRAY_SIZE(max98095_reg_def),
  2022. .reg_word_size = sizeof(u8),
  2023. .reg_cache_default = max98095_reg_def,
  2024. .readable_register = max98095_readable,
  2025. .volatile_register = max98095_volatile,
  2026. .dapm_widgets = max98095_dapm_widgets,
  2027. .num_dapm_widgets = ARRAY_SIZE(max98095_dapm_widgets),
  2028. .dapm_routes = max98095_audio_map,
  2029. .num_dapm_routes = ARRAY_SIZE(max98095_audio_map),
  2030. };
  2031. static int max98095_i2c_probe(struct i2c_client *i2c,
  2032. const struct i2c_device_id *id)
  2033. {
  2034. struct max98095_priv *max98095;
  2035. int ret;
  2036. max98095 = kzalloc(sizeof(struct max98095_priv), GFP_KERNEL);
  2037. if (max98095 == NULL)
  2038. return -ENOMEM;
  2039. max98095->devtype = id->driver_data;
  2040. i2c_set_clientdata(i2c, max98095);
  2041. max98095->control_data = i2c;
  2042. max98095->pdata = i2c->dev.platform_data;
  2043. ret = snd_soc_register_codec(&i2c->dev,
  2044. &soc_codec_dev_max98095, &max98095_dai[0], 3);
  2045. if (ret < 0)
  2046. kfree(max98095);
  2047. return ret;
  2048. }
  2049. static int __devexit max98095_i2c_remove(struct i2c_client *client)
  2050. {
  2051. snd_soc_unregister_codec(&client->dev);
  2052. kfree(i2c_get_clientdata(client));
  2053. return 0;
  2054. }
  2055. static const struct i2c_device_id max98095_i2c_id[] = {
  2056. { "max98095", MAX98095 },
  2057. { }
  2058. };
  2059. MODULE_DEVICE_TABLE(i2c, max98095_i2c_id);
  2060. static struct i2c_driver max98095_i2c_driver = {
  2061. .driver = {
  2062. .name = "max98095",
  2063. .owner = THIS_MODULE,
  2064. },
  2065. .probe = max98095_i2c_probe,
  2066. .remove = __devexit_p(max98095_i2c_remove),
  2067. .id_table = max98095_i2c_id,
  2068. };
  2069. static int __init max98095_init(void)
  2070. {
  2071. int ret;
  2072. ret = i2c_add_driver(&max98095_i2c_driver);
  2073. if (ret)
  2074. pr_err("Failed to register max98095 I2C driver: %d\n", ret);
  2075. return ret;
  2076. }
  2077. module_init(max98095_init);
  2078. static void __exit max98095_exit(void)
  2079. {
  2080. i2c_del_driver(&max98095_i2c_driver);
  2081. }
  2082. module_exit(max98095_exit);
  2083. MODULE_DESCRIPTION("ALSA SoC MAX98095 driver");
  2084. MODULE_AUTHOR("Peter Hsiang");
  2085. MODULE_LICENSE("GPL");