Commit | Line | Data |
---|---|---|
6d7f68a1 JK |
1 | /* |
2 | * ams-delta.c -- SoC audio for Amstrad E3 (Delta) videophone | |
3 | * | |
4 | * Copyright (C) 2009 Janusz Krzysztofik <jkrzyszt@tis.icnet.pl> | |
5 | * | |
6 | * Initially based on sound/soc/omap/osk5912.x | |
7 | * Copyright (C) 2008 Mistral Solutions | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or | |
10 | * modify it under the terms of the GNU General Public License | |
11 | * version 2 as published by the Free Software Foundation. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
16 | * General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA | |
21 | * 02110-1301 USA | |
22 | * | |
23 | */ | |
24 | ||
25 | #include <linux/gpio.h> | |
26 | #include <linux/spinlock.h> | |
27 | #include <linux/tty.h> | |
da155d5b | 28 | #include <linux/module.h> |
6d7f68a1 | 29 | |
ce6120cc | 30 | #include <sound/soc.h> |
6d7f68a1 JK |
31 | #include <sound/jack.h> |
32 | ||
33 | #include <asm/mach-types.h> | |
34 | ||
ce491cf8 TL |
35 | #include <plat/board-ams-delta.h> |
36 | #include <plat/mcbsp.h> | |
6d7f68a1 JK |
37 | |
38 | #include "omap-mcbsp.h" | |
39 | #include "omap-pcm.h" | |
40 | #include "../codecs/cx20442.h" | |
41 | ||
42 | ||
43 | /* Board specific DAPM widgets */ | |
02624621 | 44 | static const struct snd_soc_dapm_widget ams_delta_dapm_widgets[] = { |
6d7f68a1 JK |
45 | /* Handset */ |
46 | SND_SOC_DAPM_MIC("Mouthpiece", NULL), | |
47 | SND_SOC_DAPM_HP("Earpiece", NULL), | |
48 | /* Handsfree/Speakerphone */ | |
49 | SND_SOC_DAPM_MIC("Microphone", NULL), | |
50 | SND_SOC_DAPM_SPK("Speaker", NULL), | |
51 | }; | |
52 | ||
53 | /* How they are connected to codec pins */ | |
54 | static const struct snd_soc_dapm_route ams_delta_audio_map[] = { | |
55 | {"TELIN", NULL, "Mouthpiece"}, | |
56 | {"Earpiece", NULL, "TELOUT"}, | |
57 | ||
58 | {"MIC", NULL, "Microphone"}, | |
59 | {"Speaker", NULL, "SPKOUT"}, | |
60 | }; | |
61 | ||
62 | /* | |
63 | * Controls, functional after the modem line discipline is activated. | |
64 | */ | |
65 | ||
66 | /* Virtual switch: audio input/output constellations */ | |
67 | static const char *ams_delta_audio_mode[] = | |
68 | {"Mixed", "Handset", "Handsfree", "Speakerphone"}; | |
69 | ||
70 | /* Selection <-> pin translation */ | |
71 | #define AMS_DELTA_MOUTHPIECE 0 | |
72 | #define AMS_DELTA_EARPIECE 1 | |
73 | #define AMS_DELTA_MICROPHONE 2 | |
74 | #define AMS_DELTA_SPEAKER 3 | |
75 | #define AMS_DELTA_AGC 4 | |
76 | ||
77 | #define AMS_DELTA_MIXED ((1 << AMS_DELTA_EARPIECE) | \ | |
78 | (1 << AMS_DELTA_MICROPHONE)) | |
79 | #define AMS_DELTA_HANDSET ((1 << AMS_DELTA_MOUTHPIECE) | \ | |
80 | (1 << AMS_DELTA_EARPIECE)) | |
81 | #define AMS_DELTA_HANDSFREE ((1 << AMS_DELTA_MICROPHONE) | \ | |
82 | (1 << AMS_DELTA_SPEAKER)) | |
83 | #define AMS_DELTA_SPEAKERPHONE (AMS_DELTA_HANDSFREE | (1 << AMS_DELTA_AGC)) | |
84 | ||
02624621 | 85 | static const unsigned short ams_delta_audio_mode_pins[] = { |
6d7f68a1 JK |
86 | AMS_DELTA_MIXED, |
87 | AMS_DELTA_HANDSET, | |
88 | AMS_DELTA_HANDSFREE, | |
89 | AMS_DELTA_SPEAKERPHONE, | |
90 | }; | |
91 | ||
92 | static unsigned short ams_delta_audio_agc; | |
93 | ||
94 | static int ams_delta_set_audio_mode(struct snd_kcontrol *kcontrol, | |
95 | struct snd_ctl_elem_value *ucontrol) | |
96 | { | |
97 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); | |
ce6120cc | 98 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
6d7f68a1 JK |
99 | struct soc_enum *control = (struct soc_enum *)kcontrol->private_value; |
100 | unsigned short pins; | |
101 | int pin, changed = 0; | |
102 | ||
103 | /* Refuse any mode changes if we are not able to control the codec. */ | |
f0fba2ad | 104 | if (!codec->hw_write) |
6d7f68a1 JK |
105 | return -EUNATCH; |
106 | ||
107 | if (ucontrol->value.enumerated.item[0] >= control->max) | |
108 | return -EINVAL; | |
109 | ||
110 | mutex_lock(&codec->mutex); | |
111 | ||
112 | /* Translate selection to bitmap */ | |
113 | pins = ams_delta_audio_mode_pins[ucontrol->value.enumerated.item[0]]; | |
114 | ||
115 | /* Setup pins after corresponding bits if changed */ | |
116 | pin = !!(pins & (1 << AMS_DELTA_MOUTHPIECE)); | |
ce6120cc | 117 | if (pin != snd_soc_dapm_get_pin_status(dapm, "Mouthpiece")) { |
6d7f68a1 JK |
118 | changed = 1; |
119 | if (pin) | |
ce6120cc | 120 | snd_soc_dapm_enable_pin(dapm, "Mouthpiece"); |
6d7f68a1 | 121 | else |
ce6120cc | 122 | snd_soc_dapm_disable_pin(dapm, "Mouthpiece"); |
6d7f68a1 JK |
123 | } |
124 | pin = !!(pins & (1 << AMS_DELTA_EARPIECE)); | |
ce6120cc | 125 | if (pin != snd_soc_dapm_get_pin_status(dapm, "Earpiece")) { |
6d7f68a1 JK |
126 | changed = 1; |
127 | if (pin) | |
ce6120cc | 128 | snd_soc_dapm_enable_pin(dapm, "Earpiece"); |
6d7f68a1 | 129 | else |
ce6120cc | 130 | snd_soc_dapm_disable_pin(dapm, "Earpiece"); |
6d7f68a1 JK |
131 | } |
132 | pin = !!(pins & (1 << AMS_DELTA_MICROPHONE)); | |
ce6120cc | 133 | if (pin != snd_soc_dapm_get_pin_status(dapm, "Microphone")) { |
6d7f68a1 JK |
134 | changed = 1; |
135 | if (pin) | |
ce6120cc | 136 | snd_soc_dapm_enable_pin(dapm, "Microphone"); |
6d7f68a1 | 137 | else |
ce6120cc | 138 | snd_soc_dapm_disable_pin(dapm, "Microphone"); |
6d7f68a1 JK |
139 | } |
140 | pin = !!(pins & (1 << AMS_DELTA_SPEAKER)); | |
ce6120cc | 141 | if (pin != snd_soc_dapm_get_pin_status(dapm, "Speaker")) { |
6d7f68a1 JK |
142 | changed = 1; |
143 | if (pin) | |
ce6120cc | 144 | snd_soc_dapm_enable_pin(dapm, "Speaker"); |
6d7f68a1 | 145 | else |
ce6120cc | 146 | snd_soc_dapm_disable_pin(dapm, "Speaker"); |
6d7f68a1 JK |
147 | } |
148 | pin = !!(pins & (1 << AMS_DELTA_AGC)); | |
149 | if (pin != ams_delta_audio_agc) { | |
150 | ams_delta_audio_agc = pin; | |
151 | changed = 1; | |
152 | if (pin) | |
ce6120cc | 153 | snd_soc_dapm_enable_pin(dapm, "AGCIN"); |
6d7f68a1 | 154 | else |
ce6120cc | 155 | snd_soc_dapm_disable_pin(dapm, "AGCIN"); |
6d7f68a1 JK |
156 | } |
157 | if (changed) | |
ce6120cc | 158 | snd_soc_dapm_sync(dapm); |
6d7f68a1 JK |
159 | |
160 | mutex_unlock(&codec->mutex); | |
161 | ||
162 | return changed; | |
163 | } | |
164 | ||
165 | static int ams_delta_get_audio_mode(struct snd_kcontrol *kcontrol, | |
166 | struct snd_ctl_elem_value *ucontrol) | |
167 | { | |
168 | struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); | |
ce6120cc | 169 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
6d7f68a1 JK |
170 | unsigned short pins, mode; |
171 | ||
ce6120cc | 172 | pins = ((snd_soc_dapm_get_pin_status(dapm, "Mouthpiece") << |
6d7f68a1 | 173 | AMS_DELTA_MOUTHPIECE) | |
ce6120cc | 174 | (snd_soc_dapm_get_pin_status(dapm, "Earpiece") << |
6d7f68a1 JK |
175 | AMS_DELTA_EARPIECE)); |
176 | if (pins) | |
ce6120cc | 177 | pins |= (snd_soc_dapm_get_pin_status(dapm, "Microphone") << |
6d7f68a1 JK |
178 | AMS_DELTA_MICROPHONE); |
179 | else | |
ce6120cc | 180 | pins = ((snd_soc_dapm_get_pin_status(dapm, "Microphone") << |
6d7f68a1 | 181 | AMS_DELTA_MICROPHONE) | |
ce6120cc | 182 | (snd_soc_dapm_get_pin_status(dapm, "Speaker") << |
6d7f68a1 JK |
183 | AMS_DELTA_SPEAKER) | |
184 | (ams_delta_audio_agc << AMS_DELTA_AGC)); | |
185 | ||
186 | for (mode = 0; mode < ARRAY_SIZE(ams_delta_audio_mode); mode++) | |
187 | if (pins == ams_delta_audio_mode_pins[mode]) | |
188 | break; | |
189 | ||
190 | if (mode >= ARRAY_SIZE(ams_delta_audio_mode)) | |
191 | return -EINVAL; | |
192 | ||
193 | ucontrol->value.enumerated.item[0] = mode; | |
194 | ||
195 | return 0; | |
196 | } | |
197 | ||
198 | static const struct soc_enum ams_delta_audio_enum[] = { | |
199 | SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(ams_delta_audio_mode), | |
200 | ams_delta_audio_mode), | |
201 | }; | |
202 | ||
203 | static const struct snd_kcontrol_new ams_delta_audio_controls[] = { | |
204 | SOC_ENUM_EXT("Audio Mode", ams_delta_audio_enum[0], | |
205 | ams_delta_get_audio_mode, ams_delta_set_audio_mode), | |
206 | }; | |
207 | ||
208 | /* Hook switch */ | |
209 | static struct snd_soc_jack ams_delta_hook_switch; | |
210 | static struct snd_soc_jack_gpio ams_delta_hook_switch_gpios[] = { | |
211 | { | |
212 | .gpio = 4, | |
213 | .name = "hook_switch", | |
214 | .report = SND_JACK_HEADSET, | |
215 | .invert = 1, | |
216 | .debounce_time = 150, | |
217 | } | |
218 | }; | |
219 | ||
220 | /* After we are able to control the codec over the modem, | |
221 | * the hook switch can be used for dynamic DAPM reconfiguration. */ | |
222 | static struct snd_soc_jack_pin ams_delta_hook_switch_pins[] = { | |
223 | /* Handset */ | |
224 | { | |
225 | .pin = "Mouthpiece", | |
226 | .mask = SND_JACK_MICROPHONE, | |
227 | }, | |
228 | { | |
229 | .pin = "Earpiece", | |
230 | .mask = SND_JACK_HEADPHONE, | |
231 | }, | |
232 | /* Handsfree */ | |
233 | { | |
234 | .pin = "Microphone", | |
235 | .mask = SND_JACK_MICROPHONE, | |
236 | .invert = 1, | |
237 | }, | |
238 | { | |
239 | .pin = "Speaker", | |
240 | .mask = SND_JACK_HEADPHONE, | |
241 | .invert = 1, | |
242 | }, | |
243 | }; | |
244 | ||
245 | ||
246 | /* | |
247 | * Modem line discipline, required for making above controls functional. | |
248 | * Activated from userspace with ldattach, possibly invoked from udev rule. | |
249 | */ | |
250 | ||
251 | /* To actually apply any modem controlled configuration changes to the codec, | |
25985edc | 252 | * we must connect codec DAI pins to the modem for a moment. Be careful not |
6d7f68a1 JK |
253 | * to interfere with our digital mute function that shares the same hardware. */ |
254 | static struct timer_list cx81801_timer; | |
255 | static bool cx81801_cmd_pending; | |
256 | static bool ams_delta_muted; | |
257 | static DEFINE_SPINLOCK(ams_delta_lock); | |
258 | ||
259 | static void cx81801_timeout(unsigned long data) | |
260 | { | |
261 | int muted; | |
262 | ||
263 | spin_lock(&ams_delta_lock); | |
264 | cx81801_cmd_pending = 0; | |
265 | muted = ams_delta_muted; | |
266 | spin_unlock(&ams_delta_lock); | |
267 | ||
268 | /* Reconnect the codec DAI back from the modem to the CPU DAI | |
269 | * only if digital mute still off */ | |
270 | if (!muted) | |
271 | ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC, 0); | |
272 | } | |
273 | ||
f0fba2ad LG |
274 | /* |
275 | * Used for passing a codec structure pointer | |
276 | * from the board initialization code to the tty line discipline. | |
277 | */ | |
278 | static struct snd_soc_codec *cx20442_codec; | |
279 | ||
6d7f68a1 JK |
280 | /* Line discipline .open() */ |
281 | static int cx81801_open(struct tty_struct *tty) | |
282 | { | |
f0fba2ad LG |
283 | int ret; |
284 | ||
285 | if (!cx20442_codec) | |
286 | return -ENODEV; | |
287 | ||
288 | /* | |
289 | * Pass the codec structure pointer for use by other ldisc callbacks, | |
290 | * both the card and the codec specific parts. | |
291 | */ | |
292 | tty->disc_data = cx20442_codec; | |
293 | ||
294 | ret = v253_ops.open(tty); | |
295 | ||
296 | if (ret < 0) | |
297 | tty->disc_data = NULL; | |
298 | ||
299 | return ret; | |
6d7f68a1 JK |
300 | } |
301 | ||
302 | /* Line discipline .close() */ | |
303 | static void cx81801_close(struct tty_struct *tty) | |
304 | { | |
305 | struct snd_soc_codec *codec = tty->disc_data; | |
ce6120cc | 306 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
6d7f68a1 JK |
307 | |
308 | del_timer_sync(&cx81801_timer); | |
309 | ||
6d7f68a1 JK |
310 | /* Prevent the hook switch from further changing the DAPM pins */ |
311 | INIT_LIST_HEAD(&ams_delta_hook_switch.pins); | |
312 | ||
f0fba2ad LG |
313 | if (!codec) |
314 | return; | |
315 | ||
316 | v253_ops.close(tty); | |
317 | ||
6d7f68a1 | 318 | /* Revert back to default audio input/output constellation */ |
ce6120cc LG |
319 | snd_soc_dapm_disable_pin(dapm, "Mouthpiece"); |
320 | snd_soc_dapm_enable_pin(dapm, "Earpiece"); | |
321 | snd_soc_dapm_enable_pin(dapm, "Microphone"); | |
322 | snd_soc_dapm_disable_pin(dapm, "Speaker"); | |
323 | snd_soc_dapm_disable_pin(dapm, "AGCIN"); | |
324 | snd_soc_dapm_sync(dapm); | |
6d7f68a1 JK |
325 | } |
326 | ||
327 | /* Line discipline .hangup() */ | |
328 | static int cx81801_hangup(struct tty_struct *tty) | |
329 | { | |
330 | cx81801_close(tty); | |
331 | return 0; | |
332 | } | |
333 | ||
dbc6221b | 334 | /* Line discipline .receive_buf() */ |
6d7f68a1 JK |
335 | static void cx81801_receive(struct tty_struct *tty, |
336 | const unsigned char *cp, char *fp, int count) | |
337 | { | |
338 | struct snd_soc_codec *codec = tty->disc_data; | |
339 | const unsigned char *c; | |
340 | int apply, ret; | |
341 | ||
f0fba2ad LG |
342 | if (!codec) |
343 | return; | |
344 | ||
345 | if (!codec->hw_write) { | |
6d7f68a1 JK |
346 | /* First modem response, complete setup procedure */ |
347 | ||
348 | /* Initialize timer used for config pulse generation */ | |
349 | setup_timer(&cx81801_timer, cx81801_timeout, 0); | |
350 | ||
351 | v253_ops.receive_buf(tty, cp, fp, count); | |
352 | ||
353 | /* Link hook switch to DAPM pins */ | |
354 | ret = snd_soc_jack_add_pins(&ams_delta_hook_switch, | |
355 | ARRAY_SIZE(ams_delta_hook_switch_pins), | |
356 | ams_delta_hook_switch_pins); | |
357 | if (ret) | |
f0fba2ad | 358 | dev_warn(codec->dev, |
6d7f68a1 JK |
359 | "Failed to link hook switch to DAPM pins, " |
360 | "will continue with hook switch unlinked.\n"); | |
361 | ||
362 | return; | |
363 | } | |
364 | ||
365 | v253_ops.receive_buf(tty, cp, fp, count); | |
366 | ||
367 | for (c = &cp[count - 1]; c >= cp; c--) { | |
368 | if (*c != '\r') | |
369 | continue; | |
370 | /* Complete modem response received, apply config to codec */ | |
371 | ||
372 | spin_lock_bh(&ams_delta_lock); | |
373 | mod_timer(&cx81801_timer, jiffies + msecs_to_jiffies(150)); | |
374 | apply = !ams_delta_muted && !cx81801_cmd_pending; | |
375 | cx81801_cmd_pending = 1; | |
376 | spin_unlock_bh(&ams_delta_lock); | |
377 | ||
378 | /* Apply config pulse by connecting the codec to the modem | |
379 | * if not already done */ | |
380 | if (apply) | |
381 | ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC, | |
382 | AMS_DELTA_LATCH2_MODEM_CODEC); | |
383 | break; | |
384 | } | |
385 | } | |
386 | ||
387 | /* Line discipline .write_wakeup() */ | |
388 | static void cx81801_wakeup(struct tty_struct *tty) | |
389 | { | |
390 | v253_ops.write_wakeup(tty); | |
391 | } | |
392 | ||
393 | static struct tty_ldisc_ops cx81801_ops = { | |
394 | .magic = TTY_LDISC_MAGIC, | |
395 | .name = "cx81801", | |
396 | .owner = THIS_MODULE, | |
397 | .open = cx81801_open, | |
398 | .close = cx81801_close, | |
399 | .hangup = cx81801_hangup, | |
400 | .receive_buf = cx81801_receive, | |
401 | .write_wakeup = cx81801_wakeup, | |
402 | }; | |
403 | ||
404 | ||
405 | /* | |
25985edc | 406 | * Even if not very useful, the sound card can still work without any of the |
6d7f68a1 | 407 | * above functonality activated. You can still control its audio input/output |
25985edc | 408 | * constellation and speakerphone gain from userspace by issuing AT commands |
6d7f68a1 JK |
409 | * over the modem port. |
410 | */ | |
411 | ||
412 | static int ams_delta_hw_params(struct snd_pcm_substream *substream, | |
413 | struct snd_pcm_hw_params *params) | |
414 | { | |
415 | struct snd_soc_pcm_runtime *rtd = substream->private_data; | |
416 | ||
417 | /* Set cpu DAI configuration */ | |
f0fba2ad | 418 | return snd_soc_dai_set_fmt(rtd->cpu_dai, |
6d7f68a1 JK |
419 | SND_SOC_DAIFMT_DSP_A | |
420 | SND_SOC_DAIFMT_NB_NF | | |
421 | SND_SOC_DAIFMT_CBM_CFM); | |
422 | } | |
423 | ||
424 | static struct snd_soc_ops ams_delta_ops = { | |
425 | .hw_params = ams_delta_hw_params, | |
426 | }; | |
427 | ||
428 | ||
429 | /* Board specific codec bias level control */ | |
430 | static int ams_delta_set_bias_level(struct snd_soc_card *card, | |
d4c6005f MB |
431 | struct snd_soc_dapm_context *dapm, |
432 | enum snd_soc_bias_level level) | |
6d7f68a1 | 433 | { |
6d7f68a1 JK |
434 | switch (level) { |
435 | case SND_SOC_BIAS_ON: | |
436 | case SND_SOC_BIAS_PREPARE: | |
437 | case SND_SOC_BIAS_STANDBY: | |
f75a8ff6 | 438 | if (card->dapm.bias_level == SND_SOC_BIAS_OFF) |
6d7f68a1 JK |
439 | ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_NRESET, |
440 | AMS_DELTA_LATCH2_MODEM_NRESET); | |
441 | break; | |
442 | case SND_SOC_BIAS_OFF: | |
f75a8ff6 | 443 | if (card->dapm.bias_level != SND_SOC_BIAS_OFF) |
6d7f68a1 JK |
444 | ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_NRESET, |
445 | 0); | |
446 | } | |
f75a8ff6 | 447 | card->dapm.bias_level = level; |
6d7f68a1 JK |
448 | |
449 | return 0; | |
450 | } | |
451 | ||
452 | /* Digital mute implemented using modem/CPU multiplexer. | |
453 | * Shares hardware with codec config pulse generation */ | |
454 | static bool ams_delta_muted = 1; | |
455 | ||
456 | static int ams_delta_digital_mute(struct snd_soc_dai *dai, int mute) | |
457 | { | |
458 | int apply; | |
459 | ||
460 | if (ams_delta_muted == mute) | |
461 | return 0; | |
462 | ||
463 | spin_lock_bh(&ams_delta_lock); | |
464 | ams_delta_muted = mute; | |
465 | apply = !cx81801_cmd_pending; | |
466 | spin_unlock_bh(&ams_delta_lock); | |
467 | ||
468 | if (apply) | |
469 | ams_delta_latch2_write(AMS_DELTA_LATCH2_MODEM_CODEC, | |
470 | mute ? AMS_DELTA_LATCH2_MODEM_CODEC : 0); | |
471 | return 0; | |
472 | } | |
473 | ||
474 | /* Our codec DAI probably doesn't have its own .ops structure */ | |
85e7652d | 475 | static const struct snd_soc_dai_ops ams_delta_dai_ops = { |
6d7f68a1 JK |
476 | .digital_mute = ams_delta_digital_mute, |
477 | }; | |
478 | ||
479 | /* Will be used if the codec ever has its own digital_mute function */ | |
480 | static int ams_delta_startup(struct snd_pcm_substream *substream) | |
481 | { | |
482 | return ams_delta_digital_mute(NULL, 0); | |
483 | } | |
484 | ||
485 | static void ams_delta_shutdown(struct snd_pcm_substream *substream) | |
486 | { | |
487 | ams_delta_digital_mute(NULL, 1); | |
488 | } | |
489 | ||
490 | ||
491 | /* | |
492 | * Card initialization | |
493 | */ | |
494 | ||
f0fba2ad | 495 | static int ams_delta_cx20442_init(struct snd_soc_pcm_runtime *rtd) |
6d7f68a1 | 496 | { |
f0fba2ad | 497 | struct snd_soc_codec *codec = rtd->codec; |
ce6120cc | 498 | struct snd_soc_dapm_context *dapm = &codec->dapm; |
f0fba2ad LG |
499 | struct snd_soc_dai *codec_dai = rtd->codec_dai; |
500 | struct snd_soc_card *card = rtd->card; | |
6d7f68a1 JK |
501 | int ret; |
502 | /* Codec is ready, now add/activate board specific controls */ | |
503 | ||
f0fba2ad LG |
504 | /* Store a pointer to the codec structure for tty ldisc use */ |
505 | cx20442_codec = codec; | |
506 | ||
6d7f68a1 | 507 | /* Set up digital mute if not provided by the codec */ |
f0fba2ad LG |
508 | if (!codec_dai->driver->ops) { |
509 | codec_dai->driver->ops = &ams_delta_dai_ops; | |
6d7f68a1 JK |
510 | } else { |
511 | ams_delta_ops.startup = ams_delta_startup; | |
512 | ams_delta_ops.shutdown = ams_delta_shutdown; | |
513 | } | |
514 | ||
515 | /* Set codec bias level */ | |
e574044a | 516 | ams_delta_set_bias_level(card, dapm, SND_SOC_BIAS_STANDBY); |
6d7f68a1 JK |
517 | |
518 | /* Add hook switch - can be used to control the codec from userspace | |
519 | * even if line discipline fails */ | |
f0fba2ad | 520 | ret = snd_soc_jack_new(rtd->codec, "hook_switch", |
6d7f68a1 JK |
521 | SND_JACK_HEADSET, &ams_delta_hook_switch); |
522 | if (ret) | |
523 | dev_warn(card->dev, | |
524 | "Failed to allocate resources for hook switch, " | |
525 | "will continue without one.\n"); | |
526 | else { | |
527 | ret = snd_soc_jack_add_gpios(&ams_delta_hook_switch, | |
528 | ARRAY_SIZE(ams_delta_hook_switch_gpios), | |
529 | ams_delta_hook_switch_gpios); | |
530 | if (ret) | |
531 | dev_warn(card->dev, | |
532 | "Failed to set up hook switch GPIO line, " | |
533 | "will continue with hook switch inactive.\n"); | |
534 | } | |
535 | ||
536 | /* Register optional line discipline for over the modem control */ | |
b7b8f9bf | 537 | ret = tty_register_ldisc(N_V253, &cx81801_ops); |
6d7f68a1 JK |
538 | if (ret) { |
539 | dev_warn(card->dev, | |
540 | "Failed to register line discipline, " | |
541 | "will continue without any controls.\n"); | |
542 | return 0; | |
543 | } | |
544 | ||
545 | /* Add board specific DAPM widgets and routes */ | |
ce6120cc | 546 | ret = snd_soc_dapm_new_controls(dapm, ams_delta_dapm_widgets, |
6d7f68a1 JK |
547 | ARRAY_SIZE(ams_delta_dapm_widgets)); |
548 | if (ret) { | |
549 | dev_warn(card->dev, | |
550 | "Failed to register DAPM controls, " | |
551 | "will continue without any.\n"); | |
552 | return 0; | |
553 | } | |
554 | ||
ce6120cc | 555 | ret = snd_soc_dapm_add_routes(dapm, ams_delta_audio_map, |
6d7f68a1 JK |
556 | ARRAY_SIZE(ams_delta_audio_map)); |
557 | if (ret) { | |
558 | dev_warn(card->dev, | |
559 | "Failed to set up DAPM routes, " | |
560 | "will continue with codec default map.\n"); | |
561 | return 0; | |
562 | } | |
563 | ||
564 | /* Set up initial pin constellation */ | |
ce6120cc LG |
565 | snd_soc_dapm_disable_pin(dapm, "Mouthpiece"); |
566 | snd_soc_dapm_enable_pin(dapm, "Earpiece"); | |
567 | snd_soc_dapm_enable_pin(dapm, "Microphone"); | |
568 | snd_soc_dapm_disable_pin(dapm, "Speaker"); | |
569 | snd_soc_dapm_disable_pin(dapm, "AGCIN"); | |
570 | snd_soc_dapm_disable_pin(dapm, "AGCOUT"); | |
6d7f68a1 JK |
571 | |
572 | /* Add virtual switch */ | |
022658be | 573 | ret = snd_soc_add_codec_controls(codec, ams_delta_audio_controls, |
6d7f68a1 JK |
574 | ARRAY_SIZE(ams_delta_audio_controls)); |
575 | if (ret) | |
576 | dev_warn(card->dev, | |
577 | "Failed to register audio mode control, " | |
578 | "will continue without it.\n"); | |
579 | ||
580 | return 0; | |
581 | } | |
582 | ||
583 | /* DAI glue - connects codec <--> CPU */ | |
584 | static struct snd_soc_dai_link ams_delta_dai_link = { | |
585 | .name = "CX20442", | |
586 | .stream_name = "CX20442", | |
f0fba2ad | 587 | .cpu_dai_name ="omap-mcbsp-dai.0", |
5394637a | 588 | .codec_dai_name = "cx20442-voice", |
6d7f68a1 | 589 | .init = ams_delta_cx20442_init, |
f0fba2ad LG |
590 | .platform_name = "omap-pcm-audio", |
591 | .codec_name = "cx20442-codec", | |
6d7f68a1 JK |
592 | .ops = &ams_delta_ops, |
593 | }; | |
594 | ||
595 | /* Audio card driver */ | |
596 | static struct snd_soc_card ams_delta_audio_card = { | |
597 | .name = "AMS_DELTA", | |
b425b884 | 598 | .owner = THIS_MODULE, |
6d7f68a1 JK |
599 | .dai_link = &ams_delta_dai_link, |
600 | .num_links = 1, | |
601 | .set_bias_level = ams_delta_set_bias_level, | |
602 | }; | |
603 | ||
6d7f68a1 JK |
604 | /* Module init/exit */ |
605 | static struct platform_device *ams_delta_audio_platform_device; | |
606 | static struct platform_device *cx20442_platform_device; | |
607 | ||
608 | static int __init ams_delta_module_init(void) | |
609 | { | |
610 | int ret; | |
611 | ||
612 | if (!(machine_is_ams_delta())) | |
613 | return -ENODEV; | |
614 | ||
615 | ams_delta_audio_platform_device = | |
616 | platform_device_alloc("soc-audio", -1); | |
617 | if (!ams_delta_audio_platform_device) | |
618 | return -ENOMEM; | |
619 | ||
620 | platform_set_drvdata(ams_delta_audio_platform_device, | |
f0fba2ad | 621 | &ams_delta_audio_card); |
6d7f68a1 JK |
622 | |
623 | ret = platform_device_add(ams_delta_audio_platform_device); | |
624 | if (ret) | |
625 | goto err; | |
626 | ||
627 | /* | |
628 | * Codec platform device could be registered from elsewhere (board?), | |
629 | * but I do it here as it makes sense only if used with the card. | |
630 | */ | |
f0fba2ad LG |
631 | cx20442_platform_device = |
632 | platform_device_register_simple("cx20442-codec", -1, NULL, 0); | |
6d7f68a1 JK |
633 | return 0; |
634 | err: | |
635 | platform_device_put(ams_delta_audio_platform_device); | |
636 | return ret; | |
637 | } | |
638 | module_init(ams_delta_module_init); | |
639 | ||
640 | static void __exit ams_delta_module_exit(void) | |
641 | { | |
b7b8f9bf | 642 | if (tty_unregister_ldisc(N_V253) != 0) |
6d7f68a1 | 643 | dev_warn(&ams_delta_audio_platform_device->dev, |
b7b8f9bf | 644 | "failed to unregister V253 line discipline\n"); |
6d7f68a1 JK |
645 | |
646 | snd_soc_jack_free_gpios(&ams_delta_hook_switch, | |
647 | ARRAY_SIZE(ams_delta_hook_switch_gpios), | |
648 | ams_delta_hook_switch_gpios); | |
649 | ||
650 | /* Keep modem power on */ | |
e574044a JN |
651 | ams_delta_set_bias_level(&ams_delta_audio_card, |
652 | &ams_delta_audio_card.rtd[0].codec->dapm, | |
653 | SND_SOC_BIAS_STANDBY); | |
6d7f68a1 JK |
654 | |
655 | platform_device_unregister(cx20442_platform_device); | |
656 | platform_device_unregister(ams_delta_audio_platform_device); | |
657 | } | |
658 | module_exit(ams_delta_module_exit); | |
659 | ||
660 | MODULE_AUTHOR("Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>"); | |
661 | MODULE_DESCRIPTION("ALSA SoC driver for Amstrad E3 (Delta) videophone"); | |
662 | MODULE_LICENSE("GPL"); |