2 * cx20442.c -- CX20442 ALSA Soc Audio driver
4 * Copyright 2009 Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>
6 * Initially based on sound/soc/codecs/wm8400.c
7 * Copyright 2008, 2009 Wolfson Microelectronics PLC.
8 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
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.
16 #include <linux/tty.h>
17 #include <linux/slab.h>
19 #include <sound/core.h>
20 #include <sound/initval.h>
21 #include <sound/soc.h>
27 enum snd_soc_control_type control_type
;
32 #define CX20442_PM 0x0
34 #define CX20442_TELIN 0
35 #define CX20442_TELOUT 1
37 #define CX20442_SPKOUT 3
40 static const struct snd_soc_dapm_widget cx20442_dapm_widgets
[] = {
41 SND_SOC_DAPM_OUTPUT("TELOUT"),
42 SND_SOC_DAPM_OUTPUT("SPKOUT"),
43 SND_SOC_DAPM_OUTPUT("AGCOUT"),
45 SND_SOC_DAPM_MIXER("SPKOUT Mixer", SND_SOC_NOPM
, 0, 0, NULL
, 0),
47 SND_SOC_DAPM_PGA("TELOUT Amp", CX20442_PM
, CX20442_TELOUT
, 0, NULL
, 0),
48 SND_SOC_DAPM_PGA("SPKOUT Amp", CX20442_PM
, CX20442_SPKOUT
, 0, NULL
, 0),
49 SND_SOC_DAPM_PGA("SPKOUT AGC", CX20442_PM
, CX20442_AGC
, 0, NULL
, 0),
51 SND_SOC_DAPM_DAC("DAC", "Playback", SND_SOC_NOPM
, 0, 0),
52 SND_SOC_DAPM_ADC("ADC", "Capture", SND_SOC_NOPM
, 0, 0),
54 SND_SOC_DAPM_MIXER("Input Mixer", SND_SOC_NOPM
, 0, 0, NULL
, 0),
56 SND_SOC_DAPM_MICBIAS("TELIN Bias", CX20442_PM
, CX20442_TELIN
, 0),
57 SND_SOC_DAPM_MICBIAS("MIC Bias", CX20442_PM
, CX20442_MIC
, 0),
59 SND_SOC_DAPM_PGA("MIC AGC", CX20442_PM
, CX20442_AGC
, 0, NULL
, 0),
61 SND_SOC_DAPM_INPUT("TELIN"),
62 SND_SOC_DAPM_INPUT("MIC"),
63 SND_SOC_DAPM_INPUT("AGCIN"),
66 static const struct snd_soc_dapm_route cx20442_audio_map
[] = {
67 {"TELOUT", NULL
, "TELOUT Amp"},
69 {"SPKOUT", NULL
, "SPKOUT Mixer"},
70 {"SPKOUT Mixer", NULL
, "SPKOUT Amp"},
72 {"TELOUT Amp", NULL
, "DAC"},
73 {"SPKOUT Amp", NULL
, "DAC"},
75 {"SPKOUT Mixer", NULL
, "SPKOUT AGC"},
76 {"SPKOUT AGC", NULL
, "AGCIN"},
78 {"AGCOUT", NULL
, "MIC AGC"},
79 {"MIC AGC", NULL
, "MIC"},
81 {"MIC Bias", NULL
, "MIC"},
82 {"Input Mixer", NULL
, "MIC Bias"},
84 {"TELIN Bias", NULL
, "TELIN"},
85 {"Input Mixer", NULL
, "TELIN Bias"},
87 {"ADC", NULL
, "Input Mixer"},
90 static int cx20442_add_widgets(struct snd_soc_codec
*codec
)
92 struct snd_soc_dapm_context
*dapm
= &codec
->dapm
;
94 snd_soc_dapm_new_controls(dapm
, cx20442_dapm_widgets
,
95 ARRAY_SIZE(cx20442_dapm_widgets
));
96 snd_soc_dapm_add_routes(dapm
, cx20442_audio_map
,
97 ARRAY_SIZE(cx20442_audio_map
));
102 static unsigned int cx20442_read_reg_cache(struct snd_soc_codec
*codec
,
105 u8
*reg_cache
= codec
->reg_cache
;
107 if (reg
>= codec
->driver
->reg_cache_size
)
110 return reg_cache
[reg
];
137 static int cx20442_pm_to_v253_vls(u8 value
)
139 switch (value
& ~(1 << CX20442_AGC
)) {
142 case (1 << CX20442_SPKOUT
):
143 case (1 << CX20442_MIC
):
144 case (1 << CX20442_SPKOUT
) | (1 << CX20442_MIC
):
145 return V253_VLS_M1S1
;
146 case (1 << CX20442_TELOUT
):
147 case (1 << CX20442_TELIN
):
148 case (1 << CX20442_TELOUT
) | (1 << CX20442_TELIN
):
150 case (1 << CX20442_TELOUT
) | (1 << CX20442_MIC
):
151 return V253_VLS_NONE
;
155 static int cx20442_pm_to_v253_vsp(u8 value
)
157 switch (value
& ~(1 << CX20442_AGC
)) {
158 case (1 << CX20442_SPKOUT
):
159 case (1 << CX20442_MIC
):
160 case (1 << CX20442_SPKOUT
) | (1 << CX20442_MIC
):
161 return (bool)(value
& (1 << CX20442_AGC
));
163 return (value
& (1 << CX20442_AGC
)) ? -EINVAL
: 0;
166 static int cx20442_write(struct snd_soc_codec
*codec
, unsigned int reg
,
169 struct cx20442_priv
*cx20442
= snd_soc_codec_get_drvdata(codec
);
170 u8
*reg_cache
= codec
->reg_cache
;
171 int vls
, vsp
, old
, len
;
174 if (reg
>= codec
->driver
->reg_cache_size
)
177 /* hw_write and control_data pointers required for talking to the modem
178 * are expected to be set by the line discipline initialization code */
179 if (!codec
->hw_write
|| !cx20442
->control_data
)
182 old
= reg_cache
[reg
];
183 reg_cache
[reg
] = value
;
185 vls
= cx20442_pm_to_v253_vls(value
);
189 vsp
= cx20442_pm_to_v253_vsp(value
);
193 if ((vls
== V253_VLS_T
) ||
194 (vls
== cx20442_pm_to_v253_vls(old
))) {
195 if (vsp
== cx20442_pm_to_v253_vsp(old
))
197 len
= snprintf(buf
, ARRAY_SIZE(buf
), "at+vsp=%d\r", vsp
);
198 } else if (vsp
== cx20442_pm_to_v253_vsp(old
))
199 len
= snprintf(buf
, ARRAY_SIZE(buf
), "at+vls=%d\r", vls
);
201 len
= snprintf(buf
, ARRAY_SIZE(buf
),
202 "at+vls=%d;+vsp=%d\r", vls
, vsp
);
204 if (unlikely(len
> (ARRAY_SIZE(buf
) - 1)))
207 dev_dbg(codec
->dev
, "%s: %s\n", __func__
, buf
);
208 if (codec
->hw_write(cx20442
->control_data
, buf
, len
) != len
)
216 * Line discpline related code
218 * Any of the callback functions below can be used in two ways:
219 * 1) registerd by a machine driver as one of line discipline operations,
220 * 2) called from a machine's provided line discipline callback function
221 * in case when extra machine specific code must be run as well.
224 /* Modem init: echo off, digital speaker off, quiet off, voice mode */
225 static const char *v253_init
= "ate0m0q0+fclass=8\r";
227 /* Line discipline .open() */
228 static int v253_open(struct tty_struct
*tty
)
230 int ret
, len
= strlen(v253_init
);
232 /* Doesn't make sense without write callback */
233 if (!tty
->ops
->write
)
236 /* Won't work if no codec pointer has been passed by a card driver */
240 if (tty
->ops
->write(tty
, v253_init
, len
) != len
) {
244 /* Actual setup will be performed after the modem responds. */
247 tty
->disc_data
= NULL
;
251 /* Line discipline .close() */
252 static void v253_close(struct tty_struct
*tty
)
254 struct snd_soc_codec
*codec
= tty
->disc_data
;
255 struct cx20442_priv
*cx20442
;
257 tty
->disc_data
= NULL
;
262 cx20442
= snd_soc_codec_get_drvdata(codec
);
264 /* Prevent the codec driver from further accessing the modem */
265 codec
->hw_write
= NULL
;
266 cx20442
->control_data
= NULL
;
267 codec
->dapm
.pop_time
= 0;
270 /* Line discipline .hangup() */
271 static int v253_hangup(struct tty_struct
*tty
)
277 /* Line discipline .receive_buf() */
278 static void v253_receive(struct tty_struct
*tty
,
279 const unsigned char *cp
, char *fp
, int count
)
281 struct snd_soc_codec
*codec
= tty
->disc_data
;
282 struct cx20442_priv
*cx20442
;
287 cx20442
= snd_soc_codec_get_drvdata(codec
);
289 if (!cx20442
->control_data
) {
290 /* First modem response, complete setup procedure */
292 /* Set up codec driver access to modem controls */
293 cx20442
->control_data
= tty
;
294 codec
->hw_write
= (hw_write_t
)tty
->ops
->write
;
295 codec
->dapm
.pop_time
= 1;
299 /* Line discipline .write_wakeup() */
300 static void v253_wakeup(struct tty_struct
*tty
)
304 struct tty_ldisc_ops v253_ops
= {
305 .magic
= TTY_LDISC_MAGIC
,
307 .owner
= THIS_MODULE
,
310 .hangup
= v253_hangup
,
311 .receive_buf
= v253_receive
,
312 .write_wakeup
= v253_wakeup
,
314 EXPORT_SYMBOL_GPL(v253_ops
);
321 static struct snd_soc_dai_driver cx20442_dai
= {
322 .name
= "cx20442-voice",
324 .stream_name
= "Playback",
327 .rates
= SNDRV_PCM_RATE_8000
,
328 .formats
= SNDRV_PCM_FMTBIT_S16_LE
,
331 .stream_name
= "Capture",
334 .rates
= SNDRV_PCM_RATE_8000
,
335 .formats
= SNDRV_PCM_FMTBIT_S16_LE
,
339 static int cx20442_codec_probe(struct snd_soc_codec
*codec
)
341 struct cx20442_priv
*cx20442
;
343 cx20442
= kzalloc(sizeof(struct cx20442_priv
), GFP_KERNEL
);
346 snd_soc_codec_set_drvdata(codec
, cx20442
);
348 cx20442_add_widgets(codec
);
350 cx20442
->control_data
= NULL
;
351 codec
->hw_write
= NULL
;
352 codec
->dapm
.pop_time
= 0;
357 /* power down chip */
358 static int cx20442_codec_remove(struct snd_soc_codec
*codec
)
360 struct cx20442_priv
*cx20442
= snd_soc_codec_get_drvdata(codec
);
362 if (cx20442
->control_data
) {
363 struct tty_struct
*tty
= cx20442
->control_data
;
371 static struct snd_soc_codec_driver cx20442_codec_dev
= {
372 .probe
= cx20442_codec_probe
,
373 .remove
= cx20442_codec_remove
,
375 .reg_word_size
= sizeof(u8
),
376 .read
= cx20442_read_reg_cache
,
377 .write
= cx20442_write
,
380 static int cx20442_platform_probe(struct platform_device
*pdev
)
382 return snd_soc_register_codec(&pdev
->dev
,
383 &cx20442_codec_dev
, &cx20442_dai
, 1);
386 static int __exit
cx20442_platform_remove(struct platform_device
*pdev
)
388 snd_soc_unregister_codec(&pdev
->dev
);
392 static struct platform_driver cx20442_platform_driver
= {
394 .name
= "cx20442-codec",
395 .owner
= THIS_MODULE
,
397 .probe
= cx20442_platform_probe
,
398 .remove
= __exit_p(cx20442_platform_remove
),
401 static int __init
cx20442_init(void)
403 return platform_driver_register(&cx20442_platform_driver
);
405 module_init(cx20442_init
);
407 static void __exit
cx20442_exit(void)
409 platform_driver_unregister(&cx20442_platform_driver
);
411 module_exit(cx20442_exit
);
413 MODULE_DESCRIPTION("ASoC CX20442-11 voice modem codec driver");
414 MODULE_AUTHOR("Janusz Krzysztofik");
415 MODULE_LICENSE("GPL");
416 MODULE_ALIAS("platform:cx20442-codec");