1
2
3
4
5
6
7
8
9
10
11#include <linux/gpio/consumer.h>
12#include <linux/spinlock.h>
13#include <linux/tty.h>
14#include <linux/module.h>
15
16#include <sound/soc.h>
17#include <sound/jack.h>
18
19#include <asm/mach-types.h>
20
21#include <linux/platform_data/asoc-ti-mcbsp.h>
22
23#include "omap-mcbsp.h"
24#include "../codecs/cx20442.h"
25
26static struct gpio_desc *handset_mute;
27static struct gpio_desc *handsfree_mute;
28
29static int ams_delta_event_handset(struct snd_soc_dapm_widget *w,
30 struct snd_kcontrol *k, int event)
31{
32 gpiod_set_value_cansleep(handset_mute, !SND_SOC_DAPM_EVENT_ON(event));
33 return 0;
34}
35
36static int ams_delta_event_handsfree(struct snd_soc_dapm_widget *w,
37 struct snd_kcontrol *k, int event)
38{
39 gpiod_set_value_cansleep(handsfree_mute, !SND_SOC_DAPM_EVENT_ON(event));
40 return 0;
41}
42
43
44static const struct snd_soc_dapm_widget ams_delta_dapm_widgets[] = {
45
46 SND_SOC_DAPM_MIC("Mouthpiece", NULL),
47 SND_SOC_DAPM_HP("Earpiece", ams_delta_event_handset),
48
49 SND_SOC_DAPM_MIC("Microphone", NULL),
50 SND_SOC_DAPM_SPK("Speaker", ams_delta_event_handsfree),
51};
52
53
54static 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
64
65
66
67static const char *ams_delta_audio_mode[] =
68 {"Mixed", "Handset", "Handsfree", "Speakerphone"};
69
70
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
85static const unsigned short ams_delta_audio_mode_pins[] = {
86 AMS_DELTA_MIXED,
87 AMS_DELTA_HANDSET,
88 AMS_DELTA_HANDSFREE,
89 AMS_DELTA_SPEAKERPHONE,
90};
91
92static unsigned short ams_delta_audio_agc;
93
94
95
96
97
98static struct snd_soc_component *cx20442_codec;
99
100static int ams_delta_set_audio_mode(struct snd_kcontrol *kcontrol,
101 struct snd_ctl_elem_value *ucontrol)
102{
103 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
104 struct snd_soc_dapm_context *dapm = &card->dapm;
105 struct soc_enum *control = (struct soc_enum *)kcontrol->private_value;
106 unsigned short pins;
107 int pin, changed = 0;
108
109
110 if (!cx20442_codec->card->pop_time)
111 return -EUNATCH;
112
113 if (ucontrol->value.enumerated.item[0] >= control->items)
114 return -EINVAL;
115
116 snd_soc_dapm_mutex_lock(dapm);
117
118
119 pins = ams_delta_audio_mode_pins[ucontrol->value.enumerated.item[0]];
120
121
122 pin = !!(pins & (1 << AMS_DELTA_MOUTHPIECE));
123
124 if (pin != snd_soc_dapm_get_pin_status(dapm, "Mouthpiece")) {
125 changed = 1;
126 if (pin)
127 snd_soc_dapm_enable_pin_unlocked(dapm, "Mouthpiece");
128 else
129 snd_soc_dapm_disable_pin_unlocked(dapm, "Mouthpiece");
130 }
131 pin = !!(pins & (1 << AMS_DELTA_EARPIECE));
132 if (pin != snd_soc_dapm_get_pin_status(dapm, "Earpiece")) {
133 changed = 1;
134 if (pin)
135 snd_soc_dapm_enable_pin_unlocked(dapm, "Earpiece");
136 else
137 snd_soc_dapm_disable_pin_unlocked(dapm, "Earpiece");
138 }
139 pin = !!(pins & (1 << AMS_DELTA_MICROPHONE));
140 if (pin != snd_soc_dapm_get_pin_status(dapm, "Microphone")) {
141 changed = 1;
142 if (pin)
143 snd_soc_dapm_enable_pin_unlocked(dapm, "Microphone");
144 else
145 snd_soc_dapm_disable_pin_unlocked(dapm, "Microphone");
146 }
147 pin = !!(pins & (1 << AMS_DELTA_SPEAKER));
148 if (pin != snd_soc_dapm_get_pin_status(dapm, "Speaker")) {
149 changed = 1;
150 if (pin)
151 snd_soc_dapm_enable_pin_unlocked(dapm, "Speaker");
152 else
153 snd_soc_dapm_disable_pin_unlocked(dapm, "Speaker");
154 }
155 pin = !!(pins & (1 << AMS_DELTA_AGC));
156 if (pin != ams_delta_audio_agc) {
157 ams_delta_audio_agc = pin;
158 changed = 1;
159 if (pin)
160 snd_soc_dapm_enable_pin_unlocked(dapm, "AGCIN");
161 else
162 snd_soc_dapm_disable_pin_unlocked(dapm, "AGCIN");
163 }
164
165 if (changed)
166 snd_soc_dapm_sync_unlocked(dapm);
167
168 snd_soc_dapm_mutex_unlock(dapm);
169
170 return changed;
171}
172
173static int ams_delta_get_audio_mode(struct snd_kcontrol *kcontrol,
174 struct snd_ctl_elem_value *ucontrol)
175{
176 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
177 struct snd_soc_dapm_context *dapm = &card->dapm;
178 unsigned short pins, mode;
179
180 pins = ((snd_soc_dapm_get_pin_status(dapm, "Mouthpiece") <<
181 AMS_DELTA_MOUTHPIECE) |
182 (snd_soc_dapm_get_pin_status(dapm, "Earpiece") <<
183 AMS_DELTA_EARPIECE));
184 if (pins)
185 pins |= (snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
186 AMS_DELTA_MICROPHONE);
187 else
188 pins = ((snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
189 AMS_DELTA_MICROPHONE) |
190 (snd_soc_dapm_get_pin_status(dapm, "Speaker") <<
191 AMS_DELTA_SPEAKER) |
192 (ams_delta_audio_agc << AMS_DELTA_AGC));
193
194 for (mode = 0; mode < ARRAY_SIZE(ams_delta_audio_mode); mode++)
195 if (pins == ams_delta_audio_mode_pins[mode])
196 break;
197
198 if (mode >= ARRAY_SIZE(ams_delta_audio_mode))
199 return -EINVAL;
200
201 ucontrol->value.enumerated.item[0] = mode;
202
203 return 0;
204}
205
206static SOC_ENUM_SINGLE_EXT_DECL(ams_delta_audio_enum,
207 ams_delta_audio_mode);
208
209static const struct snd_kcontrol_new ams_delta_audio_controls[] = {
210 SOC_ENUM_EXT("Audio Mode", ams_delta_audio_enum,
211 ams_delta_get_audio_mode, ams_delta_set_audio_mode),
212};
213
214
215static struct snd_soc_jack ams_delta_hook_switch;
216static struct snd_soc_jack_gpio ams_delta_hook_switch_gpios[] = {
217 {
218 .name = "hook_switch",
219 .report = SND_JACK_HEADSET,
220 .invert = 1,
221 .debounce_time = 150,
222 }
223};
224
225
226
227static struct snd_soc_jack_pin ams_delta_hook_switch_pins[] = {
228
229 {
230 .pin = "Mouthpiece",
231 .mask = SND_JACK_MICROPHONE,
232 },
233 {
234 .pin = "Earpiece",
235 .mask = SND_JACK_HEADPHONE,
236 },
237
238 {
239 .pin = "Microphone",
240 .mask = SND_JACK_MICROPHONE,
241 .invert = 1,
242 },
243 {
244 .pin = "Speaker",
245 .mask = SND_JACK_HEADPHONE,
246 .invert = 1,
247 },
248};
249
250
251
252
253
254
255
256
257
258
259static struct timer_list cx81801_timer;
260static bool cx81801_cmd_pending;
261static bool ams_delta_muted;
262static DEFINE_SPINLOCK(ams_delta_lock);
263static struct gpio_desc *gpiod_modem_codec;
264
265static void cx81801_timeout(struct timer_list *unused)
266{
267 int muted;
268
269 spin_lock(&ams_delta_lock);
270 cx81801_cmd_pending = 0;
271 muted = ams_delta_muted;
272 spin_unlock(&ams_delta_lock);
273
274
275
276 if (!muted)
277 gpiod_set_value(gpiod_modem_codec, 0);
278}
279
280
281static int cx81801_open(struct tty_struct *tty)
282{
283 int ret;
284
285 if (!cx20442_codec)
286 return -ENODEV;
287
288
289
290
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;
300}
301
302
303static void cx81801_close(struct tty_struct *tty)
304{
305 struct snd_soc_component *component = tty->disc_data;
306 struct snd_soc_dapm_context *dapm = &component->card->dapm;
307
308 del_timer_sync(&cx81801_timer);
309
310
311 INIT_LIST_HEAD(&ams_delta_hook_switch.pins);
312
313 if (!component)
314 return;
315
316 v253_ops.close(tty);
317
318
319 snd_soc_dapm_mutex_lock(dapm);
320
321 snd_soc_dapm_disable_pin_unlocked(dapm, "Mouthpiece");
322 snd_soc_dapm_enable_pin_unlocked(dapm, "Earpiece");
323 snd_soc_dapm_enable_pin_unlocked(dapm, "Microphone");
324 snd_soc_dapm_disable_pin_unlocked(dapm, "Speaker");
325 snd_soc_dapm_disable_pin_unlocked(dapm, "AGCIN");
326
327 snd_soc_dapm_sync_unlocked(dapm);
328
329 snd_soc_dapm_mutex_unlock(dapm);
330}
331
332
333static int cx81801_hangup(struct tty_struct *tty)
334{
335 cx81801_close(tty);
336 return 0;
337}
338
339
340static void cx81801_receive(struct tty_struct *tty, const unsigned char *cp,
341 const char *fp, int count)
342{
343 struct snd_soc_component *component = tty->disc_data;
344 const unsigned char *c;
345 int apply, ret;
346
347 if (!component)
348 return;
349
350 if (!component->card->pop_time) {
351
352
353
354 timer_setup(&cx81801_timer, cx81801_timeout, 0);
355
356 v253_ops.receive_buf(tty, cp, fp, count);
357
358
359 ret = snd_soc_jack_add_pins(&ams_delta_hook_switch,
360 ARRAY_SIZE(ams_delta_hook_switch_pins),
361 ams_delta_hook_switch_pins);
362 if (ret)
363 dev_warn(component->dev,
364 "Failed to link hook switch to DAPM pins, "
365 "will continue with hook switch unlinked.\n");
366
367 return;
368 }
369
370 v253_ops.receive_buf(tty, cp, fp, count);
371
372 for (c = &cp[count - 1]; c >= cp; c--) {
373 if (*c != '\r')
374 continue;
375
376
377 spin_lock_bh(&ams_delta_lock);
378 mod_timer(&cx81801_timer, jiffies + msecs_to_jiffies(150));
379 apply = !ams_delta_muted && !cx81801_cmd_pending;
380 cx81801_cmd_pending = 1;
381 spin_unlock_bh(&ams_delta_lock);
382
383
384
385 if (apply)
386 gpiod_set_value(gpiod_modem_codec, 1);
387 break;
388 }
389}
390
391
392static void cx81801_wakeup(struct tty_struct *tty)
393{
394 v253_ops.write_wakeup(tty);
395}
396
397static struct tty_ldisc_ops cx81801_ops = {
398 .name = "cx81801",
399 .num = N_V253,
400 .owner = THIS_MODULE,
401 .open = cx81801_open,
402 .close = cx81801_close,
403 .hangup = cx81801_hangup,
404 .receive_buf = cx81801_receive,
405 .write_wakeup = cx81801_wakeup,
406};
407
408
409
410
411
412
413
414
415
416static struct snd_soc_ops ams_delta_ops;
417
418
419
420
421static bool ams_delta_muted = 1;
422
423static int ams_delta_mute(struct snd_soc_dai *dai, int mute, int direction)
424{
425 int apply;
426
427 if (ams_delta_muted == mute)
428 return 0;
429
430 spin_lock_bh(&ams_delta_lock);
431 ams_delta_muted = mute;
432 apply = !cx81801_cmd_pending;
433 spin_unlock_bh(&ams_delta_lock);
434
435 if (apply)
436 gpiod_set_value(gpiod_modem_codec, !!mute);
437 return 0;
438}
439
440
441static const struct snd_soc_dai_ops ams_delta_dai_ops = {
442 .mute_stream = ams_delta_mute,
443 .no_capture_mute = 1,
444};
445
446
447static int ams_delta_startup(struct snd_pcm_substream *substream)
448{
449 return ams_delta_mute(NULL, 0, substream->stream);
450}
451
452static void ams_delta_shutdown(struct snd_pcm_substream *substream)
453{
454 ams_delta_mute(NULL, 1, substream->stream);
455}
456
457
458
459
460
461
462static int ams_delta_cx20442_init(struct snd_soc_pcm_runtime *rtd)
463{
464 struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0);
465 struct snd_soc_card *card = rtd->card;
466 struct snd_soc_dapm_context *dapm = &card->dapm;
467 int ret;
468
469
470
471 cx20442_codec = asoc_rtd_to_codec(rtd, 0)->component;
472
473
474
475 ret = snd_soc_card_jack_new(card, "hook_switch", SND_JACK_HEADSET,
476 &ams_delta_hook_switch, NULL, 0);
477 if (ret)
478 dev_warn(card->dev,
479 "Failed to allocate resources for hook switch, "
480 "will continue without one.\n");
481 else {
482 ret = snd_soc_jack_add_gpiods(card->dev, &ams_delta_hook_switch,
483 ARRAY_SIZE(ams_delta_hook_switch_gpios),
484 ams_delta_hook_switch_gpios);
485 if (ret)
486 dev_warn(card->dev,
487 "Failed to set up hook switch GPIO line, "
488 "will continue with hook switch inactive.\n");
489 }
490
491 gpiod_modem_codec = devm_gpiod_get(card->dev, "modem_codec",
492 GPIOD_OUT_HIGH);
493 if (IS_ERR(gpiod_modem_codec)) {
494 dev_warn(card->dev, "Failed to obtain modem_codec GPIO\n");
495 return 0;
496 }
497
498
499 if (!codec_dai->driver->ops) {
500 codec_dai->driver->ops = &ams_delta_dai_ops;
501 } else {
502 ams_delta_ops.startup = ams_delta_startup;
503 ams_delta_ops.shutdown = ams_delta_shutdown;
504 }
505
506
507 ret = tty_register_ldisc(&cx81801_ops);
508 if (ret) {
509 dev_warn(card->dev,
510 "Failed to register line discipline, "
511 "will continue without any controls.\n");
512 return 0;
513 }
514
515
516 snd_soc_dapm_disable_pin(dapm, "Mouthpiece");
517 snd_soc_dapm_disable_pin(dapm, "Speaker");
518 snd_soc_dapm_disable_pin(dapm, "AGCIN");
519 snd_soc_dapm_disable_pin(dapm, "AGCOUT");
520
521 return 0;
522}
523
524
525SND_SOC_DAILINK_DEFS(cx20442,
526 DAILINK_COMP_ARRAY(COMP_CPU("omap-mcbsp.1")),
527 DAILINK_COMP_ARRAY(COMP_CODEC("cx20442-codec", "cx20442-voice")),
528 DAILINK_COMP_ARRAY(COMP_PLATFORM("omap-mcbsp.1")));
529
530static struct snd_soc_dai_link ams_delta_dai_link = {
531 .name = "CX20442",
532 .stream_name = "CX20442",
533 .init = ams_delta_cx20442_init,
534 .ops = &ams_delta_ops,
535 .dai_fmt = SND_SOC_DAIFMT_DSP_A | SND_SOC_DAIFMT_NB_NF |
536 SND_SOC_DAIFMT_CBM_CFM,
537 SND_SOC_DAILINK_REG(cx20442),
538};
539
540
541static struct snd_soc_card ams_delta_audio_card = {
542 .name = "AMS_DELTA",
543 .owner = THIS_MODULE,
544 .dai_link = &ams_delta_dai_link,
545 .num_links = 1,
546
547 .controls = ams_delta_audio_controls,
548 .num_controls = ARRAY_SIZE(ams_delta_audio_controls),
549 .dapm_widgets = ams_delta_dapm_widgets,
550 .num_dapm_widgets = ARRAY_SIZE(ams_delta_dapm_widgets),
551 .dapm_routes = ams_delta_audio_map,
552 .num_dapm_routes = ARRAY_SIZE(ams_delta_audio_map),
553};
554
555
556static int ams_delta_probe(struct platform_device *pdev)
557{
558 struct snd_soc_card *card = &ams_delta_audio_card;
559 int ret;
560
561 card->dev = &pdev->dev;
562
563 handset_mute = devm_gpiod_get(card->dev, "handset_mute",
564 GPIOD_OUT_HIGH);
565 if (IS_ERR(handset_mute))
566 return PTR_ERR(handset_mute);
567
568 handsfree_mute = devm_gpiod_get(card->dev, "handsfree_mute",
569 GPIOD_OUT_HIGH);
570 if (IS_ERR(handsfree_mute))
571 return PTR_ERR(handsfree_mute);
572
573 ret = snd_soc_register_card(card);
574 if (ret) {
575 dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret);
576 card->dev = NULL;
577 return ret;
578 }
579 return 0;
580}
581
582static int ams_delta_remove(struct platform_device *pdev)
583{
584 struct snd_soc_card *card = platform_get_drvdata(pdev);
585
586 tty_unregister_ldisc(&cx81801_ops);
587
588 snd_soc_unregister_card(card);
589 card->dev = NULL;
590 return 0;
591}
592
593#define DRV_NAME "ams-delta-audio"
594
595static struct platform_driver ams_delta_driver = {
596 .driver = {
597 .name = DRV_NAME,
598 },
599 .probe = ams_delta_probe,
600 .remove = ams_delta_remove,
601};
602
603module_platform_driver(ams_delta_driver);
604
605MODULE_AUTHOR("Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>");
606MODULE_DESCRIPTION("ALSA SoC driver for Amstrad E3 (Delta) videophone");
607MODULE_LICENSE("GPL");
608MODULE_ALIAS("platform:" DRV_NAME);
609