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 32*5998102bSMark 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 { 37*5998102bSMark Brown struct snd_soc_codec codec; 38*5998102bSMark 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 490*5998102bSMark Brown static int wm8731_probe(struct platform_device *pdev) 49140e0aa64SRichard Purdie { 492*5998102bSMark Brown struct snd_soc_device *socdev = platform_get_drvdata(pdev); 493*5998102bSMark Brown struct snd_soc_codec *codec; 494*5998102bSMark Brown int ret = 0; 49540e0aa64SRichard Purdie 496*5998102bSMark Brown if (wm8731_codec == NULL) { 497*5998102bSMark Brown dev_err(&pdev->dev, "Codec device not registered\n"); 498*5998102bSMark Brown return -ENODEV; 499*5998102bSMark Brown } 50040e0aa64SRichard Purdie 501*5998102bSMark Brown socdev->card->codec = wm8731_codec; 502*5998102bSMark 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) { 507*5998102bSMark 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) { 516*5998102bSMark 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 548*5998102bSMark Brown static int wm8731_register(struct wm8731_priv *wm8731) 549a8035c8fSMark Brown { 550a8035c8fSMark Brown int ret; 551*5998102bSMark Brown struct snd_soc_codec *codec = &wm8731->codec; 552*5998102bSMark Brown u16 reg; 553a8035c8fSMark Brown 554*5998102bSMark Brown if (wm8731_codec) { 555*5998102bSMark Brown dev_err(codec->dev, "Another WM8731 is registered\n"); 556*5998102bSMark Brown return -EINVAL; 557*5998102bSMark Brown } 558a8035c8fSMark Brown 559*5998102bSMark Brown mutex_init(&codec->mutex); 560*5998102bSMark Brown INIT_LIST_HEAD(&codec->dapm_widgets); 561*5998102bSMark Brown INIT_LIST_HEAD(&codec->dapm_paths); 562a8035c8fSMark Brown 563*5998102bSMark Brown codec->private_data = wm8731; 564*5998102bSMark Brown codec->name = "WM8731"; 565*5998102bSMark Brown codec->owner = THIS_MODULE; 566*5998102bSMark Brown codec->read = wm8731_read_reg_cache; 567*5998102bSMark Brown codec->write = wm8731_write; 568*5998102bSMark Brown codec->bias_level = SND_SOC_BIAS_OFF; 569*5998102bSMark Brown codec->set_bias_level = wm8731_set_bias_level; 570*5998102bSMark Brown codec->dai = &wm8731_dai; 571*5998102bSMark Brown codec->num_dai = 1; 572*5998102bSMark Brown codec->reg_cache_size = WM8731_CACHEREGNUM; 573*5998102bSMark Brown codec->reg_cache = &wm8731->reg_cache; 574*5998102bSMark Brown 575*5998102bSMark Brown memcpy(codec->reg_cache, wm8731_reg, sizeof(wm8731_reg)); 576*5998102bSMark Brown 577*5998102bSMark Brown wm8731_dai.dev = codec->dev; 578*5998102bSMark Brown 579*5998102bSMark Brown wm8731_reset(codec); 580*5998102bSMark Brown wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY); 581*5998102bSMark Brown 582*5998102bSMark Brown /* Latch the update bits */ 583*5998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_LOUT1V); 584*5998102bSMark Brown wm8731_write(codec, WM8731_LOUT1V, reg & ~0x0100); 585*5998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_ROUT1V); 586*5998102bSMark Brown wm8731_write(codec, WM8731_ROUT1V, reg & ~0x0100); 587*5998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_LINVOL); 588*5998102bSMark Brown wm8731_write(codec, WM8731_LINVOL, reg & ~0x0100); 589*5998102bSMark Brown reg = wm8731_read_reg_cache(codec, WM8731_RINVOL); 590*5998102bSMark Brown wm8731_write(codec, WM8731_RINVOL, reg & ~0x0100); 591*5998102bSMark Brown 592*5998102bSMark Brown wm8731_codec = codec; 593*5998102bSMark Brown 594*5998102bSMark Brown ret = snd_soc_register_codec(codec); 595*5998102bSMark Brown if (ret != 0) { 596*5998102bSMark Brown dev_err(codec->dev, "Failed to register codec: %d\n", ret); 597a8035c8fSMark Brown return ret; 598a8035c8fSMark Brown } 599a8035c8fSMark Brown 600*5998102bSMark Brown ret = snd_soc_register_dai(&wm8731_dai); 601*5998102bSMark Brown if (ret != 0) { 602*5998102bSMark Brown dev_err(codec->dev, "Failed to register DAI: %d\n", ret); 603*5998102bSMark Brown snd_soc_unregister_codec(codec); 604*5998102bSMark Brown return ret; 605*5998102bSMark Brown } 606*5998102bSMark Brown 607a8035c8fSMark Brown return 0; 608a8035c8fSMark Brown } 609a8035c8fSMark Brown 610*5998102bSMark Brown static void wm8731_unregister(struct wm8731_priv *wm8731) 611*5998102bSMark Brown { 612*5998102bSMark Brown wm8731_set_bias_level(&wm8731->codec, SND_SOC_BIAS_OFF); 613*5998102bSMark Brown snd_soc_unregister_dai(&wm8731_dai); 614*5998102bSMark Brown snd_soc_unregister_codec(&wm8731->codec); 615*5998102bSMark Brown kfree(wm8731); 616*5998102bSMark Brown wm8731_codec = NULL; 617*5998102bSMark Brown } 618a8035c8fSMark Brown 619*5998102bSMark 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 } 643*5998102bSMark Brown 644*5998102bSMark Brown static int __devinit wm8731_spi_probe(struct spi_device *spi) 645*5998102bSMark Brown { 646*5998102bSMark Brown struct snd_soc_codec *codec; 647*5998102bSMark Brown struct wm8731_priv *wm8731; 648*5998102bSMark Brown 649*5998102bSMark Brown wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL); 650*5998102bSMark Brown if (wm8731 == NULL) 651*5998102bSMark Brown return -ENOMEM; 652*5998102bSMark Brown 653*5998102bSMark Brown codec = &wm8731->codec; 654*5998102bSMark Brown codec->control_data = spi; 655*5998102bSMark Brown codec->hw_write = (hw_write_t)wm8731_spi_write; 656*5998102bSMark Brown codec->dev = &spi->dev; 657*5998102bSMark Brown 658*5998102bSMark Brown return wm8731_register(wm8731); 659*5998102bSMark Brown } 660*5998102bSMark Brown 661*5998102bSMark Brown static int __devexit wm8731_spi_remove(struct spi_device *spi) 662*5998102bSMark Brown { 663*5998102bSMark Brown /* FIXME: This isn't actually implemented... */ 664*5998102bSMark Brown return 0; 665*5998102bSMark Brown } 666*5998102bSMark Brown 667*5998102bSMark Brown static struct spi_driver wm8731_spi_driver = { 668*5998102bSMark Brown .driver = { 669*5998102bSMark Brown .name = "wm8731", 670*5998102bSMark Brown .bus = &spi_bus_type, 671*5998102bSMark Brown .owner = THIS_MODULE, 672*5998102bSMark Brown }, 673*5998102bSMark Brown .probe = wm8731_spi_probe, 674*5998102bSMark Brown .remove = __devexit_p(wm8731_spi_remove), 675*5998102bSMark Brown }; 676a8035c8fSMark Brown #endif /* CONFIG_SPI_MASTER */ 677a8035c8fSMark Brown 678a8035c8fSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 679a8035c8fSMark Brown static int wm8731_i2c_probe(struct i2c_client *i2c, 680a8035c8fSMark Brown const struct i2c_device_id *id) 681a8035c8fSMark Brown { 682*5998102bSMark Brown struct wm8731_priv *wm8731; 683*5998102bSMark Brown struct snd_soc_codec *codec; 684a8035c8fSMark Brown 685*5998102bSMark Brown wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL); 686*5998102bSMark Brown if (wm8731 == NULL) 687*5998102bSMark Brown return -ENOMEM; 688*5998102bSMark Brown 689*5998102bSMark Brown codec = &wm8731->codec; 690*5998102bSMark Brown codec->hw_write = (hw_write_t)i2c_master_send; 691*5998102bSMark Brown 692*5998102bSMark Brown i2c_set_clientdata(i2c, wm8731); 693a8035c8fSMark Brown codec->control_data = i2c; 694a8035c8fSMark Brown 695*5998102bSMark Brown codec->dev = &i2c->dev; 696a8035c8fSMark Brown 697*5998102bSMark Brown return wm8731_register(wm8731); 698a8035c8fSMark Brown } 699a8035c8fSMark Brown 700a8035c8fSMark Brown static int wm8731_i2c_remove(struct i2c_client *client) 701a8035c8fSMark Brown { 702*5998102bSMark Brown struct wm8731_priv *wm8731 = i2c_get_clientdata(client); 703*5998102bSMark Brown wm8731_unregister(wm8731); 704a8035c8fSMark Brown return 0; 705a8035c8fSMark Brown } 706a8035c8fSMark Brown 707a8035c8fSMark Brown static const struct i2c_device_id wm8731_i2c_id[] = { 708a8035c8fSMark Brown { "wm8731", 0 }, 709a8035c8fSMark Brown { } 710a8035c8fSMark Brown }; 711a8035c8fSMark Brown MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id); 712a8035c8fSMark Brown 713a8035c8fSMark Brown static struct i2c_driver wm8731_i2c_driver = { 714a8035c8fSMark Brown .driver = { 715a8035c8fSMark Brown .name = "WM8731 I2C Codec", 716a8035c8fSMark Brown .owner = THIS_MODULE, 717a8035c8fSMark Brown }, 718a8035c8fSMark Brown .probe = wm8731_i2c_probe, 719a8035c8fSMark Brown .remove = wm8731_i2c_remove, 720a8035c8fSMark Brown .id_table = wm8731_i2c_id, 721a8035c8fSMark Brown }; 722a8035c8fSMark Brown #endif 723a8035c8fSMark Brown 724c9b3a40fSTakashi Iwai static int __init wm8731_modinit(void) 72564089b84SMark Brown { 726*5998102bSMark Brown int ret; 727*5998102bSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 728*5998102bSMark Brown ret = i2c_add_driver(&wm8731_i2c_driver); 729*5998102bSMark Brown if (ret != 0) { 730*5998102bSMark Brown printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n", 731*5998102bSMark Brown ret); 732*5998102bSMark Brown } 733*5998102bSMark Brown #endif 734*5998102bSMark Brown #if defined(CONFIG_SPI_MASTER) 735*5998102bSMark Brown ret = spi_register_driver(&wm8731_spi_driver); 736*5998102bSMark Brown if (ret != 0) { 737*5998102bSMark Brown printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n", 738*5998102bSMark Brown ret); 739*5998102bSMark Brown } 740*5998102bSMark Brown #endif 741*5998102bSMark Brown return 0; 74264089b84SMark Brown } 74364089b84SMark Brown module_init(wm8731_modinit); 74464089b84SMark Brown 74564089b84SMark Brown static void __exit wm8731_exit(void) 74664089b84SMark Brown { 747*5998102bSMark Brown #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) 748*5998102bSMark Brown i2c_del_driver(&wm8731_i2c_driver); 749*5998102bSMark Brown #endif 750*5998102bSMark Brown #if defined(CONFIG_SPI_MASTER) 751*5998102bSMark Brown spi_unregister_driver(&wm8731_spi_driver); 752*5998102bSMark Brown #endif 75364089b84SMark Brown } 75464089b84SMark Brown module_exit(wm8731_exit); 75564089b84SMark Brown 75640e0aa64SRichard Purdie MODULE_DESCRIPTION("ASoC WM8731 driver"); 75740e0aa64SRichard Purdie MODULE_AUTHOR("Richard Purdie"); 75840e0aa64SRichard Purdie MODULE_LICENSE("GPL"); 759