1070 lines
		
	
	
		
			29 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1070 lines
		
	
	
		
			29 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * wm8988.c -- WM8988 ALSA SoC audio driver
 | |
|  *
 | |
|  * Copyright 2009 Wolfson Microelectronics plc
 | |
|  * Copyright 2005 Openedhand Ltd.
 | |
|  *
 | |
|  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License version 2 as
 | |
|  * published by the Free Software Foundation.
 | |
|  */
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/moduleparam.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/pm.h>
 | |
| #include <linux/i2c.h>
 | |
| #include <linux/spi/spi.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <sound/core.h>
 | |
| #include <sound/pcm.h>
 | |
| #include <sound/pcm_params.h>
 | |
| #include <sound/tlv.h>
 | |
| #include <sound/soc.h>
 | |
| #include <sound/soc-dapm.h>
 | |
| #include <sound/initval.h>
 | |
| 
 | |
| #include "wm8988.h"
 | |
| 
 | |
| /*
 | |
|  * wm8988 register cache
 | |
|  * We can't read the WM8988 register space when we
 | |
|  * are using 2 wire for device control, so we cache them instead.
 | |
|  */
 | |
| static const u16 wm8988_reg[] = {
 | |
| 	0x0097, 0x0097, 0x0079, 0x0079,  /*  0 */
 | |
| 	0x0000, 0x0008, 0x0000, 0x000a,  /*  4 */
 | |
| 	0x0000, 0x0000, 0x00ff, 0x00ff,  /*  8 */
 | |
| 	0x000f, 0x000f, 0x0000, 0x0000,  /* 12 */
 | |
| 	0x0000, 0x007b, 0x0000, 0x0032,  /* 16 */
 | |
| 	0x0000, 0x00c3, 0x00c3, 0x00c0,  /* 20 */
 | |
| 	0x0000, 0x0000, 0x0000, 0x0000,  /* 24 */
 | |
| 	0x0000, 0x0000, 0x0000, 0x0000,  /* 28 */
 | |
| 	0x0000, 0x0000, 0x0050, 0x0050,  /* 32 */
 | |
| 	0x0050, 0x0050, 0x0050, 0x0050,  /* 36 */
 | |
| 	0x0079, 0x0079, 0x0079,          /* 40 */
 | |
| };
 | |
| 
 | |
| /* codec private data */
 | |
| struct wm8988_priv {
 | |
| 	unsigned int sysclk;
 | |
| 	struct snd_soc_codec codec;
 | |
| 	struct snd_pcm_hw_constraint_list *sysclk_constraints;
 | |
| 	u16 reg_cache[WM8988_NUM_REG];
 | |
| };
 | |
| 
 | |
| 
 | |
| #define wm8988_reset(c)	snd_soc_write(c, WM8988_RESET, 0)
 | |
| 
 | |
| /*
 | |
|  * WM8988 Controls
 | |
|  */
 | |
| 
 | |
| static const char *bass_boost_txt[] = {"Linear Control", "Adaptive Boost"};
 | |
| static const struct soc_enum bass_boost =
 | |
| 	SOC_ENUM_SINGLE(WM8988_BASS, 7, 2, bass_boost_txt);
 | |
| 
 | |
| static const char *bass_filter_txt[] = { "130Hz @ 48kHz", "200Hz @ 48kHz" };
 | |
| static const struct soc_enum bass_filter =
 | |
| 	SOC_ENUM_SINGLE(WM8988_BASS, 6, 2, bass_filter_txt);
 | |
| 
 | |
| static const char *treble_txt[] = {"8kHz", "4kHz"};
 | |
| static const struct soc_enum treble =
 | |
| 	SOC_ENUM_SINGLE(WM8988_TREBLE, 6, 2, treble_txt);
 | |
| 
 | |
| static const char *stereo_3d_lc_txt[] = {"200Hz", "500Hz"};
 | |
| static const struct soc_enum stereo_3d_lc =
 | |
| 	SOC_ENUM_SINGLE(WM8988_3D, 5, 2, stereo_3d_lc_txt);
 | |
| 
 | |
| static const char *stereo_3d_uc_txt[] = {"2.2kHz", "1.5kHz"};
 | |
| static const struct soc_enum stereo_3d_uc =
 | |
| 	SOC_ENUM_SINGLE(WM8988_3D, 6, 2, stereo_3d_uc_txt);
 | |
| 
 | |
| static const char *stereo_3d_func_txt[] = {"Capture", "Playback"};
 | |
| static const struct soc_enum stereo_3d_func =
 | |
| 	SOC_ENUM_SINGLE(WM8988_3D, 7, 2, stereo_3d_func_txt);
 | |
| 
 | |
| static const char *alc_func_txt[] = {"Off", "Right", "Left", "Stereo"};
 | |
| static const struct soc_enum alc_func =
 | |
| 	SOC_ENUM_SINGLE(WM8988_ALC1, 7, 4, alc_func_txt);
 | |
| 
 | |
| static const char *ng_type_txt[] = {"Constant PGA Gain",
 | |
| 				    "Mute ADC Output"};
 | |
| static const struct soc_enum ng_type =
 | |
| 	SOC_ENUM_SINGLE(WM8988_NGATE, 1, 2, ng_type_txt);
 | |
| 
 | |
| static const char *deemph_txt[] = {"None", "32Khz", "44.1Khz", "48Khz"};
 | |
| static const struct soc_enum deemph =
 | |
| 	SOC_ENUM_SINGLE(WM8988_ADCDAC, 1, 4, deemph_txt);
 | |
| 
 | |
| static const char *adcpol_txt[] = {"Normal", "L Invert", "R Invert",
 | |
| 				   "L + R Invert"};
 | |
| static const struct soc_enum adcpol =
 | |
| 	SOC_ENUM_SINGLE(WM8988_ADCDAC, 5, 4, adcpol_txt);
 | |
| 
 | |
| static const DECLARE_TLV_DB_SCALE(pga_tlv, -1725, 75, 0);
 | |
| static const DECLARE_TLV_DB_SCALE(adc_tlv, -9750, 50, 1);
 | |
| static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1);
 | |
| static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1);
 | |
| static const DECLARE_TLV_DB_SCALE(bypass_tlv, -1500, 300, 0);
 | |
| 
 | |
| static const struct snd_kcontrol_new wm8988_snd_controls[] = {
 | |
| 
 | |
| SOC_ENUM("Bass Boost", bass_boost),
 | |
| SOC_ENUM("Bass Filter", bass_filter),
 | |
| SOC_SINGLE("Bass Volume", WM8988_BASS, 0, 15, 1),
 | |
| 
 | |
| SOC_SINGLE("Treble Volume", WM8988_TREBLE, 0, 15, 0),
 | |
| SOC_ENUM("Treble Cut-off", treble),
 | |
| 
 | |
| SOC_SINGLE("3D Switch", WM8988_3D, 0, 1, 0),
 | |
| SOC_SINGLE("3D Volume", WM8988_3D, 1, 15, 0),
 | |
| SOC_ENUM("3D Lower Cut-off", stereo_3d_lc),
 | |
| SOC_ENUM("3D Upper Cut-off", stereo_3d_uc),
 | |
| SOC_ENUM("3D Mode", stereo_3d_func),
 | |
| 
 | |
| SOC_SINGLE("ALC Capture Target Volume", WM8988_ALC1, 0, 7, 0),
 | |
| SOC_SINGLE("ALC Capture Max Volume", WM8988_ALC1, 4, 7, 0),
 | |
| SOC_ENUM("ALC Capture Function", alc_func),
 | |
| SOC_SINGLE("ALC Capture ZC Switch", WM8988_ALC2, 7, 1, 0),
 | |
| SOC_SINGLE("ALC Capture Hold Time", WM8988_ALC2, 0, 15, 0),
 | |
| SOC_SINGLE("ALC Capture Decay Time", WM8988_ALC3, 4, 15, 0),
 | |
| SOC_SINGLE("ALC Capture Attack Time", WM8988_ALC3, 0, 15, 0),
 | |
| SOC_SINGLE("ALC Capture NG Threshold", WM8988_NGATE, 3, 31, 0),
 | |
| SOC_ENUM("ALC Capture NG Type", ng_type),
 | |
| SOC_SINGLE("ALC Capture NG Switch", WM8988_NGATE, 0, 1, 0),
 | |
| 
 | |
| SOC_SINGLE("ZC Timeout Switch", WM8988_ADCTL1, 0, 1, 0),
 | |
| 
 | |
| SOC_DOUBLE_R_TLV("Capture Digital Volume", WM8988_LADC, WM8988_RADC,
 | |
| 		 0, 255, 0, adc_tlv),
 | |
| SOC_DOUBLE_R_TLV("Capture Volume", WM8988_LINVOL, WM8988_RINVOL,
 | |
| 		 0, 63, 0, pga_tlv),
 | |
| SOC_DOUBLE_R("Capture ZC Switch", WM8988_LINVOL, WM8988_RINVOL, 6, 1, 0),
 | |
| SOC_DOUBLE_R("Capture Switch", WM8988_LINVOL, WM8988_RINVOL, 7, 1, 1),
 | |
| 
 | |
| SOC_ENUM("Playback De-emphasis", deemph),
 | |
| 
 | |
| SOC_ENUM("Capture Polarity", adcpol),
 | |
| SOC_SINGLE("Playback 6dB Attenuate", WM8988_ADCDAC, 7, 1, 0),
 | |
| SOC_SINGLE("Capture 6dB Attenuate", WM8988_ADCDAC, 8, 1, 0),
 | |
| 
 | |
| SOC_DOUBLE_R_TLV("PCM Volume", WM8988_LDAC, WM8988_RDAC, 0, 255, 0, dac_tlv),
 | |
| 
 | |
| SOC_SINGLE_TLV("Left Mixer Left Bypass Volume", WM8988_LOUTM1, 4, 7, 1,
 | |
| 	       bypass_tlv),
 | |
| SOC_SINGLE_TLV("Left Mixer Right Bypass Volume", WM8988_LOUTM2, 4, 7, 1,
 | |
| 	       bypass_tlv),
 | |
| SOC_SINGLE_TLV("Right Mixer Left Bypass Volume", WM8988_ROUTM1, 4, 7, 1,
 | |
| 	       bypass_tlv),
 | |
| SOC_SINGLE_TLV("Right Mixer Right Bypass Volume", WM8988_ROUTM2, 4, 7, 1,
 | |
| 	       bypass_tlv),
 | |
| 
 | |
| SOC_DOUBLE_R("Output 1 Playback ZC Switch", WM8988_LOUT1V,
 | |
| 	     WM8988_ROUT1V, 7, 1, 0),
 | |
| SOC_DOUBLE_R_TLV("Output 1 Playback Volume", WM8988_LOUT1V, WM8988_ROUT1V,
 | |
| 		 0, 127, 0, out_tlv),
 | |
| 
 | |
| SOC_DOUBLE_R("Output 2 Playback ZC Switch", WM8988_LOUT2V,
 | |
| 	     WM8988_ROUT2V, 7, 1, 0),
 | |
| SOC_DOUBLE_R_TLV("Output 2 Playback Volume", WM8988_LOUT2V, WM8988_ROUT2V,
 | |
| 		 0, 127, 0, out_tlv),
 | |
| 
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * DAPM Controls
 | |
|  */
 | |
| 
 | |
| static int wm8988_lrc_control(struct snd_soc_dapm_widget *w,
 | |
| 			      struct snd_kcontrol *kcontrol, int event)
 | |
| {
 | |
| 	struct snd_soc_codec *codec = w->codec;
 | |
| 	u16 adctl2 = snd_soc_read(codec, WM8988_ADCTL2);
 | |
| 
 | |
| 	/* Use the DAC to gate LRC if active, otherwise use ADC */
 | |
| 	if (snd_soc_read(codec, WM8988_PWR2) & 0x180)
 | |
| 		adctl2 &= ~0x4;
 | |
| 	else
 | |
| 		adctl2 |= 0x4;
 | |
| 
 | |
| 	return snd_soc_write(codec, WM8988_ADCTL2, adctl2);
 | |
| }
 | |
| 
 | |
| static const char *wm8988_line_texts[] = {
 | |
| 	"Line 1", "Line 2", "PGA", "Differential"};
 | |
| 
 | |
| static const unsigned int wm8988_line_values[] = {
 | |
| 	0, 1, 3, 4};
 | |
| 
 | |
| static const struct soc_enum wm8988_lline_enum =
 | |
| 	SOC_VALUE_ENUM_SINGLE(WM8988_LOUTM1, 0, 7,
 | |
| 			      ARRAY_SIZE(wm8988_line_texts),
 | |
| 			      wm8988_line_texts,
 | |
| 			      wm8988_line_values);
 | |
| static const struct snd_kcontrol_new wm8988_left_line_controls =
 | |
| 	SOC_DAPM_VALUE_ENUM("Route", wm8988_lline_enum);
 | |
| 
 | |
| static const struct soc_enum wm8988_rline_enum =
 | |
| 	SOC_VALUE_ENUM_SINGLE(WM8988_ROUTM1, 0, 7,
 | |
| 			      ARRAY_SIZE(wm8988_line_texts),
 | |
| 			      wm8988_line_texts,
 | |
| 			      wm8988_line_values);
 | |
| static const struct snd_kcontrol_new wm8988_right_line_controls =
 | |
| 	SOC_DAPM_VALUE_ENUM("Route", wm8988_lline_enum);
 | |
| 
 | |
| /* Left Mixer */
 | |
| static const struct snd_kcontrol_new wm8988_left_mixer_controls[] = {
 | |
| 	SOC_DAPM_SINGLE("Playback Switch", WM8988_LOUTM1, 8, 1, 0),
 | |
| 	SOC_DAPM_SINGLE("Left Bypass Switch", WM8988_LOUTM1, 7, 1, 0),
 | |
| 	SOC_DAPM_SINGLE("Right Playback Switch", WM8988_LOUTM2, 8, 1, 0),
 | |
| 	SOC_DAPM_SINGLE("Right Bypass Switch", WM8988_LOUTM2, 7, 1, 0),
 | |
| };
 | |
| 
 | |
| /* Right Mixer */
 | |
| static const struct snd_kcontrol_new wm8988_right_mixer_controls[] = {
 | |
| 	SOC_DAPM_SINGLE("Left Playback Switch", WM8988_ROUTM1, 8, 1, 0),
 | |
| 	SOC_DAPM_SINGLE("Left Bypass Switch", WM8988_ROUTM1, 7, 1, 0),
 | |
| 	SOC_DAPM_SINGLE("Playback Switch", WM8988_ROUTM2, 8, 1, 0),
 | |
| 	SOC_DAPM_SINGLE("Right Bypass Switch", WM8988_ROUTM2, 7, 1, 0),
 | |
| };
 | |
| 
 | |
| static const char *wm8988_pga_sel[] = {"Line 1", "Line 2", "Differential"};
 | |
| static const unsigned int wm8988_pga_val[] = { 0, 1, 3 };
 | |
| 
 | |
| /* Left PGA Mux */
 | |
| static const struct soc_enum wm8988_lpga_enum =
 | |
| 	SOC_VALUE_ENUM_SINGLE(WM8988_LADCIN, 6, 3,
 | |
| 			      ARRAY_SIZE(wm8988_pga_sel),
 | |
| 			      wm8988_pga_sel,
 | |
| 			      wm8988_pga_val);
 | |
| static const struct snd_kcontrol_new wm8988_left_pga_controls =
 | |
| 	SOC_DAPM_VALUE_ENUM("Route", wm8988_lpga_enum);
 | |
| 
 | |
| /* Right PGA Mux */
 | |
| static const struct soc_enum wm8988_rpga_enum =
 | |
| 	SOC_VALUE_ENUM_SINGLE(WM8988_RADCIN, 6, 3,
 | |
| 			      ARRAY_SIZE(wm8988_pga_sel),
 | |
| 			      wm8988_pga_sel,
 | |
| 			      wm8988_pga_val);
 | |
| static const struct snd_kcontrol_new wm8988_right_pga_controls =
 | |
| 	SOC_DAPM_VALUE_ENUM("Route", wm8988_rpga_enum);
 | |
| 
 | |
| /* Differential Mux */
 | |
| static const char *wm8988_diff_sel[] = {"Line 1", "Line 2"};
 | |
| static const struct soc_enum diffmux =
 | |
| 	SOC_ENUM_SINGLE(WM8988_ADCIN, 8, 2, wm8988_diff_sel);
 | |
| static const struct snd_kcontrol_new wm8988_diffmux_controls =
 | |
| 	SOC_DAPM_ENUM("Route", diffmux);
 | |
| 
 | |
| /* Mono ADC Mux */
 | |
| static const char *wm8988_mono_mux[] = {"Stereo", "Mono (Left)",
 | |
| 	"Mono (Right)", "Digital Mono"};
 | |
| static const struct soc_enum monomux =
 | |
| 	SOC_ENUM_SINGLE(WM8988_ADCIN, 6, 4, wm8988_mono_mux);
 | |
| static const struct snd_kcontrol_new wm8988_monomux_controls =
 | |
| 	SOC_DAPM_ENUM("Route", monomux);
 | |
| 
 | |
| static const struct snd_soc_dapm_widget wm8988_dapm_widgets[] = {
 | |
| 	SND_SOC_DAPM_MICBIAS("Mic Bias", WM8988_PWR1, 1, 0),
 | |
| 
 | |
| 	SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0,
 | |
| 		&wm8988_diffmux_controls),
 | |
| 	SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0,
 | |
| 		&wm8988_monomux_controls),
 | |
| 	SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0,
 | |
| 		&wm8988_monomux_controls),
 | |
| 
 | |
| 	SND_SOC_DAPM_MUX("Left PGA Mux", WM8988_PWR1, 5, 0,
 | |
| 		&wm8988_left_pga_controls),
 | |
| 	SND_SOC_DAPM_MUX("Right PGA Mux", WM8988_PWR1, 4, 0,
 | |
| 		&wm8988_right_pga_controls),
 | |
| 
 | |
| 	SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0,
 | |
| 		&wm8988_left_line_controls),
 | |
| 	SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0,
 | |
| 		&wm8988_right_line_controls),
 | |
| 
 | |
| 	SND_SOC_DAPM_ADC("Right ADC", "Right Capture", WM8988_PWR1, 2, 0),
 | |
| 	SND_SOC_DAPM_ADC("Left ADC", "Left Capture", WM8988_PWR1, 3, 0),
 | |
| 
 | |
| 	SND_SOC_DAPM_DAC("Right DAC", "Right Playback", WM8988_PWR2, 7, 0),
 | |
| 	SND_SOC_DAPM_DAC("Left DAC", "Left Playback", WM8988_PWR2, 8, 0),
 | |
| 
 | |
| 	SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0,
 | |
| 		&wm8988_left_mixer_controls[0],
 | |
| 		ARRAY_SIZE(wm8988_left_mixer_controls)),
 | |
| 	SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0,
 | |
| 		&wm8988_right_mixer_controls[0],
 | |
| 		ARRAY_SIZE(wm8988_right_mixer_controls)),
 | |
| 
 | |
| 	SND_SOC_DAPM_PGA("Right Out 2", WM8988_PWR2, 3, 0, NULL, 0),
 | |
| 	SND_SOC_DAPM_PGA("Left Out 2", WM8988_PWR2, 4, 0, NULL, 0),
 | |
| 	SND_SOC_DAPM_PGA("Right Out 1", WM8988_PWR2, 5, 0, NULL, 0),
 | |
| 	SND_SOC_DAPM_PGA("Left Out 1", WM8988_PWR2, 6, 0, NULL, 0),
 | |
| 
 | |
| 	SND_SOC_DAPM_POST("LRC control", wm8988_lrc_control),
 | |
| 
 | |
| 	SND_SOC_DAPM_OUTPUT("LOUT1"),
 | |
| 	SND_SOC_DAPM_OUTPUT("ROUT1"),
 | |
| 	SND_SOC_DAPM_OUTPUT("LOUT2"),
 | |
| 	SND_SOC_DAPM_OUTPUT("ROUT2"),
 | |
| 	SND_SOC_DAPM_OUTPUT("VREF"),
 | |
| 
 | |
| 	SND_SOC_DAPM_INPUT("LINPUT1"),
 | |
| 	SND_SOC_DAPM_INPUT("LINPUT2"),
 | |
| 	SND_SOC_DAPM_INPUT("RINPUT1"),
 | |
| 	SND_SOC_DAPM_INPUT("RINPUT2"),
 | |
| };
 | |
| 
 | |
| static const struct snd_soc_dapm_route audio_map[] = {
 | |
| 
 | |
| 	{ "Left Line Mux", "Line 1", "LINPUT1" },
 | |
| 	{ "Left Line Mux", "Line 2", "LINPUT2" },
 | |
| 	{ "Left Line Mux", "PGA", "Left PGA Mux" },
 | |
| 	{ "Left Line Mux", "Differential", "Differential Mux" },
 | |
| 
 | |
| 	{ "Right Line Mux", "Line 1", "RINPUT1" },
 | |
| 	{ "Right Line Mux", "Line 2", "RINPUT2" },
 | |
| 	{ "Right Line Mux", "PGA", "Right PGA Mux" },
 | |
| 	{ "Right Line Mux", "Differential", "Differential Mux" },
 | |
| 
 | |
| 	{ "Left PGA Mux", "Line 1", "LINPUT1" },
 | |
| 	{ "Left PGA Mux", "Line 2", "LINPUT2" },
 | |
| 	{ "Left PGA Mux", "Differential", "Differential Mux" },
 | |
| 
 | |
| 	{ "Right PGA Mux", "Line 1", "RINPUT1" },
 | |
| 	{ "Right PGA Mux", "Line 2", "RINPUT2" },
 | |
| 	{ "Right PGA Mux", "Differential", "Differential Mux" },
 | |
| 
 | |
| 	{ "Differential Mux", "Line 1", "LINPUT1" },
 | |
| 	{ "Differential Mux", "Line 1", "RINPUT1" },
 | |
| 	{ "Differential Mux", "Line 2", "LINPUT2" },
 | |
| 	{ "Differential Mux", "Line 2", "RINPUT2" },
 | |
| 
 | |
| 	{ "Left ADC Mux", "Stereo", "Left PGA Mux" },
 | |
| 	{ "Left ADC Mux", "Mono (Left)", "Left PGA Mux" },
 | |
| 	{ "Left ADC Mux", "Digital Mono", "Left PGA Mux" },
 | |
| 
 | |
| 	{ "Right ADC Mux", "Stereo", "Right PGA Mux" },
 | |
| 	{ "Right ADC Mux", "Mono (Right)", "Right PGA Mux" },
 | |
| 	{ "Right ADC Mux", "Digital Mono", "Right PGA Mux" },
 | |
| 
 | |
| 	{ "Left ADC", NULL, "Left ADC Mux" },
 | |
| 	{ "Right ADC", NULL, "Right ADC Mux" },
 | |
| 
 | |
| 	{ "Left Line Mux", "Line 1", "LINPUT1" },
 | |
| 	{ "Left Line Mux", "Line 2", "LINPUT2" },
 | |
| 	{ "Left Line Mux", "PGA", "Left PGA Mux" },
 | |
| 	{ "Left Line Mux", "Differential", "Differential Mux" },
 | |
| 
 | |
| 	{ "Right Line Mux", "Line 1", "RINPUT1" },
 | |
| 	{ "Right Line Mux", "Line 2", "RINPUT2" },
 | |
| 	{ "Right Line Mux", "PGA", "Right PGA Mux" },
 | |
| 	{ "Right Line Mux", "Differential", "Differential Mux" },
 | |
| 
 | |
| 	{ "Left Mixer", "Playback Switch", "Left DAC" },
 | |
| 	{ "Left Mixer", "Left Bypass Switch", "Left Line Mux" },
 | |
| 	{ "Left Mixer", "Right Playback Switch", "Right DAC" },
 | |
| 	{ "Left Mixer", "Right Bypass Switch", "Right Line Mux" },
 | |
| 
 | |
| 	{ "Right Mixer", "Left Playback Switch", "Left DAC" },
 | |
| 	{ "Right Mixer", "Left Bypass Switch", "Left Line Mux" },
 | |
| 	{ "Right Mixer", "Playback Switch", "Right DAC" },
 | |
| 	{ "Right Mixer", "Right Bypass Switch", "Right Line Mux" },
 | |
| 
 | |
| 	{ "Left Out 1", NULL, "Left Mixer" },
 | |
| 	{ "LOUT1", NULL, "Left Out 1" },
 | |
| 	{ "Right Out 1", NULL, "Right Mixer" },
 | |
| 	{ "ROUT1", NULL, "Right Out 1" },
 | |
| 
 | |
| 	{ "Left Out 2", NULL, "Left Mixer" },
 | |
| 	{ "LOUT2", NULL, "Left Out 2" },
 | |
| 	{ "Right Out 2", NULL, "Right Mixer" },
 | |
| 	{ "ROUT2", NULL, "Right Out 2" },
 | |
| };
 | |
| 
 | |
| struct _coeff_div {
 | |
| 	u32 mclk;
 | |
| 	u32 rate;
 | |
| 	u16 fs;
 | |
| 	u8 sr:5;
 | |
| 	u8 usb:1;
 | |
| };
 | |
| 
 | |
| /* codec hifi mclk clock divider coefficients */
 | |
| static const struct _coeff_div coeff_div[] = {
 | |
| 	/* 8k */
 | |
| 	{12288000, 8000, 1536, 0x6, 0x0},
 | |
| 	{11289600, 8000, 1408, 0x16, 0x0},
 | |
| 	{18432000, 8000, 2304, 0x7, 0x0},
 | |
| 	{16934400, 8000, 2112, 0x17, 0x0},
 | |
| 	{12000000, 8000, 1500, 0x6, 0x1},
 | |
| 
 | |
| 	/* 11.025k */
 | |
| 	{11289600, 11025, 1024, 0x18, 0x0},
 | |
| 	{16934400, 11025, 1536, 0x19, 0x0},
 | |
| 	{12000000, 11025, 1088, 0x19, 0x1},
 | |
| 
 | |
| 	/* 16k */
 | |
| 	{12288000, 16000, 768, 0xa, 0x0},
 | |
| 	{18432000, 16000, 1152, 0xb, 0x0},
 | |
| 	{12000000, 16000, 750, 0xa, 0x1},
 | |
| 
 | |
| 	/* 22.05k */
 | |
| 	{11289600, 22050, 512, 0x1a, 0x0},
 | |
| 	{16934400, 22050, 768, 0x1b, 0x0},
 | |
| 	{12000000, 22050, 544, 0x1b, 0x1},
 | |
| 
 | |
| 	/* 32k */
 | |
| 	{12288000, 32000, 384, 0xc, 0x0},
 | |
| 	{18432000, 32000, 576, 0xd, 0x0},
 | |
| 	{12000000, 32000, 375, 0xa, 0x1},
 | |
| 
 | |
| 	/* 44.1k */
 | |
| 	{11289600, 44100, 256, 0x10, 0x0},
 | |
| 	{16934400, 44100, 384, 0x11, 0x0},
 | |
| 	{12000000, 44100, 272, 0x11, 0x1},
 | |
| 
 | |
| 	/* 48k */
 | |
| 	{12288000, 48000, 256, 0x0, 0x0},
 | |
| 	{18432000, 48000, 384, 0x1, 0x0},
 | |
| 	{12000000, 48000, 250, 0x0, 0x1},
 | |
| 
 | |
| 	/* 88.2k */
 | |
| 	{11289600, 88200, 128, 0x1e, 0x0},
 | |
| 	{16934400, 88200, 192, 0x1f, 0x0},
 | |
| 	{12000000, 88200, 136, 0x1f, 0x1},
 | |
| 
 | |
| 	/* 96k */
 | |
| 	{12288000, 96000, 128, 0xe, 0x0},
 | |
| 	{18432000, 96000, 192, 0xf, 0x0},
 | |
| 	{12000000, 96000, 125, 0xe, 0x1},
 | |
| };
 | |
| 
 | |
| static inline int get_coeff(int mclk, int rate)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
 | |
| 		if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
 | |
| 			return i;
 | |
| 	}
 | |
| 
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| /* The set of rates we can generate from the above for each SYSCLK */
 | |
| 
 | |
| static unsigned int rates_12288[] = {
 | |
| 	8000, 12000, 16000, 24000, 24000, 32000, 48000, 96000,
 | |
| };
 | |
| 
 | |
| static struct snd_pcm_hw_constraint_list constraints_12288 = {
 | |
| 	.count	= ARRAY_SIZE(rates_12288),
 | |
| 	.list	= rates_12288,
 | |
| };
 | |
| 
 | |
| static unsigned int rates_112896[] = {
 | |
| 	8000, 11025, 22050, 44100,
 | |
| };
 | |
| 
 | |
| static struct snd_pcm_hw_constraint_list constraints_112896 = {
 | |
| 	.count	= ARRAY_SIZE(rates_112896),
 | |
| 	.list	= rates_112896,
 | |
| };
 | |
| 
 | |
| static unsigned int rates_12[] = {
 | |
| 	8000, 11025, 12000, 16000, 22050, 2400, 32000, 41100, 48000,
 | |
| 	48000, 88235, 96000,
 | |
| };
 | |
| 
 | |
| static struct snd_pcm_hw_constraint_list constraints_12 = {
 | |
| 	.count	= ARRAY_SIZE(rates_12),
 | |
| 	.list	= rates_12,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * Note that this should be called from init rather than from hw_params.
 | |
|  */
 | |
| static int wm8988_set_dai_sysclk(struct snd_soc_dai *codec_dai,
 | |
| 		int clk_id, unsigned int freq, int dir)
 | |
| {
 | |
| 	struct snd_soc_codec *codec = codec_dai->codec;
 | |
| 	struct wm8988_priv *wm8988 = codec->private_data;
 | |
| 
 | |
| 	switch (freq) {
 | |
| 	case 11289600:
 | |
| 	case 18432000:
 | |
| 	case 22579200:
 | |
| 	case 36864000:
 | |
| 		wm8988->sysclk_constraints = &constraints_112896;
 | |
| 		wm8988->sysclk = freq;
 | |
| 		return 0;
 | |
| 
 | |
| 	case 12288000:
 | |
| 	case 16934400:
 | |
| 	case 24576000:
 | |
| 	case 33868800:
 | |
| 		wm8988->sysclk_constraints = &constraints_12288;
 | |
| 		wm8988->sysclk = freq;
 | |
| 		return 0;
 | |
| 
 | |
| 	case 12000000:
 | |
| 	case 24000000:
 | |
| 		wm8988->sysclk_constraints = &constraints_12;
 | |
| 		wm8988->sysclk = freq;
 | |
| 		return 0;
 | |
| 	}
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int wm8988_set_dai_fmt(struct snd_soc_dai *codec_dai,
 | |
| 		unsigned int fmt)
 | |
| {
 | |
| 	struct snd_soc_codec *codec = codec_dai->codec;
 | |
| 	u16 iface = 0;
 | |
| 
 | |
| 	/* set master/slave audio interface */
 | |
| 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 | |
| 	case SND_SOC_DAIFMT_CBM_CFM:
 | |
| 		iface = 0x0040;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_CBS_CFS:
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	/* interface format */
 | |
| 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 | |
| 	case SND_SOC_DAIFMT_I2S:
 | |
| 		iface |= 0x0002;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_RIGHT_J:
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_LEFT_J:
 | |
| 		iface |= 0x0001;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_DSP_A:
 | |
| 		iface |= 0x0003;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_DSP_B:
 | |
| 		iface |= 0x0013;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	/* clock inversion */
 | |
| 	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
 | |
| 	case SND_SOC_DAIFMT_NB_NF:
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_IB_IF:
 | |
| 		iface |= 0x0090;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_IB_NF:
 | |
| 		iface |= 0x0080;
 | |
| 		break;
 | |
| 	case SND_SOC_DAIFMT_NB_IF:
 | |
| 		iface |= 0x0010;
 | |
| 		break;
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	snd_soc_write(codec, WM8988_IFACE, iface);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int wm8988_pcm_startup(struct snd_pcm_substream *substream,
 | |
| 			      struct snd_soc_dai *dai)
 | |
| {
 | |
| 	struct snd_soc_codec *codec = dai->codec;
 | |
| 	struct wm8988_priv *wm8988 = codec->private_data;
 | |
| 
 | |
| 	/* The set of sample rates that can be supported depends on the
 | |
| 	 * MCLK supplied to the CODEC - enforce this.
 | |
| 	 */
 | |
| 	if (!wm8988->sysclk) {
 | |
| 		dev_err(codec->dev,
 | |
| 			"No MCLK configured, call set_sysclk() on init\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	snd_pcm_hw_constraint_list(substream->runtime, 0,
 | |
| 				   SNDRV_PCM_HW_PARAM_RATE,
 | |
| 				   wm8988->sysclk_constraints);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int wm8988_pcm_hw_params(struct snd_pcm_substream *substream,
 | |
| 				struct snd_pcm_hw_params *params,
 | |
| 				struct snd_soc_dai *dai)
 | |
| {
 | |
| 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
 | |
| 	struct snd_soc_device *socdev = rtd->socdev;
 | |
| 	struct snd_soc_codec *codec = socdev->card->codec;
 | |
| 	struct wm8988_priv *wm8988 = codec->private_data;
 | |
| 	u16 iface = snd_soc_read(codec, WM8988_IFACE) & 0x1f3;
 | |
| 	u16 srate = snd_soc_read(codec, WM8988_SRATE) & 0x180;
 | |
| 	int coeff;
 | |
| 
 | |
| 	coeff = get_coeff(wm8988->sysclk, params_rate(params));
 | |
| 	if (coeff < 0) {
 | |
| 		coeff = get_coeff(wm8988->sysclk / 2, params_rate(params));
 | |
| 		srate |= 0x40;
 | |
| 	}
 | |
| 	if (coeff < 0) {
 | |
| 		dev_err(codec->dev,
 | |
| 			"Unable to configure sample rate %dHz with %dHz MCLK\n",
 | |
| 			params_rate(params), wm8988->sysclk);
 | |
| 		return coeff;
 | |
| 	}
 | |
| 
 | |
| 	/* bit size */
 | |
| 	switch (params_format(params)) {
 | |
| 	case SNDRV_PCM_FORMAT_S16_LE:
 | |
| 		break;
 | |
| 	case SNDRV_PCM_FORMAT_S20_3LE:
 | |
| 		iface |= 0x0004;
 | |
| 		break;
 | |
| 	case SNDRV_PCM_FORMAT_S24_LE:
 | |
| 		iface |= 0x0008;
 | |
| 		break;
 | |
| 	case SNDRV_PCM_FORMAT_S32_LE:
 | |
| 		iface |= 0x000c;
 | |
| 		break;
 | |
| 	}
 | |
| 
 | |
| 	/* set iface & srate */
 | |
| 	snd_soc_write(codec, WM8988_IFACE, iface);
 | |
| 	if (coeff >= 0)
 | |
| 		snd_soc_write(codec, WM8988_SRATE, srate |
 | |
| 			(coeff_div[coeff].sr << 1) | coeff_div[coeff].usb);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int wm8988_mute(struct snd_soc_dai *dai, int mute)
 | |
| {
 | |
| 	struct snd_soc_codec *codec = dai->codec;
 | |
| 	u16 mute_reg = snd_soc_read(codec, WM8988_ADCDAC) & 0xfff7;
 | |
| 
 | |
| 	if (mute)
 | |
| 		snd_soc_write(codec, WM8988_ADCDAC, mute_reg | 0x8);
 | |
| 	else
 | |
| 		snd_soc_write(codec, WM8988_ADCDAC, mute_reg);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int wm8988_set_bias_level(struct snd_soc_codec *codec,
 | |
| 				 enum snd_soc_bias_level level)
 | |
| {
 | |
| 	u16 pwr_reg = snd_soc_read(codec, WM8988_PWR1) & ~0x1c1;
 | |
| 
 | |
| 	switch (level) {
 | |
| 	case SND_SOC_BIAS_ON:
 | |
| 		break;
 | |
| 
 | |
| 	case SND_SOC_BIAS_PREPARE:
 | |
| 		/* VREF, VMID=2x50k, digital enabled */
 | |
| 		snd_soc_write(codec, WM8988_PWR1, pwr_reg | 0x00c0);
 | |
| 		break;
 | |
| 
 | |
| 	case SND_SOC_BIAS_STANDBY:
 | |
| 		if (codec->bias_level == SND_SOC_BIAS_OFF) {
 | |
| 			/* VREF, VMID=2x5k */
 | |
| 			snd_soc_write(codec, WM8988_PWR1, pwr_reg | 0x1c1);
 | |
| 
 | |
| 			/* Charge caps */
 | |
| 			msleep(100);
 | |
| 		}
 | |
| 
 | |
| 		/* VREF, VMID=2*500k, digital stopped */
 | |
| 		snd_soc_write(codec, WM8988_PWR1, pwr_reg | 0x0141);
 | |
| 		break;
 | |
| 
 | |
| 	case SND_SOC_BIAS_OFF:
 | |
| 		snd_soc_write(codec, WM8988_PWR1, 0x0000);
 | |
| 		break;
 | |
| 	}
 | |
| 	codec->bias_level = level;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #define WM8988_RATES SNDRV_PCM_RATE_8000_96000
 | |
| 
 | |
| #define WM8988_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
 | |
| 	SNDRV_PCM_FMTBIT_S24_LE)
 | |
| 
 | |
| static struct snd_soc_dai_ops wm8988_ops = {
 | |
| 	.startup = wm8988_pcm_startup,
 | |
| 	.hw_params = wm8988_pcm_hw_params,
 | |
| 	.set_fmt = wm8988_set_dai_fmt,
 | |
| 	.set_sysclk = wm8988_set_dai_sysclk,
 | |
| 	.digital_mute = wm8988_mute,
 | |
| };
 | |
| 
 | |
| struct snd_soc_dai wm8988_dai = {
 | |
| 	.name = "WM8988",
 | |
| 	.playback = {
 | |
| 		.stream_name = "Playback",
 | |
| 		.channels_min = 1,
 | |
| 		.channels_max = 2,
 | |
| 		.rates = WM8988_RATES,
 | |
| 		.formats = WM8988_FORMATS,
 | |
| 	},
 | |
| 	.capture = {
 | |
| 		.stream_name = "Capture",
 | |
| 		.channels_min = 1,
 | |
| 		.channels_max = 2,
 | |
| 		.rates = WM8988_RATES,
 | |
| 		.formats = WM8988_FORMATS,
 | |
| 	 },
 | |
| 	.ops = &wm8988_ops,
 | |
| 	.symmetric_rates = 1,
 | |
| };
 | |
| EXPORT_SYMBOL_GPL(wm8988_dai);
 | |
| 
 | |
| static int wm8988_suspend(struct platform_device *pdev, pm_message_t state)
 | |
| {
 | |
| 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 | |
| 	struct snd_soc_codec *codec = socdev->card->codec;
 | |
| 
 | |
| 	wm8988_set_bias_level(codec, SND_SOC_BIAS_OFF);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int wm8988_resume(struct platform_device *pdev)
 | |
| {
 | |
| 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 | |
| 	struct snd_soc_codec *codec = socdev->card->codec;
 | |
| 	int i;
 | |
| 	u8 data[2];
 | |
| 	u16 *cache = codec->reg_cache;
 | |
| 
 | |
| 	/* Sync reg_cache with the hardware */
 | |
| 	for (i = 0; i < WM8988_NUM_REG; i++) {
 | |
| 		if (i == WM8988_RESET)
 | |
| 			continue;
 | |
| 		data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
 | |
| 		data[1] = cache[i] & 0x00ff;
 | |
| 		codec->hw_write(codec->control_data, data, 2);
 | |
| 	}
 | |
| 
 | |
| 	wm8988_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static struct snd_soc_codec *wm8988_codec;
 | |
| 
 | |
| static int wm8988_probe(struct platform_device *pdev)
 | |
| {
 | |
| 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 | |
| 	struct snd_soc_codec *codec;
 | |
| 	int ret = 0;
 | |
| 
 | |
| 	if (wm8988_codec == NULL) {
 | |
| 		dev_err(&pdev->dev, "Codec device not registered\n");
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	socdev->card->codec = wm8988_codec;
 | |
| 	codec = wm8988_codec;
 | |
| 
 | |
| 	/* register pcms */
 | |
| 	ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(codec->dev, "failed to create pcms: %d\n", ret);
 | |
| 		goto pcm_err;
 | |
| 	}
 | |
| 
 | |
| 	snd_soc_add_controls(codec, wm8988_snd_controls,
 | |
| 				ARRAY_SIZE(wm8988_snd_controls));
 | |
| 	snd_soc_dapm_new_controls(codec, wm8988_dapm_widgets,
 | |
| 				  ARRAY_SIZE(wm8988_dapm_widgets));
 | |
| 	snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
 | |
| 	snd_soc_dapm_new_widgets(codec);
 | |
| 
 | |
| 	ret = snd_soc_init_card(socdev);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(codec->dev, "failed to register card: %d\n", ret);
 | |
| 		goto card_err;
 | |
| 	}
 | |
| 
 | |
| 	return ret;
 | |
| 
 | |
| card_err:
 | |
| 	snd_soc_free_pcms(socdev);
 | |
| 	snd_soc_dapm_free(socdev);
 | |
| pcm_err:
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static int wm8988_remove(struct platform_device *pdev)
 | |
| {
 | |
| 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 | |
| 
 | |
| 	snd_soc_free_pcms(socdev);
 | |
| 	snd_soc_dapm_free(socdev);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| struct snd_soc_codec_device soc_codec_dev_wm8988 = {
 | |
| 	.probe = 	wm8988_probe,
 | |
| 	.remove = 	wm8988_remove,
 | |
| 	.suspend = 	wm8988_suspend,
 | |
| 	.resume =	wm8988_resume,
 | |
| };
 | |
| EXPORT_SYMBOL_GPL(soc_codec_dev_wm8988);
 | |
| 
 | |
| static int wm8988_register(struct wm8988_priv *wm8988,
 | |
| 			   enum snd_soc_control_type control)
 | |
| {
 | |
| 	struct snd_soc_codec *codec = &wm8988->codec;
 | |
| 	int ret;
 | |
| 	u16 reg;
 | |
| 
 | |
| 	if (wm8988_codec) {
 | |
| 		dev_err(codec->dev, "Another WM8988 is registered\n");
 | |
| 		ret = -EINVAL;
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	mutex_init(&codec->mutex);
 | |
| 	INIT_LIST_HEAD(&codec->dapm_widgets);
 | |
| 	INIT_LIST_HEAD(&codec->dapm_paths);
 | |
| 
 | |
| 	codec->private_data = wm8988;
 | |
| 	codec->name = "WM8988";
 | |
| 	codec->owner = THIS_MODULE;
 | |
| 	codec->dai = &wm8988_dai;
 | |
| 	codec->num_dai = 1;
 | |
| 	codec->reg_cache_size = ARRAY_SIZE(wm8988->reg_cache);
 | |
| 	codec->reg_cache = &wm8988->reg_cache;
 | |
| 	codec->bias_level = SND_SOC_BIAS_OFF;
 | |
| 	codec->set_bias_level = wm8988_set_bias_level;
 | |
| 
 | |
| 	memcpy(codec->reg_cache, wm8988_reg,
 | |
| 	       sizeof(wm8988_reg));
 | |
| 
 | |
| 	ret = snd_soc_codec_set_cache_io(codec, 7, 9, control);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	ret = wm8988_reset(codec);
 | |
| 	if (ret < 0) {
 | |
| 		dev_err(codec->dev, "Failed to issue reset\n");
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	/* set the update bits (we always update left then right) */
 | |
| 	reg = snd_soc_read(codec, WM8988_RADC);
 | |
| 	snd_soc_write(codec, WM8988_RADC, reg | 0x100);
 | |
| 	reg = snd_soc_read(codec, WM8988_RDAC);
 | |
| 	snd_soc_write(codec, WM8988_RDAC, reg | 0x0100);
 | |
| 	reg = snd_soc_read(codec, WM8988_ROUT1V);
 | |
| 	snd_soc_write(codec, WM8988_ROUT1V, reg | 0x0100);
 | |
| 	reg = snd_soc_read(codec, WM8988_ROUT2V);
 | |
| 	snd_soc_write(codec, WM8988_ROUT2V, reg | 0x0100);
 | |
| 	reg = snd_soc_read(codec, WM8988_RINVOL);
 | |
| 	snd_soc_write(codec, WM8988_RINVOL, reg | 0x0100);
 | |
| 
 | |
| 	wm8988_set_bias_level(&wm8988->codec, SND_SOC_BIAS_STANDBY);
 | |
| 
 | |
| 	wm8988_dai.dev = codec->dev;
 | |
| 
 | |
| 	wm8988_codec = codec;
 | |
| 
 | |
| 	ret = snd_soc_register_codec(codec);
 | |
| 	if (ret != 0) {
 | |
| 		dev_err(codec->dev, "Failed to register codec: %d\n", ret);
 | |
| 		goto err;
 | |
| 	}
 | |
| 
 | |
| 	ret = snd_soc_register_dai(&wm8988_dai);
 | |
| 	if (ret != 0) {
 | |
| 		dev_err(codec->dev, "Failed to register DAI: %d\n", ret);
 | |
| 		snd_soc_unregister_codec(codec);
 | |
| 		goto err_codec;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| err_codec:
 | |
| 	snd_soc_unregister_codec(codec);
 | |
| err:
 | |
| 	kfree(wm8988);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static void wm8988_unregister(struct wm8988_priv *wm8988)
 | |
| {
 | |
| 	wm8988_set_bias_level(&wm8988->codec, SND_SOC_BIAS_OFF);
 | |
| 	snd_soc_unregister_dai(&wm8988_dai);
 | |
| 	snd_soc_unregister_codec(&wm8988->codec);
 | |
| 	kfree(wm8988);
 | |
| 	wm8988_codec = NULL;
 | |
| }
 | |
| 
 | |
| #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
 | |
| static int wm8988_i2c_probe(struct i2c_client *i2c,
 | |
| 			    const struct i2c_device_id *id)
 | |
| {
 | |
| 	struct wm8988_priv *wm8988;
 | |
| 	struct snd_soc_codec *codec;
 | |
| 
 | |
| 	wm8988 = kzalloc(sizeof(struct wm8988_priv), GFP_KERNEL);
 | |
| 	if (wm8988 == NULL)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	codec = &wm8988->codec;
 | |
| 
 | |
| 	i2c_set_clientdata(i2c, wm8988);
 | |
| 	codec->control_data = i2c;
 | |
| 
 | |
| 	codec->dev = &i2c->dev;
 | |
| 
 | |
| 	return wm8988_register(wm8988, SND_SOC_I2C);
 | |
| }
 | |
| 
 | |
| static int wm8988_i2c_remove(struct i2c_client *client)
 | |
| {
 | |
| 	struct wm8988_priv *wm8988 = i2c_get_clientdata(client);
 | |
| 	wm8988_unregister(wm8988);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_PM
 | |
| static int wm8988_i2c_suspend(struct i2c_client *client, pm_message_t msg)
 | |
| {
 | |
| 	return snd_soc_suspend_device(&client->dev);
 | |
| }
 | |
| 
 | |
| static int wm8988_i2c_resume(struct i2c_client *client)
 | |
| {
 | |
| 	return snd_soc_resume_device(&client->dev);
 | |
| }
 | |
| #else
 | |
| #define wm8988_i2c_suspend NULL
 | |
| #define wm8988_i2c_resume NULL
 | |
| #endif
 | |
| 
 | |
| static const struct i2c_device_id wm8988_i2c_id[] = {
 | |
| 	{ "wm8988", 0 },
 | |
| 	{ }
 | |
| };
 | |
| MODULE_DEVICE_TABLE(i2c, wm8988_i2c_id);
 | |
| 
 | |
| static struct i2c_driver wm8988_i2c_driver = {
 | |
| 	.driver = {
 | |
| 		.name = "WM8988",
 | |
| 		.owner = THIS_MODULE,
 | |
| 	},
 | |
| 	.probe = wm8988_i2c_probe,
 | |
| 	.remove = wm8988_i2c_remove,
 | |
| 	.suspend = wm8988_i2c_suspend,
 | |
| 	.resume = wm8988_i2c_resume,
 | |
| 	.id_table = wm8988_i2c_id,
 | |
| };
 | |
| #endif
 | |
| 
 | |
| #if defined(CONFIG_SPI_MASTER)
 | |
| static int __devinit wm8988_spi_probe(struct spi_device *spi)
 | |
| {
 | |
| 	struct wm8988_priv *wm8988;
 | |
| 	struct snd_soc_codec *codec;
 | |
| 
 | |
| 	wm8988 = kzalloc(sizeof(struct wm8988_priv), GFP_KERNEL);
 | |
| 	if (wm8988 == NULL)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	codec = &wm8988->codec;
 | |
| 	codec->control_data = spi;
 | |
| 	codec->dev = &spi->dev;
 | |
| 
 | |
| 	dev_set_drvdata(&spi->dev, wm8988);
 | |
| 
 | |
| 	return wm8988_register(wm8988, SND_SOC_SPI);
 | |
| }
 | |
| 
 | |
| static int __devexit wm8988_spi_remove(struct spi_device *spi)
 | |
| {
 | |
| 	struct wm8988_priv *wm8988 = dev_get_drvdata(&spi->dev);
 | |
| 
 | |
| 	wm8988_unregister(wm8988);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_PM
 | |
| static int wm8988_spi_suspend(struct spi_device *spi, pm_message_t msg)
 | |
| {
 | |
| 	return snd_soc_suspend_device(&spi->dev);
 | |
| }
 | |
| 
 | |
| static int wm8988_spi_resume(struct spi_device *spi)
 | |
| {
 | |
| 	return snd_soc_resume_device(&spi->dev);
 | |
| }
 | |
| #else
 | |
| #define wm8988_spi_suspend NULL
 | |
| #define wm8988_spi_resume NULL
 | |
| #endif
 | |
| 
 | |
| static struct spi_driver wm8988_spi_driver = {
 | |
| 	.driver = {
 | |
| 		.name	= "wm8988",
 | |
| 		.bus	= &spi_bus_type,
 | |
| 		.owner	= THIS_MODULE,
 | |
| 	},
 | |
| 	.probe		= wm8988_spi_probe,
 | |
| 	.remove		= __devexit_p(wm8988_spi_remove),
 | |
| 	.suspend	= wm8988_spi_suspend,
 | |
| 	.resume		= wm8988_spi_resume,
 | |
| };
 | |
| #endif
 | |
| 
 | |
| static int __init wm8988_modinit(void)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
 | |
| 	ret = i2c_add_driver(&wm8988_i2c_driver);
 | |
| 	if (ret != 0)
 | |
| 		pr_err("WM8988: Unable to register I2C driver: %d\n", ret);
 | |
| #endif
 | |
| #if defined(CONFIG_SPI_MASTER)
 | |
| 	ret = spi_register_driver(&wm8988_spi_driver);
 | |
| 	if (ret != 0)
 | |
| 		pr_err("WM8988: Unable to register SPI driver: %d\n", ret);
 | |
| #endif
 | |
| 	return ret;
 | |
| }
 | |
| module_init(wm8988_modinit);
 | |
| 
 | |
| static void __exit wm8988_exit(void)
 | |
| {
 | |
| #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
 | |
| 	i2c_del_driver(&wm8988_i2c_driver);
 | |
| #endif
 | |
| #if defined(CONFIG_SPI_MASTER)
 | |
| 	spi_unregister_driver(&wm8988_spi_driver);
 | |
| #endif
 | |
| }
 | |
| module_exit(wm8988_exit);
 | |
| 
 | |
| 
 | |
| MODULE_DESCRIPTION("ASoC WM8988 driver");
 | |
| MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
 | |
| MODULE_LICENSE("GPL");
 |