xref: /linux/sound/soc/codecs/wm8731.c (revision 93b760b7072ca6972c15c798e97af3f830d8bbba)
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>
22d2a40355SCliff Cai #include <linux/spi/spi.h>
2340e0aa64SRichard Purdie #include <sound/core.h>
2440e0aa64SRichard Purdie #include <sound/pcm.h>
2540e0aa64SRichard Purdie #include <sound/pcm_params.h>
2640e0aa64SRichard Purdie #include <sound/soc.h>
2740e0aa64SRichard Purdie #include <sound/soc-dapm.h>
2840e0aa64SRichard Purdie #include <sound/initval.h>
2940e0aa64SRichard Purdie 
3040e0aa64SRichard Purdie #include "wm8731.h"
3140e0aa64SRichard Purdie 
325998102bSMark Brown static struct snd_soc_codec *wm8731_codec;
3340e0aa64SRichard Purdie struct snd_soc_codec_device soc_codec_dev_wm8731;
3440e0aa64SRichard Purdie 
35b36d61d4SFrank Mandarino /* codec private data */
36b36d61d4SFrank Mandarino struct wm8731_priv {
375998102bSMark Brown 	struct snd_soc_codec codec;
385998102bSMark Brown 	u16 reg_cache[WM8731_CACHEREGNUM];
39b36d61d4SFrank Mandarino 	unsigned int sysclk;
40b36d61d4SFrank Mandarino };
41b36d61d4SFrank Mandarino 
42a8035c8fSMark Brown #ifdef CONFIG_SPI_MASTER
43a8035c8fSMark Brown static int wm8731_spi_write(struct spi_device *spi, const char *data, int len);
44a8035c8fSMark Brown #endif
45a8035c8fSMark Brown 
4640e0aa64SRichard Purdie /*
4740e0aa64SRichard Purdie  * wm8731 register cache
4840e0aa64SRichard Purdie  * We can't read the WM8731 register space when we are
4940e0aa64SRichard Purdie  * using 2 wire for device control, so we cache them instead.
5040e0aa64SRichard Purdie  * There is no point in caching the reset register
5140e0aa64SRichard Purdie  */
5240e0aa64SRichard Purdie static const u16 wm8731_reg[WM8731_CACHEREGNUM] = {
5340e0aa64SRichard Purdie     0x0097, 0x0097, 0x0079, 0x0079,
5440e0aa64SRichard Purdie     0x000a, 0x0008, 0x009f, 0x000a,
5540e0aa64SRichard Purdie     0x0000, 0x0000
5640e0aa64SRichard Purdie };
5740e0aa64SRichard Purdie 
5840e0aa64SRichard Purdie /*
5940e0aa64SRichard Purdie  * read wm8731 register cache
6040e0aa64SRichard Purdie  */
6140e0aa64SRichard Purdie static inline unsigned int wm8731_read_reg_cache(struct snd_soc_codec *codec,
6240e0aa64SRichard Purdie 	unsigned int reg)
6340e0aa64SRichard Purdie {
6440e0aa64SRichard Purdie 	u16 *cache = codec->reg_cache;
6540e0aa64SRichard Purdie 	if (reg == WM8731_RESET)
6640e0aa64SRichard Purdie 		return 0;
6740e0aa64SRichard Purdie 	if (reg >= WM8731_CACHEREGNUM)
6840e0aa64SRichard Purdie 		return -1;
6940e0aa64SRichard Purdie 	return cache[reg];
7040e0aa64SRichard Purdie }
7140e0aa64SRichard Purdie 
7240e0aa64SRichard Purdie /*
7340e0aa64SRichard Purdie  * write wm8731 register cache
7440e0aa64SRichard Purdie  */
7540e0aa64SRichard Purdie static inline void wm8731_write_reg_cache(struct snd_soc_codec *codec,
7640e0aa64SRichard Purdie 	u16 reg, unsigned int value)
7740e0aa64SRichard Purdie {
7840e0aa64SRichard Purdie 	u16 *cache = codec->reg_cache;
7940e0aa64SRichard Purdie 	if (reg >= WM8731_CACHEREGNUM)
8040e0aa64SRichard Purdie 		return;
8140e0aa64SRichard Purdie 	cache[reg] = value;
8240e0aa64SRichard Purdie }
8340e0aa64SRichard Purdie 
8440e0aa64SRichard Purdie /*
8540e0aa64SRichard Purdie  * write to the WM8731 register space
8640e0aa64SRichard Purdie  */
8740e0aa64SRichard Purdie static int wm8731_write(struct snd_soc_codec *codec, unsigned int reg,
8840e0aa64SRichard Purdie 	unsigned int value)
8940e0aa64SRichard Purdie {
9040e0aa64SRichard Purdie 	u8 data[2];
9140e0aa64SRichard Purdie 
9240e0aa64SRichard Purdie 	/* data is
9340e0aa64SRichard Purdie 	 *   D15..D9 WM8731 register offset
9440e0aa64SRichard Purdie 	 *   D8...D0 register data
9540e0aa64SRichard Purdie 	 */
9640e0aa64SRichard Purdie 	data[0] = (reg << 1) | ((value >> 8) & 0x0001);
9740e0aa64SRichard Purdie 	data[1] = value & 0x00ff;
9840e0aa64SRichard Purdie 
9940e0aa64SRichard Purdie 	wm8731_write_reg_cache(codec, reg, value);
10040e0aa64SRichard Purdie 	if (codec->hw_write(codec->control_data, data, 2) == 2)
10140e0aa64SRichard Purdie 		return 0;
10240e0aa64SRichard Purdie 	else
10340e0aa64SRichard Purdie 		return -EIO;
10440e0aa64SRichard Purdie }
10540e0aa64SRichard Purdie 
10640e0aa64SRichard Purdie #define wm8731_reset(c)	wm8731_write(c, WM8731_RESET, 0)
10740e0aa64SRichard Purdie 
10840e0aa64SRichard Purdie static const char *wm8731_input_select[] = {"Line In", "Mic"};
10940e0aa64SRichard Purdie static const char *wm8731_deemph[] = {"None", "32Khz", "44.1Khz", "48Khz"};
11040e0aa64SRichard Purdie 
11140e0aa64SRichard Purdie static const struct soc_enum wm8731_enum[] = {
11240e0aa64SRichard Purdie 	SOC_ENUM_SINGLE(WM8731_APANA, 2, 2, wm8731_input_select),
11340e0aa64SRichard Purdie 	SOC_ENUM_SINGLE(WM8731_APDIGI, 1, 4, wm8731_deemph),
11440e0aa64SRichard Purdie };
11540e0aa64SRichard Purdie 
11640e0aa64SRichard Purdie static const struct snd_kcontrol_new wm8731_snd_controls[] = {
11740e0aa64SRichard Purdie 
118bd903b6eSLiam Girdwood SOC_DOUBLE_R("Master Playback Volume", WM8731_LOUT1V, WM8731_ROUT1V,
119bd903b6eSLiam Girdwood 	0, 127, 0),
120bd903b6eSLiam Girdwood SOC_DOUBLE_R("Master Playback ZC Switch", WM8731_LOUT1V, WM8731_ROUT1V,
121bd903b6eSLiam Girdwood 	7, 1, 0),
12240e0aa64SRichard Purdie 
12340e0aa64SRichard Purdie SOC_DOUBLE_R("Capture Volume", WM8731_LINVOL, WM8731_RINVOL, 0, 31, 0),
12440e0aa64SRichard Purdie SOC_DOUBLE_R("Line Capture Switch", WM8731_LINVOL, WM8731_RINVOL, 7, 1, 1),
12540e0aa64SRichard Purdie 
12640e0aa64SRichard Purdie SOC_SINGLE("Mic Boost (+20dB)", WM8731_APANA, 0, 1, 0),
12740e0aa64SRichard Purdie SOC_SINGLE("Capture Mic Switch", WM8731_APANA, 1, 1, 1),
12840e0aa64SRichard Purdie 
12940e0aa64SRichard Purdie SOC_SINGLE("Sidetone Playback Volume", WM8731_APANA, 6, 3, 1),
13040e0aa64SRichard Purdie 
13140e0aa64SRichard Purdie SOC_SINGLE("ADC High Pass Filter Switch", WM8731_APDIGI, 0, 1, 1),
13240e0aa64SRichard Purdie SOC_SINGLE("Store DC Offset Switch", WM8731_APDIGI, 4, 1, 0),
13340e0aa64SRichard Purdie 
13440e0aa64SRichard Purdie SOC_ENUM("Playback De-emphasis", wm8731_enum[1]),
13540e0aa64SRichard Purdie };
13640e0aa64SRichard Purdie 
13740e0aa64SRichard Purdie /* Output Mixer */
13840e0aa64SRichard Purdie static const struct snd_kcontrol_new wm8731_output_mixer_controls[] = {
13940e0aa64SRichard Purdie SOC_DAPM_SINGLE("Line Bypass Switch", WM8731_APANA, 3, 1, 0),
14040e0aa64SRichard Purdie SOC_DAPM_SINGLE("Mic Sidetone Switch", WM8731_APANA, 5, 1, 0),
14140e0aa64SRichard Purdie SOC_DAPM_SINGLE("HiFi Playback Switch", WM8731_APANA, 4, 1, 0),
14240e0aa64SRichard Purdie };
14340e0aa64SRichard Purdie 
14440e0aa64SRichard Purdie /* Input mux */
14540e0aa64SRichard Purdie static const struct snd_kcontrol_new wm8731_input_mux_controls =
14640e0aa64SRichard Purdie SOC_DAPM_ENUM("Input Select", wm8731_enum[0]);
14740e0aa64SRichard Purdie 
14840e0aa64SRichard Purdie static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
14940e0aa64SRichard Purdie SND_SOC_DAPM_MIXER("Output Mixer", WM8731_PWR, 4, 1,
15040e0aa64SRichard Purdie 	&wm8731_output_mixer_controls[0],
15140e0aa64SRichard Purdie 	ARRAY_SIZE(wm8731_output_mixer_controls)),
15240e0aa64SRichard Purdie SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8731_PWR, 3, 1),
15340e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("LOUT"),
15440e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("LHPOUT"),
15540e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("ROUT"),
15640e0aa64SRichard Purdie SND_SOC_DAPM_OUTPUT("RHPOUT"),
15740e0aa64SRichard Purdie SND_SOC_DAPM_ADC("ADC", "HiFi Capture", WM8731_PWR, 2, 1),
15840e0aa64SRichard Purdie SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0, &wm8731_input_mux_controls),
15940e0aa64SRichard Purdie SND_SOC_DAPM_PGA("Line Input", WM8731_PWR, 0, 1, NULL, 0),
16040e0aa64SRichard Purdie SND_SOC_DAPM_MICBIAS("Mic Bias", WM8731_PWR, 1, 1),
16140e0aa64SRichard Purdie SND_SOC_DAPM_INPUT("MICIN"),
16240e0aa64SRichard Purdie SND_SOC_DAPM_INPUT("RLINEIN"),
16340e0aa64SRichard Purdie SND_SOC_DAPM_INPUT("LLINEIN"),
16440e0aa64SRichard Purdie };
16540e0aa64SRichard Purdie 
166a65f0568SMark Brown static const struct snd_soc_dapm_route intercon[] = {
16740e0aa64SRichard Purdie 	/* output mixer */
16840e0aa64SRichard Purdie 	{"Output Mixer", "Line Bypass Switch", "Line Input"},
16940e0aa64SRichard Purdie 	{"Output Mixer", "HiFi Playback Switch", "DAC"},
17040e0aa64SRichard Purdie 	{"Output Mixer", "Mic Sidetone Switch", "Mic Bias"},
17140e0aa64SRichard Purdie 
17240e0aa64SRichard Purdie 	/* outputs */
17340e0aa64SRichard Purdie 	{"RHPOUT", NULL, "Output Mixer"},
17440e0aa64SRichard Purdie 	{"ROUT", NULL, "Output Mixer"},
17540e0aa64SRichard Purdie 	{"LHPOUT", NULL, "Output Mixer"},
17640e0aa64SRichard Purdie 	{"LOUT", NULL, "Output Mixer"},
17740e0aa64SRichard Purdie 
17840e0aa64SRichard Purdie 	/* input mux */
17940e0aa64SRichard Purdie 	{"Input Mux", "Line In", "Line Input"},
18040e0aa64SRichard Purdie 	{"Input Mux", "Mic", "Mic Bias"},
18140e0aa64SRichard Purdie 	{"ADC", NULL, "Input Mux"},
18240e0aa64SRichard Purdie 
18340e0aa64SRichard Purdie 	/* inputs */
18440e0aa64SRichard Purdie 	{"Line Input", NULL, "LLINEIN"},
18540e0aa64SRichard Purdie 	{"Line Input", NULL, "RLINEIN"},
18640e0aa64SRichard Purdie 	{"Mic Bias", NULL, "MICIN"},
18740e0aa64SRichard Purdie };
18840e0aa64SRichard Purdie 
18940e0aa64SRichard Purdie static int wm8731_add_widgets(struct snd_soc_codec *codec)
19040e0aa64SRichard Purdie {
191a65f0568SMark Brown 	snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets,
192a65f0568SMark Brown 				  ARRAY_SIZE(wm8731_dapm_widgets));
19340e0aa64SRichard Purdie 
194a65f0568SMark Brown 	snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
19540e0aa64SRichard Purdie 
19640e0aa64SRichard Purdie 	snd_soc_dapm_new_widgets(codec);
19740e0aa64SRichard Purdie 	return 0;
19840e0aa64SRichard Purdie }
19940e0aa64SRichard Purdie 
20040e0aa64SRichard Purdie struct _coeff_div {
20140e0aa64SRichard Purdie 	u32 mclk;
20240e0aa64SRichard Purdie 	u32 rate;
20340e0aa64SRichard Purdie 	u16 fs;
20440e0aa64SRichard Purdie 	u8 sr:4;
20540e0aa64SRichard Purdie 	u8 bosr:1;
20640e0aa64SRichard Purdie 	u8 usb:1;
20740e0aa64SRichard Purdie };
20840e0aa64SRichard Purdie 
20940e0aa64SRichard Purdie /* codec mclk clock divider coefficients */
21040e0aa64SRichard Purdie static const struct _coeff_div coeff_div[] = {
21140e0aa64SRichard Purdie 	/* 48k */
21240e0aa64SRichard Purdie 	{12288000, 48000, 256, 0x0, 0x0, 0x0},
21340e0aa64SRichard Purdie 	{18432000, 48000, 384, 0x0, 0x1, 0x0},
21440e0aa64SRichard Purdie 	{12000000, 48000, 250, 0x0, 0x0, 0x1},
21540e0aa64SRichard Purdie 
21640e0aa64SRichard Purdie 	/* 32k */
21740e0aa64SRichard Purdie 	{12288000, 32000, 384, 0x6, 0x0, 0x0},
21840e0aa64SRichard Purdie 	{18432000, 32000, 576, 0x6, 0x1, 0x0},
219298a2c75SFrank Mandarino 	{12000000, 32000, 375, 0x6, 0x0, 0x1},
22040e0aa64SRichard Purdie 
22140e0aa64SRichard Purdie 	/* 8k */
22240e0aa64SRichard Purdie 	{12288000, 8000, 1536, 0x3, 0x0, 0x0},
22340e0aa64SRichard Purdie 	{18432000, 8000, 2304, 0x3, 0x1, 0x0},
22440e0aa64SRichard Purdie 	{11289600, 8000, 1408, 0xb, 0x0, 0x0},
22540e0aa64SRichard Purdie 	{16934400, 8000, 2112, 0xb, 0x1, 0x0},
22640e0aa64SRichard Purdie 	{12000000, 8000, 1500, 0x3, 0x0, 0x1},
22740e0aa64SRichard Purdie 
22840e0aa64SRichard Purdie 	/* 96k */
22940e0aa64SRichard Purdie 	{12288000, 96000, 128, 0x7, 0x0, 0x0},
23040e0aa64SRichard Purdie 	{18432000, 96000, 192, 0x7, 0x1, 0x0},
23140e0aa64SRichard Purdie 	{12000000, 96000, 125, 0x7, 0x0, 0x1},
23240e0aa64SRichard Purdie 
23340e0aa64SRichard Purdie 	/* 44.1k */
23440e0aa64SRichard Purdie 	{11289600, 44100, 256, 0x8, 0x0, 0x0},
23540e0aa64SRichard Purdie 	{16934400, 44100, 384, 0x8, 0x1, 0x0},
23640e0aa64SRichard Purdie 	{12000000, 44100, 272, 0x8, 0x1, 0x1},
23740e0aa64SRichard Purdie 
23840e0aa64SRichard Purdie 	/* 88.2k */
23940e0aa64SRichard Purdie 	{11289600, 88200, 128, 0xf, 0x0, 0x0},
24040e0aa64SRichard Purdie 	{16934400, 88200, 192, 0xf, 0x1, 0x0},
24140e0aa64SRichard Purdie 	{12000000, 88200, 136, 0xf, 0x1, 0x1},
24240e0aa64SRichard Purdie };
24340e0aa64SRichard Purdie 
24440e0aa64SRichard Purdie static inline int get_coeff(int mclk, int rate)
24540e0aa64SRichard Purdie {
24640e0aa64SRichard Purdie 	int i;
24740e0aa64SRichard Purdie 
24840e0aa64SRichard Purdie 	for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
24940e0aa64SRichard Purdie 		if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
25040e0aa64SRichard Purdie 			return i;
25140e0aa64SRichard Purdie 	}
25240e0aa64SRichard Purdie 	return 0;
25340e0aa64SRichard Purdie }
25440e0aa64SRichard Purdie 
255b36d61d4SFrank Mandarino static int wm8731_hw_params(struct snd_pcm_substream *substream,
256dee89c4dSMark Brown 			    struct snd_pcm_hw_params *params,
257dee89c4dSMark Brown 			    struct snd_soc_dai *dai)
25840e0aa64SRichard Purdie {
259b36d61d4SFrank Mandarino 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
260b36d61d4SFrank Mandarino 	struct snd_soc_device *socdev = rtd->socdev;
2616627a653SMark Brown 	struct snd_soc_codec *codec = socdev->card->codec;
262b36d61d4SFrank Mandarino 	struct wm8731_priv *wm8731 = codec->private_data;
263b36d61d4SFrank Mandarino 	u16 iface = wm8731_read_reg_cache(codec, WM8731_IFACE) & 0xfff3;
264b36d61d4SFrank Mandarino 	int i = get_coeff(wm8731->sysclk, params_rate(params));
265b36d61d4SFrank Mandarino 	u16 srate = (coeff_div[i].sr << 2) |
266b36d61d4SFrank Mandarino 		(coeff_div[i].bosr << 1) | coeff_div[i].usb;
26740e0aa64SRichard Purdie 
268b36d61d4SFrank Mandarino 	wm8731_write(codec, WM8731_SRATE, srate);
26940e0aa64SRichard Purdie 
270b36d61d4SFrank Mandarino 	/* bit size */
271b36d61d4SFrank Mandarino 	switch (params_format(params)) {
272b36d61d4SFrank Mandarino 	case SNDRV_PCM_FORMAT_S16_LE:
273b36d61d4SFrank Mandarino 		break;
274b36d61d4SFrank Mandarino 	case SNDRV_PCM_FORMAT_S20_3LE:
275b36d61d4SFrank Mandarino 		iface |= 0x0004;
276b36d61d4SFrank Mandarino 		break;
277b36d61d4SFrank Mandarino 	case SNDRV_PCM_FORMAT_S24_LE:
278b36d61d4SFrank Mandarino 		iface |= 0x0008;
279b36d61d4SFrank Mandarino 		break;
280b36d61d4SFrank Mandarino 	}
281b36d61d4SFrank Mandarino 
282b36d61d4SFrank Mandarino 	wm8731_write(codec, WM8731_IFACE, iface);
283b36d61d4SFrank Mandarino 	return 0;
28440e0aa64SRichard Purdie }
28540e0aa64SRichard Purdie 
286dee89c4dSMark Brown static int wm8731_pcm_prepare(struct snd_pcm_substream *substream,
287dee89c4dSMark Brown 			      struct snd_soc_dai *dai)
28840e0aa64SRichard Purdie {
28940e0aa64SRichard Purdie 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
29040e0aa64SRichard Purdie 	struct snd_soc_device *socdev = rtd->socdev;
2916627a653SMark Brown 	struct snd_soc_codec *codec = socdev->card->codec;
29240e0aa64SRichard Purdie 
29340e0aa64SRichard Purdie 	/* set active */
29440e0aa64SRichard Purdie 	wm8731_write(codec, WM8731_ACTIVE, 0x0001);
295b36d61d4SFrank Mandarino 
29640e0aa64SRichard Purdie 	return 0;
29740e0aa64SRichard Purdie }
29840e0aa64SRichard Purdie 
299dee89c4dSMark Brown static void wm8731_shutdown(struct snd_pcm_substream *substream,
300dee89c4dSMark Brown 			    struct snd_soc_dai *dai)
30140e0aa64SRichard Purdie {
30240e0aa64SRichard Purdie 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
30340e0aa64SRichard Purdie 	struct snd_soc_device *socdev = rtd->socdev;
3046627a653SMark Brown 	struct snd_soc_codec *codec = socdev->card->codec;
30540e0aa64SRichard Purdie 
30640e0aa64SRichard Purdie 	/* deactivate */
30740e0aa64SRichard Purdie 	if (!codec->active) {
30840e0aa64SRichard Purdie 		udelay(50);
30940e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_ACTIVE, 0x0);
31040e0aa64SRichard Purdie 	}
31140e0aa64SRichard Purdie }
31240e0aa64SRichard Purdie 
313e550e17fSLiam Girdwood static int wm8731_mute(struct snd_soc_dai *dai, int mute)
31440e0aa64SRichard Purdie {
315b36d61d4SFrank Mandarino 	struct snd_soc_codec *codec = dai->codec;
31640e0aa64SRichard Purdie 	u16 mute_reg = wm8731_read_reg_cache(codec, WM8731_APDIGI) & 0xfff7;
317b36d61d4SFrank Mandarino 
31840e0aa64SRichard Purdie 	if (mute)
31940e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_APDIGI, mute_reg | 0x8);
32040e0aa64SRichard Purdie 	else
32140e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_APDIGI, mute_reg);
32240e0aa64SRichard Purdie 	return 0;
32340e0aa64SRichard Purdie }
32440e0aa64SRichard Purdie 
325e550e17fSLiam Girdwood static int wm8731_set_dai_sysclk(struct snd_soc_dai *codec_dai,
326b36d61d4SFrank Mandarino 		int clk_id, unsigned int freq, int dir)
327b36d61d4SFrank Mandarino {
328b36d61d4SFrank Mandarino 	struct snd_soc_codec *codec = codec_dai->codec;
329b36d61d4SFrank Mandarino 	struct wm8731_priv *wm8731 = codec->private_data;
330b36d61d4SFrank Mandarino 
331b36d61d4SFrank Mandarino 	switch (freq) {
332b36d61d4SFrank Mandarino 	case 11289600:
333b36d61d4SFrank Mandarino 	case 12000000:
334b36d61d4SFrank Mandarino 	case 12288000:
335b36d61d4SFrank Mandarino 	case 16934400:
336b36d61d4SFrank Mandarino 	case 18432000:
337b36d61d4SFrank Mandarino 		wm8731->sysclk = freq;
338b36d61d4SFrank Mandarino 		return 0;
339b36d61d4SFrank Mandarino 	}
340b36d61d4SFrank Mandarino 	return -EINVAL;
341b36d61d4SFrank Mandarino }
342b36d61d4SFrank Mandarino 
343b36d61d4SFrank Mandarino 
344e550e17fSLiam Girdwood static int wm8731_set_dai_fmt(struct snd_soc_dai *codec_dai,
345b36d61d4SFrank Mandarino 		unsigned int fmt)
346b36d61d4SFrank Mandarino {
347b36d61d4SFrank Mandarino 	struct snd_soc_codec *codec = codec_dai->codec;
348b36d61d4SFrank Mandarino 	u16 iface = 0;
349b36d61d4SFrank Mandarino 
350b36d61d4SFrank Mandarino 	/* set master/slave audio interface */
351b36d61d4SFrank Mandarino 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
352b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_CBM_CFM:
353b36d61d4SFrank Mandarino 		iface |= 0x0040;
354b36d61d4SFrank Mandarino 		break;
355b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_CBS_CFS:
356b36d61d4SFrank Mandarino 		break;
357b36d61d4SFrank Mandarino 	default:
358b36d61d4SFrank Mandarino 		return -EINVAL;
359b36d61d4SFrank Mandarino 	}
360b36d61d4SFrank Mandarino 
361b36d61d4SFrank Mandarino 	/* interface format */
362b36d61d4SFrank Mandarino 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
363b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_I2S:
364b36d61d4SFrank Mandarino 		iface |= 0x0002;
365b36d61d4SFrank Mandarino 		break;
366b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_RIGHT_J:
367b36d61d4SFrank Mandarino 		break;
368b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_LEFT_J:
369b36d61d4SFrank Mandarino 		iface |= 0x0001;
370b36d61d4SFrank Mandarino 		break;
371b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_DSP_A:
372b36d61d4SFrank Mandarino 		iface |= 0x0003;
373b36d61d4SFrank Mandarino 		break;
374b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_DSP_B:
375b36d61d4SFrank Mandarino 		iface |= 0x0013;
376b36d61d4SFrank Mandarino 		break;
377b36d61d4SFrank Mandarino 	default:
378b36d61d4SFrank Mandarino 		return -EINVAL;
379b36d61d4SFrank Mandarino 	}
380b36d61d4SFrank Mandarino 
381b36d61d4SFrank Mandarino 	/* clock inversion */
382b36d61d4SFrank Mandarino 	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
383b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_NB_NF:
384b36d61d4SFrank Mandarino 		break;
385b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_IB_IF:
386b36d61d4SFrank Mandarino 		iface |= 0x0090;
387b36d61d4SFrank Mandarino 		break;
388b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_IB_NF:
389b36d61d4SFrank Mandarino 		iface |= 0x0080;
390b36d61d4SFrank Mandarino 		break;
391b36d61d4SFrank Mandarino 	case SND_SOC_DAIFMT_NB_IF:
392b36d61d4SFrank Mandarino 		iface |= 0x0010;
393b36d61d4SFrank Mandarino 		break;
394b36d61d4SFrank Mandarino 	default:
395b36d61d4SFrank Mandarino 		return -EINVAL;
396b36d61d4SFrank Mandarino 	}
397b36d61d4SFrank Mandarino 
398b36d61d4SFrank Mandarino 	/* set iface */
399b36d61d4SFrank Mandarino 	wm8731_write(codec, WM8731_IFACE, iface);
400b36d61d4SFrank Mandarino 	return 0;
401b36d61d4SFrank Mandarino }
402b36d61d4SFrank Mandarino 
4030be9898aSMark Brown static int wm8731_set_bias_level(struct snd_soc_codec *codec,
4040be9898aSMark Brown 				 enum snd_soc_bias_level level)
40540e0aa64SRichard Purdie {
40622d22ee5SMark Brown 	u16 reg;
40740e0aa64SRichard Purdie 
4080be9898aSMark Brown 	switch (level) {
4090be9898aSMark Brown 	case SND_SOC_BIAS_ON:
41040e0aa64SRichard Purdie 		break;
4110be9898aSMark Brown 	case SND_SOC_BIAS_PREPARE:
41240e0aa64SRichard Purdie 		break;
4130be9898aSMark Brown 	case SND_SOC_BIAS_STANDBY:
41422d22ee5SMark Brown 		/* Clear PWROFF, gate CLKOUT, everything else as-is */
41522d22ee5SMark Brown 		reg = wm8731_read_reg_cache(codec, WM8731_PWR) & 0xff7f;
41640e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_PWR, reg | 0x0040);
41740e0aa64SRichard Purdie 		break;
4180be9898aSMark Brown 	case SND_SOC_BIAS_OFF:
41940e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_ACTIVE, 0x0);
42040e0aa64SRichard Purdie 		wm8731_write(codec, WM8731_PWR, 0xffff);
42140e0aa64SRichard Purdie 		break;
42240e0aa64SRichard Purdie 	}
4230be9898aSMark Brown 	codec->bias_level = level;
42440e0aa64SRichard Purdie 	return 0;
42540e0aa64SRichard Purdie }
42640e0aa64SRichard Purdie 
427b36d61d4SFrank Mandarino #define WM8731_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
428b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
429b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |\
430b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |\
431b36d61d4SFrank Mandarino 		SNDRV_PCM_RATE_96000)
432b36d61d4SFrank Mandarino 
433b36d61d4SFrank Mandarino #define WM8731_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
434b36d61d4SFrank Mandarino 	SNDRV_PCM_FMTBIT_S24_LE)
435b36d61d4SFrank Mandarino 
436e550e17fSLiam Girdwood struct snd_soc_dai wm8731_dai = {
43740e0aa64SRichard Purdie 	.name = "WM8731",
43840e0aa64SRichard Purdie 	.playback = {
43940e0aa64SRichard Purdie 		.stream_name = "Playback",
44040e0aa64SRichard Purdie 		.channels_min = 1,
44140e0aa64SRichard Purdie 		.channels_max = 2,
442b36d61d4SFrank Mandarino 		.rates = WM8731_RATES,
443b36d61d4SFrank Mandarino 		.formats = WM8731_FORMATS,},
44440e0aa64SRichard Purdie 	.capture = {
44540e0aa64SRichard Purdie 		.stream_name = "Capture",
44640e0aa64SRichard Purdie 		.channels_min = 1,
44740e0aa64SRichard Purdie 		.channels_max = 2,
448b36d61d4SFrank Mandarino 		.rates = WM8731_RATES,
449b36d61d4SFrank Mandarino 		.formats = WM8731_FORMATS,},
45040e0aa64SRichard Purdie 	.ops = {
45140e0aa64SRichard Purdie 		.prepare = wm8731_pcm_prepare,
452b36d61d4SFrank Mandarino 		.hw_params = wm8731_hw_params,
45340e0aa64SRichard Purdie 		.shutdown = wm8731_shutdown,
454b36d61d4SFrank Mandarino 		.digital_mute = wm8731_mute,
455b36d61d4SFrank Mandarino 		.set_sysclk = wm8731_set_dai_sysclk,
456b36d61d4SFrank Mandarino 		.set_fmt = wm8731_set_dai_fmt,
457b36d61d4SFrank Mandarino 	}
45840e0aa64SRichard Purdie };
45940e0aa64SRichard Purdie EXPORT_SYMBOL_GPL(wm8731_dai);
46040e0aa64SRichard Purdie 
46140e0aa64SRichard Purdie static int wm8731_suspend(struct platform_device *pdev, pm_message_t state)
46240e0aa64SRichard Purdie {
46340e0aa64SRichard Purdie 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
4646627a653SMark Brown 	struct snd_soc_codec *codec = socdev->card->codec;
46540e0aa64SRichard Purdie 
46640e0aa64SRichard Purdie 	wm8731_write(codec, WM8731_ACTIVE, 0x0);
4670be9898aSMark Brown 	wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF);
46840e0aa64SRichard Purdie 	return 0;
46940e0aa64SRichard Purdie }
47040e0aa64SRichard Purdie 
47140e0aa64SRichard Purdie static int wm8731_resume(struct platform_device *pdev)
47240e0aa64SRichard Purdie {
47340e0aa64SRichard Purdie 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
4746627a653SMark Brown 	struct snd_soc_codec *codec = socdev->card->codec;
47540e0aa64SRichard Purdie 	int i;
47640e0aa64SRichard Purdie 	u8 data[2];
47740e0aa64SRichard Purdie 	u16 *cache = codec->reg_cache;
47840e0aa64SRichard Purdie 
47940e0aa64SRichard Purdie 	/* Sync reg_cache with the hardware */
48040e0aa64SRichard Purdie 	for (i = 0; i < ARRAY_SIZE(wm8731_reg); i++) {
48140e0aa64SRichard Purdie 		data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
48240e0aa64SRichard Purdie 		data[1] = cache[i] & 0x00ff;
48340e0aa64SRichard Purdie 		codec->hw_write(codec->control_data, data, 2);
48440e0aa64SRichard Purdie 	}
4850be9898aSMark Brown 	wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
4860be9898aSMark Brown 	wm8731_set_bias_level(codec, codec->suspend_bias_level);
48740e0aa64SRichard Purdie 	return 0;
48840e0aa64SRichard Purdie }
48940e0aa64SRichard Purdie 
4905998102bSMark Brown static int wm8731_probe(struct platform_device *pdev)
49140e0aa64SRichard Purdie {
4925998102bSMark Brown 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
4935998102bSMark Brown 	struct snd_soc_codec *codec;
4945998102bSMark Brown 	int ret = 0;
49540e0aa64SRichard Purdie 
4965998102bSMark Brown 	if (wm8731_codec == NULL) {
4975998102bSMark Brown 		dev_err(&pdev->dev, "Codec device not registered\n");
4985998102bSMark Brown 		return -ENODEV;
4995998102bSMark Brown 	}
50040e0aa64SRichard Purdie 
5015998102bSMark Brown 	socdev->card->codec = wm8731_codec;
5025998102bSMark Brown 	codec = wm8731_codec;
50340e0aa64SRichard Purdie 
50440e0aa64SRichard Purdie 	/* register pcms */
50540e0aa64SRichard Purdie 	ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
50640e0aa64SRichard Purdie 	if (ret < 0) {
5075998102bSMark Brown 		dev_err(codec->dev, "failed to create pcms: %d\n", ret);
508e35115a5SLiam Girdwood 		goto pcm_err;
50940e0aa64SRichard Purdie 	}
51040e0aa64SRichard Purdie 
5113e8e1952SIan Molton 	snd_soc_add_controls(codec, wm8731_snd_controls,
5123e8e1952SIan Molton 			     ARRAY_SIZE(wm8731_snd_controls));
51340e0aa64SRichard Purdie 	wm8731_add_widgets(codec);
514968a6025SMark Brown 	ret = snd_soc_init_card(socdev);
51540e0aa64SRichard Purdie 	if (ret < 0) {
5165998102bSMark Brown 		dev_err(codec->dev, "failed to register card: %d\n", ret);
517e35115a5SLiam Girdwood 		goto card_err;
51840e0aa64SRichard Purdie 	}
51940e0aa64SRichard Purdie 
52040e0aa64SRichard Purdie 	return ret;
521e35115a5SLiam Girdwood 
522e35115a5SLiam Girdwood card_err:
523e35115a5SLiam Girdwood 	snd_soc_free_pcms(socdev);
524e35115a5SLiam Girdwood 	snd_soc_dapm_free(socdev);
525e35115a5SLiam Girdwood pcm_err:
52640e0aa64SRichard Purdie 	return ret;
52740e0aa64SRichard Purdie }
52840e0aa64SRichard Purdie 
52940e0aa64SRichard Purdie /* power down chip */
53040e0aa64SRichard Purdie static int wm8731_remove(struct platform_device *pdev)
53140e0aa64SRichard Purdie {
53240e0aa64SRichard Purdie 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
53340e0aa64SRichard Purdie 
53440e0aa64SRichard Purdie 	snd_soc_free_pcms(socdev);
53540e0aa64SRichard Purdie 	snd_soc_dapm_free(socdev);
53640e0aa64SRichard Purdie 
53740e0aa64SRichard Purdie 	return 0;
53840e0aa64SRichard Purdie }
53940e0aa64SRichard Purdie 
54040e0aa64SRichard Purdie struct snd_soc_codec_device soc_codec_dev_wm8731 = {
54140e0aa64SRichard Purdie 	.probe = 	wm8731_probe,
54240e0aa64SRichard Purdie 	.remove = 	wm8731_remove,
54340e0aa64SRichard Purdie 	.suspend = 	wm8731_suspend,
54440e0aa64SRichard Purdie 	.resume =	wm8731_resume,
54540e0aa64SRichard Purdie };
54640e0aa64SRichard Purdie EXPORT_SYMBOL_GPL(soc_codec_dev_wm8731);
54740e0aa64SRichard Purdie 
5485998102bSMark Brown static int wm8731_register(struct wm8731_priv *wm8731)
549a8035c8fSMark Brown {
550a8035c8fSMark Brown 	int ret;
5515998102bSMark Brown 	struct snd_soc_codec *codec = &wm8731->codec;
5525998102bSMark Brown 	u16 reg;
553a8035c8fSMark Brown 
5545998102bSMark Brown 	if (wm8731_codec) {
5555998102bSMark Brown 		dev_err(codec->dev, "Another WM8731 is registered\n");
5565998102bSMark Brown 		return -EINVAL;
5575998102bSMark Brown 	}
558a8035c8fSMark Brown 
5595998102bSMark Brown 	mutex_init(&codec->mutex);
5605998102bSMark Brown 	INIT_LIST_HEAD(&codec->dapm_widgets);
5615998102bSMark Brown 	INIT_LIST_HEAD(&codec->dapm_paths);
562a8035c8fSMark Brown 
5635998102bSMark Brown 	codec->private_data = wm8731;
5645998102bSMark Brown 	codec->name = "WM8731";
5655998102bSMark Brown 	codec->owner = THIS_MODULE;
5665998102bSMark Brown 	codec->read = wm8731_read_reg_cache;
5675998102bSMark Brown 	codec->write = wm8731_write;
5685998102bSMark Brown 	codec->bias_level = SND_SOC_BIAS_OFF;
5695998102bSMark Brown 	codec->set_bias_level = wm8731_set_bias_level;
5705998102bSMark Brown 	codec->dai = &wm8731_dai;
5715998102bSMark Brown 	codec->num_dai = 1;
5725998102bSMark Brown 	codec->reg_cache_size = WM8731_CACHEREGNUM;
5735998102bSMark Brown 	codec->reg_cache = &wm8731->reg_cache;
5745998102bSMark Brown 
5755998102bSMark Brown 	memcpy(codec->reg_cache, wm8731_reg, sizeof(wm8731_reg));
5765998102bSMark Brown 
5775998102bSMark Brown 	wm8731_dai.dev = codec->dev;
5785998102bSMark Brown 
5795998102bSMark Brown 	wm8731_reset(codec);
5805998102bSMark Brown 	wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
5815998102bSMark Brown 
5825998102bSMark Brown 	/* Latch the update bits */
5835998102bSMark Brown 	reg = wm8731_read_reg_cache(codec, WM8731_LOUT1V);
5845998102bSMark Brown 	wm8731_write(codec, WM8731_LOUT1V, reg & ~0x0100);
5855998102bSMark Brown 	reg = wm8731_read_reg_cache(codec, WM8731_ROUT1V);
5865998102bSMark Brown 	wm8731_write(codec, WM8731_ROUT1V, reg & ~0x0100);
5875998102bSMark Brown 	reg = wm8731_read_reg_cache(codec, WM8731_LINVOL);
5885998102bSMark Brown 	wm8731_write(codec, WM8731_LINVOL, reg & ~0x0100);
5895998102bSMark Brown 	reg = wm8731_read_reg_cache(codec, WM8731_RINVOL);
5905998102bSMark Brown 	wm8731_write(codec, WM8731_RINVOL, reg & ~0x0100);
5915998102bSMark Brown 
5925998102bSMark Brown 	wm8731_codec = codec;
5935998102bSMark Brown 
5945998102bSMark Brown 	ret = snd_soc_register_codec(codec);
5955998102bSMark Brown 	if (ret != 0) {
5965998102bSMark Brown 		dev_err(codec->dev, "Failed to register codec: %d\n", ret);
597a8035c8fSMark Brown 		return ret;
598a8035c8fSMark Brown 	}
599a8035c8fSMark Brown 
6005998102bSMark Brown 	ret = snd_soc_register_dai(&wm8731_dai);
6015998102bSMark Brown 	if (ret != 0) {
6025998102bSMark Brown 		dev_err(codec->dev, "Failed to register DAI: %d\n", ret);
6035998102bSMark Brown 		snd_soc_unregister_codec(codec);
6045998102bSMark Brown 		return ret;
6055998102bSMark Brown 	}
6065998102bSMark Brown 
607a8035c8fSMark Brown 	return 0;
608a8035c8fSMark Brown }
609a8035c8fSMark Brown 
6105998102bSMark Brown static void wm8731_unregister(struct wm8731_priv *wm8731)
6115998102bSMark Brown {
6125998102bSMark Brown 	wm8731_set_bias_level(&wm8731->codec, SND_SOC_BIAS_OFF);
6135998102bSMark Brown 	snd_soc_unregister_dai(&wm8731_dai);
6145998102bSMark Brown 	snd_soc_unregister_codec(&wm8731->codec);
6155998102bSMark Brown 	kfree(wm8731);
6165998102bSMark Brown 	wm8731_codec = NULL;
6175998102bSMark Brown }
618a8035c8fSMark Brown 
6195998102bSMark Brown #if defined(CONFIG_SPI_MASTER)
620a8035c8fSMark Brown static int wm8731_spi_write(struct spi_device *spi, const char *data, int len)
621a8035c8fSMark Brown {
622a8035c8fSMark Brown 	struct spi_transfer t;
623a8035c8fSMark Brown 	struct spi_message m;
624a8035c8fSMark Brown 	u8 msg[2];
625a8035c8fSMark Brown 
626a8035c8fSMark Brown 	if (len <= 0)
627a8035c8fSMark Brown 		return 0;
628a8035c8fSMark Brown 
629a8035c8fSMark Brown 	msg[0] = data[0];
630a8035c8fSMark Brown 	msg[1] = data[1];
631a8035c8fSMark Brown 
632a8035c8fSMark Brown 	spi_message_init(&m);
633a8035c8fSMark Brown 	memset(&t, 0, (sizeof t));
634a8035c8fSMark Brown 
635a8035c8fSMark Brown 	t.tx_buf = &msg[0];
636a8035c8fSMark Brown 	t.len = len;
637a8035c8fSMark Brown 
638a8035c8fSMark Brown 	spi_message_add_tail(&t, &m);
639a8035c8fSMark Brown 	spi_sync(spi, &m);
640a8035c8fSMark Brown 
641a8035c8fSMark Brown 	return len;
642a8035c8fSMark Brown }
6435998102bSMark Brown 
6445998102bSMark Brown static int __devinit wm8731_spi_probe(struct spi_device *spi)
6455998102bSMark Brown {
6465998102bSMark Brown 	struct snd_soc_codec *codec;
6475998102bSMark Brown 	struct wm8731_priv *wm8731;
6485998102bSMark Brown 
6495998102bSMark Brown 	wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL);
6505998102bSMark Brown 	if (wm8731 == NULL)
6515998102bSMark Brown 		return -ENOMEM;
6525998102bSMark Brown 
6535998102bSMark Brown 	codec = &wm8731->codec;
6545998102bSMark Brown 	codec->control_data = spi;
6555998102bSMark Brown 	codec->hw_write = (hw_write_t)wm8731_spi_write;
6565998102bSMark Brown 	codec->dev = &spi->dev;
6575998102bSMark Brown 
658*93b760b7SMark Brown 	spi->dev.driver_data = wm8731;
659*93b760b7SMark Brown 
6605998102bSMark Brown 	return wm8731_register(wm8731);
6615998102bSMark Brown }
6625998102bSMark Brown 
6635998102bSMark Brown static int __devexit wm8731_spi_remove(struct spi_device *spi)
6645998102bSMark Brown {
665*93b760b7SMark Brown 	struct wm8731_priv *wm8731 = spi->dev.driver_data;
666*93b760b7SMark Brown 
667*93b760b7SMark Brown 	wm8731_unregister(wm8731);
668*93b760b7SMark Brown 
6695998102bSMark Brown 	return 0;
6705998102bSMark Brown }
6715998102bSMark Brown 
6725998102bSMark Brown static struct spi_driver wm8731_spi_driver = {
6735998102bSMark Brown 	.driver = {
6745998102bSMark Brown 		.name	= "wm8731",
6755998102bSMark Brown 		.bus	= &spi_bus_type,
6765998102bSMark Brown 		.owner	= THIS_MODULE,
6775998102bSMark Brown 	},
6785998102bSMark Brown 	.probe		= wm8731_spi_probe,
6795998102bSMark Brown 	.remove		= __devexit_p(wm8731_spi_remove),
6805998102bSMark Brown };
681a8035c8fSMark Brown #endif /* CONFIG_SPI_MASTER */
682a8035c8fSMark Brown 
683a8035c8fSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
684a8035c8fSMark Brown static int wm8731_i2c_probe(struct i2c_client *i2c,
685a8035c8fSMark Brown 			    const struct i2c_device_id *id)
686a8035c8fSMark Brown {
6875998102bSMark Brown 	struct wm8731_priv *wm8731;
6885998102bSMark Brown 	struct snd_soc_codec *codec;
689a8035c8fSMark Brown 
6905998102bSMark Brown 	wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL);
6915998102bSMark Brown 	if (wm8731 == NULL)
6925998102bSMark Brown 		return -ENOMEM;
6935998102bSMark Brown 
6945998102bSMark Brown 	codec = &wm8731->codec;
6955998102bSMark Brown 	codec->hw_write = (hw_write_t)i2c_master_send;
6965998102bSMark Brown 
6975998102bSMark Brown 	i2c_set_clientdata(i2c, wm8731);
698a8035c8fSMark Brown 	codec->control_data = i2c;
699a8035c8fSMark Brown 
7005998102bSMark Brown 	codec->dev = &i2c->dev;
701a8035c8fSMark Brown 
7025998102bSMark Brown 	return wm8731_register(wm8731);
703a8035c8fSMark Brown }
704a8035c8fSMark Brown 
705a8035c8fSMark Brown static int wm8731_i2c_remove(struct i2c_client *client)
706a8035c8fSMark Brown {
7075998102bSMark Brown 	struct wm8731_priv *wm8731 = i2c_get_clientdata(client);
7085998102bSMark Brown 	wm8731_unregister(wm8731);
709a8035c8fSMark Brown 	return 0;
710a8035c8fSMark Brown }
711a8035c8fSMark Brown 
712a8035c8fSMark Brown static const struct i2c_device_id wm8731_i2c_id[] = {
713a8035c8fSMark Brown 	{ "wm8731", 0 },
714a8035c8fSMark Brown 	{ }
715a8035c8fSMark Brown };
716a8035c8fSMark Brown MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id);
717a8035c8fSMark Brown 
718a8035c8fSMark Brown static struct i2c_driver wm8731_i2c_driver = {
719a8035c8fSMark Brown 	.driver = {
720a8035c8fSMark Brown 		.name = "WM8731 I2C Codec",
721a8035c8fSMark Brown 		.owner = THIS_MODULE,
722a8035c8fSMark Brown 	},
723a8035c8fSMark Brown 	.probe =    wm8731_i2c_probe,
724a8035c8fSMark Brown 	.remove =   wm8731_i2c_remove,
725a8035c8fSMark Brown 	.id_table = wm8731_i2c_id,
726a8035c8fSMark Brown };
727a8035c8fSMark Brown #endif
728a8035c8fSMark Brown 
729c9b3a40fSTakashi Iwai static int __init wm8731_modinit(void)
73064089b84SMark Brown {
7315998102bSMark Brown 	int ret;
7325998102bSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
7335998102bSMark Brown 	ret = i2c_add_driver(&wm8731_i2c_driver);
7345998102bSMark Brown 	if (ret != 0) {
7355998102bSMark Brown 		printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n",
7365998102bSMark Brown 		       ret);
7375998102bSMark Brown 	}
7385998102bSMark Brown #endif
7395998102bSMark Brown #if defined(CONFIG_SPI_MASTER)
7405998102bSMark Brown 	ret = spi_register_driver(&wm8731_spi_driver);
7415998102bSMark Brown 	if (ret != 0) {
7425998102bSMark Brown 		printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n",
7435998102bSMark Brown 		       ret);
7445998102bSMark Brown 	}
7455998102bSMark Brown #endif
7465998102bSMark Brown 	return 0;
74764089b84SMark Brown }
74864089b84SMark Brown module_init(wm8731_modinit);
74964089b84SMark Brown 
75064089b84SMark Brown static void __exit wm8731_exit(void)
75164089b84SMark Brown {
7525998102bSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
7535998102bSMark Brown 	i2c_del_driver(&wm8731_i2c_driver);
7545998102bSMark Brown #endif
7555998102bSMark Brown #if defined(CONFIG_SPI_MASTER)
7565998102bSMark Brown 	spi_unregister_driver(&wm8731_spi_driver);
7575998102bSMark Brown #endif
75864089b84SMark Brown }
75964089b84SMark Brown module_exit(wm8731_exit);
76064089b84SMark Brown 
76140e0aa64SRichard Purdie MODULE_DESCRIPTION("ASoC WM8731 driver");
76240e0aa64SRichard Purdie MODULE_AUTHOR("Richard Purdie");
76340e0aa64SRichard Purdie MODULE_LICENSE("GPL");
764