xref: /linux/sound/soc/codecs/wm8731.c (revision d751b233bb8568f1de1ccbe3824ca69090326251)
140e0aa64SRichard Purdie /*
240e0aa64SRichard Purdie  * wm8731.c  --  WM8731 ALSA SoC Audio driver
340e0aa64SRichard Purdie  *
440e0aa64SRichard Purdie  * Copyright 2005 Openedhand Ltd.
540e0aa64SRichard Purdie  *
640e0aa64SRichard Purdie  * Author: Richard Purdie <richard@openedhand.com>
740e0aa64SRichard Purdie  *
840e0aa64SRichard Purdie  * Based on wm8753.c by Liam Girdwood
940e0aa64SRichard Purdie  *
1040e0aa64SRichard Purdie  * This program is free software; you can redistribute it and/or modify
1140e0aa64SRichard Purdie  * it under the terms of the GNU General Public License version 2 as
1240e0aa64SRichard Purdie  * published by the Free Software Foundation.
1340e0aa64SRichard Purdie  */
1440e0aa64SRichard Purdie 
1540e0aa64SRichard Purdie #include <linux/module.h>
1640e0aa64SRichard Purdie #include <linux/moduleparam.h>
1740e0aa64SRichard Purdie #include <linux/init.h>
1840e0aa64SRichard Purdie #include <linux/delay.h>
1940e0aa64SRichard Purdie #include <linux/pm.h>
2040e0aa64SRichard Purdie #include <linux/i2c.h>
2140e0aa64SRichard Purdie #include <linux/platform_device.h>
2240e0aa64SRichard Purdie #include <sound/core.h>
2340e0aa64SRichard Purdie #include <sound/pcm.h>
2440e0aa64SRichard Purdie #include <sound/pcm_params.h>
2540e0aa64SRichard Purdie #include <sound/soc.h>
2640e0aa64SRichard Purdie #include <sound/soc-dapm.h>
2740e0aa64SRichard Purdie #include <sound/initval.h>
2840e0aa64SRichard Purdie 
2940e0aa64SRichard Purdie #include "wm8731.h"
3040e0aa64SRichard Purdie 
3140e0aa64SRichard Purdie #define AUDIO_NAME "wm8731"
32b36d61d4SFrank Mandarino #define WM8731_VERSION "0.13"
3340e0aa64SRichard Purdie 
3440e0aa64SRichard Purdie /*
3540e0aa64SRichard Purdie  * Debug
3640e0aa64SRichard Purdie  */
3740e0aa64SRichard Purdie 
3840e0aa64SRichard Purdie #define WM8731_DEBUG 0
3940e0aa64SRichard Purdie 
4040e0aa64SRichard Purdie #ifdef WM8731_DEBUG
4140e0aa64SRichard Purdie #define dbg(format, arg...) \
4240e0aa64SRichard Purdie 	printk(KERN_DEBUG AUDIO_NAME ": " format "\n" , ## arg)
4340e0aa64SRichard Purdie #else
4440e0aa64SRichard Purdie #define dbg(format, arg...) do {} while (0)
4540e0aa64SRichard Purdie #endif
4640e0aa64SRichard Purdie #define err(format, arg...) \
4740e0aa64SRichard Purdie 	printk(KERN_ERR AUDIO_NAME ": " format "\n" , ## arg)
4840e0aa64SRichard Purdie #define info(format, arg...) \
4940e0aa64SRichard Purdie 	printk(KERN_INFO AUDIO_NAME ": " format "\n" , ## arg)
5040e0aa64SRichard Purdie #define warn(format, arg...) \
5140e0aa64SRichard Purdie 	printk(KERN_WARNING AUDIO_NAME ": " format "\n" , ## arg)
5240e0aa64SRichard Purdie 
5340e0aa64SRichard Purdie struct snd_soc_codec_device soc_codec_dev_wm8731;
5440e0aa64SRichard Purdie 
55b36d61d4SFrank Mandarino /* codec private data */
56b36d61d4SFrank Mandarino struct wm8731_priv {
57b36d61d4SFrank Mandarino 	unsigned int sysclk;
58b36d61d4SFrank Mandarino };
59b36d61d4SFrank Mandarino 
6040e0aa64SRichard Purdie /*
6140e0aa64SRichard Purdie  * wm8731 register cache
6240e0aa64SRichard Purdie  * We can't read the WM8731 register space when we are
6340e0aa64SRichard Purdie  * using 2 wire for device control, so we cache them instead.
6440e0aa64SRichard Purdie  * There is no point in caching the reset register
6540e0aa64SRichard Purdie  */
6640e0aa64SRichard Purdie static const u16 wm8731_reg[WM8731_CACHEREGNUM] = {
6740e0aa64SRichard Purdie     0x0097, 0x0097, 0x0079, 0x0079,
6840e0aa64SRichard Purdie     0x000a, 0x0008, 0x009f, 0x000a,
6940e0aa64SRichard Purdie     0x0000, 0x0000
7040e0aa64SRichard Purdie };
7140e0aa64SRichard Purdie 
7240e0aa64SRichard Purdie /*
7340e0aa64SRichard Purdie  * read wm8731 register cache
7440e0aa64SRichard Purdie  */
7540e0aa64SRichard Purdie static inline unsigned int wm8731_read_reg_cache(struct snd_soc_codec *codec,
7640e0aa64SRichard Purdie 	unsigned int reg)
7740e0aa64SRichard Purdie {
7840e0aa64SRichard Purdie 	u16 *cache = codec->reg_cache;
7940e0aa64SRichard Purdie 	if (reg == WM8731_RESET)
8040e0aa64SRichard Purdie 		return 0;
8140e0aa64SRichard Purdie 	if (reg >= WM8731_CACHEREGNUM)
8240e0aa64SRichard Purdie 		return -1;
8340e0aa64SRichard Purdie 	return cache[reg];
8440e0aa64SRichard Purdie }
8540e0aa64SRichard Purdie 
8640e0aa64SRichard Purdie /*
8740e0aa64SRichard Purdie  * write wm8731 register cache
8840e0aa64SRichard Purdie  */
8940e0aa64SRichard Purdie static inline void wm8731_write_reg_cache(struct snd_soc_codec *codec,
9040e0aa64SRichard Purdie 	u16 reg, unsigned int value)
9140e0aa64SRichard Purdie {
9240e0aa64SRichard Purdie 	u16 *cache = codec->reg_cache;
9340e0aa64SRichard Purdie 	if (reg >= WM8731_CACHEREGNUM)
9440e0aa64SRichard Purdie 		return;
9540e0aa64SRichard Purdie 	cache[reg] = value;
9640e0aa64SRichard Purdie }
9740e0aa64SRichard Purdie 
9840e0aa64SRichard Purdie /*
9940e0aa64SRichard Purdie  * write to the WM8731 register space
10040e0aa64SRichard Purdie  */
10140e0aa64SRichard Purdie static int wm8731_write(struct snd_soc_codec *codec, unsigned int reg,
10240e0aa64SRichard Purdie 	unsigned int value)
10340e0aa64SRichard Purdie {
10440e0aa64SRichard Purdie 	u8 data[2];
10540e0aa64SRichard Purdie 
10640e0aa64SRichard Purdie 	/* data is
10740e0aa64SRichard Purdie 	 *   D15..D9 WM8731 register offset
10840e0aa64SRichard Purdie 	 *   D8...D0 register data
10940e0aa64SRichard Purdie 	 */
11040e0aa64SRichard Purdie 	data[0] = (reg << 1) | ((value >> 8) & 0x0001);
11140e0aa64SRichard Purdie 	data[1] = value & 0x00ff;
11240e0aa64SRichard Purdie 
11340e0aa64SRichard Purdie 	wm8731_write_reg_cache(codec, reg, value);
11440e0aa64SRichard Purdie 	if (codec->hw_write(codec->control_data, data, 2) == 2)
11540e0aa64SRichard Purdie 		return 0;
11640e0aa64SRichard Purdie 	else
11740e0aa64SRichard Purdie 		return -EIO;
11840e0aa64SRichard Purdie }
11940e0aa64SRichard Purdie 
12040e0aa64SRichard Purdie #define wm8731_reset(c)	wm8731_write(c, WM8731_RESET, 0)
12140e0aa64SRichard Purdie 
12240e0aa64SRichard Purdie static const char *wm8731_input_select[] = {"Line In", "Mic"};
12340e0aa64SRichard Purdie static const char *wm8731_deemph[] = {"None", "32Khz", "44.1Khz", "48Khz"};
12440e0aa64SRichard Purdie 
12540e0aa64SRichard Purdie static const struct soc_enum wm8731_enum[] = {
12640e0aa64SRichard Purdie 	SOC_ENUM_SINGLE(WM8731_APANA, 2, 2, wm8731_input_select),
12740e0aa64SRichard Purdie 	SOC_ENUM_SINGLE(WM8731_APDIGI, 1, 4, wm8731_deemph),
12840e0aa64SRichard Purdie };
12940e0aa64SRichard Purdie 
13040e0aa64SRichard Purdie static const struct snd_kcontrol_new wm8731_snd_controls[] = {
13140e0aa64SRichard Purdie 
132bd903b6eSLiam Girdwood SOC_DOUBLE_R("Master Playback Volume", WM8731_LOUT1V, WM8731_ROUT1V,
133bd903b6eSLiam Girdwood 	0, 127, 0),
134bd903b6eSLiam Girdwood SOC_DOUBLE_R("Master Playback ZC Switch", WM8731_LOUT1V, WM8731_ROUT1V,
135bd903b6eSLiam Girdwood 	7, 1, 0),
13640e0aa64SRichard Purdie 
13740e0aa64SRichard Purdie SOC_DOUBLE_R("Capture Volume", WM8731_LINVOL, WM8731_RINVOL, 0, 31, 0),
13840e0aa64SRichard Purdie SOC_DOUBLE_R("Line Capture Switch", WM8731_LINVOL, WM8731_RINVOL, 7, 1, 1),
13940e0aa64SRichard Purdie 
14040e0aa64SRichard Purdie SOC_SINGLE("Mic Boost (+20dB)", WM8731_APANA, 0, 1, 0),
14140e0aa64SRichard Purdie SOC_SINGLE("Capture Mic Switch", WM8731_APANA, 1, 1, 1),
14240e0aa64SRichard Purdie 
14340e0aa64SRichard Purdie SOC_SINGLE("Sidetone Playback Volume", WM8731_APANA, 6, 3, 1),
14440e0aa64SRichard Purdie 
14540e0aa64SRichard Purdie SOC_SINGLE("ADC High Pass Filter Switch", WM8731_APDIGI, 0, 1, 1),
14640e0aa64SRichard Purdie SOC_SINGLE("Store DC Offset Switch", WM8731_APDIGI, 4, 1, 0),
14740e0aa64SRichard Purdie 
14840e0aa64SRichard Purdie SOC_ENUM("Playback De-emphasis", wm8731_enum[1]),
14940e0aa64SRichard Purdie };
15040e0aa64SRichard Purdie 
15140e0aa64SRichard Purdie /* add non dapm controls */
15240e0aa64SRichard Purdie static int wm8731_add_controls(struct snd_soc_codec *codec)
15340e0aa64SRichard Purdie {
15440e0aa64SRichard Purdie 	int err, i;
15540e0aa64SRichard Purdie 
15640e0aa64SRichard Purdie 	for (i = 0; i < ARRAY_SIZE(wm8731_snd_controls); i++) {
157d454aee9SMark Brown 		err = snd_ctl_add(codec->card,
158d454aee9SMark Brown 				  snd_soc_cnew(&wm8731_snd_controls[i],
159d454aee9SMark Brown 						codec, NULL));
160d454aee9SMark Brown 		if (err < 0)
16140e0aa64SRichard Purdie 			return err;
16240e0aa64SRichard Purdie 	}
16340e0aa64SRichard Purdie 
16440e0aa64SRichard Purdie 	return 0;
16540e0aa64SRichard Purdie }
16640e0aa64SRichard Purdie 
16740e0aa64SRichard Purdie /* Output Mixer */
16840e0aa64SRichard Purdie static const struct snd_kcontrol_new wm8731_output_mixer_controls[] = {
16940e0aa64SRichard Purdie SOC_DAPM_SINGLE("Line Bypass Switch", WM8731_APANA, 3, 1, 0),
17040e0aa64SRichard Purdie SOC_DAPM_SINGLE("Mic Sidetone Switch", WM8731_APANA, 5, 1, 0),
17140e0aa64SRichard Purdie SOC_DAPM_SINGLE("HiFi Playback Switch", WM8731_APANA, 4, 1, 0),
17240e0aa64SRichard Purdie };
17340e0aa64SRichard Purdie 
17440e0aa64SRichard Purdie /* Input mux */
17540e0aa64SRichard Purdie static const struct snd_kcontrol_new wm8731_input_mux_controls =
17640e0aa64SRichard Purdie SOC_DAPM_ENUM("Input Select", wm8731_enum[0]);
17740e0aa64SRichard Purdie 
17840e0aa64SRichard Purdie static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
17940e0aa64SRichard Purdie SND_SOC_DAPM_MIXER("Output Mixer", WM8731_PWR, 4, 1,
18040e0aa64SRichard Purdie 	&wm8731_output_mixer_controls[0],
18140e0aa64SRichard Purdie 	ARRAY_SIZE(wm8731_output_mixer_controls)),
18240e0aa64SRichard Purdie SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8731_PWR, 3, 1),
18340e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("LOUT"),
18440e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("LHPOUT"),
18540e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("ROUT"),
18640e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("RHPOUT"),
18740e0aa64SRichard Purdie SND_SOC_DAPM_ADC("ADC", "HiFi Capture", WM8731_PWR, 2, 1),
18840e0aa64SRichard Purdie SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0, &wm8731_input_mux_controls),
18940e0aa64SRichard Purdie SND_SOC_DAPM_PGA("Line Input", WM8731_PWR, 0, 1, NULL, 0),
19040e0aa64SRichard Purdie SND_SOC_DAPM_MICBIAS("Mic Bias", WM8731_PWR, 1, 1),
19140e0aa64SRichard Purdie SND_SOC_DAPM_INPUT("MICIN"),
19240e0aa64SRichard Purdie SND_SOC_DAPM_INPUT("RLINEIN"),
19340e0aa64SRichard Purdie SND_SOC_DAPM_INPUT("LLINEIN"),
19440e0aa64SRichard Purdie };
19540e0aa64SRichard Purdie 
196a65f0568SMark Brown static const struct snd_soc_dapm_route intercon[] = {
19740e0aa64SRichard Purdie 	/* output mixer */
19840e0aa64SRichard Purdie 	{"Output Mixer", "Line Bypass Switch", "Line Input"},
19940e0aa64SRichard Purdie 	{"Output Mixer", "HiFi Playback Switch", "DAC"},
20040e0aa64SRichard Purdie 	{"Output Mixer", "Mic Sidetone Switch", "Mic Bias"},
20140e0aa64SRichard Purdie 
20240e0aa64SRichard Purdie 	/* outputs */
20340e0aa64SRichard Purdie 	{"RHPOUT", NULL, "Output Mixer"},
20440e0aa64SRichard Purdie 	{"ROUT", NULL, "Output Mixer"},
20540e0aa64SRichard Purdie 	{"LHPOUT", NULL, "Output Mixer"},
20640e0aa64SRichard Purdie 	{"LOUT", NULL, "Output Mixer"},
20740e0aa64SRichard Purdie 
20840e0aa64SRichard Purdie 	/* input mux */
20940e0aa64SRichard Purdie 	{"Input Mux", "Line In", "Line Input"},
21040e0aa64SRichard Purdie 	{"Input Mux", "Mic", "Mic Bias"},
21140e0aa64SRichard Purdie 	{"ADC", NULL, "Input Mux"},
21240e0aa64SRichard Purdie 
21340e0aa64SRichard Purdie 	/* inputs */
21440e0aa64SRichard Purdie 	{"Line Input", NULL, "LLINEIN"},
21540e0aa64SRichard Purdie 	{"Line Input", NULL, "RLINEIN"},
21640e0aa64SRichard Purdie 	{"Mic Bias", NULL, "MICIN"},
21740e0aa64SRichard Purdie };
21840e0aa64SRichard Purdie 
21940e0aa64SRichard Purdie static int wm8731_add_widgets(struct snd_soc_codec *codec)
22040e0aa64SRichard Purdie {
221a65f0568SMark Brown 	snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets,
222a65f0568SMark Brown 				  ARRAY_SIZE(wm8731_dapm_widgets));
22340e0aa64SRichard Purdie 
224a65f0568SMark Brown 	snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
22540e0aa64SRichard Purdie 
22640e0aa64SRichard Purdie 	snd_soc_dapm_new_widgets(codec);
22740e0aa64SRichard Purdie 	return 0;
22840e0aa64SRichard Purdie }
22940e0aa64SRichard Purdie 
23040e0aa64SRichard Purdie struct _coeff_div {
23140e0aa64SRichard Purdie 	u32 mclk;
23240e0aa64SRichard Purdie 	u32 rate;
23340e0aa64SRichard Purdie 	u16 fs;
23440e0aa64SRichard Purdie 	u8 sr:4;
23540e0aa64SRichard Purdie 	u8 bosr:1;
23640e0aa64SRichard Purdie 	u8 usb:1;
23740e0aa64SRichard Purdie };
23840e0aa64SRichard Purdie 
23940e0aa64SRichard Purdie /* codec mclk clock divider coefficients */
24040e0aa64SRichard Purdie static const struct _coeff_div coeff_div[] = {
24140e0aa64SRichard Purdie 	/* 48k */
24240e0aa64SRichard Purdie 	{12288000, 48000, 256, 0x0, 0x0, 0x0},
24340e0aa64SRichard Purdie 	{18432000, 48000, 384, 0x0, 0x1, 0x0},
24440e0aa64SRichard Purdie 	{12000000, 48000, 250, 0x0, 0x0, 0x1},
24540e0aa64SRichard Purdie 
24640e0aa64SRichard Purdie 	/* 32k */
24740e0aa64SRichard Purdie 	{12288000, 32000, 384, 0x6, 0x0, 0x0},
24840e0aa64SRichard Purdie 	{18432000, 32000, 576, 0x6, 0x1, 0x0},
249298a2c75SFrank Mandarino 	{12000000, 32000, 375, 0x6, 0x0, 0x1},
25040e0aa64SRichard Purdie 
25140e0aa64SRichard Purdie 	/* 8k */
25240e0aa64SRichard Purdie 	{12288000, 8000, 1536, 0x3, 0x0, 0x0},
25340e0aa64SRichard Purdie 	{18432000, 8000, 2304, 0x3, 0x1, 0x0},
25440e0aa64SRichard Purdie 	{11289600, 8000, 1408, 0xb, 0x0, 0x0},
25540e0aa64SRichard Purdie 	{16934400, 8000, 2112, 0xb, 0x1, 0x0},
25640e0aa64SRichard Purdie 	{12000000, 8000, 1500, 0x3, 0x0, 0x1},
25740e0aa64SRichard Purdie 
25840e0aa64SRichard Purdie 	/* 96k */
25940e0aa64SRichard Purdie 	{12288000, 96000, 128, 0x7, 0x0, 0x0},
26040e0aa64SRichard Purdie 	{18432000, 96000, 192, 0x7, 0x1, 0x0},
26140e0aa64SRichard Purdie 	{12000000, 96000, 125, 0x7, 0x0, 0x1},
26240e0aa64SRichard Purdie 
26340e0aa64SRichard Purdie 	/* 44.1k */
26440e0aa64SRichard Purdie 	{11289600, 44100, 256, 0x8, 0x0, 0x0},
26540e0aa64SRichard Purdie 	{16934400, 44100, 384, 0x8, 0x1, 0x0},
26640e0aa64SRichard Purdie 	{12000000, 44100, 272, 0x8, 0x1, 0x1},
26740e0aa64SRichard Purdie 
26840e0aa64SRichard Purdie 	/* 88.2k */
26940e0aa64SRichard Purdie 	{11289600, 88200, 128, 0xf, 0x0, 0x0},
27040e0aa64SRichard Purdie 	{16934400, 88200, 192, 0xf, 0x1, 0x0},
27140e0aa64SRichard Purdie 	{12000000, 88200, 136, 0xf, 0x1, 0x1},
27240e0aa64SRichard Purdie };
27340e0aa64SRichard Purdie 
27440e0aa64SRichard Purdie static inline int get_coeff(int mclk, int rate)
27540e0aa64SRichard Purdie {
27640e0aa64SRichard Purdie 	int i;
27740e0aa64SRichard Purdie 
27840e0aa64SRichard Purdie 	for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
27940e0aa64SRichard Purdie 		if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
28040e0aa64SRichard Purdie 			return i;
28140e0aa64SRichard Purdie 	}
28240e0aa64SRichard Purdie 	return 0;
28340e0aa64SRichard Purdie }
28440e0aa64SRichard Purdie 
285b36d61d4SFrank Mandarino static int wm8731_hw_params(struct snd_pcm_substream *substream,
286b36d61d4SFrank Mandarino 	struct snd_pcm_hw_params *params)
28740e0aa64SRichard Purdie {
288b36d61d4SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
289b36d61d4SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
290b36d61d4SFrank Mandarino 	struct snd_soc_codec *codec = socdev->codec;
291b36d61d4SFrank Mandarino 	struct wm8731_priv *wm8731 = codec->private_data;
292b36d61d4SFrank Mandarino 	u16 iface = wm8731_read_reg_cache(codec, WM8731_IFACE) & 0xfff3;
293b36d61d4SFrank Mandarino 	int i = get_coeff(wm8731->sysclk, params_rate(params));
294b36d61d4SFrank Mandarino 	u16 srate = (coeff_div[i].sr << 2) |
295b36d61d4SFrank Mandarino 		(coeff_div[i].bosr << 1) | coeff_div[i].usb;
29640e0aa64SRichard Purdie 
297b36d61d4SFrank Mandarino 	wm8731_write(codec, WM8731_SRATE, srate);
29840e0aa64SRichard Purdie 
299b36d61d4SFrank Mandarino 	/* bit size */
300b36d61d4SFrank Mandarino 	switch (params_format(params)) {
301b36d61d4SFrank Mandarino 	case SNDRV_PCM_FORMAT_S16_LE:
302b36d61d4SFrank Mandarino 		break;
303b36d61d4SFrank Mandarino 	case SNDRV_PCM_FORMAT_S20_3LE:
304b36d61d4SFrank Mandarino 		iface |= 0x0004;
305b36d61d4SFrank Mandarino 		break;
306b36d61d4SFrank Mandarino 	case SNDRV_PCM_FORMAT_S24_LE:
307b36d61d4SFrank Mandarino 		iface |= 0x0008;
308b36d61d4SFrank Mandarino 		break;
309b36d61d4SFrank Mandarino 	}
310b36d61d4SFrank Mandarino 
311b36d61d4SFrank Mandarino 	wm8731_write(codec, WM8731_IFACE, iface);
312b36d61d4SFrank Mandarino 	return 0;
31340e0aa64SRichard Purdie }
31440e0aa64SRichard Purdie 
31540e0aa64SRichard Purdie static int wm8731_pcm_prepare(struct snd_pcm_substream *substream)
31640e0aa64SRichard Purdie {
31740e0aa64SRichard Purdie 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
31840e0aa64SRichard Purdie 	struct snd_soc_device *socdev = rtd->socdev;
31940e0aa64SRichard Purdie 	struct snd_soc_codec *codec = socdev->codec;
32040e0aa64SRichard Purdie 
32140e0aa64SRichard Purdie 	/* set active */
32240e0aa64SRichard Purdie 	wm8731_write(codec, WM8731_ACTIVE, 0x0001);
323b36d61d4SFrank Mandarino 
32440e0aa64SRichard Purdie 	return 0;
32540e0aa64SRichard Purdie }
32640e0aa64SRichard Purdie 
32740e0aa64SRichard Purdie static void wm8731_shutdown(struct snd_pcm_substream *substream)
32840e0aa64SRichard Purdie {
32940e0aa64SRichard Purdie 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
33040e0aa64SRichard Purdie 	struct snd_soc_device *socdev = rtd->socdev;
33140e0aa64SRichard Purdie 	struct snd_soc_codec *codec = socdev->codec;
33240e0aa64SRichard Purdie 
33340e0aa64SRichard Purdie 	/* deactivate */
33440e0aa64SRichard Purdie 	if (!codec->active) {
33540e0aa64SRichard Purdie 		udelay(50);
33640e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_ACTIVE, 0x0);
33740e0aa64SRichard Purdie 	}
33840e0aa64SRichard Purdie }
33940e0aa64SRichard Purdie 
340b36d61d4SFrank Mandarino static int wm8731_mute(struct snd_soc_codec_dai *dai, int mute)
34140e0aa64SRichard Purdie {
342b36d61d4SFrank Mandarino 	struct snd_soc_codec *codec = dai->codec;
34340e0aa64SRichard Purdie 	u16 mute_reg = wm8731_read_reg_cache(codec, WM8731_APDIGI) & 0xfff7;
344b36d61d4SFrank Mandarino 
34540e0aa64SRichard Purdie 	if (mute)
34640e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_APDIGI, mute_reg | 0x8);
34740e0aa64SRichard Purdie 	else
34840e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_APDIGI, mute_reg);
34940e0aa64SRichard Purdie 	return 0;
35040e0aa64SRichard Purdie }
35140e0aa64SRichard Purdie 
352b36d61d4SFrank Mandarino static int wm8731_set_dai_sysclk(struct snd_soc_codec_dai *codec_dai,
353b36d61d4SFrank Mandarino 		int clk_id, unsigned int freq, int dir)
354b36d61d4SFrank Mandarino {
355b36d61d4SFrank Mandarino 	struct snd_soc_codec *codec = codec_dai->codec;
356b36d61d4SFrank Mandarino 	struct wm8731_priv *wm8731 = codec->private_data;
357b36d61d4SFrank Mandarino 
358b36d61d4SFrank Mandarino 	switch (freq) {
359b36d61d4SFrank Mandarino 	case 11289600:
360b36d61d4SFrank Mandarino 	case 12000000:
361b36d61d4SFrank Mandarino 	case 12288000:
362b36d61d4SFrank Mandarino 	case 16934400:
363b36d61d4SFrank Mandarino 	case 18432000:
364b36d61d4SFrank Mandarino 		wm8731->sysclk = freq;
365b36d61d4SFrank Mandarino 		return 0;
366b36d61d4SFrank Mandarino 	}
367b36d61d4SFrank Mandarino 	return -EINVAL;
368b36d61d4SFrank Mandarino }
369b36d61d4SFrank Mandarino 
370b36d61d4SFrank Mandarino 
371b36d61d4SFrank Mandarino static int wm8731_set_dai_fmt(struct snd_soc_codec_dai *codec_dai,
372b36d61d4SFrank Mandarino 		unsigned int fmt)
373b36d61d4SFrank Mandarino {
374b36d61d4SFrank Mandarino 	struct snd_soc_codec *codec = codec_dai->codec;
375b36d61d4SFrank Mandarino 	u16 iface = 0;
376b36d61d4SFrank Mandarino 
377b36d61d4SFrank Mandarino 	/* set master/slave audio interface */
378b36d61d4SFrank Mandarino 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
379b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_CBM_CFM:
380b36d61d4SFrank Mandarino 		iface |= 0x0040;
381b36d61d4SFrank Mandarino 		break;
382b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_CBS_CFS:
383b36d61d4SFrank Mandarino 		break;
384b36d61d4SFrank Mandarino 	default:
385b36d61d4SFrank Mandarino 		return -EINVAL;
386b36d61d4SFrank Mandarino 	}
387b36d61d4SFrank Mandarino 
388b36d61d4SFrank Mandarino 	/* interface format */
389b36d61d4SFrank Mandarino 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
390b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_I2S:
391b36d61d4SFrank Mandarino 		iface |= 0x0002;
392b36d61d4SFrank Mandarino 		break;
393b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_RIGHT_J:
394b36d61d4SFrank Mandarino 		break;
395b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_LEFT_J:
396b36d61d4SFrank Mandarino 		iface |= 0x0001;
397b36d61d4SFrank Mandarino 		break;
398b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_DSP_A:
399b36d61d4SFrank Mandarino 		iface |= 0x0003;
400b36d61d4SFrank Mandarino 		break;
401b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_DSP_B:
402b36d61d4SFrank Mandarino 		iface |= 0x0013;
403b36d61d4SFrank Mandarino 		break;
404b36d61d4SFrank Mandarino 	default:
405b36d61d4SFrank Mandarino 		return -EINVAL;
406b36d61d4SFrank Mandarino 	}
407b36d61d4SFrank Mandarino 
408b36d61d4SFrank Mandarino 	/* clock inversion */
409b36d61d4SFrank Mandarino 	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
410b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_NB_NF:
411b36d61d4SFrank Mandarino 		break;
412b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_IB_IF:
413b36d61d4SFrank Mandarino 		iface |= 0x0090;
414b36d61d4SFrank Mandarino 		break;
415b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_IB_NF:
416b36d61d4SFrank Mandarino 		iface |= 0x0080;
417b36d61d4SFrank Mandarino 		break;
418b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_NB_IF:
419b36d61d4SFrank Mandarino 		iface |= 0x0010;
420b36d61d4SFrank Mandarino 		break;
421b36d61d4SFrank Mandarino 	default:
422b36d61d4SFrank Mandarino 		return -EINVAL;
423b36d61d4SFrank Mandarino 	}
424b36d61d4SFrank Mandarino 
425b36d61d4SFrank Mandarino 	/* set iface */
426b36d61d4SFrank Mandarino 	wm8731_write(codec, WM8731_IFACE, iface);
427b36d61d4SFrank Mandarino 	return 0;
428b36d61d4SFrank Mandarino }
429b36d61d4SFrank Mandarino 
4300be9898aSMark Brown static int wm8731_set_bias_level(struct snd_soc_codec *codec,
4310be9898aSMark Brown 				 enum snd_soc_bias_level level)
43240e0aa64SRichard Purdie {
43340e0aa64SRichard Purdie 	u16 reg = wm8731_read_reg_cache(codec, WM8731_PWR) & 0xff7f;
43440e0aa64SRichard Purdie 
4350be9898aSMark Brown 	switch (level) {
4360be9898aSMark Brown 	case SND_SOC_BIAS_ON:
43740e0aa64SRichard Purdie 		/* vref/mid, osc on, dac unmute */
43840e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_PWR, reg);
43940e0aa64SRichard Purdie 		break;
4400be9898aSMark Brown 	case SND_SOC_BIAS_PREPARE:
44140e0aa64SRichard Purdie 		break;
4420be9898aSMark Brown 	case SND_SOC_BIAS_STANDBY:
44340e0aa64SRichard Purdie 		/* everything off except vref/vmid, */
44440e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_PWR, reg | 0x0040);
44540e0aa64SRichard Purdie 		break;
4460be9898aSMark Brown 	case SND_SOC_BIAS_OFF:
44740e0aa64SRichard Purdie 		/* everything off, dac mute, inactive */
44840e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_ACTIVE, 0x0);
44940e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_PWR, 0xffff);
45040e0aa64SRichard Purdie 		break;
45140e0aa64SRichard Purdie 	}
4520be9898aSMark Brown 	codec->bias_level = level;
45340e0aa64SRichard Purdie 	return 0;
45440e0aa64SRichard Purdie }
45540e0aa64SRichard Purdie 
456b36d61d4SFrank Mandarino #define WM8731_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
457b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
458b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |\
459b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |\
460b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_96000)
461b36d61d4SFrank Mandarino 
462b36d61d4SFrank Mandarino #define WM8731_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
463b36d61d4SFrank Mandarino 	SNDRV_PCM_FMTBIT_S24_LE)
464b36d61d4SFrank Mandarino 
46540e0aa64SRichard Purdie struct snd_soc_codec_dai wm8731_dai = {
46640e0aa64SRichard Purdie 	.name = "WM8731",
46740e0aa64SRichard Purdie 	.playback = {
46840e0aa64SRichard Purdie 		.stream_name = "Playback",
46940e0aa64SRichard Purdie 		.channels_min = 1,
47040e0aa64SRichard Purdie 		.channels_max = 2,
471b36d61d4SFrank Mandarino 		.rates = WM8731_RATES,
472b36d61d4SFrank Mandarino 		.formats = WM8731_FORMATS,},
47340e0aa64SRichard Purdie 	.capture = {
47440e0aa64SRichard Purdie 		.stream_name = "Capture",
47540e0aa64SRichard Purdie 		.channels_min = 1,
47640e0aa64SRichard Purdie 		.channels_max = 2,
477b36d61d4SFrank Mandarino 		.rates = WM8731_RATES,
478b36d61d4SFrank Mandarino 		.formats = WM8731_FORMATS,},
47940e0aa64SRichard Purdie 	.ops = {
48040e0aa64SRichard Purdie 		.prepare = wm8731_pcm_prepare,
481b36d61d4SFrank Mandarino 		.hw_params = wm8731_hw_params,
48240e0aa64SRichard Purdie 		.shutdown = wm8731_shutdown,
48340e0aa64SRichard Purdie 	},
484b36d61d4SFrank Mandarino 	.dai_ops = {
485b36d61d4SFrank Mandarino 		.digital_mute = wm8731_mute,
486b36d61d4SFrank Mandarino 		.set_sysclk = wm8731_set_dai_sysclk,
487b36d61d4SFrank Mandarino 		.set_fmt = wm8731_set_dai_fmt,
488b36d61d4SFrank Mandarino 	}
48940e0aa64SRichard Purdie };
49040e0aa64SRichard Purdie EXPORT_SYMBOL_GPL(wm8731_dai);
49140e0aa64SRichard Purdie 
49240e0aa64SRichard Purdie static int wm8731_suspend(struct platform_device *pdev, pm_message_t state)
49340e0aa64SRichard Purdie {
49440e0aa64SRichard Purdie 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
49540e0aa64SRichard Purdie 	struct snd_soc_codec *codec = socdev->codec;
49640e0aa64SRichard Purdie 
49740e0aa64SRichard Purdie 	wm8731_write(codec, WM8731_ACTIVE, 0x0);
4980be9898aSMark Brown 	wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF);
49940e0aa64SRichard Purdie 	return 0;
50040e0aa64SRichard Purdie }
50140e0aa64SRichard Purdie 
50240e0aa64SRichard Purdie static int wm8731_resume(struct platform_device *pdev)
50340e0aa64SRichard Purdie {
50440e0aa64SRichard Purdie 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
50540e0aa64SRichard Purdie 	struct snd_soc_codec *codec = socdev->codec;
50640e0aa64SRichard Purdie 	int i;
50740e0aa64SRichard Purdie 	u8 data[2];
50840e0aa64SRichard Purdie 	u16 *cache = codec->reg_cache;
50940e0aa64SRichard Purdie 
51040e0aa64SRichard Purdie 	/* Sync reg_cache with the hardware */
51140e0aa64SRichard Purdie 	for (i = 0; i < ARRAY_SIZE(wm8731_reg); i++) {
51240e0aa64SRichard Purdie 		data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
51340e0aa64SRichard Purdie 		data[1] = cache[i] & 0x00ff;
51440e0aa64SRichard Purdie 		codec->hw_write(codec->control_data, data, 2);
51540e0aa64SRichard Purdie 	}
5160be9898aSMark Brown 	wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
5170be9898aSMark Brown 	wm8731_set_bias_level(codec, codec->suspend_bias_level);
51840e0aa64SRichard Purdie 	return 0;
51940e0aa64SRichard Purdie }
52040e0aa64SRichard Purdie 
52140e0aa64SRichard Purdie /*
52240e0aa64SRichard Purdie  * initialise the WM8731 driver
52340e0aa64SRichard Purdie  * register the mixer and dsp interfaces with the kernel
52440e0aa64SRichard Purdie  */
52540e0aa64SRichard Purdie static int wm8731_init(struct snd_soc_device *socdev)
52640e0aa64SRichard Purdie {
52740e0aa64SRichard Purdie 	struct snd_soc_codec *codec = socdev->codec;
52840e0aa64SRichard Purdie 	int reg, ret = 0;
52940e0aa64SRichard Purdie 
53040e0aa64SRichard Purdie 	codec->name = "WM8731";
53140e0aa64SRichard Purdie 	codec->owner = THIS_MODULE;
53240e0aa64SRichard Purdie 	codec->read = wm8731_read_reg_cache;
53340e0aa64SRichard Purdie 	codec->write = wm8731_write;
5340be9898aSMark Brown 	codec->set_bias_level = wm8731_set_bias_level;
53540e0aa64SRichard Purdie 	codec->dai = &wm8731_dai;
53640e0aa64SRichard Purdie 	codec->num_dai = 1;
537*d751b233SMark Brown 	codec->reg_cache_size = ARRAY_SIZE(wm8731_reg);
53888cb4290STakashi Iwai 	codec->reg_cache = kmemdup(wm8731_reg, sizeof(wm8731_reg), GFP_KERNEL);
53940e0aa64SRichard Purdie 	if (codec->reg_cache == NULL)
54040e0aa64SRichard Purdie 		return -ENOMEM;
54140e0aa64SRichard Purdie 
54240e0aa64SRichard Purdie 	wm8731_reset(codec);
54340e0aa64SRichard Purdie 
54440e0aa64SRichard Purdie 	/* register pcms */
54540e0aa64SRichard Purdie 	ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
54640e0aa64SRichard Purdie 	if (ret < 0) {
547e35115a5SLiam Girdwood 		printk(KERN_ERR "wm8731: failed to create pcms\n");
548e35115a5SLiam Girdwood 		goto pcm_err;
54940e0aa64SRichard Purdie 	}
55040e0aa64SRichard Purdie 
55140e0aa64SRichard Purdie 	/* power on device */
5520be9898aSMark Brown 	wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
55340e0aa64SRichard Purdie 
55440e0aa64SRichard Purdie 	/* set the update bits */
55540e0aa64SRichard Purdie 	reg = wm8731_read_reg_cache(codec, WM8731_LOUT1V);
556389619f1SVille Syrjala 	wm8731_write(codec, WM8731_LOUT1V, reg & ~0x0100);
55740e0aa64SRichard Purdie 	reg = wm8731_read_reg_cache(codec, WM8731_ROUT1V);
558389619f1SVille Syrjala 	wm8731_write(codec, WM8731_ROUT1V, reg & ~0x0100);
55940e0aa64SRichard Purdie 	reg = wm8731_read_reg_cache(codec, WM8731_LINVOL);
560389619f1SVille Syrjala 	wm8731_write(codec, WM8731_LINVOL, reg & ~0x0100);
56140e0aa64SRichard Purdie 	reg = wm8731_read_reg_cache(codec, WM8731_RINVOL);
562389619f1SVille Syrjala 	wm8731_write(codec, WM8731_RINVOL, reg & ~0x0100);
56340e0aa64SRichard Purdie 
56440e0aa64SRichard Purdie 	wm8731_add_controls(codec);
56540e0aa64SRichard Purdie 	wm8731_add_widgets(codec);
56640e0aa64SRichard Purdie 	ret = snd_soc_register_card(socdev);
56740e0aa64SRichard Purdie 	if (ret < 0) {
568e35115a5SLiam Girdwood 		printk(KERN_ERR "wm8731: failed to register card\n");
569e35115a5SLiam Girdwood 		goto card_err;
57040e0aa64SRichard Purdie 	}
57140e0aa64SRichard Purdie 
57240e0aa64SRichard Purdie 	return ret;
573e35115a5SLiam Girdwood 
574e35115a5SLiam Girdwood card_err:
575e35115a5SLiam Girdwood 	snd_soc_free_pcms(socdev);
576e35115a5SLiam Girdwood 	snd_soc_dapm_free(socdev);
577e35115a5SLiam Girdwood pcm_err:
578e35115a5SLiam Girdwood 	kfree(codec->reg_cache);
579e35115a5SLiam Girdwood 	return ret;
58040e0aa64SRichard Purdie }
58140e0aa64SRichard Purdie 
58240e0aa64SRichard Purdie static struct snd_soc_device *wm8731_socdev;
58340e0aa64SRichard Purdie 
58440e0aa64SRichard Purdie #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
58540e0aa64SRichard Purdie 
58640e0aa64SRichard Purdie /*
58740e0aa64SRichard Purdie  * WM8731 2 wire address is determined by GPIO5
58840e0aa64SRichard Purdie  * state during powerup.
58940e0aa64SRichard Purdie  *    low  = 0x1a
59040e0aa64SRichard Purdie  *    high = 0x1b
59140e0aa64SRichard Purdie  */
59240e0aa64SRichard Purdie static unsigned short normal_i2c[] = { 0, I2C_CLIENT_END };
59340e0aa64SRichard Purdie 
59440e0aa64SRichard Purdie /* Magic definition of all other variables and things */
59540e0aa64SRichard Purdie I2C_CLIENT_INSMOD;
59640e0aa64SRichard Purdie 
59740e0aa64SRichard Purdie static struct i2c_driver wm8731_i2c_driver;
59840e0aa64SRichard Purdie static struct i2c_client client_template;
59940e0aa64SRichard Purdie 
60040e0aa64SRichard Purdie /* If the i2c layer weren't so broken, we could pass this kind of data
60140e0aa64SRichard Purdie    around */
60240e0aa64SRichard Purdie 
60340e0aa64SRichard Purdie static int wm8731_codec_probe(struct i2c_adapter *adap, int addr, int kind)
60440e0aa64SRichard Purdie {
60540e0aa64SRichard Purdie 	struct snd_soc_device *socdev = wm8731_socdev;
60640e0aa64SRichard Purdie 	struct wm8731_setup_data *setup = socdev->codec_data;
60740e0aa64SRichard Purdie 	struct snd_soc_codec *codec = socdev->codec;
60840e0aa64SRichard Purdie 	struct i2c_client *i2c;
60940e0aa64SRichard Purdie 	int ret;
61040e0aa64SRichard Purdie 
61140e0aa64SRichard Purdie 	if (addr != setup->i2c_address)
61240e0aa64SRichard Purdie 		return -ENODEV;
61340e0aa64SRichard Purdie 
61440e0aa64SRichard Purdie 	client_template.adapter = adap;
61540e0aa64SRichard Purdie 	client_template.addr = addr;
61640e0aa64SRichard Purdie 
61788cb4290STakashi Iwai 	i2c = kmemdup(&client_template, sizeof(client_template), GFP_KERNEL);
61840e0aa64SRichard Purdie 	if (i2c == NULL) {
61940e0aa64SRichard Purdie 		kfree(codec);
62040e0aa64SRichard Purdie 		return -ENOMEM;
62140e0aa64SRichard Purdie 	}
62240e0aa64SRichard Purdie 	i2c_set_clientdata(i2c, codec);
62340e0aa64SRichard Purdie 	codec->control_data = i2c;
62440e0aa64SRichard Purdie 
62540e0aa64SRichard Purdie 	ret = i2c_attach_client(i2c);
62640e0aa64SRichard Purdie 	if (ret < 0) {
62740e0aa64SRichard Purdie 		err("failed to attach codec at addr %x\n", addr);
62840e0aa64SRichard Purdie 		goto err;
62940e0aa64SRichard Purdie 	}
63040e0aa64SRichard Purdie 
63140e0aa64SRichard Purdie 	ret = wm8731_init(socdev);
63240e0aa64SRichard Purdie 	if (ret < 0) {
63340e0aa64SRichard Purdie 		err("failed to initialise WM8731\n");
63440e0aa64SRichard Purdie 		goto err;
63540e0aa64SRichard Purdie 	}
63640e0aa64SRichard Purdie 	return ret;
63740e0aa64SRichard Purdie 
63840e0aa64SRichard Purdie err:
63940e0aa64SRichard Purdie 	kfree(codec);
64040e0aa64SRichard Purdie 	kfree(i2c);
64140e0aa64SRichard Purdie 	return ret;
64240e0aa64SRichard Purdie }
64340e0aa64SRichard Purdie 
64440e0aa64SRichard Purdie static int wm8731_i2c_detach(struct i2c_client *client)
64540e0aa64SRichard Purdie {
64640e0aa64SRichard Purdie 	struct snd_soc_codec *codec = i2c_get_clientdata(client);
64740e0aa64SRichard Purdie 	i2c_detach_client(client);
64840e0aa64SRichard Purdie 	kfree(codec->reg_cache);
64940e0aa64SRichard Purdie 	kfree(client);
65040e0aa64SRichard Purdie 	return 0;
65140e0aa64SRichard Purdie }
65240e0aa64SRichard Purdie 
65340e0aa64SRichard Purdie static int wm8731_i2c_attach(struct i2c_adapter *adap)
65440e0aa64SRichard Purdie {
65540e0aa64SRichard Purdie 	return i2c_probe(adap, &addr_data, wm8731_codec_probe);
65640e0aa64SRichard Purdie }
65740e0aa64SRichard Purdie 
65840e0aa64SRichard Purdie /* corgi i2c codec control layer */
65940e0aa64SRichard Purdie static struct i2c_driver wm8731_i2c_driver = {
66040e0aa64SRichard Purdie 	.driver = {
66140e0aa64SRichard Purdie 		.name = "WM8731 I2C Codec",
66240e0aa64SRichard Purdie 		.owner = THIS_MODULE,
66340e0aa64SRichard Purdie 	},
66440e0aa64SRichard Purdie 	.id =             I2C_DRIVERID_WM8731,
66540e0aa64SRichard Purdie 	.attach_adapter = wm8731_i2c_attach,
66640e0aa64SRichard Purdie 	.detach_client =  wm8731_i2c_detach,
66740e0aa64SRichard Purdie 	.command =        NULL,
66840e0aa64SRichard Purdie };
66940e0aa64SRichard Purdie 
67040e0aa64SRichard Purdie static struct i2c_client client_template = {
67140e0aa64SRichard Purdie 	.name =   "WM8731",
67240e0aa64SRichard Purdie 	.driver = &wm8731_i2c_driver,
67340e0aa64SRichard Purdie };
67440e0aa64SRichard Purdie #endif
67540e0aa64SRichard Purdie 
67640e0aa64SRichard Purdie static int wm8731_probe(struct platform_device *pdev)
67740e0aa64SRichard Purdie {
67840e0aa64SRichard Purdie 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
67940e0aa64SRichard Purdie 	struct wm8731_setup_data *setup;
68040e0aa64SRichard Purdie 	struct snd_soc_codec *codec;
681b36d61d4SFrank Mandarino 	struct wm8731_priv *wm8731;
68240e0aa64SRichard Purdie 	int ret = 0;
68340e0aa64SRichard Purdie 
68440e0aa64SRichard Purdie 	info("WM8731 Audio Codec %s", WM8731_VERSION);
68540e0aa64SRichard Purdie 
68640e0aa64SRichard Purdie 	setup = socdev->codec_data;
68740e0aa64SRichard Purdie 	codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
68840e0aa64SRichard Purdie 	if (codec == NULL)
68940e0aa64SRichard Purdie 		return -ENOMEM;
69040e0aa64SRichard Purdie 
691b36d61d4SFrank Mandarino 	wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL);
692b36d61d4SFrank Mandarino 	if (wm8731 == NULL) {
693b36d61d4SFrank Mandarino 		kfree(codec);
694b36d61d4SFrank Mandarino 		return -ENOMEM;
695b36d61d4SFrank Mandarino 	}
696b36d61d4SFrank Mandarino 
697b36d61d4SFrank Mandarino 	codec->private_data = wm8731;
69840e0aa64SRichard Purdie 	socdev->codec = codec;
69940e0aa64SRichard Purdie 	mutex_init(&codec->mutex);
70040e0aa64SRichard Purdie 	INIT_LIST_HEAD(&codec->dapm_widgets);
70140e0aa64SRichard Purdie 	INIT_LIST_HEAD(&codec->dapm_paths);
70240e0aa64SRichard Purdie 
70340e0aa64SRichard Purdie 	wm8731_socdev = socdev;
70440e0aa64SRichard Purdie #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
70540e0aa64SRichard Purdie 	if (setup->i2c_address) {
70640e0aa64SRichard Purdie 		normal_i2c[0] = setup->i2c_address;
70740e0aa64SRichard Purdie 		codec->hw_write = (hw_write_t)i2c_master_send;
70840e0aa64SRichard Purdie 		ret = i2c_add_driver(&wm8731_i2c_driver);
70940e0aa64SRichard Purdie 		if (ret != 0)
71040e0aa64SRichard Purdie 			printk(KERN_ERR "can't add i2c driver");
71140e0aa64SRichard Purdie 	}
71240e0aa64SRichard Purdie #else
71340e0aa64SRichard Purdie 	/* Add other interfaces here */
71440e0aa64SRichard Purdie #endif
71540e0aa64SRichard Purdie 	return ret;
71640e0aa64SRichard Purdie }
71740e0aa64SRichard Purdie 
71840e0aa64SRichard Purdie /* power down chip */
71940e0aa64SRichard Purdie static int wm8731_remove(struct platform_device *pdev)
72040e0aa64SRichard Purdie {
72140e0aa64SRichard Purdie 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
72240e0aa64SRichard Purdie 	struct snd_soc_codec *codec = socdev->codec;
72340e0aa64SRichard Purdie 
72440e0aa64SRichard Purdie 	if (codec->control_data)
7250be9898aSMark Brown 		wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF);
72640e0aa64SRichard Purdie 
72740e0aa64SRichard Purdie 	snd_soc_free_pcms(socdev);
72840e0aa64SRichard Purdie 	snd_soc_dapm_free(socdev);
72940e0aa64SRichard Purdie #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
73040e0aa64SRichard Purdie 	i2c_del_driver(&wm8731_i2c_driver);
73140e0aa64SRichard Purdie #endif
732b36d61d4SFrank Mandarino 	kfree(codec->private_data);
73340e0aa64SRichard Purdie 	kfree(codec);
73440e0aa64SRichard Purdie 
73540e0aa64SRichard Purdie 	return 0;
73640e0aa64SRichard Purdie }
73740e0aa64SRichard Purdie 
73840e0aa64SRichard Purdie struct snd_soc_codec_device soc_codec_dev_wm8731 = {
73940e0aa64SRichard Purdie 	.probe = 	wm8731_probe,
74040e0aa64SRichard Purdie 	.remove = 	wm8731_remove,
74140e0aa64SRichard Purdie 	.suspend = 	wm8731_suspend,
74240e0aa64SRichard Purdie 	.resume =	wm8731_resume,
74340e0aa64SRichard Purdie };
74440e0aa64SRichard Purdie EXPORT_SYMBOL_GPL(soc_codec_dev_wm8731);
74540e0aa64SRichard Purdie 
74640e0aa64SRichard Purdie MODULE_DESCRIPTION("ASoC WM8731 driver");
74740e0aa64SRichard Purdie MODULE_AUTHOR("Richard Purdie");
74840e0aa64SRichard Purdie MODULE_LICENSE("GPL");
749