1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * ams-delta.c -- SoC audio for Amstrad E3 (Delta) videophone
4 *
5 * Copyright (C) 2009 Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>
6 *
7 * Initially based on sound/soc/omap/osk5912.x
8 * Copyright (C) 2008 Mistral Solutions
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 <linux/platform_data/asoc-ti-mcbsp.h>
20
21 #include "omap-mcbsp.h"
22 #include "../codecs/cx20442.h"
23
24 static struct gpio_desc *handset_mute;
25 static struct gpio_desc *handsfree_mute;
26
ams_delta_event_handset(struct snd_soc_dapm_widget * w,struct snd_kcontrol * k,int event)27 static int ams_delta_event_handset(struct snd_soc_dapm_widget *w,
28 struct snd_kcontrol *k, int event)
29 {
30 gpiod_set_value_cansleep(handset_mute, !SND_SOC_DAPM_EVENT_ON(event));
31 return 0;
32 }
33
ams_delta_event_handsfree(struct snd_soc_dapm_widget * w,struct snd_kcontrol * k,int event)34 static int ams_delta_event_handsfree(struct snd_soc_dapm_widget *w,
35 struct snd_kcontrol *k, int event)
36 {
37 gpiod_set_value_cansleep(handsfree_mute, !SND_SOC_DAPM_EVENT_ON(event));
38 return 0;
39 }
40
41 /* Board specific DAPM widgets */
42 static const struct snd_soc_dapm_widget ams_delta_dapm_widgets[] = {
43 /* Handset */
44 SND_SOC_DAPM_MIC("Mouthpiece", NULL),
45 SND_SOC_DAPM_HP("Earpiece", ams_delta_event_handset),
46 /* Handsfree/Speakerphone */
47 SND_SOC_DAPM_MIC("Microphone", NULL),
48 SND_SOC_DAPM_SPK("Speaker", ams_delta_event_handsfree),
49 };
50
51 /* How they are connected to codec pins */
52 static const struct snd_soc_dapm_route ams_delta_audio_map[] = {
53 {"TELIN", NULL, "Mouthpiece"},
54 {"Earpiece", NULL, "TELOUT"},
55
56 {"MIC", NULL, "Microphone"},
57 {"Speaker", NULL, "SPKOUT"},
58 };
59
60 /*
61 * Controls, functional after the modem line discipline is activated.
62 */
63
64 /* Virtual switch: audio input/output constellations */
65 static const char *ams_delta_audio_mode[] =
66 {"Mixed", "Handset", "Handsfree", "Speakerphone"};
67
68 /* Selection <-> pin translation */
69 #define AMS_DELTA_MOUTHPIECE 0
70 #define AMS_DELTA_EARPIECE 1
71 #define AMS_DELTA_MICROPHONE 2
72 #define AMS_DELTA_SPEAKER 3
73 #define AMS_DELTA_AGC 4
74
75 #define AMS_DELTA_MIXED ((1 << AMS_DELTA_EARPIECE) | \
76 (1 << AMS_DELTA_MICROPHONE))
77 #define AMS_DELTA_HANDSET ((1 << AMS_DELTA_MOUTHPIECE) | \
78 (1 << AMS_DELTA_EARPIECE))
79 #define AMS_DELTA_HANDSFREE ((1 << AMS_DELTA_MICROPHONE) | \
80 (1 << AMS_DELTA_SPEAKER))
81 #define AMS_DELTA_SPEAKERPHONE (AMS_DELTA_HANDSFREE | (1 << AMS_DELTA_AGC))
82
83 static const unsigned short ams_delta_audio_mode_pins[] = {
84 AMS_DELTA_MIXED,
85 AMS_DELTA_HANDSET,
86 AMS_DELTA_HANDSFREE,
87 AMS_DELTA_SPEAKERPHONE,
88 };
89
90 static unsigned short ams_delta_audio_agc;
91
92 /*
93 * Used for passing a codec structure pointer
94 * from the board initialization code to the tty line discipline.
95 */
96 static struct snd_soc_component *cx20442_codec;
97
ams_delta_set_audio_mode(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)98 static int ams_delta_set_audio_mode(struct snd_kcontrol *kcontrol,
99 struct snd_ctl_elem_value *ucontrol)
100 {
101 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
102 struct snd_soc_dapm_context *dapm = &card->dapm;
103 struct soc_enum *control = (struct soc_enum *)kcontrol->private_value;
104 unsigned short pins;
105 int pin, changed = 0;
106
107 /* Refuse any mode changes if we are not able to control the codec. */
108 if (!cx20442_codec->card->pop_time)
109 return -EUNATCH;
110
111 if (ucontrol->value.enumerated.item[0] >= control->items)
112 return -EINVAL;
113
114 snd_soc_dapm_mutex_lock(dapm);
115
116 /* Translate selection to bitmap */
117 pins = ams_delta_audio_mode_pins[ucontrol->value.enumerated.item[0]];
118
119 /* Setup pins after corresponding bits if changed */
120 pin = !!(pins & (1 << AMS_DELTA_MOUTHPIECE));
121
122 if (pin != snd_soc_dapm_get_pin_status(dapm, "Mouthpiece")) {
123 changed = 1;
124 if (pin)
125 snd_soc_dapm_enable_pin_unlocked(dapm, "Mouthpiece");
126 else
127 snd_soc_dapm_disable_pin_unlocked(dapm, "Mouthpiece");
128 }
129 pin = !!(pins & (1 << AMS_DELTA_EARPIECE));
130 if (pin != snd_soc_dapm_get_pin_status(dapm, "Earpiece")) {
131 changed = 1;
132 if (pin)
133 snd_soc_dapm_enable_pin_unlocked(dapm, "Earpiece");
134 else
135 snd_soc_dapm_disable_pin_unlocked(dapm, "Earpiece");
136 }
137 pin = !!(pins & (1 << AMS_DELTA_MICROPHONE));
138 if (pin != snd_soc_dapm_get_pin_status(dapm, "Microphone")) {
139 changed = 1;
140 if (pin)
141 snd_soc_dapm_enable_pin_unlocked(dapm, "Microphone");
142 else
143 snd_soc_dapm_disable_pin_unlocked(dapm, "Microphone");
144 }
145 pin = !!(pins & (1 << AMS_DELTA_SPEAKER));
146 if (pin != snd_soc_dapm_get_pin_status(dapm, "Speaker")) {
147 changed = 1;
148 if (pin)
149 snd_soc_dapm_enable_pin_unlocked(dapm, "Speaker");
150 else
151 snd_soc_dapm_disable_pin_unlocked(dapm, "Speaker");
152 }
153 pin = !!(pins & (1 << AMS_DELTA_AGC));
154 if (pin != ams_delta_audio_agc) {
155 ams_delta_audio_agc = pin;
156 changed = 1;
157 if (pin)
158 snd_soc_dapm_enable_pin_unlocked(dapm, "AGCIN");
159 else
160 snd_soc_dapm_disable_pin_unlocked(dapm, "AGCIN");
161 }
162
163 if (changed)
164 snd_soc_dapm_sync_unlocked(dapm);
165
166 snd_soc_dapm_mutex_unlock(dapm);
167
168 return changed;
169 }
170
ams_delta_get_audio_mode(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)171 static int ams_delta_get_audio_mode(struct snd_kcontrol *kcontrol,
172 struct snd_ctl_elem_value *ucontrol)
173 {
174 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol);
175 struct snd_soc_dapm_context *dapm = &card->dapm;
176 unsigned short pins, mode;
177
178 pins = ((snd_soc_dapm_get_pin_status(dapm, "Mouthpiece") <<
179 AMS_DELTA_MOUTHPIECE) |
180 (snd_soc_dapm_get_pin_status(dapm, "Earpiece") <<
181 AMS_DELTA_EARPIECE));
182 if (pins)
183 pins |= (snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
184 AMS_DELTA_MICROPHONE);
185 else
186 pins = ((snd_soc_dapm_get_pin_status(dapm, "Microphone") <<
187 AMS_DELTA_MICROPHONE) |
188 (snd_soc_dapm_get_pin_status(dapm, "Speaker") <<
189 AMS_DELTA_SPEAKER) |
190 (ams_delta_audio_agc << AMS_DELTA_AGC));
191
192 for (mode = 0; mode < ARRAY_SIZE(ams_delta_audio_mode); mode++)
193 if (pins == ams_delta_audio_mode_pins[mode])
194 break;
195
196 if (mode >= ARRAY_SIZE(ams_delta_audio_mode))
197 return -EINVAL;
198
199 ucontrol->value.enumerated.item[0] = mode;
200
201 return 0;
202 }
203
204 static SOC_ENUM_SINGLE_EXT_DECL(ams_delta_audio_enum,
205 ams_delta_audio_mode);
206
207 static const struct snd_kcontrol_new ams_delta_audio_controls[] = {
208 SOC_ENUM_EXT("Audio Mode", ams_delta_audio_enum,
209 ams_delta_get_audio_mode, ams_delta_set_audio_mode),
210 };
211
212 /* Hook switch */
213 static struct snd_soc_jack ams_delta_hook_switch;
214 static struct snd_soc_jack_gpio ams_delta_hook_switch_gpios[] = {
215 {
216 .name = "hook_switch",
217 .report = SND_JACK_HEADSET,
218 .invert = 1,
219 .debounce_time = 150,
220 }
221 };
222
223 /* After we are able to control the codec over the modem,
224 * the hook switch can be used for dynamic DAPM reconfiguration. */
225 static struct snd_soc_jack_pin ams_delta_hook_switch_pins[] = {
226 /* Handset */
227 {
228 .pin = "Mouthpiece",
229 .mask = SND_JACK_MICROPHONE,
230 },
231 {
232 .pin = "Earpiece",
233 .mask = SND_JACK_HEADPHONE,
234 },
235 /* Handsfree */
236 {
237 .pin = "Microphone",
238 .mask = SND_JACK_MICROPHONE,
239 .invert = 1,
240 },
241 {
242 .pin = "Speaker",
243 .mask = SND_JACK_HEADPHONE,
244 .invert = 1,
245 },
246 };
247
248
249 /*
250 * Modem line discipline, required for making above controls functional.
251 * Activated from userspace with ldattach, possibly invoked from udev rule.
252 */
253
254 /* To actually apply any modem controlled configuration changes to the codec,
255 * we must connect codec DAI pins to the modem for a moment. Be careful not
256 * to interfere with our digital mute function that shares the same hardware. */
257 static struct timer_list cx81801_timer;
258 static bool cx81801_cmd_pending;
259 static bool ams_delta_muted;
260 static DEFINE_SPINLOCK(ams_delta_lock);
261 static struct gpio_desc *gpiod_modem_codec;
262
cx81801_timeout(struct timer_list * unused)263 static void cx81801_timeout(struct timer_list *unused)
264 {
265 int muted;
266
267 spin_lock(&ams_delta_lock);
268 cx81801_cmd_pending = 0;
269 muted = ams_delta_muted;
270 spin_unlock(&ams_delta_lock);
271
272 /* Reconnect the codec DAI back from the modem to the CPU DAI
273 * only if digital mute still off */
274 if (!muted)
275 gpiod_set_value(gpiod_modem_codec, 0);
276 }
277
278 /* Line discipline .open() */
cx81801_open(struct tty_struct * tty)279 static int cx81801_open(struct tty_struct *tty)
280 {
281 int ret;
282
283 if (!cx20442_codec)
284 return -ENODEV;
285
286 /*
287 * Pass the codec structure pointer for use by other ldisc callbacks,
288 * both the card and the codec specific parts.
289 */
290 tty->disc_data = cx20442_codec;
291
292 ret = v253_ops.open(tty);
293
294 if (ret < 0)
295 tty->disc_data = NULL;
296
297 return ret;
298 }
299
300 /* Line discipline .close() */
cx81801_close(struct tty_struct * tty)301 static void cx81801_close(struct tty_struct *tty)
302 {
303 struct snd_soc_component *component = tty->disc_data;
304 struct snd_soc_dapm_context *dapm;
305
306 del_timer_sync(&cx81801_timer);
307
308 /* Prevent the hook switch from further changing the DAPM pins */
309 INIT_LIST_HEAD(&ams_delta_hook_switch.pins);
310
311 if (!component)
312 return;
313
314 v253_ops.close(tty);
315
316 dapm = &component->card->dapm;
317
318 /* Revert back to default audio input/output constellation */
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 /* Line discipline .hangup() */
cx81801_hangup(struct tty_struct * tty)333 static void cx81801_hangup(struct tty_struct *tty)
334 {
335 cx81801_close(tty);
336 }
337
338 /* Line discipline .receive_buf() */
cx81801_receive(struct tty_struct * tty,const u8 * cp,const u8 * fp,size_t count)339 static void cx81801_receive(struct tty_struct *tty, const u8 *cp, const u8 *fp,
340 size_t count)
341 {
342 struct snd_soc_component *component = tty->disc_data;
343 const unsigned char *c;
344 int apply, ret;
345
346 if (!component)
347 return;
348
349 if (!component->card->pop_time) {
350 /* First modem response, complete setup procedure */
351
352 /* Initialize timer used for config pulse generation */
353 timer_setup(&cx81801_timer, cx81801_timeout, 0);
354
355 v253_ops.receive_buf(tty, cp, fp, count);
356
357 /* Link hook switch to DAPM pins */
358 ret = snd_soc_jack_add_pins(&ams_delta_hook_switch,
359 ARRAY_SIZE(ams_delta_hook_switch_pins),
360 ams_delta_hook_switch_pins);
361 if (ret)
362 dev_warn(component->dev,
363 "Failed to link hook switch to DAPM pins, "
364 "will continue with hook switch unlinked.\n");
365
366 return;
367 }
368
369 v253_ops.receive_buf(tty, cp, fp, count);
370
371 for (c = &cp[count - 1]; c >= cp; c--) {
372 if (*c != '\r')
373 continue;
374 /* Complete modem response received, apply config to codec */
375
376 spin_lock_bh(&ams_delta_lock);
377 mod_timer(&cx81801_timer, jiffies + msecs_to_jiffies(150));
378 apply = !ams_delta_muted && !cx81801_cmd_pending;
379 cx81801_cmd_pending = 1;
380 spin_unlock_bh(&ams_delta_lock);
381
382 /* Apply config pulse by connecting the codec to the modem
383 * if not already done */
384 if (apply)
385 gpiod_set_value(gpiod_modem_codec, 1);
386 break;
387 }
388 }
389
390 /* Line discipline .write_wakeup() */
cx81801_wakeup(struct tty_struct * tty)391 static void cx81801_wakeup(struct tty_struct *tty)
392 {
393 v253_ops.write_wakeup(tty);
394 }
395
396 static struct tty_ldisc_ops cx81801_ops = {
397 .name = "cx81801",
398 .num = N_V253,
399 .owner = THIS_MODULE,
400 .open = cx81801_open,
401 .close = cx81801_close,
402 .hangup = cx81801_hangup,
403 .receive_buf = cx81801_receive,
404 .write_wakeup = cx81801_wakeup,
405 };
406
407
408 /*
409 * Even if not very useful, the sound card can still work without any of the
410 * above functionality activated. You can still control its audio input/output
411 * constellation and speakerphone gain from userspace by issuing AT commands
412 * over the modem port.
413 */
414
415 static struct snd_soc_ops ams_delta_ops;
416
417
418 /* Digital mute implemented using modem/CPU multiplexer.
419 * Shares hardware with codec config pulse generation */
420 static bool ams_delta_muted = 1;
421
ams_delta_mute(struct snd_soc_dai * dai,int mute,int direction)422 static int ams_delta_mute(struct snd_soc_dai *dai, int mute, int direction)
423 {
424 int apply;
425
426 if (ams_delta_muted == mute)
427 return 0;
428
429 spin_lock_bh(&ams_delta_lock);
430 ams_delta_muted = mute;
431 apply = !cx81801_cmd_pending;
432 spin_unlock_bh(&ams_delta_lock);
433
434 if (apply)
435 gpiod_set_value(gpiod_modem_codec, !!mute);
436 return 0;
437 }
438
439 /* Our codec DAI probably doesn't have its own .ops structure */
440 static const struct snd_soc_dai_ops ams_delta_dai_ops = {
441 .mute_stream = ams_delta_mute,
442 .no_capture_mute = 1,
443 };
444
445 /* Will be used if the codec ever has its own digital_mute function */
ams_delta_startup(struct snd_pcm_substream * substream)446 static int ams_delta_startup(struct snd_pcm_substream *substream)
447 {
448 return ams_delta_mute(NULL, 0, substream->stream);
449 }
450
ams_delta_shutdown(struct snd_pcm_substream * substream)451 static void ams_delta_shutdown(struct snd_pcm_substream *substream)
452 {
453 ams_delta_mute(NULL, 1, substream->stream);
454 }
455
456
457 /*
458 * Card initialization
459 */
460
ams_delta_cx20442_init(struct snd_soc_pcm_runtime * rtd)461 static int ams_delta_cx20442_init(struct snd_soc_pcm_runtime *rtd)
462 {
463 struct snd_soc_dai *codec_dai = snd_soc_rtd_to_codec(rtd, 0);
464 struct snd_soc_card *card = rtd->card;
465 struct snd_soc_dapm_context *dapm = &card->dapm;
466 int ret;
467 /* Codec is ready, now add/activate board specific controls */
468
469 /* Store a pointer to the codec structure for tty ldisc use */
470 cx20442_codec = snd_soc_rtd_to_codec(rtd, 0)->component;
471
472 /* Add hook switch - can be used to control the codec from userspace
473 * even if line discipline fails */
474 ret = snd_soc_card_jack_new_pins(card, "hook_switch", SND_JACK_HEADSET,
475 &ams_delta_hook_switch, NULL, 0);
476 if (ret)
477 dev_warn(card->dev,
478 "Failed to allocate resources for hook switch, "
479 "will continue without one.\n");
480 else {
481 ret = snd_soc_jack_add_gpiods(card->dev, &ams_delta_hook_switch,
482 ARRAY_SIZE(ams_delta_hook_switch_gpios),
483 ams_delta_hook_switch_gpios);
484 if (ret)
485 dev_warn(card->dev,
486 "Failed to set up hook switch GPIO line, "
487 "will continue with hook switch inactive.\n");
488 }
489
490 gpiod_modem_codec = devm_gpiod_get(card->dev, "modem_codec",
491 GPIOD_OUT_HIGH);
492 if (IS_ERR(gpiod_modem_codec)) {
493 dev_warn(card->dev, "Failed to obtain modem_codec GPIO\n");
494 return 0;
495 }
496
497 /* Set up digital mute if not provided by the codec */
498 if (!codec_dai->driver->ops) {
499 codec_dai->driver->ops = &ams_delta_dai_ops;
500 } else {
501 ams_delta_ops.startup = ams_delta_startup;
502 ams_delta_ops.shutdown = ams_delta_shutdown;
503 }
504
505 /* Register optional line discipline for over the modem control */
506 ret = tty_register_ldisc(&cx81801_ops);
507 if (ret) {
508 dev_warn(card->dev,
509 "Failed to register line discipline, "
510 "will continue without any controls.\n");
511 return 0;
512 }
513
514 /* Set up initial pin constellation */
515 snd_soc_dapm_disable_pin(dapm, "Mouthpiece");
516 snd_soc_dapm_disable_pin(dapm, "Speaker");
517 snd_soc_dapm_disable_pin(dapm, "AGCIN");
518 snd_soc_dapm_disable_pin(dapm, "AGCOUT");
519
520 return 0;
521 }
522
523 /* DAI glue - connects codec <--> CPU */
524 SND_SOC_DAILINK_DEFS(cx20442,
525 DAILINK_COMP_ARRAY(COMP_CPU("omap-mcbsp.1")),
526 DAILINK_COMP_ARRAY(COMP_CODEC("cx20442-codec", "cx20442-voice")),
527 DAILINK_COMP_ARRAY(COMP_PLATFORM("omap-mcbsp.1")));
528
529 static struct snd_soc_dai_link ams_delta_dai_link = {
530 .name = "CX20442",
531 .stream_name = "CX20442",
532 .init = ams_delta_cx20442_init,
533 .ops = &ams_delta_ops,
534 .dai_fmt = SND_SOC_DAIFMT_DSP_A | SND_SOC_DAIFMT_NB_NF |
535 SND_SOC_DAIFMT_CBM_CFM,
536 SND_SOC_DAILINK_REG(cx20442),
537 };
538
539 /* Audio card driver */
540 static struct snd_soc_card ams_delta_audio_card = {
541 .name = "AMS_DELTA",
542 .owner = THIS_MODULE,
543 .dai_link = &ams_delta_dai_link,
544 .num_links = 1,
545
546 .controls = ams_delta_audio_controls,
547 .num_controls = ARRAY_SIZE(ams_delta_audio_controls),
548 .dapm_widgets = ams_delta_dapm_widgets,
549 .num_dapm_widgets = ARRAY_SIZE(ams_delta_dapm_widgets),
550 .dapm_routes = ams_delta_audio_map,
551 .num_dapm_routes = ARRAY_SIZE(ams_delta_audio_map),
552 };
553
554 /* Module init/exit */
ams_delta_probe(struct platform_device * pdev)555 static int ams_delta_probe(struct platform_device *pdev)
556 {
557 struct snd_soc_card *card = &ams_delta_audio_card;
558 int ret;
559
560 card->dev = &pdev->dev;
561
562 handset_mute = devm_gpiod_get(card->dev, "handset_mute",
563 GPIOD_OUT_HIGH);
564 if (IS_ERR(handset_mute))
565 return PTR_ERR(handset_mute);
566
567 handsfree_mute = devm_gpiod_get(card->dev, "handsfree_mute",
568 GPIOD_OUT_HIGH);
569 if (IS_ERR(handsfree_mute))
570 return PTR_ERR(handsfree_mute);
571
572 ret = snd_soc_register_card(card);
573 if (ret) {
574 dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret);
575 card->dev = NULL;
576 return ret;
577 }
578 return 0;
579 }
580
ams_delta_remove(struct platform_device * pdev)581 static void ams_delta_remove(struct platform_device *pdev)
582 {
583 struct snd_soc_card *card = platform_get_drvdata(pdev);
584
585 tty_unregister_ldisc(&cx81801_ops);
586
587 snd_soc_unregister_card(card);
588 card->dev = NULL;
589 }
590
591 #define DRV_NAME "ams-delta-audio"
592
593 static struct platform_driver ams_delta_driver = {
594 .driver = {
595 .name = DRV_NAME,
596 },
597 .probe = ams_delta_probe,
598 .remove = ams_delta_remove,
599 };
600
601 module_platform_driver(ams_delta_driver);
602
603 MODULE_AUTHOR("Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>");
604 MODULE_DESCRIPTION("ALSA SoC driver for Amstrad E3 (Delta) videophone");
605 MODULE_LICENSE("GPL");
606 MODULE_ALIAS("platform:" DRV_NAME);
607