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