wm8753.c 50 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723
  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/initval.h>
  48. #include <sound/tlv.h>
  49. #include <asm/div64.h>
  50. #include "wm8753.h"
  51. static int caps_charge = 2000;
  52. module_param(caps_charge, int, 0);
  53. MODULE_PARM_DESC(caps_charge, "WM8753 cap charge time (msecs)");
  54. static void wm8753_set_dai_mode(struct snd_soc_codec *codec,
  55. struct snd_soc_dai *dai, unsigned int hifi);
  56. /*
  57. * wm8753 register cache
  58. * We can't read the WM8753 register space when we
  59. * are using 2 wire for device control, so we cache them instead.
  60. */
  61. static const u16 wm8753_reg[] = {
  62. 0x0008, 0x0000, 0x000a, 0x000a,
  63. 0x0033, 0x0000, 0x0007, 0x00ff,
  64. 0x00ff, 0x000f, 0x000f, 0x007b,
  65. 0x0000, 0x0032, 0x0000, 0x00c3,
  66. 0x00c3, 0x00c0, 0x0000, 0x0000,
  67. 0x0000, 0x0000, 0x0000, 0x0000,
  68. 0x0000, 0x0000, 0x0000, 0x0000,
  69. 0x0000, 0x0000, 0x0000, 0x0055,
  70. 0x0005, 0x0050, 0x0055, 0x0050,
  71. 0x0055, 0x0050, 0x0055, 0x0079,
  72. 0x0079, 0x0079, 0x0079, 0x0079,
  73. 0x0000, 0x0000, 0x0000, 0x0000,
  74. 0x0097, 0x0097, 0x0000, 0x0004,
  75. 0x0000, 0x0083, 0x0024, 0x01ba,
  76. 0x0000, 0x0083, 0x0024, 0x01ba,
  77. 0x0000, 0x0000, 0x0000
  78. };
  79. /* codec private data */
  80. struct wm8753_priv {
  81. enum snd_soc_control_type control_type;
  82. unsigned int sysclk;
  83. unsigned int pcmclk;
  84. u16 reg_cache[ARRAY_SIZE(wm8753_reg)];
  85. int dai_func;
  86. };
  87. /*
  88. * read wm8753 register cache
  89. */
  90. static inline unsigned int wm8753_read_reg_cache(struct snd_soc_codec *codec,
  91. unsigned int reg)
  92. {
  93. u16 *cache = codec->reg_cache;
  94. if (reg < 1 || reg >= (ARRAY_SIZE(wm8753_reg) + 1))
  95. return -1;
  96. return cache[reg - 1];
  97. }
  98. /*
  99. * write wm8753 register cache
  100. */
  101. static inline void wm8753_write_reg_cache(struct snd_soc_codec *codec,
  102. unsigned int reg, unsigned int value)
  103. {
  104. u16 *cache = codec->reg_cache;
  105. if (reg < 1 || reg >= (ARRAY_SIZE(wm8753_reg) + 1))
  106. return;
  107. cache[reg - 1] = value;
  108. }
  109. /*
  110. * write to the WM8753 register space
  111. */
  112. static int wm8753_write(struct snd_soc_codec *codec, unsigned int reg,
  113. unsigned int value)
  114. {
  115. u8 data[2];
  116. /* data is
  117. * D15..D9 WM8753 register offset
  118. * D8...D0 register data
  119. */
  120. data[0] = (reg << 1) | ((value >> 8) & 0x0001);
  121. data[1] = value & 0x00ff;
  122. wm8753_write_reg_cache(codec, reg, value);
  123. if (codec->hw_write(codec->control_data, data, 2) == 2)
  124. return 0;
  125. else
  126. return -EIO;
  127. }
  128. #define wm8753_reset(c) wm8753_write(c, WM8753_RESET, 0)
  129. /*
  130. * WM8753 Controls
  131. */
  132. static const char *wm8753_base[] = {"Linear Control", "Adaptive Boost"};
  133. static const char *wm8753_base_filter[] =
  134. {"130Hz @ 48kHz", "200Hz @ 48kHz", "100Hz @ 16kHz", "400Hz @ 48kHz",
  135. "100Hz @ 8kHz", "200Hz @ 8kHz"};
  136. static const char *wm8753_treble[] = {"8kHz", "4kHz"};
  137. static const char *wm8753_alc_func[] = {"Off", "Right", "Left", "Stereo"};
  138. static const char *wm8753_ng_type[] = {"Constant PGA Gain", "Mute ADC Output"};
  139. static const char *wm8753_3d_func[] = {"Capture", "Playback"};
  140. static const char *wm8753_3d_uc[] = {"2.2kHz", "1.5kHz"};
  141. static const char *wm8753_3d_lc[] = {"200Hz", "500Hz"};
  142. static const char *wm8753_deemp[] = {"None", "32kHz", "44.1kHz", "48kHz"};
  143. static const char *wm8753_mono_mix[] = {"Stereo", "Left", "Right", "Mono"};
  144. static const char *wm8753_dac_phase[] = {"Non Inverted", "Inverted"};
  145. static const char *wm8753_line_mix[] = {"Line 1 + 2", "Line 1 - 2",
  146. "Line 1", "Line 2"};
  147. static const char *wm8753_mono_mux[] = {"Line Mix", "Rx Mix"};
  148. static const char *wm8753_right_mux[] = {"Line 2", "Rx Mix"};
  149. static const char *wm8753_left_mux[] = {"Line 1", "Rx Mix"};
  150. static const char *wm8753_rxmsel[] = {"RXP - RXN", "RXP + RXN", "RXP", "RXN"};
  151. static const char *wm8753_sidetone_mux[] = {"Left PGA", "Mic 1", "Mic 2",
  152. "Right PGA"};
  153. static const char *wm8753_mono2_src[] = {"Inverted Mono 1", "Left", "Right",
  154. "Left + Right"};
  155. static const char *wm8753_out3[] = {"VREF", "ROUT2", "Left + Right"};
  156. static const char *wm8753_out4[] = {"VREF", "Capture ST", "LOUT2"};
  157. static const char *wm8753_radcsel[] = {"PGA", "Line or RXP-RXN", "Sidetone"};
  158. static const char *wm8753_ladcsel[] = {"PGA", "Line or RXP-RXN", "Line"};
  159. static const char *wm8753_mono_adc[] = {"Stereo", "Analogue Mix Left",
  160. "Analogue Mix Right", "Digital Mono Mix"};
  161. static const char *wm8753_adc_hp[] = {"3.4Hz @ 48kHz", "82Hz @ 16k",
  162. "82Hz @ 8kHz", "170Hz @ 8kHz"};
  163. static const char *wm8753_adc_filter[] = {"HiFi", "Voice"};
  164. static const char *wm8753_mic_sel[] = {"Mic 1", "Mic 2", "Mic 3"};
  165. static const char *wm8753_dai_mode[] = {"DAI 0", "DAI 1", "DAI 2", "DAI 3"};
  166. static const char *wm8753_dat_sel[] = {"Stereo", "Left ADC", "Right ADC",
  167. "Channel Swap"};
  168. static const char *wm8753_rout2_phase[] = {"Non Inverted", "Inverted"};
  169. static const struct soc_enum wm8753_enum[] = {
  170. SOC_ENUM_SINGLE(WM8753_BASS, 7, 2, wm8753_base),
  171. SOC_ENUM_SINGLE(WM8753_BASS, 4, 6, wm8753_base_filter),
  172. SOC_ENUM_SINGLE(WM8753_TREBLE, 6, 2, wm8753_treble),
  173. SOC_ENUM_SINGLE(WM8753_ALC1, 7, 4, wm8753_alc_func),
  174. SOC_ENUM_SINGLE(WM8753_NGATE, 1, 2, wm8753_ng_type),
  175. SOC_ENUM_SINGLE(WM8753_3D, 7, 2, wm8753_3d_func),
  176. SOC_ENUM_SINGLE(WM8753_3D, 6, 2, wm8753_3d_uc),
  177. SOC_ENUM_SINGLE(WM8753_3D, 5, 2, wm8753_3d_lc),
  178. SOC_ENUM_SINGLE(WM8753_DAC, 1, 4, wm8753_deemp),
  179. SOC_ENUM_SINGLE(WM8753_DAC, 4, 4, wm8753_mono_mix),
  180. SOC_ENUM_SINGLE(WM8753_DAC, 6, 2, wm8753_dac_phase),
  181. SOC_ENUM_SINGLE(WM8753_INCTL1, 3, 4, wm8753_line_mix),
  182. SOC_ENUM_SINGLE(WM8753_INCTL1, 2, 2, wm8753_mono_mux),
  183. SOC_ENUM_SINGLE(WM8753_INCTL1, 1, 2, wm8753_right_mux),
  184. SOC_ENUM_SINGLE(WM8753_INCTL1, 0, 2, wm8753_left_mux),
  185. SOC_ENUM_SINGLE(WM8753_INCTL2, 6, 4, wm8753_rxmsel),
  186. SOC_ENUM_SINGLE(WM8753_INCTL2, 4, 4, wm8753_sidetone_mux),
  187. SOC_ENUM_SINGLE(WM8753_OUTCTL, 7, 4, wm8753_mono2_src),
  188. SOC_ENUM_SINGLE(WM8753_OUTCTL, 0, 3, wm8753_out3),
  189. SOC_ENUM_SINGLE(WM8753_ADCTL2, 7, 3, wm8753_out4),
  190. SOC_ENUM_SINGLE(WM8753_ADCIN, 2, 3, wm8753_radcsel),
  191. SOC_ENUM_SINGLE(WM8753_ADCIN, 0, 3, wm8753_ladcsel),
  192. SOC_ENUM_SINGLE(WM8753_ADCIN, 4, 4, wm8753_mono_adc),
  193. SOC_ENUM_SINGLE(WM8753_ADC, 2, 4, wm8753_adc_hp),
  194. SOC_ENUM_SINGLE(WM8753_ADC, 4, 2, wm8753_adc_filter),
  195. SOC_ENUM_SINGLE(WM8753_MICBIAS, 6, 3, wm8753_mic_sel),
  196. SOC_ENUM_SINGLE(WM8753_IOCTL, 2, 4, wm8753_dai_mode),
  197. SOC_ENUM_SINGLE(WM8753_ADC, 7, 4, wm8753_dat_sel),
  198. SOC_ENUM_SINGLE(WM8753_OUTCTL, 2, 2, wm8753_rout2_phase),
  199. };
  200. static int wm8753_get_dai(struct snd_kcontrol *kcontrol,
  201. struct snd_ctl_elem_value *ucontrol)
  202. {
  203. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  204. int mode = wm8753_read_reg_cache(codec, WM8753_IOCTL);
  205. ucontrol->value.integer.value[0] = (mode & 0xc) >> 2;
  206. return 0;
  207. }
  208. static int wm8753_set_dai(struct snd_kcontrol *kcontrol,
  209. struct snd_ctl_elem_value *ucontrol)
  210. {
  211. struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
  212. int mode = wm8753_read_reg_cache(codec, WM8753_IOCTL);
  213. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  214. if (((mode & 0xc) >> 2) == ucontrol->value.integer.value[0])
  215. return 0;
  216. mode &= 0xfff3;
  217. mode |= (ucontrol->value.integer.value[0] << 2);
  218. wm8753->dai_func = ucontrol->value.integer.value[0];
  219. return 1;
  220. }
  221. static const DECLARE_TLV_DB_SCALE(rec_mix_tlv, -1500, 300, 0);
  222. static const DECLARE_TLV_DB_SCALE(mic_preamp_tlv, 1200, 600, 0);
  223. static const DECLARE_TLV_DB_SCALE(adc_tlv, -9750, 50, 1);
  224. static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1);
  225. static const unsigned int out_tlv[] = {
  226. TLV_DB_RANGE_HEAD(2),
  227. /* 0000000 - 0101111 = "Analogue mute" */
  228. 0, 48, TLV_DB_SCALE_ITEM(-25500, 0, 0),
  229. 48, 127, TLV_DB_SCALE_ITEM(-7300, 100, 0),
  230. };
  231. static const DECLARE_TLV_DB_SCALE(mix_tlv, -1500, 300, 0);
  232. static const DECLARE_TLV_DB_SCALE(voice_mix_tlv, -1200, 300, 0);
  233. static const DECLARE_TLV_DB_SCALE(pga_tlv, -1725, 75, 0);
  234. static const struct snd_kcontrol_new wm8753_snd_controls[] = {
  235. SOC_DOUBLE_R_TLV("PCM Volume", WM8753_LDAC, WM8753_RDAC, 0, 255, 0, dac_tlv),
  236. SOC_DOUBLE_R_TLV("ADC Capture Volume", WM8753_LADC, WM8753_RADC, 0, 255, 0,
  237. adc_tlv),
  238. SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8753_LOUT1V, WM8753_ROUT1V,
  239. 0, 127, 0, out_tlv),
  240. SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8753_LOUT2V, WM8753_ROUT2V, 0,
  241. 127, 0, out_tlv),
  242. SOC_SINGLE_TLV("Mono Playback Volume", WM8753_MOUTV, 0, 127, 0, out_tlv),
  243. SOC_DOUBLE_R_TLV("Bypass Playback Volume", WM8753_LOUTM1, WM8753_ROUTM1, 4, 7,
  244. 1, mix_tlv),
  245. SOC_DOUBLE_R_TLV("Sidetone Playback Volume", WM8753_LOUTM2, WM8753_ROUTM2, 4,
  246. 7, 1, mix_tlv),
  247. SOC_DOUBLE_R_TLV("Voice Playback Volume", WM8753_LOUTM2, WM8753_ROUTM2, 0, 7,
  248. 1, voice_mix_tlv),
  249. SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8753_LOUT1V, WM8753_ROUT1V, 7,
  250. 1, 0),
  251. SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8753_LOUT2V, WM8753_ROUT2V, 7,
  252. 1, 0),
  253. SOC_SINGLE_TLV("Mono Bypass Playback Volume", WM8753_MOUTM1, 4, 7, 1, mix_tlv),
  254. SOC_SINGLE_TLV("Mono Sidetone Playback Volume", WM8753_MOUTM2, 4, 7, 1,
  255. mix_tlv),
  256. SOC_SINGLE_TLV("Mono Voice Playback Volume", WM8753_MOUTM2, 0, 7, 1,
  257. voice_mix_tlv),
  258. SOC_SINGLE("Mono Playback ZC Switch", WM8753_MOUTV, 7, 1, 0),
  259. SOC_ENUM("Bass Boost", wm8753_enum[0]),
  260. SOC_ENUM("Bass Filter", wm8753_enum[1]),
  261. SOC_SINGLE("Bass Volume", WM8753_BASS, 0, 15, 1),
  262. SOC_SINGLE("Treble Volume", WM8753_TREBLE, 0, 15, 1),
  263. SOC_ENUM("Treble Cut-off", wm8753_enum[2]),
  264. SOC_DOUBLE_TLV("Sidetone Capture Volume", WM8753_RECMIX1, 0, 4, 7, 1,
  265. rec_mix_tlv),
  266. SOC_SINGLE_TLV("Voice Sidetone Capture Volume", WM8753_RECMIX2, 0, 7, 1,
  267. rec_mix_tlv),
  268. SOC_DOUBLE_R_TLV("Capture Volume", WM8753_LINVOL, WM8753_RINVOL, 0, 63, 0,
  269. pga_tlv),
  270. SOC_DOUBLE_R("Capture ZC Switch", WM8753_LINVOL, WM8753_RINVOL, 6, 1, 0),
  271. SOC_DOUBLE_R("Capture Switch", WM8753_LINVOL, WM8753_RINVOL, 7, 1, 1),
  272. SOC_ENUM("Capture Filter Select", wm8753_enum[23]),
  273. SOC_ENUM("Capture Filter Cut-off", wm8753_enum[24]),
  274. SOC_SINGLE("Capture Filter Switch", WM8753_ADC, 0, 1, 1),
  275. SOC_SINGLE("ALC Capture Target Volume", WM8753_ALC1, 0, 7, 0),
  276. SOC_SINGLE("ALC Capture Max Volume", WM8753_ALC1, 4, 7, 0),
  277. SOC_ENUM("ALC Capture Function", wm8753_enum[3]),
  278. SOC_SINGLE("ALC Capture ZC Switch", WM8753_ALC2, 8, 1, 0),
  279. SOC_SINGLE("ALC Capture Hold Time", WM8753_ALC2, 0, 15, 1),
  280. SOC_SINGLE("ALC Capture Decay Time", WM8753_ALC3, 4, 15, 1),
  281. SOC_SINGLE("ALC Capture Attack Time", WM8753_ALC3, 0, 15, 0),
  282. SOC_SINGLE("ALC Capture NG Threshold", WM8753_NGATE, 3, 31, 0),
  283. SOC_ENUM("ALC Capture NG Type", wm8753_enum[4]),
  284. SOC_SINGLE("ALC Capture NG Switch", WM8753_NGATE, 0, 1, 0),
  285. SOC_ENUM("3D Function", wm8753_enum[5]),
  286. SOC_ENUM("3D Upper Cut-off", wm8753_enum[6]),
  287. SOC_ENUM("3D Lower Cut-off", wm8753_enum[7]),
  288. SOC_SINGLE("3D Volume", WM8753_3D, 1, 15, 0),
  289. SOC_SINGLE("3D Switch", WM8753_3D, 0, 1, 0),
  290. SOC_SINGLE("Capture 6dB Attenuate", WM8753_ADCTL1, 2, 1, 0),
  291. SOC_SINGLE("Playback 6dB Attenuate", WM8753_ADCTL1, 1, 1, 0),
  292. SOC_ENUM("De-emphasis", wm8753_enum[8]),
  293. SOC_ENUM("Playback Mono Mix", wm8753_enum[9]),
  294. SOC_ENUM("Playback Phase", wm8753_enum[10]),
  295. SOC_SINGLE_TLV("Mic2 Capture Volume", WM8753_INCTL1, 7, 3, 0, mic_preamp_tlv),
  296. SOC_SINGLE_TLV("Mic1 Capture Volume", WM8753_INCTL1, 5, 3, 0, mic_preamp_tlv),
  297. SOC_ENUM_EXT("DAI Mode", wm8753_enum[26], wm8753_get_dai, wm8753_set_dai),
  298. SOC_ENUM("ADC Data Select", wm8753_enum[27]),
  299. SOC_ENUM("ROUT2 Phase", wm8753_enum[28]),
  300. };
  301. /*
  302. * _DAPM_ Controls
  303. */
  304. /* Left Mixer */
  305. static const struct snd_kcontrol_new wm8753_left_mixer_controls[] = {
  306. SOC_DAPM_SINGLE("Voice Playback Switch", WM8753_LOUTM2, 8, 1, 0),
  307. SOC_DAPM_SINGLE("Sidetone Playback Switch", WM8753_LOUTM2, 7, 1, 0),
  308. SOC_DAPM_SINGLE("Left Playback Switch", WM8753_LOUTM1, 8, 1, 0),
  309. SOC_DAPM_SINGLE("Bypass Playback Switch", WM8753_LOUTM1, 7, 1, 0),
  310. };
  311. /* Right mixer */
  312. static const struct snd_kcontrol_new wm8753_right_mixer_controls[] = {
  313. SOC_DAPM_SINGLE("Voice Playback Switch", WM8753_ROUTM2, 8, 1, 0),
  314. SOC_DAPM_SINGLE("Sidetone Playback Switch", WM8753_ROUTM2, 7, 1, 0),
  315. SOC_DAPM_SINGLE("Right Playback Switch", WM8753_ROUTM1, 8, 1, 0),
  316. SOC_DAPM_SINGLE("Bypass Playback Switch", WM8753_ROUTM1, 7, 1, 0),
  317. };
  318. /* Mono mixer */
  319. static const struct snd_kcontrol_new wm8753_mono_mixer_controls[] = {
  320. SOC_DAPM_SINGLE("Left Playback Switch", WM8753_MOUTM1, 8, 1, 0),
  321. SOC_DAPM_SINGLE("Right Playback Switch", WM8753_MOUTM2, 8, 1, 0),
  322. SOC_DAPM_SINGLE("Voice Playback Switch", WM8753_MOUTM2, 3, 1, 0),
  323. SOC_DAPM_SINGLE("Sidetone Playback Switch", WM8753_MOUTM2, 7, 1, 0),
  324. SOC_DAPM_SINGLE("Bypass Playback Switch", WM8753_MOUTM1, 7, 1, 0),
  325. };
  326. /* Mono 2 Mux */
  327. static const struct snd_kcontrol_new wm8753_mono2_controls =
  328. SOC_DAPM_ENUM("Route", wm8753_enum[17]);
  329. /* Out 3 Mux */
  330. static const struct snd_kcontrol_new wm8753_out3_controls =
  331. SOC_DAPM_ENUM("Route", wm8753_enum[18]);
  332. /* Out 4 Mux */
  333. static const struct snd_kcontrol_new wm8753_out4_controls =
  334. SOC_DAPM_ENUM("Route", wm8753_enum[19]);
  335. /* ADC Mono Mix */
  336. static const struct snd_kcontrol_new wm8753_adc_mono_controls =
  337. SOC_DAPM_ENUM("Route", wm8753_enum[22]);
  338. /* Record mixer */
  339. static const struct snd_kcontrol_new wm8753_record_mixer_controls[] = {
  340. SOC_DAPM_SINGLE("Voice Capture Switch", WM8753_RECMIX2, 3, 1, 0),
  341. SOC_DAPM_SINGLE("Left Capture Switch", WM8753_RECMIX1, 3, 1, 0),
  342. SOC_DAPM_SINGLE("Right Capture Switch", WM8753_RECMIX1, 7, 1, 0),
  343. };
  344. /* Left ADC mux */
  345. static const struct snd_kcontrol_new wm8753_adc_left_controls =
  346. SOC_DAPM_ENUM("Route", wm8753_enum[21]);
  347. /* Right ADC mux */
  348. static const struct snd_kcontrol_new wm8753_adc_right_controls =
  349. SOC_DAPM_ENUM("Route", wm8753_enum[20]);
  350. /* MIC mux */
  351. static const struct snd_kcontrol_new wm8753_mic_mux_controls =
  352. SOC_DAPM_ENUM("Route", wm8753_enum[16]);
  353. /* ALC mixer */
  354. static const struct snd_kcontrol_new wm8753_alc_mixer_controls[] = {
  355. SOC_DAPM_SINGLE("Line Capture Switch", WM8753_INCTL2, 3, 1, 0),
  356. SOC_DAPM_SINGLE("Mic2 Capture Switch", WM8753_INCTL2, 2, 1, 0),
  357. SOC_DAPM_SINGLE("Mic1 Capture Switch", WM8753_INCTL2, 1, 1, 0),
  358. SOC_DAPM_SINGLE("Rx Capture Switch", WM8753_INCTL2, 0, 1, 0),
  359. };
  360. /* Left Line mux */
  361. static const struct snd_kcontrol_new wm8753_line_left_controls =
  362. SOC_DAPM_ENUM("Route", wm8753_enum[14]);
  363. /* Right Line mux */
  364. static const struct snd_kcontrol_new wm8753_line_right_controls =
  365. SOC_DAPM_ENUM("Route", wm8753_enum[13]);
  366. /* Mono Line mux */
  367. static const struct snd_kcontrol_new wm8753_line_mono_controls =
  368. SOC_DAPM_ENUM("Route", wm8753_enum[12]);
  369. /* Line mux and mixer */
  370. static const struct snd_kcontrol_new wm8753_line_mux_mix_controls =
  371. SOC_DAPM_ENUM("Route", wm8753_enum[11]);
  372. /* Rx mux and mixer */
  373. static const struct snd_kcontrol_new wm8753_rx_mux_mix_controls =
  374. SOC_DAPM_ENUM("Route", wm8753_enum[15]);
  375. /* Mic Selector Mux */
  376. static const struct snd_kcontrol_new wm8753_mic_sel_mux_controls =
  377. SOC_DAPM_ENUM("Route", wm8753_enum[25]);
  378. static const struct snd_soc_dapm_widget wm8753_dapm_widgets[] = {
  379. SND_SOC_DAPM_MICBIAS("Mic Bias", WM8753_PWR1, 5, 0),
  380. SND_SOC_DAPM_MIXER("Left Mixer", WM8753_PWR4, 0, 0,
  381. &wm8753_left_mixer_controls[0], ARRAY_SIZE(wm8753_left_mixer_controls)),
  382. SND_SOC_DAPM_PGA("Left Out 1", WM8753_PWR3, 8, 0, NULL, 0),
  383. SND_SOC_DAPM_PGA("Left Out 2", WM8753_PWR3, 6, 0, NULL, 0),
  384. SND_SOC_DAPM_DAC("Left DAC", "Left HiFi Playback", WM8753_PWR1, 3, 0),
  385. SND_SOC_DAPM_OUTPUT("LOUT1"),
  386. SND_SOC_DAPM_OUTPUT("LOUT2"),
  387. SND_SOC_DAPM_MIXER("Right Mixer", WM8753_PWR4, 1, 0,
  388. &wm8753_right_mixer_controls[0], ARRAY_SIZE(wm8753_right_mixer_controls)),
  389. SND_SOC_DAPM_PGA("Right Out 1", WM8753_PWR3, 7, 0, NULL, 0),
  390. SND_SOC_DAPM_PGA("Right Out 2", WM8753_PWR3, 5, 0, NULL, 0),
  391. SND_SOC_DAPM_DAC("Right DAC", "Right HiFi Playback", WM8753_PWR1, 2, 0),
  392. SND_SOC_DAPM_OUTPUT("ROUT1"),
  393. SND_SOC_DAPM_OUTPUT("ROUT2"),
  394. SND_SOC_DAPM_MIXER("Mono Mixer", WM8753_PWR4, 2, 0,
  395. &wm8753_mono_mixer_controls[0], ARRAY_SIZE(wm8753_mono_mixer_controls)),
  396. SND_SOC_DAPM_PGA("Mono Out 1", WM8753_PWR3, 2, 0, NULL, 0),
  397. SND_SOC_DAPM_PGA("Mono Out 2", WM8753_PWR3, 1, 0, NULL, 0),
  398. SND_SOC_DAPM_DAC("Voice DAC", "Voice Playback", WM8753_PWR1, 4, 0),
  399. SND_SOC_DAPM_OUTPUT("MONO1"),
  400. SND_SOC_DAPM_MUX("Mono 2 Mux", SND_SOC_NOPM, 0, 0, &wm8753_mono2_controls),
  401. SND_SOC_DAPM_OUTPUT("MONO2"),
  402. SND_SOC_DAPM_MIXER("Out3 Left + Right", -1, 0, 0, NULL, 0),
  403. SND_SOC_DAPM_MUX("Out3 Mux", SND_SOC_NOPM, 0, 0, &wm8753_out3_controls),
  404. SND_SOC_DAPM_PGA("Out 3", WM8753_PWR3, 4, 0, NULL, 0),
  405. SND_SOC_DAPM_OUTPUT("OUT3"),
  406. SND_SOC_DAPM_MUX("Out4 Mux", SND_SOC_NOPM, 0, 0, &wm8753_out4_controls),
  407. SND_SOC_DAPM_PGA("Out 4", WM8753_PWR3, 3, 0, NULL, 0),
  408. SND_SOC_DAPM_OUTPUT("OUT4"),
  409. SND_SOC_DAPM_MIXER("Playback Mixer", WM8753_PWR4, 3, 0,
  410. &wm8753_record_mixer_controls[0],
  411. ARRAY_SIZE(wm8753_record_mixer_controls)),
  412. SND_SOC_DAPM_ADC("Left ADC", "Left Capture", WM8753_PWR2, 3, 0),
  413. SND_SOC_DAPM_ADC("Right ADC", "Right Capture", WM8753_PWR2, 2, 0),
  414. SND_SOC_DAPM_MUX("Capture Left Mixer", SND_SOC_NOPM, 0, 0,
  415. &wm8753_adc_mono_controls),
  416. SND_SOC_DAPM_MUX("Capture Right Mixer", SND_SOC_NOPM, 0, 0,
  417. &wm8753_adc_mono_controls),
  418. SND_SOC_DAPM_MUX("Capture Left Mux", SND_SOC_NOPM, 0, 0,
  419. &wm8753_adc_left_controls),
  420. SND_SOC_DAPM_MUX("Capture Right Mux", SND_SOC_NOPM, 0, 0,
  421. &wm8753_adc_right_controls),
  422. SND_SOC_DAPM_MUX("Mic Sidetone Mux", SND_SOC_NOPM, 0, 0,
  423. &wm8753_mic_mux_controls),
  424. SND_SOC_DAPM_PGA("Left Capture Volume", WM8753_PWR2, 5, 0, NULL, 0),
  425. SND_SOC_DAPM_PGA("Right Capture Volume", WM8753_PWR2, 4, 0, NULL, 0),
  426. SND_SOC_DAPM_MIXER("ALC Mixer", WM8753_PWR2, 6, 0,
  427. &wm8753_alc_mixer_controls[0], ARRAY_SIZE(wm8753_alc_mixer_controls)),
  428. SND_SOC_DAPM_MUX("Line Left Mux", SND_SOC_NOPM, 0, 0,
  429. &wm8753_line_left_controls),
  430. SND_SOC_DAPM_MUX("Line Right Mux", SND_SOC_NOPM, 0, 0,
  431. &wm8753_line_right_controls),
  432. SND_SOC_DAPM_MUX("Line Mono Mux", SND_SOC_NOPM, 0, 0,
  433. &wm8753_line_mono_controls),
  434. SND_SOC_DAPM_MUX("Line Mixer", WM8753_PWR2, 0, 0,
  435. &wm8753_line_mux_mix_controls),
  436. SND_SOC_DAPM_MUX("Rx Mixer", WM8753_PWR2, 1, 0,
  437. &wm8753_rx_mux_mix_controls),
  438. SND_SOC_DAPM_PGA("Mic 1 Volume", WM8753_PWR2, 8, 0, NULL, 0),
  439. SND_SOC_DAPM_PGA("Mic 2 Volume", WM8753_PWR2, 7, 0, NULL, 0),
  440. SND_SOC_DAPM_MUX("Mic Selection Mux", SND_SOC_NOPM, 0, 0,
  441. &wm8753_mic_sel_mux_controls),
  442. SND_SOC_DAPM_INPUT("LINE1"),
  443. SND_SOC_DAPM_INPUT("LINE2"),
  444. SND_SOC_DAPM_INPUT("RXP"),
  445. SND_SOC_DAPM_INPUT("RXN"),
  446. SND_SOC_DAPM_INPUT("ACIN"),
  447. SND_SOC_DAPM_OUTPUT("ACOP"),
  448. SND_SOC_DAPM_INPUT("MIC1N"),
  449. SND_SOC_DAPM_INPUT("MIC1"),
  450. SND_SOC_DAPM_INPUT("MIC2N"),
  451. SND_SOC_DAPM_INPUT("MIC2"),
  452. SND_SOC_DAPM_VMID("VREF"),
  453. };
  454. static const struct snd_soc_dapm_route audio_map[] = {
  455. /* left mixer */
  456. {"Left Mixer", "Left Playback Switch", "Left DAC"},
  457. {"Left Mixer", "Voice Playback Switch", "Voice DAC"},
  458. {"Left Mixer", "Sidetone Playback Switch", "Mic Sidetone Mux"},
  459. {"Left Mixer", "Bypass Playback Switch", "Line Left Mux"},
  460. /* right mixer */
  461. {"Right Mixer", "Right Playback Switch", "Right DAC"},
  462. {"Right Mixer", "Voice Playback Switch", "Voice DAC"},
  463. {"Right Mixer", "Sidetone Playback Switch", "Mic Sidetone Mux"},
  464. {"Right Mixer", "Bypass Playback Switch", "Line Right Mux"},
  465. /* mono mixer */
  466. {"Mono Mixer", "Voice Playback Switch", "Voice DAC"},
  467. {"Mono Mixer", "Left Playback Switch", "Left DAC"},
  468. {"Mono Mixer", "Right Playback Switch", "Right DAC"},
  469. {"Mono Mixer", "Sidetone Playback Switch", "Mic Sidetone Mux"},
  470. {"Mono Mixer", "Bypass Playback Switch", "Line Mono Mux"},
  471. /* left out */
  472. {"Left Out 1", NULL, "Left Mixer"},
  473. {"Left Out 2", NULL, "Left Mixer"},
  474. {"LOUT1", NULL, "Left Out 1"},
  475. {"LOUT2", NULL, "Left Out 2"},
  476. /* right out */
  477. {"Right Out 1", NULL, "Right Mixer"},
  478. {"Right Out 2", NULL, "Right Mixer"},
  479. {"ROUT1", NULL, "Right Out 1"},
  480. {"ROUT2", NULL, "Right Out 2"},
  481. /* mono 1 out */
  482. {"Mono Out 1", NULL, "Mono Mixer"},
  483. {"MONO1", NULL, "Mono Out 1"},
  484. /* mono 2 out */
  485. {"Mono 2 Mux", "Left + Right", "Out3 Left + Right"},
  486. {"Mono 2 Mux", "Inverted Mono 1", "MONO1"},
  487. {"Mono 2 Mux", "Left", "Left Mixer"},
  488. {"Mono 2 Mux", "Right", "Right Mixer"},
  489. {"Mono Out 2", NULL, "Mono 2 Mux"},
  490. {"MONO2", NULL, "Mono Out 2"},
  491. /* out 3 */
  492. {"Out3 Left + Right", NULL, "Left Mixer"},
  493. {"Out3 Left + Right", NULL, "Right Mixer"},
  494. {"Out3 Mux", "VREF", "VREF"},
  495. {"Out3 Mux", "Left + Right", "Out3 Left + Right"},
  496. {"Out3 Mux", "ROUT2", "ROUT2"},
  497. {"Out 3", NULL, "Out3 Mux"},
  498. {"OUT3", NULL, "Out 3"},
  499. /* out 4 */
  500. {"Out4 Mux", "VREF", "VREF"},
  501. {"Out4 Mux", "Capture ST", "Playback Mixer"},
  502. {"Out4 Mux", "LOUT2", "LOUT2"},
  503. {"Out 4", NULL, "Out4 Mux"},
  504. {"OUT4", NULL, "Out 4"},
  505. /* record mixer */
  506. {"Playback Mixer", "Left Capture Switch", "Left Mixer"},
  507. {"Playback Mixer", "Voice Capture Switch", "Mono Mixer"},
  508. {"Playback Mixer", "Right Capture Switch", "Right Mixer"},
  509. /* Mic/SideTone Mux */
  510. {"Mic Sidetone Mux", "Left PGA", "Left Capture Volume"},
  511. {"Mic Sidetone Mux", "Right PGA", "Right Capture Volume"},
  512. {"Mic Sidetone Mux", "Mic 1", "Mic 1 Volume"},
  513. {"Mic Sidetone Mux", "Mic 2", "Mic 2 Volume"},
  514. /* Capture Left Mux */
  515. {"Capture Left Mux", "PGA", "Left Capture Volume"},
  516. {"Capture Left Mux", "Line or RXP-RXN", "Line Left Mux"},
  517. {"Capture Left Mux", "Line", "LINE1"},
  518. /* Capture Right Mux */
  519. {"Capture Right Mux", "PGA", "Right Capture Volume"},
  520. {"Capture Right Mux", "Line or RXP-RXN", "Line Right Mux"},
  521. {"Capture Right Mux", "Sidetone", "Playback Mixer"},
  522. /* Mono Capture mixer-mux */
  523. {"Capture Right Mixer", "Stereo", "Capture Right Mux"},
  524. {"Capture Left Mixer", "Stereo", "Capture Left Mux"},
  525. {"Capture Left Mixer", "Analogue Mix Left", "Capture Left Mux"},
  526. {"Capture Left Mixer", "Analogue Mix Left", "Capture Right Mux"},
  527. {"Capture Right Mixer", "Analogue Mix Right", "Capture Left Mux"},
  528. {"Capture Right Mixer", "Analogue Mix Right", "Capture Right Mux"},
  529. {"Capture Left Mixer", "Digital Mono Mix", "Capture Left Mux"},
  530. {"Capture Left Mixer", "Digital Mono Mix", "Capture Right Mux"},
  531. {"Capture Right Mixer", "Digital Mono Mix", "Capture Left Mux"},
  532. {"Capture Right Mixer", "Digital Mono Mix", "Capture Right Mux"},
  533. /* ADC */
  534. {"Left ADC", NULL, "Capture Left Mixer"},
  535. {"Right ADC", NULL, "Capture Right Mixer"},
  536. /* Left Capture Volume */
  537. {"Left Capture Volume", NULL, "ACIN"},
  538. /* Right Capture Volume */
  539. {"Right Capture Volume", NULL, "Mic 2 Volume"},
  540. /* ALC Mixer */
  541. {"ALC Mixer", "Line Capture Switch", "Line Mixer"},
  542. {"ALC Mixer", "Mic2 Capture Switch", "Mic 2 Volume"},
  543. {"ALC Mixer", "Mic1 Capture Switch", "Mic 1 Volume"},
  544. {"ALC Mixer", "Rx Capture Switch", "Rx Mixer"},
  545. /* Line Left Mux */
  546. {"Line Left Mux", "Line 1", "LINE1"},
  547. {"Line Left Mux", "Rx Mix", "Rx Mixer"},
  548. /* Line Right Mux */
  549. {"Line Right Mux", "Line 2", "LINE2"},
  550. {"Line Right Mux", "Rx Mix", "Rx Mixer"},
  551. /* Line Mono Mux */
  552. {"Line Mono Mux", "Line Mix", "Line Mixer"},
  553. {"Line Mono Mux", "Rx Mix", "Rx Mixer"},
  554. /* Line Mixer/Mux */
  555. {"Line Mixer", "Line 1 + 2", "LINE1"},
  556. {"Line Mixer", "Line 1 - 2", "LINE1"},
  557. {"Line Mixer", "Line 1 + 2", "LINE2"},
  558. {"Line Mixer", "Line 1 - 2", "LINE2"},
  559. {"Line Mixer", "Line 1", "LINE1"},
  560. {"Line Mixer", "Line 2", "LINE2"},
  561. /* Rx Mixer/Mux */
  562. {"Rx Mixer", "RXP - RXN", "RXP"},
  563. {"Rx Mixer", "RXP + RXN", "RXP"},
  564. {"Rx Mixer", "RXP - RXN", "RXN"},
  565. {"Rx Mixer", "RXP + RXN", "RXN"},
  566. {"Rx Mixer", "RXP", "RXP"},
  567. {"Rx Mixer", "RXN", "RXN"},
  568. /* Mic 1 Volume */
  569. {"Mic 1 Volume", NULL, "MIC1N"},
  570. {"Mic 1 Volume", NULL, "Mic Selection Mux"},
  571. /* Mic 2 Volume */
  572. {"Mic 2 Volume", NULL, "MIC2N"},
  573. {"Mic 2 Volume", NULL, "MIC2"},
  574. /* Mic Selector Mux */
  575. {"Mic Selection Mux", "Mic 1", "MIC1"},
  576. {"Mic Selection Mux", "Mic 2", "MIC2N"},
  577. {"Mic Selection Mux", "Mic 3", "MIC2"},
  578. /* ACOP */
  579. {"ACOP", NULL, "ALC Mixer"},
  580. };
  581. static int wm8753_add_widgets(struct snd_soc_codec *codec)
  582. {
  583. struct snd_soc_dapm_context *dapm = &codec->dapm;
  584. snd_soc_dapm_new_controls(dapm, wm8753_dapm_widgets,
  585. ARRAY_SIZE(wm8753_dapm_widgets));
  586. snd_soc_dapm_add_routes(dapm, 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->dapm.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_dapm_context *dapm =
  1306. container_of(work, struct snd_soc_dapm_context,
  1307. delayed_work.work);
  1308. struct snd_soc_codec *codec = dapm->codec;
  1309. wm8753_set_bias_level(codec, dapm->bias_level);
  1310. }
  1311. static int wm8753_suspend(struct snd_soc_codec *codec, pm_message_t state)
  1312. {
  1313. wm8753_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1314. return 0;
  1315. }
  1316. static int wm8753_resume(struct snd_soc_codec *codec)
  1317. {
  1318. int i;
  1319. u8 data[2];
  1320. u16 *cache = codec->reg_cache;
  1321. /* Sync reg_cache with the hardware */
  1322. for (i = 0; i < ARRAY_SIZE(wm8753_reg); i++) {
  1323. if (i + 1 == WM8753_RESET)
  1324. continue;
  1325. /* No point in writing hardware default values back */
  1326. if (cache[i] == wm8753_reg[i])
  1327. continue;
  1328. data[0] = ((i + 1) << 1) | ((cache[i] >> 8) & 0x0001);
  1329. data[1] = cache[i] & 0x00ff;
  1330. codec->hw_write(codec->control_data, data, 2);
  1331. }
  1332. wm8753_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1333. /* charge wm8753 caps */
  1334. if (codec->dapm.suspend_bias_level == SND_SOC_BIAS_ON) {
  1335. wm8753_set_bias_level(codec, SND_SOC_BIAS_PREPARE);
  1336. codec->dapm.bias_level = SND_SOC_BIAS_ON;
  1337. schedule_delayed_work(&codec->dapm.delayed_work,
  1338. msecs_to_jiffies(caps_charge));
  1339. }
  1340. return 0;
  1341. }
  1342. static int wm8753_probe(struct snd_soc_codec *codec)
  1343. {
  1344. struct wm8753_priv *wm8753 = snd_soc_codec_get_drvdata(codec);
  1345. int ret = 0, reg;
  1346. INIT_DELAYED_WORK(&codec->dapm.delayed_work, wm8753_work);
  1347. ret = snd_soc_codec_set_cache_io(codec, 7, 9, wm8753->control_type);
  1348. if (ret < 0) {
  1349. dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
  1350. return ret;
  1351. }
  1352. ret = wm8753_reset(codec);
  1353. if (ret < 0) {
  1354. dev_err(codec->dev, "Failed to issue reset: %d\n", ret);
  1355. return ret;
  1356. }
  1357. wm8753_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
  1358. wm8753->dai_func = 0;
  1359. /* charge output caps */
  1360. wm8753_set_bias_level(codec, SND_SOC_BIAS_PREPARE);
  1361. schedule_delayed_work(&codec->dapm.delayed_work,
  1362. msecs_to_jiffies(caps_charge));
  1363. /* set the update bits */
  1364. reg = wm8753_read_reg_cache(codec, WM8753_LDAC);
  1365. wm8753_write(codec, WM8753_LDAC, reg | 0x0100);
  1366. reg = wm8753_read_reg_cache(codec, WM8753_RDAC);
  1367. wm8753_write(codec, WM8753_RDAC, reg | 0x0100);
  1368. reg = wm8753_read_reg_cache(codec, WM8753_LADC);
  1369. wm8753_write(codec, WM8753_LADC, reg | 0x0100);
  1370. reg = wm8753_read_reg_cache(codec, WM8753_RADC);
  1371. wm8753_write(codec, WM8753_RADC, reg | 0x0100);
  1372. reg = wm8753_read_reg_cache(codec, WM8753_LOUT1V);
  1373. wm8753_write(codec, WM8753_LOUT1V, reg | 0x0100);
  1374. reg = wm8753_read_reg_cache(codec, WM8753_ROUT1V);
  1375. wm8753_write(codec, WM8753_ROUT1V, reg | 0x0100);
  1376. reg = wm8753_read_reg_cache(codec, WM8753_LOUT2V);
  1377. wm8753_write(codec, WM8753_LOUT2V, reg | 0x0100);
  1378. reg = wm8753_read_reg_cache(codec, WM8753_ROUT2V);
  1379. wm8753_write(codec, WM8753_ROUT2V, reg | 0x0100);
  1380. reg = wm8753_read_reg_cache(codec, WM8753_LINVOL);
  1381. wm8753_write(codec, WM8753_LINVOL, reg | 0x0100);
  1382. reg = wm8753_read_reg_cache(codec, WM8753_RINVOL);
  1383. wm8753_write(codec, WM8753_RINVOL, reg | 0x0100);
  1384. snd_soc_add_controls(codec, wm8753_snd_controls,
  1385. ARRAY_SIZE(wm8753_snd_controls));
  1386. wm8753_add_widgets(codec);
  1387. return 0;
  1388. }
  1389. /* power down chip */
  1390. static int wm8753_remove(struct snd_soc_codec *codec)
  1391. {
  1392. flush_delayed_work_sync(&codec->dapm.delayed_work);
  1393. wm8753_set_bias_level(codec, SND_SOC_BIAS_OFF);
  1394. return 0;
  1395. }
  1396. static struct snd_soc_codec_driver soc_codec_dev_wm8753 = {
  1397. .probe = wm8753_probe,
  1398. .remove = wm8753_remove,
  1399. .suspend = wm8753_suspend,
  1400. .resume = wm8753_resume,
  1401. .set_bias_level = wm8753_set_bias_level,
  1402. .reg_cache_size = ARRAY_SIZE(wm8753_reg),
  1403. .reg_word_size = sizeof(u16),
  1404. .reg_cache_default = wm8753_reg,
  1405. };
  1406. #if defined(CONFIG_SPI_MASTER)
  1407. static int __devinit wm8753_spi_probe(struct spi_device *spi)
  1408. {
  1409. struct wm8753_priv *wm8753;
  1410. int ret;
  1411. wm8753 = kzalloc(sizeof(struct wm8753_priv), GFP_KERNEL);
  1412. if (wm8753 == NULL)
  1413. return -ENOMEM;
  1414. wm8753->control_type = SND_SOC_SPI;
  1415. spi_set_drvdata(spi, wm8753);
  1416. ret = snd_soc_register_codec(&spi->dev,
  1417. &soc_codec_dev_wm8753, wm8753_dai, ARRAY_SIZE(wm8753_dai));
  1418. if (ret < 0)
  1419. kfree(wm8753);
  1420. return ret;
  1421. }
  1422. static int __devexit wm8753_spi_remove(struct spi_device *spi)
  1423. {
  1424. snd_soc_unregister_codec(&spi->dev);
  1425. kfree(spi_get_drvdata(spi));
  1426. return 0;
  1427. }
  1428. static struct spi_driver wm8753_spi_driver = {
  1429. .driver = {
  1430. .name = "wm8753-codec",
  1431. .owner = THIS_MODULE,
  1432. },
  1433. .probe = wm8753_spi_probe,
  1434. .remove = __devexit_p(wm8753_spi_remove),
  1435. };
  1436. #endif /* CONFIG_SPI_MASTER */
  1437. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  1438. static __devinit int wm8753_i2c_probe(struct i2c_client *i2c,
  1439. const struct i2c_device_id *id)
  1440. {
  1441. struct wm8753_priv *wm8753;
  1442. int ret;
  1443. wm8753 = kzalloc(sizeof(struct wm8753_priv), GFP_KERNEL);
  1444. if (wm8753 == NULL)
  1445. return -ENOMEM;
  1446. i2c_set_clientdata(i2c, wm8753);
  1447. wm8753->control_type = SND_SOC_I2C;
  1448. ret = snd_soc_register_codec(&i2c->dev,
  1449. &soc_codec_dev_wm8753, wm8753_dai, ARRAY_SIZE(wm8753_dai));
  1450. if (ret < 0)
  1451. kfree(wm8753);
  1452. return ret;
  1453. }
  1454. static __devexit int wm8753_i2c_remove(struct i2c_client *client)
  1455. {
  1456. snd_soc_unregister_codec(&client->dev);
  1457. kfree(i2c_get_clientdata(client));
  1458. return 0;
  1459. }
  1460. static const struct i2c_device_id wm8753_i2c_id[] = {
  1461. { "wm8753", 0 },
  1462. { }
  1463. };
  1464. MODULE_DEVICE_TABLE(i2c, wm8753_i2c_id);
  1465. static struct i2c_driver wm8753_i2c_driver = {
  1466. .driver = {
  1467. .name = "wm8753-codec",
  1468. .owner = THIS_MODULE,
  1469. },
  1470. .probe = wm8753_i2c_probe,
  1471. .remove = __devexit_p(wm8753_i2c_remove),
  1472. .id_table = wm8753_i2c_id,
  1473. };
  1474. #endif
  1475. static int __init wm8753_modinit(void)
  1476. {
  1477. int ret = 0;
  1478. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  1479. ret = i2c_add_driver(&wm8753_i2c_driver);
  1480. if (ret != 0) {
  1481. printk(KERN_ERR "Failed to register wm8753 I2C driver: %d\n",
  1482. ret);
  1483. }
  1484. #endif
  1485. #if defined(CONFIG_SPI_MASTER)
  1486. ret = spi_register_driver(&wm8753_spi_driver);
  1487. if (ret != 0) {
  1488. printk(KERN_ERR "Failed to register wm8753 SPI driver: %d\n",
  1489. ret);
  1490. }
  1491. #endif
  1492. return ret;
  1493. }
  1494. module_init(wm8753_modinit);
  1495. static void __exit wm8753_exit(void)
  1496. {
  1497. #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
  1498. i2c_del_driver(&wm8753_i2c_driver);
  1499. #endif
  1500. #if defined(CONFIG_SPI_MASTER)
  1501. spi_unregister_driver(&wm8753_spi_driver);
  1502. #endif
  1503. }
  1504. module_exit(wm8753_exit);
  1505. MODULE_DESCRIPTION("ASoC WM8753 driver");
  1506. MODULE_AUTHOR("Liam Girdwood");
  1507. MODULE_LICENSE("GPL");