projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
ASoC: make ops a pointer in 'struct snd_soc_dai'
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / sound / soc / codecs / wm8971.c
CommitLineData
8bae3e23
KK		 1/*
2 * wm8971.c -- WM8971 ALSA SoC Audio driver
3 *
4 * Copyright 2005 Lab126, Inc.
5 *
6 * Author: Kenneth Kiraly <kiraly@lab126.com>
7 *
8 * Based on wm8753.c by Liam Girdwood
9 *
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
14 */
15
16#include <linux/module.h>
17#include <linux/moduleparam.h>
18#include <linux/init.h>
19#include <linux/delay.h>
20#include <linux/pm.h>
21#include <linux/i2c.h>
22#include <linux/platform_device.h>
23#include <sound/core.h>
24#include <sound/pcm.h>
25#include <sound/pcm_params.h>
26#include <sound/soc.h>
27#include <sound/soc-dapm.h>
28#include <sound/initval.h>
29
30#include "wm8971.h"
31
8bae3e23
KK		 32#define WM8971_VERSION "0.9"
33
34#define WM8971_REG_COUNT 43
35
36static struct workqueue_struct *wm8971_workq = NULL;
37
38/* codec private data */
39struct wm8971_priv {
40 unsigned int sysclk;
41};
42
43/*
44 * wm8971 register cache
45 * We can't read the WM8971 register space when we
46 * are using 2 wire for device control, so we cache them instead.
47 */
48static const u16 wm8971_reg[] = {
49 0x0097, 0x0097, 0x0079, 0x0079, /* 0 */
50 0x0000, 0x0008, 0x0000, 0x000a, /* 4 */
51 0x0000, 0x0000, 0x00ff, 0x00ff, /* 8 */
52 0x000f, 0x000f, 0x0000, 0x0000, /* 12 */
53 0x0000, 0x007b, 0x0000, 0x0032, /* 16 */
54 0x0000, 0x00c3, 0x00c3, 0x00c0, /* 20 */
55 0x0000, 0x0000, 0x0000, 0x0000, /* 24 */
56 0x0000, 0x0000, 0x0000, 0x0000, /* 28 */
57 0x0000, 0x0000, 0x0050, 0x0050, /* 32 */
58 0x0050, 0x0050, 0x0050, 0x0050, /* 36 */
59 0x0079, 0x0079, 0x0079, /* 40 */
60};
61
62static inline unsigned int wm8971_read_reg_cache(struct snd_soc_codec *codec,
63 unsigned int reg)
64{
65 u16 *cache = codec->reg_cache;
66 if (reg < WM8971_REG_COUNT)
67 return cache[reg];
68
69 return -1;
70}
71
72static inline void wm8971_write_reg_cache(struct snd_soc_codec *codec,
73 unsigned int reg, unsigned int value)
74{
75 u16 *cache = codec->reg_cache;
76 if (reg < WM8971_REG_COUNT)
77 cache[reg] = value;
78}
79
80static int wm8971_write(struct snd_soc_codec *codec, unsigned int reg,
81 unsigned int value)
82{
83 u8 data[2];
84
85 /* data is
86 * D15..D9 WM8753 register offset
87 * D8...D0 register data
88 */
89 data[0] = (reg << 1) | ((value >> 8) & 0x0001);
90 data[1] = value & 0x00ff;
91
92 wm8971_write_reg_cache (codec, reg, value);
93 if (codec->hw_write(codec->control_data, data, 2) == 2)
94 return 0;
95 else
96 return -EIO;
97}
98
99#define wm8971_reset(c) wm8971_write(c, WM8971_RESET, 0)
100
101/* WM8971 Controls */
102static const char *wm8971_bass[] = { "Linear Control", "Adaptive Boost" };
103static const char *wm8971_bass_filter[] = { "130Hz @ 48kHz",
104 "200Hz @ 48kHz" };
105static const char *wm8971_treble[] = { "8kHz", "4kHz" };
106static const char *wm8971_alc_func[] = { "Off", "Right", "Left", "Stereo" };
107static const char *wm8971_ng_type[] = { "Constant PGA Gain",
108 "Mute ADC Output" };
109static const char *wm8971_deemp[] = { "None", "32kHz", "44.1kHz", "48kHz" };
110static const char *wm8971_mono_mux[] = {"Stereo", "Mono (Left)",
111 "Mono (Right)", "Digital Mono"};
112static const char *wm8971_dac_phase[] = { "Non Inverted", "Inverted" };
113static const char *wm8971_lline_mux[] = {"Line", "NC", "NC", "PGA",
114 "Differential"};
115static const char *wm8971_rline_mux[] = {"Line", "Mic", "NC", "PGA",
116 "Differential"};
117static const char *wm8971_lpga_sel[] = {"Line", "NC", "NC", "Differential"};
118static const char *wm8971_rpga_sel[] = {"Line", "Mic", "NC", "Differential"};
119static const char *wm8971_adcpol[] = {"Normal", "L Invert", "R Invert",
120 "L + R Invert"};
121
122static const struct soc_enum wm8971_enum[] = {
123 SOC_ENUM_SINGLE(WM8971_BASS, 7, 2, wm8971_bass), /* 0 */
124 SOC_ENUM_SINGLE(WM8971_BASS, 6, 2, wm8971_bass_filter),
125 SOC_ENUM_SINGLE(WM8971_TREBLE, 6, 2, wm8971_treble),
126 SOC_ENUM_SINGLE(WM8971_ALC1, 7, 4, wm8971_alc_func),
127 SOC_ENUM_SINGLE(WM8971_NGATE, 1, 2, wm8971_ng_type), /* 4 */
128 SOC_ENUM_SINGLE(WM8971_ADCDAC, 1, 4, wm8971_deemp),
129 SOC_ENUM_SINGLE(WM8971_ADCTL1, 4, 4, wm8971_mono_mux),
130 SOC_ENUM_SINGLE(WM8971_ADCTL1, 1, 2, wm8971_dac_phase),
131 SOC_ENUM_SINGLE(WM8971_LOUTM1, 0, 5, wm8971_lline_mux), /* 8 */
132 SOC_ENUM_SINGLE(WM8971_ROUTM1, 0, 5, wm8971_rline_mux),
133 SOC_ENUM_SINGLE(WM8971_LADCIN, 6, 4, wm8971_lpga_sel),
134 SOC_ENUM_SINGLE(WM8971_RADCIN, 6, 4, wm8971_rpga_sel),
135 SOC_ENUM_SINGLE(WM8971_ADCDAC, 5, 4, wm8971_adcpol), /* 12 */
136 SOC_ENUM_SINGLE(WM8971_ADCIN, 6, 4, wm8971_mono_mux),
137};
138
139static const struct snd_kcontrol_new wm8971_snd_controls[] = {
140 SOC_DOUBLE_R("Capture Volume", WM8971_LINVOL, WM8971_RINVOL, 0, 63, 0),
141 SOC_DOUBLE_R("Capture ZC Switch", WM8971_LINVOL, WM8971_RINVOL,
142 6, 1, 0),
143 SOC_DOUBLE_R("Capture Switch", WM8971_LINVOL, WM8971_RINVOL, 7, 1, 1),
144
145 SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8971_LOUT1V,
146 WM8971_ROUT1V, 7, 1, 0),
147 SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8971_LOUT2V,
148 WM8971_ROUT2V, 7, 1, 0),
149 SOC_SINGLE("Mono Playback ZC Switch", WM8971_MOUTV, 7, 1, 0),
150
151 SOC_DOUBLE_R("PCM Volume", WM8971_LDAC, WM8971_RDAC, 0, 255, 0),
152
153 SOC_DOUBLE_R("Bypass Left Playback Volume", WM8971_LOUTM1,
154 WM8971_LOUTM2, 4, 7, 1),
155 SOC_DOUBLE_R("Bypass Right Playback Volume", WM8971_ROUTM1,
156 WM8971_ROUTM2, 4, 7, 1),
157 SOC_DOUBLE_R("Bypass Mono Playback Volume", WM8971_MOUTM1,
158 WM8971_MOUTM2, 4, 7, 1),
159
160 SOC_DOUBLE_R("Headphone Playback Volume", WM8971_LOUT1V,
161 WM8971_ROUT1V, 0, 127, 0),
162 SOC_DOUBLE_R("Speaker Playback Volume", WM8971_LOUT2V,
163 WM8971_ROUT2V, 0, 127, 0),
164
165 SOC_ENUM("Bass Boost", wm8971_enum[0]),
166 SOC_ENUM("Bass Filter", wm8971_enum[1]),
167 SOC_SINGLE("Bass Volume", WM8971_BASS, 0, 7, 1),
168
169 SOC_SINGLE("Treble Volume", WM8971_TREBLE, 0, 7, 0),
170 SOC_ENUM("Treble Cut-off", wm8971_enum[2]),
171
172 SOC_SINGLE("Capture Filter Switch", WM8971_ADCDAC, 0, 1, 1),
173
174 SOC_SINGLE("ALC Target Volume", WM8971_ALC1, 0, 7, 0),
175 SOC_SINGLE("ALC Max Volume", WM8971_ALC1, 4, 7, 0),
176
177 SOC_SINGLE("ALC Capture Target Volume", WM8971_ALC1, 0, 7, 0),
178 SOC_SINGLE("ALC Capture Max Volume", WM8971_ALC1, 4, 7, 0),
179 SOC_ENUM("ALC Capture Function", wm8971_enum[3]),
180 SOC_SINGLE("ALC Capture ZC Switch", WM8971_ALC2, 7, 1, 0),
181 SOC_SINGLE("ALC Capture Hold Time", WM8971_ALC2, 0, 15, 0),
182 SOC_SINGLE("ALC Capture Decay Time", WM8971_ALC3, 4, 15, 0),
183 SOC_SINGLE("ALC Capture Attack Time", WM8971_ALC3, 0, 15, 0),
184 SOC_SINGLE("ALC Capture NG Threshold", WM8971_NGATE, 3, 31, 0),
185 SOC_ENUM("ALC Capture NG Type", wm8971_enum[4]),
186 SOC_SINGLE("ALC Capture NG Switch", WM8971_NGATE, 0, 1, 0),
187
188 SOC_SINGLE("Capture 6dB Attenuate", WM8971_ADCDAC, 8, 1, 0),
189 SOC_SINGLE("Playback 6dB Attenuate", WM8971_ADCDAC, 7, 1, 0),
190
191 SOC_ENUM("Playback De-emphasis", wm8971_enum[5]),
192 SOC_ENUM("Playback Function", wm8971_enum[6]),
193 SOC_ENUM("Playback Phase", wm8971_enum[7]),
194
195 SOC_DOUBLE_R("Mic Boost", WM8971_LADCIN, WM8971_RADCIN, 4, 3, 0),
196};
197
8bae3e23
KK		 198/*
199 * DAPM Controls
200 */
201
202/* Left Mixer */
203static const struct snd_kcontrol_new wm8971_left_mixer_controls[] = {
204SOC_DAPM_SINGLE("Playback Switch", WM8971_LOUTM1, 8, 1, 0),
205SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_LOUTM1, 7, 1, 0),
206SOC_DAPM_SINGLE("Right Playback Switch", WM8971_LOUTM2, 8, 1, 0),
207SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_LOUTM2, 7, 1, 0),
208};
209
210/* Right Mixer */
211static const struct snd_kcontrol_new wm8971_right_mixer_controls[] = {
212SOC_DAPM_SINGLE("Left Playback Switch", WM8971_ROUTM1, 8, 1, 0),
213SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_ROUTM1, 7, 1, 0),
214SOC_DAPM_SINGLE("Playback Switch", WM8971_ROUTM2, 8, 1, 0),
215SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_ROUTM2, 7, 1, 0),
216};
217
218/* Mono Mixer */
219static const struct snd_kcontrol_new wm8971_mono_mixer_controls[] = {
220SOC_DAPM_SINGLE("Left Playback Switch", WM8971_MOUTM1, 8, 1, 0),
221SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_MOUTM1, 7, 1, 0),
222SOC_DAPM_SINGLE("Right Playback Switch", WM8971_MOUTM2, 8, 1, 0),
223SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_MOUTM2, 7, 1, 0),
224};
225
226/* Left Line Mux */
227static const struct snd_kcontrol_new wm8971_left_line_controls =
228SOC_DAPM_ENUM("Route", wm8971_enum[8]);
229
230/* Right Line Mux */
231static const struct snd_kcontrol_new wm8971_right_line_controls =
232SOC_DAPM_ENUM("Route", wm8971_enum[9]);
233
234/* Left PGA Mux */
235static const struct snd_kcontrol_new wm8971_left_pga_controls =
236SOC_DAPM_ENUM("Route", wm8971_enum[10]);
237
238/* Right PGA Mux */
239static const struct snd_kcontrol_new wm8971_right_pga_controls =
240SOC_DAPM_ENUM("Route", wm8971_enum[11]);
241
242/* Mono ADC Mux */
243static const struct snd_kcontrol_new wm8971_monomux_controls =
244SOC_DAPM_ENUM("Route", wm8971_enum[13]);
245
246static const struct snd_soc_dapm_widget wm8971_dapm_widgets[] = {
247 SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0,
248 &wm8971_left_mixer_controls[0],
249 ARRAY_SIZE(wm8971_left_mixer_controls)),
250 SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0,
251 &wm8971_right_mixer_controls[0],
252 ARRAY_SIZE(wm8971_right_mixer_controls)),
253 SND_SOC_DAPM_MIXER("Mono Mixer", WM8971_PWR2, 2, 0,
254 &wm8971_mono_mixer_controls[0],
255 ARRAY_SIZE(wm8971_mono_mixer_controls)),
256
257 SND_SOC_DAPM_PGA("Right Out 2", WM8971_PWR2, 3, 0, NULL, 0),
258 SND_SOC_DAPM_PGA("Left Out 2", WM8971_PWR2, 4, 0, NULL, 0),
259 SND_SOC_DAPM_PGA("Right Out 1", WM8971_PWR2, 5, 0, NULL, 0),
260 SND_SOC_DAPM_PGA("Left Out 1", WM8971_PWR2, 6, 0, NULL, 0),
261 SND_SOC_DAPM_DAC("Right DAC", "Right Playback", WM8971_PWR2, 7, 0),
262 SND_SOC_DAPM_DAC("Left DAC", "Left Playback", WM8971_PWR2, 8, 0),
263 SND_SOC_DAPM_PGA("Mono Out 1", WM8971_PWR2, 2, 0, NULL, 0),
264
265 SND_SOC_DAPM_MICBIAS("Mic Bias", WM8971_PWR1, 1, 0),
266 SND_SOC_DAPM_ADC("Right ADC", "Right Capture", WM8971_PWR1, 2, 0),
267 SND_SOC_DAPM_ADC("Left ADC", "Left Capture", WM8971_PWR1, 3, 0),
268
269 SND_SOC_DAPM_MUX("Left PGA Mux", WM8971_PWR1, 5, 0,
270 &wm8971_left_pga_controls),
271 SND_SOC_DAPM_MUX("Right PGA Mux", WM8971_PWR1, 4, 0,
272 &wm8971_right_pga_controls),
273 SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0,
274 &wm8971_left_line_controls),
275 SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0,
276 &wm8971_right_line_controls),
277
278 SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0,
279 &wm8971_monomux_controls),
280 SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0,
281 &wm8971_monomux_controls),
282
283 SND_SOC_DAPM_OUTPUT("LOUT1"),
284 SND_SOC_DAPM_OUTPUT("ROUT1"),
285 SND_SOC_DAPM_OUTPUT("LOUT2"),
286 SND_SOC_DAPM_OUTPUT("ROUT2"),
287 SND_SOC_DAPM_OUTPUT("MONO"),
288
289 SND_SOC_DAPM_INPUT("LINPUT1"),
290 SND_SOC_DAPM_INPUT("RINPUT1"),
291 SND_SOC_DAPM_INPUT("MIC"),
292};
293
294static const struct snd_soc_dapm_route audio_map[] = {
295 /* left mixer */
296 {"Left Mixer", "Playback Switch", "Left DAC"},
297 {"Left Mixer", "Left Bypass Switch", "Left Line Mux"},
298 {"Left Mixer", "Right Playback Switch", "Right DAC"},
299 {"Left Mixer", "Right Bypass Switch", "Right Line Mux"},
300
301 /* right mixer */
302 {"Right Mixer", "Left Playback Switch", "Left DAC"},
303 {"Right Mixer", "Left Bypass Switch", "Left Line Mux"},
304 {"Right Mixer", "Playback Switch", "Right DAC"},
305 {"Right Mixer", "Right Bypass Switch", "Right Line Mux"},
306
307 /* left out 1 */
308 {"Left Out 1", NULL, "Left Mixer"},
309 {"LOUT1", NULL, "Left Out 1"},
310
311 /* left out 2 */
312 {"Left Out 2", NULL, "Left Mixer"},
313 {"LOUT2", NULL, "Left Out 2"},
314
315 /* right out 1 */
316 {"Right Out 1", NULL, "Right Mixer"},
317 {"ROUT1", NULL, "Right Out 1"},
318
319 /* right out 2 */
320 {"Right Out 2", NULL, "Right Mixer"},
321 {"ROUT2", NULL, "Right Out 2"},
322
323 /* mono mixer */
324 {"Mono Mixer", "Left Playback Switch", "Left DAC"},
325 {"Mono Mixer", "Left Bypass Switch", "Left Line Mux"},
326 {"Mono Mixer", "Right Playback Switch", "Right DAC"},
327 {"Mono Mixer", "Right Bypass Switch", "Right Line Mux"},
328
329 /* mono out */
330 {"Mono Out", NULL, "Mono Mixer"},
331 {"MONO1", NULL, "Mono Out"},
332
333 /* Left Line Mux */
334 {"Left Line Mux", "Line", "LINPUT1"},
335 {"Left Line Mux", "PGA", "Left PGA Mux"},
336 {"Left Line Mux", "Differential", "Differential Mux"},
337
338 /* Right Line Mux */
339 {"Right Line Mux", "Line", "RINPUT1"},
340 {"Right Line Mux", "Mic", "MIC"},
341 {"Right Line Mux", "PGA", "Right PGA Mux"},
342 {"Right Line Mux", "Differential", "Differential Mux"},
343
344 /* Left PGA Mux */
345 {"Left PGA Mux", "Line", "LINPUT1"},
346 {"Left PGA Mux", "Differential", "Differential Mux"},
347
348 /* Right PGA Mux */
349 {"Right PGA Mux", "Line", "RINPUT1"},
350 {"Right PGA Mux", "Differential", "Differential Mux"},
351
352 /* Differential Mux */
353 {"Differential Mux", "Line", "LINPUT1"},
354 {"Differential Mux", "Line", "RINPUT1"},
355
356 /* Left ADC Mux */
357 {"Left ADC Mux", "Stereo", "Left PGA Mux"},
358 {"Left ADC Mux", "Mono (Left)", "Left PGA Mux"},
359 {"Left ADC Mux", "Digital Mono", "Left PGA Mux"},
360
361 /* Right ADC Mux */
362 {"Right ADC Mux", "Stereo", "Right PGA Mux"},
363 {"Right ADC Mux", "Mono (Right)", "Right PGA Mux"},
364 {"Right ADC Mux", "Digital Mono", "Right PGA Mux"},
365
366 /* ADC */
367 {"Left ADC", NULL, "Left ADC Mux"},
368 {"Right ADC", NULL, "Right ADC Mux"},
369};
370
371static int wm8971_add_widgets(struct snd_soc_codec *codec)
372{
373 snd_soc_dapm_new_controls(codec, wm8971_dapm_widgets,
374 ARRAY_SIZE(wm8971_dapm_widgets));
375
376 snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
377
378 snd_soc_dapm_new_widgets(codec);
379
380 return 0;
381}
382
383struct _coeff_div {
384 u32 mclk;
385 u32 rate;
386 u16 fs;
387 u8 sr:5;
388 u8 usb:1;
389};
390
391/* codec hifi mclk clock divider coefficients */
392static const struct _coeff_div coeff_div[] = {
393 /* 8k */
394 {12288000, 8000, 1536, 0x6, 0x0},
395 {11289600, 8000, 1408, 0x16, 0x0},
396 {18432000, 8000, 2304, 0x7, 0x0},
397 {16934400, 8000, 2112, 0x17, 0x0},
398 {12000000, 8000, 1500, 0x6, 0x1},
399
400 /* 11.025k */
401 {11289600, 11025, 1024, 0x18, 0x0},
402 {16934400, 11025, 1536, 0x19, 0x0},
403 {12000000, 11025, 1088, 0x19, 0x1},
404
405 /* 16k */
406 {12288000, 16000, 768, 0xa, 0x0},
407 {18432000, 16000, 1152, 0xb, 0x0},
408 {12000000, 16000, 750, 0xa, 0x1},
409
410 /* 22.05k */
411 {11289600, 22050, 512, 0x1a, 0x0},
412 {16934400, 22050, 768, 0x1b, 0x0},
413 {12000000, 22050, 544, 0x1b, 0x1},
414
415 /* 32k */
416 {12288000, 32000, 384, 0xc, 0x0},
417 {18432000, 32000, 576, 0xd, 0x0},
418 {12000000, 32000, 375, 0xa, 0x1},
419
420 /* 44.1k */
421 {11289600, 44100, 256, 0x10, 0x0},
422 {16934400, 44100, 384, 0x11, 0x0},
423 {12000000, 44100, 272, 0x11, 0x1},
424
425 /* 48k */
426 {12288000, 48000, 256, 0x0, 0x0},
427 {18432000, 48000, 384, 0x1, 0x0},
428 {12000000, 48000, 250, 0x0, 0x1},
429
430 /* 88.2k */
431 {11289600, 88200, 128, 0x1e, 0x0},
432 {16934400, 88200, 192, 0x1f, 0x0},
433 {12000000, 88200, 136, 0x1f, 0x1},
434
435 /* 96k */
436 {12288000, 96000, 128, 0xe, 0x0},
437 {18432000, 96000, 192, 0xf, 0x0},
438 {12000000, 96000, 125, 0xe, 0x1},
439};
440
441static int get_coeff(int mclk, int rate)
442{
443 int i;
444
445 for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
446 if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
447 return i;
448 }
449 return -EINVAL;
450}
451
452static int wm8971_set_dai_sysclk(struct snd_soc_dai *codec_dai,
453 int clk_id, unsigned int freq, int dir)
454{
455 struct snd_soc_codec *codec = codec_dai->codec;
456 struct wm8971_priv *wm8971 = codec->private_data;
457
458 switch (freq) {
459 case 11289600:
460 case 12000000:
461 case 12288000:
462 case 16934400:
463 case 18432000:
464 wm8971->sysclk = freq;
465 return 0;
466 }
467 return -EINVAL;
468}
469
470static int wm8971_set_dai_fmt(struct snd_soc_dai *codec_dai,
471 unsigned int fmt)
472{
473 struct snd_soc_codec *codec = codec_dai->codec;
474 u16 iface = 0;
475
476 /* set master/slave audio interface */
477 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
478 case SND_SOC_DAIFMT_CBM_CFM:
479 iface = 0x0040;
480 break;
481 case SND_SOC_DAIFMT_CBS_CFS:
482 break;
483 default:
484 return -EINVAL;
485 }
486
487 /* interface format */
488 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
489 case SND_SOC_DAIFMT_I2S:
490 iface |= 0x0002;
491 break;
492 case SND_SOC_DAIFMT_RIGHT_J:
493 break;
494 case SND_SOC_DAIFMT_LEFT_J:
495 iface |= 0x0001;
496 break;
497 case SND_SOC_DAIFMT_DSP_A:
498 iface |= 0x0003;
499 break;
500 case SND_SOC_DAIFMT_DSP_B:
501 iface |= 0x0013;
502 break;
503 default:
504 return -EINVAL;
505 }
506
507 /* clock inversion */
508 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
509 case SND_SOC_DAIFMT_NB_NF:
510 break;
511 case SND_SOC_DAIFMT_IB_IF:
512 iface |= 0x0090;
513 break;
514 case SND_SOC_DAIFMT_IB_NF:
515 iface |= 0x0080;
516 break;
517 case SND_SOC_DAIFMT_NB_IF:
518 iface |= 0x0010;
519 break;
520 default:
521 return -EINVAL;
522 }
523
524 wm8971_write(codec, WM8971_IFACE, iface);
525 return 0;
526}
527
528static int wm8971_pcm_hw_params(struct snd_pcm_substream *substream,
dee89c4d
MB		 529 struct snd_pcm_hw_params *params,
530 struct snd_soc_dai *dai)
8bae3e23
KK		 531{
532 struct snd_soc_pcm_runtime *rtd = substream->private_data;
533 struct snd_soc_device *socdev = rtd->socdev;
6627a653 534 struct snd_soc_codec *codec = socdev->card->codec;
8bae3e23
KK		 535 struct wm8971_priv *wm8971 = codec->private_data;
536 u16 iface = wm8971_read_reg_cache(codec, WM8971_IFACE) & 0x1f3;
537 u16 srate = wm8971_read_reg_cache(codec, WM8971_SRATE) & 0x1c0;
538 int coeff = get_coeff(wm8971->sysclk, params_rate(params));
539
540 /* bit size */
541 switch (params_format(params)) {
542 case SNDRV_PCM_FORMAT_S16_LE:
543 break;
544 case SNDRV_PCM_FORMAT_S20_3LE:
545 iface |= 0x0004;
546 break;
547 case SNDRV_PCM_FORMAT_S24_LE:
548 iface |= 0x0008;
549 break;
550 case SNDRV_PCM_FORMAT_S32_LE:
551 iface |= 0x000c;
552 break;
553 }
554
555 /* set iface & srate */
556 wm8971_write(codec, WM8971_IFACE, iface);
557 if (coeff >= 0)
558 wm8971_write(codec, WM8971_SRATE, srate |
559 (coeff_div[coeff].sr << 1) | coeff_div[coeff].usb);
560
561 return 0;
562}
563
564static int wm8971_mute(struct snd_soc_dai *dai, int mute)
565{
566 struct snd_soc_codec *codec = dai->codec;
567 u16 mute_reg = wm8971_read_reg_cache(codec, WM8971_ADCDAC) & 0xfff7;
568
569 if (mute)
570 wm8971_write(codec, WM8971_ADCDAC, mute_reg | 0x8);
571 else
572 wm8971_write(codec, WM8971_ADCDAC, mute_reg);
573 return 0;
574}
575
576static int wm8971_set_bias_level(struct snd_soc_codec *codec,
577 enum snd_soc_bias_level level)
578{
579 u16 pwr_reg = wm8971_read_reg_cache(codec, WM8971_PWR1) & 0xfe3e;
580
581 switch (level) {
582 case SND_SOC_BIAS_ON:
583 /* set vmid to 50k and unmute dac */
584 wm8971_write(codec, WM8971_PWR1, pwr_reg | 0x00c1);
585 break;
586 case SND_SOC_BIAS_PREPARE:
587 break;
588 case SND_SOC_BIAS_STANDBY:
589 /* mute dac and set vmid to 500k, enable VREF */
590 wm8971_write(codec, WM8971_PWR1, pwr_reg | 0x0140);
591 break;
592 case SND_SOC_BIAS_OFF:
593 wm8971_write(codec, WM8971_PWR1, 0x0001);
594 break;
595 }
596 codec->bias_level = level;
597 return 0;
598}
599
600#define WM8971_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
601 SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 | SNDRV_PCM_RATE_44100 | \
602 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000)
603
604#define WM8971_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
605 SNDRV_PCM_FMTBIT_S24_LE)
606
6335d055
EM		 607static struct snd_soc_dai_ops wm8971_dai_ops = {
608 .hw_params = wm8971_pcm_hw_params,
609 .digital_mute = wm8971_mute,
610 .set_fmt = wm8971_set_dai_fmt,
611 .set_sysclk = wm8971_set_dai_sysclk,
612};
613
8bae3e23
KK		 614struct snd_soc_dai wm8971_dai = {
615 .name = "WM8971",
616 .playback = {
617 .stream_name = "Playback",
618 .channels_min = 1,
619 .channels_max = 2,
620 .rates = WM8971_RATES,
621 .formats = WM8971_FORMATS,},
622 .capture = {
623 .stream_name = "Capture",
624 .channels_min = 1,
625 .channels_max = 2,
626 .rates = WM8971_RATES,
627 .formats = WM8971_FORMATS,},
6335d055 628 .ops = &wm8971_dai_ops,
8bae3e23
KK		 629};
630EXPORT_SYMBOL_GPL(wm8971_dai);
631
632static void wm8971_work(struct work_struct *work)
633{
634 struct snd_soc_codec *codec =
635 container_of(work, struct snd_soc_codec, delayed_work.work);
636 wm8971_set_bias_level(codec, codec->bias_level);
637}
638
639static int wm8971_suspend(struct platform_device *pdev, pm_message_t state)
640{
641 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 642 struct snd_soc_codec *codec = socdev->card->codec;
8bae3e23
KK		 643
644 wm8971_set_bias_level(codec, SND_SOC_BIAS_OFF);
645 return 0;
646}
647
648static int wm8971_resume(struct platform_device *pdev)
649{
650 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 651 struct snd_soc_codec *codec = socdev->card->codec;
8bae3e23
KK		 652 int i;
653 u8 data[2];
654 u16 *cache = codec->reg_cache;
655 u16 reg;
656
657 /* Sync reg_cache with the hardware */
658 for (i = 0; i < ARRAY_SIZE(wm8971_reg); i++) {
659 if (i + 1 == WM8971_RESET)
660 continue;
661 data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
662 data[1] = cache[i] & 0x00ff;
663 codec->hw_write(codec->control_data, data, 2);
664 }
665
666 wm8971_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
667
668 /* charge wm8971 caps */
669 if (codec->suspend_bias_level == SND_SOC_BIAS_ON) {
670 reg = wm8971_read_reg_cache(codec, WM8971_PWR1) & 0xfe3e;
671 wm8971_write(codec, WM8971_PWR1, reg | 0x01c0);
672 codec->bias_level = SND_SOC_BIAS_ON;
673 queue_delayed_work(wm8971_workq, &codec->delayed_work,
674 msecs_to_jiffies(1000));
675 }
676
677 return 0;
678}
679
680static int wm8971_init(struct snd_soc_device *socdev)
681{
6627a653 682 struct snd_soc_codec *codec = socdev->card->codec;
8bae3e23
KK		 683 int reg, ret = 0;
684
685 codec->name = "WM8971";
686 codec->owner = THIS_MODULE;
687 codec->read = wm8971_read_reg_cache;
688 codec->write = wm8971_write;
689 codec->set_bias_level = wm8971_set_bias_level;
690 codec->dai = &wm8971_dai;
691 codec->reg_cache_size = ARRAY_SIZE(wm8971_reg);
692 codec->num_dai = 1;
693 codec->reg_cache = kmemdup(wm8971_reg, sizeof(wm8971_reg), GFP_KERNEL);
694
695 if (codec->reg_cache == NULL)
696 return -ENOMEM;
697
698 wm8971_reset(codec);
699
700 /* register pcms */
701 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
702 if (ret < 0) {
703 printk(KERN_ERR "wm8971: failed to create pcms\n");
704 goto pcm_err;
705 }
706
707 /* charge output caps - set vmid to 5k for quick power up */
708 reg = wm8971_read_reg_cache(codec, WM8971_PWR1) & 0xfe3e;
709 wm8971_write(codec, WM8971_PWR1, reg | 0x01c0);
710 codec->bias_level = SND_SOC_BIAS_STANDBY;
711 queue_delayed_work(wm8971_workq, &codec->delayed_work,
712 msecs_to_jiffies(1000));
713
714 /* set the update bits */
715 reg = wm8971_read_reg_cache(codec, WM8971_LDAC);
716 wm8971_write(codec, WM8971_LDAC, reg | 0x0100);
717 reg = wm8971_read_reg_cache(codec, WM8971_RDAC);
718 wm8971_write(codec, WM8971_RDAC, reg | 0x0100);
719
720 reg = wm8971_read_reg_cache(codec, WM8971_LOUT1V);
721 wm8971_write(codec, WM8971_LOUT1V, reg | 0x0100);
722 reg = wm8971_read_reg_cache(codec, WM8971_ROUT1V);
723 wm8971_write(codec, WM8971_ROUT1V, reg | 0x0100);
724
725 reg = wm8971_read_reg_cache(codec, WM8971_LOUT2V);
726 wm8971_write(codec, WM8971_LOUT2V, reg | 0x0100);
727 reg = wm8971_read_reg_cache(codec, WM8971_ROUT2V);
728 wm8971_write(codec, WM8971_ROUT2V, reg | 0x0100);
729
730 reg = wm8971_read_reg_cache(codec, WM8971_LINVOL);
731 wm8971_write(codec, WM8971_LINVOL, reg | 0x0100);
732 reg = wm8971_read_reg_cache(codec, WM8971_RINVOL);
733 wm8971_write(codec, WM8971_RINVOL, reg | 0x0100);
734
3e8e1952
IM		 735 snd_soc_add_controls(codec, wm8971_snd_controls,
736 ARRAY_SIZE(wm8971_snd_controls));
8bae3e23 737 wm8971_add_widgets(codec);
968a6025 738 ret = snd_soc_init_card(socdev);
8bae3e23
KK		 739 if (ret < 0) {
740 printk(KERN_ERR "wm8971: failed to register card\n");
741 goto card_err;
742 }
743 return ret;
744
745card_err:
746 snd_soc_free_pcms(socdev);
747 snd_soc_dapm_free(socdev);
748pcm_err:
749 kfree(codec->reg_cache);
750 return ret;
751}
752
753/* If the i2c layer weren't so broken, we could pass this kind of data
754 around */
755static struct snd_soc_device *wm8971_socdev;
756
757#if defined (CONFIG_I2C) || defined (CONFIG_I2C_MODULE)
758
759static int wm8971_i2c_probe(struct i2c_client *i2c,
760 const struct i2c_device_id *id)
761{
762 struct snd_soc_device *socdev = wm8971_socdev;
6627a653 763 struct snd_soc_codec *codec = socdev->card->codec;
8bae3e23
KK		 764 int ret;
765
766 i2c_set_clientdata(i2c, codec);
767
768 codec->control_data = i2c;
769
770 ret = wm8971_init(socdev);
771 if (ret < 0)
772 pr_err("failed to initialise WM8971\n");
773
774 return ret;
775}
776
777static int wm8971_i2c_remove(struct i2c_client *client)
778{
779 struct snd_soc_codec *codec = i2c_get_clientdata(client);
780 kfree(codec->reg_cache);
781 return 0;
782}
783
784static const struct i2c_device_id wm8971_i2c_id[] = {
785 { "wm8971", 0 },
786 { }
787};
788MODULE_DEVICE_TABLE(i2c, wm8971_i2c_id);
789
790static struct i2c_driver wm8971_i2c_driver = {
791 .driver = {
792 .name = "WM8971 I2C Codec",
793 .owner = THIS_MODULE,
794 },
795 .probe = wm8971_i2c_probe,
796 .remove = wm8971_i2c_remove,
797 .id_table = wm8971_i2c_id,
798};
799
800static int wm8971_add_i2c_device(struct platform_device *pdev,
801 const struct wm8971_setup_data *setup)
802{
803 struct i2c_board_info info;
804 struct i2c_adapter *adapter;
805 struct i2c_client *client;
806 int ret;
807
808 ret = i2c_add_driver(&wm8971_i2c_driver);
809 if (ret != 0) {
810 dev_err(&pdev->dev, "can't add i2c driver\n");
811 return ret;
812 }
813
814 memset(&info, 0, sizeof(struct i2c_board_info));
815 info.addr = setup->i2c_address;
816 strlcpy(info.type, "wm8971", I2C_NAME_SIZE);
817
818 adapter = i2c_get_adapter(setup->i2c_bus);
819 if (!adapter) {
820 dev_err(&pdev->dev, "can't get i2c adapter %d\n",
821 setup->i2c_bus);
822 goto err_driver;
823 }
824
825 client = i2c_new_device(adapter, &info);
826 i2c_put_adapter(adapter);
827 if (!client) {
828 dev_err(&pdev->dev, "can't add i2c device at 0x%x\n",
829 (unsigned int)info.addr);
830 goto err_driver;
831 }
832
833 return 0;
834
835err_driver:
836 i2c_del_driver(&wm8971_i2c_driver);
837 return -ENODEV;
838}
839
840#endif
841
842static int wm8971_probe(struct platform_device *pdev)
843{
844 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
845 struct wm8971_setup_data *setup;
846 struct snd_soc_codec *codec;
847 struct wm8971_priv *wm8971;
848 int ret = 0;
849
850 pr_info("WM8971 Audio Codec %s", WM8971_VERSION);
851
852 setup = socdev->codec_data;
853 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
854 if (codec == NULL)
855 return -ENOMEM;
856
857 wm8971 = kzalloc(sizeof(struct wm8971_priv), GFP_KERNEL);
858 if (wm8971 == NULL) {
859 kfree(codec);
860 return -ENOMEM;
861 }
862
863 codec->private_data = wm8971;
6627a653 864 socdev->card->codec = codec;
8bae3e23
KK		 865 mutex_init(&codec->mutex);
866 INIT_LIST_HEAD(&codec->dapm_widgets);
867 INIT_LIST_HEAD(&codec->dapm_paths);
868 wm8971_socdev = socdev;
869
870 INIT_DELAYED_WORK(&codec->delayed_work, wm8971_work);
871 wm8971_workq = create_workqueue("wm8971");
872 if (wm8971_workq == NULL) {
873 kfree(codec->private_data);
874 kfree(codec);
875 return -ENOMEM;
876 }
877
878#if defined (CONFIG_I2C) || defined (CONFIG_I2C_MODULE)
879 if (setup->i2c_address) {
880 codec->hw_write = (hw_write_t)i2c_master_send;
881 ret = wm8971_add_i2c_device(pdev, setup);
882 }
883#endif
884 /* Add other interfaces here */
885
886 if (ret != 0) {
887 destroy_workqueue(wm8971_workq);
888 kfree(codec->private_data);
889 kfree(codec);
890 }
891
892 return ret;
893}
894
895/* power down chip */
896static int wm8971_remove(struct platform_device *pdev)
897{
898 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 899 struct snd_soc_codec *codec = socdev->card->codec;
8bae3e23
KK		 900
901 if (codec->control_data)
902 wm8971_set_bias_level(codec, SND_SOC_BIAS_OFF);
903 if (wm8971_workq)
904 destroy_workqueue(wm8971_workq);
905 snd_soc_free_pcms(socdev);
906 snd_soc_dapm_free(socdev);
907#if defined (CONFIG_I2C) || defined (CONFIG_I2C_MODULE)
908 i2c_unregister_device(codec->control_data);
909 i2c_del_driver(&wm8971_i2c_driver);
910#endif
911 kfree(codec->private_data);
912 kfree(codec);
913
914 return 0;
915}
916
917struct snd_soc_codec_device soc_codec_dev_wm8971 = {
918 .probe = wm8971_probe,
919 .remove = wm8971_remove,
920 .suspend = wm8971_suspend,
921 .resume = wm8971_resume,
922};
923
924EXPORT_SYMBOL_GPL(soc_codec_dev_wm8971);
925
c9b3a40f 926static int __init wm8971_modinit(void)
64089b84
MB		 927{
928 return snd_soc_register_dai(&wm8971_dai);
929}
930module_init(wm8971_modinit);
931
932static void __exit wm8971_exit(void)
933{
934 snd_soc_unregister_dai(&wm8971_dai);
935}
936module_exit(wm8971_exit);
937
8bae3e23
KK		 938MODULE_DESCRIPTION("ASoC WM8971 driver");
939MODULE_AUTHOR("Lab126");
940MODULE_LICENSE("GPL");
kernel source for telekom puls (alcatel/mediatek)