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 enum snd_soc_control_type control_type; 28 void *control_data; 29 u8 reg_cache[1]; 30 }; 31 32 #define CX20442_PM 0x0 33 34 #define CX20442_TELIN 0 35 #define CX20442_TELOUT 1 36 #define CX20442_MIC 2 37 #define CX20442_SPKOUT 3 38 #define CX20442_AGC 4 39 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"), 44 45 SND_SOC_DAPM_MIXER("SPKOUT Mixer", SND_SOC_NOPM, 0, 0, NULL, 0), 46 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), 50 51 SND_SOC_DAPM_DAC("DAC", "Playback", SND_SOC_NOPM, 0, 0), 52 SND_SOC_DAPM_ADC("ADC", "Capture", SND_SOC_NOPM, 0, 0), 53 54 SND_SOC_DAPM_MIXER("Input Mixer", SND_SOC_NOPM, 0, 0, NULL, 0), 55 56 SND_SOC_DAPM_MICBIAS("TELIN Bias", CX20442_PM, CX20442_TELIN, 0), 57 SND_SOC_DAPM_MICBIAS("MIC Bias", CX20442_PM, CX20442_MIC, 0), 58 59 SND_SOC_DAPM_PGA("MIC AGC", CX20442_PM, CX20442_AGC, 0, NULL, 0), 60 61 SND_SOC_DAPM_INPUT("TELIN"), 62 SND_SOC_DAPM_INPUT("MIC"), 63 SND_SOC_DAPM_INPUT("AGCIN"), 64 }; 65 66 static const struct snd_soc_dapm_route cx20442_audio_map[] = { 67 {"TELOUT", NULL, "TELOUT Amp"}, 68 69 {"SPKOUT", NULL, "SPKOUT Mixer"}, 70 {"SPKOUT Mixer", NULL, "SPKOUT Amp"}, 71 72 {"TELOUT Amp", NULL, "DAC"}, 73 {"SPKOUT Amp", NULL, "DAC"}, 74 75 {"SPKOUT Mixer", NULL, "SPKOUT AGC"}, 76 {"SPKOUT AGC", NULL, "AGCIN"}, 77 78 {"AGCOUT", NULL, "MIC AGC"}, 79 {"MIC AGC", NULL, "MIC"}, 80 81 {"MIC Bias", NULL, "MIC"}, 82 {"Input Mixer", NULL, "MIC Bias"}, 83 84 {"TELIN Bias", NULL, "TELIN"}, 85 {"Input Mixer", NULL, "TELIN Bias"}, 86 87 {"ADC", NULL, "Input Mixer"}, 88 }; 89 90 static int cx20442_add_widgets(struct snd_soc_codec *codec) 91 { 92 snd_soc_dapm_new_controls(codec, cx20442_dapm_widgets, 93 ARRAY_SIZE(cx20442_dapm_widgets)); 94 95 snd_soc_dapm_add_routes(codec, cx20442_audio_map, 96 ARRAY_SIZE(cx20442_audio_map)); 97 98 return 0; 99 } 100 101 static unsigned int cx20442_read_reg_cache(struct snd_soc_codec *codec, 102 unsigned int reg) 103 { 104 u8 *reg_cache = codec->reg_cache; 105 106 if (reg >= codec->driver->reg_cache_size) 107 return -EINVAL; 108 109 return reg_cache[reg]; 110 } 111 112 enum v253_vls { 113 V253_VLS_NONE = 0, 114 V253_VLS_T, 115 V253_VLS_L, 116 V253_VLS_LT, 117 V253_VLS_S, 118 V253_VLS_ST, 119 V253_VLS_M, 120 V253_VLS_MST, 121 V253_VLS_S1, 122 V253_VLS_S1T, 123 V253_VLS_MS1T, 124 V253_VLS_M1, 125 V253_VLS_M1ST, 126 V253_VLS_M1S1T, 127 V253_VLS_H, 128 V253_VLS_HT, 129 V253_VLS_MS, 130 V253_VLS_MS1, 131 V253_VLS_M1S, 132 V253_VLS_M1S1, 133 V253_VLS_TEST, 134 }; 135 136 static int cx20442_pm_to_v253_vls(u8 value) 137 { 138 switch (value & ~(1 << CX20442_AGC)) { 139 case 0: 140 return V253_VLS_T; 141 case (1 << CX20442_SPKOUT): 142 case (1 << CX20442_MIC): 143 case (1 << CX20442_SPKOUT) | (1 << CX20442_MIC): 144 return V253_VLS_M1S1; 145 case (1 << CX20442_TELOUT): 146 case (1 << CX20442_TELIN): 147 case (1 << CX20442_TELOUT) | (1 << CX20442_TELIN): 148 return V253_VLS_L; 149 case (1 << CX20442_TELOUT) | (1 << CX20442_MIC): 150 return V253_VLS_NONE; 151 } 152 return -EINVAL; 153 } 154 static int cx20442_pm_to_v253_vsp(u8 value) 155 { 156 switch (value & ~(1 << CX20442_AGC)) { 157 case (1 << CX20442_SPKOUT): 158 case (1 << CX20442_MIC): 159 case (1 << CX20442_SPKOUT) | (1 << CX20442_MIC): 160 return (bool)(value & (1 << CX20442_AGC)); 161 } 162 return (value & (1 << CX20442_AGC)) ? -EINVAL : 0; 163 } 164 165 static int cx20442_write(struct snd_soc_codec *codec, unsigned int reg, 166 unsigned int value) 167 { 168 struct cx20442_priv *cx20442 = snd_soc_codec_get_drvdata(codec); 169 u8 *reg_cache = codec->reg_cache; 170 int vls, vsp, old, len; 171 char buf[18]; 172 173 if (reg >= codec->driver->reg_cache_size) 174 return -EINVAL; 175 176 /* hw_write and control_data pointers required for talking to the modem 177 * are expected to be set by the line discipline initialization code */ 178 if (!codec->hw_write || !cx20442->control_data) 179 return -EIO; 180 181 old = reg_cache[reg]; 182 reg_cache[reg] = value; 183 184 vls = cx20442_pm_to_v253_vls(value); 185 if (vls < 0) 186 return vls; 187 188 vsp = cx20442_pm_to_v253_vsp(value); 189 if (vsp < 0) 190 return vsp; 191 192 if ((vls == V253_VLS_T) || 193 (vls == cx20442_pm_to_v253_vls(old))) { 194 if (vsp == cx20442_pm_to_v253_vsp(old)) 195 return 0; 196 len = snprintf(buf, ARRAY_SIZE(buf), "at+vsp=%d\r", vsp); 197 } else if (vsp == cx20442_pm_to_v253_vsp(old)) 198 len = snprintf(buf, ARRAY_SIZE(buf), "at+vls=%d\r", vls); 199 else 200 len = snprintf(buf, ARRAY_SIZE(buf), 201 "at+vls=%d;+vsp=%d\r", vls, vsp); 202 203 if (unlikely(len > (ARRAY_SIZE(buf) - 1))) 204 return -ENOMEM; 205 206 dev_dbg(codec->dev, "%s: %s\n", __func__, buf); 207 if (codec->hw_write(cx20442->control_data, buf, len) != len) 208 return -EIO; 209 210 return 0; 211 } 212 213 214 /* 215 * Line discpline related code 216 * 217 * Any of the callback functions below can be used in two ways: 218 * 1) registerd by a machine driver as one of line discipline operations, 219 * 2) called from a machine's provided line discipline callback function 220 * in case when extra machine specific code must be run as well. 221 */ 222 223 /* Modem init: echo off, digital speaker off, quiet off, voice mode */ 224 static const char *v253_init = "ate0m0q0+fclass=8\r"; 225 226 /* Line discipline .open() */ 227 static int v253_open(struct tty_struct *tty) 228 { 229 int ret, len = strlen(v253_init); 230 231 /* Doesn't make sense without write callback */ 232 if (!tty->ops->write) 233 return -EINVAL; 234 235 /* Won't work if no codec pointer has been passed by a card driver */ 236 if (!tty->disc_data) 237 return -ENODEV; 238 239 if (tty->ops->write(tty, v253_init, len) != len) { 240 ret = -EIO; 241 goto err; 242 } 243 /* Actual setup will be performed after the modem responds. */ 244 return 0; 245 err: 246 tty->disc_data = NULL; 247 return ret; 248 } 249 250 /* Line discipline .close() */ 251 static void v253_close(struct tty_struct *tty) 252 { 253 struct snd_soc_codec *codec = tty->disc_data; 254 struct cx20442_priv *cx20442; 255 256 tty->disc_data = NULL; 257 258 if (!codec) 259 return; 260 261 cx20442 = snd_soc_codec_get_drvdata(codec); 262 263 /* Prevent the codec driver from further accessing the modem */ 264 codec->hw_write = NULL; 265 cx20442->control_data = NULL; 266 codec->pop_time = 0; 267 } 268 269 /* Line discipline .hangup() */ 270 static int v253_hangup(struct tty_struct *tty) 271 { 272 v253_close(tty); 273 return 0; 274 } 275 276 /* Line discipline .receive_buf() */ 277 static void v253_receive(struct tty_struct *tty, 278 const unsigned char *cp, char *fp, int count) 279 { 280 struct snd_soc_codec *codec = tty->disc_data; 281 struct cx20442_priv *cx20442; 282 283 if (!codec) 284 return; 285 286 cx20442 = snd_soc_codec_get_drvdata(codec); 287 288 if (!cx20442->control_data) { 289 /* First modem response, complete setup procedure */ 290 291 /* Set up codec driver access to modem controls */ 292 cx20442->control_data = tty; 293 codec->hw_write = (hw_write_t)tty->ops->write; 294 codec->pop_time = 1; 295 } 296 } 297 298 /* Line discipline .write_wakeup() */ 299 static void v253_wakeup(struct tty_struct *tty) 300 { 301 } 302 303 struct tty_ldisc_ops v253_ops = { 304 .magic = TTY_LDISC_MAGIC, 305 .name = "cx20442", 306 .owner = THIS_MODULE, 307 .open = v253_open, 308 .close = v253_close, 309 .hangup = v253_hangup, 310 .receive_buf = v253_receive, 311 .write_wakeup = v253_wakeup, 312 }; 313 EXPORT_SYMBOL_GPL(v253_ops); 314 315 316 /* 317 * Codec DAI 318 */ 319 320 static struct snd_soc_dai_driver cx20442_dai = { 321 .name = "cx20442-voice", 322 .playback = { 323 .stream_name = "Playback", 324 .channels_min = 1, 325 .channels_max = 1, 326 .rates = SNDRV_PCM_RATE_8000, 327 .formats = SNDRV_PCM_FMTBIT_S16_LE, 328 }, 329 .capture = { 330 .stream_name = "Capture", 331 .channels_min = 1, 332 .channels_max = 1, 333 .rates = SNDRV_PCM_RATE_8000, 334 .formats = SNDRV_PCM_FMTBIT_S16_LE, 335 }, 336 }; 337 338 static int cx20442_codec_probe(struct snd_soc_codec *codec) 339 { 340 struct cx20442_priv *cx20442; 341 342 cx20442 = kzalloc(sizeof(struct cx20442_priv), GFP_KERNEL); 343 if (cx20442 == NULL) 344 return -ENOMEM; 345 snd_soc_codec_set_drvdata(codec, cx20442); 346 347 cx20442_add_widgets(codec); 348 349 cx20442->control_data = NULL; 350 codec->hw_write = NULL; 351 codec->pop_time = 0; 352 353 return 0; 354 } 355 356 /* power down chip */ 357 static int cx20442_codec_remove(struct snd_soc_codec *codec) 358 { 359 struct cx20442_priv *cx20442 = snd_soc_codec_get_drvdata(codec); 360 361 if (cx20442->control_data) { 362 struct tty_struct *tty = cx20442->control_data; 363 tty_hangup(tty); 364 } 365 366 kfree(cx20442); 367 return 0; 368 } 369 370 static struct snd_soc_codec_driver cx20442_codec_dev = { 371 .probe = cx20442_codec_probe, 372 .remove = cx20442_codec_remove, 373 .reg_cache_size = 1, 374 .reg_word_size = sizeof(u8), 375 .read = cx20442_read_reg_cache, 376 .write = cx20442_write, 377 }; 378 379 static int cx20442_platform_probe(struct platform_device *pdev) 380 { 381 return snd_soc_register_codec(&pdev->dev, 382 &cx20442_codec_dev, &cx20442_dai, 1); 383 } 384 385 static int __exit cx20442_platform_remove(struct platform_device *pdev) 386 { 387 snd_soc_unregister_codec(&pdev->dev); 388 return 0; 389 } 390 391 static struct platform_driver cx20442_platform_driver = { 392 .driver = { 393 .name = "cx20442-codec", 394 .owner = THIS_MODULE, 395 }, 396 .probe = cx20442_platform_probe, 397 .remove = __exit_p(cx20442_platform_remove), 398 }; 399 400 static int __init cx20442_init(void) 401 { 402 return platform_driver_register(&cx20442_platform_driver); 403 } 404 module_init(cx20442_init); 405 406 static void __exit cx20442_exit(void) 407 { 408 platform_driver_unregister(&cx20442_platform_driver); 409 } 410 module_exit(cx20442_exit); 411 412 MODULE_DESCRIPTION("ASoC CX20442-11 voice modem codec driver"); 413 MODULE_AUTHOR("Janusz Krzysztofik"); 414 MODULE_LICENSE("GPL"); 415 MODULE_ALIAS("platform:cx20442-codec"); 416