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 4366335d055SEric Miao static struct snd_soc_dai_ops wm8731_dai_ops = { 4376335d055SEric Miao .prepare = wm8731_pcm_prepare, 4386335d055SEric Miao .hw_params = wm8731_hw_params, 4396335d055SEric Miao .shutdown = wm8731_shutdown, 4406335d055SEric Miao .digital_mute = wm8731_mute, 4416335d055SEric Miao .set_sysclk = wm8731_set_dai_sysclk, 4426335d055SEric Miao .set_fmt = wm8731_set_dai_fmt, 4436335d055SEric Miao }; 4446335d055SEric Miao 445e550e17fSLiam Girdwood struct snd_soc_dai wm8731_dai = { 44640e0aa64SRichard Purdie .name = "WM8731", 44740e0aa64SRichard Purdie .playback = { 44840e0aa64SRichard Purdie .stream_name = "Playback", 44940e0aa64SRichard Purdie .channels_min = 1, 45040e0aa64SRichard Purdie .channels_max = 2, 451b36d61d4SFrank Mandarino .rates = WM8731_RATES, 452b36d61d4SFrank Mandarino .formats = WM8731_FORMATS,}, 45340e0aa64SRichard Purdie .capture = { 45440e0aa64SRichard Purdie .stream_name = "Capture", 45540e0aa64SRichard Purdie .channels_min = 1, 45640e0aa64SRichard Purdie .channels_max = 2, 457b36d61d4SFrank Mandarino .rates = WM8731_RATES, 458b36d61d4SFrank Mandarino .formats = WM8731_FORMATS,}, 4596335d055SEric Miao .ops = &wm8731_dai_ops, 46040e0aa64SRichard Purdie }; 46140e0aa64SRichard Purdie EXPORT_SYMBOL_GPL(wm8731_dai); 46240e0aa64SRichard Purdie 463b3b50b3fSMark Brown #ifdef CONFIG_PM 46440e0aa64SRichard Purdie static int wm8731_suspend(struct platform_device *pdev, pm_message_t state) 46540e0aa64SRichard Purdie { 46640e0aa64SRichard Purdie struct snd_soc_device *socdev = platform_get_drvdata(pdev); 4676627a653SMark Brown struct snd_soc_codec *codec = socdev->card->codec; 46840e0aa64SRichard Purdie 46940e0aa64SRichard Purdie wm8731_write(codec, WM8731_ACTIVE, 0x0); 4700be9898aSMark Brown wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF); 47140e0aa64SRichard Purdie return 0; 47240e0aa64SRichard Purdie } 47340e0aa64SRichard Purdie 47440e0aa64SRichard Purdie static int wm8731_resume(struct platform_device *pdev) 47540e0aa64SRichard Purdie { 47640e0aa64SRichard Purdie struct snd_soc_device *socdev = platform_get_drvdata(pdev); 4776627a653SMark Brown struct snd_soc_codec *codec = socdev->card->codec; 47840e0aa64SRichard Purdie int i; 47940e0aa64SRichard Purdie u8 data[2]; 48040e0aa64SRichard Purdie u16 *cache = codec->reg_cache; 48140e0aa64SRichard Purdie 48240e0aa64SRichard Purdie /* Sync reg_cache with the hardware */ 48340e0aa64SRichard Purdie for (i = 0; i < ARRAY_SIZE(wm8731_reg); i++) { 48440e0aa64SRichard Purdie data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001); 48540e0aa64SRichard Purdie data[1] = cache[i] & 0x00ff; 48640e0aa64SRichard Purdie codec->hw_write(codec->control_data, data, 2); 48740e0aa64SRichard Purdie } 4880be9898aSMark Brown wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY); 4890be9898aSMark Brown wm8731_set_bias_level(codec, codec->suspend_bias_level); 49040e0aa64SRichard Purdie return 0; 49140e0aa64SRichard Purdie } 492b3b50b3fSMark Brown #else 493b3b50b3fSMark Brown #define wm8731_suspend NULL 494b3b50b3fSMark Brown #define wm8731_resume NULL 495b3b50b3fSMark Brown #endif 49640e0aa64SRichard Purdie 4975998102bSMark Brown static int wm8731_probe(struct platform_device *pdev) 49840e0aa64SRichard Purdie { 4995998102bSMark Brown struct snd_soc_device *socdev = platform_get_drvdata(pdev); 5005998102bSMark Brown struct snd_soc_codec *codec; 5015998102bSMark Brown int ret = 0; 50240e0aa64SRichard Purdie 5035998102bSMark Brown if (wm8731_codec == NULL) { 5045998102bSMark Brown dev_err(&pdev->dev, "Codec device not registered\n"); 5055998102bSMark Brown return -ENODEV; 5065998102bSMark Brown } 50740e0aa64SRichard Purdie 5085998102bSMark Brown socdev->card->codec = wm8731_codec; 5095998102bSMark Brown codec = wm8731_codec; 51040e0aa64SRichard Purdie 51140e0aa64SRichard Purdie /* register pcms */ 51240e0aa64SRichard Purdie ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1); 51340e0aa64SRichard Purdie if (ret < 0) { 5145998102bSMark Brown dev_err(codec->dev, "failed to create pcms: %d\n", ret); 515e35115a5SLiam Girdwood goto pcm_err; 51640e0aa64SRichard Purdie } 51740e0aa64SRichard Purdie 5183e8e1952SIan Molton snd_soc_add_controls(codec, wm8731_snd_controls, 5193e8e1952SIan Molton ARRAY_SIZE(wm8731_snd_controls)); 52040e0aa64SRichard Purdie wm8731_add_widgets(codec); 521968a6025SMark Brown ret = snd_soc_init_card(socdev); 52240e0aa64SRichard Purdie if (ret < 0) { 5235998102bSMark Brown dev_err(codec->dev, "failed to register card: %d\n", ret); 524e35115a5SLiam Girdwood goto card_err; 52540e0aa64SRichard Purdie } 52640e0aa64SRichard Purdie 52740e0aa64SRichard Purdie return ret; 528e35115a5SLiam Girdwood 529e35115a5SLiam Girdwood card_err: 530e35115a5SLiam Girdwood snd_soc_free_pcms(socdev); 531e35115a5SLiam Girdwood snd_soc_dapm_free(socdev); 532e35115a5SLiam Girdwood pcm_err: 53340e0aa64SRichard Purdie return ret; 53440e0aa64SRichard Purdie } 53540e0aa64SRichard Purdie 53640e0aa64SRichard Purdie /* power down chip */ 53740e0aa64SRichard Purdie static int wm8731_remove(struct platform_device *pdev) 53840e0aa64SRichard Purdie { 53940e0aa64SRichard Purdie struct snd_soc_device *socdev = platform_get_drvdata(pdev); 54040e0aa64SRichard Purdie 54140e0aa64SRichard Purdie snd_soc_free_pcms(socdev); 54240e0aa64SRichard Purdie snd_soc_dapm_free(socdev); 54340e0aa64SRichard Purdie 54440e0aa64SRichard Purdie return 0; 54540e0aa64SRichard Purdie } 54640e0aa64SRichard Purdie 54740e0aa64SRichard Purdie struct snd_soc_codec_device soc_codec_dev_wm8731 = { 54840e0aa64SRichard Purdie .probe = wm8731_probe, 54940e0aa64SRichard Purdie .remove = wm8731_remove, 55040e0aa64SRichard Purdie .suspend = wm8731_suspend, 55140e0aa64SRichard Purdie .resume = wm8731_resume, 55240e0aa64SRichard Purdie }; 55340e0aa64SRichard Purdie EXPORT_SYMBOL_GPL(soc_codec_dev_wm8731); 55440e0aa64SRichard Purdie 5555998102bSMark Brown static int wm8731_register(struct wm8731_priv *wm8731) 556a8035c8fSMark Brown { 557a8035c8fSMark Brown int ret; 5585998102bSMark Brown struct snd_soc_codec *codec = &wm8731->codec; 5595998102bSMark Brown u16 reg; 560a8035c8fSMark Brown 5615998102bSMark Brown if (wm8731_codec) { 5625998102bSMark Brown dev_err(codec->dev, "Another WM8731 is registered\n"); 563*fe5422fcSMark Brown ret = -EINVAL; 564*fe5422fcSMark Brown goto err; 5655998102bSMark Brown } 566a8035c8fSMark Brown 5675998102bSMark Brown mutex_init(&codec->mutex); 5685998102bSMark Brown INIT_LIST_HEAD(&codec->dapm_widgets); 5695998102bSMark Brown INIT_LIST_HEAD(&codec->dapm_paths); 570a8035c8fSMark Brown 5715998102bSMark Brown codec->private_data = wm8731; 5725998102bSMark Brown codec->name = "WM8731"; 5735998102bSMark Brown codec->owner = THIS_MODULE; 5745998102bSMark Brown codec->read = wm8731_read_reg_cache; 5755998102bSMark Brown codec->write = wm8731_write; 5765998102bSMark Brown codec->bias_level = SND_SOC_BIAS_OFF; 5775998102bSMark Brown codec->set_bias_level = wm8731_set_bias_level; 5785998102bSMark Brown codec->dai = &wm8731_dai; 5795998102bSMark Brown codec->num_dai = 1; 5805998102bSMark Brown codec->reg_cache_size = WM8731_CACHEREGNUM; 5815998102bSMark Brown codec->reg_cache = &wm8731->reg_cache; 5825998102bSMark Brown 5835998102bSMark Brown memcpy(codec->reg_cache, wm8731_reg, sizeof(wm8731_reg)); 5845998102bSMark Brown 585519cf2dfSMark Brown ret = wm8731_reset(codec); 586519cf2dfSMark Brown if (ret < 0) { 587*fe5422fcSMark Brown dev_err(codec->dev, "Failed to issue reset: %d\n", ret); 588*fe5422fcSMark Brown goto err; 589519cf2dfSMark Brown } 590519cf2dfSMark Brown 5915998102bSMark Brown wm8731_dai.dev = codec->dev; 5925998102bSMark Brown 5935998102bSMark Brown wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY); 5945998102bSMark Brown 5955998102bSMark Brown /* Latch the update bits */ 5965998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_LOUT1V); 5975998102bSMark Brown wm8731_write(codec, WM8731_LOUT1V, reg & ~0x0100); 5985998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_ROUT1V); 5995998102bSMark Brown wm8731_write(codec, WM8731_ROUT1V, reg & ~0x0100); 6005998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_LINVOL); 6015998102bSMark Brown wm8731_write(codec, WM8731_LINVOL, reg & ~0x0100); 6025998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_RINVOL); 6035998102bSMark Brown wm8731_write(codec, WM8731_RINVOL, reg & ~0x0100); 6045998102bSMark Brown 605ce3bdaa8SMark Brown /* Disable bypass path by default */ 606ce3bdaa8SMark Brown reg = wm8731_read_reg_cache(codec, WM8731_APANA); 607ce3bdaa8SMark Brown wm8731_write(codec, WM8731_APANA, reg & ~0x4); 608ce3bdaa8SMark Brown 6095998102bSMark Brown wm8731_codec = codec; 6105998102bSMark Brown 6115998102bSMark Brown ret = snd_soc_register_codec(codec); 6125998102bSMark Brown if (ret != 0) { 6135998102bSMark Brown dev_err(codec->dev, "Failed to register codec: %d\n", ret); 614*fe5422fcSMark Brown goto err; 615a8035c8fSMark Brown } 616a8035c8fSMark Brown 6175998102bSMark Brown ret = snd_soc_register_dai(&wm8731_dai); 6185998102bSMark Brown if (ret != 0) { 6195998102bSMark Brown dev_err(codec->dev, "Failed to register DAI: %d\n", ret); 6205998102bSMark Brown snd_soc_unregister_codec(codec); 621*fe5422fcSMark Brown goto err_codec; 6225998102bSMark Brown } 6235998102bSMark Brown 624a8035c8fSMark Brown return 0; 625*fe5422fcSMark Brown 626*fe5422fcSMark Brown err_codec: 627*fe5422fcSMark Brown snd_soc_unregister_codec(codec); 628*fe5422fcSMark Brown err: 629*fe5422fcSMark Brown kfree(wm8731); 630*fe5422fcSMark Brown return ret; 631a8035c8fSMark Brown } 632a8035c8fSMark Brown 6335998102bSMark Brown static void wm8731_unregister(struct wm8731_priv *wm8731) 6345998102bSMark Brown { 6355998102bSMark Brown wm8731_set_bias_level(&wm8731->codec, SND_SOC_BIAS_OFF); 6365998102bSMark Brown snd_soc_unregister_dai(&wm8731_dai); 6375998102bSMark Brown snd_soc_unregister_codec(&wm8731->codec); 6385998102bSMark Brown kfree(wm8731); 6395998102bSMark Brown wm8731_codec = NULL; 6405998102bSMark Brown } 641a8035c8fSMark Brown 6425998102bSMark Brown #if defined(CONFIG_SPI_MASTER) 643a8035c8fSMark Brown static int wm8731_spi_write(struct spi_device *spi, const char *data, int len) 644a8035c8fSMark Brown { 645a8035c8fSMark Brown struct spi_transfer t; 646a8035c8fSMark Brown struct spi_message m; 647a8035c8fSMark Brown u8 msg[2]; 648a8035c8fSMark Brown 649a8035c8fSMark Brown if (len <= 0) 650a8035c8fSMark Brown return 0; 651a8035c8fSMark Brown 652a8035c8fSMark Brown msg[0] = data[0]; 653a8035c8fSMark Brown msg[1] = data[1]; 654a8035c8fSMark Brown 655a8035c8fSMark Brown spi_message_init(&m); 656a8035c8fSMark Brown memset(&t, 0, (sizeof t)); 657a8035c8fSMark Brown 658a8035c8fSMark Brown t.tx_buf = &msg[0]; 659a8035c8fSMark Brown t.len = len; 660a8035c8fSMark Brown 661a8035c8fSMark Brown spi_message_add_tail(&t, &m); 662a8035c8fSMark Brown spi_sync(spi, &m); 663a8035c8fSMark Brown 664a8035c8fSMark Brown return len; 665a8035c8fSMark Brown } 6665998102bSMark Brown 6675998102bSMark Brown static int __devinit wm8731_spi_probe(struct spi_device *spi) 6685998102bSMark Brown { 6695998102bSMark Brown struct snd_soc_codec *codec; 6705998102bSMark Brown struct wm8731_priv *wm8731; 6715998102bSMark Brown 6725998102bSMark Brown wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL); 6735998102bSMark Brown if (wm8731 == NULL) 6745998102bSMark Brown return -ENOMEM; 6755998102bSMark Brown 6765998102bSMark Brown codec = &wm8731->codec; 6775998102bSMark Brown codec->control_data = spi; 6785998102bSMark Brown codec->hw_write = (hw_write_t)wm8731_spi_write; 6795998102bSMark Brown codec->dev = &spi->dev; 6805998102bSMark Brown 681ae31c1fbSGreg Kroah-Hartman dev_set_drvdata(&spi->dev, wm8731); 68293b760b7SMark Brown 6835998102bSMark Brown return wm8731_register(wm8731); 6845998102bSMark Brown } 6855998102bSMark Brown 6865998102bSMark Brown static int __devexit wm8731_spi_remove(struct spi_device *spi) 6875998102bSMark Brown { 688ae31c1fbSGreg Kroah-Hartman struct wm8731_priv *wm8731 = dev_get_drvdata(&spi->dev); 68993b760b7SMark Brown 69093b760b7SMark Brown wm8731_unregister(wm8731); 69193b760b7SMark Brown 6925998102bSMark Brown return 0; 6935998102bSMark Brown } 6945998102bSMark Brown 695b3b50b3fSMark Brown #ifdef CONFIG_PM 696b3b50b3fSMark Brown static int wm8731_spi_suspend(struct spi_device *spi, pm_message_t msg) 697b3b50b3fSMark Brown { 698b3b50b3fSMark Brown return snd_soc_suspend_device(&spi->dev); 699b3b50b3fSMark Brown } 700b3b50b3fSMark Brown 701b3b50b3fSMark Brown static int wm8731_spi_resume(struct spi_device *spi) 702b3b50b3fSMark Brown { 703b3b50b3fSMark Brown return snd_soc_resume_device(&spi->dev); 704b3b50b3fSMark Brown } 705b3b50b3fSMark Brown #else 706b3b50b3fSMark Brown #define wm8731_spi_suspend NULL 707b3b50b3fSMark Brown #define wm8731_spi_resume NULL 708b3b50b3fSMark Brown #endif 709b3b50b3fSMark Brown 7105998102bSMark Brown static struct spi_driver wm8731_spi_driver = { 7115998102bSMark Brown .driver = { 7125998102bSMark Brown .name = "wm8731", 7135998102bSMark Brown .bus = &spi_bus_type, 7145998102bSMark Brown .owner = THIS_MODULE, 7155998102bSMark Brown }, 7165998102bSMark Brown .probe = wm8731_spi_probe, 717b3b50b3fSMark Brown .suspend = wm8731_spi_suspend, 718b3b50b3fSMark Brown .resume = wm8731_spi_resume, 7195998102bSMark Brown .remove = __devexit_p(wm8731_spi_remove), 7205998102bSMark Brown }; 721a8035c8fSMark Brown #endif /* CONFIG_SPI_MASTER */ 722a8035c8fSMark Brown 723a8035c8fSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 724c6f29811SMark Brown static __devinit int wm8731_i2c_probe(struct i2c_client *i2c, 725a8035c8fSMark Brown const struct i2c_device_id *id) 726a8035c8fSMark Brown { 7275998102bSMark Brown struct wm8731_priv *wm8731; 7285998102bSMark Brown struct snd_soc_codec *codec; 729a8035c8fSMark Brown 7305998102bSMark Brown wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL); 7315998102bSMark Brown if (wm8731 == NULL) 7325998102bSMark Brown return -ENOMEM; 7335998102bSMark Brown 7345998102bSMark Brown codec = &wm8731->codec; 7355998102bSMark Brown codec->hw_write = (hw_write_t)i2c_master_send; 7365998102bSMark Brown 7375998102bSMark Brown i2c_set_clientdata(i2c, wm8731); 738a8035c8fSMark Brown codec->control_data = i2c; 739a8035c8fSMark Brown 7405998102bSMark Brown codec->dev = &i2c->dev; 741a8035c8fSMark Brown 7425998102bSMark Brown return wm8731_register(wm8731); 743a8035c8fSMark Brown } 744a8035c8fSMark Brown 745c6f29811SMark Brown static __devexit int wm8731_i2c_remove(struct i2c_client *client) 746a8035c8fSMark Brown { 7475998102bSMark Brown struct wm8731_priv *wm8731 = i2c_get_clientdata(client); 7485998102bSMark Brown wm8731_unregister(wm8731); 749a8035c8fSMark Brown return 0; 750a8035c8fSMark Brown } 751a8035c8fSMark Brown 752b3b50b3fSMark Brown #ifdef CONFIG_PM 753b3b50b3fSMark Brown static int wm8731_i2c_suspend(struct i2c_client *i2c, pm_message_t msg) 754b3b50b3fSMark Brown { 755b3b50b3fSMark Brown return snd_soc_suspend_device(&i2c->dev); 756b3b50b3fSMark Brown } 757b3b50b3fSMark Brown 758b3b50b3fSMark Brown static int wm8731_i2c_resume(struct i2c_client *i2c) 759b3b50b3fSMark Brown { 760b3b50b3fSMark Brown return snd_soc_resume_device(&i2c->dev); 761b3b50b3fSMark Brown } 762b3b50b3fSMark Brown #else 763b3b50b3fSMark Brown #define wm8731_i2c_suspend NULL 764b3b50b3fSMark Brown #define wm8731_i2c_resume NULL 765b3b50b3fSMark Brown #endif 766b3b50b3fSMark Brown 767a8035c8fSMark Brown static const struct i2c_device_id wm8731_i2c_id[] = { 768a8035c8fSMark Brown { "wm8731", 0 }, 769a8035c8fSMark Brown { } 770a8035c8fSMark Brown }; 771a8035c8fSMark Brown MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id); 772a8035c8fSMark Brown 773a8035c8fSMark Brown static struct i2c_driver wm8731_i2c_driver = { 774a8035c8fSMark Brown .driver = { 775a8035c8fSMark Brown .name = "WM8731 I2C Codec", 776a8035c8fSMark Brown .owner = THIS_MODULE, 777a8035c8fSMark Brown }, 778a8035c8fSMark Brown .probe = wm8731_i2c_probe, 779c6f29811SMark Brown .remove = __devexit_p(wm8731_i2c_remove), 780b3b50b3fSMark Brown .suspend = wm8731_i2c_suspend, 781b3b50b3fSMark Brown .resume = wm8731_i2c_resume, 782a8035c8fSMark Brown .id_table = wm8731_i2c_id, 783a8035c8fSMark Brown }; 784a8035c8fSMark Brown #endif 785a8035c8fSMark Brown 786c9b3a40fSTakashi Iwai static int __init wm8731_modinit(void) 78764089b84SMark Brown { 7885998102bSMark Brown int ret; 7895998102bSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 7905998102bSMark Brown ret = i2c_add_driver(&wm8731_i2c_driver); 7915998102bSMark Brown if (ret != 0) { 7925998102bSMark Brown printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n", 7935998102bSMark Brown ret); 7945998102bSMark Brown } 7955998102bSMark Brown #endif 7965998102bSMark Brown #if defined(CONFIG_SPI_MASTER) 7975998102bSMark Brown ret = spi_register_driver(&wm8731_spi_driver); 7985998102bSMark Brown if (ret != 0) { 7995998102bSMark Brown printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n", 8005998102bSMark Brown ret); 8015998102bSMark Brown } 8025998102bSMark Brown #endif 8035998102bSMark Brown return 0; 80464089b84SMark Brown } 80564089b84SMark Brown module_init(wm8731_modinit); 80664089b84SMark Brown 80764089b84SMark Brown static void __exit wm8731_exit(void) 80864089b84SMark Brown { 8095998102bSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 8105998102bSMark Brown i2c_del_driver(&wm8731_i2c_driver); 8115998102bSMark Brown #endif 8125998102bSMark Brown #if defined(CONFIG_SPI_MASTER) 8135998102bSMark Brown spi_unregister_driver(&wm8731_spi_driver); 8145998102bSMark Brown #endif 81564089b84SMark Brown } 81664089b84SMark Brown module_exit(wm8731_exit); 81764089b84SMark Brown 81840e0aa64SRichard Purdie MODULE_DESCRIPTION("ASoC WM8731 driver"); 81940e0aa64SRichard Purdie MODULE_AUTHOR("Richard Purdie"); 82040e0aa64SRichard Purdie MODULE_LICENSE("GPL"); 821