ASoC: Fix leaks in WM8988 registration error handling
[safe/jmp/linux-2.6] / sound / soc / codecs / wm8900.c
1 /*
2  * wm8900.c  --  WM8900 ALSA Soc Audio driver
3  *
4  * Copyright 2007, 2008 Wolfson Microelectronics PLC.
5  *
6  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  *
12  * TODO:
13  *  - Tristating.
14  *  - TDM.
15  *  - Jack detect.
16  *  - FLL source configuration, currently only MCLK is supported.
17  */
18
19 #include <linux/module.h>
20 #include <linux/moduleparam.h>
21 #include <linux/kernel.h>
22 #include <linux/init.h>
23 #include <linux/delay.h>
24 #include <linux/pm.h>
25 #include <linux/i2c.h>
26 #include <linux/platform_device.h>
27 #include <sound/core.h>
28 #include <sound/pcm.h>
29 #include <sound/pcm_params.h>
30 #include <sound/soc.h>
31 #include <sound/soc-dapm.h>
32 #include <sound/initval.h>
33 #include <sound/tlv.h>
34
35 #include "wm8900.h"
36
37 /* WM8900 register space */
38 #define WM8900_REG_RESET        0x0
39 #define WM8900_REG_ID           0x0
40 #define WM8900_REG_POWER1       0x1
41 #define WM8900_REG_POWER2       0x2
42 #define WM8900_REG_POWER3       0x3
43 #define WM8900_REG_AUDIO1       0x4
44 #define WM8900_REG_AUDIO2       0x5
45 #define WM8900_REG_CLOCKING1    0x6
46 #define WM8900_REG_CLOCKING2    0x7
47 #define WM8900_REG_AUDIO3       0x8
48 #define WM8900_REG_AUDIO4       0x9
49 #define WM8900_REG_DACCTRL      0xa
50 #define WM8900_REG_LDAC_DV      0xb
51 #define WM8900_REG_RDAC_DV      0xc
52 #define WM8900_REG_SIDETONE     0xd
53 #define WM8900_REG_ADCCTRL      0xe
54 #define WM8900_REG_LADC_DV      0xf
55 #define WM8900_REG_RADC_DV      0x10
56 #define WM8900_REG_GPIO         0x12
57 #define WM8900_REG_INCTL        0x15
58 #define WM8900_REG_LINVOL       0x16
59 #define WM8900_REG_RINVOL       0x17
60 #define WM8900_REG_INBOOSTMIX1  0x18
61 #define WM8900_REG_INBOOSTMIX2  0x19
62 #define WM8900_REG_ADCPATH      0x1a
63 #define WM8900_REG_AUXBOOST     0x1b
64 #define WM8900_REG_ADDCTL       0x1e
65 #define WM8900_REG_FLLCTL1      0x24
66 #define WM8900_REG_FLLCTL2      0x25
67 #define WM8900_REG_FLLCTL3      0x26
68 #define WM8900_REG_FLLCTL4      0x27
69 #define WM8900_REG_FLLCTL5      0x28
70 #define WM8900_REG_FLLCTL6      0x29
71 #define WM8900_REG_LOUTMIXCTL1  0x2c
72 #define WM8900_REG_ROUTMIXCTL1  0x2d
73 #define WM8900_REG_BYPASS1      0x2e
74 #define WM8900_REG_BYPASS2      0x2f
75 #define WM8900_REG_AUXOUT_CTL   0x30
76 #define WM8900_REG_LOUT1CTL     0x33
77 #define WM8900_REG_ROUT1CTL     0x34
78 #define WM8900_REG_LOUT2CTL     0x35
79 #define WM8900_REG_ROUT2CTL     0x36
80 #define WM8900_REG_HPCTL1       0x3a
81 #define WM8900_REG_OUTBIASCTL   0x73
82
83 #define WM8900_MAXREG           0x80
84
85 #define WM8900_REG_ADDCTL_OUT1_DIS    0x80
86 #define WM8900_REG_ADDCTL_OUT2_DIS    0x40
87 #define WM8900_REG_ADDCTL_VMID_DIS    0x20
88 #define WM8900_REG_ADDCTL_BIAS_SRC    0x10
89 #define WM8900_REG_ADDCTL_VMID_SOFTST 0x04
90 #define WM8900_REG_ADDCTL_TEMP_SD     0x02
91
92 #define WM8900_REG_GPIO_TEMP_ENA   0x2
93
94 #define WM8900_REG_POWER1_STARTUP_BIAS_ENA 0x0100
95 #define WM8900_REG_POWER1_BIAS_ENA         0x0008
96 #define WM8900_REG_POWER1_VMID_BUF_ENA     0x0004
97 #define WM8900_REG_POWER1_FLL_ENA          0x0040
98
99 #define WM8900_REG_POWER2_SYSCLK_ENA  0x8000
100 #define WM8900_REG_POWER2_ADCL_ENA    0x0002
101 #define WM8900_REG_POWER2_ADCR_ENA    0x0001
102
103 #define WM8900_REG_POWER3_DACL_ENA    0x0002
104 #define WM8900_REG_POWER3_DACR_ENA    0x0001
105
106 #define WM8900_REG_AUDIO1_AIF_FMT_MASK 0x0018
107 #define WM8900_REG_AUDIO1_LRCLK_INV    0x0080
108 #define WM8900_REG_AUDIO1_BCLK_INV     0x0100
109
110 #define WM8900_REG_CLOCKING1_BCLK_DIR   0x1
111 #define WM8900_REG_CLOCKING1_MCLK_SRC   0x100
112 #define WM8900_REG_CLOCKING1_BCLK_MASK  (~0x01e)
113 #define WM8900_REG_CLOCKING1_OPCLK_MASK (~0x7000)
114
115 #define WM8900_REG_CLOCKING2_ADC_CLKDIV 0xe0
116 #define WM8900_REG_CLOCKING2_DAC_CLKDIV 0x1c
117
118 #define WM8900_REG_DACCTRL_MUTE          0x004
119 #define WM8900_REG_DACCTRL_DAC_SB_FILT   0x100
120 #define WM8900_REG_DACCTRL_AIF_LRCLKRATE 0x400
121
122 #define WM8900_REG_AUDIO3_ADCLRC_DIR    0x0800
123
124 #define WM8900_REG_AUDIO4_DACLRC_DIR    0x0800
125
126 #define WM8900_REG_FLLCTL1_OSC_ENA    0x100
127
128 #define WM8900_REG_FLLCTL6_FLL_SLOW_LOCK_REF 0x100
129
130 #define WM8900_REG_HPCTL1_HP_IPSTAGE_ENA 0x80
131 #define WM8900_REG_HPCTL1_HP_OPSTAGE_ENA 0x40
132 #define WM8900_REG_HPCTL1_HP_CLAMP_IP    0x20
133 #define WM8900_REG_HPCTL1_HP_CLAMP_OP    0x10
134 #define WM8900_REG_HPCTL1_HP_SHORT       0x08
135 #define WM8900_REG_HPCTL1_HP_SHORT2      0x04
136
137 #define WM8900_LRC_MASK 0xfc00
138
139 struct snd_soc_codec_device soc_codec_dev_wm8900;
140
141 struct wm8900_priv {
142         struct snd_soc_codec codec;
143
144         u16 reg_cache[WM8900_MAXREG];
145
146         u32 fll_in; /* FLL input frequency */
147         u32 fll_out; /* FLL output frequency */
148 };
149
150 /*
151  * wm8900 register cache.  We can't read the entire register space and we
152  * have slow control buses so we cache the registers.
153  */
154 static const u16 wm8900_reg_defaults[WM8900_MAXREG] = {
155         0x8900, 0x0000,
156         0xc000, 0x0000,
157         0x4050, 0x4000,
158         0x0008, 0x0000,
159         0x0040, 0x0040,
160         0x1004, 0x00c0,
161         0x00c0, 0x0000,
162         0x0100, 0x00c0,
163         0x00c0, 0x0000,
164         0xb001, 0x0000,
165         0x0000, 0x0044,
166         0x004c, 0x004c,
167         0x0044, 0x0044,
168         0x0000, 0x0044,
169         0x0000, 0x0000,
170         0x0002, 0x0000,
171         0x0000, 0x0000,
172         0x0000, 0x0000,
173         0x0008, 0x0000,
174         0x0000, 0x0008,
175         0x0097, 0x0100,
176         0x0000, 0x0000,
177         0x0050, 0x0050,
178         0x0055, 0x0055,
179         0x0055, 0x0000,
180         0x0000, 0x0079,
181         0x0079, 0x0079,
182         0x0079, 0x0000,
183         /* Remaining registers all zero */
184 };
185
186 /*
187  * read wm8900 register cache
188  */
189 static inline unsigned int wm8900_read_reg_cache(struct snd_soc_codec *codec,
190         unsigned int reg)
191 {
192         u16 *cache = codec->reg_cache;
193
194         BUG_ON(reg >= WM8900_MAXREG);
195
196         if (reg == WM8900_REG_ID)
197                 return 0;
198
199         return cache[reg];
200 }
201
202 /*
203  * write wm8900 register cache
204  */
205 static inline void wm8900_write_reg_cache(struct snd_soc_codec *codec,
206         u16 reg, unsigned int value)
207 {
208         u16 *cache = codec->reg_cache;
209
210         BUG_ON(reg >= WM8900_MAXREG);
211
212         cache[reg] = value;
213 }
214
215 /*
216  * write to the WM8900 register space
217  */
218 static int wm8900_write(struct snd_soc_codec *codec, unsigned int reg,
219                         unsigned int value)
220 {
221         u8 data[3];
222
223         if (value == wm8900_read_reg_cache(codec, reg))
224                 return 0;
225
226         /* data is
227          *   D15..D9 WM8900 register offset
228          *   D8...D0 register data
229          */
230         data[0] = reg;
231         data[1] = value >> 8;
232         data[2] = value & 0x00ff;
233
234         wm8900_write_reg_cache(codec, reg, value);
235         if (codec->hw_write(codec->control_data, data, 3) == 3)
236                 return 0;
237         else
238                 return -EIO;
239 }
240
241 /*
242  * Read from the wm8900.
243  */
244 static unsigned int wm8900_chip_read(struct snd_soc_codec *codec, u8 reg)
245 {
246         struct i2c_msg xfer[2];
247         u16 data;
248         int ret;
249         struct i2c_client *client = codec->control_data;
250
251         BUG_ON(reg != WM8900_REG_ID && reg != WM8900_REG_POWER1);
252
253         /* Write register */
254         xfer[0].addr = client->addr;
255         xfer[0].flags = 0;
256         xfer[0].len = 1;
257         xfer[0].buf = &reg;
258
259         /* Read data */
260         xfer[1].addr = client->addr;
261         xfer[1].flags = I2C_M_RD;
262         xfer[1].len = 2;
263         xfer[1].buf = (u8 *)&data;
264
265         ret = i2c_transfer(client->adapter, xfer, 2);
266         if (ret != 2) {
267                 printk(KERN_CRIT "i2c_transfer returned %d\n", ret);
268                 return 0;
269         }
270
271         return (data >> 8) | ((data & 0xff) << 8);
272 }
273
274 /*
275  * Read from the WM8900 register space.  Most registers can't be read
276  * and are therefore supplied from cache.
277  */
278 static unsigned int wm8900_read(struct snd_soc_codec *codec, unsigned int reg)
279 {
280         switch (reg) {
281         case WM8900_REG_ID:
282                 return wm8900_chip_read(codec, reg);
283         default:
284                 return wm8900_read_reg_cache(codec, reg);
285         }
286 }
287
288 static void wm8900_reset(struct snd_soc_codec *codec)
289 {
290         wm8900_write(codec, WM8900_REG_RESET, 0);
291
292         memcpy(codec->reg_cache, wm8900_reg_defaults,
293                sizeof(codec->reg_cache));
294 }
295
296 static int wm8900_hp_event(struct snd_soc_dapm_widget *w,
297                            struct snd_kcontrol *kcontrol, int event)
298 {
299         struct snd_soc_codec *codec = w->codec;
300         u16 hpctl1 = wm8900_read(codec, WM8900_REG_HPCTL1);
301
302         switch (event) {
303         case SND_SOC_DAPM_PRE_PMU:
304                 /* Clamp headphone outputs */
305                 hpctl1 = WM8900_REG_HPCTL1_HP_CLAMP_IP |
306                         WM8900_REG_HPCTL1_HP_CLAMP_OP;
307                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
308                 break;
309
310         case SND_SOC_DAPM_POST_PMU:
311                 /* Enable the input stage */
312                 hpctl1 &= ~WM8900_REG_HPCTL1_HP_CLAMP_IP;
313                 hpctl1 |= WM8900_REG_HPCTL1_HP_SHORT |
314                         WM8900_REG_HPCTL1_HP_SHORT2 |
315                         WM8900_REG_HPCTL1_HP_IPSTAGE_ENA;
316                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
317
318                 msleep(400);
319
320                 /* Enable the output stage */
321                 hpctl1 &= ~WM8900_REG_HPCTL1_HP_CLAMP_OP;
322                 hpctl1 |= WM8900_REG_HPCTL1_HP_OPSTAGE_ENA;
323                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
324
325                 /* Remove the shorts */
326                 hpctl1 &= ~WM8900_REG_HPCTL1_HP_SHORT2;
327                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
328                 hpctl1 &= ~WM8900_REG_HPCTL1_HP_SHORT;
329                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
330                 break;
331
332         case SND_SOC_DAPM_PRE_PMD:
333                 /* Short the output */
334                 hpctl1 |= WM8900_REG_HPCTL1_HP_SHORT;
335                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
336
337                 /* Disable the output stage */
338                 hpctl1 &= ~WM8900_REG_HPCTL1_HP_OPSTAGE_ENA;
339                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
340
341                 /* Clamp the outputs and power down input */
342                 hpctl1 |= WM8900_REG_HPCTL1_HP_CLAMP_IP |
343                         WM8900_REG_HPCTL1_HP_CLAMP_OP;
344                 hpctl1 &= ~WM8900_REG_HPCTL1_HP_IPSTAGE_ENA;
345                 wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
346                 break;
347
348         case SND_SOC_DAPM_POST_PMD:
349                 /* Disable everything */
350                 wm8900_write(codec, WM8900_REG_HPCTL1, 0);
351                 break;
352
353         default:
354                 BUG();
355         }
356
357         return 0;
358 }
359
360 static const DECLARE_TLV_DB_SCALE(out_pga_tlv, -5700, 100, 0);
361
362 static const DECLARE_TLV_DB_SCALE(out_mix_tlv, -1500, 300, 0);
363
364 static const DECLARE_TLV_DB_SCALE(in_boost_tlv, -1200, 600, 0);
365
366 static const DECLARE_TLV_DB_SCALE(in_pga_tlv, -1200, 100, 0);
367
368 static const DECLARE_TLV_DB_SCALE(dac_boost_tlv, 0, 600, 0);
369
370 static const DECLARE_TLV_DB_SCALE(dac_tlv, -7200, 75, 1);
371
372 static const DECLARE_TLV_DB_SCALE(adc_svol_tlv, -3600, 300, 0);
373
374 static const DECLARE_TLV_DB_SCALE(adc_tlv, -7200, 75, 1);
375
376 static const char *mic_bias_level_txt[] = { "0.9*AVDD", "0.65*AVDD" };
377
378 static const struct soc_enum mic_bias_level =
379 SOC_ENUM_SINGLE(WM8900_REG_INCTL, 8, 2, mic_bias_level_txt);
380
381 static const char *dac_mute_rate_txt[] = { "Fast", "Slow" };
382
383 static const struct soc_enum dac_mute_rate =
384 SOC_ENUM_SINGLE(WM8900_REG_DACCTRL, 7, 2, dac_mute_rate_txt);
385
386 static const char *dac_deemphasis_txt[] = {
387         "Disabled", "32kHz", "44.1kHz", "48kHz"
388 };
389
390 static const struct soc_enum dac_deemphasis =
391 SOC_ENUM_SINGLE(WM8900_REG_DACCTRL, 4, 4, dac_deemphasis_txt);
392
393 static const char *adc_hpf_cut_txt[] = {
394         "Hi-fi mode", "Voice mode 1", "Voice mode 2", "Voice mode 3"
395 };
396
397 static const struct soc_enum adc_hpf_cut =
398 SOC_ENUM_SINGLE(WM8900_REG_ADCCTRL, 5, 4, adc_hpf_cut_txt);
399
400 static const char *lr_txt[] = {
401         "Left", "Right"
402 };
403
404 static const struct soc_enum aifl_src =
405 SOC_ENUM_SINGLE(WM8900_REG_AUDIO1, 15, 2, lr_txt);
406
407 static const struct soc_enum aifr_src =
408 SOC_ENUM_SINGLE(WM8900_REG_AUDIO1, 14, 2, lr_txt);
409
410 static const struct soc_enum dacl_src =
411 SOC_ENUM_SINGLE(WM8900_REG_AUDIO2, 15, 2, lr_txt);
412
413 static const struct soc_enum dacr_src =
414 SOC_ENUM_SINGLE(WM8900_REG_AUDIO2, 14, 2, lr_txt);
415
416 static const char *sidetone_txt[] = {
417         "Disabled", "Left ADC", "Right ADC"
418 };
419
420 static const struct soc_enum dacl_sidetone =
421 SOC_ENUM_SINGLE(WM8900_REG_SIDETONE, 2, 3, sidetone_txt);
422
423 static const struct soc_enum dacr_sidetone =
424 SOC_ENUM_SINGLE(WM8900_REG_SIDETONE, 0, 3, sidetone_txt);
425
426 static const struct snd_kcontrol_new wm8900_snd_controls[] = {
427 SOC_ENUM("Mic Bias Level", mic_bias_level),
428
429 SOC_SINGLE_TLV("Left Input PGA Volume", WM8900_REG_LINVOL, 0, 31, 0,
430                in_pga_tlv),
431 SOC_SINGLE("Left Input PGA Switch", WM8900_REG_LINVOL, 6, 1, 1),
432 SOC_SINGLE("Left Input PGA ZC Switch", WM8900_REG_LINVOL, 7, 1, 0),
433
434 SOC_SINGLE_TLV("Right Input PGA Volume", WM8900_REG_RINVOL, 0, 31, 0,
435                in_pga_tlv),
436 SOC_SINGLE("Right Input PGA Switch", WM8900_REG_RINVOL, 6, 1, 1),
437 SOC_SINGLE("Right Input PGA ZC Switch", WM8900_REG_RINVOL, 7, 1, 0),
438
439 SOC_SINGLE("DAC Soft Mute Switch", WM8900_REG_DACCTRL, 6, 1, 1),
440 SOC_ENUM("DAC Mute Rate", dac_mute_rate),
441 SOC_SINGLE("DAC Mono Switch", WM8900_REG_DACCTRL, 9, 1, 0),
442 SOC_ENUM("DAC Deemphasis", dac_deemphasis),
443 SOC_SINGLE("DAC Sigma-Delta Modulator Clock Switch", WM8900_REG_DACCTRL,
444            12, 1, 0),
445
446 SOC_SINGLE("ADC HPF Switch", WM8900_REG_ADCCTRL, 8, 1, 0),
447 SOC_ENUM("ADC HPF Cut-Off", adc_hpf_cut),
448 SOC_DOUBLE("ADC Invert Switch", WM8900_REG_ADCCTRL, 1, 0, 1, 0),
449 SOC_SINGLE_TLV("Left ADC Sidetone Volume", WM8900_REG_SIDETONE, 9, 12, 0,
450                adc_svol_tlv),
451 SOC_SINGLE_TLV("Right ADC Sidetone Volume", WM8900_REG_SIDETONE, 5, 12, 0,
452                adc_svol_tlv),
453 SOC_ENUM("Left Digital Audio Source", aifl_src),
454 SOC_ENUM("Right Digital Audio Source", aifr_src),
455
456 SOC_SINGLE_TLV("DAC Input Boost Volume", WM8900_REG_AUDIO2, 10, 4, 0,
457                dac_boost_tlv),
458 SOC_ENUM("Left DAC Source", dacl_src),
459 SOC_ENUM("Right DAC Source", dacr_src),
460 SOC_ENUM("Left DAC Sidetone", dacl_sidetone),
461 SOC_ENUM("Right DAC Sidetone", dacr_sidetone),
462 SOC_DOUBLE("DAC Invert Switch", WM8900_REG_DACCTRL, 1, 0, 1, 0),
463
464 SOC_DOUBLE_R_TLV("Digital Playback Volume",
465                  WM8900_REG_LDAC_DV, WM8900_REG_RDAC_DV,
466                  1, 96, 0, dac_tlv),
467 SOC_DOUBLE_R_TLV("Digital Capture Volume",
468                  WM8900_REG_LADC_DV, WM8900_REG_RADC_DV, 1, 119, 0, adc_tlv),
469
470 SOC_SINGLE_TLV("LINPUT3 Bypass Volume", WM8900_REG_LOUTMIXCTL1, 4, 7, 0,
471                out_mix_tlv),
472 SOC_SINGLE_TLV("RINPUT3 Bypass Volume", WM8900_REG_ROUTMIXCTL1, 4, 7, 0,
473                out_mix_tlv),
474 SOC_SINGLE_TLV("Left AUX Bypass Volume", WM8900_REG_AUXOUT_CTL, 4, 7, 0,
475                out_mix_tlv),
476 SOC_SINGLE_TLV("Right AUX Bypass Volume", WM8900_REG_AUXOUT_CTL, 0, 7, 0,
477                out_mix_tlv),
478
479 SOC_SINGLE_TLV("LeftIn to RightOut Mixer Volume", WM8900_REG_BYPASS1, 0, 7, 0,
480                out_mix_tlv),
481 SOC_SINGLE_TLV("LeftIn to LeftOut Mixer Volume", WM8900_REG_BYPASS1, 4, 7, 0,
482                out_mix_tlv),
483 SOC_SINGLE_TLV("RightIn to LeftOut Mixer Volume", WM8900_REG_BYPASS2, 0, 7, 0,
484                out_mix_tlv),
485 SOC_SINGLE_TLV("RightIn to RightOut Mixer Volume", WM8900_REG_BYPASS2, 4, 7, 0,
486                out_mix_tlv),
487
488 SOC_SINGLE_TLV("IN2L Boost Volume", WM8900_REG_INBOOSTMIX1, 0, 3, 0,
489                in_boost_tlv),
490 SOC_SINGLE_TLV("IN3L Boost Volume", WM8900_REG_INBOOSTMIX1, 4, 3, 0,
491                in_boost_tlv),
492 SOC_SINGLE_TLV("IN2R Boost Volume", WM8900_REG_INBOOSTMIX2, 0, 3, 0,
493                in_boost_tlv),
494 SOC_SINGLE_TLV("IN3R Boost Volume", WM8900_REG_INBOOSTMIX2, 4, 3, 0,
495                in_boost_tlv),
496 SOC_SINGLE_TLV("Left AUX Boost Volume", WM8900_REG_AUXBOOST, 4, 3, 0,
497                in_boost_tlv),
498 SOC_SINGLE_TLV("Right AUX Boost Volume", WM8900_REG_AUXBOOST, 0, 3, 0,
499                in_boost_tlv),
500
501 SOC_DOUBLE_R_TLV("LINEOUT1 Volume", WM8900_REG_LOUT1CTL, WM8900_REG_ROUT1CTL,
502                0, 63, 0, out_pga_tlv),
503 SOC_DOUBLE_R("LINEOUT1 Switch", WM8900_REG_LOUT1CTL, WM8900_REG_ROUT1CTL,
504              6, 1, 1),
505 SOC_DOUBLE_R("LINEOUT1 ZC Switch", WM8900_REG_LOUT1CTL, WM8900_REG_ROUT1CTL,
506              7, 1, 0),
507
508 SOC_DOUBLE_R_TLV("LINEOUT2 Volume",
509                  WM8900_REG_LOUT2CTL, WM8900_REG_ROUT2CTL,
510                  0, 63, 0, out_pga_tlv),
511 SOC_DOUBLE_R("LINEOUT2 Switch",
512              WM8900_REG_LOUT2CTL, WM8900_REG_ROUT2CTL, 6, 1, 1),
513 SOC_DOUBLE_R("LINEOUT2 ZC Switch",
514              WM8900_REG_LOUT2CTL, WM8900_REG_ROUT2CTL, 7, 1, 0),
515 SOC_SINGLE("LINEOUT2 LP -12dB", WM8900_REG_LOUTMIXCTL1,
516            0, 1, 1),
517
518 };
519
520 static const struct snd_kcontrol_new wm8900_dapm_loutput2_control =
521 SOC_DAPM_SINGLE("LINEOUT2L Switch", WM8900_REG_POWER3, 6, 1, 0);
522
523 static const struct snd_kcontrol_new wm8900_dapm_routput2_control =
524 SOC_DAPM_SINGLE("LINEOUT2R Switch", WM8900_REG_POWER3, 5, 1, 0);
525
526 static const struct snd_kcontrol_new wm8900_loutmix_controls[] = {
527 SOC_DAPM_SINGLE("LINPUT3 Bypass Switch", WM8900_REG_LOUTMIXCTL1, 7, 1, 0),
528 SOC_DAPM_SINGLE("AUX Bypass Switch", WM8900_REG_AUXOUT_CTL, 7, 1, 0),
529 SOC_DAPM_SINGLE("Left Input Mixer Switch", WM8900_REG_BYPASS1, 7, 1, 0),
530 SOC_DAPM_SINGLE("Right Input Mixer Switch", WM8900_REG_BYPASS2, 3, 1, 0),
531 SOC_DAPM_SINGLE("DACL Switch", WM8900_REG_LOUTMIXCTL1, 8, 1, 0),
532 };
533
534 static const struct snd_kcontrol_new wm8900_routmix_controls[] = {
535 SOC_DAPM_SINGLE("RINPUT3 Bypass Switch", WM8900_REG_ROUTMIXCTL1, 7, 1, 0),
536 SOC_DAPM_SINGLE("AUX Bypass Switch", WM8900_REG_AUXOUT_CTL, 3, 1, 0),
537 SOC_DAPM_SINGLE("Left Input Mixer Switch", WM8900_REG_BYPASS1, 3, 1, 0),
538 SOC_DAPM_SINGLE("Right Input Mixer Switch", WM8900_REG_BYPASS2, 7, 1, 0),
539 SOC_DAPM_SINGLE("DACR Switch", WM8900_REG_ROUTMIXCTL1, 8, 1, 0),
540 };
541
542 static const struct snd_kcontrol_new wm8900_linmix_controls[] = {
543 SOC_DAPM_SINGLE("LINPUT2 Switch", WM8900_REG_INBOOSTMIX1, 2, 1, 1),
544 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8900_REG_INBOOSTMIX1, 6, 1, 1),
545 SOC_DAPM_SINGLE("AUX Switch", WM8900_REG_AUXBOOST, 6, 1, 1),
546 SOC_DAPM_SINGLE("Input PGA Switch", WM8900_REG_ADCPATH, 6, 1, 0),
547 };
548
549 static const struct snd_kcontrol_new wm8900_rinmix_controls[] = {
550 SOC_DAPM_SINGLE("RINPUT2 Switch", WM8900_REG_INBOOSTMIX2, 2, 1, 1),
551 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8900_REG_INBOOSTMIX2, 6, 1, 1),
552 SOC_DAPM_SINGLE("AUX Switch", WM8900_REG_AUXBOOST, 2, 1, 1),
553 SOC_DAPM_SINGLE("Input PGA Switch", WM8900_REG_ADCPATH, 2, 1, 0),
554 };
555
556 static const struct snd_kcontrol_new wm8900_linpga_controls[] = {
557 SOC_DAPM_SINGLE("LINPUT1 Switch", WM8900_REG_INCTL, 6, 1, 0),
558 SOC_DAPM_SINGLE("LINPUT2 Switch", WM8900_REG_INCTL, 5, 1, 0),
559 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8900_REG_INCTL, 4, 1, 0),
560 };
561
562 static const struct snd_kcontrol_new wm8900_rinpga_controls[] = {
563 SOC_DAPM_SINGLE("RINPUT1 Switch", WM8900_REG_INCTL, 2, 1, 0),
564 SOC_DAPM_SINGLE("RINPUT2 Switch", WM8900_REG_INCTL, 1, 1, 0),
565 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8900_REG_INCTL, 0, 1, 0),
566 };
567
568 static const char *wm9700_lp_mux[] = { "Disabled", "Enabled" };
569
570 static const struct soc_enum wm8900_lineout2_lp_mux =
571 SOC_ENUM_SINGLE(WM8900_REG_LOUTMIXCTL1, 1, 2, wm9700_lp_mux);
572
573 static const struct snd_kcontrol_new wm8900_lineout2_lp =
574 SOC_DAPM_ENUM("Route", wm8900_lineout2_lp_mux);
575
576 static const struct snd_soc_dapm_widget wm8900_dapm_widgets[] = {
577
578 /* Externally visible pins */
579 SND_SOC_DAPM_OUTPUT("LINEOUT1L"),
580 SND_SOC_DAPM_OUTPUT("LINEOUT1R"),
581 SND_SOC_DAPM_OUTPUT("LINEOUT2L"),
582 SND_SOC_DAPM_OUTPUT("LINEOUT2R"),
583 SND_SOC_DAPM_OUTPUT("HP_L"),
584 SND_SOC_DAPM_OUTPUT("HP_R"),
585
586 SND_SOC_DAPM_INPUT("RINPUT1"),
587 SND_SOC_DAPM_INPUT("LINPUT1"),
588 SND_SOC_DAPM_INPUT("RINPUT2"),
589 SND_SOC_DAPM_INPUT("LINPUT2"),
590 SND_SOC_DAPM_INPUT("RINPUT3"),
591 SND_SOC_DAPM_INPUT("LINPUT3"),
592 SND_SOC_DAPM_INPUT("AUX"),
593
594 SND_SOC_DAPM_VMID("VMID"),
595
596 /* Input */
597 SND_SOC_DAPM_MIXER("Left Input PGA", WM8900_REG_POWER2, 3, 0,
598                    wm8900_linpga_controls,
599                    ARRAY_SIZE(wm8900_linpga_controls)),
600 SND_SOC_DAPM_MIXER("Right Input PGA", WM8900_REG_POWER2, 2, 0,
601                    wm8900_rinpga_controls,
602                    ARRAY_SIZE(wm8900_rinpga_controls)),
603
604 SND_SOC_DAPM_MIXER("Left Input Mixer", WM8900_REG_POWER2, 5, 0,
605                    wm8900_linmix_controls,
606                    ARRAY_SIZE(wm8900_linmix_controls)),
607 SND_SOC_DAPM_MIXER("Right Input Mixer", WM8900_REG_POWER2, 4, 0,
608                    wm8900_rinmix_controls,
609                    ARRAY_SIZE(wm8900_rinmix_controls)),
610
611 SND_SOC_DAPM_MICBIAS("Mic Bias", WM8900_REG_POWER1, 4, 0),
612
613 SND_SOC_DAPM_ADC("ADCL", "Left HiFi Capture", WM8900_REG_POWER2, 1, 0),
614 SND_SOC_DAPM_ADC("ADCR", "Right HiFi Capture", WM8900_REG_POWER2, 0, 0),
615
616 /* Output */
617 SND_SOC_DAPM_DAC("DACL", "Left HiFi Playback", WM8900_REG_POWER3, 1, 0),
618 SND_SOC_DAPM_DAC("DACR", "Right HiFi Playback", WM8900_REG_POWER3, 0, 0),
619
620 SND_SOC_DAPM_PGA_E("Headphone Amplifier", WM8900_REG_POWER3, 7, 0, NULL, 0,
621                    wm8900_hp_event,
622                    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
623                    SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
624
625 SND_SOC_DAPM_PGA("LINEOUT1L PGA", WM8900_REG_POWER2, 8, 0, NULL, 0),
626 SND_SOC_DAPM_PGA("LINEOUT1R PGA", WM8900_REG_POWER2, 7, 0, NULL, 0),
627
628 SND_SOC_DAPM_MUX("LINEOUT2 LP", SND_SOC_NOPM, 0, 0, &wm8900_lineout2_lp),
629 SND_SOC_DAPM_PGA("LINEOUT2L PGA", WM8900_REG_POWER3, 6, 0, NULL, 0),
630 SND_SOC_DAPM_PGA("LINEOUT2R PGA", WM8900_REG_POWER3, 5, 0, NULL, 0),
631
632 SND_SOC_DAPM_MIXER("Left Output Mixer", WM8900_REG_POWER3, 3, 0,
633                    wm8900_loutmix_controls,
634                    ARRAY_SIZE(wm8900_loutmix_controls)),
635 SND_SOC_DAPM_MIXER("Right Output Mixer", WM8900_REG_POWER3, 2, 0,
636                    wm8900_routmix_controls,
637                    ARRAY_SIZE(wm8900_routmix_controls)),
638 };
639
640 /* Target, Path, Source */
641 static const struct snd_soc_dapm_route audio_map[] = {
642 /* Inputs */
643 {"Left Input PGA", "LINPUT1 Switch", "LINPUT1"},
644 {"Left Input PGA", "LINPUT2 Switch", "LINPUT2"},
645 {"Left Input PGA", "LINPUT3 Switch", "LINPUT3"},
646
647 {"Right Input PGA", "RINPUT1 Switch", "RINPUT1"},
648 {"Right Input PGA", "RINPUT2 Switch", "RINPUT2"},
649 {"Right Input PGA", "RINPUT3 Switch", "RINPUT3"},
650
651 {"Left Input Mixer", "LINPUT2 Switch", "LINPUT2"},
652 {"Left Input Mixer", "LINPUT3 Switch", "LINPUT3"},
653 {"Left Input Mixer", "AUX Switch", "AUX"},
654 {"Left Input Mixer", "Input PGA Switch", "Left Input PGA"},
655
656 {"Right Input Mixer", "RINPUT2 Switch", "RINPUT2"},
657 {"Right Input Mixer", "RINPUT3 Switch", "RINPUT3"},
658 {"Right Input Mixer", "AUX Switch", "AUX"},
659 {"Right Input Mixer", "Input PGA Switch", "Right Input PGA"},
660
661 {"ADCL", NULL, "Left Input Mixer"},
662 {"ADCR", NULL, "Right Input Mixer"},
663
664 /* Outputs */
665 {"LINEOUT1L", NULL, "LINEOUT1L PGA"},
666 {"LINEOUT1L PGA", NULL, "Left Output Mixer"},
667 {"LINEOUT1R", NULL, "LINEOUT1R PGA"},
668 {"LINEOUT1R PGA", NULL, "Right Output Mixer"},
669
670 {"LINEOUT2L PGA", NULL, "Left Output Mixer"},
671 {"LINEOUT2 LP", "Disabled", "LINEOUT2L PGA"},
672 {"LINEOUT2 LP", "Enabled", "Left Output Mixer"},
673 {"LINEOUT2L", NULL, "LINEOUT2 LP"},
674
675 {"LINEOUT2R PGA", NULL, "Right Output Mixer"},
676 {"LINEOUT2 LP", "Disabled", "LINEOUT2R PGA"},
677 {"LINEOUT2 LP", "Enabled", "Right Output Mixer"},
678 {"LINEOUT2R", NULL, "LINEOUT2 LP"},
679
680 {"Left Output Mixer", "LINPUT3 Bypass Switch", "LINPUT3"},
681 {"Left Output Mixer", "AUX Bypass Switch", "AUX"},
682 {"Left Output Mixer", "Left Input Mixer Switch", "Left Input Mixer"},
683 {"Left Output Mixer", "Right Input Mixer Switch", "Right Input Mixer"},
684 {"Left Output Mixer", "DACL Switch", "DACL"},
685
686 {"Right Output Mixer", "RINPUT3 Bypass Switch", "RINPUT3"},
687 {"Right Output Mixer", "AUX Bypass Switch", "AUX"},
688 {"Right Output Mixer", "Left Input Mixer Switch", "Left Input Mixer"},
689 {"Right Output Mixer", "Right Input Mixer Switch", "Right Input Mixer"},
690 {"Right Output Mixer", "DACR Switch", "DACR"},
691
692 /* Note that the headphone output stage needs to be connected
693  * externally to LINEOUT2 via DC blocking capacitors.  Other
694  * configurations are not supported.
695  *
696  * Note also that left and right headphone paths are treated as a
697  * mono path.
698  */
699 {"Headphone Amplifier", NULL, "LINEOUT2 LP"},
700 {"Headphone Amplifier", NULL, "LINEOUT2 LP"},
701 {"HP_L", NULL, "Headphone Amplifier"},
702 {"HP_R", NULL, "Headphone Amplifier"},
703 };
704
705 static int wm8900_add_widgets(struct snd_soc_codec *codec)
706 {
707         snd_soc_dapm_new_controls(codec, wm8900_dapm_widgets,
708                                   ARRAY_SIZE(wm8900_dapm_widgets));
709
710         snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
711
712         snd_soc_dapm_new_widgets(codec);
713
714         return 0;
715 }
716
717 static int wm8900_hw_params(struct snd_pcm_substream *substream,
718         struct snd_pcm_hw_params *params,
719         struct snd_soc_dai *dai)
720 {
721         struct snd_soc_pcm_runtime *rtd = substream->private_data;
722         struct snd_soc_device *socdev = rtd->socdev;
723         struct snd_soc_codec *codec = socdev->card->codec;
724         u16 reg;
725
726         reg = wm8900_read(codec, WM8900_REG_AUDIO1) & ~0x60;
727
728         switch (params_format(params)) {
729         case SNDRV_PCM_FORMAT_S16_LE:
730                 break;
731         case SNDRV_PCM_FORMAT_S20_3LE:
732                 reg |= 0x20;
733                 break;
734         case SNDRV_PCM_FORMAT_S24_LE:
735                 reg |= 0x40;
736                 break;
737         case SNDRV_PCM_FORMAT_S32_LE:
738                 reg |= 0x60;
739                 break;
740         default:
741                 return -EINVAL;
742         }
743
744         wm8900_write(codec, WM8900_REG_AUDIO1, reg);
745
746         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
747                 reg = wm8900_read(codec, WM8900_REG_DACCTRL);
748
749                 if (params_rate(params) <= 24000)
750                         reg |= WM8900_REG_DACCTRL_DAC_SB_FILT;
751                 else
752                         reg &= ~WM8900_REG_DACCTRL_DAC_SB_FILT;
753
754                 wm8900_write(codec, WM8900_REG_DACCTRL, reg);
755         }
756
757         return 0;
758 }
759
760 /* FLL divisors */
761 struct _fll_div {
762         u16 fll_ratio;
763         u16 fllclk_div;
764         u16 fll_slow_lock_ref;
765         u16 n;
766         u16 k;
767 };
768
769 /* The size in bits of the FLL divide multiplied by 10
770  * to allow rounding later */
771 #define FIXED_FLL_SIZE ((1 << 16) * 10)
772
773 static int fll_factors(struct _fll_div *fll_div, unsigned int Fref,
774                        unsigned int Fout)
775 {
776         u64 Kpart;
777         unsigned int K, Ndiv, Nmod, target;
778         unsigned int div;
779
780         BUG_ON(!Fout);
781
782         /* The FLL must run at 90-100MHz which is then scaled down to
783          * the output value by FLLCLK_DIV. */
784         target = Fout;
785         div = 1;
786         while (target < 90000000) {
787                 div *= 2;
788                 target *= 2;
789         }
790
791         if (target > 100000000)
792                 printk(KERN_WARNING "wm8900: FLL rate %u out of range, Fref=%u"
793                        " Fout=%u\n", target, Fref, Fout);
794         if (div > 32) {
795                 printk(KERN_ERR "wm8900: Invalid FLL division rate %u, "
796                        "Fref=%u, Fout=%u, target=%u\n",
797                        div, Fref, Fout, target);
798                 return -EINVAL;
799         }
800
801         fll_div->fllclk_div = div >> 2;
802
803         if (Fref < 48000)
804                 fll_div->fll_slow_lock_ref = 1;
805         else
806                 fll_div->fll_slow_lock_ref = 0;
807
808         Ndiv = target / Fref;
809
810         if (Fref < 1000000)
811                 fll_div->fll_ratio = 8;
812         else
813                 fll_div->fll_ratio = 1;
814
815         fll_div->n = Ndiv / fll_div->fll_ratio;
816         Nmod = (target / fll_div->fll_ratio) % Fref;
817
818         /* Calculate fractional part - scale up so we can round. */
819         Kpart = FIXED_FLL_SIZE * (long long)Nmod;
820
821         do_div(Kpart, Fref);
822
823         K = Kpart & 0xFFFFFFFF;
824
825         if ((K % 10) >= 5)
826                 K += 5;
827
828         /* Move down to proper range now rounding is done */
829         fll_div->k = K / 10;
830
831         BUG_ON(target != Fout * (fll_div->fllclk_div << 2));
832         BUG_ON(!K && target != Fref * fll_div->fll_ratio * fll_div->n);
833
834         return 0;
835 }
836
837 static int wm8900_set_fll(struct snd_soc_codec *codec,
838         int fll_id, unsigned int freq_in, unsigned int freq_out)
839 {
840         struct wm8900_priv *wm8900 = codec->private_data;
841         struct _fll_div fll_div;
842         unsigned int reg;
843
844         if (wm8900->fll_in == freq_in && wm8900->fll_out == freq_out)
845                 return 0;
846
847         /* The digital side should be disabled during any change. */
848         reg = wm8900_read(codec, WM8900_REG_POWER1);
849         wm8900_write(codec, WM8900_REG_POWER1,
850                      reg & (~WM8900_REG_POWER1_FLL_ENA));
851
852         /* Disable the FLL? */
853         if (!freq_in || !freq_out) {
854                 reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
855                 wm8900_write(codec, WM8900_REG_CLOCKING1,
856                              reg & (~WM8900_REG_CLOCKING1_MCLK_SRC));
857
858                 reg = wm8900_read(codec, WM8900_REG_FLLCTL1);
859                 wm8900_write(codec, WM8900_REG_FLLCTL1,
860                              reg & (~WM8900_REG_FLLCTL1_OSC_ENA));
861
862                 wm8900->fll_in = freq_in;
863                 wm8900->fll_out = freq_out;
864
865                 return 0;
866         }
867
868         if (fll_factors(&fll_div, freq_in, freq_out) != 0)
869                 goto reenable;
870
871         wm8900->fll_in = freq_in;
872         wm8900->fll_out = freq_out;
873
874         /* The osclilator *MUST* be enabled before we enable the
875          * digital circuit. */
876         wm8900_write(codec, WM8900_REG_FLLCTL1,
877                      fll_div.fll_ratio | WM8900_REG_FLLCTL1_OSC_ENA);
878
879         wm8900_write(codec, WM8900_REG_FLLCTL4, fll_div.n >> 5);
880         wm8900_write(codec, WM8900_REG_FLLCTL5,
881                      (fll_div.fllclk_div << 6) | (fll_div.n & 0x1f));
882
883         if (fll_div.k) {
884                 wm8900_write(codec, WM8900_REG_FLLCTL2,
885                              (fll_div.k >> 8) | 0x100);
886                 wm8900_write(codec, WM8900_REG_FLLCTL3, fll_div.k & 0xff);
887         } else
888                 wm8900_write(codec, WM8900_REG_FLLCTL2, 0);
889
890         if (fll_div.fll_slow_lock_ref)
891                 wm8900_write(codec, WM8900_REG_FLLCTL6,
892                              WM8900_REG_FLLCTL6_FLL_SLOW_LOCK_REF);
893         else
894                 wm8900_write(codec, WM8900_REG_FLLCTL6, 0);
895
896         reg = wm8900_read(codec, WM8900_REG_POWER1);
897         wm8900_write(codec, WM8900_REG_POWER1,
898                      reg | WM8900_REG_POWER1_FLL_ENA);
899
900 reenable:
901         reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
902         wm8900_write(codec, WM8900_REG_CLOCKING1,
903                      reg | WM8900_REG_CLOCKING1_MCLK_SRC);
904
905         return 0;
906 }
907
908 static int wm8900_set_dai_pll(struct snd_soc_dai *codec_dai,
909                 int pll_id, unsigned int freq_in, unsigned int freq_out)
910 {
911         return wm8900_set_fll(codec_dai->codec, pll_id, freq_in, freq_out);
912 }
913
914 static int wm8900_set_dai_clkdiv(struct snd_soc_dai *codec_dai,
915                                  int div_id, int div)
916 {
917         struct snd_soc_codec *codec = codec_dai->codec;
918         unsigned int reg;
919
920         switch (div_id) {
921         case WM8900_BCLK_DIV:
922                 reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
923                 wm8900_write(codec, WM8900_REG_CLOCKING1,
924                              div | (reg & WM8900_REG_CLOCKING1_BCLK_MASK));
925                 break;
926         case WM8900_OPCLK_DIV:
927                 reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
928                 wm8900_write(codec, WM8900_REG_CLOCKING1,
929                              div | (reg & WM8900_REG_CLOCKING1_OPCLK_MASK));
930                 break;
931         case WM8900_DAC_LRCLK:
932                 reg = wm8900_read(codec, WM8900_REG_AUDIO4);
933                 wm8900_write(codec, WM8900_REG_AUDIO4,
934                              div | (reg & WM8900_LRC_MASK));
935                 break;
936         case WM8900_ADC_LRCLK:
937                 reg = wm8900_read(codec, WM8900_REG_AUDIO3);
938                 wm8900_write(codec, WM8900_REG_AUDIO3,
939                              div | (reg & WM8900_LRC_MASK));
940                 break;
941         case WM8900_DAC_CLKDIV:
942                 reg = wm8900_read(codec, WM8900_REG_CLOCKING2);
943                 wm8900_write(codec, WM8900_REG_CLOCKING2,
944                              div | (reg & WM8900_REG_CLOCKING2_DAC_CLKDIV));
945                 break;
946         case WM8900_ADC_CLKDIV:
947                 reg = wm8900_read(codec, WM8900_REG_CLOCKING2);
948                 wm8900_write(codec, WM8900_REG_CLOCKING2,
949                              div | (reg & WM8900_REG_CLOCKING2_ADC_CLKDIV));
950                 break;
951         case WM8900_LRCLK_MODE:
952                 reg = wm8900_read(codec, WM8900_REG_DACCTRL);
953                 wm8900_write(codec, WM8900_REG_DACCTRL,
954                              div | (reg & WM8900_REG_DACCTRL_AIF_LRCLKRATE));
955                 break;
956         default:
957                 return -EINVAL;
958         }
959
960         return 0;
961 }
962
963
964 static int wm8900_set_dai_fmt(struct snd_soc_dai *codec_dai,
965                               unsigned int fmt)
966 {
967         struct snd_soc_codec *codec = codec_dai->codec;
968         unsigned int clocking1, aif1, aif3, aif4;
969
970         clocking1 = wm8900_read(codec, WM8900_REG_CLOCKING1);
971         aif1 = wm8900_read(codec, WM8900_REG_AUDIO1);
972         aif3 = wm8900_read(codec, WM8900_REG_AUDIO3);
973         aif4 = wm8900_read(codec, WM8900_REG_AUDIO4);
974
975         /* set master/slave audio interface */
976         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
977         case SND_SOC_DAIFMT_CBS_CFS:
978                 clocking1 &= ~WM8900_REG_CLOCKING1_BCLK_DIR;
979                 aif3 &= ~WM8900_REG_AUDIO3_ADCLRC_DIR;
980                 aif4 &= ~WM8900_REG_AUDIO4_DACLRC_DIR;
981                 break;
982         case SND_SOC_DAIFMT_CBS_CFM:
983                 clocking1 &= ~WM8900_REG_CLOCKING1_BCLK_DIR;
984                 aif3 |= WM8900_REG_AUDIO3_ADCLRC_DIR;
985                 aif4 |= WM8900_REG_AUDIO4_DACLRC_DIR;
986                 break;
987         case SND_SOC_DAIFMT_CBM_CFM:
988                 clocking1 |= WM8900_REG_CLOCKING1_BCLK_DIR;
989                 aif3 |= WM8900_REG_AUDIO3_ADCLRC_DIR;
990                 aif4 |= WM8900_REG_AUDIO4_DACLRC_DIR;
991                 break;
992         case SND_SOC_DAIFMT_CBM_CFS:
993                 clocking1 |= WM8900_REG_CLOCKING1_BCLK_DIR;
994                 aif3 &= ~WM8900_REG_AUDIO3_ADCLRC_DIR;
995                 aif4 &= ~WM8900_REG_AUDIO4_DACLRC_DIR;
996                 break;
997         default:
998                 return -EINVAL;
999         }
1000
1001         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1002         case SND_SOC_DAIFMT_DSP_A:
1003                 aif1 |= WM8900_REG_AUDIO1_AIF_FMT_MASK;
1004                 aif1 &= ~WM8900_REG_AUDIO1_LRCLK_INV;
1005                 break;
1006         case SND_SOC_DAIFMT_DSP_B:
1007                 aif1 |= WM8900_REG_AUDIO1_AIF_FMT_MASK;
1008                 aif1 |= WM8900_REG_AUDIO1_LRCLK_INV;
1009                 break;
1010         case SND_SOC_DAIFMT_I2S:
1011                 aif1 &= ~WM8900_REG_AUDIO1_AIF_FMT_MASK;
1012                 aif1 |= 0x10;
1013                 break;
1014         case SND_SOC_DAIFMT_RIGHT_J:
1015                 aif1 &= ~WM8900_REG_AUDIO1_AIF_FMT_MASK;
1016                 break;
1017         case SND_SOC_DAIFMT_LEFT_J:
1018                 aif1 &= ~WM8900_REG_AUDIO1_AIF_FMT_MASK;
1019                 aif1 |= 0x8;
1020                 break;
1021         default:
1022                 return -EINVAL;
1023         }
1024
1025         /* Clock inversion */
1026         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1027         case SND_SOC_DAIFMT_DSP_A:
1028         case SND_SOC_DAIFMT_DSP_B:
1029                 /* frame inversion not valid for DSP modes */
1030                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1031                 case SND_SOC_DAIFMT_NB_NF:
1032                         aif1 &= ~WM8900_REG_AUDIO1_BCLK_INV;
1033                         break;
1034                 case SND_SOC_DAIFMT_IB_NF:
1035                         aif1 |= WM8900_REG_AUDIO1_BCLK_INV;
1036                         break;
1037                 default:
1038                         return -EINVAL;
1039                 }
1040                 break;
1041         case SND_SOC_DAIFMT_I2S:
1042         case SND_SOC_DAIFMT_RIGHT_J:
1043         case SND_SOC_DAIFMT_LEFT_J:
1044                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1045                 case SND_SOC_DAIFMT_NB_NF:
1046                         aif1 &= ~WM8900_REG_AUDIO1_BCLK_INV;
1047                         aif1 &= ~WM8900_REG_AUDIO1_LRCLK_INV;
1048                         break;
1049                 case SND_SOC_DAIFMT_IB_IF:
1050                         aif1 |= WM8900_REG_AUDIO1_BCLK_INV;
1051                         aif1 |= WM8900_REG_AUDIO1_LRCLK_INV;
1052                         break;
1053                 case SND_SOC_DAIFMT_IB_NF:
1054                         aif1 |= WM8900_REG_AUDIO1_BCLK_INV;
1055                         aif1 &= ~WM8900_REG_AUDIO1_LRCLK_INV;
1056                         break;
1057                 case SND_SOC_DAIFMT_NB_IF:
1058                         aif1 &= ~WM8900_REG_AUDIO1_BCLK_INV;
1059                         aif1 |= WM8900_REG_AUDIO1_LRCLK_INV;
1060                         break;
1061                 default:
1062                         return -EINVAL;
1063                 }
1064                 break;
1065         default:
1066                 return -EINVAL;
1067         }
1068
1069         wm8900_write(codec, WM8900_REG_CLOCKING1, clocking1);
1070         wm8900_write(codec, WM8900_REG_AUDIO1, aif1);
1071         wm8900_write(codec, WM8900_REG_AUDIO3, aif3);
1072         wm8900_write(codec, WM8900_REG_AUDIO4, aif4);
1073
1074         return 0;
1075 }
1076
1077 static int wm8900_digital_mute(struct snd_soc_dai *codec_dai, int mute)
1078 {
1079         struct snd_soc_codec *codec = codec_dai->codec;
1080         u16 reg;
1081
1082         reg = wm8900_read(codec, WM8900_REG_DACCTRL);
1083
1084         if (mute)
1085                 reg |= WM8900_REG_DACCTRL_MUTE;
1086         else
1087                 reg &= ~WM8900_REG_DACCTRL_MUTE;
1088
1089         wm8900_write(codec, WM8900_REG_DACCTRL, reg);
1090
1091         return 0;
1092 }
1093
1094 #define WM8900_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
1095                       SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
1096                       SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000)
1097
1098 #define WM8900_PCM_FORMATS \
1099         (SNDRV_PCM_FORMAT_S16_LE | SNDRV_PCM_FORMAT_S20_3LE | \
1100          SNDRV_PCM_FORMAT_S24_LE)
1101
1102 static struct snd_soc_dai_ops wm8900_dai_ops = {
1103         .hw_params      = wm8900_hw_params,
1104         .set_clkdiv     = wm8900_set_dai_clkdiv,
1105         .set_pll        = wm8900_set_dai_pll,
1106         .set_fmt        = wm8900_set_dai_fmt,
1107         .digital_mute   = wm8900_digital_mute,
1108 };
1109
1110 struct snd_soc_dai wm8900_dai = {
1111         .name = "WM8900 HiFi",
1112         .playback = {
1113                 .stream_name = "HiFi Playback",
1114                 .channels_min = 1,
1115                 .channels_max = 2,
1116                 .rates = WM8900_RATES,
1117                 .formats = WM8900_PCM_FORMATS,
1118         },
1119         .capture = {
1120                 .stream_name = "HiFi Capture",
1121                 .channels_min = 1,
1122                 .channels_max = 2,
1123                 .rates = WM8900_RATES,
1124                 .formats = WM8900_PCM_FORMATS,
1125          },
1126         .ops = &wm8900_dai_ops,
1127 };
1128 EXPORT_SYMBOL_GPL(wm8900_dai);
1129
1130 static int wm8900_set_bias_level(struct snd_soc_codec *codec,
1131                                  enum snd_soc_bias_level level)
1132 {
1133         u16 reg;
1134
1135         switch (level) {
1136         case SND_SOC_BIAS_ON:
1137                 /* Enable thermal shutdown */
1138                 reg = wm8900_read(codec, WM8900_REG_GPIO);
1139                 wm8900_write(codec, WM8900_REG_GPIO,
1140                              reg | WM8900_REG_GPIO_TEMP_ENA);
1141                 reg = wm8900_read(codec, WM8900_REG_ADDCTL);
1142                 wm8900_write(codec, WM8900_REG_ADDCTL,
1143                              reg | WM8900_REG_ADDCTL_TEMP_SD);
1144                 break;
1145
1146         case SND_SOC_BIAS_PREPARE:
1147                 break;
1148
1149         case SND_SOC_BIAS_STANDBY:
1150                 /* Charge capacitors if initial power up */
1151                 if (codec->bias_level == SND_SOC_BIAS_OFF) {
1152                         /* STARTUP_BIAS_ENA on */
1153                         wm8900_write(codec, WM8900_REG_POWER1,
1154                                      WM8900_REG_POWER1_STARTUP_BIAS_ENA);
1155
1156                         /* Startup bias mode */
1157                         wm8900_write(codec, WM8900_REG_ADDCTL,
1158                                      WM8900_REG_ADDCTL_BIAS_SRC |
1159                                      WM8900_REG_ADDCTL_VMID_SOFTST);
1160
1161                         /* VMID 2x50k */
1162                         wm8900_write(codec, WM8900_REG_POWER1,
1163                                      WM8900_REG_POWER1_STARTUP_BIAS_ENA | 0x1);
1164
1165                         /* Allow capacitors to charge */
1166                         schedule_timeout_interruptible(msecs_to_jiffies(400));
1167
1168                         /* Enable bias */
1169                         wm8900_write(codec, WM8900_REG_POWER1,
1170                                      WM8900_REG_POWER1_STARTUP_BIAS_ENA |
1171                                      WM8900_REG_POWER1_BIAS_ENA | 0x1);
1172
1173                         wm8900_write(codec, WM8900_REG_ADDCTL, 0);
1174
1175                         wm8900_write(codec, WM8900_REG_POWER1,
1176                                      WM8900_REG_POWER1_BIAS_ENA | 0x1);
1177                 }
1178
1179                 reg = wm8900_read(codec, WM8900_REG_POWER1);
1180                 wm8900_write(codec, WM8900_REG_POWER1,
1181                              (reg & WM8900_REG_POWER1_FLL_ENA) |
1182                              WM8900_REG_POWER1_BIAS_ENA | 0x1);
1183                 wm8900_write(codec, WM8900_REG_POWER2,
1184                              WM8900_REG_POWER2_SYSCLK_ENA);
1185                 wm8900_write(codec, WM8900_REG_POWER3, 0);
1186                 break;
1187
1188         case SND_SOC_BIAS_OFF:
1189                 /* Startup bias enable */
1190                 reg = wm8900_read(codec, WM8900_REG_POWER1);
1191                 wm8900_write(codec, WM8900_REG_POWER1,
1192                              reg & WM8900_REG_POWER1_STARTUP_BIAS_ENA);
1193                 wm8900_write(codec, WM8900_REG_ADDCTL,
1194                              WM8900_REG_ADDCTL_BIAS_SRC |
1195                              WM8900_REG_ADDCTL_VMID_SOFTST);
1196
1197                 /* Discharge caps */
1198                 wm8900_write(codec, WM8900_REG_POWER1,
1199                              WM8900_REG_POWER1_STARTUP_BIAS_ENA);
1200                 schedule_timeout_interruptible(msecs_to_jiffies(500));
1201
1202                 /* Remove clamp */
1203                 wm8900_write(codec, WM8900_REG_HPCTL1, 0);
1204
1205                 /* Power down */
1206                 wm8900_write(codec, WM8900_REG_ADDCTL, 0);
1207                 wm8900_write(codec, WM8900_REG_POWER1, 0);
1208                 wm8900_write(codec, WM8900_REG_POWER2, 0);
1209                 wm8900_write(codec, WM8900_REG_POWER3, 0);
1210
1211                 /* Need to let things settle before stopping the clock
1212                  * to ensure that restart works, see "Stopping the
1213                  * master clock" in the datasheet. */
1214                 schedule_timeout_interruptible(msecs_to_jiffies(1));
1215                 wm8900_write(codec, WM8900_REG_POWER2,
1216                              WM8900_REG_POWER2_SYSCLK_ENA);
1217                 break;
1218         }
1219         codec->bias_level = level;
1220         return 0;
1221 }
1222
1223 static int wm8900_suspend(struct platform_device *pdev, pm_message_t state)
1224 {
1225         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1226         struct snd_soc_codec *codec = socdev->card->codec;
1227         struct wm8900_priv *wm8900 = codec->private_data;
1228         int fll_out = wm8900->fll_out;
1229         int fll_in  = wm8900->fll_in;
1230         int ret;
1231
1232         /* Stop the FLL in an orderly fashion */
1233         ret = wm8900_set_fll(codec, 0, 0, 0);
1234         if (ret != 0) {
1235                 dev_err(&pdev->dev, "Failed to stop FLL\n");
1236                 return ret;
1237         }
1238
1239         wm8900->fll_out = fll_out;
1240         wm8900->fll_in = fll_in;
1241
1242         wm8900_set_bias_level(codec, SND_SOC_BIAS_OFF);
1243
1244         return 0;
1245 }
1246
1247 static int wm8900_resume(struct platform_device *pdev)
1248 {
1249         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1250         struct snd_soc_codec *codec = socdev->card->codec;
1251         struct wm8900_priv *wm8900 = codec->private_data;
1252         u16 *cache;
1253         int i, ret;
1254
1255         cache = kmemdup(codec->reg_cache, sizeof(wm8900_reg_defaults),
1256                         GFP_KERNEL);
1257
1258         wm8900_reset(codec);
1259         wm8900_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1260
1261         /* Restart the FLL? */
1262         if (wm8900->fll_out) {
1263                 int fll_out = wm8900->fll_out;
1264                 int fll_in  = wm8900->fll_in;
1265
1266                 wm8900->fll_in = 0;
1267                 wm8900->fll_out = 0;
1268
1269                 ret = wm8900_set_fll(codec, 0, fll_in, fll_out);
1270                 if (ret != 0) {
1271                         dev_err(&pdev->dev, "Failed to restart FLL\n");
1272                         return ret;
1273                 }
1274         }
1275
1276         if (cache) {
1277                 for (i = 0; i < WM8900_MAXREG; i++)
1278                         wm8900_write(codec, i, cache[i]);
1279                 kfree(cache);
1280         } else
1281                 dev_err(&pdev->dev, "Unable to allocate register cache\n");
1282
1283         return 0;
1284 }
1285
1286 static struct snd_soc_codec *wm8900_codec;
1287
1288 static __devinit int wm8900_i2c_probe(struct i2c_client *i2c,
1289                                       const struct i2c_device_id *id)
1290 {
1291         struct wm8900_priv *wm8900;
1292         struct snd_soc_codec *codec;
1293         unsigned int reg;
1294         int ret;
1295
1296         wm8900 = kzalloc(sizeof(struct wm8900_priv), GFP_KERNEL);
1297         if (wm8900 == NULL)
1298                 return -ENOMEM;
1299
1300         codec = &wm8900->codec;
1301         codec->private_data = wm8900;
1302         codec->reg_cache = &wm8900->reg_cache[0];
1303         codec->reg_cache_size = WM8900_MAXREG;
1304
1305         mutex_init(&codec->mutex);
1306         INIT_LIST_HEAD(&codec->dapm_widgets);
1307         INIT_LIST_HEAD(&codec->dapm_paths);
1308
1309         codec->name = "WM8900";
1310         codec->owner = THIS_MODULE;
1311         codec->read = wm8900_read;
1312         codec->write = wm8900_write;
1313         codec->dai = &wm8900_dai;
1314         codec->num_dai = 1;
1315         codec->hw_write = (hw_write_t)i2c_master_send;
1316         codec->control_data = i2c;
1317         codec->set_bias_level = wm8900_set_bias_level;
1318         codec->dev = &i2c->dev;
1319
1320         reg = wm8900_read(codec, WM8900_REG_ID);
1321         if (reg != 0x8900) {
1322                 dev_err(&i2c->dev, "Device is not a WM8900 - ID %x\n", reg);
1323                 ret = -ENODEV;
1324                 goto err;
1325         }
1326
1327         /* Read back from the chip */
1328         reg = wm8900_chip_read(codec, WM8900_REG_POWER1);
1329         reg = (reg >> 12) & 0xf;
1330         dev_info(&i2c->dev, "WM8900 revision %d\n", reg);
1331
1332         wm8900_reset(codec);
1333
1334         /* Turn the chip on */
1335         wm8900_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1336
1337         /* Latch the volume update bits */
1338         wm8900_write(codec, WM8900_REG_LINVOL,
1339                      wm8900_read(codec, WM8900_REG_LINVOL) | 0x100);
1340         wm8900_write(codec, WM8900_REG_RINVOL,
1341                      wm8900_read(codec, WM8900_REG_RINVOL) | 0x100);
1342         wm8900_write(codec, WM8900_REG_LOUT1CTL,
1343                      wm8900_read(codec, WM8900_REG_LOUT1CTL) | 0x100);
1344         wm8900_write(codec, WM8900_REG_ROUT1CTL,
1345                      wm8900_read(codec, WM8900_REG_ROUT1CTL) | 0x100);
1346         wm8900_write(codec, WM8900_REG_LOUT2CTL,
1347                      wm8900_read(codec, WM8900_REG_LOUT2CTL) | 0x100);
1348         wm8900_write(codec, WM8900_REG_ROUT2CTL,
1349                      wm8900_read(codec, WM8900_REG_ROUT2CTL) | 0x100);
1350         wm8900_write(codec, WM8900_REG_LDAC_DV,
1351                      wm8900_read(codec, WM8900_REG_LDAC_DV) | 0x100);
1352         wm8900_write(codec, WM8900_REG_RDAC_DV,
1353                      wm8900_read(codec, WM8900_REG_RDAC_DV) | 0x100);
1354         wm8900_write(codec, WM8900_REG_LADC_DV,
1355                      wm8900_read(codec, WM8900_REG_LADC_DV) | 0x100);
1356         wm8900_write(codec, WM8900_REG_RADC_DV,
1357                      wm8900_read(codec, WM8900_REG_RADC_DV) | 0x100);
1358
1359         /* Set the DAC and mixer output bias */
1360         wm8900_write(codec, WM8900_REG_OUTBIASCTL, 0x81);
1361
1362         wm8900_dai.dev = &i2c->dev;
1363
1364         wm8900_codec = codec;
1365
1366         ret = snd_soc_register_codec(codec);
1367         if (ret != 0) {
1368                 dev_err(&i2c->dev, "Failed to register codec: %d\n", ret);
1369                 goto err;
1370         }
1371
1372         ret = snd_soc_register_dai(&wm8900_dai);
1373         if (ret != 0) {
1374                 dev_err(&i2c->dev, "Failed to register DAI: %d\n", ret);
1375                 goto err_codec;
1376         }
1377
1378         return ret;
1379
1380 err_codec:
1381         snd_soc_unregister_codec(codec);
1382 err:
1383         kfree(wm8900);
1384         wm8900_codec = NULL;
1385         return ret;
1386 }
1387
1388 static __devexit int wm8900_i2c_remove(struct i2c_client *client)
1389 {
1390         snd_soc_unregister_dai(&wm8900_dai);
1391         snd_soc_unregister_codec(wm8900_codec);
1392
1393         wm8900_set_bias_level(wm8900_codec, SND_SOC_BIAS_OFF);
1394
1395         wm8900_dai.dev = NULL;
1396         kfree(wm8900_codec->private_data);
1397         wm8900_codec = NULL;
1398
1399         return 0;
1400 }
1401
1402 #ifdef CONFIG_PM
1403 static int wm8900_i2c_suspend(struct i2c_client *client, pm_message_t msg)
1404 {
1405         return snd_soc_suspend_device(&client->dev);
1406 }
1407
1408 static int wm8900_i2c_resume(struct i2c_client *client)
1409 {
1410         return snd_soc_resume_device(&client->dev);
1411 }
1412 #else
1413 #define wm8900_i2c_suspend NULL
1414 #define wm8900_i2c_resume NULL
1415 #endif
1416
1417 static const struct i2c_device_id wm8900_i2c_id[] = {
1418         { "wm8900", 0 },
1419         { }
1420 };
1421 MODULE_DEVICE_TABLE(i2c, wm8900_i2c_id);
1422
1423 static struct i2c_driver wm8900_i2c_driver = {
1424         .driver = {
1425                 .name = "WM8900",
1426                 .owner = THIS_MODULE,
1427         },
1428         .probe = wm8900_i2c_probe,
1429         .remove = __devexit_p(wm8900_i2c_remove),
1430         .suspend = wm8900_i2c_suspend,
1431         .resume = wm8900_i2c_resume,
1432         .id_table = wm8900_i2c_id,
1433 };
1434
1435 static int wm8900_probe(struct platform_device *pdev)
1436 {
1437         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1438         struct snd_soc_codec *codec;
1439         int ret = 0;
1440
1441         if (!wm8900_codec) {
1442                 dev_err(&pdev->dev, "I2C client not yet instantiated\n");
1443                 return -ENODEV;
1444         }
1445
1446         codec = wm8900_codec;
1447         socdev->card->codec = codec;
1448
1449         /* Register pcms */
1450         ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
1451         if (ret < 0) {
1452                 dev_err(&pdev->dev, "Failed to register new PCMs\n");
1453                 goto pcm_err;
1454         }
1455
1456         snd_soc_add_controls(codec, wm8900_snd_controls,
1457                                 ARRAY_SIZE(wm8900_snd_controls));
1458         wm8900_add_widgets(codec);
1459
1460         ret = snd_soc_init_card(socdev);
1461         if (ret < 0) {
1462                 dev_err(&pdev->dev, "Failed to register card\n");
1463                 goto card_err;
1464         }
1465
1466         return ret;
1467
1468 card_err:
1469         snd_soc_free_pcms(socdev);
1470         snd_soc_dapm_free(socdev);
1471 pcm_err:
1472         return ret;
1473 }
1474
1475 /* power down chip */
1476 static int wm8900_remove(struct platform_device *pdev)
1477 {
1478         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1479
1480         snd_soc_free_pcms(socdev);
1481         snd_soc_dapm_free(socdev);
1482
1483         return 0;
1484 }
1485
1486 struct snd_soc_codec_device soc_codec_dev_wm8900 = {
1487         .probe =        wm8900_probe,
1488         .remove =       wm8900_remove,
1489         .suspend =      wm8900_suspend,
1490         .resume =       wm8900_resume,
1491 };
1492 EXPORT_SYMBOL_GPL(soc_codec_dev_wm8900);
1493
1494 static int __init wm8900_modinit(void)
1495 {
1496         return i2c_add_driver(&wm8900_i2c_driver);
1497 }
1498 module_init(wm8900_modinit);
1499
1500 static void __exit wm8900_exit(void)
1501 {
1502         i2c_del_driver(&wm8900_i2c_driver);
1503 }
1504 module_exit(wm8900_exit);
1505
1506 MODULE_DESCRIPTION("ASoC WM8900 driver");
1507 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfonmicro.com>");
1508 MODULE_LICENSE("GPL");