wm8753.c 50 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740
  1. /*
  2. * wm8753.c -- WM8753 ALSA Soc Audio driver
  3. *
  4. * Copyright 2003 Wolfson Microelectronics PLC.
  5. * Author: Liam Girdwood <lrg@slimlogic.co.uk>
  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. * Notes:
  13. * The WM8753 is a low power, high quality stereo codec with integrated PCM
  14. * codec designed for portable digital telephony applications.
  15. *
  16. * Dual DAI:-
  17. *
  18. * This driver support 2 DAI PCM's. This makes the default PCM available for
  19. * HiFi audio (e.g. MP3, ogg) playback/capture and the other PCM available for
  20. * voice.
  21. *
  22. * Please note that the voice PCM can be connected directly to a Bluetooth
  23. * codec or GSM modem and thus cannot be read or written to, although it is
  24. * available to be configured with snd_hw_params(), etc and kcontrols in the
  25. * normal alsa manner.
  26. *
  27. * Fast DAI switching:-
  28. *
  29. * The driver can now fast switch between the DAI configurations via a
  30. * an alsa kcontrol. This allows the PCM to remain open.
  31. *
  32. */
  33. #include <linux/module.h>
  34. #include <linux/moduleparam.h>
  35. #include <linux/kernel.h>
  36. #include <linux/init.h>
  37. #include <linux/delay.h>
  38. #include <linux/pm.h>
  39. #include <linux/i2c.h>
  40. #include <linux/platform_device.h>
  41. #include <linux/spi/spi.h>
  42. #include <linux/slab.h>
  43. #include <sound/core.h>
  44. #include <sound/pcm.h>
  45. #include <sound/pcm_params.h>
  46. #include <sound/soc.h>
  47. #include <sound/soc-dapm.h>
  48. #include <sound/initval.h>
  49. #include <sound/tlv.h>
  50. #include <asm/div64.h>
  51. #include "wm8753.h"
  52. static int caps_charge = 2000;
  53. module_param(caps_charge, int, 0);
  54. MODULE_PARM_DESC(caps_charge, "WM8753 cap charge time (msecs)");
  55. static void wm8753_set_dai_mode(struct snd_soc_codec *codec,
  56. struct snd_soc_dai *dai, unsigned int hifi);
  57. /*
  58. * wm8753 register cache
  59. * We can't read the WM8753 register space when we
  60. * are using 2 wire for device control, so we cache them instead.
  61. */
  62. static const u16 wm8753_reg[] = {
  63. 0x0008, 0x0000, 0x000a, 0x000a,
  64. 0x0033, 0x0000, 0x0007, 0x00ff,
  65. 0x00ff, 0x000f, 0x000f, 0x007b,
  66. 0x0000, 0x0032, 0x0000, 0x00c3,
  67. 0x00c3, 0x00c0, 0x0000, 0x0000,
  68. 0x0000, 0x0000, 0x0000, 0x0000,
  69. 0x0000, 0x0000, 0x0000, 0x0000,
  70. 0x0000, 0x0000, 0x0000, 0x0055,
  71. 0x0005, 0x0050, 0x0055, 0x0050,
  72. 0x0055, 0x0050, 0x0055, 0x0079,
  73. 0x0079, 0x0079, 0x0079, 0x0079,
  74. 0x0000, 0x0000, 0x0000, 0x0000,
  75. 0x0097, 0x0097, 0x0000, 0x0004,
  76. 0x0000, 0x0083, 0x0024, 0x01ba,
  77. 0x0000, 0x0083, 0x0024, 0x01ba,
  78. 0x0000, 0x0000, 0x0000
  79. };
  80. /* codec private data */
  81. struct wm8753_priv {
  82. enum snd_soc_control_type control_type;
  83. unsigned int sysclk;
  84. unsigned int pcmclk;
  85. u16 reg_cache[ARRAY_SIZE(wm8753_reg)];
  86. int dai_func;
  87. };
  88. /*
  89. * read wm8753 register cache
  90. */
  91. static inline unsigned int wm8753_read_reg_cache(struct snd_soc_codec *codec,
  92. unsigned int reg)
  93. {
  94. u16 *cache = codec->reg_cache;
  95. if (reg < 1 || reg >= (ARRAY_SIZE(wm8753_reg) + 1))
  96. return -1;
  97. return cache[reg - 1];
  98. }
  99. /*
  100. * write wm8753 register cache
  101. */
  102. static inline void wm8753_write_reg_cache(struct snd_soc_codec *codec,
  103. unsigned int reg, unsigned int value)
  104. {
  105. u16 *cache = codec->reg_cache;
  106. if (reg < 1 || reg >= (ARRAY_SIZE(wm8753_reg) + 1))
  107. return;
  108. cache[reg - 1] = value;
  109. }
  110. /*
  111. * write to the WM8753 register space
  112. */
  113. static int wm8753_write(struct snd_soc_codec *codec, unsigned int reg,
  114. unsigned int value)
  115. {
  116. u8 data[2];
  117. /* data is
  118. * D15..D9 WM8753 register offset
  119. * D8...D0 register data
  120. */
  121. data[0] = (reg << 1) | ((value >> 8) & 0x0001);
  122. data[1] = value & 0x00ff;
  123. wm8753_write_reg_cache(codec, reg, value);
  124. if (codec->hw_write(codec->control_data, data, 2) == 2)
  125. return 0;
  126. else
  127. return -EIO;
  128. }
  129. #define wm8753_reset(c) wm8753_write(c, WM8753_RESET, 0)
  130. /*
  131. * WM8753 Controls
  132. */
  133. static const char *wm8753_base[] = {"Linear Control", "Adaptive Boost"};
  134. static const char *wm8753_base_filter[] =
  135. {"130Hz @ 48kHz", "200Hz @ 48kHz", "100Hz @ 16kHz", "400Hz @ 48kHz",
  136. "100Hz @ 8kHz", "200Hz @ 8kHz"};
  137. static const char *wm8753_treble[] = {"8kHz", "4kHz"};
  138. static const char *wm8753_alc_func[] = {"Off", "Right", "Left", "Stereo"};
  139. static const char *wm8753_ng_type[] = {"Constant PGA Gain", "Mute ADC Output"};
  140. static const char *wm8753_3d_func[] = {"Capture", "Playback"};
  141. static const char *wm8753_3d_uc[] = {"2.2kHz", "1.5kHz"};
  142. static const char *wm8753_3d_lc[] = {"200Hz", "500Hz"};
  143. static const char *wm8753_deemp[] = {"None", "32kHz", "44.1kHz", "48kHz"};
  144. static const char *wm8753_mono_mix[] = {"Stereo", "Left", "Right", "Mono"};
  145. static const char *wm8753_dac_phase[] = {"Non Inverted", "Inverted"};
  146. static const char *wm8753_line_mix[] = {"Line 1 + 2", "Line 1 - 2",
  147. "Line 1", "Line 2"};
  148. static const char *wm8753_mono_mux[] = {"Line Mix", "Rx Mix"};
  149. static const char *wm8753_right_mux[] = {"Line 2", "Rx Mix"};
  150. static const char *wm8753_left_mux[] = {"Line 1", "Rx Mix"};
  151. static const char *wm8753_rxmsel[] = {"RXP - RXN", "RXP + RXN", "RXP", "RXN"};
  152. static const char *wm8753_sidetone_mux[] = {"Left PGA", "Mic 1", "Mic 2",
  153. "Right PGA"};
  154. static const char *wm8753_mono2_src[] = {"Inverted Mono 1", "Left", "Right",
  155. "Left + Right"};
  156. static const char *wm8753_out3[] = {"VREF", "ROUT2", "Left + Right"};
  157. static const char *wm8753_out4[] = {"VREF", "Capture ST", "LOUT2"};
  158. static const char *wm8753_radcsel[] = {"PGA", "Line or RXP-RXN", "Sidetone"};
  159. static const char *wm8753_ladcsel[] = {"PGA", "Line or RXP-RXN", "Line"};
  160. static const char *wm8753_mono_adc[] = {"Stereo", "Analogue Mix Left",
  161. "Analogue Mix Right", "Digital Mono Mix"};
  162. static const char *wm8753_adc_hp[] = {"3.4Hz @ 48kHz", "82Hz @ 16k",
  163. "82Hz @ 8kHz", "170Hz @ 8kHz"};
  164. static const char *wm8753_adc_filter[] = {"HiFi", "Voice"};
  165. static const char *wm8753_mic_sel[] = {"Mic 1", "Mic 2", "Mic 3"};
  166. static const char *wm8753_dai_mode[] = {"DAI 0", "DAI 1", "DAI 2", "DAI 3"};
  167. static const char *wm8753_dat_sel[] = {"Stereo", "Left ADC", "Right ADC",
  168. "Channel Swap"};
  169. static const char *wm8753_rout2_phase[] = {"Non Inverted", "Inverted"};
  170. static const struct soc_enum wm8753_enum[] = {
  171. SOC_ENUM_SINGLE(WM8753_BASS, 7, 2, wm8753_base),
  172. SOC_ENUM_SINGLE(WM8753_BASS, 4, 6, wm8753_base_filter),
  173. SOC_ENUM_SINGLE(WM8753_TREBLE, 6, 2, wm8753_treble),
  174. SOC_ENUM_SINGLE(WM8753_ALC1, 7, 4, wm8753_alc_func),
  175. SOC_ENUM_SINGLE(WM8753_NGATE, 1, 2, wm8753_ng_type),
  176. SOC_ENUM_SINGLE(WM8753_3D, 7, 2, wm8753_3d_func),
  177. SOC_ENUM_SINGLE(WM8753_3D, 6, 2, wm8753_3d_uc),
  178. SOC_ENUM_SINGLE(WM8753_3D, 5, 2, wm8753_3d_lc),
  179. SOC_ENUM_SINGLE(WM8753_DAC, 1, 4, wm8753_deemp),
  180. SOC_ENUM_SINGLE(WM8753_DAC, 4, 4, wm8753_mono_mix),
  181. SOC_ENUM_SINGLE(WM8753_DAC, 6, 2, wm8753_dac_phase),
  182. SOC_ENUM_SINGLE(WM8753_INCTL1, 3, 4, wm8753_line_mix),
  183. SOC_ENUM_SINGLE(WM8753_INCTL1, 2, 2, wm8753_mono_mux),
  184. SOC_ENUM_SINGLE(WM8753_INCTL1, 1, 2, wm8753_right_mux),
  185. SOC_ENUM_SINGLE(WM8753_INCTL1, 0, 2, wm8753_left_mux),
  186. SOC_ENUM_SINGLE(WM8753_INCTL2, 6, 4, wm8753_rxmsel),
  187. SOC_ENUM_SINGLE(WM8753_INCTL2, 4, 4, wm8753_sidetone_mux),
  188. SOC_ENUM_SINGLE(WM8753_OUTCTL, 7, 4, wm8753_mono2_src),
  189. SOC_ENUM_SINGLE(WM8753_OUTCTL, 0, 3, wm8753_out3),
  190. SOC_ENUM_SINGLE(WM8753_ADCTL2, 7, 3, wm8753_out4),
  191. SOC_ENUM_SINGLE(WM8753_ADCIN, 2, 3, wm8753_radcsel),
  192. SOC_ENUM_SINGLE(WM8753_ADCIN, 0, 3, wm8753_ladcsel),
  193. SOC_ENUM_SINGLE(WM8753_ADCIN, 4, 4, wm8753_mono_adc),
  194. SOC_ENUM_SINGLE(WM8753_ADC, 2, 4, wm8753_adc_hp),
  195. SOC_ENUM_SINGLE(WM8753_ADC, 4, 2, wm8753_adc_filter),
  196. SOC_ENUM_SINGLE(WM8753_MICBIAS, 6, 3, wm8753_mic_sel),
  197. SOC_ENUM_SINGLE(WM8753_IOCTL, 2, 4, wm8753_dai_mode),
  198. SOC_ENUM_SINGLE(WM8753_ADC, 7, 4, wm8753_dat_sel),
  199. SOC_ENUM_SINGLE(WM8753_OUTCTL, 2, 2, wm8753_rout2_phase),
  200. };
  201. static int wm8753_get_dai(struct snd_kcontrol *kcontrol,
  202. struct snd_ctl_elem_value *ucontrol)
  203. {
  204. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  205. int mode = wm8753_read_reg_cache(codec, WM8753_IOCTL);
  206. ucontrol->value.integer.value[0] = (mode & 0xc) >> 2;
  207. return 0;
  208. }
  209. static int wm8753_set_dai(struct snd_kcontrol *kcontrol,
  210. struct snd_ctl_elem_value *ucontrol)
  211. {
  212. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  213. int mode = wm8753_read_reg_cache(codec, WM8753_IOCTL);
  214. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  215. if (((mode & 0xc) >> 2) == ucontrol->value.integer.value[0])
  216. return 0;
  217. mode &= 0xfff3;
  218. mode |= (ucontrol->value.integer.value[0] << 2);
  219. wm8753->dai_func = ucontrol->value.integer.value[0];
  220. return 1;
  221. }
  222. static const DECLARE_TLV_DB_SCALE(rec_mix_tlv, -1500, 300, 0);
  223. static const DECLARE_TLV_DB_SCALE(mic_preamp_tlv, 1200, 600, 0);
  224. static const DECLARE_TLV_DB_SCALE(adc_tlv, -9750, 50, 1);
  225. static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1);
  226. static const unsigned int out_tlv[] = {
  227. TLV_DB_RANGE_HEAD(2),
  228. /* 0000000 - 0101111 = "Analogue mute" */
  229. 0, 48, TLV_DB_SCALE_ITEM(-25500, 0, 0),
  230. 48, 127, TLV_DB_SCALE_ITEM(-7300, 100, 0),
  231. };
  232. static const DECLARE_TLV_DB_SCALE(mix_tlv, -1500, 300, 0);
  233. static const DECLARE_TLV_DB_SCALE(voice_mix_tlv, -1200, 300, 0);
  234. static const DECLARE_TLV_DB_SCALE(pga_tlv, -1725, 75, 0);
  235. static const struct snd_kcontrol_new wm8753_snd_controls[] = {
  236. SOC_DOUBLE_R_TLV("PCM Volume", WM8753_LDAC, WM8753_RDAC, 0, 255, 0, dac_tlv),
  237. SOC_DOUBLE_R_TLV("ADC Capture Volume", WM8753_LADC, WM8753_RADC, 0, 255, 0,
  238. adc_tlv),
  239. SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8753_LOUT1V, WM8753_ROUT1V,
  240. 0, 127, 0, out_tlv),
  241. SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8753_LOUT2V, WM8753_ROUT2V, 0,
  242. 127, 0, out_tlv),
  243. SOC_SINGLE_TLV("Mono Playback Volume", WM8753_MOUTV, 0, 127, 0, out_tlv),
  244. SOC_DOUBLE_R_TLV("Bypass Playback Volume", WM8753_LOUTM1, WM8753_ROUTM1, 4, 7,
  245. 1, mix_tlv),
  246. SOC_DOUBLE_R_TLV("Sidetone Playback Volume", WM8753_LOUTM2, WM8753_ROUTM2, 4,
  247. 7, 1, mix_tlv),
  248. SOC_DOUBLE_R_TLV("Voice Playback Volume", WM8753_LOUTM2, WM8753_ROUTM2, 0, 7,
  249. 1, voice_mix_tlv),
  250. SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8753_LOUT1V, WM8753_ROUT1V, 7,
  251. 1, 0),
  252. SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8753_LOUT2V, WM8753_ROUT2V, 7,
  253. 1, 0),
  254. SOC_SINGLE_TLV("Mono Bypass Playback Volume", WM8753_MOUTM1, 4, 7, 1, mix_tlv),
  255. SOC_SINGLE_TLV("Mono Sidetone Playback Volume", WM8753_MOUTM2, 4, 7, 1,
  256. mix_tlv),
  257. SOC_SINGLE_TLV("Mono Voice Playback Volume", WM8753_MOUTM2, 0, 7, 1,
  258. voice_mix_tlv),
  259. SOC_SINGLE("Mono Playback ZC Switch", WM8753_MOUTV, 7, 1, 0),
  260. SOC_ENUM("Bass Boost", wm8753_enum[0]),
  261. SOC_ENUM("Bass Filter", wm8753_enum[1]),
  262. SOC_SINGLE("Bass Volume", WM8753_BASS, 0, 15, 1),
  263. SOC_SINGLE("Treble Volume", WM8753_TREBLE, 0, 15, 1),
  264. SOC_ENUM("Treble Cut-off", wm8753_enum[2]),
  265. SOC_DOUBLE_TLV("Sidetone Capture Volume", WM8753_RECMIX1, 0, 4, 7, 1,
  266. rec_mix_tlv),
  267. SOC_SINGLE_TLV("Voice Sidetone Capture Volume", WM8753_RECMIX2, 0, 7, 1,
  268. rec_mix_tlv),
  269. SOC_DOUBLE_R_TLV("Capture Volume", WM8753_LINVOL, WM8753_RINVOL, 0, 63, 0,
  270. pga_tlv),
  271. SOC_DOUBLE_R("Capture ZC Switch", WM8753_LINVOL, WM8753_RINVOL, 6, 1, 0),
  272. SOC_DOUBLE_R("Capture Switch", WM8753_LINVOL, WM8753_RINVOL, 7, 1, 1),
  273. SOC_ENUM("Capture Filter Select", wm8753_enum[23]),
  274. SOC_ENUM("Capture Filter Cut-off", wm8753_enum[24]),
  275. SOC_SINGLE("Capture Filter Switch", WM8753_ADC, 0, 1, 1),
  276. SOC_SINGLE("ALC Capture Target Volume", WM8753_ALC1, 0, 7, 0),
  277. SOC_SINGLE("ALC Capture Max Volume", WM8753_ALC1, 4, 7, 0),
  278. SOC_ENUM("ALC Capture Function", wm8753_enum[3]),
  279. SOC_SINGLE("ALC Capture ZC Switch", WM8753_ALC2, 8, 1, 0),
  280. SOC_SINGLE("ALC Capture Hold Time", WM8753_ALC2, 0, 15, 1),
  281. SOC_SINGLE("ALC Capture Decay Time", WM8753_ALC3, 4, 15, 1),
  282. SOC_SINGLE("ALC Capture Attack Time", WM8753_ALC3, 0, 15, 0),
  283. SOC_SINGLE("ALC Capture NG Threshold", WM8753_NGATE, 3, 31, 0),
  284. SOC_ENUM("ALC Capture NG Type", wm8753_enum[4]),
  285. SOC_SINGLE("ALC Capture NG Switch", WM8753_NGATE, 0, 1, 0),
  286. SOC_ENUM("3D Function", wm8753_enum[5]),
  287. SOC_ENUM("3D Upper Cut-off", wm8753_enum[6]),
  288. SOC_ENUM("3D Lower Cut-off", wm8753_enum[7]),
  289. SOC_SINGLE("3D Volume", WM8753_3D, 1, 15, 0),
  290. SOC_SINGLE("3D Switch", WM8753_3D, 0, 1, 0),
  291. SOC_SINGLE("Capture 6dB Attenuate", WM8753_ADCTL1, 2, 1, 0),
  292. SOC_SINGLE("Playback 6dB Attenuate", WM8753_ADCTL1, 1, 1, 0),
  293. SOC_ENUM("De-emphasis", wm8753_enum[8]),
  294. SOC_ENUM("Playback Mono Mix", wm8753_enum[9]),
  295. SOC_ENUM("Playback Phase", wm8753_enum[10]),
  296. SOC_SINGLE_TLV("Mic2 Capture Volume", WM8753_INCTL1, 7, 3, 0, mic_preamp_tlv),
  297. SOC_SINGLE_TLV("Mic1 Capture Volume", WM8753_INCTL1, 5, 3, 0, mic_preamp_tlv),
  298. SOC_ENUM_EXT("DAI Mode", wm8753_enum[26], wm8753_get_dai, wm8753_set_dai),
  299. SOC_ENUM("ADC Data Select", wm8753_enum[27]),
  300. SOC_ENUM("ROUT2 Phase", wm8753_enum[28]),
  301. };
  302. /*
  303. * _DAPM_ Controls
  304. */
  305. /* Left Mixer */
  306. static const struct snd_kcontrol_new wm8753_left_mixer_controls[] = {
  307. SOC_DAPM_SINGLE("Voice Playback Switch", WM8753_LOUTM2, 8, 1, 0),
  308. SOC_DAPM_SINGLE("Sidetone Playback Switch", WM8753_LOUTM2, 7, 1, 0),
  309. SOC_DAPM_SINGLE("Left Playback Switch", WM8753_LOUTM1, 8, 1, 0),
  310. SOC_DAPM_SINGLE("Bypass Playback Switch", WM8753_LOUTM1, 7, 1, 0),
  311. };
  312. /* Right mixer */
  313. static const struct snd_kcontrol_new wm8753_right_mixer_controls[] = {
  314. SOC_DAPM_SINGLE("Voice Playback Switch", WM8753_ROUTM2, 8, 1, 0),
  315. SOC_DAPM_SINGLE("Sidetone Playback Switch", WM8753_ROUTM2, 7, 1, 0),
  316. SOC_DAPM_SINGLE("Right Playback Switch", WM8753_ROUTM1, 8, 1, 0),
  317. SOC_DAPM_SINGLE("Bypass Playback Switch", WM8753_ROUTM1, 7, 1, 0),
  318. };
  319. /* Mono mixer */
  320. static const struct snd_kcontrol_new wm8753_mono_mixer_controls[] = {
  321. SOC_DAPM_SINGLE("Left Playback Switch", WM8753_MOUTM1, 8, 1, 0),
  322. SOC_DAPM_SINGLE("Right Playback Switch", WM8753_MOUTM2, 8, 1, 0),
  323. SOC_DAPM_SINGLE("Voice Playback Switch", WM8753_MOUTM2, 3, 1, 0),
  324. SOC_DAPM_SINGLE("Sidetone Playback Switch", WM8753_MOUTM2, 7, 1, 0),
  325. SOC_DAPM_SINGLE("Bypass Playback Switch", WM8753_MOUTM1, 7, 1, 0),
  326. };
  327. /* Mono 2 Mux */
  328. static const struct snd_kcontrol_new wm8753_mono2_controls =
  329. SOC_DAPM_ENUM("Route", wm8753_enum[17]);
  330. /* Out 3 Mux */
  331. static const struct snd_kcontrol_new wm8753_out3_controls =
  332. SOC_DAPM_ENUM("Route", wm8753_enum[18]);
  333. /* Out 4 Mux */
  334. static const struct snd_kcontrol_new wm8753_out4_controls =
  335. SOC_DAPM_ENUM("Route", wm8753_enum[19]);
  336. /* ADC Mono Mix */
  337. static const struct snd_kcontrol_new wm8753_adc_mono_controls =
  338. SOC_DAPM_ENUM("Route", wm8753_enum[22]);
  339. /* Record mixer */
  340. static const struct snd_kcontrol_new wm8753_record_mixer_controls[] = {
  341. SOC_DAPM_SINGLE("Voice Capture Switch", WM8753_RECMIX2, 3, 1, 0),
  342. SOC_DAPM_SINGLE("Left Capture Switch", WM8753_RECMIX1, 3, 1, 0),
  343. SOC_DAPM_SINGLE("Right Capture Switch", WM8753_RECMIX1, 7, 1, 0),
  344. };
  345. /* Left ADC mux */
  346. static const struct snd_kcontrol_new wm8753_adc_left_controls =
  347. SOC_DAPM_ENUM("Route", wm8753_enum[21]);
  348. /* Right ADC mux */
  349. static const struct snd_kcontrol_new wm8753_adc_right_controls =
  350. SOC_DAPM_ENUM("Route", wm8753_enum[20]);
  351. /* MIC mux */
  352. static const struct snd_kcontrol_new wm8753_mic_mux_controls =
  353. SOC_DAPM_ENUM("Route", wm8753_enum[16]);
  354. /* ALC mixer */
  355. static const struct snd_kcontrol_new wm8753_alc_mixer_controls[] = {
  356. SOC_DAPM_SINGLE("Line Capture Switch", WM8753_INCTL2, 3, 1, 0),
  357. SOC_DAPM_SINGLE("Mic2 Capture Switch", WM8753_INCTL2, 2, 1, 0),
  358. SOC_DAPM_SINGLE("Mic1 Capture Switch", WM8753_INCTL2, 1, 1, 0),
  359. SOC_DAPM_SINGLE("Rx Capture Switch", WM8753_INCTL2, 0, 1, 0),
  360. };
  361. /* Left Line mux */
  362. static const struct snd_kcontrol_new wm8753_line_left_controls =
  363. SOC_DAPM_ENUM("Route", wm8753_enum[14]);
  364. /* Right Line mux */
  365. static const struct snd_kcontrol_new wm8753_line_right_controls =
  366. SOC_DAPM_ENUM("Route", wm8753_enum[13]);
  367. /* Mono Line mux */
  368. static const struct snd_kcontrol_new wm8753_line_mono_controls =
  369. SOC_DAPM_ENUM("Route", wm8753_enum[12]);
  370. /* Line mux and mixer */
  371. static const struct snd_kcontrol_new wm8753_line_mux_mix_controls =
  372. SOC_DAPM_ENUM("Route", wm8753_enum[11]);
  373. /* Rx mux and mixer */
  374. static const struct snd_kcontrol_new wm8753_rx_mux_mix_controls =
  375. SOC_DAPM_ENUM("Route", wm8753_enum[15]);
  376. /* Mic Selector Mux */
  377. static const struct snd_kcontrol_new wm8753_mic_sel_mux_controls =
  378. SOC_DAPM_ENUM("Route", wm8753_enum[25]);
  379. static const struct snd_soc_dapm_widget wm8753_dapm_widgets[] = {
  380. SND_SOC_DAPM_MICBIAS("Mic Bias", WM8753_PWR1, 5, 0),
  381. SND_SOC_DAPM_MIXER("Left Mixer", WM8753_PWR4, 0, 0,
  382. &wm8753_left_mixer_controls[0], ARRAY_SIZE(wm8753_left_mixer_controls)),
  383. SND_SOC_DAPM_PGA("Left Out 1", WM8753_PWR3, 8, 0, NULL, 0),
  384. SND_SOC_DAPM_PGA("Left Out 2", WM8753_PWR3, 6, 0, NULL, 0),
  385. SND_SOC_DAPM_DAC("Left DAC", "Left HiFi Playback", WM8753_PWR1, 3, 0),
  386. SND_SOC_DAPM_OUTPUT("LOUT1"),
  387. SND_SOC_DAPM_OUTPUT("LOUT2"),
  388. SND_SOC_DAPM_MIXER("Right Mixer", WM8753_PWR4, 1, 0,
  389. &wm8753_right_mixer_controls[0], ARRAY_SIZE(wm8753_right_mixer_controls)),
  390. SND_SOC_DAPM_PGA("Right Out 1", WM8753_PWR3, 7, 0, NULL, 0),
  391. SND_SOC_DAPM_PGA("Right Out 2", WM8753_PWR3, 5, 0, NULL, 0),
  392. SND_SOC_DAPM_DAC("Right DAC", "Right HiFi Playback", WM8753_PWR1, 2, 0),
  393. SND_SOC_DAPM_OUTPUT("ROUT1"),
  394. SND_SOC_DAPM_OUTPUT("ROUT2"),
  395. SND_SOC_DAPM_MIXER("Mono Mixer", WM8753_PWR4, 2, 0,
  396. &wm8753_mono_mixer_controls[0], ARRAY_SIZE(wm8753_mono_mixer_controls)),
  397. SND_SOC_DAPM_PGA("Mono Out 1", WM8753_PWR3, 2, 0, NULL, 0),
  398. SND_SOC_DAPM_PGA("Mono Out 2", WM8753_PWR3, 1, 0, NULL, 0),
  399. SND_SOC_DAPM_DAC("Voice DAC", "Voice Playback", WM8753_PWR1, 4, 0),
  400. SND_SOC_DAPM_OUTPUT("MONO1"),
  401. SND_SOC_DAPM_MUX("Mono 2 Mux", SND_SOC_NOPM, 0, 0, &wm8753_mono2_controls),
  402. SND_SOC_DAPM_OUTPUT("MONO2"),
  403. SND_SOC_DAPM_MIXER("Out3 Left + Right", -1, 0, 0, NULL, 0),
  404. SND_SOC_DAPM_MUX("Out3 Mux", SND_SOC_NOPM, 0, 0, &wm8753_out3_controls),
  405. SND_SOC_DAPM_PGA("Out 3", WM8753_PWR3, 4, 0, NULL, 0),
  406. SND_SOC_DAPM_OUTPUT("OUT3"),
  407. SND_SOC_DAPM_MUX("Out4 Mux", SND_SOC_NOPM, 0, 0, &wm8753_out4_controls),
  408. SND_SOC_DAPM_PGA("Out 4", WM8753_PWR3, 3, 0, NULL, 0),
  409. SND_SOC_DAPM_OUTPUT("OUT4"),
  410. SND_SOC_DAPM_MIXER("Playback Mixer", WM8753_PWR4, 3, 0,
  411. &wm8753_record_mixer_controls[0],
  412. ARRAY_SIZE(wm8753_record_mixer_controls)),
  413. SND_SOC_DAPM_ADC("Left ADC", "Left Capture", WM8753_PWR2, 3, 0),
  414. SND_SOC_DAPM_ADC("Right ADC", "Right Capture", WM8753_PWR2, 2, 0),
  415. SND_SOC_DAPM_MUX("Capture Left Mixer", SND_SOC_NOPM, 0, 0,
  416. &wm8753_adc_mono_controls),
  417. SND_SOC_DAPM_MUX("Capture Right Mixer", SND_SOC_NOPM, 0, 0,
  418. &wm8753_adc_mono_controls),
  419. SND_SOC_DAPM_MUX("Capture Left Mux", SND_SOC_NOPM, 0, 0,
  420. &wm8753_adc_left_controls),
  421. SND_SOC_DAPM_MUX("Capture Right Mux", SND_SOC_NOPM, 0, 0,
  422. &wm8753_adc_right_controls),
  423. SND_SOC_DAPM_MUX("Mic Sidetone Mux", SND_SOC_NOPM, 0, 0,
  424. &wm8753_mic_mux_controls),
  425. SND_SOC_DAPM_PGA("Left Capture Volume", WM8753_PWR2, 5, 0, NULL, 0),
  426. SND_SOC_DAPM_PGA("Right Capture Volume", WM8753_PWR2, 4, 0, NULL, 0),
  427. SND_SOC_DAPM_MIXER("ALC Mixer", WM8753_PWR2, 6, 0,
  428. &wm8753_alc_mixer_controls[0], ARRAY_SIZE(wm8753_alc_mixer_controls)),
  429. SND_SOC_DAPM_MUX("Line Left Mux", SND_SOC_NOPM, 0, 0,
  430. &wm8753_line_left_controls),
  431. SND_SOC_DAPM_MUX("Line Right Mux", SND_SOC_NOPM, 0, 0,
  432. &wm8753_line_right_controls),
  433. SND_SOC_DAPM_MUX("Line Mono Mux", SND_SOC_NOPM, 0, 0,
  434. &wm8753_line_mono_controls),
  435. SND_SOC_DAPM_MUX("Line Mixer", WM8753_PWR2, 0, 0,
  436. &wm8753_line_mux_mix_controls),
  437. SND_SOC_DAPM_MUX("Rx Mixer", WM8753_PWR2, 1, 0,
  438. &wm8753_rx_mux_mix_controls),
  439. SND_SOC_DAPM_PGA("Mic 1 Volume", WM8753_PWR2, 8, 0, NULL, 0),
  440. SND_SOC_DAPM_PGA("Mic 2 Volume", WM8753_PWR2, 7, 0, NULL, 0),
  441. SND_SOC_DAPM_MUX("Mic Selection Mux", SND_SOC_NOPM, 0, 0,
  442. &wm8753_mic_sel_mux_controls),
  443. SND_SOC_DAPM_INPUT("LINE1"),
  444. SND_SOC_DAPM_INPUT("LINE2"),
  445. SND_SOC_DAPM_INPUT("RXP"),
  446. SND_SOC_DAPM_INPUT("RXN"),
  447. SND_SOC_DAPM_INPUT("ACIN"),
  448. SND_SOC_DAPM_OUTPUT("ACOP"),
  449. SND_SOC_DAPM_INPUT("MIC1N"),
  450. SND_SOC_DAPM_INPUT("MIC1"),
  451. SND_SOC_DAPM_INPUT("MIC2N"),
  452. SND_SOC_DAPM_INPUT("MIC2"),
  453. SND_SOC_DAPM_VMID("VREF"),
  454. };
  455. static const struct snd_soc_dapm_route audio_map[] = {
  456. /* left mixer */
  457. {"Left Mixer", "Left Playback Switch", "Left DAC"},
  458. {"Left Mixer", "Voice Playback Switch", "Voice DAC"},
  459. {"Left Mixer", "Sidetone Playback Switch", "Mic Sidetone Mux"},
  460. {"Left Mixer", "Bypass Playback Switch", "Line Left Mux"},
  461. /* right mixer */
  462. {"Right Mixer", "Right Playback Switch", "Right DAC"},
  463. {"Right Mixer", "Voice Playback Switch", "Voice DAC"},
  464. {"Right Mixer", "Sidetone Playback Switch", "Mic Sidetone Mux"},
  465. {"Right Mixer", "Bypass Playback Switch", "Line Right Mux"},
  466. /* mono mixer */
  467. {"Mono Mixer", "Voice Playback Switch", "Voice DAC"},
  468. {"Mono Mixer", "Left Playback Switch", "Left DAC"},
  469. {"Mono Mixer", "Right Playback Switch", "Right DAC"},
  470. {"Mono Mixer", "Sidetone Playback Switch", "Mic Sidetone Mux"},
  471. {"Mono Mixer", "Bypass Playback Switch", "Line Mono Mux"},
  472. /* left out */
  473. {"Left Out 1", NULL, "Left Mixer"},
  474. {"Left Out 2", NULL, "Left Mixer"},
  475. {"LOUT1", NULL, "Left Out 1"},
  476. {"LOUT2", NULL, "Left Out 2"},
  477. /* right out */
  478. {"Right Out 1", NULL, "Right Mixer"},
  479. {"Right Out 2", NULL, "Right Mixer"},
  480. {"ROUT1", NULL, "Right Out 1"},
  481. {"ROUT2", NULL, "Right Out 2"},
  482. /* mono 1 out */
  483. {"Mono Out 1", NULL, "Mono Mixer"},
  484. {"MONO1", NULL, "Mono Out 1"},
  485. /* mono 2 out */
  486. {"Mono 2 Mux", "Left + Right", "Out3 Left + Right"},
  487. {"Mono 2 Mux", "Inverted Mono 1", "MONO1"},
  488. {"Mono 2 Mux", "Left", "Left Mixer"},
  489. {"Mono 2 Mux", "Right", "Right Mixer"},
  490. {"Mono Out 2", NULL, "Mono 2 Mux"},
  491. {"MONO2", NULL, "Mono Out 2"},
  492. /* out 3 */
  493. {"Out3 Left + Right", NULL, "Left Mixer"},
  494. {"Out3 Left + Right", NULL, "Right Mixer"},
  495. {"Out3 Mux", "VREF", "VREF"},
  496. {"Out3 Mux", "Left + Right", "Out3 Left + Right"},
  497. {"Out3 Mux", "ROUT2", "ROUT2"},
  498. {"Out 3", NULL, "Out3 Mux"},
  499. {"OUT3", NULL, "Out 3"},
  500. /* out 4 */
  501. {"Out4 Mux", "VREF", "VREF"},
  502. {"Out4 Mux", "Capture ST", "Playback Mixer"},
  503. {"Out4 Mux", "LOUT2", "LOUT2"},
  504. {"Out 4", NULL, "Out4 Mux"},
  505. {"OUT4", NULL, "Out 4"},
  506. /* record mixer */
  507. {"Playback Mixer", "Left Capture Switch", "Left Mixer"},
  508. {"Playback Mixer", "Voice Capture Switch", "Mono Mixer"},
  509. {"Playback Mixer", "Right Capture Switch", "Right Mixer"},
  510. /* Mic/SideTone Mux */
  511. {"Mic Sidetone Mux", "Left PGA", "Left Capture Volume"},
  512. {"Mic Sidetone Mux", "Right PGA", "Right Capture Volume"},
  513. {"Mic Sidetone Mux", "Mic 1", "Mic 1 Volume"},
  514. {"Mic Sidetone Mux", "Mic 2", "Mic 2 Volume"},
  515. /* Capture Left Mux */
  516. {"Capture Left Mux", "PGA", "Left Capture Volume"},
  517. {"Capture Left Mux", "Line or RXP-RXN", "Line Left Mux"},
  518. {"Capture Left Mux", "Line", "LINE1"},
  519. /* Capture Right Mux */
  520. {"Capture Right Mux", "PGA", "Right Capture Volume"},
  521. {"Capture Right Mux", "Line or RXP-RXN", "Line Right Mux"},
  522. {"Capture Right Mux", "Sidetone", "Playback Mixer"},
  523. /* Mono Capture mixer-mux */
  524. {"Capture Right Mixer", "Stereo", "Capture Right Mux"},
  525. {"Capture Left Mixer", "Stereo", "Capture Left Mux"},
  526. {"Capture Left Mixer", "Analogue Mix Left", "Capture Left Mux"},
  527. {"Capture Left Mixer", "Analogue Mix Left", "Capture Right Mux"},
  528. {"Capture Right Mixer", "Analogue Mix Right", "Capture Left Mux"},
  529. {"Capture Right Mixer", "Analogue Mix Right", "Capture Right Mux"},
  530. {"Capture Left Mixer", "Digital Mono Mix", "Capture Left Mux"},
  531. {"Capture Left Mixer", "Digital Mono Mix", "Capture Right Mux"},
  532. {"Capture Right Mixer", "Digital Mono Mix", "Capture Left Mux"},
  533. {"Capture Right Mixer", "Digital Mono Mix", "Capture Right Mux"},
  534. /* ADC */
  535. {"Left ADC", NULL, "Capture Left Mixer"},
  536. {"Right ADC", NULL, "Capture Right Mixer"},
  537. /* Left Capture Volume */
  538. {"Left Capture Volume", NULL, "ACIN"},
  539. /* Right Capture Volume */
  540. {"Right Capture Volume", NULL, "Mic 2 Volume"},
  541. /* ALC Mixer */
  542. {"ALC Mixer", "Line Capture Switch", "Line Mixer"},
  543. {"ALC Mixer", "Mic2 Capture Switch", "Mic 2 Volume"},
  544. {"ALC Mixer", "Mic1 Capture Switch", "Mic 1 Volume"},
  545. {"ALC Mixer", "Rx Capture Switch", "Rx Mixer"},
  546. /* Line Left Mux */
  547. {"Line Left Mux", "Line 1", "LINE1"},
  548. {"Line Left Mux", "Rx Mix", "Rx Mixer"},
  549. /* Line Right Mux */
  550. {"Line Right Mux", "Line 2", "LINE2"},
  551. {"Line Right Mux", "Rx Mix", "Rx Mixer"},
  552. /* Line Mono Mux */
  553. {"Line Mono Mux", "Line Mix", "Line Mixer"},
  554. {"Line Mono Mux", "Rx Mix", "Rx Mixer"},
  555. /* Line Mixer/Mux */
  556. {"Line Mixer", "Line 1 + 2", "LINE1"},
  557. {"Line Mixer", "Line 1 - 2", "LINE1"},
  558. {"Line Mixer", "Line 1 + 2", "LINE2"},
  559. {"Line Mixer", "Line 1 - 2", "LINE2"},
  560. {"Line Mixer", "Line 1", "LINE1"},
  561. {"Line Mixer", "Line 2", "LINE2"},
  562. /* Rx Mixer/Mux */
  563. {"Rx Mixer", "RXP - RXN", "RXP"},
  564. {"Rx Mixer", "RXP + RXN", "RXP"},
  565. {"Rx Mixer", "RXP - RXN", "RXN"},
  566. {"Rx Mixer", "RXP + RXN", "RXN"},
  567. {"Rx Mixer", "RXP", "RXP"},
  568. {"Rx Mixer", "RXN", "RXN"},
  569. /* Mic 1 Volume */
  570. {"Mic 1 Volume", NULL, "MIC1N"},
  571. {"Mic 1 Volume", NULL, "Mic Selection Mux"},
  572. /* Mic 2 Volume */
  573. {"Mic 2 Volume", NULL, "MIC2N"},
  574. {"Mic 2 Volume", NULL, "MIC2"},
  575. /* Mic Selector Mux */
  576. {"Mic Selection Mux", "Mic 1", "MIC1"},
  577. {"Mic Selection Mux", "Mic 2", "MIC2N"},
  578. {"Mic Selection Mux", "Mic 3", "MIC2"},
  579. /* ACOP */
  580. {"ACOP", NULL, "ALC Mixer"},
  581. };
  582. static int wm8753_add_widgets(struct snd_soc_codec *codec)
  583. {
  584. snd_soc_dapm_new_controls(codec, wm8753_dapm_widgets,
  585. ARRAY_SIZE(wm8753_dapm_widgets));
  586. snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
  587. return 0;
  588. }
  589. /* PLL divisors */
  590. struct _pll_div {
  591. u32 div2:1;
  592. u32 n:4;
  593. u32 k:24;
  594. };
  595. /* The size in bits of the pll divide multiplied by 10
  596. * to allow rounding later */
  597. #define FIXED_PLL_SIZE ((1 << 22) * 10)
  598. static void pll_factors(struct _pll_div *pll_div, unsigned int target,
  599. unsigned int source)
  600. {
  601. u64 Kpart;
  602. unsigned int K, Ndiv, Nmod;
  603. Ndiv = target / source;
  604. if (Ndiv < 6) {
  605. source >>= 1;
  606. pll_div->div2 = 1;
  607. Ndiv = target / source;
  608. } else
  609. pll_div->div2 = 0;
  610. if ((Ndiv < 6) || (Ndiv > 12))
  611. printk(KERN_WARNING
  612. "wm8753: unsupported N = %u\n", Ndiv);
  613. pll_div->n = Ndiv;
  614. Nmod = target % source;
  615. Kpart = FIXED_PLL_SIZE * (long long)Nmod;
  616. do_div(Kpart, source);
  617. K = Kpart & 0xFFFFFFFF;
  618. /* Check if we need to round */
  619. if ((K % 10) >= 5)
  620. K += 5;
  621. /* Move down to proper range now rounding is done */
  622. K /= 10;
  623. pll_div->k = K;
  624. }
  625. static int wm8753_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
  626. int source, unsigned int freq_in, unsigned int freq_out)
  627. {
  628. u16 reg, enable;
  629. int offset;
  630. struct snd_soc_codec *codec = codec_dai->codec;
  631. if (pll_id < WM8753_PLL1 || pll_id > WM8753_PLL2)
  632. return -ENODEV;
  633. if (pll_id == WM8753_PLL1) {
  634. offset = 0;
  635. enable = 0x10;
  636. reg = wm8753_read_reg_cache(codec, WM8753_CLOCK) & 0xffef;
  637. } else {
  638. offset = 4;
  639. enable = 0x8;
  640. reg = wm8753_read_reg_cache(codec, WM8753_CLOCK) & 0xfff7;
  641. }
  642. if (!freq_in || !freq_out) {
  643. /* disable PLL */
  644. wm8753_write(codec, WM8753_PLL1CTL1 + offset, 0x0026);
  645. wm8753_write(codec, WM8753_CLOCK, reg);
  646. return 0;
  647. } else {
  648. u16 value = 0;
  649. struct _pll_div pll_div;
  650. pll_factors(&pll_div, freq_out * 8, freq_in);
  651. /* set up N and K PLL divisor ratios */
  652. /* bits 8:5 = PLL_N, bits 3:0 = PLL_K[21:18] */
  653. value = (pll_div.n << 5) + ((pll_div.k & 0x3c0000) >> 18);
  654. wm8753_write(codec, WM8753_PLL1CTL2 + offset, value);
  655. /* bits 8:0 = PLL_K[17:9] */
  656. value = (pll_div.k & 0x03fe00) >> 9;
  657. wm8753_write(codec, WM8753_PLL1CTL3 + offset, value);
  658. /* bits 8:0 = PLL_K[8:0] */
  659. value = pll_div.k & 0x0001ff;
  660. wm8753_write(codec, WM8753_PLL1CTL4 + offset, value);
  661. /* set PLL as input and enable */
  662. wm8753_write(codec, WM8753_PLL1CTL1 + offset, 0x0027 |
  663. (pll_div.div2 << 3));
  664. wm8753_write(codec, WM8753_CLOCK, reg | enable);
  665. }
  666. return 0;
  667. }
  668. struct _coeff_div {
  669. u32 mclk;
  670. u32 rate;
  671. u8 sr:5;
  672. u8 usb:1;
  673. };
  674. /* codec hifi mclk (after PLL) clock divider coefficients */
  675. static const struct _coeff_div coeff_div[] = {
  676. /* 8k */
  677. {12288000, 8000, 0x6, 0x0},
  678. {11289600, 8000, 0x16, 0x0},
  679. {18432000, 8000, 0x7, 0x0},
  680. {16934400, 8000, 0x17, 0x0},
  681. {12000000, 8000, 0x6, 0x1},
  682. /* 11.025k */
  683. {11289600, 11025, 0x18, 0x0},
  684. {16934400, 11025, 0x19, 0x0},
  685. {12000000, 11025, 0x19, 0x1},
  686. /* 16k */
  687. {12288000, 16000, 0xa, 0x0},
  688. {18432000, 16000, 0xb, 0x0},
  689. {12000000, 16000, 0xa, 0x1},
  690. /* 22.05k */
  691. {11289600, 22050, 0x1a, 0x0},
  692. {16934400, 22050, 0x1b, 0x0},
  693. {12000000, 22050, 0x1b, 0x1},
  694. /* 32k */
  695. {12288000, 32000, 0xc, 0x0},
  696. {18432000, 32000, 0xd, 0x0},
  697. {12000000, 32000, 0xa, 0x1},
  698. /* 44.1k */
  699. {11289600, 44100, 0x10, 0x0},
  700. {16934400, 44100, 0x11, 0x0},
  701. {12000000, 44100, 0x11, 0x1},
  702. /* 48k */
  703. {12288000, 48000, 0x0, 0x0},
  704. {18432000, 48000, 0x1, 0x0},
  705. {12000000, 48000, 0x0, 0x1},
  706. /* 88.2k */
  707. {11289600, 88200, 0x1e, 0x0},
  708. {16934400, 88200, 0x1f, 0x0},
  709. {12000000, 88200, 0x1f, 0x1},
  710. /* 96k */
  711. {12288000, 96000, 0xe, 0x0},
  712. {18432000, 96000, 0xf, 0x0},
  713. {12000000, 96000, 0xe, 0x1},
  714. };
  715. static int get_coeff(int mclk, int rate)
  716. {
  717. int i;
  718. for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
  719. if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
  720. return i;
  721. }
  722. return -EINVAL;
  723. }
  724. /*
  725. * Clock after PLL and dividers
  726. */
  727. static int wm8753_set_dai_sysclk(struct snd_soc_dai *codec_dai,
  728. int clk_id, unsigned int freq, int dir)
  729. {
  730. struct snd_soc_codec *codec = codec_dai->codec;
  731. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  732. switch (freq) {
  733. case 11289600:
  734. case 12000000:
  735. case 12288000:
  736. case 16934400:
  737. case 18432000:
  738. if (clk_id == WM8753_MCLK) {
  739. wm8753->sysclk = freq;
  740. return 0;
  741. } else if (clk_id == WM8753_PCMCLK) {
  742. wm8753->pcmclk = freq;
  743. return 0;
  744. }
  745. break;
  746. }
  747. return -EINVAL;
  748. }
  749. /*
  750. * Set's ADC and Voice DAC format.
  751. */
  752. static int wm8753_vdac_adc_set_dai_fmt(struct snd_soc_dai *codec_dai,
  753. unsigned int fmt)
  754. {
  755. struct snd_soc_codec *codec = codec_dai->codec;
  756. u16 voice = wm8753_read_reg_cache(codec, WM8753_PCM) & 0x01ec;
  757. /* interface format */
  758. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  759. case SND_SOC_DAIFMT_I2S:
  760. voice |= 0x0002;
  761. break;
  762. case SND_SOC_DAIFMT_RIGHT_J:
  763. break;
  764. case SND_SOC_DAIFMT_LEFT_J:
  765. voice |= 0x0001;
  766. break;
  767. case SND_SOC_DAIFMT_DSP_A:
  768. voice |= 0x0003;
  769. break;
  770. case SND_SOC_DAIFMT_DSP_B:
  771. voice |= 0x0013;
  772. break;
  773. default:
  774. return -EINVAL;
  775. }
  776. wm8753_write(codec, WM8753_PCM, voice);
  777. return 0;
  778. }
  779. static int wm8753_pcm_startup(struct snd_pcm_substream *substream,
  780. struct snd_soc_dai *dai)
  781. {
  782. wm8753_set_dai_mode(dai->codec, dai, 0);
  783. return 0;
  784. }
  785. /*
  786. * Set PCM DAI bit size and sample rate.
  787. */
  788. static int wm8753_pcm_hw_params(struct snd_pcm_substream *substream,
  789. struct snd_pcm_hw_params *params,
  790. struct snd_soc_dai *dai)
  791. {
  792. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  793. struct snd_soc_codec *codec = rtd->codec;
  794. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  795. u16 voice = wm8753_read_reg_cache(codec, WM8753_PCM) & 0x01f3;
  796. u16 srate = wm8753_read_reg_cache(codec, WM8753_SRATE1) & 0x017f;
  797. /* bit size */
  798. switch (params_format(params)) {
  799. case SNDRV_PCM_FORMAT_S16_LE:
  800. break;
  801. case SNDRV_PCM_FORMAT_S20_3LE:
  802. voice |= 0x0004;
  803. break;
  804. case SNDRV_PCM_FORMAT_S24_LE:
  805. voice |= 0x0008;
  806. break;
  807. case SNDRV_PCM_FORMAT_S32_LE:
  808. voice |= 0x000c;
  809. break;
  810. }
  811. /* sample rate */
  812. if (params_rate(params) * 384 == wm8753->pcmclk)
  813. srate |= 0x80;
  814. wm8753_write(codec, WM8753_SRATE1, srate);
  815. wm8753_write(codec, WM8753_PCM, voice);
  816. return 0;
  817. }
  818. /*
  819. * Set's PCM dai fmt and BCLK.
  820. */
  821. static int wm8753_pcm_set_dai_fmt(struct snd_soc_dai *codec_dai,
  822. unsigned int fmt)
  823. {
  824. struct snd_soc_codec *codec = codec_dai->codec;
  825. u16 voice, ioctl;
  826. voice = wm8753_read_reg_cache(codec, WM8753_PCM) & 0x011f;
  827. ioctl = wm8753_read_reg_cache(codec, WM8753_IOCTL) & 0x015d;
  828. /* set master/slave audio interface */
  829. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  830. case SND_SOC_DAIFMT_CBS_CFS:
  831. break;
  832. case SND_SOC_DAIFMT_CBM_CFM:
  833. ioctl |= 0x2;
  834. case SND_SOC_DAIFMT_CBM_CFS:
  835. voice |= 0x0040;
  836. break;
  837. default:
  838. return -EINVAL;
  839. }
  840. /* clock inversion */
  841. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  842. case SND_SOC_DAIFMT_DSP_A:
  843. case SND_SOC_DAIFMT_DSP_B:
  844. /* frame inversion not valid for DSP modes */
  845. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  846. case SND_SOC_DAIFMT_NB_NF:
  847. break;
  848. case SND_SOC_DAIFMT_IB_NF:
  849. voice |= 0x0080;
  850. break;
  851. default:
  852. return -EINVAL;
  853. }
  854. break;
  855. case SND_SOC_DAIFMT_I2S:
  856. case SND_SOC_DAIFMT_RIGHT_J:
  857. case SND_SOC_DAIFMT_LEFT_J:
  858. voice &= ~0x0010;
  859. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  860. case SND_SOC_DAIFMT_NB_NF:
  861. break;
  862. case SND_SOC_DAIFMT_IB_IF:
  863. voice |= 0x0090;
  864. break;
  865. case SND_SOC_DAIFMT_IB_NF:
  866. voice |= 0x0080;
  867. break;
  868. case SND_SOC_DAIFMT_NB_IF:
  869. voice |= 0x0010;
  870. break;
  871. default:
  872. return -EINVAL;
  873. }
  874. break;
  875. default:
  876. return -EINVAL;
  877. }
  878. wm8753_write(codec, WM8753_PCM, voice);
  879. wm8753_write(codec, WM8753_IOCTL, ioctl);
  880. return 0;
  881. }
  882. static int wm8753_set_dai_clkdiv(struct snd_soc_dai *codec_dai,
  883. int div_id, int div)
  884. {
  885. struct snd_soc_codec *codec = codec_dai->codec;
  886. u16 reg;
  887. switch (div_id) {
  888. case WM8753_PCMDIV:
  889. reg = wm8753_read_reg_cache(codec, WM8753_CLOCK) & 0x003f;
  890. wm8753_write(codec, WM8753_CLOCK, reg | div);
  891. break;
  892. case WM8753_BCLKDIV:
  893. reg = wm8753_read_reg_cache(codec, WM8753_SRATE2) & 0x01c7;
  894. wm8753_write(codec, WM8753_SRATE2, reg | div);
  895. break;
  896. case WM8753_VXCLKDIV:
  897. reg = wm8753_read_reg_cache(codec, WM8753_SRATE2) & 0x003f;
  898. wm8753_write(codec, WM8753_SRATE2, reg | div);
  899. break;
  900. default:
  901. return -EINVAL;
  902. }
  903. return 0;
  904. }
  905. /*
  906. * Set's HiFi DAC format.
  907. */
  908. static int wm8753_hdac_set_dai_fmt(struct snd_soc_dai *codec_dai,
  909. unsigned int fmt)
  910. {
  911. struct snd_soc_codec *codec = codec_dai->codec;
  912. u16 hifi = wm8753_read_reg_cache(codec, WM8753_HIFI) & 0x01e0;
  913. /* interface format */
  914. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  915. case SND_SOC_DAIFMT_I2S:
  916. hifi |= 0x0002;
  917. break;
  918. case SND_SOC_DAIFMT_RIGHT_J:
  919. break;
  920. case SND_SOC_DAIFMT_LEFT_J:
  921. hifi |= 0x0001;
  922. break;
  923. case SND_SOC_DAIFMT_DSP_A:
  924. hifi |= 0x0003;
  925. break;
  926. case SND_SOC_DAIFMT_DSP_B:
  927. hifi |= 0x0013;
  928. break;
  929. default:
  930. return -EINVAL;
  931. }
  932. wm8753_write(codec, WM8753_HIFI, hifi);
  933. return 0;
  934. }
  935. /*
  936. * Set's I2S DAI format.
  937. */
  938. static int wm8753_i2s_set_dai_fmt(struct snd_soc_dai *codec_dai,
  939. unsigned int fmt)
  940. {
  941. struct snd_soc_codec *codec = codec_dai->codec;
  942. u16 ioctl, hifi;
  943. hifi = wm8753_read_reg_cache(codec, WM8753_HIFI) & 0x011f;
  944. ioctl = wm8753_read_reg_cache(codec, WM8753_IOCTL) & 0x00ae;
  945. /* set master/slave audio interface */
  946. switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
  947. case SND_SOC_DAIFMT_CBS_CFS:
  948. break;
  949. case SND_SOC_DAIFMT_CBM_CFM:
  950. ioctl |= 0x1;
  951. case SND_SOC_DAIFMT_CBM_CFS:
  952. hifi |= 0x0040;
  953. break;
  954. default:
  955. return -EINVAL;
  956. }
  957. /* clock inversion */
  958. switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
  959. case SND_SOC_DAIFMT_DSP_A:
  960. case SND_SOC_DAIFMT_DSP_B:
  961. /* frame inversion not valid for DSP modes */
  962. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  963. case SND_SOC_DAIFMT_NB_NF:
  964. break;
  965. case SND_SOC_DAIFMT_IB_NF:
  966. hifi |= 0x0080;
  967. break;
  968. default:
  969. return -EINVAL;
  970. }
  971. break;
  972. case SND_SOC_DAIFMT_I2S:
  973. case SND_SOC_DAIFMT_RIGHT_J:
  974. case SND_SOC_DAIFMT_LEFT_J:
  975. hifi &= ~0x0010;
  976. switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
  977. case SND_SOC_DAIFMT_NB_NF:
  978. break;
  979. case SND_SOC_DAIFMT_IB_IF:
  980. hifi |= 0x0090;
  981. break;
  982. case SND_SOC_DAIFMT_IB_NF:
  983. hifi |= 0x0080;
  984. break;
  985. case SND_SOC_DAIFMT_NB_IF:
  986. hifi |= 0x0010;
  987. break;
  988. default:
  989. return -EINVAL;
  990. }
  991. break;
  992. default:
  993. return -EINVAL;
  994. }
  995. wm8753_write(codec, WM8753_HIFI, hifi);
  996. wm8753_write(codec, WM8753_IOCTL, ioctl);
  997. return 0;
  998. }
  999. static int wm8753_i2s_startup(struct snd_pcm_substream *substream,
  1000. struct snd_soc_dai *dai)
  1001. {
  1002. wm8753_set_dai_mode(dai->codec, dai, 1);
  1003. return 0;
  1004. }
  1005. /*
  1006. * Set PCM DAI bit size and sample rate.
  1007. */
  1008. static int wm8753_i2s_hw_params(struct snd_pcm_substream *substream,
  1009. struct snd_pcm_hw_params *params,
  1010. struct snd_soc_dai *dai)
  1011. {
  1012. struct snd_soc_pcm_runtime *rtd = substream->private_data;
  1013. struct snd_soc_codec *codec = rtd->codec;
  1014. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  1015. u16 srate = wm8753_read_reg_cache(codec, WM8753_SRATE1) & 0x01c0;
  1016. u16 hifi = wm8753_read_reg_cache(codec, WM8753_HIFI) & 0x01f3;
  1017. int coeff;
  1018. /* is digital filter coefficient valid ? */
  1019. coeff = get_coeff(wm8753->sysclk, params_rate(params));
  1020. if (coeff < 0) {
  1021. printk(KERN_ERR "wm8753 invalid MCLK or rate\n");
  1022. return coeff;
  1023. }
  1024. wm8753_write(codec, WM8753_SRATE1, srate | (coeff_div[coeff].sr << 1) |
  1025. coeff_div[coeff].usb);
  1026. /* bit size */
  1027. switch (params_format(params)) {
  1028. case SNDRV_PCM_FORMAT_S16_LE:
  1029. break;
  1030. case SNDRV_PCM_FORMAT_S20_3LE:
  1031. hifi |= 0x0004;
  1032. break;
  1033. case SNDRV_PCM_FORMAT_S24_LE:
  1034. hifi |= 0x0008;
  1035. break;
  1036. case SNDRV_PCM_FORMAT_S32_LE:
  1037. hifi |= 0x000c;
  1038. break;
  1039. }
  1040. wm8753_write(codec, WM8753_HIFI, hifi);
  1041. return 0;
  1042. }
  1043. static int wm8753_mode1v_set_dai_fmt(struct snd_soc_dai *codec_dai,
  1044. unsigned int fmt)
  1045. {
  1046. struct snd_soc_codec *codec = codec_dai->codec;
  1047. u16 clock;
  1048. /* set clk source as pcmclk */
  1049. clock = wm8753_read_reg_cache(codec, WM8753_CLOCK) & 0xfffb;
  1050. wm8753_write(codec, WM8753_CLOCK, clock);
  1051. if (wm8753_vdac_adc_set_dai_fmt(codec_dai, fmt) < 0)
  1052. return -EINVAL;
  1053. return wm8753_pcm_set_dai_fmt(codec_dai, fmt);
  1054. }
  1055. static int wm8753_mode1h_set_dai_fmt(struct snd_soc_dai *codec_dai,
  1056. unsigned int fmt)
  1057. {
  1058. if (wm8753_hdac_set_dai_fmt(codec_dai, fmt) < 0)
  1059. return -EINVAL;
  1060. return wm8753_i2s_set_dai_fmt(codec_dai, fmt);
  1061. }
  1062. static int wm8753_mode2_set_dai_fmt(struct snd_soc_dai *codec_dai,
  1063. unsigned int fmt)
  1064. {
  1065. struct snd_soc_codec *codec = codec_dai->codec;
  1066. u16 clock;
  1067. /* set clk source as pcmclk */
  1068. clock = wm8753_read_reg_cache(codec, WM8753_CLOCK) & 0xfffb;
  1069. wm8753_write(codec, WM8753_CLOCK, clock);
  1070. if (wm8753_vdac_adc_set_dai_fmt(codec_dai, fmt) < 0)
  1071. return -EINVAL;
  1072. return wm8753_i2s_set_dai_fmt(codec_dai, fmt);
  1073. }
  1074. static int wm8753_mode3_4_set_dai_fmt(struct snd_soc_dai *codec_dai,
  1075. unsigned int fmt)
  1076. {
  1077. struct snd_soc_codec *codec = codec_dai->codec;
  1078. u16 clock;
  1079. /* set clk source as mclk */
  1080. clock = wm8753_read_reg_cache(codec, WM8753_CLOCK) & 0xfffb;
  1081. wm8753_write(codec, WM8753_CLOCK, clock | 0x4);
  1082. if (wm8753_hdac_set_dai_fmt(codec_dai, fmt) < 0)
  1083. return -EINVAL;
  1084. if (wm8753_vdac_adc_set_dai_fmt(codec_dai, fmt) < 0)
  1085. return -EINVAL;
  1086. return wm8753_i2s_set_dai_fmt(codec_dai, fmt);
  1087. }
  1088. static int wm8753_mute(struct snd_soc_dai *dai, int mute)
  1089. {
  1090. struct snd_soc_codec *codec = dai->codec;
  1091. u16 mute_reg = wm8753_read_reg_cache(codec, WM8753_DAC) & 0xfff7;
  1092. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  1093. /* the digital mute covers the HiFi and Voice DAC's on the WM8753.
  1094. * make sure we check if they are not both active when we mute */
  1095. if (mute && wm8753->dai_func == 1) {
  1096. if (!codec->active)
  1097. wm8753_write(codec, WM8753_DAC, mute_reg | 0x8);
  1098. } else {
  1099. if (mute)
  1100. wm8753_write(codec, WM8753_DAC, mute_reg | 0x8);
  1101. else
  1102. wm8753_write(codec, WM8753_DAC, mute_reg);
  1103. }
  1104. return 0;
  1105. }
  1106. static int wm8753_set_bias_level(struct snd_soc_codec *codec,
  1107. enum snd_soc_bias_level level)
  1108. {
  1109. u16 pwr_reg = wm8753_read_reg_cache(codec, WM8753_PWR1) & 0xfe3e;
  1110. switch (level) {
  1111. case SND_SOC_BIAS_ON:
  1112. /* set vmid to 50k and unmute dac */
  1113. wm8753_write(codec, WM8753_PWR1, pwr_reg | 0x00c0);
  1114. break;
  1115. case SND_SOC_BIAS_PREPARE:
  1116. /* set vmid to 5k for quick power up */
  1117. wm8753_write(codec, WM8753_PWR1, pwr_reg | 0x01c1);
  1118. break;
  1119. case SND_SOC_BIAS_STANDBY:
  1120. /* mute dac and set vmid to 500k, enable VREF */
  1121. wm8753_write(codec, WM8753_PWR1, pwr_reg | 0x0141);
  1122. break;
  1123. case SND_SOC_BIAS_OFF:
  1124. wm8753_write(codec, WM8753_PWR1, 0x0001);
  1125. break;
  1126. }
  1127. codec->bias_level = level;
  1128. return 0;
  1129. }
  1130. #define WM8753_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
  1131. SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
  1132. SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |\
  1133. SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000)
  1134. #define WM8753_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
  1135. SNDRV_PCM_FMTBIT_S24_LE)
  1136. /*
  1137. * The WM8753 supports upto 4 different and mutually exclusive DAI
  1138. * configurations. This gives 2 PCM's available for use, hifi and voice.
  1139. * NOTE: The Voice PCM cannot play or capture audio to the CPU as it's DAI
  1140. * is connected between the wm8753 and a BT codec or GSM modem.
  1141. *
  1142. * 1. Voice over PCM DAI - HIFI DAC over HIFI DAI
  1143. * 2. Voice over HIFI DAI - HIFI disabled
  1144. * 3. Voice disabled - HIFI over HIFI
  1145. * 4. Voice disabled - HIFI over HIFI, uses voice DAI LRC for capture
  1146. */
  1147. static struct snd_soc_dai_ops wm8753_dai_ops_hifi_mode1 = {
  1148. .startup = wm8753_i2s_startup,
  1149. .hw_params = wm8753_i2s_hw_params,
  1150. .digital_mute = wm8753_mute,
  1151. .set_fmt = wm8753_mode1h_set_dai_fmt,
  1152. .set_clkdiv = wm8753_set_dai_clkdiv,
  1153. .set_pll = wm8753_set_dai_pll,
  1154. .set_sysclk = wm8753_set_dai_sysclk,
  1155. };
  1156. static struct snd_soc_dai_ops wm8753_dai_ops_voice_mode1 = {
  1157. .startup = wm8753_pcm_startup,
  1158. .hw_params = wm8753_pcm_hw_params,
  1159. .digital_mute = wm8753_mute,
  1160. .set_fmt = wm8753_mode1v_set_dai_fmt,
  1161. .set_clkdiv = wm8753_set_dai_clkdiv,
  1162. .set_pll = wm8753_set_dai_pll,
  1163. .set_sysclk = wm8753_set_dai_sysclk,
  1164. };
  1165. static struct snd_soc_dai_ops wm8753_dai_ops_voice_mode2 = {
  1166. .startup = wm8753_pcm_startup,
  1167. .hw_params = wm8753_pcm_hw_params,
  1168. .digital_mute = wm8753_mute,
  1169. .set_fmt = wm8753_mode2_set_dai_fmt,
  1170. .set_clkdiv = wm8753_set_dai_clkdiv,
  1171. .set_pll = wm8753_set_dai_pll,
  1172. .set_sysclk = wm8753_set_dai_sysclk,
  1173. };
  1174. static struct snd_soc_dai_ops wm8753_dai_ops_hifi_mode3 = {
  1175. .startup = wm8753_i2s_startup,
  1176. .hw_params = wm8753_i2s_hw_params,
  1177. .digital_mute = wm8753_mute,
  1178. .set_fmt = wm8753_mode3_4_set_dai_fmt,
  1179. .set_clkdiv = wm8753_set_dai_clkdiv,
  1180. .set_pll = wm8753_set_dai_pll,
  1181. .set_sysclk = wm8753_set_dai_sysclk,
  1182. };
  1183. static struct snd_soc_dai_ops wm8753_dai_ops_hifi_mode4 = {
  1184. .startup = wm8753_i2s_startup,
  1185. .hw_params = wm8753_i2s_hw_params,
  1186. .digital_mute = wm8753_mute,
  1187. .set_fmt = wm8753_mode3_4_set_dai_fmt,
  1188. .set_clkdiv = wm8753_set_dai_clkdiv,
  1189. .set_pll = wm8753_set_dai_pll,
  1190. .set_sysclk = wm8753_set_dai_sysclk,
  1191. };
  1192. static struct snd_soc_dai_driver wm8753_all_dai[] = {
  1193. /* DAI HiFi mode 1 */
  1194. { .name = "wm8753-hifi",
  1195. .playback = {
  1196. .stream_name = "HiFi Playback",
  1197. .channels_min = 1,
  1198. .channels_max = 2,
  1199. .rates = WM8753_RATES,
  1200. .formats = WM8753_FORMATS},
  1201. .capture = { /* dummy for fast DAI switching */
  1202. .stream_name = "Capture",
  1203. .channels_min = 1,
  1204. .channels_max = 2,
  1205. .rates = WM8753_RATES,
  1206. .formats = WM8753_FORMATS},
  1207. .ops = &wm8753_dai_ops_hifi_mode1,
  1208. },
  1209. /* DAI Voice mode 1 */
  1210. { .name = "wm8753-voice",
  1211. .playback = {
  1212. .stream_name = "Voice Playback",
  1213. .channels_min = 1,
  1214. .channels_max = 1,
  1215. .rates = WM8753_RATES,
  1216. .formats = WM8753_FORMATS,},
  1217. .capture = {
  1218. .stream_name = "Capture",
  1219. .channels_min = 1,
  1220. .channels_max = 2,
  1221. .rates = WM8753_RATES,
  1222. .formats = WM8753_FORMATS,},
  1223. .ops = &wm8753_dai_ops_voice_mode1,
  1224. },
  1225. /* DAI HiFi mode 2 - dummy */
  1226. { .name = "wm8753-hifi",
  1227. },
  1228. /* DAI Voice mode 2 */
  1229. { .name = "wm8753-voice",
  1230. .playback = {
  1231. .stream_name = "Voice Playback",
  1232. .channels_min = 1,
  1233. .channels_max = 1,
  1234. .rates = WM8753_RATES,
  1235. .formats = WM8753_FORMATS,},
  1236. .capture = {
  1237. .stream_name = "Capture",
  1238. .channels_min = 1,
  1239. .channels_max = 2,
  1240. .rates = WM8753_RATES,
  1241. .formats = WM8753_FORMATS,},
  1242. .ops = &wm8753_dai_ops_voice_mode2,
  1243. },
  1244. /* DAI HiFi mode 3 */
  1245. { .name = "wm8753-hifi",
  1246. .playback = {
  1247. .stream_name = "HiFi Playback",
  1248. .channels_min = 1,
  1249. .channels_max = 2,
  1250. .rates = WM8753_RATES,
  1251. .formats = WM8753_FORMATS,},
  1252. .capture = {
  1253. .stream_name = "Capture",
  1254. .channels_min = 1,
  1255. .channels_max = 2,
  1256. .rates = WM8753_RATES,
  1257. .formats = WM8753_FORMATS,},
  1258. .ops = &wm8753_dai_ops_hifi_mode3,
  1259. },
  1260. /* DAI Voice mode 3 - dummy */
  1261. { .name = "wm8753-voice",
  1262. },
  1263. /* DAI HiFi mode 4 */
  1264. { .name = "wm8753-hifi",
  1265. .playback = {
  1266. .stream_name = "HiFi Playback",
  1267. .channels_min = 1,
  1268. .channels_max = 2,
  1269. .rates = WM8753_RATES,
  1270. .formats = WM8753_FORMATS,},
  1271. .capture = {
  1272. .stream_name = "Capture",
  1273. .channels_min = 1,
  1274. .channels_max = 2,
  1275. .rates = WM8753_RATES,
  1276. .formats = WM8753_FORMATS,},
  1277. .ops = &wm8753_dai_ops_hifi_mode4,
  1278. },
  1279. /* DAI Voice mode 4 - dummy */
  1280. { .name = "wm8753-voice",
  1281. },
  1282. };
  1283. static struct snd_soc_dai_driver wm8753_dai[] = {
  1284. {
  1285. .name = "wm8753-aif0",
  1286. },
  1287. {
  1288. .name = "wm8753-aif1",
  1289. },
  1290. };
  1291. static void wm8753_set_dai_mode(struct snd_soc_codec *codec,
  1292. struct snd_soc_dai *dai, unsigned int hifi)
  1293. {
  1294. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  1295. if (wm8753->dai_func < 4) {
  1296. if (hifi)
  1297. dai->driver = &wm8753_all_dai[wm8753->dai_func << 1];
  1298. else
  1299. dai->driver = &wm8753_all_dai[(wm8753->dai_func << 1) + 1];
  1300. }
  1301. wm8753_write(codec, WM8753_IOCTL, wm8753->dai_func);
  1302. }
  1303. static void wm8753_work(struct work_struct *work)
  1304. {
  1305. struct snd_soc_codec *codec =
  1306. container_of(work, struct snd_soc_codec, delayed_work.work);
  1307. wm8753_set_bias_level(codec, codec->bias_level);
  1308. }
  1309. static int wm8753_suspend(struct snd_soc_codec *codec, pm_message_t state)
  1310. {
  1311. wm8753_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1312. return 0;
  1313. }
  1314. static int wm8753_resume(struct snd_soc_codec *codec)
  1315. {
  1316. int i;
  1317. u8 data[2];
  1318. u16 *cache = codec->reg_cache;
  1319. /* Sync reg_cache with the hardware */
  1320. for (i = 0; i < ARRAY_SIZE(wm8753_reg); i++) {
  1321. if (i + 1 == WM8753_RESET)
  1322. continue;
  1323. /* No point in writing hardware default values back */
  1324. if (cache[i] == wm8753_reg[i])
  1325. continue;
  1326. data[0] = ((i + 1) << 1) | ((cache[i] >> 8) & 0x0001);
  1327. data[1] = cache[i] & 0x00ff;
  1328. codec->hw_write(codec->control_data, data, 2);
  1329. }
  1330. wm8753_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1331. /* charge wm8753 caps */
  1332. if (codec->suspend_bias_level == SND_SOC_BIAS_ON) {
  1333. wm8753_set_bias_level(codec, SND_SOC_BIAS_PREPARE);
  1334. codec->bias_level = SND_SOC_BIAS_ON;
  1335. schedule_delayed_work(&codec->delayed_work,
  1336. msecs_to_jiffies(caps_charge));
  1337. }
  1338. return 0;
  1339. }
  1340. /*
  1341. * This function forces any delayed work to be queued and run.
  1342. */
  1343. static int run_delayed_work(struct delayed_work *dwork)
  1344. {
  1345. int ret;
  1346. /* cancel any work waiting to be queued. */
  1347. ret = cancel_delayed_work(dwork);
  1348. /* if there was any work waiting then we run it now and
  1349. * wait for it's completion */
  1350. if (ret) {
  1351. schedule_delayed_work(dwork, 0);
  1352. flush_scheduled_work();
  1353. }
  1354. return ret;
  1355. }
  1356. static int wm8753_probe(struct snd_soc_codec *codec)
  1357. {
  1358. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  1359. int ret = 0, reg;
  1360. INIT_DELAYED_WORK(&codec->delayed_work, wm8753_work);
  1361. ret = snd_soc_codec_set_cache_io(codec, 7, 9, wm8753->control_type);
  1362. if (ret < 0) {
  1363. dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
  1364. return ret;
  1365. }
  1366. ret = wm8753_reset(codec);
  1367. if (ret < 0) {
  1368. dev_err(codec->dev, "Failed to issue reset: %d\n", ret);
  1369. return ret;
  1370. }
  1371. wm8753_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1372. wm8753->dai_func = 0;
  1373. /* charge output caps */
  1374. wm8753_set_bias_level(codec, SND_SOC_BIAS_PREPARE);
  1375. schedule_delayed_work(&codec->delayed_work,
  1376. msecs_to_jiffies(caps_charge));
  1377. /* set the update bits */
  1378. reg = wm8753_read_reg_cache(codec, WM8753_LDAC);
  1379. wm8753_write(codec, WM8753_LDAC, reg | 0x0100);
  1380. reg = wm8753_read_reg_cache(codec, WM8753_RDAC);
  1381. wm8753_write(codec, WM8753_RDAC, reg | 0x0100);
  1382. reg = wm8753_read_reg_cache(codec, WM8753_LADC);
  1383. wm8753_write(codec, WM8753_LADC, reg | 0x0100);
  1384. reg = wm8753_read_reg_cache(codec, WM8753_RADC);
  1385. wm8753_write(codec, WM8753_RADC, reg | 0x0100);
  1386. reg = wm8753_read_reg_cache(codec, WM8753_LOUT1V);
  1387. wm8753_write(codec, WM8753_LOUT1V, reg | 0x0100);
  1388. reg = wm8753_read_reg_cache(codec, WM8753_ROUT1V);
  1389. wm8753_write(codec, WM8753_ROUT1V, reg | 0x0100);
  1390. reg = wm8753_read_reg_cache(codec, WM8753_LOUT2V);
  1391. wm8753_write(codec, WM8753_LOUT2V, reg | 0x0100);
  1392. reg = wm8753_read_reg_cache(codec, WM8753_ROUT2V);
  1393. wm8753_write(codec, WM8753_ROUT2V, reg | 0x0100);
  1394. reg = wm8753_read_reg_cache(codec, WM8753_LINVOL);
  1395. wm8753_write(codec, WM8753_LINVOL, reg | 0x0100);
  1396. reg = wm8753_read_reg_cache(codec, WM8753_RINVOL);
  1397. wm8753_write(codec, WM8753_RINVOL, reg | 0x0100);
  1398. snd_soc_add_controls(codec, wm8753_snd_controls,
  1399. ARRAY_SIZE(wm8753_snd_controls));
  1400. wm8753_add_widgets(codec);
  1401. return 0;
  1402. }
  1403. /* power down chip */
  1404. static int wm8753_remove(struct snd_soc_codec *codec)
  1405. {
  1406. run_delayed_work(&codec->delayed_work);
  1407. wm8753_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1408. return 0;
  1409. }
  1410. static struct snd_soc_codec_driver soc_codec_dev_wm8753 = {
  1411. .probe = wm8753_probe,
  1412. .remove = wm8753_remove,
  1413. .suspend = wm8753_suspend,
  1414. .resume = wm8753_resume,
  1415. .set_bias_level = wm8753_set_bias_level,
  1416. .reg_cache_size = ARRAY_SIZE(wm8753_reg),
  1417. .reg_word_size = sizeof(u16),
  1418. .reg_cache_default = wm8753_reg,
  1419. };
  1420. #if defined(CONFIG_SPI_MASTER)
  1421. static int __devinit wm8753_spi_probe(struct spi_device *spi)
  1422. {
  1423. struct wm8753_priv *wm8753;
  1424. int ret;
  1425. wm8753 = kzalloc(sizeof(struct wm8753_priv), GFP_KERNEL);
  1426. if (wm8753 == NULL)
  1427. return -ENOMEM;
  1428. wm8753->control_type = SND_SOC_SPI;
  1429. spi_set_drvdata(spi, wm8753);
  1430. ret = snd_soc_register_codec(&spi->dev,
  1431. &soc_codec_dev_wm8753, wm8753_dai, ARRAY_SIZE(wm8753_dai));
  1432. if (ret < 0)
  1433. kfree(wm8753);
  1434. return ret;
  1435. }
  1436. static int __devexit wm8753_spi_remove(struct spi_device *spi)
  1437. {
  1438. snd_soc_unregister_codec(&spi->dev);
  1439. kfree(spi_get_drvdata(spi));
  1440. return 0;
  1441. }
  1442. static struct spi_driver wm8753_spi_driver = {
  1443. .driver = {
  1444. .name = "wm8753-codec",
  1445. .owner = THIS_MODULE,
  1446. },
  1447. .probe = wm8753_spi_probe,
  1448. .remove = __devexit_p(wm8753_spi_remove),
  1449. };
  1450. #endif /* CONFIG_SPI_MASTER */
  1451. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  1452. static __devinit int wm8753_i2c_probe(struct i2c_client *i2c,
  1453. const struct i2c_device_id *id)
  1454. {
  1455. struct wm8753_priv *wm8753;
  1456. int ret;
  1457. wm8753 = kzalloc(sizeof(struct wm8753_priv), GFP_KERNEL);
  1458. if (wm8753 == NULL)
  1459. return -ENOMEM;
  1460. i2c_set_clientdata(i2c, wm8753);
  1461. wm8753->control_type = SND_SOC_I2C;
  1462. ret = snd_soc_register_codec(&i2c->dev,
  1463. &soc_codec_dev_wm8753, wm8753_dai, ARRAY_SIZE(wm8753_dai));
  1464. if (ret < 0)
  1465. kfree(wm8753);
  1466. return ret;
  1467. }
  1468. static __devexit int wm8753_i2c_remove(struct i2c_client *client)
  1469. {
  1470. snd_soc_unregister_codec(&client->dev);
  1471. kfree(i2c_get_clientdata(client));
  1472. return 0;
  1473. }
  1474. static const struct i2c_device_id wm8753_i2c_id[] = {
  1475. { "wm8753", 0 },
  1476. { }
  1477. };
  1478. MODULE_DEVICE_TABLE(i2c, wm8753_i2c_id);
  1479. static struct i2c_driver wm8753_i2c_driver = {
  1480. .driver = {
  1481. .name = "wm8753-codec",
  1482. .owner = THIS_MODULE,
  1483. },
  1484. .probe = wm8753_i2c_probe,
  1485. .remove = __devexit_p(wm8753_i2c_remove),
  1486. .id_table = wm8753_i2c_id,
  1487. };
  1488. #endif
  1489. static int __init wm8753_modinit(void)
  1490. {
  1491. int ret = 0;
  1492. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  1493. ret = i2c_add_driver(&wm8753_i2c_driver);
  1494. if (ret != 0) {
  1495. printk(KERN_ERR "Failed to register wm8753 I2C driver: %d\n",
  1496. ret);
  1497. }
  1498. #endif
  1499. #if defined(CONFIG_SPI_MASTER)
  1500. ret = spi_register_driver(&wm8753_spi_driver);
  1501. if (ret != 0) {
  1502. printk(KERN_ERR "Failed to register wm8753 SPI driver: %d\n",
  1503. ret);
  1504. }
  1505. #endif
  1506. return ret;
  1507. }
  1508. module_init(wm8753_modinit);
  1509. static void __exit wm8753_exit(void)
  1510. {
  1511. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  1512. i2c_del_driver(&wm8753_i2c_driver);
  1513. #endif
  1514. #if defined(CONFIG_SPI_MASTER)
  1515. spi_unregister_driver(&wm8753_spi_driver);
  1516. #endif
  1517. }
  1518. module_exit(wm8753_exit);
  1519. MODULE_DESCRIPTION("ASoC WM8753 driver");
  1520. MODULE_AUTHOR("Liam Girdwood");
  1521. MODULE_LICENSE("GPL");