diff options
author | Mark Brown <broonie@opensource.wolfsonmicro.com> | 2009-08-15 06:20:44 -0400 |
---|---|---|
committer | Mark Brown <broonie@opensource.wolfsonmicro.com> | 2009-08-15 06:20:44 -0400 |
commit | 08229de4b42816079ed5d15f0689fcd0af946d5e (patch) | |
tree | 7126dc7b220fbbce745cb5d9a8864e9690587da4 /sound/soc/codecs/stac9766.c | |
parent | fbb474dedab871c7382858c374acd287dad4ab38 (diff) | |
parent | 2a708137fd7d3e0928f27157aaed8aba404b11c9 (diff) |
Merge branch 'for-2.6.32' into mxc
Conflicts:
sound/soc/Makefile
Diffstat (limited to 'sound/soc/codecs/stac9766.c')
-rw-r--r-- | sound/soc/codecs/stac9766.c | 463 |
1 files changed, 463 insertions, 0 deletions
diff --git a/sound/soc/codecs/stac9766.c b/sound/soc/codecs/stac9766.c new file mode 100644 index 000000000000..befc6488c39a --- /dev/null +++ b/sound/soc/codecs/stac9766.c | |||
@@ -0,0 +1,463 @@ | |||
1 | /* | ||
2 | * stac9766.c -- ALSA SoC STAC9766 codec support | ||
3 | * | ||
4 | * Copyright 2009 Jon Smirl, Digispeaker | ||
5 | * Author: Jon Smirl <jonsmirl@gmail.com> | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify it | ||
8 | * under the terms of the GNU General Public License as published by the | ||
9 | * Free Software Foundation; either version 2 of the License, or (at your | ||
10 | * option) any later version. | ||
11 | * | ||
12 | * Features:- | ||
13 | * | ||
14 | * o Support for AC97 Codec, S/PDIF | ||
15 | */ | ||
16 | |||
17 | #include <linux/init.h> | ||
18 | #include <linux/module.h> | ||
19 | #include <linux/device.h> | ||
20 | #include <sound/core.h> | ||
21 | #include <sound/pcm.h> | ||
22 | #include <sound/ac97_codec.h> | ||
23 | #include <sound/initval.h> | ||
24 | #include <sound/pcm_params.h> | ||
25 | #include <sound/soc.h> | ||
26 | #include <sound/tlv.h> | ||
27 | #include <sound/soc-of-simple.h> | ||
28 | |||
29 | #include "stac9766.h" | ||
30 | |||
31 | #define STAC9766_VERSION "0.10" | ||
32 | |||
33 | /* | ||
34 | * STAC9766 register cache | ||
35 | */ | ||
36 | static const u16 stac9766_reg[] = { | ||
37 | 0x6A90, 0x8000, 0x8000, 0x8000, /* 6 */ | ||
38 | 0x0000, 0x0000, 0x8008, 0x8008, /* e */ | ||
39 | 0x8808, 0x8808, 0x8808, 0x8808, /* 16 */ | ||
40 | 0x8808, 0x0000, 0x8000, 0x0000, /* 1e */ | ||
41 | 0x0000, 0x0000, 0x0000, 0x000f, /* 26 */ | ||
42 | 0x0a05, 0x0400, 0xbb80, 0x0000, /* 2e */ | ||
43 | 0x0000, 0xbb80, 0x0000, 0x0000, /* 36 */ | ||
44 | 0x0000, 0x2000, 0x0000, 0x0100, /* 3e */ | ||
45 | 0x0000, 0x0000, 0x0080, 0x0000, /* 46 */ | ||
46 | 0x0000, 0x0000, 0x0003, 0xffff, /* 4e */ | ||
47 | 0x0000, 0x0000, 0x0000, 0x0000, /* 56 */ | ||
48 | 0x4000, 0x0000, 0x0000, 0x0000, /* 5e */ | ||
49 | 0x1201, 0xFFFF, 0xFFFF, 0x0000, /* 66 */ | ||
50 | 0x0000, 0x0000, 0x0000, 0x0000, /* 6e */ | ||
51 | 0x0000, 0x0000, 0x0000, 0x0006, /* 76 */ | ||
52 | 0x0000, 0x0000, 0x0000, 0x0000, /* 7e */ | ||
53 | }; | ||
54 | |||
55 | static const char *stac9766_record_mux[] = {"Mic", "CD", "Video", "AUX", | ||
56 | "Line", "Stereo Mix", "Mono Mix", "Phone"}; | ||
57 | static const char *stac9766_mono_mux[] = {"Mix", "Mic"}; | ||
58 | static const char *stac9766_mic_mux[] = {"Mic1", "Mic2"}; | ||
59 | static const char *stac9766_SPDIF_mux[] = {"PCM", "ADC Record"}; | ||
60 | static const char *stac9766_popbypass_mux[] = {"Normal", "Bypass Mixer"}; | ||
61 | static const char *stac9766_record_all_mux[] = {"All analog", | ||
62 | "Analog plus DAC"}; | ||
63 | static const char *stac9766_boost1[] = {"0dB", "10dB"}; | ||
64 | static const char *stac9766_boost2[] = {"0dB", "20dB"}; | ||
65 | static const char *stac9766_stereo_mic[] = {"Off", "On"}; | ||
66 | |||
67 | static const struct soc_enum stac9766_record_enum = | ||
68 | SOC_ENUM_DOUBLE(AC97_REC_SEL, 8, 0, 8, stac9766_record_mux); | ||
69 | static const struct soc_enum stac9766_mono_enum = | ||
70 | SOC_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 9, 2, stac9766_mono_mux); | ||
71 | static const struct soc_enum stac9766_mic_enum = | ||
72 | SOC_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 8, 2, stac9766_mic_mux); | ||
73 | static const struct soc_enum stac9766_SPDIF_enum = | ||
74 | SOC_ENUM_SINGLE(AC97_STAC_DA_CONTROL, 1, 2, stac9766_SPDIF_mux); | ||
75 | static const struct soc_enum stac9766_popbypass_enum = | ||
76 | SOC_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 15, 2, stac9766_popbypass_mux); | ||
77 | static const struct soc_enum stac9766_record_all_enum = | ||
78 | SOC_ENUM_SINGLE(AC97_STAC_ANALOG_SPECIAL, 12, 2, | ||
79 | stac9766_record_all_mux); | ||
80 | static const struct soc_enum stac9766_boost1_enum = | ||
81 | SOC_ENUM_SINGLE(AC97_MIC, 6, 2, stac9766_boost1); /* 0/10dB */ | ||
82 | static const struct soc_enum stac9766_boost2_enum = | ||
83 | SOC_ENUM_SINGLE(AC97_STAC_ANALOG_SPECIAL, 2, 2, stac9766_boost2); /* 0/20dB */ | ||
84 | static const struct soc_enum stac9766_stereo_mic_enum = | ||
85 | SOC_ENUM_SINGLE(AC97_STAC_STEREO_MIC, 2, 1, stac9766_stereo_mic); | ||
86 | |||
87 | static const DECLARE_TLV_DB_LINEAR(master_tlv, -4600, 0); | ||
88 | static const DECLARE_TLV_DB_LINEAR(record_tlv, 0, 2250); | ||
89 | static const DECLARE_TLV_DB_LINEAR(beep_tlv, -4500, 0); | ||
90 | static const DECLARE_TLV_DB_LINEAR(mix_tlv, -3450, 1200); | ||
91 | |||
92 | static const struct snd_kcontrol_new stac9766_snd_ac97_controls[] = { | ||
93 | SOC_DOUBLE_TLV("Speaker Volume", AC97_MASTER, 8, 0, 31, 1, master_tlv), | ||
94 | SOC_SINGLE("Speaker Switch", AC97_MASTER, 15, 1, 1), | ||
95 | SOC_DOUBLE_TLV("Headphone Volume", AC97_HEADPHONE, 8, 0, 31, 1, | ||
96 | master_tlv), | ||
97 | SOC_SINGLE("Headphone Switch", AC97_HEADPHONE, 15, 1, 1), | ||
98 | SOC_SINGLE_TLV("Mono Out Volume", AC97_MASTER_MONO, 0, 31, 1, | ||
99 | master_tlv), | ||
100 | SOC_SINGLE("Mono Out Switch", AC97_MASTER_MONO, 15, 1, 1), | ||
101 | |||
102 | SOC_DOUBLE_TLV("Record Volume", AC97_REC_GAIN, 8, 0, 15, 0, record_tlv), | ||
103 | SOC_SINGLE("Record Switch", AC97_REC_GAIN, 15, 1, 1), | ||
104 | |||
105 | |||
106 | SOC_SINGLE_TLV("Beep Volume", AC97_PC_BEEP, 1, 15, 1, beep_tlv), | ||
107 | SOC_SINGLE("Beep Switch", AC97_PC_BEEP, 15, 1, 1), | ||
108 | SOC_SINGLE("Beep Frequency", AC97_PC_BEEP, 5, 127, 1), | ||
109 | SOC_SINGLE_TLV("Phone Volume", AC97_PHONE, 0, 31, 1, mix_tlv), | ||
110 | SOC_SINGLE("Phone Switch", AC97_PHONE, 15, 1, 1), | ||
111 | |||
112 | SOC_ENUM("Mic Boost1", stac9766_boost1_enum), | ||
113 | SOC_ENUM("Mic Boost2", stac9766_boost2_enum), | ||
114 | SOC_SINGLE_TLV("Mic Volume", AC97_MIC, 0, 31, 1, mix_tlv), | ||
115 | SOC_SINGLE("Mic Switch", AC97_MIC, 15, 1, 1), | ||
116 | SOC_ENUM("Stereo Mic", stac9766_stereo_mic_enum), | ||
117 | |||
118 | SOC_DOUBLE_TLV("Line Volume", AC97_LINE, 8, 0, 31, 1, mix_tlv), | ||
119 | SOC_SINGLE("Line Switch", AC97_LINE, 15, 1, 1), | ||
120 | SOC_DOUBLE_TLV("CD Volume", AC97_CD, 8, 0, 31, 1, mix_tlv), | ||
121 | SOC_SINGLE("CD Switch", AC97_CD, 15, 1, 1), | ||
122 | SOC_DOUBLE_TLV("AUX Volume", AC97_AUX, 8, 0, 31, 1, mix_tlv), | ||
123 | SOC_SINGLE("AUX Switch", AC97_AUX, 15, 1, 1), | ||
124 | SOC_DOUBLE_TLV("Video Volume", AC97_VIDEO, 8, 0, 31, 1, mix_tlv), | ||
125 | SOC_SINGLE("Video Switch", AC97_VIDEO, 15, 1, 1), | ||
126 | |||
127 | SOC_DOUBLE_TLV("DAC Volume", AC97_PCM, 8, 0, 31, 1, mix_tlv), | ||
128 | SOC_SINGLE("DAC Switch", AC97_PCM, 15, 1, 1), | ||
129 | SOC_SINGLE("Loopback Test Switch", AC97_GENERAL_PURPOSE, 7, 1, 0), | ||
130 | SOC_SINGLE("3D Volume", AC97_3D_CONTROL, 3, 2, 1), | ||
131 | SOC_SINGLE("3D Switch", AC97_GENERAL_PURPOSE, 13, 1, 0), | ||
132 | |||
133 | SOC_ENUM("SPDIF Mux", stac9766_SPDIF_enum), | ||
134 | SOC_ENUM("Mic1/2 Mux", stac9766_mic_enum), | ||
135 | SOC_ENUM("Record All Mux", stac9766_record_all_enum), | ||
136 | SOC_ENUM("Record Mux", stac9766_record_enum), | ||
137 | SOC_ENUM("Mono Mux", stac9766_mono_enum), | ||
138 | SOC_ENUM("Pop Bypass Mux", stac9766_popbypass_enum), | ||
139 | }; | ||
140 | |||
141 | static int stac9766_ac97_write(struct snd_soc_codec *codec, unsigned int reg, | ||
142 | unsigned int val) | ||
143 | { | ||
144 | u16 *cache = codec->reg_cache; | ||
145 | |||
146 | if (reg > AC97_STAC_PAGE0) { | ||
147 | stac9766_ac97_write(codec, AC97_INT_PAGING, 0); | ||
148 | soc_ac97_ops.write(codec->ac97, reg, val); | ||
149 | stac9766_ac97_write(codec, AC97_INT_PAGING, 1); | ||
150 | return 0; | ||
151 | } | ||
152 | if (reg / 2 >= ARRAY_SIZE(stac9766_reg)) | ||
153 | return -EIO; | ||
154 | |||
155 | soc_ac97_ops.write(codec->ac97, reg, val); | ||
156 | cache[reg / 2] = val; | ||
157 | return 0; | ||
158 | } | ||
159 | |||
160 | static unsigned int stac9766_ac97_read(struct snd_soc_codec *codec, | ||
161 | unsigned int reg) | ||
162 | { | ||
163 | u16 val = 0, *cache = codec->reg_cache; | ||
164 | |||
165 | if (reg > AC97_STAC_PAGE0) { | ||
166 | stac9766_ac97_write(codec, AC97_INT_PAGING, 0); | ||
167 | val = soc_ac97_ops.read(codec->ac97, reg - AC97_STAC_PAGE0); | ||
168 | stac9766_ac97_write(codec, AC97_INT_PAGING, 1); | ||
169 | return val; | ||
170 | } | ||
171 | if (reg / 2 >= ARRAY_SIZE(stac9766_reg)) | ||
172 | return -EIO; | ||
173 | |||
174 | if (reg == AC97_RESET || reg == AC97_GPIO_STATUS || | ||
175 | reg == AC97_INT_PAGING || reg == AC97_VENDOR_ID1 || | ||
176 | reg == AC97_VENDOR_ID2) { | ||
177 | |||
178 | val = soc_ac97_ops.read(codec->ac97, reg); | ||
179 | return val; | ||
180 | } | ||
181 | return cache[reg / 2]; | ||
182 | } | ||
183 | |||
184 | static int ac97_analog_prepare(struct snd_pcm_substream *substream, | ||
185 | struct snd_soc_dai *dai) | ||
186 | { | ||
187 | struct snd_soc_codec *codec = dai->codec; | ||
188 | struct snd_pcm_runtime *runtime = substream->runtime; | ||
189 | unsigned short reg, vra; | ||
190 | |||
191 | vra = stac9766_ac97_read(codec, AC97_EXTENDED_STATUS); | ||
192 | |||
193 | vra |= 0x1; /* enable variable rate audio */ | ||
194 | |||
195 | stac9766_ac97_write(codec, AC97_EXTENDED_STATUS, vra); | ||
196 | |||
197 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) | ||
198 | reg = AC97_PCM_FRONT_DAC_RATE; | ||
199 | else | ||
200 | reg = AC97_PCM_LR_ADC_RATE; | ||
201 | |||
202 | return stac9766_ac97_write(codec, reg, runtime->rate); | ||
203 | } | ||
204 | |||
205 | static int ac97_digital_prepare(struct snd_pcm_substream *substream, | ||
206 | struct snd_soc_dai *dai) | ||
207 | { | ||
208 | struct snd_soc_codec *codec = dai->codec; | ||
209 | struct snd_pcm_runtime *runtime = substream->runtime; | ||
210 | unsigned short reg, vra; | ||
211 | |||
212 | stac9766_ac97_write(codec, AC97_SPDIF, 0x2002); | ||
213 | |||
214 | vra = stac9766_ac97_read(codec, AC97_EXTENDED_STATUS); | ||
215 | vra |= 0x5; /* Enable VRA and SPDIF out */ | ||
216 | |||
217 | stac9766_ac97_write(codec, AC97_EXTENDED_STATUS, vra); | ||
218 | |||
219 | reg = AC97_PCM_FRONT_DAC_RATE; | ||
220 | |||
221 | return stac9766_ac97_write(codec, reg, runtime->rate); | ||
222 | } | ||
223 | |||
224 | static int ac97_digital_trigger(struct snd_pcm_substream *substream, | ||
225 | int cmd, struct snd_soc_dai *dai) | ||
226 | { | ||
227 | struct snd_soc_codec *codec = dai->codec; | ||
228 | unsigned short vra; | ||
229 | |||
230 | switch (cmd) { | ||
231 | case SNDRV_PCM_TRIGGER_STOP: | ||
232 | vra = stac9766_ac97_read(codec, AC97_EXTENDED_STATUS); | ||
233 | vra &= !0x04; | ||
234 | stac9766_ac97_write(codec, AC97_EXTENDED_STATUS, vra); | ||
235 | break; | ||
236 | } | ||
237 | return 0; | ||
238 | } | ||
239 | |||
240 | static int stac9766_set_bias_level(struct snd_soc_codec *codec, | ||
241 | enum snd_soc_bias_level level) | ||
242 | { | ||
243 | switch (level) { | ||
244 | case SND_SOC_BIAS_ON: /* full On */ | ||
245 | case SND_SOC_BIAS_PREPARE: /* partial On */ | ||
246 | case SND_SOC_BIAS_STANDBY: /* Off, with power */ | ||
247 | stac9766_ac97_write(codec, AC97_POWERDOWN, 0x0000); | ||
248 | break; | ||
249 | case SND_SOC_BIAS_OFF: /* Off, without power */ | ||
250 | /* disable everything including AC link */ | ||
251 | stac9766_ac97_write(codec, AC97_POWERDOWN, 0xffff); | ||
252 | break; | ||
253 | } | ||
254 | codec->bias_level = level; | ||
255 | return 0; | ||
256 | } | ||
257 | |||
258 | static int stac9766_reset(struct snd_soc_codec *codec, int try_warm) | ||
259 | { | ||
260 | if (try_warm && soc_ac97_ops.warm_reset) { | ||
261 | soc_ac97_ops.warm_reset(codec->ac97); | ||
262 | if (stac9766_ac97_read(codec, 0) == stac9766_reg[0]) | ||
263 | return 1; | ||
264 | } | ||
265 | |||
266 | soc_ac97_ops.reset(codec->ac97); | ||
267 | if (soc_ac97_ops.warm_reset) | ||
268 | soc_ac97_ops.warm_reset(codec->ac97); | ||
269 | if (stac9766_ac97_read(codec, 0) != stac9766_reg[0]) | ||
270 | return -EIO; | ||
271 | return 0; | ||
272 | } | ||
273 | |||
274 | static int stac9766_codec_suspend(struct platform_device *pdev, | ||
275 | pm_message_t state) | ||
276 | { | ||
277 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
278 | struct snd_soc_codec *codec = socdev->card->codec; | ||
279 | |||
280 | stac9766_set_bias_level(codec, SND_SOC_BIAS_OFF); | ||
281 | return 0; | ||
282 | } | ||
283 | |||
284 | static int stac9766_codec_resume(struct platform_device *pdev) | ||
285 | { | ||
286 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
287 | struct snd_soc_codec *codec = socdev->card->codec; | ||
288 | u16 id, reset; | ||
289 | |||
290 | reset = 0; | ||
291 | /* give the codec an AC97 warm reset to start the link */ | ||
292 | reset: | ||
293 | if (reset > 5) { | ||
294 | printk(KERN_ERR "stac9766 failed to resume"); | ||
295 | return -EIO; | ||
296 | } | ||
297 | codec->ac97->bus->ops->warm_reset(codec->ac97); | ||
298 | id = soc_ac97_ops.read(codec->ac97, AC97_VENDOR_ID2); | ||
299 | if (id != 0x4c13) { | ||
300 | stac9766_reset(codec, 0); | ||
301 | reset++; | ||
302 | goto reset; | ||
303 | } | ||
304 | stac9766_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | ||
305 | |||
306 | if (codec->suspend_bias_level == SND_SOC_BIAS_ON) | ||
307 | stac9766_set_bias_level(codec, SND_SOC_BIAS_ON); | ||
308 | |||
309 | return 0; | ||
310 | } | ||
311 | |||
312 | static struct snd_soc_dai_ops stac9766_dai_ops_analog = { | ||
313 | .prepare = ac97_analog_prepare, | ||
314 | }; | ||
315 | |||
316 | static struct snd_soc_dai_ops stac9766_dai_ops_digital = { | ||
317 | .prepare = ac97_digital_prepare, | ||
318 | .trigger = ac97_digital_trigger, | ||
319 | }; | ||
320 | |||
321 | struct snd_soc_dai stac9766_dai[] = { | ||
322 | { | ||
323 | .name = "stac9766 analog", | ||
324 | .id = 0, | ||
325 | .ac97_control = 1, | ||
326 | |||
327 | /* stream cababilities */ | ||
328 | .playback = { | ||
329 | .stream_name = "stac9766 analog", | ||
330 | .channels_min = 1, | ||
331 | .channels_max = 2, | ||
332 | .rates = SNDRV_PCM_RATE_8000_48000, | ||
333 | .formats = SND_SOC_STD_AC97_FMTS, | ||
334 | }, | ||
335 | .capture = { | ||
336 | .stream_name = "stac9766 analog", | ||
337 | .channels_min = 1, | ||
338 | .channels_max = 2, | ||
339 | .rates = SNDRV_PCM_RATE_8000_48000, | ||
340 | .formats = SND_SOC_STD_AC97_FMTS, | ||
341 | }, | ||
342 | /* alsa ops */ | ||
343 | .ops = &stac9766_dai_ops_analog, | ||
344 | }, | ||
345 | { | ||
346 | .name = "stac9766 IEC958", | ||
347 | .id = 1, | ||
348 | .ac97_control = 1, | ||
349 | |||
350 | /* stream cababilities */ | ||
351 | .playback = { | ||
352 | .stream_name = "stac9766 IEC958", | ||
353 | .channels_min = 1, | ||
354 | .channels_max = 2, | ||
355 | .rates = SNDRV_PCM_RATE_32000 | \ | ||
356 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000, | ||
357 | .formats = SNDRV_PCM_FORMAT_IEC958_SUBFRAME_BE, | ||
358 | }, | ||
359 | /* alsa ops */ | ||
360 | .ops = &stac9766_dai_ops_digital, | ||
361 | } | ||
362 | }; | ||
363 | EXPORT_SYMBOL_GPL(stac9766_dai); | ||
364 | |||
365 | static int stac9766_codec_probe(struct platform_device *pdev) | ||
366 | { | ||
367 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
368 | struct snd_soc_codec *codec; | ||
369 | int ret = 0; | ||
370 | |||
371 | printk(KERN_INFO "STAC9766 SoC Audio Codec %s\n", STAC9766_VERSION); | ||
372 | |||
373 | socdev->card->codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL); | ||
374 | if (socdev->card->codec == NULL) | ||
375 | return -ENOMEM; | ||
376 | codec = socdev->card->codec; | ||
377 | mutex_init(&codec->mutex); | ||
378 | |||
379 | codec->reg_cache = kmemdup(stac9766_reg, sizeof(stac9766_reg), | ||
380 | GFP_KERNEL); | ||
381 | if (codec->reg_cache == NULL) { | ||
382 | ret = -ENOMEM; | ||
383 | goto cache_err; | ||
384 | } | ||
385 | codec->reg_cache_size = sizeof(stac9766_reg); | ||
386 | codec->reg_cache_step = 2; | ||
387 | |||
388 | codec->name = "STAC9766"; | ||
389 | codec->owner = THIS_MODULE; | ||
390 | codec->dai = stac9766_dai; | ||
391 | codec->num_dai = ARRAY_SIZE(stac9766_dai); | ||
392 | codec->write = stac9766_ac97_write; | ||
393 | codec->read = stac9766_ac97_read; | ||
394 | codec->set_bias_level = stac9766_set_bias_level; | ||
395 | INIT_LIST_HEAD(&codec->dapm_widgets); | ||
396 | INIT_LIST_HEAD(&codec->dapm_paths); | ||
397 | |||
398 | ret = snd_soc_new_ac97_codec(codec, &soc_ac97_ops, 0); | ||
399 | if (ret < 0) | ||
400 | goto codec_err; | ||
401 | |||
402 | /* register pcms */ | ||
403 | ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1); | ||
404 | if (ret < 0) | ||
405 | goto pcm_err; | ||
406 | |||
407 | /* do a cold reset for the controller and then try | ||
408 | * a warm reset followed by an optional cold reset for codec */ | ||
409 | stac9766_reset(codec, 0); | ||
410 | ret = stac9766_reset(codec, 1); | ||
411 | if (ret < 0) { | ||
412 | printk(KERN_ERR "Failed to reset STAC9766: AC97 link error\n"); | ||
413 | goto reset_err; | ||
414 | } | ||
415 | |||
416 | stac9766_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | ||
417 | |||
418 | snd_soc_add_controls(codec, stac9766_snd_ac97_controls, | ||
419 | ARRAY_SIZE(stac9766_snd_ac97_controls)); | ||
420 | |||
421 | ret = snd_soc_init_card(socdev); | ||
422 | if (ret < 0) | ||
423 | goto reset_err; | ||
424 | return 0; | ||
425 | |||
426 | reset_err: | ||
427 | snd_soc_free_pcms(socdev); | ||
428 | pcm_err: | ||
429 | snd_soc_free_ac97_codec(codec); | ||
430 | codec_err: | ||
431 | kfree(codec->private_data); | ||
432 | cache_err: | ||
433 | kfree(socdev->card->codec); | ||
434 | socdev->card->codec = NULL; | ||
435 | return ret; | ||
436 | } | ||
437 | |||
438 | static int stac9766_codec_remove(struct platform_device *pdev) | ||
439 | { | ||
440 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
441 | struct snd_soc_codec *codec = socdev->card->codec; | ||
442 | |||
443 | if (codec == NULL) | ||
444 | return 0; | ||
445 | |||
446 | snd_soc_free_pcms(socdev); | ||
447 | snd_soc_free_ac97_codec(codec); | ||
448 | kfree(codec->reg_cache); | ||
449 | kfree(codec); | ||
450 | return 0; | ||
451 | } | ||
452 | |||
453 | struct snd_soc_codec_device soc_codec_dev_stac9766 = { | ||
454 | .probe = stac9766_codec_probe, | ||
455 | .remove = stac9766_codec_remove, | ||
456 | .suspend = stac9766_codec_suspend, | ||
457 | .resume = stac9766_codec_resume, | ||
458 | }; | ||
459 | EXPORT_SYMBOL_GPL(soc_codec_dev_stac9766); | ||
460 | |||
461 | MODULE_DESCRIPTION("ASoC stac9766 driver"); | ||
462 | MODULE_AUTHOR("Jon Smirl <jonsmirl@gmail.com>"); | ||
463 | MODULE_LICENSE("GPL"); | ||