Commit | Line | Data |
---|---|---|
a1533d94 BS |
1 | /* |
2 | * AD193X Audio Codec driver supporting AD1936/7/8/9 | |
3 | * | |
4 | * Copyright 2010 Analog Devices Inc. | |
5 | * | |
6 | * Licensed under the GPL-2 or later. | |
7 | */ | |
8 | ||
9 | #include <linux/init.h> | |
10 | #include <linux/module.h> | |
11 | #include <linux/kernel.h> | |
12 | #include <linux/device.h> | |
13 | #include <linux/i2c.h> | |
14 | #include <linux/spi/spi.h> | |
1b132ea0 | 15 | #include <linux/slab.h> |
a1533d94 BS |
16 | #include <sound/core.h> |
17 | #include <sound/pcm.h> | |
18 | #include <sound/pcm_params.h> | |
19 | #include <sound/initval.h> | |
20 | #include <sound/soc.h> | |
21 | #include <sound/tlv.h> | |
a1533d94 BS |
22 | #include "ad193x.h" |
23 | ||
24 | /* codec private data */ | |
25 | struct ad193x_priv { | |
30ab1e78 | 26 | struct regmap *regmap; |
f0fba2ad | 27 | int sysclk; |
a1533d94 BS |
28 | }; |
29 | ||
a1533d94 BS |
30 | /* |
31 | * AD193X volume/mute/de-emphasis etc. controls | |
32 | */ | |
33 | static const char *ad193x_deemp[] = {"None", "48kHz", "44.1kHz", "32kHz"}; | |
34 | ||
35 | static const struct soc_enum ad193x_deemp_enum = | |
36 | SOC_ENUM_SINGLE(AD193X_DAC_CTRL2, 1, 4, ad193x_deemp); | |
37 | ||
591c034a LPC |
38 | static const DECLARE_TLV_DB_MINMAX(adau193x_tlv, -9563, 0); |
39 | ||
a1533d94 BS |
40 | static const struct snd_kcontrol_new ad193x_snd_controls[] = { |
41 | /* DAC volume control */ | |
591c034a LPC |
42 | SOC_DOUBLE_R_TLV("DAC1 Volume", AD193X_DAC_L1_VOL, |
43 | AD193X_DAC_R1_VOL, 0, 0xFF, 1, adau193x_tlv), | |
44 | SOC_DOUBLE_R_TLV("DAC2 Volume", AD193X_DAC_L2_VOL, | |
45 | AD193X_DAC_R2_VOL, 0, 0xFF, 1, adau193x_tlv), | |
46 | SOC_DOUBLE_R_TLV("DAC3 Volume", AD193X_DAC_L3_VOL, | |
47 | AD193X_DAC_R3_VOL, 0, 0xFF, 1, adau193x_tlv), | |
48 | SOC_DOUBLE_R_TLV("DAC4 Volume", AD193X_DAC_L4_VOL, | |
49 | AD193X_DAC_R4_VOL, 0, 0xFF, 1, adau193x_tlv), | |
a1533d94 BS |
50 | |
51 | /* ADC switch control */ | |
52 | SOC_DOUBLE("ADC1 Switch", AD193X_ADC_CTRL0, AD193X_ADCL1_MUTE, | |
53 | AD193X_ADCR1_MUTE, 1, 1), | |
54 | SOC_DOUBLE("ADC2 Switch", AD193X_ADC_CTRL0, AD193X_ADCL2_MUTE, | |
55 | AD193X_ADCR2_MUTE, 1, 1), | |
56 | ||
57 | /* DAC switch control */ | |
58 | SOC_DOUBLE("DAC1 Switch", AD193X_DAC_CHNL_MUTE, AD193X_DACL1_MUTE, | |
59 | AD193X_DACR1_MUTE, 1, 1), | |
60 | SOC_DOUBLE("DAC2 Switch", AD193X_DAC_CHNL_MUTE, AD193X_DACL2_MUTE, | |
61 | AD193X_DACR2_MUTE, 1, 1), | |
62 | SOC_DOUBLE("DAC3 Switch", AD193X_DAC_CHNL_MUTE, AD193X_DACL3_MUTE, | |
63 | AD193X_DACR3_MUTE, 1, 1), | |
64 | SOC_DOUBLE("DAC4 Switch", AD193X_DAC_CHNL_MUTE, AD193X_DACL4_MUTE, | |
65 | AD193X_DACR4_MUTE, 1, 1), | |
66 | ||
67 | /* ADC high-pass filter */ | |
68 | SOC_SINGLE("ADC High Pass Filter Switch", AD193X_ADC_CTRL0, | |
69 | AD193X_ADC_HIGHPASS_FILTER, 1, 0), | |
70 | ||
71 | /* DAC de-emphasis */ | |
72 | SOC_ENUM("Playback Deemphasis", ad193x_deemp_enum), | |
73 | }; | |
74 | ||
75 | static const struct snd_soc_dapm_widget ad193x_dapm_widgets[] = { | |
76 | SND_SOC_DAPM_DAC("DAC", "Playback", AD193X_DAC_CTRL0, 0, 1), | |
77 | SND_SOC_DAPM_ADC("ADC", "Capture", SND_SOC_NOPM, 0, 0), | |
78 | SND_SOC_DAPM_SUPPLY("PLL_PWR", AD193X_PLL_CLK_CTRL0, 0, 1, NULL, 0), | |
79 | SND_SOC_DAPM_SUPPLY("ADC_PWR", AD193X_ADC_CTRL0, 0, 1, NULL, 0), | |
80 | SND_SOC_DAPM_OUTPUT("DAC1OUT"), | |
81 | SND_SOC_DAPM_OUTPUT("DAC2OUT"), | |
82 | SND_SOC_DAPM_OUTPUT("DAC3OUT"), | |
83 | SND_SOC_DAPM_OUTPUT("DAC4OUT"), | |
84 | SND_SOC_DAPM_INPUT("ADC1IN"), | |
85 | SND_SOC_DAPM_INPUT("ADC2IN"), | |
86 | }; | |
87 | ||
88 | static const struct snd_soc_dapm_route audio_paths[] = { | |
89 | { "DAC", NULL, "PLL_PWR" }, | |
90 | { "ADC", NULL, "PLL_PWR" }, | |
91 | { "DAC", NULL, "ADC_PWR" }, | |
92 | { "ADC", NULL, "ADC_PWR" }, | |
93 | { "DAC1OUT", "DAC1 Switch", "DAC" }, | |
94 | { "DAC2OUT", "DAC2 Switch", "DAC" }, | |
95 | { "DAC3OUT", "DAC3 Switch", "DAC" }, | |
96 | { "DAC4OUT", "DAC4 Switch", "DAC" }, | |
97 | { "ADC", "ADC1 Switch", "ADC1IN" }, | |
98 | { "ADC", "ADC2 Switch", "ADC2IN" }, | |
99 | }; | |
100 | ||
101 | /* | |
102 | * DAI ops entries | |
103 | */ | |
104 | ||
105 | static int ad193x_mute(struct snd_soc_dai *dai, int mute) | |
106 | { | |
107 | struct snd_soc_codec *codec = dai->codec; | |
a1533d94 | 108 | |
54c96cfd AL |
109 | if (mute) |
110 | snd_soc_update_bits(codec, AD193X_DAC_CTRL2, | |
111 | AD193X_DAC_MASTER_MUTE, | |
112 | AD193X_DAC_MASTER_MUTE); | |
113 | else | |
114 | snd_soc_update_bits(codec, AD193X_DAC_CTRL2, | |
115 | AD193X_DAC_MASTER_MUTE, 0); | |
a1533d94 BS |
116 | |
117 | return 0; | |
118 | } | |
119 | ||
120 | static int ad193x_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask, | |
121 | unsigned int rx_mask, int slots, int width) | |
122 | { | |
123 | struct snd_soc_codec *codec = dai->codec; | |
124 | int dac_reg = snd_soc_read(codec, AD193X_DAC_CTRL1); | |
125 | int adc_reg = snd_soc_read(codec, AD193X_ADC_CTRL2); | |
126 | ||
127 | dac_reg &= ~AD193X_DAC_CHAN_MASK; | |
128 | adc_reg &= ~AD193X_ADC_CHAN_MASK; | |
129 | ||
130 | switch (slots) { | |
131 | case 2: | |
132 | dac_reg |= AD193X_DAC_2_CHANNELS << AD193X_DAC_CHAN_SHFT; | |
133 | adc_reg |= AD193X_ADC_2_CHANNELS << AD193X_ADC_CHAN_SHFT; | |
134 | break; | |
135 | case 4: | |
136 | dac_reg |= AD193X_DAC_4_CHANNELS << AD193X_DAC_CHAN_SHFT; | |
137 | adc_reg |= AD193X_ADC_4_CHANNELS << AD193X_ADC_CHAN_SHFT; | |
138 | break; | |
139 | case 8: | |
140 | dac_reg |= AD193X_DAC_8_CHANNELS << AD193X_DAC_CHAN_SHFT; | |
141 | adc_reg |= AD193X_ADC_8_CHANNELS << AD193X_ADC_CHAN_SHFT; | |
142 | break; | |
143 | case 16: | |
144 | dac_reg |= AD193X_DAC_16_CHANNELS << AD193X_DAC_CHAN_SHFT; | |
145 | adc_reg |= AD193X_ADC_16_CHANNELS << AD193X_ADC_CHAN_SHFT; | |
146 | break; | |
147 | default: | |
148 | return -EINVAL; | |
149 | } | |
150 | ||
151 | snd_soc_write(codec, AD193X_DAC_CTRL1, dac_reg); | |
152 | snd_soc_write(codec, AD193X_ADC_CTRL2, adc_reg); | |
153 | ||
154 | return 0; | |
155 | } | |
156 | ||
157 | static int ad193x_set_dai_fmt(struct snd_soc_dai *codec_dai, | |
158 | unsigned int fmt) | |
159 | { | |
160 | struct snd_soc_codec *codec = codec_dai->codec; | |
d6bdc0f7 | 161 | int adc_reg1, adc_reg2, dac_reg; |
a1533d94 | 162 | |
d6bdc0f7 BS |
163 | adc_reg1 = snd_soc_read(codec, AD193X_ADC_CTRL1); |
164 | adc_reg2 = snd_soc_read(codec, AD193X_ADC_CTRL2); | |
a1533d94 BS |
165 | dac_reg = snd_soc_read(codec, AD193X_DAC_CTRL1); |
166 | ||
167 | /* At present, the driver only support AUX ADC mode(SND_SOC_DAIFMT_I2S | |
168 | * with TDM) and ADC&DAC TDM mode(SND_SOC_DAIFMT_DSP_A) | |
169 | */ | |
170 | switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { | |
171 | case SND_SOC_DAIFMT_I2S: | |
d6bdc0f7 BS |
172 | adc_reg1 &= ~AD193X_ADC_SERFMT_MASK; |
173 | adc_reg1 |= AD193X_ADC_SERFMT_TDM; | |
a1533d94 BS |
174 | break; |
175 | case SND_SOC_DAIFMT_DSP_A: | |
d6bdc0f7 BS |
176 | adc_reg1 &= ~AD193X_ADC_SERFMT_MASK; |
177 | adc_reg1 |= AD193X_ADC_SERFMT_AUX; | |
a1533d94 BS |
178 | break; |
179 | default: | |
180 | return -EINVAL; | |
181 | } | |
182 | ||
183 | switch (fmt & SND_SOC_DAIFMT_INV_MASK) { | |
184 | case SND_SOC_DAIFMT_NB_NF: /* normal bit clock + frame */ | |
d6bdc0f7 BS |
185 | adc_reg2 &= ~AD193X_ADC_LEFT_HIGH; |
186 | adc_reg2 &= ~AD193X_ADC_BCLK_INV; | |
a1533d94 BS |
187 | dac_reg &= ~AD193X_DAC_LEFT_HIGH; |
188 | dac_reg &= ~AD193X_DAC_BCLK_INV; | |
189 | break; | |
190 | case SND_SOC_DAIFMT_NB_IF: /* normal bclk + invert frm */ | |
d6bdc0f7 BS |
191 | adc_reg2 |= AD193X_ADC_LEFT_HIGH; |
192 | adc_reg2 &= ~AD193X_ADC_BCLK_INV; | |
a1533d94 BS |
193 | dac_reg |= AD193X_DAC_LEFT_HIGH; |
194 | dac_reg &= ~AD193X_DAC_BCLK_INV; | |
195 | break; | |
196 | case SND_SOC_DAIFMT_IB_NF: /* invert bclk + normal frm */ | |
d6bdc0f7 BS |
197 | adc_reg2 &= ~AD193X_ADC_LEFT_HIGH; |
198 | adc_reg2 |= AD193X_ADC_BCLK_INV; | |
a1533d94 BS |
199 | dac_reg &= ~AD193X_DAC_LEFT_HIGH; |
200 | dac_reg |= AD193X_DAC_BCLK_INV; | |
201 | break; | |
202 | ||
203 | case SND_SOC_DAIFMT_IB_IF: /* invert bclk + frm */ | |
d6bdc0f7 BS |
204 | adc_reg2 |= AD193X_ADC_LEFT_HIGH; |
205 | adc_reg2 |= AD193X_ADC_BCLK_INV; | |
a1533d94 BS |
206 | dac_reg |= AD193X_DAC_LEFT_HIGH; |
207 | dac_reg |= AD193X_DAC_BCLK_INV; | |
208 | break; | |
209 | default: | |
210 | return -EINVAL; | |
211 | } | |
212 | ||
213 | switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { | |
214 | case SND_SOC_DAIFMT_CBM_CFM: /* codec clk & frm master */ | |
d6bdc0f7 BS |
215 | adc_reg2 |= AD193X_ADC_LCR_MASTER; |
216 | adc_reg2 |= AD193X_ADC_BCLK_MASTER; | |
a1533d94 BS |
217 | dac_reg |= AD193X_DAC_LCR_MASTER; |
218 | dac_reg |= AD193X_DAC_BCLK_MASTER; | |
219 | break; | |
220 | case SND_SOC_DAIFMT_CBS_CFM: /* codec clk slave & frm master */ | |
d6bdc0f7 BS |
221 | adc_reg2 |= AD193X_ADC_LCR_MASTER; |
222 | adc_reg2 &= ~AD193X_ADC_BCLK_MASTER; | |
a1533d94 BS |
223 | dac_reg |= AD193X_DAC_LCR_MASTER; |
224 | dac_reg &= ~AD193X_DAC_BCLK_MASTER; | |
225 | break; | |
226 | case SND_SOC_DAIFMT_CBM_CFS: /* codec clk master & frame slave */ | |
d6bdc0f7 BS |
227 | adc_reg2 &= ~AD193X_ADC_LCR_MASTER; |
228 | adc_reg2 |= AD193X_ADC_BCLK_MASTER; | |
a1533d94 BS |
229 | dac_reg &= ~AD193X_DAC_LCR_MASTER; |
230 | dac_reg |= AD193X_DAC_BCLK_MASTER; | |
231 | break; | |
232 | case SND_SOC_DAIFMT_CBS_CFS: /* codec clk & frm slave */ | |
d6bdc0f7 BS |
233 | adc_reg2 &= ~AD193X_ADC_LCR_MASTER; |
234 | adc_reg2 &= ~AD193X_ADC_BCLK_MASTER; | |
a1533d94 BS |
235 | dac_reg &= ~AD193X_DAC_LCR_MASTER; |
236 | dac_reg &= ~AD193X_DAC_BCLK_MASTER; | |
237 | break; | |
238 | default: | |
239 | return -EINVAL; | |
240 | } | |
241 | ||
d6bdc0f7 BS |
242 | snd_soc_write(codec, AD193X_ADC_CTRL1, adc_reg1); |
243 | snd_soc_write(codec, AD193X_ADC_CTRL2, adc_reg2); | |
a1533d94 BS |
244 | snd_soc_write(codec, AD193X_DAC_CTRL1, dac_reg); |
245 | ||
246 | return 0; | |
247 | } | |
248 | ||
fab90aa4 BS |
249 | static int ad193x_set_dai_sysclk(struct snd_soc_dai *codec_dai, |
250 | int clk_id, unsigned int freq, int dir) | |
251 | { | |
252 | struct snd_soc_codec *codec = codec_dai->codec; | |
253 | struct ad193x_priv *ad193x = snd_soc_codec_get_drvdata(codec); | |
254 | switch (freq) { | |
255 | case 12288000: | |
256 | case 18432000: | |
257 | case 24576000: | |
258 | case 36864000: | |
259 | ad193x->sysclk = freq; | |
260 | return 0; | |
261 | } | |
262 | return -EINVAL; | |
263 | } | |
264 | ||
a1533d94 BS |
265 | static int ad193x_hw_params(struct snd_pcm_substream *substream, |
266 | struct snd_pcm_hw_params *params, | |
267 | struct snd_soc_dai *dai) | |
268 | { | |
54c96cfd | 269 | int word_len = 0, master_rate = 0; |
a1533d94 BS |
270 | |
271 | struct snd_soc_pcm_runtime *rtd = substream->private_data; | |
f0fba2ad | 272 | struct snd_soc_codec *codec = rtd->codec; |
fab90aa4 | 273 | struct ad193x_priv *ad193x = snd_soc_codec_get_drvdata(codec); |
a1533d94 BS |
274 | |
275 | /* bit size */ | |
276 | switch (params_format(params)) { | |
277 | case SNDRV_PCM_FORMAT_S16_LE: | |
278 | word_len = 3; | |
279 | break; | |
280 | case SNDRV_PCM_FORMAT_S20_3LE: | |
281 | word_len = 1; | |
282 | break; | |
283 | case SNDRV_PCM_FORMAT_S24_LE: | |
284 | case SNDRV_PCM_FORMAT_S32_LE: | |
285 | word_len = 0; | |
286 | break; | |
287 | } | |
288 | ||
fab90aa4 BS |
289 | switch (ad193x->sysclk) { |
290 | case 12288000: | |
291 | master_rate = AD193X_PLL_INPUT_256; | |
292 | break; | |
293 | case 18432000: | |
294 | master_rate = AD193X_PLL_INPUT_384; | |
295 | break; | |
296 | case 24576000: | |
297 | master_rate = AD193X_PLL_INPUT_512; | |
298 | break; | |
299 | case 36864000: | |
300 | master_rate = AD193X_PLL_INPUT_768; | |
301 | break; | |
302 | } | |
303 | ||
54c96cfd AL |
304 | snd_soc_update_bits(codec, AD193X_PLL_CLK_CTRL0, |
305 | AD193X_PLL_INPUT_MASK, master_rate); | |
fab90aa4 | 306 | |
54c96cfd AL |
307 | snd_soc_update_bits(codec, AD193X_DAC_CTRL2, |
308 | AD193X_DAC_WORD_LEN_MASK, | |
309 | word_len << AD193X_DAC_WORD_LEN_SHFT); | |
a1533d94 | 310 | |
54c96cfd AL |
311 | snd_soc_update_bits(codec, AD193X_ADC_CTRL1, |
312 | AD193X_ADC_WORD_LEN_MASK, word_len); | |
a1533d94 BS |
313 | |
314 | return 0; | |
315 | } | |
316 | ||
85e7652d | 317 | static const struct snd_soc_dai_ops ad193x_dai_ops = { |
9dd7b79a BS |
318 | .hw_params = ad193x_hw_params, |
319 | .digital_mute = ad193x_mute, | |
320 | .set_tdm_slot = ad193x_set_tdm_slot, | |
fab90aa4 | 321 | .set_sysclk = ad193x_set_dai_sysclk, |
9dd7b79a BS |
322 | .set_fmt = ad193x_set_dai_fmt, |
323 | }; | |
324 | ||
325 | /* codec DAI instance */ | |
f0fba2ad LG |
326 | static struct snd_soc_dai_driver ad193x_dai = { |
327 | .name = "ad193x-hifi", | |
9dd7b79a BS |
328 | .playback = { |
329 | .stream_name = "Playback", | |
330 | .channels_min = 2, | |
331 | .channels_max = 8, | |
332 | .rates = SNDRV_PCM_RATE_48000, | |
333 | .formats = SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S16_LE | | |
334 | SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S24_LE, | |
335 | }, | |
336 | .capture = { | |
337 | .stream_name = "Capture", | |
338 | .channels_min = 2, | |
339 | .channels_max = 4, | |
340 | .rates = SNDRV_PCM_RATE_48000, | |
341 | .formats = SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S16_LE | | |
342 | SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S24_LE, | |
343 | }, | |
344 | .ops = &ad193x_dai_ops, | |
345 | }; | |
9dd7b79a | 346 | |
f0fba2ad | 347 | static int ad193x_probe(struct snd_soc_codec *codec) |
a1533d94 | 348 | { |
f0fba2ad LG |
349 | struct ad193x_priv *ad193x = snd_soc_codec_get_drvdata(codec); |
350 | int ret; | |
a1533d94 | 351 | |
30ab1e78 LPC |
352 | codec->control_data = ad193x->regmap; |
353 | ret = snd_soc_codec_set_cache_io(codec, 0, 0, SND_SOC_REGMAP); | |
f0fba2ad | 354 | if (ret < 0) { |
119bfef2 | 355 | dev_err(codec->dev, "failed to set cache I/O: %d\n", ret); |
f0fba2ad | 356 | return ret; |
a1533d94 BS |
357 | } |
358 | ||
f0fba2ad | 359 | /* default setting for ad193x */ |
a1533d94 | 360 | |
f0fba2ad LG |
361 | /* unmute dac channels */ |
362 | snd_soc_write(codec, AD193X_DAC_CHNL_MUTE, 0x0); | |
363 | /* de-emphasis: 48kHz, powedown dac */ | |
364 | snd_soc_write(codec, AD193X_DAC_CTRL2, 0x1A); | |
365 | /* powerdown dac, dac in tdm mode */ | |
366 | snd_soc_write(codec, AD193X_DAC_CTRL0, 0x41); | |
367 | /* high-pass filter enable */ | |
368 | snd_soc_write(codec, AD193X_ADC_CTRL0, 0x3); | |
369 | /* sata delay=1, adc aux mode */ | |
370 | snd_soc_write(codec, AD193X_ADC_CTRL1, 0x43); | |
371 | /* pll input: mclki/xi */ | |
372 | snd_soc_write(codec, AD193X_PLL_CLK_CTRL0, 0x99); /* mclk=24.576Mhz: 0x9D; mclk=12.288Mhz: 0x99 */ | |
373 | snd_soc_write(codec, AD193X_PLL_CLK_CTRL1, 0x04); | |
a1533d94 | 374 | |
a1533d94 BS |
375 | return ret; |
376 | } | |
377 | ||
f0fba2ad | 378 | static struct snd_soc_codec_driver soc_codec_dev_ad193x = { |
a1533d94 | 379 | .probe = ad193x_probe, |
b90d4183 LPC |
380 | .controls = ad193x_snd_controls, |
381 | .num_controls = ARRAY_SIZE(ad193x_snd_controls), | |
382 | .dapm_widgets = ad193x_dapm_widgets, | |
383 | .num_dapm_widgets = ARRAY_SIZE(ad193x_dapm_widgets), | |
384 | .dapm_routes = audio_paths, | |
385 | .num_dapm_routes = ARRAY_SIZE(audio_paths), | |
a1533d94 | 386 | }; |
a1533d94 BS |
387 | |
388 | #if defined(CONFIG_SPI_MASTER) | |
30ab1e78 LPC |
389 | |
390 | static const struct regmap_config ad193x_spi_regmap_config = { | |
391 | .val_bits = 8, | |
392 | .reg_bits = 16, | |
393 | .read_flag_mask = 0x09, | |
394 | .write_flag_mask = 0x08, | |
395 | }; | |
396 | ||
a1533d94 BS |
397 | static int __devinit ad193x_spi_probe(struct spi_device *spi) |
398 | { | |
f0fba2ad LG |
399 | struct ad193x_priv *ad193x; |
400 | int ret; | |
401 | ||
402 | ad193x = kzalloc(sizeof(struct ad193x_priv), GFP_KERNEL); | |
403 | if (ad193x == NULL) | |
404 | return -ENOMEM; | |
405 | ||
30ab1e78 LPC |
406 | ad193x->regmap = regmap_init_spi(spi, &ad193x_spi_regmap_config); |
407 | if (IS_ERR(ad193x->regmap)) { | |
408 | ret = PTR_ERR(ad193x->regmap); | |
409 | goto err_free; | |
410 | } | |
411 | ||
f0fba2ad | 412 | spi_set_drvdata(spi, ad193x); |
f0fba2ad LG |
413 | |
414 | ret = snd_soc_register_codec(&spi->dev, | |
415 | &soc_codec_dev_ad193x, &ad193x_dai, 1); | |
416 | if (ret < 0) | |
30ab1e78 LPC |
417 | goto err_regmap_exit; |
418 | ||
419 | return 0; | |
420 | ||
421 | err_regmap_exit: | |
422 | regmap_exit(ad193x->regmap); | |
423 | err_free: | |
424 | kfree(ad193x); | |
425 | ||
f0fba2ad | 426 | return ret; |
a1533d94 BS |
427 | } |
428 | ||
429 | static int __devexit ad193x_spi_remove(struct spi_device *spi) | |
430 | { | |
30ab1e78 LPC |
431 | struct ad193x_priv *ad193x = spi_get_drvdata(spi); |
432 | ||
f0fba2ad | 433 | snd_soc_unregister_codec(&spi->dev); |
30ab1e78 LPC |
434 | regmap_exit(ad193x->regmap); |
435 | kfree(ad193x); | |
f0fba2ad | 436 | return 0; |
a1533d94 BS |
437 | } |
438 | ||
439 | static struct spi_driver ad193x_spi_driver = { | |
440 | .driver = { | |
e43a7d41 | 441 | .name = "ad193x", |
a1533d94 BS |
442 | .owner = THIS_MODULE, |
443 | }, | |
444 | .probe = ad193x_spi_probe, | |
445 | .remove = __devexit_p(ad193x_spi_remove), | |
446 | }; | |
447 | #endif | |
448 | ||
449 | #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) | |
30ab1e78 LPC |
450 | |
451 | static const struct regmap_config ad193x_i2c_regmap_config = { | |
452 | .val_bits = 8, | |
453 | .reg_bits = 8, | |
454 | }; | |
455 | ||
a1533d94 BS |
456 | static const struct i2c_device_id ad193x_id[] = { |
457 | { "ad1936", 0 }, | |
458 | { "ad1937", 0 }, | |
459 | { } | |
460 | }; | |
461 | MODULE_DEVICE_TABLE(i2c, ad193x_id); | |
462 | ||
463 | static int __devinit ad193x_i2c_probe(struct i2c_client *client, | |
464 | const struct i2c_device_id *id) | |
465 | { | |
f0fba2ad LG |
466 | struct ad193x_priv *ad193x; |
467 | int ret; | |
468 | ||
469 | ad193x = kzalloc(sizeof(struct ad193x_priv), GFP_KERNEL); | |
470 | if (ad193x == NULL) | |
471 | return -ENOMEM; | |
472 | ||
30ab1e78 LPC |
473 | ad193x->regmap = regmap_init_i2c(client, &ad193x_i2c_regmap_config); |
474 | if (IS_ERR(ad193x->regmap)) { | |
475 | ret = PTR_ERR(ad193x->regmap); | |
476 | goto err_free; | |
477 | } | |
478 | ||
f0fba2ad | 479 | i2c_set_clientdata(client, ad193x); |
f0fba2ad LG |
480 | |
481 | ret = snd_soc_register_codec(&client->dev, | |
482 | &soc_codec_dev_ad193x, &ad193x_dai, 1); | |
483 | if (ret < 0) | |
30ab1e78 LPC |
484 | goto err_regmap_exit; |
485 | ||
486 | return 0; | |
487 | ||
488 | err_regmap_exit: | |
489 | regmap_exit(ad193x->regmap); | |
490 | err_free: | |
491 | kfree(ad193x); | |
f0fba2ad | 492 | return ret; |
a1533d94 BS |
493 | } |
494 | ||
495 | static int __devexit ad193x_i2c_remove(struct i2c_client *client) | |
496 | { | |
30ab1e78 LPC |
497 | struct ad193x_priv *ad193x = i2c_get_clientdata(client); |
498 | ||
f0fba2ad | 499 | snd_soc_unregister_codec(&client->dev); |
30ab1e78 LPC |
500 | regmap_exit(ad193x->regmap); |
501 | kfree(ad193x); | |
f0fba2ad | 502 | return 0; |
a1533d94 BS |
503 | } |
504 | ||
505 | static struct i2c_driver ad193x_i2c_driver = { | |
506 | .driver = { | |
e43a7d41 | 507 | .name = "ad193x", |
a1533d94 BS |
508 | }, |
509 | .probe = ad193x_i2c_probe, | |
510 | .remove = __devexit_p(ad193x_i2c_remove), | |
511 | .id_table = ad193x_id, | |
512 | }; | |
513 | #endif | |
514 | ||
515 | static int __init ad193x_modinit(void) | |
516 | { | |
517 | int ret; | |
518 | ||
519 | #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) | |
520 | ret = i2c_add_driver(&ad193x_i2c_driver); | |
521 | if (ret != 0) { | |
522 | printk(KERN_ERR "Failed to register AD193X I2C driver: %d\n", | |
523 | ret); | |
524 | } | |
525 | #endif | |
526 | ||
527 | #if defined(CONFIG_SPI_MASTER) | |
528 | ret = spi_register_driver(&ad193x_spi_driver); | |
529 | if (ret != 0) { | |
530 | printk(KERN_ERR "Failed to register AD193X SPI driver: %d\n", | |
531 | ret); | |
532 | } | |
533 | #endif | |
534 | return ret; | |
535 | } | |
536 | module_init(ad193x_modinit); | |
537 | ||
538 | static void __exit ad193x_modexit(void) | |
539 | { | |
540 | #if defined(CONFIG_SPI_MASTER) | |
541 | spi_unregister_driver(&ad193x_spi_driver); | |
542 | #endif | |
543 | ||
544 | #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE) | |
545 | i2c_del_driver(&ad193x_i2c_driver); | |
546 | #endif | |
547 | } | |
548 | module_exit(ad193x_modexit); | |
549 | ||
550 | MODULE_DESCRIPTION("ASoC ad193x driver"); | |
551 | MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>"); | |
552 | MODULE_LICENSE("GPL"); |