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