ASoC: wm9713: convert to regmap
[sfrench/cifs-2.6.git] / sound / soc / codecs / wm9713.c
1 /*
2  * wm9713.c  --  ALSA Soc WM9713 codec support
3  *
4  * Copyright 2006-10 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  *  Features:-
13  *
14  *   o Support for AC97 Codec, Voice DAC and Aux DAC
15  *   o Support for DAPM
16  */
17
18 #include <linux/init.h>
19 #include <linux/slab.h>
20 #include <linux/module.h>
21 #include <linux/device.h>
22 #include <linux/regmap.h>
23 #include <sound/core.h>
24 #include <sound/pcm.h>
25 #include <sound/ac97_codec.h>
26 #include <sound/initval.h>
27 #include <sound/pcm_params.h>
28 #include <sound/tlv.h>
29 #include <sound/soc.h>
30
31 #include "wm9713.h"
32
33 #define WM9713_VENDOR_ID 0x574d4c13
34 #define WM9713_VENDOR_ID_MASK 0xffffffff
35
36 struct wm9713_priv {
37         struct snd_ac97 *ac97;
38         u32 pll_in; /* PLL input frequency */
39         unsigned int hp_mixer[2];
40         struct mutex lock;
41 };
42
43 static unsigned int ac97_read(struct snd_soc_codec *codec, unsigned int reg)
44 {
45         return snd_soc_read(codec, reg);
46 }
47 static int ac97_write(struct snd_soc_codec *codec, unsigned int reg,
48                       unsigned int val)
49 {
50         return snd_soc_write(codec, reg, val);
51 }
52
53 #define HPL_MIXER 0
54 #define HPR_MIXER 1
55
56 static const char *wm9713_mic_mixer[] = {"Stereo", "Mic 1", "Mic 2", "Mute"};
57 static const char *wm9713_rec_mux[] = {"Stereo", "Left", "Right", "Mute"};
58 static const char *wm9713_rec_src[] =
59         {"Mic 1", "Mic 2", "Line", "Mono In", "Headphone", "Speaker",
60         "Mono Out", "Zh"};
61 static const char *wm9713_rec_gain[] = {"+1.5dB Steps", "+0.75dB Steps"};
62 static const char *wm9713_alc_select[] = {"None", "Left", "Right", "Stereo"};
63 static const char *wm9713_mono_pga[] = {"Vmid", "Zh", "Mono", "Inv"};
64 static const char *wm9713_spk_pga[] =
65         {"Vmid", "Zh", "Headphone", "Speaker", "Inv", "Headphone Vmid",
66         "Speaker Vmid", "Inv Vmid"};
67 static const char *wm9713_hp_pga[] = {"Vmid", "Zh", "Headphone",
68         "Headphone Vmid"};
69 static const char *wm9713_out3_pga[] = {"Vmid", "Zh", "Inv 1", "Inv 1 Vmid"};
70 static const char *wm9713_out4_pga[] = {"Vmid", "Zh", "Inv 2", "Inv 2 Vmid"};
71 static const char *wm9713_dac_inv[] =
72         {"Off", "Mono", "Speaker", "Left Headphone", "Right Headphone",
73         "Headphone Mono", "NC", "Vmid"};
74 static const char *wm9713_bass[] = {"Linear Control", "Adaptive Boost"};
75 static const char *wm9713_ng_type[] = {"Constant Gain", "Mute"};
76 static const char *wm9713_mic_select[] = {"Mic 1", "Mic 2 A", "Mic 2 B"};
77 static const char *wm9713_micb_select[] = {"MPB", "MPA"};
78
79 static const struct soc_enum wm9713_enum[] = {
80 SOC_ENUM_SINGLE(AC97_LINE, 3, 4, wm9713_mic_mixer), /* record mic mixer 0 */
81 SOC_ENUM_SINGLE(AC97_VIDEO, 14, 4, wm9713_rec_mux), /* record mux hp 1 */
82 SOC_ENUM_SINGLE(AC97_VIDEO, 9, 4, wm9713_rec_mux),  /* record mux mono 2 */
83 SOC_ENUM_SINGLE(AC97_VIDEO, 3, 8, wm9713_rec_src),  /* record mux left 3 */
84 SOC_ENUM_SINGLE(AC97_VIDEO, 0, 8, wm9713_rec_src),  /* record mux right 4*/
85 SOC_ENUM_DOUBLE(AC97_CD, 14, 6, 2, wm9713_rec_gain), /* record step size 5 */
86 SOC_ENUM_SINGLE(AC97_PCI_SVID, 14, 4, wm9713_alc_select), /* alc source select 6*/
87 SOC_ENUM_SINGLE(AC97_REC_GAIN, 14, 4, wm9713_mono_pga), /* mono input select 7 */
88 SOC_ENUM_SINGLE(AC97_REC_GAIN, 11, 8, wm9713_spk_pga), /* speaker left input select 8 */
89 SOC_ENUM_SINGLE(AC97_REC_GAIN, 8, 8, wm9713_spk_pga), /* speaker right input select 9 */
90 SOC_ENUM_SINGLE(AC97_REC_GAIN, 6, 3, wm9713_hp_pga), /* headphone left input 10 */
91 SOC_ENUM_SINGLE(AC97_REC_GAIN, 4, 3, wm9713_hp_pga), /* headphone right input 11 */
92 SOC_ENUM_SINGLE(AC97_REC_GAIN, 2, 4, wm9713_out3_pga), /* out 3 source 12 */
93 SOC_ENUM_SINGLE(AC97_REC_GAIN, 0, 4, wm9713_out4_pga), /* out 4 source 13 */
94 SOC_ENUM_SINGLE(AC97_REC_GAIN_MIC, 13, 8, wm9713_dac_inv), /* dac invert 1 14 */
95 SOC_ENUM_SINGLE(AC97_REC_GAIN_MIC, 10, 8, wm9713_dac_inv), /* dac invert 2 15 */
96 SOC_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 15, 2, wm9713_bass), /* bass control 16 */
97 SOC_ENUM_SINGLE(AC97_PCI_SVID, 5, 2, wm9713_ng_type), /* noise gate type 17 */
98 SOC_ENUM_SINGLE(AC97_3D_CONTROL, 12, 3, wm9713_mic_select), /* mic selection 18 */
99 SOC_ENUM_SINGLE_VIRT(2, wm9713_micb_select), /* mic selection 19 */
100 };
101
102 static const DECLARE_TLV_DB_SCALE(out_tlv, -4650, 150, 0);
103 static const DECLARE_TLV_DB_SCALE(main_tlv, -3450, 150, 0);
104 static const DECLARE_TLV_DB_SCALE(misc_tlv, -1500, 300, 0);
105 static const  DECLARE_TLV_DB_RANGE(mic_tlv,
106         0, 2, TLV_DB_SCALE_ITEM(1200, 600, 0),
107         3, 3, TLV_DB_SCALE_ITEM(3000, 0, 0)
108 );
109
110 static const struct snd_kcontrol_new wm9713_snd_ac97_controls[] = {
111 SOC_DOUBLE_TLV("Speaker Playback Volume", AC97_MASTER, 8, 0, 31, 1, out_tlv),
112 SOC_DOUBLE("Speaker Playback Switch", AC97_MASTER, 15, 7, 1, 1),
113 SOC_DOUBLE_TLV("Headphone Playback Volume", AC97_HEADPHONE, 8, 0, 31, 1,
114                out_tlv),
115 SOC_DOUBLE("Headphone Playback Switch", AC97_HEADPHONE, 15, 7, 1, 1),
116 SOC_DOUBLE_TLV("Line In Volume", AC97_PC_BEEP, 8, 0, 31, 1, main_tlv),
117 SOC_DOUBLE_TLV("PCM Playback Volume", AC97_PHONE, 8, 0, 31, 1, main_tlv),
118 SOC_SINGLE_TLV("Mic 1 Volume", AC97_MIC, 8, 31, 1, main_tlv),
119 SOC_SINGLE_TLV("Mic 2 Volume", AC97_MIC, 0, 31, 1, main_tlv),
120 SOC_SINGLE_TLV("Mic 1 Preamp Volume", AC97_3D_CONTROL, 10, 3, 0, mic_tlv),
121 SOC_SINGLE_TLV("Mic 2 Preamp Volume", AC97_3D_CONTROL, 12, 3, 0, mic_tlv),
122
123 SOC_SINGLE("Mic Boost (+20dB) Switch", AC97_LINE, 5, 1, 0),
124 SOC_SINGLE("Mic Headphone Mixer Volume", AC97_LINE, 0, 7, 1),
125
126 SOC_SINGLE("Capture Switch", AC97_CD, 15, 1, 1),
127 SOC_ENUM("Capture Volume Steps", wm9713_enum[5]),
128 SOC_DOUBLE("Capture Volume", AC97_CD, 8, 0, 31, 0),
129 SOC_SINGLE("Capture ZC Switch", AC97_CD, 7, 1, 0),
130
131 SOC_SINGLE_TLV("Capture to Headphone Volume", AC97_VIDEO, 11, 7, 1, misc_tlv),
132 SOC_SINGLE("Capture to Mono Boost (+20dB) Switch", AC97_VIDEO, 8, 1, 0),
133 SOC_SINGLE("Capture ADC Boost (+20dB) Switch", AC97_VIDEO, 6, 1, 0),
134
135 SOC_SINGLE("ALC Target Volume", AC97_CODEC_CLASS_REV, 12, 15, 0),
136 SOC_SINGLE("ALC Hold Time", AC97_CODEC_CLASS_REV, 8, 15, 0),
137 SOC_SINGLE("ALC Decay Time", AC97_CODEC_CLASS_REV, 4, 15, 0),
138 SOC_SINGLE("ALC Attack Time", AC97_CODEC_CLASS_REV, 0, 15, 0),
139 SOC_ENUM("ALC Function", wm9713_enum[6]),
140 SOC_SINGLE("ALC Max Volume", AC97_PCI_SVID, 11, 7, 0),
141 SOC_SINGLE("ALC ZC Timeout", AC97_PCI_SVID, 9, 3, 0),
142 SOC_SINGLE("ALC ZC Switch", AC97_PCI_SVID, 8, 1, 0),
143 SOC_SINGLE("ALC NG Switch", AC97_PCI_SVID, 7, 1, 0),
144 SOC_ENUM("ALC NG Type", wm9713_enum[17]),
145 SOC_SINGLE("ALC NG Threshold", AC97_PCI_SVID, 0, 31, 0),
146
147 SOC_DOUBLE("Speaker Playback ZC Switch", AC97_MASTER, 14, 6, 1, 0),
148 SOC_DOUBLE("Headphone Playback ZC Switch", AC97_HEADPHONE, 14, 6, 1, 0),
149
150 SOC_SINGLE("Out4 Playback Switch", AC97_MASTER_MONO, 15, 1, 1),
151 SOC_SINGLE("Out4 Playback ZC Switch", AC97_MASTER_MONO, 14, 1, 0),
152 SOC_SINGLE_TLV("Out4 Playback Volume", AC97_MASTER_MONO, 8, 31, 1, out_tlv),
153
154 SOC_SINGLE("Out3 Playback Switch", AC97_MASTER_MONO, 7, 1, 1),
155 SOC_SINGLE("Out3 Playback ZC Switch", AC97_MASTER_MONO, 6, 1, 0),
156 SOC_SINGLE_TLV("Out3 Playback Volume", AC97_MASTER_MONO, 0, 31, 1, out_tlv),
157
158 SOC_SINGLE_TLV("Mono Capture Volume", AC97_MASTER_TONE, 8, 31, 1, main_tlv),
159 SOC_SINGLE("Mono Playback Switch", AC97_MASTER_TONE, 7, 1, 1),
160 SOC_SINGLE("Mono Playback ZC Switch", AC97_MASTER_TONE, 6, 1, 0),
161 SOC_SINGLE_TLV("Mono Playback Volume", AC97_MASTER_TONE, 0, 31, 1, out_tlv),
162
163 SOC_SINGLE_TLV("Headphone Mixer Beep Playback Volume", AC97_AUX, 12, 7, 1,
164                misc_tlv),
165 SOC_SINGLE_TLV("Speaker Mixer Beep Playback Volume", AC97_AUX, 8, 7, 1,
166                misc_tlv),
167 SOC_SINGLE_TLV("Mono Mixer Beep Playback Volume", AC97_AUX, 4, 7, 1, misc_tlv),
168
169 SOC_SINGLE_TLV("Voice Playback Headphone Volume", AC97_PCM, 12, 7, 1,
170                misc_tlv),
171 SOC_SINGLE("Voice Playback Master Volume", AC97_PCM, 8, 7, 1),
172 SOC_SINGLE("Voice Playback Mono Volume", AC97_PCM, 4, 7, 1),
173
174 SOC_SINGLE_TLV("Headphone Mixer Aux Playback Volume", AC97_REC_SEL, 12, 7, 1,
175                misc_tlv),
176
177 SOC_SINGLE_TLV("Speaker Mixer Voice Playback Volume", AC97_PCM, 8, 7, 1,
178                misc_tlv),
179 SOC_SINGLE_TLV("Speaker Mixer Aux Playback Volume", AC97_REC_SEL, 8, 7, 1,
180                misc_tlv),
181
182 SOC_SINGLE_TLV("Mono Mixer Voice Playback Volume", AC97_PCM, 4, 7, 1,
183                misc_tlv),
184 SOC_SINGLE_TLV("Mono Mixer Aux Playback Volume", AC97_REC_SEL, 4, 7, 1,
185                misc_tlv),
186
187 SOC_SINGLE("Aux Playback Headphone Volume", AC97_REC_SEL, 12, 7, 1),
188 SOC_SINGLE("Aux Playback Master Volume", AC97_REC_SEL, 8, 7, 1),
189
190 SOC_ENUM("Bass Control", wm9713_enum[16]),
191 SOC_SINGLE("Bass Cut-off Switch", AC97_GENERAL_PURPOSE, 12, 1, 1),
192 SOC_SINGLE("Tone Cut-off Switch", AC97_GENERAL_PURPOSE, 4, 1, 1),
193 SOC_SINGLE("Playback Attenuate (-6dB) Switch", AC97_GENERAL_PURPOSE, 6, 1, 0),
194 SOC_SINGLE("Bass Volume", AC97_GENERAL_PURPOSE, 8, 15, 1),
195 SOC_SINGLE("Tone Volume", AC97_GENERAL_PURPOSE, 0, 15, 1),
196
197 SOC_SINGLE("3D Upper Cut-off Switch", AC97_REC_GAIN_MIC, 5, 1, 0),
198 SOC_SINGLE("3D Lower Cut-off Switch", AC97_REC_GAIN_MIC, 4, 1, 0),
199 SOC_SINGLE("3D Depth", AC97_REC_GAIN_MIC, 0, 15, 1),
200 };
201
202 static int wm9713_voice_shutdown(struct snd_soc_dapm_widget *w,
203                                  struct snd_kcontrol *kcontrol, int event)
204 {
205         struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
206         u16 status, rate;
207
208         if (WARN_ON(event != SND_SOC_DAPM_PRE_PMD))
209                 return -EINVAL;
210
211         /* Gracefully shut down the voice interface. */
212         status = ac97_read(codec, AC97_EXTENDED_MID) | 0x1000;
213         rate = ac97_read(codec, AC97_HANDSET_RATE) & 0xF0FF;
214         ac97_write(codec, AC97_HANDSET_RATE, rate | 0x0200);
215         schedule_timeout_interruptible(msecs_to_jiffies(1));
216         ac97_write(codec, AC97_HANDSET_RATE, rate | 0x0F00);
217         ac97_write(codec, AC97_EXTENDED_MID, status);
218
219         return 0;
220 }
221
222 static const unsigned int wm9713_mixer_mute_regs[] = {
223         AC97_PC_BEEP,
224         AC97_MASTER_TONE,
225         AC97_PHONE,
226         AC97_REC_SEL,
227         AC97_PCM,
228         AC97_AUX,
229 };
230
231 /* We have to create a fake left and right HP mixers because
232  * the codec only has a single control that is shared by both channels.
233  * This makes it impossible to determine the audio path using the current
234  * register map, thus we add a new (virtual) register to help determine the
235  * audio route within the device.
236  */
237 static int wm9713_hp_mixer_put(struct snd_kcontrol *kcontrol,
238         struct snd_ctl_elem_value *ucontrol)
239 {
240         struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
241         struct snd_soc_codec *codec = snd_soc_dapm_to_codec(dapm);
242         struct wm9713_priv *wm9713 = snd_soc_codec_get_drvdata(codec);
243         unsigned int val = ucontrol->value.integer.value[0];
244         struct soc_mixer_control *mc =
245                 (struct soc_mixer_control *)kcontrol->private_value;
246         unsigned int mixer, mask, shift, old;
247         struct snd_soc_dapm_update update;
248         bool change;
249
250         mixer = mc->shift >> 8;
251         shift = mc->shift & 0xff;
252         mask = (1 << shift);
253
254         mutex_lock(&wm9713->lock);
255         old = wm9713->hp_mixer[mixer];
256         if (ucontrol->value.integer.value[0])
257                 wm9713->hp_mixer[mixer] |= mask;
258         else
259                 wm9713->hp_mixer[mixer] &= ~mask;
260
261         change = old != wm9713->hp_mixer[mixer];
262         if (change) {
263                 update.kcontrol = kcontrol;
264                 update.reg = wm9713_mixer_mute_regs[shift];
265                 update.mask = 0x8000;
266                 if ((wm9713->hp_mixer[0] & mask) ||
267                     (wm9713->hp_mixer[1] & mask))
268                         update.val = 0x0;
269                 else
270                         update.val = 0x8000;
271
272                 snd_soc_dapm_mixer_update_power(dapm, kcontrol, val,
273                         &update);
274         }
275
276         mutex_unlock(&wm9713->lock);
277
278         return change;
279 }
280
281 static int wm9713_hp_mixer_get(struct snd_kcontrol *kcontrol,
282         struct snd_ctl_elem_value *ucontrol)
283 {
284         struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
285         struct snd_soc_codec *codec = snd_soc_dapm_to_codec(dapm);
286         struct wm9713_priv *wm9713 = snd_soc_codec_get_drvdata(codec);
287         struct soc_mixer_control *mc =
288                 (struct soc_mixer_control *)kcontrol->private_value;
289         unsigned int mixer, shift;
290
291         mixer = mc->shift >> 8;
292         shift = mc->shift & 0xff;
293
294         ucontrol->value.integer.value[0] =
295                 (wm9713->hp_mixer[mixer] >> shift) & 1;
296
297         return 0;
298 }
299
300 #define WM9713_HP_MIXER_CTRL(xname, xmixer, xshift) { \
301         .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
302         .info = snd_soc_info_volsw, \
303         .get = wm9713_hp_mixer_get, .put = wm9713_hp_mixer_put, \
304         .private_value = SOC_DOUBLE_VALUE(SND_SOC_NOPM, \
305                 xshift, xmixer, 1, 0, 0) \
306 }
307
308 /* Left Headphone Mixers */
309 static const struct snd_kcontrol_new wm9713_hpl_mixer_controls[] = {
310 WM9713_HP_MIXER_CTRL("Beep Playback Switch", HPL_MIXER, 5),
311 WM9713_HP_MIXER_CTRL("Voice Playback Switch", HPL_MIXER, 4),
312 WM9713_HP_MIXER_CTRL("Aux Playback Switch", HPL_MIXER, 3),
313 WM9713_HP_MIXER_CTRL("PCM Playback Switch", HPL_MIXER, 2),
314 WM9713_HP_MIXER_CTRL("MonoIn Playback Switch", HPL_MIXER, 1),
315 WM9713_HP_MIXER_CTRL("Bypass Playback Switch", HPL_MIXER, 0),
316 };
317
318 /* Right Headphone Mixers */
319 static const struct snd_kcontrol_new wm9713_hpr_mixer_controls[] = {
320 WM9713_HP_MIXER_CTRL("Beep Playback Switch", HPR_MIXER, 5),
321 WM9713_HP_MIXER_CTRL("Voice Playback Switch", HPR_MIXER, 4),
322 WM9713_HP_MIXER_CTRL("Aux Playback Switch", HPR_MIXER, 3),
323 WM9713_HP_MIXER_CTRL("PCM Playback Switch", HPR_MIXER, 2),
324 WM9713_HP_MIXER_CTRL("MonoIn Playback Switch", HPR_MIXER, 1),
325 WM9713_HP_MIXER_CTRL("Bypass Playback Switch", HPR_MIXER, 0),
326 };
327
328 /* headphone capture mux */
329 static const struct snd_kcontrol_new wm9713_hp_rec_mux_controls =
330 SOC_DAPM_ENUM("Route", wm9713_enum[1]);
331
332 /* headphone mic mux */
333 static const struct snd_kcontrol_new wm9713_hp_mic_mux_controls =
334 SOC_DAPM_ENUM("Route", wm9713_enum[0]);
335
336 /* Speaker Mixer */
337 static const struct snd_kcontrol_new wm9713_speaker_mixer_controls[] = {
338 SOC_DAPM_SINGLE("Beep Playback Switch", AC97_AUX, 11, 1, 1),
339 SOC_DAPM_SINGLE("Voice Playback Switch", AC97_PCM, 11, 1, 1),
340 SOC_DAPM_SINGLE("Aux Playback Switch", AC97_REC_SEL, 11, 1, 1),
341 SOC_DAPM_SINGLE("PCM Playback Switch", AC97_PHONE, 14, 1, 1),
342 SOC_DAPM_SINGLE("MonoIn Playback Switch", AC97_MASTER_TONE, 14, 1, 1),
343 SOC_DAPM_SINGLE("Bypass Playback Switch", AC97_PC_BEEP, 14, 1, 1),
344 };
345
346 /* Mono Mixer */
347 static const struct snd_kcontrol_new wm9713_mono_mixer_controls[] = {
348 SOC_DAPM_SINGLE("Beep Playback Switch", AC97_AUX, 7, 1, 1),
349 SOC_DAPM_SINGLE("Voice Playback Switch", AC97_PCM, 7, 1, 1),
350 SOC_DAPM_SINGLE("Aux Playback Switch", AC97_REC_SEL, 7, 1, 1),
351 SOC_DAPM_SINGLE("PCM Playback Switch", AC97_PHONE, 13, 1, 1),
352 SOC_DAPM_SINGLE("MonoIn Playback Switch", AC97_MASTER_TONE, 13, 1, 1),
353 SOC_DAPM_SINGLE("Bypass Playback Switch", AC97_PC_BEEP, 13, 1, 1),
354 SOC_DAPM_SINGLE("Mic 1 Sidetone Switch", AC97_LINE, 7, 1, 1),
355 SOC_DAPM_SINGLE("Mic 2 Sidetone Switch", AC97_LINE, 6, 1, 1),
356 };
357
358 /* mono mic mux */
359 static const struct snd_kcontrol_new wm9713_mono_mic_mux_controls =
360 SOC_DAPM_ENUM("Route", wm9713_enum[2]);
361
362 /* mono output mux */
363 static const struct snd_kcontrol_new wm9713_mono_mux_controls =
364 SOC_DAPM_ENUM("Route", wm9713_enum[7]);
365
366 /* speaker left output mux */
367 static const struct snd_kcontrol_new wm9713_hp_spkl_mux_controls =
368 SOC_DAPM_ENUM("Route", wm9713_enum[8]);
369
370 /* speaker right output mux */
371 static const struct snd_kcontrol_new wm9713_hp_spkr_mux_controls =
372 SOC_DAPM_ENUM("Route", wm9713_enum[9]);
373
374 /* headphone left output mux */
375 static const struct snd_kcontrol_new wm9713_hpl_out_mux_controls =
376 SOC_DAPM_ENUM("Route", wm9713_enum[10]);
377
378 /* headphone right output mux */
379 static const struct snd_kcontrol_new wm9713_hpr_out_mux_controls =
380 SOC_DAPM_ENUM("Route", wm9713_enum[11]);
381
382 /* Out3 mux */
383 static const struct snd_kcontrol_new wm9713_out3_mux_controls =
384 SOC_DAPM_ENUM("Route", wm9713_enum[12]);
385
386 /* Out4 mux */
387 static const struct snd_kcontrol_new wm9713_out4_mux_controls =
388 SOC_DAPM_ENUM("Route", wm9713_enum[13]);
389
390 /* DAC inv mux 1 */
391 static const struct snd_kcontrol_new wm9713_dac_inv1_mux_controls =
392 SOC_DAPM_ENUM("Route", wm9713_enum[14]);
393
394 /* DAC inv mux 2 */
395 static const struct snd_kcontrol_new wm9713_dac_inv2_mux_controls =
396 SOC_DAPM_ENUM("Route", wm9713_enum[15]);
397
398 /* Capture source left */
399 static const struct snd_kcontrol_new wm9713_rec_srcl_mux_controls =
400 SOC_DAPM_ENUM("Route", wm9713_enum[3]);
401
402 /* Capture source right */
403 static const struct snd_kcontrol_new wm9713_rec_srcr_mux_controls =
404 SOC_DAPM_ENUM("Route", wm9713_enum[4]);
405
406 /* mic source */
407 static const struct snd_kcontrol_new wm9713_mic_sel_mux_controls =
408 SOC_DAPM_ENUM("Route", wm9713_enum[18]);
409
410 /* mic source B virtual control */
411 static const struct snd_kcontrol_new wm9713_micb_sel_mux_controls =
412 SOC_DAPM_ENUM("Route", wm9713_enum[19]);
413
414 static const struct snd_soc_dapm_widget wm9713_dapm_widgets[] = {
415 SND_SOC_DAPM_MUX("Capture Headphone Mux", SND_SOC_NOPM, 0, 0,
416         &wm9713_hp_rec_mux_controls),
417 SND_SOC_DAPM_MUX("Sidetone Mux", SND_SOC_NOPM, 0, 0,
418         &wm9713_hp_mic_mux_controls),
419 SND_SOC_DAPM_MUX("Capture Mono Mux", SND_SOC_NOPM, 0, 0,
420         &wm9713_mono_mic_mux_controls),
421 SND_SOC_DAPM_MUX("Mono Out Mux", SND_SOC_NOPM, 0, 0,
422         &wm9713_mono_mux_controls),
423 SND_SOC_DAPM_MUX("Left Speaker Out Mux", SND_SOC_NOPM, 0, 0,
424         &wm9713_hp_spkl_mux_controls),
425 SND_SOC_DAPM_MUX("Right Speaker Out Mux", SND_SOC_NOPM, 0, 0,
426         &wm9713_hp_spkr_mux_controls),
427 SND_SOC_DAPM_MUX("Left Headphone Out Mux", SND_SOC_NOPM, 0, 0,
428         &wm9713_hpl_out_mux_controls),
429 SND_SOC_DAPM_MUX("Right Headphone Out Mux", SND_SOC_NOPM, 0, 0,
430         &wm9713_hpr_out_mux_controls),
431 SND_SOC_DAPM_MUX("Out 3 Mux", SND_SOC_NOPM, 0, 0,
432         &wm9713_out3_mux_controls),
433 SND_SOC_DAPM_MUX("Out 4 Mux", SND_SOC_NOPM, 0, 0,
434         &wm9713_out4_mux_controls),
435 SND_SOC_DAPM_MUX("DAC Inv Mux 1", SND_SOC_NOPM, 0, 0,
436         &wm9713_dac_inv1_mux_controls),
437 SND_SOC_DAPM_MUX("DAC Inv Mux 2", SND_SOC_NOPM, 0, 0,
438         &wm9713_dac_inv2_mux_controls),
439 SND_SOC_DAPM_MUX("Left Capture Source", SND_SOC_NOPM, 0, 0,
440         &wm9713_rec_srcl_mux_controls),
441 SND_SOC_DAPM_MUX("Right Capture Source", SND_SOC_NOPM, 0, 0,
442         &wm9713_rec_srcr_mux_controls),
443 SND_SOC_DAPM_MUX("Mic A Source", SND_SOC_NOPM, 0, 0,
444         &wm9713_mic_sel_mux_controls),
445 SND_SOC_DAPM_MUX("Mic B Source", SND_SOC_NOPM, 0, 0,
446         &wm9713_micb_sel_mux_controls),
447 SND_SOC_DAPM_MIXER("Left HP Mixer", AC97_EXTENDED_MID, 3, 1,
448         &wm9713_hpl_mixer_controls[0], ARRAY_SIZE(wm9713_hpl_mixer_controls)),
449 SND_SOC_DAPM_MIXER("Right HP Mixer", AC97_EXTENDED_MID, 2, 1,
450         &wm9713_hpr_mixer_controls[0], ARRAY_SIZE(wm9713_hpr_mixer_controls)),
451 SND_SOC_DAPM_MIXER("Mono Mixer", AC97_EXTENDED_MID, 0, 1,
452         &wm9713_mono_mixer_controls[0], ARRAY_SIZE(wm9713_mono_mixer_controls)),
453 SND_SOC_DAPM_MIXER("Speaker Mixer", AC97_EXTENDED_MID, 1, 1,
454         &wm9713_speaker_mixer_controls[0],
455         ARRAY_SIZE(wm9713_speaker_mixer_controls)),
456 SND_SOC_DAPM_DAC("Left DAC", "Left HiFi Playback", AC97_EXTENDED_MID, 7, 1),
457 SND_SOC_DAPM_DAC("Right DAC", "Right HiFi Playback", AC97_EXTENDED_MID, 6, 1),
458 SND_SOC_DAPM_MIXER("AC97 Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),
459 SND_SOC_DAPM_MIXER("HP Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),
460 SND_SOC_DAPM_MIXER("Line Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),
461 SND_SOC_DAPM_MIXER("Capture Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),
462 SND_SOC_DAPM_DAC_E("Voice DAC", "Voice Playback", AC97_EXTENDED_MID, 12, 1,
463                    wm9713_voice_shutdown, SND_SOC_DAPM_PRE_PMD),
464 SND_SOC_DAPM_DAC("Aux DAC", "Aux Playback", AC97_EXTENDED_MID, 11, 1),
465 SND_SOC_DAPM_PGA("Left ADC", AC97_EXTENDED_MID, 5, 1, NULL, 0),
466 SND_SOC_DAPM_PGA("Right ADC", AC97_EXTENDED_MID, 4, 1, NULL, 0),
467 SND_SOC_DAPM_ADC("Left HiFi ADC", "Left HiFi Capture", SND_SOC_NOPM, 0, 0),
468 SND_SOC_DAPM_ADC("Right HiFi ADC", "Right HiFi Capture", SND_SOC_NOPM, 0, 0),
469 SND_SOC_DAPM_ADC("Left Voice ADC", "Left Voice Capture", SND_SOC_NOPM, 0, 0),
470 SND_SOC_DAPM_ADC("Right Voice ADC", "Right Voice Capture", SND_SOC_NOPM, 0, 0),
471 SND_SOC_DAPM_PGA("Left Headphone", AC97_EXTENDED_MSTATUS, 10, 1, NULL, 0),
472 SND_SOC_DAPM_PGA("Right Headphone", AC97_EXTENDED_MSTATUS, 9, 1, NULL, 0),
473 SND_SOC_DAPM_PGA("Left Speaker", AC97_EXTENDED_MSTATUS, 8, 1, NULL, 0),
474 SND_SOC_DAPM_PGA("Right Speaker", AC97_EXTENDED_MSTATUS, 7, 1, NULL, 0),
475 SND_SOC_DAPM_PGA("Out 3", AC97_EXTENDED_MSTATUS, 11, 1, NULL, 0),
476 SND_SOC_DAPM_PGA("Out 4", AC97_EXTENDED_MSTATUS, 12, 1, NULL, 0),
477 SND_SOC_DAPM_PGA("Mono Out", AC97_EXTENDED_MSTATUS, 13, 1, NULL, 0),
478 SND_SOC_DAPM_PGA("Left Line In", AC97_EXTENDED_MSTATUS, 6, 1, NULL, 0),
479 SND_SOC_DAPM_PGA("Right Line In", AC97_EXTENDED_MSTATUS, 5, 1, NULL, 0),
480 SND_SOC_DAPM_PGA("Mono In", AC97_EXTENDED_MSTATUS, 4, 1, NULL, 0),
481 SND_SOC_DAPM_PGA("Mic A PGA", AC97_EXTENDED_MSTATUS, 3, 1, NULL, 0),
482 SND_SOC_DAPM_PGA("Mic B PGA", AC97_EXTENDED_MSTATUS, 2, 1, NULL, 0),
483 SND_SOC_DAPM_PGA("Mic A Pre Amp", AC97_EXTENDED_MSTATUS, 1, 1, NULL, 0),
484 SND_SOC_DAPM_PGA("Mic B Pre Amp", AC97_EXTENDED_MSTATUS, 0, 1, NULL, 0),
485 SND_SOC_DAPM_MICBIAS("Mic Bias", AC97_EXTENDED_MSTATUS, 14, 1),
486 SND_SOC_DAPM_OUTPUT("MONO"),
487 SND_SOC_DAPM_OUTPUT("HPL"),
488 SND_SOC_DAPM_OUTPUT("HPR"),
489 SND_SOC_DAPM_OUTPUT("SPKL"),
490 SND_SOC_DAPM_OUTPUT("SPKR"),
491 SND_SOC_DAPM_OUTPUT("OUT3"),
492 SND_SOC_DAPM_OUTPUT("OUT4"),
493 SND_SOC_DAPM_INPUT("LINEL"),
494 SND_SOC_DAPM_INPUT("LINER"),
495 SND_SOC_DAPM_INPUT("MONOIN"),
496 SND_SOC_DAPM_INPUT("PCBEEP"),
497 SND_SOC_DAPM_INPUT("MIC1"),
498 SND_SOC_DAPM_INPUT("MIC2A"),
499 SND_SOC_DAPM_INPUT("MIC2B"),
500 SND_SOC_DAPM_VMID("VMID"),
501 };
502
503 static const struct snd_soc_dapm_route wm9713_audio_map[] = {
504         /* left HP mixer */
505         {"Left HP Mixer", "Beep Playback Switch",    "PCBEEP"},
506         {"Left HP Mixer", "Voice Playback Switch",   "Voice DAC"},
507         {"Left HP Mixer", "Aux Playback Switch",     "Aux DAC"},
508         {"Left HP Mixer", "Bypass Playback Switch",  "Left Line In"},
509         {"Left HP Mixer", "PCM Playback Switch",     "Left DAC"},
510         {"Left HP Mixer", "MonoIn Playback Switch",  "Mono In"},
511         {"Left HP Mixer", NULL,  "Capture Headphone Mux"},
512
513         /* right HP mixer */
514         {"Right HP Mixer", "Beep Playback Switch",    "PCBEEP"},
515         {"Right HP Mixer", "Voice Playback Switch",   "Voice DAC"},
516         {"Right HP Mixer", "Aux Playback Switch",     "Aux DAC"},
517         {"Right HP Mixer", "Bypass Playback Switch",  "Right Line In"},
518         {"Right HP Mixer", "PCM Playback Switch",     "Right DAC"},
519         {"Right HP Mixer", "MonoIn Playback Switch",  "Mono In"},
520         {"Right HP Mixer", NULL,  "Capture Headphone Mux"},
521
522         /* virtual mixer - mixes left & right channels for spk and mono */
523         {"AC97 Mixer", NULL, "Left DAC"},
524         {"AC97 Mixer", NULL, "Right DAC"},
525         {"Line Mixer", NULL, "Right Line In"},
526         {"Line Mixer", NULL, "Left Line In"},
527         {"HP Mixer", NULL, "Left HP Mixer"},
528         {"HP Mixer", NULL, "Right HP Mixer"},
529         {"Capture Mixer", NULL, "Left Capture Source"},
530         {"Capture Mixer", NULL, "Right Capture Source"},
531
532         /* speaker mixer */
533         {"Speaker Mixer", "Beep Playback Switch",    "PCBEEP"},
534         {"Speaker Mixer", "Voice Playback Switch",   "Voice DAC"},
535         {"Speaker Mixer", "Aux Playback Switch",     "Aux DAC"},
536         {"Speaker Mixer", "Bypass Playback Switch",  "Line Mixer"},
537         {"Speaker Mixer", "PCM Playback Switch",     "AC97 Mixer"},
538         {"Speaker Mixer", "MonoIn Playback Switch",  "Mono In"},
539
540         /* mono mixer */
541         {"Mono Mixer", "Beep Playback Switch",    "PCBEEP"},
542         {"Mono Mixer", "Voice Playback Switch",   "Voice DAC"},
543         {"Mono Mixer", "Aux Playback Switch",     "Aux DAC"},
544         {"Mono Mixer", "Bypass Playback Switch",  "Line Mixer"},
545         {"Mono Mixer", "PCM Playback Switch",     "AC97 Mixer"},
546         {"Mono Mixer", "Mic 1 Sidetone Switch", "Mic A PGA"},
547         {"Mono Mixer", "Mic 2 Sidetone Switch", "Mic B PGA"},
548         {"Mono Mixer", NULL,  "Capture Mono Mux"},
549
550         /* DAC inv mux 1 */
551         {"DAC Inv Mux 1", "Mono", "Mono Mixer"},
552         {"DAC Inv Mux 1", "Speaker", "Speaker Mixer"},
553         {"DAC Inv Mux 1", "Left Headphone", "Left HP Mixer"},
554         {"DAC Inv Mux 1", "Right Headphone", "Right HP Mixer"},
555         {"DAC Inv Mux 1", "Headphone Mono", "HP Mixer"},
556
557         /* DAC inv mux 2 */
558         {"DAC Inv Mux 2", "Mono", "Mono Mixer"},
559         {"DAC Inv Mux 2", "Speaker", "Speaker Mixer"},
560         {"DAC Inv Mux 2", "Left Headphone", "Left HP Mixer"},
561         {"DAC Inv Mux 2", "Right Headphone", "Right HP Mixer"},
562         {"DAC Inv Mux 2", "Headphone Mono", "HP Mixer"},
563
564         /* headphone left mux */
565         {"Left Headphone Out Mux", "Headphone", "Left HP Mixer"},
566
567         /* headphone right mux */
568         {"Right Headphone Out Mux", "Headphone", "Right HP Mixer"},
569
570         /* speaker left mux */
571         {"Left Speaker Out Mux", "Headphone", "Left HP Mixer"},
572         {"Left Speaker Out Mux", "Speaker", "Speaker Mixer"},
573         {"Left Speaker Out Mux", "Inv", "DAC Inv Mux 1"},
574
575         /* speaker right mux */
576         {"Right Speaker Out Mux", "Headphone", "Right HP Mixer"},
577         {"Right Speaker Out Mux", "Speaker", "Speaker Mixer"},
578         {"Right Speaker Out Mux", "Inv", "DAC Inv Mux 2"},
579
580         /* mono mux */
581         {"Mono Out Mux", "Mono", "Mono Mixer"},
582         {"Mono Out Mux", "Inv", "DAC Inv Mux 1"},
583
584         /* out 3 mux */
585         {"Out 3 Mux", "Inv 1", "DAC Inv Mux 1"},
586
587         /* out 4 mux */
588         {"Out 4 Mux", "Inv 2", "DAC Inv Mux 2"},
589
590         /* output pga */
591         {"HPL", NULL, "Left Headphone"},
592         {"Left Headphone", NULL, "Left Headphone Out Mux"},
593         {"HPR", NULL, "Right Headphone"},
594         {"Right Headphone", NULL, "Right Headphone Out Mux"},
595         {"OUT3", NULL, "Out 3"},
596         {"Out 3", NULL, "Out 3 Mux"},
597         {"OUT4", NULL, "Out 4"},
598         {"Out 4", NULL, "Out 4 Mux"},
599         {"SPKL", NULL, "Left Speaker"},
600         {"Left Speaker", NULL, "Left Speaker Out Mux"},
601         {"SPKR", NULL, "Right Speaker"},
602         {"Right Speaker", NULL, "Right Speaker Out Mux"},
603         {"MONO", NULL, "Mono Out"},
604         {"Mono Out", NULL, "Mono Out Mux"},
605
606         /* input pga */
607         {"Left Line In", NULL, "LINEL"},
608         {"Right Line In", NULL, "LINER"},
609         {"Mono In", NULL, "MONOIN"},
610         {"Mic A PGA", NULL, "Mic A Pre Amp"},
611         {"Mic B PGA", NULL, "Mic B Pre Amp"},
612
613         /* left capture select */
614         {"Left Capture Source", "Mic 1", "Mic A Pre Amp"},
615         {"Left Capture Source", "Mic 2", "Mic B Pre Amp"},
616         {"Left Capture Source", "Line", "LINEL"},
617         {"Left Capture Source", "Mono In", "MONOIN"},
618         {"Left Capture Source", "Headphone", "Left HP Mixer"},
619         {"Left Capture Source", "Speaker", "Speaker Mixer"},
620         {"Left Capture Source", "Mono Out", "Mono Mixer"},
621
622         /* right capture select */
623         {"Right Capture Source", "Mic 1", "Mic A Pre Amp"},
624         {"Right Capture Source", "Mic 2", "Mic B Pre Amp"},
625         {"Right Capture Source", "Line", "LINER"},
626         {"Right Capture Source", "Mono In", "MONOIN"},
627         {"Right Capture Source", "Headphone", "Right HP Mixer"},
628         {"Right Capture Source", "Speaker", "Speaker Mixer"},
629         {"Right Capture Source", "Mono Out", "Mono Mixer"},
630
631         /* left ADC */
632         {"Left ADC", NULL, "Left Capture Source"},
633         {"Left Voice ADC", NULL, "Left ADC"},
634         {"Left HiFi ADC", NULL, "Left ADC"},
635
636         /* right ADC */
637         {"Right ADC", NULL, "Right Capture Source"},
638         {"Right Voice ADC", NULL, "Right ADC"},
639         {"Right HiFi ADC", NULL, "Right ADC"},
640
641         /* mic */
642         {"Mic A Pre Amp", NULL, "Mic A Source"},
643         {"Mic A Source", "Mic 1", "MIC1"},
644         {"Mic A Source", "Mic 2 A", "MIC2A"},
645         {"Mic A Source", "Mic 2 B", "Mic B Source"},
646         {"Mic B Pre Amp", "MPB", "Mic B Source"},
647         {"Mic B Source", NULL, "MIC2B"},
648
649         /* headphone capture */
650         {"Capture Headphone Mux", "Stereo", "Capture Mixer"},
651         {"Capture Headphone Mux", "Left", "Left Capture Source"},
652         {"Capture Headphone Mux", "Right", "Right Capture Source"},
653
654         /* mono capture */
655         {"Capture Mono Mux", "Stereo", "Capture Mixer"},
656         {"Capture Mono Mux", "Left", "Left Capture Source"},
657         {"Capture Mono Mux", "Right", "Right Capture Source"},
658 };
659
660 static bool wm9713_readable_reg(struct device *dev, unsigned int reg)
661 {
662         switch (reg) {
663         case AC97_RESET ... AC97_PCM_SURR_DAC_RATE:
664         case AC97_PCM_LR_ADC_RATE:
665         case AC97_CENTER_LFE_MASTER:
666         case AC97_SPDIF ... AC97_LINE1_LEVEL:
667         case AC97_GPIO_CFG ... 0x5c:
668         case AC97_CODEC_CLASS_REV ... AC97_PCI_SID:
669         case 0x74 ... AC97_VENDOR_ID2:
670                 return true;
671         default:
672                 return false;
673         }
674 }
675
676 static bool wm9713_writeable_reg(struct device *dev, unsigned int reg)
677 {
678         switch (reg) {
679         case AC97_VENDOR_ID1:
680         case AC97_VENDOR_ID2:
681                 return false;
682         default:
683                 return wm9713_readable_reg(dev, reg);
684         }
685 }
686
687 static const struct reg_default wm9713_reg_defaults[] = {
688         { 0x02, 0x8080 },       /* Speaker Output Volume */
689         { 0x04, 0x8080 },       /* Headphone Output Volume */
690         { 0x06, 0x8080 },       /* Out3/OUT4 Volume */
691         { 0x08, 0xc880 },       /* Mono Volume */
692         { 0x0a, 0xe808 },       /* LINEIN Volume */
693         { 0x0c, 0xe808 },       /* DAC PGA Volume */
694         { 0x0e, 0x0808 },       /* MIC PGA Volume */
695         { 0x10, 0x00da },       /* MIC Routing Control */
696         { 0x12, 0x8000 },       /* Record PGA Volume */
697         { 0x14, 0xd600 },       /* Record Routing */
698         { 0x16, 0xaaa0 },       /* PCBEEP Volume */
699         { 0x18, 0xaaa0 },       /* VxDAC Volume */
700         { 0x1a, 0xaaa0 },       /* AUXDAC Volume */
701         { 0x1c, 0x0000 },       /* Output PGA Mux */
702         { 0x1e, 0x0000 },       /* DAC 3D control */
703         { 0x20, 0x0f0f },       /* DAC Tone Control*/
704         { 0x22, 0x0040 },       /* MIC Input Select & Bias */
705         { 0x24, 0x0000 },       /* Output Volume Mapping & Jack */
706         { 0x26, 0x7f00 },       /* Powerdown Ctrl/Stat*/
707         { 0x28, 0x0405 },       /* Extended Audio ID */
708         { 0x2a, 0x0410 },       /* Extended Audio Start/Ctrl */
709         { 0x2c, 0xbb80 },       /* Audio DACs Sample Rate */
710         { 0x2e, 0xbb80 },       /* AUXDAC Sample Rate */
711         { 0x32, 0xbb80 },       /* Audio ADCs Sample Rate */
712         { 0x36, 0x4523 },       /* PCM codec control */
713         { 0x3a, 0x2000 },       /* SPDIF control */
714         { 0x3c, 0xfdff },       /* Powerdown 1 */
715         { 0x3e, 0xffff },       /* Powerdown 2 */
716         { 0x40, 0x0000 },       /* General Purpose */
717         { 0x42, 0x0000 },       /* Fast Power-Up Control */
718         { 0x44, 0x0080 },       /* MCLK/PLL Control */
719         { 0x46, 0x0000 },       /* MCLK/PLL Control */
720         { 0x4c, 0xfffe },       /* GPIO Pin Configuration */
721         { 0x4e, 0xffff },       /* GPIO Pin Polarity / Type */
722         { 0x50, 0x0000 },       /* GPIO Pin Sticky */
723         { 0x52, 0x0000 },       /* GPIO Pin Wake-Up */
724                                 /* GPIO Pin Status */
725         { 0x56, 0xfffe },       /* GPIO Pin Sharing */
726         { 0x58, 0x4000 },       /* GPIO PullUp/PullDown */
727         { 0x5a, 0x0000 },       /* Additional Functions 1 */
728         { 0x5c, 0x0000 },       /* Additional Functions 2 */
729         { 0x60, 0xb032 },       /* ALC Control */
730         { 0x62, 0x3e00 },       /* ALC / Noise Gate Control */
731         { 0x64, 0x0000 },       /* AUXDAC input control */
732         { 0x74, 0x0000 },       /* Digitiser Reg 1 */
733         { 0x76, 0x0006 },       /* Digitiser Reg 2 */
734         { 0x78, 0x0001 },       /* Digitiser Reg 3 */
735         { 0x7a, 0x0000 },       /* Digitiser Read Back */
736 };
737
738 static const struct regmap_config wm9713_regmap_config = {
739         .reg_bits = 16,
740         .reg_stride = 2,
741         .val_bits = 16,
742         .max_register = 0x7e,
743         .cache_type = REGCACHE_RBTREE,
744
745         .reg_defaults = wm9713_reg_defaults,
746         .num_reg_defaults = ARRAY_SIZE(wm9713_reg_defaults),
747         .volatile_reg = regmap_ac97_default_volatile,
748         .readable_reg = wm9713_readable_reg,
749         .writeable_reg = wm9713_writeable_reg,
750 };
751
752 /* PLL divisors */
753 struct _pll_div {
754         u32 divsel:1;
755         u32 divctl:1;
756         u32 lf:1;
757         u32 n:4;
758         u32 k:24;
759 };
760
761 /* The size in bits of the PLL divide multiplied by 10
762  * to allow rounding later */
763 #define FIXED_PLL_SIZE ((1 << 22) * 10)
764
765 static void pll_factors(struct snd_soc_codec *codec,
766         struct _pll_div *pll_div, unsigned int source)
767 {
768         u64 Kpart;
769         unsigned int K, Ndiv, Nmod, target;
770
771         /* The the PLL output is always 98.304MHz. */
772         target = 98304000;
773
774         /* If the input frequency is over 14.4MHz then scale it down. */
775         if (source > 14400000) {
776                 source >>= 1;
777                 pll_div->divsel = 1;
778
779                 if (source > 14400000) {
780                         source >>= 1;
781                         pll_div->divctl = 1;
782                 } else
783                         pll_div->divctl = 0;
784
785         } else {
786                 pll_div->divsel = 0;
787                 pll_div->divctl = 0;
788         }
789
790         /* Low frequency sources require an additional divide in the
791          * loop.
792          */
793         if (source < 8192000) {
794                 pll_div->lf = 1;
795                 target >>= 2;
796         } else
797                 pll_div->lf = 0;
798
799         Ndiv = target / source;
800         if ((Ndiv < 5) || (Ndiv > 12))
801                 dev_warn(codec->dev,
802                         "WM9713 PLL N value %u out of recommended range!\n",
803                         Ndiv);
804
805         pll_div->n = Ndiv;
806         Nmod = target % source;
807         Kpart = FIXED_PLL_SIZE * (long long)Nmod;
808
809         do_div(Kpart, source);
810
811         K = Kpart & 0xFFFFFFFF;
812
813         /* Check if we need to round */
814         if ((K % 10) >= 5)
815                 K += 5;
816
817         /* Move down to proper range now rounding is done */
818         K /= 10;
819
820         pll_div->k = K;
821 }
822
823 /**
824  * Please note that changing the PLL input frequency may require
825  * resynchronisation with the AC97 controller.
826  */
827 static int wm9713_set_pll(struct snd_soc_codec *codec,
828         int pll_id, unsigned int freq_in, unsigned int freq_out)
829 {
830         struct wm9713_priv *wm9713 = snd_soc_codec_get_drvdata(codec);
831         u16 reg, reg2;
832         struct _pll_div pll_div;
833
834         /* turn PLL off ? */
835         if (freq_in == 0) {
836                 /* disable PLL power and select ext source */
837                 reg = ac97_read(codec, AC97_HANDSET_RATE);
838                 ac97_write(codec, AC97_HANDSET_RATE, reg | 0x0080);
839                 reg = ac97_read(codec, AC97_EXTENDED_MID);
840                 ac97_write(codec, AC97_EXTENDED_MID, reg | 0x0200);
841                 wm9713->pll_in = 0;
842                 return 0;
843         }
844
845         pll_factors(codec, &pll_div, freq_in);
846
847         if (pll_div.k == 0) {
848                 reg = (pll_div.n << 12) | (pll_div.lf << 11) |
849                         (pll_div.divsel << 9) | (pll_div.divctl << 8);
850                 ac97_write(codec, AC97_LINE1_LEVEL, reg);
851         } else {
852                 /* write the fractional k to the reg 0x46 pages */
853                 reg2 = (pll_div.n << 12) | (pll_div.lf << 11) | (1 << 10) |
854                         (pll_div.divsel << 9) | (pll_div.divctl << 8);
855
856                 /* K [21:20] */
857                 reg = reg2 | (0x5 << 4) | (pll_div.k >> 20);
858                 ac97_write(codec, AC97_LINE1_LEVEL, reg);
859
860                 /* K [19:16] */
861                 reg = reg2 | (0x4 << 4) | ((pll_div.k >> 16) & 0xf);
862                 ac97_write(codec, AC97_LINE1_LEVEL, reg);
863
864                 /* K [15:12] */
865                 reg = reg2 | (0x3 << 4) | ((pll_div.k >> 12) & 0xf);
866                 ac97_write(codec, AC97_LINE1_LEVEL, reg);
867
868                 /* K [11:8] */
869                 reg = reg2 | (0x2 << 4) | ((pll_div.k >> 8) & 0xf);
870                 ac97_write(codec, AC97_LINE1_LEVEL, reg);
871
872                 /* K [7:4] */
873                 reg = reg2 | (0x1 << 4) | ((pll_div.k >> 4) & 0xf);
874                 ac97_write(codec, AC97_LINE1_LEVEL, reg);
875
876                 reg = reg2 | (0x0 << 4) | (pll_div.k & 0xf); /* K [3:0] */
877                 ac97_write(codec, AC97_LINE1_LEVEL, reg);
878         }
879
880         /* turn PLL on and select as source */
881         reg = ac97_read(codec, AC97_EXTENDED_MID);
882         ac97_write(codec, AC97_EXTENDED_MID, reg & 0xfdff);
883         reg = ac97_read(codec, AC97_HANDSET_RATE);
884         ac97_write(codec, AC97_HANDSET_RATE, reg & 0xff7f);
885         wm9713->pll_in = freq_in;
886
887         /* wait 10ms AC97 link frames for the link to stabilise */
888         schedule_timeout_interruptible(msecs_to_jiffies(10));
889         return 0;
890 }
891
892 static int wm9713_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
893                 int source, unsigned int freq_in, unsigned int freq_out)
894 {
895         struct snd_soc_codec *codec = codec_dai->codec;
896         return wm9713_set_pll(codec, pll_id, freq_in, freq_out);
897 }
898
899 /*
900  * Tristate the PCM DAI lines, tristate can be disabled by calling
901  * wm9713_set_dai_fmt()
902  */
903 static int wm9713_set_dai_tristate(struct snd_soc_dai *codec_dai,
904         int tristate)
905 {
906         struct snd_soc_codec *codec = codec_dai->codec;
907         u16 reg = ac97_read(codec, AC97_CENTER_LFE_MASTER) & 0x9fff;
908
909         if (tristate)
910                 ac97_write(codec, AC97_CENTER_LFE_MASTER, reg);
911
912         return 0;
913 }
914
915 /*
916  * Configure WM9713 clock dividers.
917  * Voice DAC needs 256 FS
918  */
919 static int wm9713_set_dai_clkdiv(struct snd_soc_dai *codec_dai,
920                 int div_id, int div)
921 {
922         struct snd_soc_codec *codec = codec_dai->codec;
923         u16 reg;
924
925         switch (div_id) {
926         case WM9713_PCMCLK_DIV:
927                 reg = ac97_read(codec, AC97_HANDSET_RATE) & 0xf0ff;
928                 ac97_write(codec, AC97_HANDSET_RATE, reg | div);
929                 break;
930         case WM9713_CLKA_MULT:
931                 reg = ac97_read(codec, AC97_HANDSET_RATE) & 0xfffd;
932                 ac97_write(codec, AC97_HANDSET_RATE, reg | div);
933                 break;
934         case WM9713_CLKB_MULT:
935                 reg = ac97_read(codec, AC97_HANDSET_RATE) & 0xfffb;
936                 ac97_write(codec, AC97_HANDSET_RATE, reg | div);
937                 break;
938         case WM9713_HIFI_DIV:
939                 reg = ac97_read(codec, AC97_HANDSET_RATE) & 0x8fff;
940                 ac97_write(codec, AC97_HANDSET_RATE, reg | div);
941                 break;
942         case WM9713_PCMBCLK_DIV:
943                 reg = ac97_read(codec, AC97_CENTER_LFE_MASTER) & 0xf1ff;
944                 ac97_write(codec, AC97_CENTER_LFE_MASTER, reg | div);
945                 break;
946         case WM9713_PCMCLK_PLL_DIV:
947                 reg = ac97_read(codec, AC97_LINE1_LEVEL) & 0xff80;
948                 ac97_write(codec, AC97_LINE1_LEVEL, reg | 0x60 | div);
949                 break;
950         case WM9713_HIFI_PLL_DIV:
951                 reg = ac97_read(codec, AC97_LINE1_LEVEL) & 0xff80;
952                 ac97_write(codec, AC97_LINE1_LEVEL, reg | 0x70 | div);
953                 break;
954         default:
955                 return -EINVAL;
956         }
957
958         return 0;
959 }
960
961 static int wm9713_set_dai_fmt(struct snd_soc_dai *codec_dai,
962                 unsigned int fmt)
963 {
964         struct snd_soc_codec *codec = codec_dai->codec;
965         u16 gpio = ac97_read(codec, AC97_GPIO_CFG) & 0xffc5;
966         u16 reg = 0x8000;
967
968         /* clock masters */
969         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
970         case SND_SOC_DAIFMT_CBM_CFM:
971                 reg |= 0x4000;
972                 gpio |= 0x0010;
973                 break;
974         case SND_SOC_DAIFMT_CBM_CFS:
975                 reg |= 0x6000;
976                 gpio |= 0x0018;
977                 break;
978         case SND_SOC_DAIFMT_CBS_CFS:
979                 reg |= 0x2000;
980                 gpio |= 0x001a;
981                 break;
982         case SND_SOC_DAIFMT_CBS_CFM:
983                 gpio |= 0x0012;
984                 break;
985         }
986
987         /* clock inversion */
988         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
989         case SND_SOC_DAIFMT_IB_IF:
990                 reg |= 0x00c0;
991                 break;
992         case SND_SOC_DAIFMT_IB_NF:
993                 reg |= 0x0080;
994                 break;
995         case SND_SOC_DAIFMT_NB_IF:
996                 reg |= 0x0040;
997                 break;
998         }
999
1000         /* DAI format */
1001         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1002         case SND_SOC_DAIFMT_I2S:
1003                 reg |= 0x0002;
1004                 break;
1005         case SND_SOC_DAIFMT_RIGHT_J:
1006                 break;
1007         case SND_SOC_DAIFMT_LEFT_J:
1008                 reg |= 0x0001;
1009                 break;
1010         case SND_SOC_DAIFMT_DSP_A:
1011                 reg |= 0x0003;
1012                 break;
1013         case SND_SOC_DAIFMT_DSP_B:
1014                 reg |= 0x0043;
1015                 break;
1016         }
1017
1018         ac97_write(codec, AC97_GPIO_CFG, gpio);
1019         ac97_write(codec, AC97_CENTER_LFE_MASTER, reg);
1020         return 0;
1021 }
1022
1023 static int wm9713_pcm_hw_params(struct snd_pcm_substream *substream,
1024                                 struct snd_pcm_hw_params *params,
1025                                 struct snd_soc_dai *dai)
1026 {
1027         struct snd_soc_codec *codec = dai->codec;
1028         u16 reg = ac97_read(codec, AC97_CENTER_LFE_MASTER) & 0xfff3;
1029
1030         switch (params_width(params)) {
1031         case 16:
1032                 break;
1033         case 20:
1034                 reg |= 0x0004;
1035                 break;
1036         case 24:
1037                 reg |= 0x0008;
1038                 break;
1039         case 32:
1040                 reg |= 0x000c;
1041                 break;
1042         }
1043
1044         /* enable PCM interface in master mode */
1045         ac97_write(codec, AC97_CENTER_LFE_MASTER, reg);
1046         return 0;
1047 }
1048
1049 static int ac97_hifi_prepare(struct snd_pcm_substream *substream,
1050                              struct snd_soc_dai *dai)
1051 {
1052         struct snd_soc_codec *codec = dai->codec;
1053         struct snd_pcm_runtime *runtime = substream->runtime;
1054         int reg;
1055         u16 vra;
1056
1057         vra = ac97_read(codec, AC97_EXTENDED_STATUS);
1058         ac97_write(codec, AC97_EXTENDED_STATUS, vra | 0x1);
1059
1060         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1061                 reg = AC97_PCM_FRONT_DAC_RATE;
1062         else
1063                 reg = AC97_PCM_LR_ADC_RATE;
1064
1065         return ac97_write(codec, reg, runtime->rate);
1066 }
1067
1068 static int ac97_aux_prepare(struct snd_pcm_substream *substream,
1069                             struct snd_soc_dai *dai)
1070 {
1071         struct snd_soc_codec *codec = dai->codec;
1072         struct snd_pcm_runtime *runtime = substream->runtime;
1073         u16 vra, xsle;
1074
1075         vra = ac97_read(codec, AC97_EXTENDED_STATUS);
1076         ac97_write(codec, AC97_EXTENDED_STATUS, vra | 0x1);
1077         xsle = ac97_read(codec, AC97_PCI_SID);
1078         ac97_write(codec, AC97_PCI_SID, xsle | 0x8000);
1079
1080         if (substream->stream != SNDRV_PCM_STREAM_PLAYBACK)
1081                 return -ENODEV;
1082
1083         return ac97_write(codec, AC97_PCM_SURR_DAC_RATE, runtime->rate);
1084 }
1085
1086 #define WM9713_RATES (SNDRV_PCM_RATE_8000  |    \
1087                       SNDRV_PCM_RATE_11025 |    \
1088                       SNDRV_PCM_RATE_22050 |    \
1089                       SNDRV_PCM_RATE_44100 |    \
1090                       SNDRV_PCM_RATE_48000)
1091
1092 #define WM9713_PCM_RATES (SNDRV_PCM_RATE_8000  |        \
1093                           SNDRV_PCM_RATE_11025 |        \
1094                           SNDRV_PCM_RATE_16000 |        \
1095                           SNDRV_PCM_RATE_22050 |        \
1096                           SNDRV_PCM_RATE_44100 |        \
1097                           SNDRV_PCM_RATE_48000)
1098
1099 #define WM9713_PCM_FORMATS \
1100         (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
1101          SNDRV_PCM_FMTBIT_S24_LE)
1102
1103 static const struct snd_soc_dai_ops wm9713_dai_ops_hifi = {
1104         .prepare        = ac97_hifi_prepare,
1105         .set_clkdiv     = wm9713_set_dai_clkdiv,
1106         .set_pll        = wm9713_set_dai_pll,
1107 };
1108
1109 static const struct snd_soc_dai_ops wm9713_dai_ops_aux = {
1110         .prepare        = ac97_aux_prepare,
1111         .set_clkdiv     = wm9713_set_dai_clkdiv,
1112         .set_pll        = wm9713_set_dai_pll,
1113 };
1114
1115 static const struct snd_soc_dai_ops wm9713_dai_ops_voice = {
1116         .hw_params      = wm9713_pcm_hw_params,
1117         .set_clkdiv     = wm9713_set_dai_clkdiv,
1118         .set_pll        = wm9713_set_dai_pll,
1119         .set_fmt        = wm9713_set_dai_fmt,
1120         .set_tristate   = wm9713_set_dai_tristate,
1121 };
1122
1123 static struct snd_soc_dai_driver wm9713_dai[] = {
1124 {
1125         .name = "wm9713-hifi",
1126         .playback = {
1127                 .stream_name = "HiFi Playback",
1128                 .channels_min = 1,
1129                 .channels_max = 2,
1130                 .rates = WM9713_RATES,
1131                 .formats = SND_SOC_STD_AC97_FMTS,},
1132         .capture = {
1133                 .stream_name = "HiFi Capture",
1134                 .channels_min = 1,
1135                 .channels_max = 2,
1136                 .rates = WM9713_RATES,
1137                 .formats = SND_SOC_STD_AC97_FMTS,},
1138         .ops = &wm9713_dai_ops_hifi,
1139         },
1140         {
1141         .name = "wm9713-aux",
1142         .playback = {
1143                 .stream_name = "Aux Playback",
1144                 .channels_min = 1,
1145                 .channels_max = 1,
1146                 .rates = WM9713_RATES,
1147                 .formats = SND_SOC_STD_AC97_FMTS,},
1148         .ops = &wm9713_dai_ops_aux,
1149         },
1150         {
1151         .name = "wm9713-voice",
1152         .playback = {
1153                 .stream_name = "Voice Playback",
1154                 .channels_min = 1,
1155                 .channels_max = 1,
1156                 .rates = WM9713_PCM_RATES,
1157                 .formats = WM9713_PCM_FORMATS,},
1158         .capture = {
1159                 .stream_name = "Voice Capture",
1160                 .channels_min = 1,
1161                 .channels_max = 2,
1162                 .rates = WM9713_PCM_RATES,
1163                 .formats = WM9713_PCM_FORMATS,},
1164         .ops = &wm9713_dai_ops_voice,
1165         .symmetric_rates = 1,
1166         },
1167 };
1168
1169 static int wm9713_set_bias_level(struct snd_soc_codec *codec,
1170                                  enum snd_soc_bias_level level)
1171 {
1172         u16 reg;
1173
1174         switch (level) {
1175         case SND_SOC_BIAS_ON:
1176                 /* enable thermal shutdown */
1177                 reg = ac97_read(codec, AC97_EXTENDED_MID) & 0x1bff;
1178                 ac97_write(codec, AC97_EXTENDED_MID, reg);
1179                 break;
1180         case SND_SOC_BIAS_PREPARE:
1181                 break;
1182         case SND_SOC_BIAS_STANDBY:
1183                 /* enable master bias and vmid */
1184                 reg = ac97_read(codec, AC97_EXTENDED_MID) & 0x3bff;
1185                 ac97_write(codec, AC97_EXTENDED_MID, reg);
1186                 ac97_write(codec, AC97_POWERDOWN, 0x0000);
1187                 break;
1188         case SND_SOC_BIAS_OFF:
1189                 /* disable everything including AC link */
1190                 ac97_write(codec, AC97_EXTENDED_MID, 0xffff);
1191                 ac97_write(codec, AC97_EXTENDED_MSTATUS, 0xffff);
1192                 ac97_write(codec, AC97_POWERDOWN, 0xffff);
1193                 break;
1194         }
1195         return 0;
1196 }
1197
1198 static int wm9713_soc_suspend(struct snd_soc_codec *codec)
1199 {
1200         u16 reg;
1201
1202         /* Disable everything except touchpanel - that will be handled
1203          * by the touch driver and left disabled if touch is not in
1204          * use. */
1205         reg = ac97_read(codec, AC97_EXTENDED_MID);
1206         ac97_write(codec, AC97_EXTENDED_MID, reg | 0x7fff);
1207         ac97_write(codec, AC97_EXTENDED_MSTATUS, 0xffff);
1208         ac97_write(codec, AC97_POWERDOWN, 0x6f00);
1209         ac97_write(codec, AC97_POWERDOWN, 0xffff);
1210
1211         return 0;
1212 }
1213
1214 static int wm9713_soc_resume(struct snd_soc_codec *codec)
1215 {
1216         struct wm9713_priv *wm9713 = snd_soc_codec_get_drvdata(codec);
1217         int ret;
1218
1219         ret = snd_ac97_reset(wm9713->ac97, true, WM9713_VENDOR_ID,
1220                 WM9713_VENDOR_ID_MASK);
1221         if (ret < 0)
1222                 return ret;
1223
1224         snd_soc_codec_force_bias_level(codec, SND_SOC_BIAS_STANDBY);
1225
1226         /* do we need to re-start the PLL ? */
1227         if (wm9713->pll_in)
1228                 wm9713_set_pll(codec, 0, wm9713->pll_in, 0);
1229
1230         /* only synchronise the codec if warm reset failed */
1231         if (ret == 0) {
1232                 regcache_mark_dirty(codec->component.regmap);
1233                 snd_soc_cache_sync(codec);
1234         }
1235
1236         return ret;
1237 }
1238
1239 static int wm9713_soc_probe(struct snd_soc_codec *codec)
1240 {
1241         struct wm9713_priv *wm9713 = snd_soc_codec_get_drvdata(codec);
1242         struct regmap *regmap;
1243         int reg;
1244
1245         wm9713->ac97 = snd_soc_new_ac97_codec(codec, WM9713_VENDOR_ID,
1246                 WM9713_VENDOR_ID_MASK);
1247         if (IS_ERR(wm9713->ac97))
1248                 return PTR_ERR(wm9713->ac97);
1249
1250         regmap = devm_regmap_init_ac97(wm9713->ac97, &wm9713_regmap_config);
1251         if (IS_ERR(regmap)) {
1252                 snd_soc_free_ac97_codec(wm9713->ac97);
1253                 return PTR_ERR(regmap);
1254         }
1255
1256         snd_soc_codec_init_regmap(codec, regmap);
1257
1258         /* unmute the adc - move to kcontrol */
1259         reg = ac97_read(codec, AC97_CD) & 0x7fff;
1260         ac97_write(codec, AC97_CD, reg);
1261
1262         return 0;
1263 }
1264
1265 static int wm9713_soc_remove(struct snd_soc_codec *codec)
1266 {
1267         struct wm9713_priv *wm9713 = snd_soc_codec_get_drvdata(codec);
1268
1269         snd_soc_codec_exit_regmap(codec);
1270         snd_soc_free_ac97_codec(wm9713->ac97);
1271         return 0;
1272 }
1273
1274 static struct snd_soc_codec_driver soc_codec_dev_wm9713 = {
1275         .probe =        wm9713_soc_probe,
1276         .remove =       wm9713_soc_remove,
1277         .suspend =      wm9713_soc_suspend,
1278         .resume =       wm9713_soc_resume,
1279         .set_bias_level = wm9713_set_bias_level,
1280
1281         .controls = wm9713_snd_ac97_controls,
1282         .num_controls = ARRAY_SIZE(wm9713_snd_ac97_controls),
1283         .dapm_widgets = wm9713_dapm_widgets,
1284         .num_dapm_widgets = ARRAY_SIZE(wm9713_dapm_widgets),
1285         .dapm_routes = wm9713_audio_map,
1286         .num_dapm_routes = ARRAY_SIZE(wm9713_audio_map),
1287 };
1288
1289 static int wm9713_probe(struct platform_device *pdev)
1290 {
1291         struct wm9713_priv *wm9713;
1292
1293         wm9713 = devm_kzalloc(&pdev->dev, sizeof(*wm9713), GFP_KERNEL);
1294         if (wm9713 == NULL)
1295                 return -ENOMEM;
1296
1297         mutex_init(&wm9713->lock);
1298
1299         platform_set_drvdata(pdev, wm9713);
1300
1301         return snd_soc_register_codec(&pdev->dev,
1302                         &soc_codec_dev_wm9713, wm9713_dai, ARRAY_SIZE(wm9713_dai));
1303 }
1304
1305 static int wm9713_remove(struct platform_device *pdev)
1306 {
1307         snd_soc_unregister_codec(&pdev->dev);
1308         return 0;
1309 }
1310
1311 static struct platform_driver wm9713_codec_driver = {
1312         .driver = {
1313                         .name = "wm9713-codec",
1314         },
1315
1316         .probe = wm9713_probe,
1317         .remove = wm9713_remove,
1318 };
1319
1320 module_platform_driver(wm9713_codec_driver);
1321
1322 MODULE_DESCRIPTION("ASoC WM9713/WM9714 driver");
1323 MODULE_AUTHOR("Liam Girdwood");
1324 MODULE_LICENSE("GPL");