Revert "microblaze_mmu_v2: Update signal returning address"
[linux/fpc-iii.git] / sound / soc / codecs / wm8804.c
blobc088020172ab66e25bbc8e0f30f554b77debb202
1 /*
2 * wm8804.c -- WM8804 S/PDIF transceiver driver
4 * Copyright 2010-11 Wolfson Microelectronics plc
6 * Author: Dimitris Papastamos <dp@opensource.wolfsonmicro.com>
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.
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
17 #include <linux/pm.h>
18 #include <linux/i2c.h>
19 #include <linux/of_device.h>
20 #include <linux/spi/spi.h>
21 #include <linux/regmap.h>
22 #include <linux/regulator/consumer.h>
23 #include <linux/slab.h>
24 #include <sound/core.h>
25 #include <sound/pcm.h>
26 #include <sound/pcm_params.h>
27 #include <sound/soc.h>
28 #include <sound/initval.h>
29 #include <sound/tlv.h>
31 #include "wm8804.h"
33 #define WM8804_NUM_SUPPLIES 2
34 static const char *wm8804_supply_names[WM8804_NUM_SUPPLIES] = {
35 "PVDD",
36 "DVDD"
39 static const struct reg_default wm8804_reg_defaults[] = {
40 { 3, 0x21 }, /* R3 - PLL1 */
41 { 4, 0xFD }, /* R4 - PLL2 */
42 { 5, 0x36 }, /* R5 - PLL3 */
43 { 6, 0x07 }, /* R6 - PLL4 */
44 { 7, 0x16 }, /* R7 - PLL5 */
45 { 8, 0x18 }, /* R8 - PLL6 */
46 { 9, 0xFF }, /* R9 - SPDMODE */
47 { 10, 0x00 }, /* R10 - INTMASK */
48 { 18, 0x00 }, /* R18 - SPDTX1 */
49 { 19, 0x00 }, /* R19 - SPDTX2 */
50 { 20, 0x00 }, /* R20 - SPDTX3 */
51 { 21, 0x71 }, /* R21 - SPDTX4 */
52 { 22, 0x0B }, /* R22 - SPDTX5 */
53 { 23, 0x70 }, /* R23 - GPO0 */
54 { 24, 0x57 }, /* R24 - GPO1 */
55 { 26, 0x42 }, /* R26 - GPO2 */
56 { 27, 0x06 }, /* R27 - AIFTX */
57 { 28, 0x06 }, /* R28 - AIFRX */
58 { 29, 0x80 }, /* R29 - SPDRX1 */
59 { 30, 0x07 }, /* R30 - PWRDN */
62 struct wm8804_priv {
63 struct regmap *regmap;
64 struct regulator_bulk_data supplies[WM8804_NUM_SUPPLIES];
65 struct notifier_block disable_nb[WM8804_NUM_SUPPLIES];
68 static int txsrc_get(struct snd_kcontrol *kcontrol,
69 struct snd_ctl_elem_value *ucontrol);
71 static int txsrc_put(struct snd_kcontrol *kcontrol,
72 struct snd_ctl_elem_value *ucontrol);
75 * We can't use the same notifier block for more than one supply and
76 * there's no way I can see to get from a callback to the caller
77 * except container_of().
79 #define WM8804_REGULATOR_EVENT(n) \
80 static int wm8804_regulator_event_##n(struct notifier_block *nb, \
81 unsigned long event, void *data) \
82 { \
83 struct wm8804_priv *wm8804 = container_of(nb, struct wm8804_priv, \
84 disable_nb[n]); \
85 if (event & REGULATOR_EVENT_DISABLE) { \
86 regcache_mark_dirty(wm8804->regmap); \
87 } \
88 return 0; \
91 WM8804_REGULATOR_EVENT(0)
92 WM8804_REGULATOR_EVENT(1)
94 static const char *txsrc_text[] = { "S/PDIF RX", "AIF" };
95 static const SOC_ENUM_SINGLE_EXT_DECL(txsrc, txsrc_text);
97 static const struct snd_kcontrol_new wm8804_snd_controls[] = {
98 SOC_ENUM_EXT("Input Source", txsrc, txsrc_get, txsrc_put),
99 SOC_SINGLE("TX Playback Switch", WM8804_PWRDN, 2, 1, 1),
100 SOC_SINGLE("AIF Playback Switch", WM8804_PWRDN, 4, 1, 1)
103 static int txsrc_get(struct snd_kcontrol *kcontrol,
104 struct snd_ctl_elem_value *ucontrol)
106 struct snd_soc_codec *codec;
107 unsigned int src;
109 codec = snd_kcontrol_chip(kcontrol);
110 src = snd_soc_read(codec, WM8804_SPDTX4);
111 if (src & 0x40)
112 ucontrol->value.integer.value[0] = 1;
113 else
114 ucontrol->value.integer.value[0] = 0;
116 return 0;
119 static int txsrc_put(struct snd_kcontrol *kcontrol,
120 struct snd_ctl_elem_value *ucontrol)
122 struct snd_soc_codec *codec;
123 unsigned int src, txpwr;
125 codec = snd_kcontrol_chip(kcontrol);
127 if (ucontrol->value.integer.value[0] != 0
128 && ucontrol->value.integer.value[0] != 1)
129 return -EINVAL;
131 src = snd_soc_read(codec, WM8804_SPDTX4);
132 switch ((src & 0x40) >> 6) {
133 case 0:
134 if (!ucontrol->value.integer.value[0])
135 return 0;
136 break;
137 case 1:
138 if (ucontrol->value.integer.value[1])
139 return 0;
140 break;
143 /* save the current power state of the transmitter */
144 txpwr = snd_soc_read(codec, WM8804_PWRDN) & 0x4;
145 /* power down the transmitter */
146 snd_soc_update_bits(codec, WM8804_PWRDN, 0x4, 0x4);
147 /* set the tx source */
148 snd_soc_update_bits(codec, WM8804_SPDTX4, 0x40,
149 ucontrol->value.integer.value[0] << 6);
151 if (ucontrol->value.integer.value[0]) {
152 /* power down the receiver */
153 snd_soc_update_bits(codec, WM8804_PWRDN, 0x2, 0x2);
154 /* power up the AIF */
155 snd_soc_update_bits(codec, WM8804_PWRDN, 0x10, 0);
156 } else {
157 /* don't power down the AIF -- may be used as an output */
158 /* power up the receiver */
159 snd_soc_update_bits(codec, WM8804_PWRDN, 0x2, 0);
162 /* restore the transmitter's configuration */
163 snd_soc_update_bits(codec, WM8804_PWRDN, 0x4, txpwr);
165 return 0;
168 static bool wm8804_volatile(struct device *dev, unsigned int reg)
170 switch (reg) {
171 case WM8804_RST_DEVID1:
172 case WM8804_DEVID2:
173 case WM8804_DEVREV:
174 case WM8804_INTSTAT:
175 case WM8804_SPDSTAT:
176 case WM8804_RXCHAN1:
177 case WM8804_RXCHAN2:
178 case WM8804_RXCHAN3:
179 case WM8804_RXCHAN4:
180 case WM8804_RXCHAN5:
181 return true;
182 default:
183 return false;
187 static int wm8804_reset(struct snd_soc_codec *codec)
189 return snd_soc_write(codec, WM8804_RST_DEVID1, 0x0);
192 static int wm8804_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
194 struct snd_soc_codec *codec;
195 u16 format, master, bcp, lrp;
197 codec = dai->codec;
199 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
200 case SND_SOC_DAIFMT_I2S:
201 format = 0x2;
202 break;
203 case SND_SOC_DAIFMT_RIGHT_J:
204 format = 0x0;
205 break;
206 case SND_SOC_DAIFMT_LEFT_J:
207 format = 0x1;
208 break;
209 case SND_SOC_DAIFMT_DSP_A:
210 case SND_SOC_DAIFMT_DSP_B:
211 format = 0x3;
212 break;
213 default:
214 dev_err(dai->dev, "Unknown dai format\n");
215 return -EINVAL;
218 /* set data format */
219 snd_soc_update_bits(codec, WM8804_AIFTX, 0x3, format);
220 snd_soc_update_bits(codec, WM8804_AIFRX, 0x3, format);
222 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
223 case SND_SOC_DAIFMT_CBM_CFM:
224 master = 1;
225 break;
226 case SND_SOC_DAIFMT_CBS_CFS:
227 master = 0;
228 break;
229 default:
230 dev_err(dai->dev, "Unknown master/slave configuration\n");
231 return -EINVAL;
234 /* set master/slave mode */
235 snd_soc_update_bits(codec, WM8804_AIFRX, 0x40, master << 6);
237 bcp = lrp = 0;
238 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
239 case SND_SOC_DAIFMT_NB_NF:
240 break;
241 case SND_SOC_DAIFMT_IB_IF:
242 bcp = lrp = 1;
243 break;
244 case SND_SOC_DAIFMT_IB_NF:
245 bcp = 1;
246 break;
247 case SND_SOC_DAIFMT_NB_IF:
248 lrp = 1;
249 break;
250 default:
251 dev_err(dai->dev, "Unknown polarity configuration\n");
252 return -EINVAL;
255 /* set frame inversion */
256 snd_soc_update_bits(codec, WM8804_AIFTX, 0x10 | 0x20,
257 (bcp << 4) | (lrp << 5));
258 snd_soc_update_bits(codec, WM8804_AIFRX, 0x10 | 0x20,
259 (bcp << 4) | (lrp << 5));
260 return 0;
263 static int wm8804_hw_params(struct snd_pcm_substream *substream,
264 struct snd_pcm_hw_params *params,
265 struct snd_soc_dai *dai)
267 struct snd_soc_codec *codec;
268 u16 blen;
270 codec = dai->codec;
272 switch (params_format(params)) {
273 case SNDRV_PCM_FORMAT_S16_LE:
274 blen = 0x0;
275 break;
276 case SNDRV_PCM_FORMAT_S20_3LE:
277 blen = 0x1;
278 break;
279 case SNDRV_PCM_FORMAT_S24_LE:
280 blen = 0x2;
281 break;
282 default:
283 dev_err(dai->dev, "Unsupported word length: %u\n",
284 params_format(params));
285 return -EINVAL;
288 /* set word length */
289 snd_soc_update_bits(codec, WM8804_AIFTX, 0xc, blen << 2);
290 snd_soc_update_bits(codec, WM8804_AIFRX, 0xc, blen << 2);
292 return 0;
295 struct pll_div {
296 u32 prescale:1;
297 u32 mclkdiv:1;
298 u32 freqmode:2;
299 u32 n:4;
300 u32 k:22;
303 /* PLL rate to output rate divisions */
304 static struct {
305 unsigned int div;
306 unsigned int freqmode;
307 unsigned int mclkdiv;
308 } post_table[] = {
309 { 2, 0, 0 },
310 { 4, 0, 1 },
311 { 4, 1, 0 },
312 { 8, 1, 1 },
313 { 8, 2, 0 },
314 { 16, 2, 1 },
315 { 12, 3, 0 },
316 { 24, 3, 1 }
319 #define FIXED_PLL_SIZE ((1ULL << 22) * 10)
320 static int pll_factors(struct pll_div *pll_div, unsigned int target,
321 unsigned int source)
323 u64 Kpart;
324 unsigned long int K, Ndiv, Nmod, tmp;
325 int i;
328 * Scale the output frequency up; the PLL should run in the
329 * region of 90-100MHz.
331 for (i = 0; i < ARRAY_SIZE(post_table); i++) {
332 tmp = target * post_table[i].div;
333 if (tmp >= 90000000 && tmp <= 100000000) {
334 pll_div->freqmode = post_table[i].freqmode;
335 pll_div->mclkdiv = post_table[i].mclkdiv;
336 target *= post_table[i].div;
337 break;
341 if (i == ARRAY_SIZE(post_table)) {
342 pr_err("%s: Unable to scale output frequency: %uHz\n",
343 __func__, target);
344 return -EINVAL;
347 pll_div->prescale = 0;
348 Ndiv = target / source;
349 if (Ndiv < 5) {
350 source >>= 1;
351 pll_div->prescale = 1;
352 Ndiv = target / source;
355 if (Ndiv < 5 || Ndiv > 13) {
356 pr_err("%s: WM8804 N value is not within the recommended range: %lu\n",
357 __func__, Ndiv);
358 return -EINVAL;
360 pll_div->n = Ndiv;
362 Nmod = target % source;
363 Kpart = FIXED_PLL_SIZE * (u64)Nmod;
365 do_div(Kpart, source);
367 K = Kpart & 0xffffffff;
368 if ((K % 10) >= 5)
369 K += 5;
370 K /= 10;
371 pll_div->k = K;
373 return 0;
376 static int wm8804_set_pll(struct snd_soc_dai *dai, int pll_id,
377 int source, unsigned int freq_in,
378 unsigned int freq_out)
380 struct snd_soc_codec *codec;
382 codec = dai->codec;
383 if (!freq_in || !freq_out) {
384 /* disable the PLL */
385 snd_soc_update_bits(codec, WM8804_PWRDN, 0x1, 0x1);
386 return 0;
387 } else {
388 int ret;
389 struct pll_div pll_div;
391 ret = pll_factors(&pll_div, freq_out, freq_in);
392 if (ret)
393 return ret;
395 /* power down the PLL before reprogramming it */
396 snd_soc_update_bits(codec, WM8804_PWRDN, 0x1, 0x1);
398 if (!freq_in || !freq_out)
399 return 0;
401 /* set PLLN and PRESCALE */
402 snd_soc_update_bits(codec, WM8804_PLL4, 0xf | 0x10,
403 pll_div.n | (pll_div.prescale << 4));
404 /* set mclkdiv and freqmode */
405 snd_soc_update_bits(codec, WM8804_PLL5, 0x3 | 0x8,
406 pll_div.freqmode | (pll_div.mclkdiv << 3));
407 /* set PLLK */
408 snd_soc_write(codec, WM8804_PLL1, pll_div.k & 0xff);
409 snd_soc_write(codec, WM8804_PLL2, (pll_div.k >> 8) & 0xff);
410 snd_soc_write(codec, WM8804_PLL3, pll_div.k >> 16);
412 /* power up the PLL */
413 snd_soc_update_bits(codec, WM8804_PWRDN, 0x1, 0);
416 return 0;
419 static int wm8804_set_sysclk(struct snd_soc_dai *dai,
420 int clk_id, unsigned int freq, int dir)
422 struct snd_soc_codec *codec;
424 codec = dai->codec;
426 switch (clk_id) {
427 case WM8804_TX_CLKSRC_MCLK:
428 if ((freq >= 10000000 && freq <= 14400000)
429 || (freq >= 16280000 && freq <= 27000000))
430 snd_soc_update_bits(codec, WM8804_PLL6, 0x80, 0x80);
431 else {
432 dev_err(dai->dev, "OSCCLOCK is not within the "
433 "recommended range: %uHz\n", freq);
434 return -EINVAL;
436 break;
437 case WM8804_TX_CLKSRC_PLL:
438 snd_soc_update_bits(codec, WM8804_PLL6, 0x80, 0);
439 break;
440 case WM8804_CLKOUT_SRC_CLK1:
441 snd_soc_update_bits(codec, WM8804_PLL6, 0x8, 0);
442 break;
443 case WM8804_CLKOUT_SRC_OSCCLK:
444 snd_soc_update_bits(codec, WM8804_PLL6, 0x8, 0x8);
445 break;
446 default:
447 dev_err(dai->dev, "Unknown clock source: %d\n", clk_id);
448 return -EINVAL;
451 return 0;
454 static int wm8804_set_clkdiv(struct snd_soc_dai *dai,
455 int div_id, int div)
457 struct snd_soc_codec *codec;
459 codec = dai->codec;
460 switch (div_id) {
461 case WM8804_CLKOUT_DIV:
462 snd_soc_update_bits(codec, WM8804_PLL5, 0x30,
463 (div & 0x3) << 4);
464 break;
465 default:
466 dev_err(dai->dev, "Unknown clock divider: %d\n", div_id);
467 return -EINVAL;
469 return 0;
472 static int wm8804_set_bias_level(struct snd_soc_codec *codec,
473 enum snd_soc_bias_level level)
475 int ret;
476 struct wm8804_priv *wm8804;
478 wm8804 = snd_soc_codec_get_drvdata(codec);
479 switch (level) {
480 case SND_SOC_BIAS_ON:
481 break;
482 case SND_SOC_BIAS_PREPARE:
483 /* power up the OSC and the PLL */
484 snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0);
485 break;
486 case SND_SOC_BIAS_STANDBY:
487 if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
488 ret = regulator_bulk_enable(ARRAY_SIZE(wm8804->supplies),
489 wm8804->supplies);
490 if (ret) {
491 dev_err(codec->dev,
492 "Failed to enable supplies: %d\n",
493 ret);
494 return ret;
496 regcache_sync(wm8804->regmap);
498 /* power down the OSC and the PLL */
499 snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0x9);
500 break;
501 case SND_SOC_BIAS_OFF:
502 /* power down the OSC and the PLL */
503 snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0x9);
504 regulator_bulk_disable(ARRAY_SIZE(wm8804->supplies),
505 wm8804->supplies);
506 break;
509 codec->dapm.bias_level = level;
510 return 0;
513 #ifdef CONFIG_PM
514 static int wm8804_suspend(struct snd_soc_codec *codec)
516 wm8804_set_bias_level(codec, SND_SOC_BIAS_OFF);
517 return 0;
520 static int wm8804_resume(struct snd_soc_codec *codec)
522 wm8804_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
523 return 0;
525 #else
526 #define wm8804_suspend NULL
527 #define wm8804_resume NULL
528 #endif
530 static int wm8804_remove(struct snd_soc_codec *codec)
532 struct wm8804_priv *wm8804;
533 int i;
535 wm8804 = snd_soc_codec_get_drvdata(codec);
536 wm8804_set_bias_level(codec, SND_SOC_BIAS_OFF);
538 for (i = 0; i < ARRAY_SIZE(wm8804->supplies); ++i)
539 regulator_unregister_notifier(wm8804->supplies[i].consumer,
540 &wm8804->disable_nb[i]);
541 regulator_bulk_free(ARRAY_SIZE(wm8804->supplies), wm8804->supplies);
542 return 0;
545 static int wm8804_probe(struct snd_soc_codec *codec)
547 struct wm8804_priv *wm8804;
548 int i, id1, id2, ret;
550 wm8804 = snd_soc_codec_get_drvdata(codec);
552 codec->control_data = wm8804->regmap;
554 ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_REGMAP);
555 if (ret < 0) {
556 dev_err(codec->dev, "Failed to set cache i/o: %d\n", ret);
557 return ret;
560 for (i = 0; i < ARRAY_SIZE(wm8804->supplies); i++)
561 wm8804->supplies[i].supply = wm8804_supply_names[i];
563 ret = regulator_bulk_get(codec->dev, ARRAY_SIZE(wm8804->supplies),
564 wm8804->supplies);
565 if (ret) {
566 dev_err(codec->dev, "Failed to request supplies: %d\n", ret);
567 return ret;
570 wm8804->disable_nb[0].notifier_call = wm8804_regulator_event_0;
571 wm8804->disable_nb[1].notifier_call = wm8804_regulator_event_1;
573 /* This should really be moved into the regulator core */
574 for (i = 0; i < ARRAY_SIZE(wm8804->supplies); i++) {
575 ret = regulator_register_notifier(wm8804->supplies[i].consumer,
576 &wm8804->disable_nb[i]);
577 if (ret != 0) {
578 dev_err(codec->dev,
579 "Failed to register regulator notifier: %d\n",
580 ret);
584 ret = regulator_bulk_enable(ARRAY_SIZE(wm8804->supplies),
585 wm8804->supplies);
586 if (ret) {
587 dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
588 goto err_reg_get;
591 id1 = snd_soc_read(codec, WM8804_RST_DEVID1);
592 if (id1 < 0) {
593 dev_err(codec->dev, "Failed to read device ID: %d\n", id1);
594 ret = id1;
595 goto err_reg_enable;
598 id2 = snd_soc_read(codec, WM8804_DEVID2);
599 if (id2 < 0) {
600 dev_err(codec->dev, "Failed to read device ID: %d\n", id2);
601 ret = id2;
602 goto err_reg_enable;
605 id2 = (id2 << 8) | id1;
607 if (id2 != 0x8805) {
608 dev_err(codec->dev, "Invalid device ID: %#x\n", id2);
609 ret = -EINVAL;
610 goto err_reg_enable;
613 ret = snd_soc_read(codec, WM8804_DEVREV);
614 if (ret < 0) {
615 dev_err(codec->dev, "Failed to read device revision: %d\n",
616 ret);
617 goto err_reg_enable;
619 dev_info(codec->dev, "revision %c\n", ret + 'A');
621 ret = wm8804_reset(codec);
622 if (ret < 0) {
623 dev_err(codec->dev, "Failed to issue reset: %d\n", ret);
624 goto err_reg_enable;
627 wm8804_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
629 return 0;
631 err_reg_enable:
632 regulator_bulk_disable(ARRAY_SIZE(wm8804->supplies), wm8804->supplies);
633 err_reg_get:
634 regulator_bulk_free(ARRAY_SIZE(wm8804->supplies), wm8804->supplies);
635 return ret;
638 static const struct snd_soc_dai_ops wm8804_dai_ops = {
639 .hw_params = wm8804_hw_params,
640 .set_fmt = wm8804_set_fmt,
641 .set_sysclk = wm8804_set_sysclk,
642 .set_clkdiv = wm8804_set_clkdiv,
643 .set_pll = wm8804_set_pll
646 #define WM8804_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
647 SNDRV_PCM_FMTBIT_S24_LE)
649 #define WM8804_RATES (SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | \
650 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_64000 | \
651 SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000 | \
652 SNDRV_PCM_RATE_176400 | SNDRV_PCM_RATE_192000)
654 static struct snd_soc_dai_driver wm8804_dai = {
655 .name = "wm8804-spdif",
656 .playback = {
657 .stream_name = "Playback",
658 .channels_min = 2,
659 .channels_max = 2,
660 .rates = WM8804_RATES,
661 .formats = WM8804_FORMATS,
663 .capture = {
664 .stream_name = "Capture",
665 .channels_min = 2,
666 .channels_max = 2,
667 .rates = WM8804_RATES,
668 .formats = WM8804_FORMATS,
670 .ops = &wm8804_dai_ops,
671 .symmetric_rates = 1
674 static struct snd_soc_codec_driver soc_codec_dev_wm8804 = {
675 .probe = wm8804_probe,
676 .remove = wm8804_remove,
677 .suspend = wm8804_suspend,
678 .resume = wm8804_resume,
679 .set_bias_level = wm8804_set_bias_level,
680 .idle_bias_off = true,
682 .controls = wm8804_snd_controls,
683 .num_controls = ARRAY_SIZE(wm8804_snd_controls),
686 static const struct of_device_id wm8804_of_match[] = {
687 { .compatible = "wlf,wm8804", },
690 MODULE_DEVICE_TABLE(of, wm8804_of_match);
692 static struct regmap_config wm8804_regmap_config = {
693 .reg_bits = 8,
694 .val_bits = 8,
696 .max_register = WM8804_MAX_REGISTER,
697 .volatile_reg = wm8804_volatile,
699 .cache_type = REGCACHE_RBTREE,
700 .reg_defaults = wm8804_reg_defaults,
701 .num_reg_defaults = ARRAY_SIZE(wm8804_reg_defaults),
704 #if defined(CONFIG_SPI_MASTER)
705 static int __devinit wm8804_spi_probe(struct spi_device *spi)
707 struct wm8804_priv *wm8804;
708 int ret;
710 wm8804 = devm_kzalloc(&spi->dev, sizeof *wm8804, GFP_KERNEL);
711 if (!wm8804)
712 return -ENOMEM;
714 wm8804->regmap = regmap_init_spi(spi, &wm8804_regmap_config);
715 if (IS_ERR(wm8804->regmap)) {
716 ret = PTR_ERR(wm8804->regmap);
717 return ret;
720 spi_set_drvdata(spi, wm8804);
722 ret = snd_soc_register_codec(&spi->dev,
723 &soc_codec_dev_wm8804, &wm8804_dai, 1);
725 return ret;
728 static int __devexit wm8804_spi_remove(struct spi_device *spi)
730 struct wm8804_priv *wm8804 = spi_get_drvdata(spi);
731 snd_soc_unregister_codec(&spi->dev);
732 regmap_exit(wm8804->regmap);
733 return 0;
736 static struct spi_driver wm8804_spi_driver = {
737 .driver = {
738 .name = "wm8804",
739 .owner = THIS_MODULE,
740 .of_match_table = wm8804_of_match,
742 .probe = wm8804_spi_probe,
743 .remove = __devexit_p(wm8804_spi_remove)
745 #endif
747 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
748 static __devinit int wm8804_i2c_probe(struct i2c_client *i2c,
749 const struct i2c_device_id *id)
751 struct wm8804_priv *wm8804;
752 int ret;
754 wm8804 = devm_kzalloc(&i2c->dev, sizeof *wm8804, GFP_KERNEL);
755 if (!wm8804)
756 return -ENOMEM;
758 wm8804->regmap = regmap_init_i2c(i2c, &wm8804_regmap_config);
759 if (IS_ERR(wm8804->regmap)) {
760 ret = PTR_ERR(wm8804->regmap);
761 return ret;
764 i2c_set_clientdata(i2c, wm8804);
766 ret = snd_soc_register_codec(&i2c->dev,
767 &soc_codec_dev_wm8804, &wm8804_dai, 1);
768 if (ret != 0)
769 goto err;
771 return 0;
773 err:
774 regmap_exit(wm8804->regmap);
775 return ret;
778 static __devexit int wm8804_i2c_remove(struct i2c_client *i2c)
780 struct wm8804_priv *wm8804 = i2c_get_clientdata(i2c);
782 snd_soc_unregister_codec(&i2c->dev);
783 regmap_exit(wm8804->regmap);
785 return 0;
788 static const struct i2c_device_id wm8804_i2c_id[] = {
789 { "wm8804", 0 },
792 MODULE_DEVICE_TABLE(i2c, wm8804_i2c_id);
794 static struct i2c_driver wm8804_i2c_driver = {
795 .driver = {
796 .name = "wm8804",
797 .owner = THIS_MODULE,
798 .of_match_table = wm8804_of_match,
800 .probe = wm8804_i2c_probe,
801 .remove = __devexit_p(wm8804_i2c_remove),
802 .id_table = wm8804_i2c_id
804 #endif
806 static int __init wm8804_modinit(void)
808 int ret = 0;
810 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
811 ret = i2c_add_driver(&wm8804_i2c_driver);
812 if (ret) {
813 printk(KERN_ERR "Failed to register wm8804 I2C driver: %d\n",
814 ret);
816 #endif
817 #if defined(CONFIG_SPI_MASTER)
818 ret = spi_register_driver(&wm8804_spi_driver);
819 if (ret != 0) {
820 printk(KERN_ERR "Failed to register wm8804 SPI driver: %d\n",
821 ret);
823 #endif
824 return ret;
826 module_init(wm8804_modinit);
828 static void __exit wm8804_exit(void)
830 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
831 i2c_del_driver(&wm8804_i2c_driver);
832 #endif
833 #if defined(CONFIG_SPI_MASTER)
834 spi_unregister_driver(&wm8804_spi_driver);
835 #endif
837 module_exit(wm8804_exit);
839 MODULE_DESCRIPTION("ASoC WM8804 driver");
840 MODULE_AUTHOR("Dimitris Papastamos <dp@opensource.wolfsonmicro.com>");
841 MODULE_LICENSE("GPL");