xref: /linux/sound/soc/codecs/cx20442.c (revision d39d0ed196aa1685bb24771e92f78633c66ac9cb) 
1 /*
2  * cx20442.c  --  CX20442 ALSA Soc Audio driver
3  *
4  * Copyright 2009 Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>
5  *
6  * Initially based on sound/soc/codecs/wm8400.c
7  * Copyright 2008, 2009 Wolfson Microelectronics PLC.
8  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
9  *
10  *  This program is free software; you can redistribute  it and/or modify it
11  *  under  the terms of  the GNU General  Public License as published by the
12  *  Free Software Foundation;  either version 2 of the  License, or (at your
13  *  option) any later version.
14  */
15 
16 #include <linux/tty.h>
17 #include <linux/slab.h>
18 
19 #include <sound/core.h>
20 #include <sound/initval.h>
21 #include <sound/soc-dapm.h>
22 
23 #include "cx20442.h"
24 
25 
26 struct cx20442_priv {
27 	struct snd_soc_codec codec;
28 	u8 reg_cache[1];
29 };
30 
31 #define CX20442_PM		0x0
32 
33 #define CX20442_TELIN		0
34 #define CX20442_TELOUT		1
35 #define CX20442_MIC		2
36 #define CX20442_SPKOUT		3
37 #define CX20442_AGC		4
38 
39 static const struct snd_soc_dapm_widget cx20442_dapm_widgets[] = {
40 	SND_SOC_DAPM_OUTPUT("TELOUT"),
41 	SND_SOC_DAPM_OUTPUT("SPKOUT"),
42 	SND_SOC_DAPM_OUTPUT("AGCOUT"),
43 
44 	SND_SOC_DAPM_MIXER("SPKOUT Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),
45 
46 	SND_SOC_DAPM_PGA("TELOUT Amp", CX20442_PM, CX20442_TELOUT, 0, NULL, 0),
47 	SND_SOC_DAPM_PGA("SPKOUT Amp", CX20442_PM, CX20442_SPKOUT, 0, NULL, 0),
48 	SND_SOC_DAPM_PGA("SPKOUT AGC", CX20442_PM, CX20442_AGC, 0, NULL, 0),
49 
50 	SND_SOC_DAPM_DAC("DAC", "Playback", SND_SOC_NOPM, 0, 0),
51 	SND_SOC_DAPM_ADC("ADC", "Capture", SND_SOC_NOPM, 0, 0),
52 
53 	SND_SOC_DAPM_MIXER("Input Mixer", SND_SOC_NOPM, 0, 0, NULL, 0),
54 
55 	SND_SOC_DAPM_MICBIAS("TELIN Bias", CX20442_PM, CX20442_TELIN, 0),
56 	SND_SOC_DAPM_MICBIAS("MIC Bias", CX20442_PM, CX20442_MIC, 0),
57 
58 	SND_SOC_DAPM_PGA("MIC AGC", CX20442_PM, CX20442_AGC, 0, NULL, 0),
59 
60 	SND_SOC_DAPM_INPUT("TELIN"),
61 	SND_SOC_DAPM_INPUT("MIC"),
62 	SND_SOC_DAPM_INPUT("AGCIN"),
63 };
64 
65 static const struct snd_soc_dapm_route cx20442_audio_map[] = {
66 	{"TELOUT", NULL, "TELOUT Amp"},
67 
68 	{"SPKOUT", NULL, "SPKOUT Mixer"},
69 	{"SPKOUT Mixer", NULL, "SPKOUT Amp"},
70 
71 	{"TELOUT Amp", NULL, "DAC"},
72 	{"SPKOUT Amp", NULL, "DAC"},
73 
74 	{"SPKOUT Mixer", NULL, "SPKOUT AGC"},
75 	{"SPKOUT AGC", NULL, "AGCIN"},
76 
77 	{"AGCOUT", NULL, "MIC AGC"},
78 	{"MIC AGC", NULL, "MIC"},
79 
80 	{"MIC Bias", NULL, "MIC"},
81 	{"Input Mixer", NULL, "MIC Bias"},
82 
83 	{"TELIN Bias", NULL, "TELIN"},
84 	{"Input Mixer", NULL, "TELIN Bias"},
85 
86 	{"ADC", NULL, "Input Mixer"},
87 };
88 
89 static int cx20442_add_widgets(struct snd_soc_codec *codec)
90 {
91 	snd_soc_dapm_new_controls(codec, cx20442_dapm_widgets,
92 				  ARRAY_SIZE(cx20442_dapm_widgets));
93 
94 	snd_soc_dapm_add_routes(codec, cx20442_audio_map,
95 				ARRAY_SIZE(cx20442_audio_map));
96 
97 	return 0;
98 }
99 
100 static unsigned int cx20442_read_reg_cache(struct snd_soc_codec *codec,
101 							unsigned int reg)
102 {
103 	u8 *reg_cache = codec->reg_cache;
104 
105 	if (reg >= codec->reg_cache_size)
106 		return -EINVAL;
107 
108 	return reg_cache[reg];
109 }
110 
111 enum v253_vls {
112 	V253_VLS_NONE = 0,
113 	V253_VLS_T,
114 	V253_VLS_L,
115 	V253_VLS_LT,
116 	V253_VLS_S,
117 	V253_VLS_ST,
118 	V253_VLS_M,
119 	V253_VLS_MST,
120 	V253_VLS_S1,
121 	V253_VLS_S1T,
122 	V253_VLS_MS1T,
123 	V253_VLS_M1,
124 	V253_VLS_M1ST,
125 	V253_VLS_M1S1T,
126 	V253_VLS_H,
127 	V253_VLS_HT,
128 	V253_VLS_MS,
129 	V253_VLS_MS1,
130 	V253_VLS_M1S,
131 	V253_VLS_M1S1,
132 	V253_VLS_TEST,
133 };
134 
135 static int cx20442_pm_to_v253_vls(u8 value)
136 {
137 	switch (value & ~(1 << CX20442_AGC)) {
138 	case 0:
139 		return V253_VLS_T;
140 	case (1 << CX20442_SPKOUT):
141 	case (1 << CX20442_MIC):
142 	case (1 << CX20442_SPKOUT) | (1 << CX20442_MIC):
143 		return V253_VLS_M1S1;
144 	case (1 << CX20442_TELOUT):
145 	case (1 << CX20442_TELIN):
146 	case (1 << CX20442_TELOUT) | (1 << CX20442_TELIN):
147 		return V253_VLS_L;
148 	case (1 << CX20442_TELOUT) | (1 << CX20442_MIC):
149 		return V253_VLS_NONE;
150 	}
151 	return -EINVAL;
152 }
153 static int cx20442_pm_to_v253_vsp(u8 value)
154 {
155 	switch (value & ~(1 << CX20442_AGC)) {
156 	case (1 << CX20442_SPKOUT):
157 	case (1 << CX20442_MIC):
158 	case (1 << CX20442_SPKOUT) | (1 << CX20442_MIC):
159 		return (bool)(value & (1 << CX20442_AGC));
160 	}
161 	return (value & (1 << CX20442_AGC)) ? -EINVAL : 0;
162 }
163 
164 static int cx20442_write(struct snd_soc_codec *codec, unsigned int reg,
165 							unsigned int value)
166 {
167 	u8 *reg_cache = codec->reg_cache;
168 	int vls, vsp, old, len;
169 	char buf[18];
170 
171 	if (reg >= codec->reg_cache_size)
172 		return -EINVAL;
173 
174 	/* hw_write and control_data pointers required for talking to the modem
175 	 * are expected to be set by the line discipline initialization code */
176 	if (!codec->hw_write || !codec->control_data)
177 		return -EIO;
178 
179 	old = reg_cache[reg];
180 	reg_cache[reg] = value;
181 
182 	vls = cx20442_pm_to_v253_vls(value);
183 	if (vls < 0)
184 		return vls;
185 
186 	vsp = cx20442_pm_to_v253_vsp(value);
187 	if (vsp < 0)
188 		return vsp;
189 
190 	if ((vls == V253_VLS_T) ||
191 			(vls == cx20442_pm_to_v253_vls(old))) {
192 		if (vsp == cx20442_pm_to_v253_vsp(old))
193 			return 0;
194 		len = snprintf(buf, ARRAY_SIZE(buf), "at+vsp=%d\r", vsp);
195 	} else if (vsp == cx20442_pm_to_v253_vsp(old))
196 		len = snprintf(buf, ARRAY_SIZE(buf), "at+vls=%d\r", vls);
197 	else
198 		len = snprintf(buf, ARRAY_SIZE(buf),
199 					"at+vls=%d;+vsp=%d\r", vls, vsp);
200 
201 	if (unlikely(len > (ARRAY_SIZE(buf) - 1)))
202 		return -ENOMEM;
203 
204 	dev_dbg(codec->dev, "%s: %s\n", __func__, buf);
205 	if (codec->hw_write(codec->control_data, buf, len) != len)
206 		return -EIO;
207 
208 	return 0;
209 }
210 
211 
212 /* Moved up here as line discipline referres it during initialization */
213 static struct snd_soc_codec *cx20442_codec;
214 
215 
216 /*
217  * Line discpline related code
218  *
219  * Any of the callback functions below can be used in two ways:
220  * 1) registerd by a machine driver as one of line discipline operations,
221  * 2) called from a machine's provided line discipline callback function
222  *    in case when extra machine specific code must be run as well.
223  */
224 
225 /* Modem init: echo off, digital speaker off, quiet off, voice mode */
226 static const char *v253_init = "ate0m0q0+fclass=8\r";
227 
228 /* Line discipline .open() */
229 static int v253_open(struct tty_struct *tty)
230 {
231 	struct snd_soc_codec *codec = cx20442_codec;
232 	int ret, len = strlen(v253_init);
233 
234 	/* Doesn't make sense without write callback */
235 	if (!tty->ops->write)
236 		return -EINVAL;
237 
238 	/* Pass the codec structure address for use by other ldisc callbacks */
239 	tty->disc_data = codec;
240 
241 	if (tty->ops->write(tty, v253_init, len) != len) {
242 		ret = -EIO;
243 		goto err;
244 	}
245 	/* Actual setup will be performed after the modem responds. */
246 	return 0;
247 err:
248 	tty->disc_data = NULL;
249 	return ret;
250 }
251 
252 /* Line discipline .close() */
253 static void v253_close(struct tty_struct *tty)
254 {
255 	struct snd_soc_codec *codec = tty->disc_data;
256 
257 	tty->disc_data = NULL;
258 
259 	if (!codec)
260 		return;
261 
262 	/* Prevent the codec driver from further accessing the modem */
263 	codec->hw_write = NULL;
264 	codec->control_data = NULL;
265 	codec->pop_time = 0;
266 }
267 
268 /* Line discipline .hangup() */
269 static int v253_hangup(struct tty_struct *tty)
270 {
271 	v253_close(tty);
272 	return 0;
273 }
274 
275 /* Line discipline .receive_buf() */
276 static void v253_receive(struct tty_struct *tty,
277 				const unsigned char *cp, char *fp, int count)
278 {
279 	struct snd_soc_codec *codec = tty->disc_data;
280 
281 	if (!codec)
282 		return;
283 
284 	if (!codec->control_data) {
285 		/* First modem response, complete setup procedure */
286 
287 		/* Set up codec driver access to modem controls */
288 		codec->control_data = tty;
289 		codec->hw_write = (hw_write_t)tty->ops->write;
290 		codec->pop_time = 1;
291 	}
292 }
293 
294 /* Line discipline .write_wakeup() */
295 static void v253_wakeup(struct tty_struct *tty)
296 {
297 }
298 
299 struct tty_ldisc_ops v253_ops = {
300 	.magic = TTY_LDISC_MAGIC,
301 	.name = "cx20442",
302 	.owner = THIS_MODULE,
303 	.open = v253_open,
304 	.close = v253_close,
305 	.hangup = v253_hangup,
306 	.receive_buf = v253_receive,
307 	.write_wakeup = v253_wakeup,
308 };
309 EXPORT_SYMBOL_GPL(v253_ops);
310 
311 
312 /*
313  * Codec DAI
314  */
315 
316 struct snd_soc_dai cx20442_dai = {
317 	.name = "CX20442",
318 	.playback = {
319 		.stream_name = "Playback",
320 		.channels_min = 1,
321 		.channels_max = 1,
322 		.rates = SNDRV_PCM_RATE_8000,
323 		.formats = SNDRV_PCM_FMTBIT_S16_LE,
324 	},
325 	.capture = {
326 		.stream_name = "Capture",
327 		.channels_min = 1,
328 		.channels_max = 1,
329 		.rates = SNDRV_PCM_RATE_8000,
330 		.formats = SNDRV_PCM_FMTBIT_S16_LE,
331 	},
332 };
333 EXPORT_SYMBOL_GPL(cx20442_dai);
334 
335 static int cx20442_codec_probe(struct platform_device *pdev)
336 {
337 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
338 	struct snd_soc_codec *codec;
339 	int ret;
340 
341 	if (!cx20442_codec) {
342 		dev_err(&pdev->dev, "cx20442 not yet discovered\n");
343 		return -ENODEV;
344 	}
345 	codec = cx20442_codec;
346 
347 	socdev->card->codec = codec;
348 
349 	/* register pcms */
350 	ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
351 	if (ret < 0) {
352 		dev_err(&pdev->dev, "failed to create pcms\n");
353 		goto pcm_err;
354 	}
355 
356 	cx20442_add_widgets(codec);
357 
358 pcm_err:
359 	return ret;
360 }
361 
362 /* power down chip */
363 static int cx20442_codec_remove(struct platform_device *pdev)
364 {
365 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
366 
367 	snd_soc_free_pcms(socdev);
368 	snd_soc_dapm_free(socdev);
369 
370 	return 0;
371 }
372 
373 struct snd_soc_codec_device cx20442_codec_dev = {
374 	.probe = 	cx20442_codec_probe,
375 	.remove = 	cx20442_codec_remove,
376 };
377 EXPORT_SYMBOL_GPL(cx20442_codec_dev);
378 
379 static int cx20442_register(struct cx20442_priv *cx20442)
380 {
381 	struct snd_soc_codec *codec = &cx20442->codec;
382 	int ret;
383 
384 	mutex_init(&codec->mutex);
385 	INIT_LIST_HEAD(&codec->dapm_widgets);
386 	INIT_LIST_HEAD(&codec->dapm_paths);
387 
388 	codec->name = "CX20442";
389 	codec->owner = THIS_MODULE;
390 	snd_soc_codec_set_drvdata(codec, cx20442);
391 
392 	codec->dai = &cx20442_dai;
393 	codec->num_dai = 1;
394 
395 	codec->reg_cache = &cx20442->reg_cache;
396 	codec->reg_cache_size = ARRAY_SIZE(cx20442->reg_cache);
397 	codec->read = cx20442_read_reg_cache;
398 	codec->write = cx20442_write;
399 
400 	codec->bias_level = SND_SOC_BIAS_OFF;
401 
402 	cx20442_dai.dev = codec->dev;
403 
404 	cx20442_codec = codec;
405 
406 	ret = snd_soc_register_codec(codec);
407 	if (ret != 0) {
408 		dev_err(codec->dev, "Failed to register codec: %d\n", ret);
409 		goto err;
410 	}
411 
412 	ret = snd_soc_register_dai(&cx20442_dai);
413 	if (ret != 0) {
414 		dev_err(codec->dev, "Failed to register DAI: %d\n", ret);
415 		goto err_codec;
416 	}
417 
418 	return 0;
419 
420 err_codec:
421 	snd_soc_unregister_codec(codec);
422 err:
423 	cx20442_codec = NULL;
424 	kfree(cx20442);
425 	return ret;
426 }
427 
428 static void cx20442_unregister(struct cx20442_priv *cx20442)
429 {
430 	snd_soc_unregister_dai(&cx20442_dai);
431 	snd_soc_unregister_codec(&cx20442->codec);
432 
433 	cx20442_codec = NULL;
434 	kfree(cx20442);
435 }
436 
437 static int cx20442_platform_probe(struct platform_device *pdev)
438 {
439 	struct cx20442_priv *cx20442;
440 	struct snd_soc_codec *codec;
441 
442 	cx20442 = kzalloc(sizeof(struct cx20442_priv), GFP_KERNEL);
443 	if (cx20442 == NULL)
444 		return -ENOMEM;
445 
446 	codec = &cx20442->codec;
447 
448 	codec->control_data = NULL;
449 	codec->hw_write = NULL;
450 	codec->pop_time = 0;
451 
452 	codec->dev = &pdev->dev;
453 	platform_set_drvdata(pdev, cx20442);
454 
455 	return cx20442_register(cx20442);
456 }
457 
458 static int __exit cx20442_platform_remove(struct platform_device *pdev)
459 {
460 	struct cx20442_priv *cx20442 = platform_get_drvdata(pdev);
461 
462 	cx20442_unregister(cx20442);
463 	return 0;
464 }
465 
466 static struct platform_driver cx20442_platform_driver = {
467 	.driver = {
468 		.name = "cx20442",
469 		.owner = THIS_MODULE,
470 		},
471 	.probe = cx20442_platform_probe,
472 	.remove = __exit_p(cx20442_platform_remove),
473 };
474 
475 static int __init cx20442_init(void)
476 {
477 	return platform_driver_register(&cx20442_platform_driver);
478 }
479 module_init(cx20442_init);
480 
481 static void __exit cx20442_exit(void)
482 {
483 	platform_driver_unregister(&cx20442_platform_driver);
484 }
485 module_exit(cx20442_exit);
486 
487 MODULE_DESCRIPTION("ASoC CX20442-11 voice modem codec driver");
488 MODULE_AUTHOR("Janusz Krzysztofik");
489 MODULE_LICENSE("GPL");
490 MODULE_ALIAS("platform:cx20442");
491