1 /* 2 * soc-core.c -- ALSA SoC Audio Layer 3 * 4 * Copyright 2005 Wolfson Microelectronics PLC. 5 * Copyright 2005 Openedhand Ltd. 6 * Copyright (C) 2010 Slimlogic Ltd. 7 * Copyright (C) 2010 Texas Instruments Inc. 8 * 9 * Author: Liam Girdwood <lrg@slimlogic.co.uk> 10 * with code, comments and ideas from :- 11 * Richard Purdie <richard@openedhand.com> 12 * 13 * This program is free software; you can redistribute it and/or modify it 14 * under the terms of the GNU General Public License as published by the 15 * Free Software Foundation; either version 2 of the License, or (at your 16 * option) any later version. 17 * 18 * TODO: 19 * o Add hw rules to enforce rates, etc. 20 * o More testing with other codecs/machines. 21 * o Add more codecs and platforms to ensure good API coverage. 22 * o Support TDM on PCM and I2S 23 */ 24 25 #include <linux/module.h> 26 #include <linux/moduleparam.h> 27 #include <linux/init.h> 28 #include <linux/delay.h> 29 #include <linux/pm.h> 30 #include <linux/bitops.h> 31 #include <linux/debugfs.h> 32 #include <linux/platform_device.h> 33 #include <linux/ctype.h> 34 #include <linux/slab.h> 35 #include <linux/of.h> 36 #include <sound/ac97_codec.h> 37 #include <sound/core.h> 38 #include <sound/jack.h> 39 #include <sound/pcm.h> 40 #include <sound/pcm_params.h> 41 #include <sound/soc.h> 42 #include <sound/soc-dpcm.h> 43 #include <sound/initval.h> 44 45 #define CREATE_TRACE_POINTS 46 #include <trace/events/asoc.h> 47 48 #define NAME_SIZE 32 49 50 static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq); 51 52 #ifdef CONFIG_DEBUG_FS 53 struct dentry *snd_soc_debugfs_root; 54 EXPORT_SYMBOL_GPL(snd_soc_debugfs_root); 55 #endif 56 57 static DEFINE_MUTEX(client_mutex); 58 static LIST_HEAD(dai_list); 59 static LIST_HEAD(platform_list); 60 static LIST_HEAD(codec_list); 61 62 /* 63 * This is a timeout to do a DAPM powerdown after a stream is closed(). 64 * It can be used to eliminate pops between different playback streams, e.g. 65 * between two audio tracks. 66 */ 67 static int pmdown_time = 5000; 68 module_param(pmdown_time, int, 0); 69 MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)"); 70 71 /* returns the minimum number of bytes needed to represent 72 * a particular given value */ 73 static int min_bytes_needed(unsigned long val) 74 { 75 int c = 0; 76 int i; 77 78 for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c) 79 if (val & (1UL << i)) 80 break; 81 c = (sizeof val * 8) - c; 82 if (!c || (c % 8)) 83 c = (c + 8) / 8; 84 else 85 c /= 8; 86 return c; 87 } 88 89 /* fill buf which is 'len' bytes with a formatted 90 * string of the form 'reg: value\n' */ 91 static int format_register_str(struct snd_soc_codec *codec, 92 unsigned int reg, char *buf, size_t len) 93 { 94 int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2; 95 int regsize = codec->driver->reg_word_size * 2; 96 int ret; 97 char tmpbuf[len + 1]; 98 char regbuf[regsize + 1]; 99 100 /* since tmpbuf is allocated on the stack, warn the callers if they 101 * try to abuse this function */ 102 WARN_ON(len > 63); 103 104 /* +2 for ': ' and + 1 for '\n' */ 105 if (wordsize + regsize + 2 + 1 != len) 106 return -EINVAL; 107 108 ret = snd_soc_read(codec, reg); 109 if (ret < 0) { 110 memset(regbuf, 'X', regsize); 111 regbuf[regsize] = '\0'; 112 } else { 113 snprintf(regbuf, regsize + 1, "%.*x", regsize, ret); 114 } 115 116 /* prepare the buffer */ 117 snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf); 118 /* copy it back to the caller without the '\0' */ 119 memcpy(buf, tmpbuf, len); 120 121 return 0; 122 } 123 124 /* codec register dump */ 125 static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf, 126 size_t count, loff_t pos) 127 { 128 int i, step = 1; 129 int wordsize, regsize; 130 int len; 131 size_t total = 0; 132 loff_t p = 0; 133 134 wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2; 135 regsize = codec->driver->reg_word_size * 2; 136 137 len = wordsize + regsize + 2 + 1; 138 139 if (!codec->driver->reg_cache_size) 140 return 0; 141 142 if (codec->driver->reg_cache_step) 143 step = codec->driver->reg_cache_step; 144 145 for (i = 0; i < codec->driver->reg_cache_size; i += step) { 146 if (!snd_soc_codec_readable_register(codec, i)) 147 continue; 148 if (codec->driver->display_register) { 149 count += codec->driver->display_register(codec, buf + count, 150 PAGE_SIZE - count, i); 151 } else { 152 /* only support larger than PAGE_SIZE bytes debugfs 153 * entries for the default case */ 154 if (p >= pos) { 155 if (total + len >= count - 1) 156 break; 157 format_register_str(codec, i, buf + total, len); 158 total += len; 159 } 160 p += len; 161 } 162 } 163 164 total = min(total, count - 1); 165 166 return total; 167 } 168 169 static ssize_t codec_reg_show(struct device *dev, 170 struct device_attribute *attr, char *buf) 171 { 172 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev); 173 174 return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0); 175 } 176 177 static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL); 178 179 static ssize_t pmdown_time_show(struct device *dev, 180 struct device_attribute *attr, char *buf) 181 { 182 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev); 183 184 return sprintf(buf, "%ld\n", rtd->pmdown_time); 185 } 186 187 static ssize_t pmdown_time_set(struct device *dev, 188 struct device_attribute *attr, 189 const char *buf, size_t count) 190 { 191 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev); 192 int ret; 193 194 ret = strict_strtol(buf, 10, &rtd->pmdown_time); 195 if (ret) 196 return ret; 197 198 return count; 199 } 200 201 static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set); 202 203 #ifdef CONFIG_DEBUG_FS 204 static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf, 205 size_t count, loff_t *ppos) 206 { 207 ssize_t ret; 208 struct snd_soc_codec *codec = file->private_data; 209 char *buf; 210 211 if (*ppos < 0 || !count) 212 return -EINVAL; 213 214 buf = kmalloc(count, GFP_KERNEL); 215 if (!buf) 216 return -ENOMEM; 217 218 ret = soc_codec_reg_show(codec, buf, count, *ppos); 219 if (ret >= 0) { 220 if (copy_to_user(user_buf, buf, ret)) { 221 kfree(buf); 222 return -EFAULT; 223 } 224 *ppos += ret; 225 } 226 227 kfree(buf); 228 return ret; 229 } 230 231 static ssize_t codec_reg_write_file(struct file *file, 232 const char __user *user_buf, size_t count, loff_t *ppos) 233 { 234 char buf[32]; 235 size_t buf_size; 236 char *start = buf; 237 unsigned long reg, value; 238 struct snd_soc_codec *codec = file->private_data; 239 240 buf_size = min(count, (sizeof(buf)-1)); 241 if (copy_from_user(buf, user_buf, buf_size)) 242 return -EFAULT; 243 buf[buf_size] = 0; 244 245 while (*start == ' ') 246 start++; 247 reg = simple_strtoul(start, &start, 16); 248 while (*start == ' ') 249 start++; 250 if (strict_strtoul(start, 16, &value)) 251 return -EINVAL; 252 253 /* Userspace has been fiddling around behind the kernel's back */ 254 add_taint(TAINT_USER); 255 256 snd_soc_write(codec, reg, value); 257 return buf_size; 258 } 259 260 static const struct file_operations codec_reg_fops = { 261 .open = simple_open, 262 .read = codec_reg_read_file, 263 .write = codec_reg_write_file, 264 .llseek = default_llseek, 265 }; 266 267 static void soc_init_codec_debugfs(struct snd_soc_codec *codec) 268 { 269 struct dentry *debugfs_card_root = codec->card->debugfs_card_root; 270 271 codec->debugfs_codec_root = debugfs_create_dir(codec->name, 272 debugfs_card_root); 273 if (!codec->debugfs_codec_root) { 274 dev_warn(codec->dev, "ASoC: Failed to create codec debugfs" 275 " directory\n"); 276 return; 277 } 278 279 debugfs_create_bool("cache_sync", 0444, codec->debugfs_codec_root, 280 &codec->cache_sync); 281 debugfs_create_bool("cache_only", 0444, codec->debugfs_codec_root, 282 &codec->cache_only); 283 284 codec->debugfs_reg = debugfs_create_file("codec_reg", 0644, 285 codec->debugfs_codec_root, 286 codec, &codec_reg_fops); 287 if (!codec->debugfs_reg) 288 dev_warn(codec->dev, "ASoC: Failed to create codec register" 289 " debugfs file\n"); 290 291 snd_soc_dapm_debugfs_init(&codec->dapm, codec->debugfs_codec_root); 292 } 293 294 static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec) 295 { 296 debugfs_remove_recursive(codec->debugfs_codec_root); 297 } 298 299 static void soc_init_platform_debugfs(struct snd_soc_platform *platform) 300 { 301 struct dentry *debugfs_card_root = platform->card->debugfs_card_root; 302 303 platform->debugfs_platform_root = debugfs_create_dir(platform->name, 304 debugfs_card_root); 305 if (!platform->debugfs_platform_root) { 306 dev_warn(platform->dev, 307 "ASoC: Failed to create platform debugfs directory\n"); 308 return; 309 } 310 311 snd_soc_dapm_debugfs_init(&platform->dapm, 312 platform->debugfs_platform_root); 313 } 314 315 static void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform) 316 { 317 debugfs_remove_recursive(platform->debugfs_platform_root); 318 } 319 320 static ssize_t codec_list_read_file(struct file *file, char __user *user_buf, 321 size_t count, loff_t *ppos) 322 { 323 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); 324 ssize_t len, ret = 0; 325 struct snd_soc_codec *codec; 326 327 if (!buf) 328 return -ENOMEM; 329 330 list_for_each_entry(codec, &codec_list, list) { 331 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", 332 codec->name); 333 if (len >= 0) 334 ret += len; 335 if (ret > PAGE_SIZE) { 336 ret = PAGE_SIZE; 337 break; 338 } 339 } 340 341 if (ret >= 0) 342 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); 343 344 kfree(buf); 345 346 return ret; 347 } 348 349 static const struct file_operations codec_list_fops = { 350 .read = codec_list_read_file, 351 .llseek = default_llseek,/* read accesses f_pos */ 352 }; 353 354 static ssize_t dai_list_read_file(struct file *file, char __user *user_buf, 355 size_t count, loff_t *ppos) 356 { 357 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); 358 ssize_t len, ret = 0; 359 struct snd_soc_dai *dai; 360 361 if (!buf) 362 return -ENOMEM; 363 364 list_for_each_entry(dai, &dai_list, list) { 365 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", dai->name); 366 if (len >= 0) 367 ret += len; 368 if (ret > PAGE_SIZE) { 369 ret = PAGE_SIZE; 370 break; 371 } 372 } 373 374 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); 375 376 kfree(buf); 377 378 return ret; 379 } 380 381 static const struct file_operations dai_list_fops = { 382 .read = dai_list_read_file, 383 .llseek = default_llseek,/* read accesses f_pos */ 384 }; 385 386 static ssize_t platform_list_read_file(struct file *file, 387 char __user *user_buf, 388 size_t count, loff_t *ppos) 389 { 390 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL); 391 ssize_t len, ret = 0; 392 struct snd_soc_platform *platform; 393 394 if (!buf) 395 return -ENOMEM; 396 397 list_for_each_entry(platform, &platform_list, list) { 398 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", 399 platform->name); 400 if (len >= 0) 401 ret += len; 402 if (ret > PAGE_SIZE) { 403 ret = PAGE_SIZE; 404 break; 405 } 406 } 407 408 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); 409 410 kfree(buf); 411 412 return ret; 413 } 414 415 static const struct file_operations platform_list_fops = { 416 .read = platform_list_read_file, 417 .llseek = default_llseek,/* read accesses f_pos */ 418 }; 419 420 static void soc_init_card_debugfs(struct snd_soc_card *card) 421 { 422 card->debugfs_card_root = debugfs_create_dir(card->name, 423 snd_soc_debugfs_root); 424 if (!card->debugfs_card_root) { 425 dev_warn(card->dev, 426 "ASoC: Failed to create card debugfs directory\n"); 427 return; 428 } 429 430 card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644, 431 card->debugfs_card_root, 432 &card->pop_time); 433 if (!card->debugfs_pop_time) 434 dev_warn(card->dev, 435 "ASoC: Failed to create pop time debugfs file\n"); 436 } 437 438 static void soc_cleanup_card_debugfs(struct snd_soc_card *card) 439 { 440 debugfs_remove_recursive(card->debugfs_card_root); 441 } 442 443 #else 444 445 static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec) 446 { 447 } 448 449 static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec) 450 { 451 } 452 453 static inline void soc_init_platform_debugfs(struct snd_soc_platform *platform) 454 { 455 } 456 457 static inline void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform) 458 { 459 } 460 461 static inline void soc_init_card_debugfs(struct snd_soc_card *card) 462 { 463 } 464 465 static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card) 466 { 467 } 468 #endif 469 470 struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card, 471 const char *dai_link, int stream) 472 { 473 int i; 474 475 for (i = 0; i < card->num_links; i++) { 476 if (card->rtd[i].dai_link->no_pcm && 477 !strcmp(card->rtd[i].dai_link->name, dai_link)) 478 return card->rtd[i].pcm->streams[stream].substream; 479 } 480 dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link); 481 return NULL; 482 } 483 EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream); 484 485 struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card, 486 const char *dai_link) 487 { 488 int i; 489 490 for (i = 0; i < card->num_links; i++) { 491 if (!strcmp(card->rtd[i].dai_link->name, dai_link)) 492 return &card->rtd[i]; 493 } 494 dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link); 495 return NULL; 496 } 497 EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime); 498 499 #ifdef CONFIG_SND_SOC_AC97_BUS 500 /* unregister ac97 codec */ 501 static int soc_ac97_dev_unregister(struct snd_soc_codec *codec) 502 { 503 if (codec->ac97->dev.bus) 504 device_unregister(&codec->ac97->dev); 505 return 0; 506 } 507 508 /* stop no dev release warning */ 509 static void soc_ac97_device_release(struct device *dev){} 510 511 /* register ac97 codec to bus */ 512 static int soc_ac97_dev_register(struct snd_soc_codec *codec) 513 { 514 int err; 515 516 codec->ac97->dev.bus = &ac97_bus_type; 517 codec->ac97->dev.parent = codec->card->dev; 518 codec->ac97->dev.release = soc_ac97_device_release; 519 520 dev_set_name(&codec->ac97->dev, "%d-%d:%s", 521 codec->card->snd_card->number, 0, codec->name); 522 err = device_register(&codec->ac97->dev); 523 if (err < 0) { 524 dev_err(codec->dev, "ASoC: Can't register ac97 bus\n"); 525 codec->ac97->dev.bus = NULL; 526 return err; 527 } 528 return 0; 529 } 530 #endif 531 532 #ifdef CONFIG_PM_SLEEP 533 /* powers down audio subsystem for suspend */ 534 int snd_soc_suspend(struct device *dev) 535 { 536 struct snd_soc_card *card = dev_get_drvdata(dev); 537 struct snd_soc_codec *codec; 538 int i; 539 540 /* If the initialization of this soc device failed, there is no codec 541 * associated with it. Just bail out in this case. 542 */ 543 if (list_empty(&card->codec_dev_list)) 544 return 0; 545 546 /* Due to the resume being scheduled into a workqueue we could 547 * suspend before that's finished - wait for it to complete. 548 */ 549 snd_power_lock(card->snd_card); 550 snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0); 551 snd_power_unlock(card->snd_card); 552 553 /* we're going to block userspace touching us until resume completes */ 554 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot); 555 556 /* mute any active DACs */ 557 for (i = 0; i < card->num_rtd; i++) { 558 struct snd_soc_dai *dai = card->rtd[i].codec_dai; 559 struct snd_soc_dai_driver *drv = dai->driver; 560 561 if (card->rtd[i].dai_link->ignore_suspend) 562 continue; 563 564 if (drv->ops->digital_mute && dai->playback_active) 565 drv->ops->digital_mute(dai, 1); 566 } 567 568 /* suspend all pcms */ 569 for (i = 0; i < card->num_rtd; i++) { 570 if (card->rtd[i].dai_link->ignore_suspend) 571 continue; 572 573 snd_pcm_suspend_all(card->rtd[i].pcm); 574 } 575 576 if (card->suspend_pre) 577 card->suspend_pre(card); 578 579 for (i = 0; i < card->num_rtd; i++) { 580 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 581 struct snd_soc_platform *platform = card->rtd[i].platform; 582 583 if (card->rtd[i].dai_link->ignore_suspend) 584 continue; 585 586 if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control) 587 cpu_dai->driver->suspend(cpu_dai); 588 if (platform->driver->suspend && !platform->suspended) { 589 platform->driver->suspend(cpu_dai); 590 platform->suspended = 1; 591 } 592 } 593 594 /* close any waiting streams and save state */ 595 for (i = 0; i < card->num_rtd; i++) { 596 flush_delayed_work(&card->rtd[i].delayed_work); 597 card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level; 598 } 599 600 for (i = 0; i < card->num_rtd; i++) { 601 602 if (card->rtd[i].dai_link->ignore_suspend) 603 continue; 604 605 snd_soc_dapm_stream_event(&card->rtd[i], 606 SNDRV_PCM_STREAM_PLAYBACK, 607 SND_SOC_DAPM_STREAM_SUSPEND); 608 609 snd_soc_dapm_stream_event(&card->rtd[i], 610 SNDRV_PCM_STREAM_CAPTURE, 611 SND_SOC_DAPM_STREAM_SUSPEND); 612 } 613 614 /* Recheck all analogue paths too */ 615 dapm_mark_io_dirty(&card->dapm); 616 snd_soc_dapm_sync(&card->dapm); 617 618 /* suspend all CODECs */ 619 list_for_each_entry(codec, &card->codec_dev_list, card_list) { 620 /* If there are paths active then the CODEC will be held with 621 * bias _ON and should not be suspended. */ 622 if (!codec->suspended && codec->driver->suspend) { 623 switch (codec->dapm.bias_level) { 624 case SND_SOC_BIAS_STANDBY: 625 /* 626 * If the CODEC is capable of idle 627 * bias off then being in STANDBY 628 * means it's doing something, 629 * otherwise fall through. 630 */ 631 if (codec->dapm.idle_bias_off) { 632 dev_dbg(codec->dev, 633 "ASoC: idle_bias_off CODEC on" 634 " over suspend\n"); 635 break; 636 } 637 case SND_SOC_BIAS_OFF: 638 codec->driver->suspend(codec); 639 codec->suspended = 1; 640 codec->cache_sync = 1; 641 if (codec->using_regmap) 642 regcache_mark_dirty(codec->control_data); 643 break; 644 default: 645 dev_dbg(codec->dev, "ASoC: CODEC is on" 646 " over suspend\n"); 647 break; 648 } 649 } 650 } 651 652 for (i = 0; i < card->num_rtd; i++) { 653 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 654 655 if (card->rtd[i].dai_link->ignore_suspend) 656 continue; 657 658 if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control) 659 cpu_dai->driver->suspend(cpu_dai); 660 } 661 662 if (card->suspend_post) 663 card->suspend_post(card); 664 665 return 0; 666 } 667 EXPORT_SYMBOL_GPL(snd_soc_suspend); 668 669 /* deferred resume work, so resume can complete before we finished 670 * setting our codec back up, which can be very slow on I2C 671 */ 672 static void soc_resume_deferred(struct work_struct *work) 673 { 674 struct snd_soc_card *card = 675 container_of(work, struct snd_soc_card, deferred_resume_work); 676 struct snd_soc_codec *codec; 677 int i; 678 679 /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time, 680 * so userspace apps are blocked from touching us 681 */ 682 683 dev_dbg(card->dev, "ASoC: starting resume work\n"); 684 685 /* Bring us up into D2 so that DAPM starts enabling things */ 686 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2); 687 688 if (card->resume_pre) 689 card->resume_pre(card); 690 691 /* resume AC97 DAIs */ 692 for (i = 0; i < card->num_rtd; i++) { 693 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 694 695 if (card->rtd[i].dai_link->ignore_suspend) 696 continue; 697 698 if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control) 699 cpu_dai->driver->resume(cpu_dai); 700 } 701 702 list_for_each_entry(codec, &card->codec_dev_list, card_list) { 703 /* If the CODEC was idle over suspend then it will have been 704 * left with bias OFF or STANDBY and suspended so we must now 705 * resume. Otherwise the suspend was suppressed. 706 */ 707 if (codec->driver->resume && codec->suspended) { 708 switch (codec->dapm.bias_level) { 709 case SND_SOC_BIAS_STANDBY: 710 case SND_SOC_BIAS_OFF: 711 codec->driver->resume(codec); 712 codec->suspended = 0; 713 break; 714 default: 715 dev_dbg(codec->dev, "ASoC: CODEC was on over" 716 " suspend\n"); 717 break; 718 } 719 } 720 } 721 722 for (i = 0; i < card->num_rtd; i++) { 723 724 if (card->rtd[i].dai_link->ignore_suspend) 725 continue; 726 727 snd_soc_dapm_stream_event(&card->rtd[i], 728 SNDRV_PCM_STREAM_PLAYBACK, 729 SND_SOC_DAPM_STREAM_RESUME); 730 731 snd_soc_dapm_stream_event(&card->rtd[i], 732 SNDRV_PCM_STREAM_CAPTURE, 733 SND_SOC_DAPM_STREAM_RESUME); 734 } 735 736 /* unmute any active DACs */ 737 for (i = 0; i < card->num_rtd; i++) { 738 struct snd_soc_dai *dai = card->rtd[i].codec_dai; 739 struct snd_soc_dai_driver *drv = dai->driver; 740 741 if (card->rtd[i].dai_link->ignore_suspend) 742 continue; 743 744 if (drv->ops->digital_mute && dai->playback_active) 745 drv->ops->digital_mute(dai, 0); 746 } 747 748 for (i = 0; i < card->num_rtd; i++) { 749 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 750 struct snd_soc_platform *platform = card->rtd[i].platform; 751 752 if (card->rtd[i].dai_link->ignore_suspend) 753 continue; 754 755 if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control) 756 cpu_dai->driver->resume(cpu_dai); 757 if (platform->driver->resume && platform->suspended) { 758 platform->driver->resume(cpu_dai); 759 platform->suspended = 0; 760 } 761 } 762 763 if (card->resume_post) 764 card->resume_post(card); 765 766 dev_dbg(card->dev, "ASoC: resume work completed\n"); 767 768 /* userspace can access us now we are back as we were before */ 769 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0); 770 771 /* Recheck all analogue paths too */ 772 dapm_mark_io_dirty(&card->dapm); 773 snd_soc_dapm_sync(&card->dapm); 774 } 775 776 /* powers up audio subsystem after a suspend */ 777 int snd_soc_resume(struct device *dev) 778 { 779 struct snd_soc_card *card = dev_get_drvdata(dev); 780 int i, ac97_control = 0; 781 782 /* If the initialization of this soc device failed, there is no codec 783 * associated with it. Just bail out in this case. 784 */ 785 if (list_empty(&card->codec_dev_list)) 786 return 0; 787 788 /* AC97 devices might have other drivers hanging off them so 789 * need to resume immediately. Other drivers don't have that 790 * problem and may take a substantial amount of time to resume 791 * due to I/O costs and anti-pop so handle them out of line. 792 */ 793 for (i = 0; i < card->num_rtd; i++) { 794 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai; 795 ac97_control |= cpu_dai->driver->ac97_control; 796 } 797 if (ac97_control) { 798 dev_dbg(dev, "ASoC: Resuming AC97 immediately\n"); 799 soc_resume_deferred(&card->deferred_resume_work); 800 } else { 801 dev_dbg(dev, "ASoC: Scheduling resume work\n"); 802 if (!schedule_work(&card->deferred_resume_work)) 803 dev_err(dev, "ASoC: resume work item may be lost\n"); 804 } 805 806 return 0; 807 } 808 EXPORT_SYMBOL_GPL(snd_soc_resume); 809 #else 810 #define snd_soc_suspend NULL 811 #define snd_soc_resume NULL 812 #endif 813 814 static const struct snd_soc_dai_ops null_dai_ops = { 815 }; 816 817 static int soc_bind_dai_link(struct snd_soc_card *card, int num) 818 { 819 struct snd_soc_dai_link *dai_link = &card->dai_link[num]; 820 struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 821 struct snd_soc_codec *codec; 822 struct snd_soc_platform *platform; 823 struct snd_soc_dai *codec_dai, *cpu_dai; 824 const char *platform_name; 825 826 dev_dbg(card->dev, "ASoC: binding %s at idx %d\n", dai_link->name, num); 827 828 /* Find CPU DAI from registered DAIs*/ 829 list_for_each_entry(cpu_dai, &dai_list, list) { 830 if (dai_link->cpu_of_node && 831 (cpu_dai->dev->of_node != dai_link->cpu_of_node)) 832 continue; 833 if (dai_link->cpu_name && 834 strcmp(dev_name(cpu_dai->dev), dai_link->cpu_name)) 835 continue; 836 if (dai_link->cpu_dai_name && 837 strcmp(cpu_dai->name, dai_link->cpu_dai_name)) 838 continue; 839 840 rtd->cpu_dai = cpu_dai; 841 } 842 843 if (!rtd->cpu_dai) { 844 dev_err(card->dev, "ASoC: CPU DAI %s not registered\n", 845 dai_link->cpu_dai_name); 846 return -EPROBE_DEFER; 847 } 848 849 /* Find CODEC from registered CODECs */ 850 list_for_each_entry(codec, &codec_list, list) { 851 if (dai_link->codec_of_node) { 852 if (codec->dev->of_node != dai_link->codec_of_node) 853 continue; 854 } else { 855 if (strcmp(codec->name, dai_link->codec_name)) 856 continue; 857 } 858 859 rtd->codec = codec; 860 861 /* 862 * CODEC found, so find CODEC DAI from registered DAIs from 863 * this CODEC 864 */ 865 list_for_each_entry(codec_dai, &dai_list, list) { 866 if (codec->dev == codec_dai->dev && 867 !strcmp(codec_dai->name, 868 dai_link->codec_dai_name)) { 869 870 rtd->codec_dai = codec_dai; 871 } 872 } 873 874 if (!rtd->codec_dai) { 875 dev_err(card->dev, "ASoC: CODEC DAI %s not registered\n", 876 dai_link->codec_dai_name); 877 return -EPROBE_DEFER; 878 } 879 } 880 881 if (!rtd->codec) { 882 dev_err(card->dev, "ASoC: CODEC %s not registered\n", 883 dai_link->codec_name); 884 return -EPROBE_DEFER; 885 } 886 887 /* if there's no platform we match on the empty platform */ 888 platform_name = dai_link->platform_name; 889 if (!platform_name && !dai_link->platform_of_node) 890 platform_name = "snd-soc-dummy"; 891 892 /* find one from the set of registered platforms */ 893 list_for_each_entry(platform, &platform_list, list) { 894 if (dai_link->platform_of_node) { 895 if (platform->dev->of_node != 896 dai_link->platform_of_node) 897 continue; 898 } else { 899 if (strcmp(platform->name, platform_name)) 900 continue; 901 } 902 903 rtd->platform = platform; 904 } 905 if (!rtd->platform) { 906 dev_err(card->dev, "ASoC: platform %s not registered\n", 907 dai_link->platform_name); 908 return -EPROBE_DEFER; 909 } 910 911 card->num_rtd++; 912 913 return 0; 914 } 915 916 static int soc_remove_platform(struct snd_soc_platform *platform) 917 { 918 int ret; 919 920 if (platform->driver->remove) { 921 ret = platform->driver->remove(platform); 922 if (ret < 0) 923 dev_err(platform->dev, "ASoC: failed to remove %d\n", 924 ret); 925 } 926 927 /* Make sure all DAPM widgets are freed */ 928 snd_soc_dapm_free(&platform->dapm); 929 930 soc_cleanup_platform_debugfs(platform); 931 platform->probed = 0; 932 list_del(&platform->card_list); 933 module_put(platform->dev->driver->owner); 934 935 return 0; 936 } 937 938 static void soc_remove_codec(struct snd_soc_codec *codec) 939 { 940 int err; 941 942 if (codec->driver->remove) { 943 err = codec->driver->remove(codec); 944 if (err < 0) 945 dev_err(codec->dev, "ASoC: failed to remove %d\n", err); 946 } 947 948 /* Make sure all DAPM widgets are freed */ 949 snd_soc_dapm_free(&codec->dapm); 950 951 soc_cleanup_codec_debugfs(codec); 952 codec->probed = 0; 953 list_del(&codec->card_list); 954 module_put(codec->dev->driver->owner); 955 } 956 957 static void soc_remove_link_dais(struct snd_soc_card *card, int num, int order) 958 { 959 struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 960 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai; 961 int err; 962 963 /* unregister the rtd device */ 964 if (rtd->dev_registered) { 965 device_remove_file(rtd->dev, &dev_attr_pmdown_time); 966 device_remove_file(rtd->dev, &dev_attr_codec_reg); 967 device_unregister(rtd->dev); 968 rtd->dev_registered = 0; 969 } 970 971 /* remove the CODEC DAI */ 972 if (codec_dai && codec_dai->probed && 973 codec_dai->driver->remove_order == order) { 974 if (codec_dai->driver->remove) { 975 err = codec_dai->driver->remove(codec_dai); 976 if (err < 0) 977 dev_err(codec_dai->dev, 978 "ASoC: failed to remove %s: %d\n", 979 codec_dai->name, err); 980 } 981 codec_dai->probed = 0; 982 list_del(&codec_dai->card_list); 983 } 984 985 /* remove the cpu_dai */ 986 if (cpu_dai && cpu_dai->probed && 987 cpu_dai->driver->remove_order == order) { 988 if (cpu_dai->driver->remove) { 989 err = cpu_dai->driver->remove(cpu_dai); 990 if (err < 0) 991 dev_err(cpu_dai->dev, 992 "ASoC: failed to remove %s: %d\n", 993 cpu_dai->name, err); 994 } 995 cpu_dai->probed = 0; 996 list_del(&cpu_dai->card_list); 997 998 if (!cpu_dai->codec) { 999 snd_soc_dapm_free(&cpu_dai->dapm); 1000 module_put(cpu_dai->dev->driver->owner); 1001 } 1002 } 1003 } 1004 1005 static void soc_remove_link_components(struct snd_soc_card *card, int num, 1006 int order) 1007 { 1008 struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 1009 struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 1010 struct snd_soc_dai *codec_dai = rtd->codec_dai; 1011 struct snd_soc_platform *platform = rtd->platform; 1012 struct snd_soc_codec *codec; 1013 1014 /* remove the platform */ 1015 if (platform && platform->probed && 1016 platform->driver->remove_order == order) { 1017 soc_remove_platform(platform); 1018 } 1019 1020 /* remove the CODEC-side CODEC */ 1021 if (codec_dai) { 1022 codec = codec_dai->codec; 1023 if (codec && codec->probed && 1024 codec->driver->remove_order == order) 1025 soc_remove_codec(codec); 1026 } 1027 1028 /* remove any CPU-side CODEC */ 1029 if (cpu_dai) { 1030 codec = cpu_dai->codec; 1031 if (codec && codec->probed && 1032 codec->driver->remove_order == order) 1033 soc_remove_codec(codec); 1034 } 1035 } 1036 1037 static void soc_remove_dai_links(struct snd_soc_card *card) 1038 { 1039 int dai, order; 1040 1041 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; 1042 order++) { 1043 for (dai = 0; dai < card->num_rtd; dai++) 1044 soc_remove_link_dais(card, dai, order); 1045 } 1046 1047 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; 1048 order++) { 1049 for (dai = 0; dai < card->num_rtd; dai++) 1050 soc_remove_link_components(card, dai, order); 1051 } 1052 1053 card->num_rtd = 0; 1054 } 1055 1056 static void soc_set_name_prefix(struct snd_soc_card *card, 1057 struct snd_soc_codec *codec) 1058 { 1059 int i; 1060 1061 if (card->codec_conf == NULL) 1062 return; 1063 1064 for (i = 0; i < card->num_configs; i++) { 1065 struct snd_soc_codec_conf *map = &card->codec_conf[i]; 1066 if (map->dev_name && !strcmp(codec->name, map->dev_name)) { 1067 codec->name_prefix = map->name_prefix; 1068 break; 1069 } 1070 } 1071 } 1072 1073 static int soc_probe_codec(struct snd_soc_card *card, 1074 struct snd_soc_codec *codec) 1075 { 1076 int ret = 0; 1077 const struct snd_soc_codec_driver *driver = codec->driver; 1078 struct snd_soc_dai *dai; 1079 1080 codec->card = card; 1081 codec->dapm.card = card; 1082 soc_set_name_prefix(card, codec); 1083 1084 if (!try_module_get(codec->dev->driver->owner)) 1085 return -ENODEV; 1086 1087 soc_init_codec_debugfs(codec); 1088 1089 if (driver->dapm_widgets) 1090 snd_soc_dapm_new_controls(&codec->dapm, driver->dapm_widgets, 1091 driver->num_dapm_widgets); 1092 1093 /* Create DAPM widgets for each DAI stream */ 1094 list_for_each_entry(dai, &dai_list, list) { 1095 if (dai->dev != codec->dev) 1096 continue; 1097 1098 snd_soc_dapm_new_dai_widgets(&codec->dapm, dai); 1099 } 1100 1101 codec->dapm.idle_bias_off = driver->idle_bias_off; 1102 1103 if (driver->probe) { 1104 ret = driver->probe(codec); 1105 if (ret < 0) { 1106 dev_err(codec->dev, 1107 "ASoC: failed to probe CODEC %d\n", ret); 1108 goto err_probe; 1109 } 1110 } 1111 1112 /* If the driver didn't set I/O up try regmap */ 1113 if (!codec->write && dev_get_regmap(codec->dev, NULL)) 1114 snd_soc_codec_set_cache_io(codec, 0, 0, SND_SOC_REGMAP); 1115 1116 if (driver->controls) 1117 snd_soc_add_codec_controls(codec, driver->controls, 1118 driver->num_controls); 1119 if (driver->dapm_routes) 1120 snd_soc_dapm_add_routes(&codec->dapm, driver->dapm_routes, 1121 driver->num_dapm_routes); 1122 1123 /* mark codec as probed and add to card codec list */ 1124 codec->probed = 1; 1125 list_add(&codec->card_list, &card->codec_dev_list); 1126 list_add(&codec->dapm.list, &card->dapm_list); 1127 1128 return 0; 1129 1130 err_probe: 1131 soc_cleanup_codec_debugfs(codec); 1132 module_put(codec->dev->driver->owner); 1133 1134 return ret; 1135 } 1136 1137 static int soc_probe_platform(struct snd_soc_card *card, 1138 struct snd_soc_platform *platform) 1139 { 1140 int ret = 0; 1141 const struct snd_soc_platform_driver *driver = platform->driver; 1142 struct snd_soc_dai *dai; 1143 1144 platform->card = card; 1145 platform->dapm.card = card; 1146 1147 if (!try_module_get(platform->dev->driver->owner)) 1148 return -ENODEV; 1149 1150 soc_init_platform_debugfs(platform); 1151 1152 if (driver->dapm_widgets) 1153 snd_soc_dapm_new_controls(&platform->dapm, 1154 driver->dapm_widgets, driver->num_dapm_widgets); 1155 1156 /* Create DAPM widgets for each DAI stream */ 1157 list_for_each_entry(dai, &dai_list, list) { 1158 if (dai->dev != platform->dev) 1159 continue; 1160 1161 snd_soc_dapm_new_dai_widgets(&platform->dapm, dai); 1162 } 1163 1164 platform->dapm.idle_bias_off = 1; 1165 1166 if (driver->probe) { 1167 ret = driver->probe(platform); 1168 if (ret < 0) { 1169 dev_err(platform->dev, 1170 "ASoC: failed to probe platform %d\n", ret); 1171 goto err_probe; 1172 } 1173 } 1174 1175 if (driver->controls) 1176 snd_soc_add_platform_controls(platform, driver->controls, 1177 driver->num_controls); 1178 if (driver->dapm_routes) 1179 snd_soc_dapm_add_routes(&platform->dapm, driver->dapm_routes, 1180 driver->num_dapm_routes); 1181 1182 /* mark platform as probed and add to card platform list */ 1183 platform->probed = 1; 1184 list_add(&platform->card_list, &card->platform_dev_list); 1185 list_add(&platform->dapm.list, &card->dapm_list); 1186 1187 return 0; 1188 1189 err_probe: 1190 soc_cleanup_platform_debugfs(platform); 1191 module_put(platform->dev->driver->owner); 1192 1193 return ret; 1194 } 1195 1196 static void rtd_release(struct device *dev) 1197 { 1198 kfree(dev); 1199 } 1200 1201 static int soc_post_component_init(struct snd_soc_card *card, 1202 struct snd_soc_codec *codec, 1203 int num, int dailess) 1204 { 1205 struct snd_soc_dai_link *dai_link = NULL; 1206 struct snd_soc_aux_dev *aux_dev = NULL; 1207 struct snd_soc_pcm_runtime *rtd; 1208 const char *temp, *name; 1209 int ret = 0; 1210 1211 if (!dailess) { 1212 dai_link = &card->dai_link[num]; 1213 rtd = &card->rtd[num]; 1214 name = dai_link->name; 1215 } else { 1216 aux_dev = &card->aux_dev[num]; 1217 rtd = &card->rtd_aux[num]; 1218 name = aux_dev->name; 1219 } 1220 rtd->card = card; 1221 1222 /* Make sure all DAPM widgets are instantiated */ 1223 snd_soc_dapm_new_widgets(&codec->dapm); 1224 1225 /* machine controls, routes and widgets are not prefixed */ 1226 temp = codec->name_prefix; 1227 codec->name_prefix = NULL; 1228 1229 /* do machine specific initialization */ 1230 if (!dailess && dai_link->init) 1231 ret = dai_link->init(rtd); 1232 else if (dailess && aux_dev->init) 1233 ret = aux_dev->init(&codec->dapm); 1234 if (ret < 0) { 1235 dev_err(card->dev, "ASoC: failed to init %s: %d\n", name, ret); 1236 return ret; 1237 } 1238 codec->name_prefix = temp; 1239 1240 /* register the rtd device */ 1241 rtd->codec = codec; 1242 1243 rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL); 1244 if (!rtd->dev) 1245 return -ENOMEM; 1246 device_initialize(rtd->dev); 1247 rtd->dev->parent = card->dev; 1248 rtd->dev->release = rtd_release; 1249 rtd->dev->init_name = name; 1250 dev_set_drvdata(rtd->dev, rtd); 1251 mutex_init(&rtd->pcm_mutex); 1252 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients); 1253 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients); 1254 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients); 1255 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients); 1256 ret = device_add(rtd->dev); 1257 if (ret < 0) { 1258 dev_err(card->dev, 1259 "ASoC: failed to register runtime device: %d\n", ret); 1260 return ret; 1261 } 1262 rtd->dev_registered = 1; 1263 1264 /* add DAPM sysfs entries for this codec */ 1265 ret = snd_soc_dapm_sys_add(rtd->dev); 1266 if (ret < 0) 1267 dev_err(codec->dev, 1268 "ASoC: failed to add codec dapm sysfs entries: %d\n", ret); 1269 1270 /* add codec sysfs entries */ 1271 ret = device_create_file(rtd->dev, &dev_attr_codec_reg); 1272 if (ret < 0) 1273 dev_err(codec->dev, 1274 "ASoC: failed to add codec sysfs files: %d\n", ret); 1275 1276 #ifdef CONFIG_DEBUG_FS 1277 /* add DPCM sysfs entries */ 1278 if (!dailess && !dai_link->dynamic) 1279 goto out; 1280 1281 ret = soc_dpcm_debugfs_add(rtd); 1282 if (ret < 0) 1283 dev_err(rtd->dev, "ASoC: failed to add dpcm sysfs entries: %d\n", ret); 1284 1285 out: 1286 #endif 1287 return 0; 1288 } 1289 1290 static int soc_probe_link_components(struct snd_soc_card *card, int num, 1291 int order) 1292 { 1293 struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 1294 struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 1295 struct snd_soc_dai *codec_dai = rtd->codec_dai; 1296 struct snd_soc_platform *platform = rtd->platform; 1297 int ret; 1298 1299 /* probe the CPU-side component, if it is a CODEC */ 1300 if (cpu_dai->codec && 1301 !cpu_dai->codec->probed && 1302 cpu_dai->codec->driver->probe_order == order) { 1303 ret = soc_probe_codec(card, cpu_dai->codec); 1304 if (ret < 0) 1305 return ret; 1306 } 1307 1308 /* probe the CODEC-side component */ 1309 if (!codec_dai->codec->probed && 1310 codec_dai->codec->driver->probe_order == order) { 1311 ret = soc_probe_codec(card, codec_dai->codec); 1312 if (ret < 0) 1313 return ret; 1314 } 1315 1316 /* probe the platform */ 1317 if (!platform->probed && 1318 platform->driver->probe_order == order) { 1319 ret = soc_probe_platform(card, platform); 1320 if (ret < 0) 1321 return ret; 1322 } 1323 1324 return 0; 1325 } 1326 1327 static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order) 1328 { 1329 struct snd_soc_dai_link *dai_link = &card->dai_link[num]; 1330 struct snd_soc_pcm_runtime *rtd = &card->rtd[num]; 1331 struct snd_soc_codec *codec = rtd->codec; 1332 struct snd_soc_platform *platform = rtd->platform; 1333 struct snd_soc_dai *codec_dai = rtd->codec_dai; 1334 struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 1335 struct snd_soc_dapm_widget *play_w, *capture_w; 1336 int ret; 1337 1338 dev_dbg(card->dev, "ASoC: probe %s dai link %d late %d\n", 1339 card->name, num, order); 1340 1341 /* config components */ 1342 cpu_dai->platform = platform; 1343 codec_dai->card = card; 1344 cpu_dai->card = card; 1345 1346 /* set default power off timeout */ 1347 rtd->pmdown_time = pmdown_time; 1348 1349 /* probe the cpu_dai */ 1350 if (!cpu_dai->probed && 1351 cpu_dai->driver->probe_order == order) { 1352 if (!cpu_dai->codec) { 1353 cpu_dai->dapm.card = card; 1354 if (!try_module_get(cpu_dai->dev->driver->owner)) 1355 return -ENODEV; 1356 1357 list_add(&cpu_dai->dapm.list, &card->dapm_list); 1358 snd_soc_dapm_new_dai_widgets(&cpu_dai->dapm, cpu_dai); 1359 } 1360 1361 if (cpu_dai->driver->probe) { 1362 ret = cpu_dai->driver->probe(cpu_dai); 1363 if (ret < 0) { 1364 dev_err(cpu_dai->dev, 1365 "ASoC: failed to probe CPU DAI %s: %d\n", 1366 cpu_dai->name, ret); 1367 module_put(cpu_dai->dev->driver->owner); 1368 return ret; 1369 } 1370 } 1371 cpu_dai->probed = 1; 1372 /* mark cpu_dai as probed and add to card dai list */ 1373 list_add(&cpu_dai->card_list, &card->dai_dev_list); 1374 } 1375 1376 /* probe the CODEC DAI */ 1377 if (!codec_dai->probed && codec_dai->driver->probe_order == order) { 1378 if (codec_dai->driver->probe) { 1379 ret = codec_dai->driver->probe(codec_dai); 1380 if (ret < 0) { 1381 dev_err(codec_dai->dev, 1382 "ASoC: failed to probe CODEC DAI %s: %d\n", 1383 codec_dai->name, ret); 1384 return ret; 1385 } 1386 } 1387 1388 /* mark codec_dai as probed and add to card dai list */ 1389 codec_dai->probed = 1; 1390 list_add(&codec_dai->card_list, &card->dai_dev_list); 1391 } 1392 1393 /* complete DAI probe during last probe */ 1394 if (order != SND_SOC_COMP_ORDER_LAST) 1395 return 0; 1396 1397 ret = soc_post_component_init(card, codec, num, 0); 1398 if (ret) 1399 return ret; 1400 1401 ret = device_create_file(rtd->dev, &dev_attr_pmdown_time); 1402 if (ret < 0) 1403 dev_warn(rtd->dev, "ASoC: failed to add pmdown_time sysfs: %d\n", 1404 ret); 1405 1406 if (cpu_dai->driver->compress_dai) { 1407 /*create compress_device"*/ 1408 ret = soc_new_compress(rtd, num); 1409 if (ret < 0) { 1410 dev_err(card->dev, "ASoC: can't create compress %s\n", 1411 dai_link->stream_name); 1412 return ret; 1413 } 1414 } else { 1415 1416 if (!dai_link->params) { 1417 /* create the pcm */ 1418 ret = soc_new_pcm(rtd, num); 1419 if (ret < 0) { 1420 dev_err(card->dev, "ASoC: can't create pcm %s :%d\n", 1421 dai_link->stream_name, ret); 1422 return ret; 1423 } 1424 } else { 1425 /* link the DAI widgets */ 1426 play_w = codec_dai->playback_widget; 1427 capture_w = cpu_dai->capture_widget; 1428 if (play_w && capture_w) { 1429 ret = snd_soc_dapm_new_pcm(card, dai_link->params, 1430 capture_w, play_w); 1431 if (ret != 0) { 1432 dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n", 1433 play_w->name, capture_w->name, ret); 1434 return ret; 1435 } 1436 } 1437 1438 play_w = cpu_dai->playback_widget; 1439 capture_w = codec_dai->capture_widget; 1440 if (play_w && capture_w) { 1441 ret = snd_soc_dapm_new_pcm(card, dai_link->params, 1442 capture_w, play_w); 1443 if (ret != 0) { 1444 dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n", 1445 play_w->name, capture_w->name, ret); 1446 return ret; 1447 } 1448 } 1449 } 1450 } 1451 1452 /* add platform data for AC97 devices */ 1453 if (rtd->codec_dai->driver->ac97_control) 1454 snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata); 1455 1456 return 0; 1457 } 1458 1459 #ifdef CONFIG_SND_SOC_AC97_BUS 1460 static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd) 1461 { 1462 int ret; 1463 1464 /* Only instantiate AC97 if not already done by the adaptor 1465 * for the generic AC97 subsystem. 1466 */ 1467 if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) { 1468 /* 1469 * It is possible that the AC97 device is already registered to 1470 * the device subsystem. This happens when the device is created 1471 * via snd_ac97_mixer(). Currently only SoC codec that does so 1472 * is the generic AC97 glue but others migh emerge. 1473 * 1474 * In those cases we don't try to register the device again. 1475 */ 1476 if (!rtd->codec->ac97_created) 1477 return 0; 1478 1479 ret = soc_ac97_dev_register(rtd->codec); 1480 if (ret < 0) { 1481 dev_err(rtd->codec->dev, 1482 "ASoC: AC97 device register failed: %d\n", ret); 1483 return ret; 1484 } 1485 1486 rtd->codec->ac97_registered = 1; 1487 } 1488 return 0; 1489 } 1490 1491 static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec) 1492 { 1493 if (codec->ac97_registered) { 1494 soc_ac97_dev_unregister(codec); 1495 codec->ac97_registered = 0; 1496 } 1497 } 1498 #endif 1499 1500 static int soc_check_aux_dev(struct snd_soc_card *card, int num) 1501 { 1502 struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num]; 1503 struct snd_soc_codec *codec; 1504 1505 /* find CODEC from registered CODECs*/ 1506 list_for_each_entry(codec, &codec_list, list) { 1507 if (!strcmp(codec->name, aux_dev->codec_name)) 1508 return 0; 1509 } 1510 1511 dev_err(card->dev, "ASoC: %s not registered\n", aux_dev->codec_name); 1512 1513 return -EPROBE_DEFER; 1514 } 1515 1516 static int soc_probe_aux_dev(struct snd_soc_card *card, int num) 1517 { 1518 struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num]; 1519 struct snd_soc_codec *codec; 1520 int ret = -ENODEV; 1521 1522 /* find CODEC from registered CODECs*/ 1523 list_for_each_entry(codec, &codec_list, list) { 1524 if (!strcmp(codec->name, aux_dev->codec_name)) { 1525 if (codec->probed) { 1526 dev_err(codec->dev, 1527 "ASoC: codec already probed"); 1528 ret = -EBUSY; 1529 goto out; 1530 } 1531 goto found; 1532 } 1533 } 1534 /* codec not found */ 1535 dev_err(card->dev, "ASoC: codec %s not found", aux_dev->codec_name); 1536 return -EPROBE_DEFER; 1537 1538 found: 1539 ret = soc_probe_codec(card, codec); 1540 if (ret < 0) 1541 return ret; 1542 1543 ret = soc_post_component_init(card, codec, num, 1); 1544 1545 out: 1546 return ret; 1547 } 1548 1549 static void soc_remove_aux_dev(struct snd_soc_card *card, int num) 1550 { 1551 struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num]; 1552 struct snd_soc_codec *codec = rtd->codec; 1553 1554 /* unregister the rtd device */ 1555 if (rtd->dev_registered) { 1556 device_remove_file(rtd->dev, &dev_attr_codec_reg); 1557 device_del(rtd->dev); 1558 rtd->dev_registered = 0; 1559 } 1560 1561 if (codec && codec->probed) 1562 soc_remove_codec(codec); 1563 } 1564 1565 static int snd_soc_init_codec_cache(struct snd_soc_codec *codec, 1566 enum snd_soc_compress_type compress_type) 1567 { 1568 int ret; 1569 1570 if (codec->cache_init) 1571 return 0; 1572 1573 /* override the compress_type if necessary */ 1574 if (compress_type && codec->compress_type != compress_type) 1575 codec->compress_type = compress_type; 1576 ret = snd_soc_cache_init(codec); 1577 if (ret < 0) { 1578 dev_err(codec->dev, "ASoC: Failed to set cache compression" 1579 " type: %d\n", ret); 1580 return ret; 1581 } 1582 codec->cache_init = 1; 1583 return 0; 1584 } 1585 1586 static int snd_soc_instantiate_card(struct snd_soc_card *card) 1587 { 1588 struct snd_soc_codec *codec; 1589 struct snd_soc_codec_conf *codec_conf; 1590 enum snd_soc_compress_type compress_type; 1591 struct snd_soc_dai_link *dai_link; 1592 int ret, i, order, dai_fmt; 1593 1594 mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT); 1595 1596 /* bind DAIs */ 1597 for (i = 0; i < card->num_links; i++) { 1598 ret = soc_bind_dai_link(card, i); 1599 if (ret != 0) 1600 goto base_error; 1601 } 1602 1603 /* check aux_devs too */ 1604 for (i = 0; i < card->num_aux_devs; i++) { 1605 ret = soc_check_aux_dev(card, i); 1606 if (ret != 0) 1607 goto base_error; 1608 } 1609 1610 /* initialize the register cache for each available codec */ 1611 list_for_each_entry(codec, &codec_list, list) { 1612 if (codec->cache_init) 1613 continue; 1614 /* by default we don't override the compress_type */ 1615 compress_type = 0; 1616 /* check to see if we need to override the compress_type */ 1617 for (i = 0; i < card->num_configs; ++i) { 1618 codec_conf = &card->codec_conf[i]; 1619 if (!strcmp(codec->name, codec_conf->dev_name)) { 1620 compress_type = codec_conf->compress_type; 1621 if (compress_type && compress_type 1622 != codec->compress_type) 1623 break; 1624 } 1625 } 1626 ret = snd_soc_init_codec_cache(codec, compress_type); 1627 if (ret < 0) 1628 goto base_error; 1629 } 1630 1631 /* card bind complete so register a sound card */ 1632 ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1, 1633 card->owner, 0, &card->snd_card); 1634 if (ret < 0) { 1635 dev_err(card->dev, "ASoC: can't create sound card for" 1636 " card %s: %d\n", card->name, ret); 1637 goto base_error; 1638 } 1639 card->snd_card->dev = card->dev; 1640 1641 card->dapm.bias_level = SND_SOC_BIAS_OFF; 1642 card->dapm.dev = card->dev; 1643 card->dapm.card = card; 1644 list_add(&card->dapm.list, &card->dapm_list); 1645 1646 #ifdef CONFIG_DEBUG_FS 1647 snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root); 1648 #endif 1649 1650 #ifdef CONFIG_PM_SLEEP 1651 /* deferred resume work */ 1652 INIT_WORK(&card->deferred_resume_work, soc_resume_deferred); 1653 #endif 1654 1655 if (card->dapm_widgets) 1656 snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets, 1657 card->num_dapm_widgets); 1658 1659 /* initialise the sound card only once */ 1660 if (card->probe) { 1661 ret = card->probe(card); 1662 if (ret < 0) 1663 goto card_probe_error; 1664 } 1665 1666 /* probe all components used by DAI links on this card */ 1667 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; 1668 order++) { 1669 for (i = 0; i < card->num_links; i++) { 1670 ret = soc_probe_link_components(card, i, order); 1671 if (ret < 0) { 1672 dev_err(card->dev, 1673 "ASoC: failed to instantiate card %d\n", 1674 ret); 1675 goto probe_dai_err; 1676 } 1677 } 1678 } 1679 1680 /* probe all DAI links on this card */ 1681 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST; 1682 order++) { 1683 for (i = 0; i < card->num_links; i++) { 1684 ret = soc_probe_link_dais(card, i, order); 1685 if (ret < 0) { 1686 dev_err(card->dev, 1687 "ASoC: failed to instantiate card %d\n", 1688 ret); 1689 goto probe_dai_err; 1690 } 1691 } 1692 } 1693 1694 for (i = 0; i < card->num_aux_devs; i++) { 1695 ret = soc_probe_aux_dev(card, i); 1696 if (ret < 0) { 1697 dev_err(card->dev, 1698 "ASoC: failed to add auxiliary devices %d\n", 1699 ret); 1700 goto probe_aux_dev_err; 1701 } 1702 } 1703 1704 snd_soc_dapm_link_dai_widgets(card); 1705 1706 if (card->controls) 1707 snd_soc_add_card_controls(card, card->controls, card->num_controls); 1708 1709 if (card->dapm_routes) 1710 snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes, 1711 card->num_dapm_routes); 1712 1713 snd_soc_dapm_new_widgets(&card->dapm); 1714 1715 for (i = 0; i < card->num_links; i++) { 1716 dai_link = &card->dai_link[i]; 1717 dai_fmt = dai_link->dai_fmt; 1718 1719 if (dai_fmt) { 1720 ret = snd_soc_dai_set_fmt(card->rtd[i].codec_dai, 1721 dai_fmt); 1722 if (ret != 0 && ret != -ENOTSUPP) 1723 dev_warn(card->rtd[i].codec_dai->dev, 1724 "ASoC: Failed to set DAI format: %d\n", 1725 ret); 1726 } 1727 1728 /* If this is a regular CPU link there will be a platform */ 1729 if (dai_fmt && 1730 (dai_link->platform_name || dai_link->platform_of_node)) { 1731 ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai, 1732 dai_fmt); 1733 if (ret != 0 && ret != -ENOTSUPP) 1734 dev_warn(card->rtd[i].cpu_dai->dev, 1735 "ASoC: Failed to set DAI format: %d\n", 1736 ret); 1737 } else if (dai_fmt) { 1738 /* Flip the polarity for the "CPU" end */ 1739 dai_fmt &= ~SND_SOC_DAIFMT_MASTER_MASK; 1740 switch (dai_link->dai_fmt & 1741 SND_SOC_DAIFMT_MASTER_MASK) { 1742 case SND_SOC_DAIFMT_CBM_CFM: 1743 dai_fmt |= SND_SOC_DAIFMT_CBS_CFS; 1744 break; 1745 case SND_SOC_DAIFMT_CBM_CFS: 1746 dai_fmt |= SND_SOC_DAIFMT_CBS_CFM; 1747 break; 1748 case SND_SOC_DAIFMT_CBS_CFM: 1749 dai_fmt |= SND_SOC_DAIFMT_CBM_CFS; 1750 break; 1751 case SND_SOC_DAIFMT_CBS_CFS: 1752 dai_fmt |= SND_SOC_DAIFMT_CBM_CFM; 1753 break; 1754 } 1755 1756 ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai, 1757 dai_fmt); 1758 if (ret != 0 && ret != -ENOTSUPP) 1759 dev_warn(card->rtd[i].cpu_dai->dev, 1760 "ASoC: Failed to set DAI format: %d\n", 1761 ret); 1762 } 1763 } 1764 1765 snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname), 1766 "%s", card->name); 1767 snprintf(card->snd_card->longname, sizeof(card->snd_card->longname), 1768 "%s", card->long_name ? card->long_name : card->name); 1769 snprintf(card->snd_card->driver, sizeof(card->snd_card->driver), 1770 "%s", card->driver_name ? card->driver_name : card->name); 1771 for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) { 1772 switch (card->snd_card->driver[i]) { 1773 case '_': 1774 case '-': 1775 case '\0': 1776 break; 1777 default: 1778 if (!isalnum(card->snd_card->driver[i])) 1779 card->snd_card->driver[i] = '_'; 1780 break; 1781 } 1782 } 1783 1784 if (card->late_probe) { 1785 ret = card->late_probe(card); 1786 if (ret < 0) { 1787 dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n", 1788 card->name, ret); 1789 goto probe_aux_dev_err; 1790 } 1791 } 1792 1793 snd_soc_dapm_new_widgets(&card->dapm); 1794 1795 if (card->fully_routed) 1796 list_for_each_entry(codec, &card->codec_dev_list, card_list) 1797 snd_soc_dapm_auto_nc_codec_pins(codec); 1798 1799 ret = snd_card_register(card->snd_card); 1800 if (ret < 0) { 1801 dev_err(card->dev, "ASoC: failed to register soundcard %d\n", 1802 ret); 1803 goto probe_aux_dev_err; 1804 } 1805 1806 #ifdef CONFIG_SND_SOC_AC97_BUS 1807 /* register any AC97 codecs */ 1808 for (i = 0; i < card->num_rtd; i++) { 1809 ret = soc_register_ac97_dai_link(&card->rtd[i]); 1810 if (ret < 0) { 1811 dev_err(card->dev, "ASoC: failed to register AC97:" 1812 " %d\n", ret); 1813 while (--i >= 0) 1814 soc_unregister_ac97_dai_link(card->rtd[i].codec); 1815 goto probe_aux_dev_err; 1816 } 1817 } 1818 #endif 1819 1820 card->instantiated = 1; 1821 snd_soc_dapm_sync(&card->dapm); 1822 mutex_unlock(&card->mutex); 1823 1824 return 0; 1825 1826 probe_aux_dev_err: 1827 for (i = 0; i < card->num_aux_devs; i++) 1828 soc_remove_aux_dev(card, i); 1829 1830 probe_dai_err: 1831 soc_remove_dai_links(card); 1832 1833 card_probe_error: 1834 if (card->remove) 1835 card->remove(card); 1836 1837 snd_card_free(card->snd_card); 1838 1839 base_error: 1840 mutex_unlock(&card->mutex); 1841 1842 return ret; 1843 } 1844 1845 /* probes a new socdev */ 1846 static int soc_probe(struct platform_device *pdev) 1847 { 1848 struct snd_soc_card *card = platform_get_drvdata(pdev); 1849 1850 /* 1851 * no card, so machine driver should be registering card 1852 * we should not be here in that case so ret error 1853 */ 1854 if (!card) 1855 return -EINVAL; 1856 1857 dev_warn(&pdev->dev, 1858 "ASoC: machine %s should use snd_soc_register_card()\n", 1859 card->name); 1860 1861 /* Bodge while we unpick instantiation */ 1862 card->dev = &pdev->dev; 1863 1864 return snd_soc_register_card(card); 1865 } 1866 1867 static int soc_cleanup_card_resources(struct snd_soc_card *card) 1868 { 1869 int i; 1870 1871 /* make sure any delayed work runs */ 1872 for (i = 0; i < card->num_rtd; i++) { 1873 struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; 1874 flush_delayed_work(&rtd->delayed_work); 1875 } 1876 1877 /* remove auxiliary devices */ 1878 for (i = 0; i < card->num_aux_devs; i++) 1879 soc_remove_aux_dev(card, i); 1880 1881 /* remove and free each DAI */ 1882 soc_remove_dai_links(card); 1883 1884 soc_cleanup_card_debugfs(card); 1885 1886 /* remove the card */ 1887 if (card->remove) 1888 card->remove(card); 1889 1890 snd_soc_dapm_free(&card->dapm); 1891 1892 snd_card_free(card->snd_card); 1893 return 0; 1894 1895 } 1896 1897 /* removes a socdev */ 1898 static int soc_remove(struct platform_device *pdev) 1899 { 1900 struct snd_soc_card *card = platform_get_drvdata(pdev); 1901 1902 snd_soc_unregister_card(card); 1903 return 0; 1904 } 1905 1906 int snd_soc_poweroff(struct device *dev) 1907 { 1908 struct snd_soc_card *card = dev_get_drvdata(dev); 1909 int i; 1910 1911 if (!card->instantiated) 1912 return 0; 1913 1914 /* Flush out pmdown_time work - we actually do want to run it 1915 * now, we're shutting down so no imminent restart. */ 1916 for (i = 0; i < card->num_rtd; i++) { 1917 struct snd_soc_pcm_runtime *rtd = &card->rtd[i]; 1918 flush_delayed_work(&rtd->delayed_work); 1919 } 1920 1921 snd_soc_dapm_shutdown(card); 1922 1923 return 0; 1924 } 1925 EXPORT_SYMBOL_GPL(snd_soc_poweroff); 1926 1927 const struct dev_pm_ops snd_soc_pm_ops = { 1928 .suspend = snd_soc_suspend, 1929 .resume = snd_soc_resume, 1930 .freeze = snd_soc_suspend, 1931 .thaw = snd_soc_resume, 1932 .poweroff = snd_soc_poweroff, 1933 .restore = snd_soc_resume, 1934 }; 1935 EXPORT_SYMBOL_GPL(snd_soc_pm_ops); 1936 1937 /* ASoC platform driver */ 1938 static struct platform_driver soc_driver = { 1939 .driver = { 1940 .name = "soc-audio", 1941 .owner = THIS_MODULE, 1942 .pm = &snd_soc_pm_ops, 1943 }, 1944 .probe = soc_probe, 1945 .remove = soc_remove, 1946 }; 1947 1948 /** 1949 * snd_soc_codec_volatile_register: Report if a register is volatile. 1950 * 1951 * @codec: CODEC to query. 1952 * @reg: Register to query. 1953 * 1954 * Boolean function indiciating if a CODEC register is volatile. 1955 */ 1956 int snd_soc_codec_volatile_register(struct snd_soc_codec *codec, 1957 unsigned int reg) 1958 { 1959 if (codec->volatile_register) 1960 return codec->volatile_register(codec, reg); 1961 else 1962 return 0; 1963 } 1964 EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register); 1965 1966 /** 1967 * snd_soc_codec_readable_register: Report if a register is readable. 1968 * 1969 * @codec: CODEC to query. 1970 * @reg: Register to query. 1971 * 1972 * Boolean function indicating if a CODEC register is readable. 1973 */ 1974 int snd_soc_codec_readable_register(struct snd_soc_codec *codec, 1975 unsigned int reg) 1976 { 1977 if (codec->readable_register) 1978 return codec->readable_register(codec, reg); 1979 else 1980 return 1; 1981 } 1982 EXPORT_SYMBOL_GPL(snd_soc_codec_readable_register); 1983 1984 /** 1985 * snd_soc_codec_writable_register: Report if a register is writable. 1986 * 1987 * @codec: CODEC to query. 1988 * @reg: Register to query. 1989 * 1990 * Boolean function indicating if a CODEC register is writable. 1991 */ 1992 int snd_soc_codec_writable_register(struct snd_soc_codec *codec, 1993 unsigned int reg) 1994 { 1995 if (codec->writable_register) 1996 return codec->writable_register(codec, reg); 1997 else 1998 return 1; 1999 } 2000 EXPORT_SYMBOL_GPL(snd_soc_codec_writable_register); 2001 2002 int snd_soc_platform_read(struct snd_soc_platform *platform, 2003 unsigned int reg) 2004 { 2005 unsigned int ret; 2006 2007 if (!platform->driver->read) { 2008 dev_err(platform->dev, "ASoC: platform has no read back\n"); 2009 return -1; 2010 } 2011 2012 ret = platform->driver->read(platform, reg); 2013 dev_dbg(platform->dev, "read %x => %x\n", reg, ret); 2014 trace_snd_soc_preg_read(platform, reg, ret); 2015 2016 return ret; 2017 } 2018 EXPORT_SYMBOL_GPL(snd_soc_platform_read); 2019 2020 int snd_soc_platform_write(struct snd_soc_platform *platform, 2021 unsigned int reg, unsigned int val) 2022 { 2023 if (!platform->driver->write) { 2024 dev_err(platform->dev, "ASoC: platform has no write back\n"); 2025 return -1; 2026 } 2027 2028 dev_dbg(platform->dev, "write %x = %x\n", reg, val); 2029 trace_snd_soc_preg_write(platform, reg, val); 2030 return platform->driver->write(platform, reg, val); 2031 } 2032 EXPORT_SYMBOL_GPL(snd_soc_platform_write); 2033 2034 /** 2035 * snd_soc_new_ac97_codec - initailise AC97 device 2036 * @codec: audio codec 2037 * @ops: AC97 bus operations 2038 * @num: AC97 codec number 2039 * 2040 * Initialises AC97 codec resources for use by ad-hoc devices only. 2041 */ 2042 int snd_soc_new_ac97_codec(struct snd_soc_codec *codec, 2043 struct snd_ac97_bus_ops *ops, int num) 2044 { 2045 mutex_lock(&codec->mutex); 2046 2047 codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL); 2048 if (codec->ac97 == NULL) { 2049 mutex_unlock(&codec->mutex); 2050 return -ENOMEM; 2051 } 2052 2053 codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL); 2054 if (codec->ac97->bus == NULL) { 2055 kfree(codec->ac97); 2056 codec->ac97 = NULL; 2057 mutex_unlock(&codec->mutex); 2058 return -ENOMEM; 2059 } 2060 2061 codec->ac97->bus->ops = ops; 2062 codec->ac97->num = num; 2063 2064 /* 2065 * Mark the AC97 device to be created by us. This way we ensure that the 2066 * device will be registered with the device subsystem later on. 2067 */ 2068 codec->ac97_created = 1; 2069 2070 mutex_unlock(&codec->mutex); 2071 return 0; 2072 } 2073 EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec); 2074 2075 /** 2076 * snd_soc_free_ac97_codec - free AC97 codec device 2077 * @codec: audio codec 2078 * 2079 * Frees AC97 codec device resources. 2080 */ 2081 void snd_soc_free_ac97_codec(struct snd_soc_codec *codec) 2082 { 2083 mutex_lock(&codec->mutex); 2084 #ifdef CONFIG_SND_SOC_AC97_BUS 2085 soc_unregister_ac97_dai_link(codec); 2086 #endif 2087 kfree(codec->ac97->bus); 2088 kfree(codec->ac97); 2089 codec->ac97 = NULL; 2090 codec->ac97_created = 0; 2091 mutex_unlock(&codec->mutex); 2092 } 2093 EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec); 2094 2095 unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg) 2096 { 2097 unsigned int ret; 2098 2099 ret = codec->read(codec, reg); 2100 dev_dbg(codec->dev, "read %x => %x\n", reg, ret); 2101 trace_snd_soc_reg_read(codec, reg, ret); 2102 2103 return ret; 2104 } 2105 EXPORT_SYMBOL_GPL(snd_soc_read); 2106 2107 unsigned int snd_soc_write(struct snd_soc_codec *codec, 2108 unsigned int reg, unsigned int val) 2109 { 2110 dev_dbg(codec->dev, "write %x = %x\n", reg, val); 2111 trace_snd_soc_reg_write(codec, reg, val); 2112 return codec->write(codec, reg, val); 2113 } 2114 EXPORT_SYMBOL_GPL(snd_soc_write); 2115 2116 unsigned int snd_soc_bulk_write_raw(struct snd_soc_codec *codec, 2117 unsigned int reg, const void *data, size_t len) 2118 { 2119 return codec->bulk_write_raw(codec, reg, data, len); 2120 } 2121 EXPORT_SYMBOL_GPL(snd_soc_bulk_write_raw); 2122 2123 /** 2124 * snd_soc_update_bits - update codec register bits 2125 * @codec: audio codec 2126 * @reg: codec register 2127 * @mask: register mask 2128 * @value: new value 2129 * 2130 * Writes new register value. 2131 * 2132 * Returns 1 for change, 0 for no change, or negative error code. 2133 */ 2134 int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg, 2135 unsigned int mask, unsigned int value) 2136 { 2137 bool change; 2138 unsigned int old, new; 2139 int ret; 2140 2141 if (codec->using_regmap) { 2142 ret = regmap_update_bits_check(codec->control_data, reg, 2143 mask, value, &change); 2144 } else { 2145 ret = snd_soc_read(codec, reg); 2146 if (ret < 0) 2147 return ret; 2148 2149 old = ret; 2150 new = (old & ~mask) | (value & mask); 2151 change = old != new; 2152 if (change) 2153 ret = snd_soc_write(codec, reg, new); 2154 } 2155 2156 if (ret < 0) 2157 return ret; 2158 2159 return change; 2160 } 2161 EXPORT_SYMBOL_GPL(snd_soc_update_bits); 2162 2163 /** 2164 * snd_soc_update_bits_locked - update codec register bits 2165 * @codec: audio codec 2166 * @reg: codec register 2167 * @mask: register mask 2168 * @value: new value 2169 * 2170 * Writes new register value, and takes the codec mutex. 2171 * 2172 * Returns 1 for change else 0. 2173 */ 2174 int snd_soc_update_bits_locked(struct snd_soc_codec *codec, 2175 unsigned short reg, unsigned int mask, 2176 unsigned int value) 2177 { 2178 int change; 2179 2180 mutex_lock(&codec->mutex); 2181 change = snd_soc_update_bits(codec, reg, mask, value); 2182 mutex_unlock(&codec->mutex); 2183 2184 return change; 2185 } 2186 EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked); 2187 2188 /** 2189 * snd_soc_test_bits - test register for change 2190 * @codec: audio codec 2191 * @reg: codec register 2192 * @mask: register mask 2193 * @value: new value 2194 * 2195 * Tests a register with a new value and checks if the new value is 2196 * different from the old value. 2197 * 2198 * Returns 1 for change else 0. 2199 */ 2200 int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg, 2201 unsigned int mask, unsigned int value) 2202 { 2203 int change; 2204 unsigned int old, new; 2205 2206 old = snd_soc_read(codec, reg); 2207 new = (old & ~mask) | value; 2208 change = old != new; 2209 2210 return change; 2211 } 2212 EXPORT_SYMBOL_GPL(snd_soc_test_bits); 2213 2214 /** 2215 * snd_soc_set_runtime_hwparams - set the runtime hardware parameters 2216 * @substream: the pcm substream 2217 * @hw: the hardware parameters 2218 * 2219 * Sets the substream runtime hardware parameters. 2220 */ 2221 int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream, 2222 const struct snd_pcm_hardware *hw) 2223 { 2224 struct snd_pcm_runtime *runtime = substream->runtime; 2225 runtime->hw.info = hw->info; 2226 runtime->hw.formats = hw->formats; 2227 runtime->hw.period_bytes_min = hw->period_bytes_min; 2228 runtime->hw.period_bytes_max = hw->period_bytes_max; 2229 runtime->hw.periods_min = hw->periods_min; 2230 runtime->hw.periods_max = hw->periods_max; 2231 runtime->hw.buffer_bytes_max = hw->buffer_bytes_max; 2232 runtime->hw.fifo_size = hw->fifo_size; 2233 return 0; 2234 } 2235 EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams); 2236 2237 /** 2238 * snd_soc_cnew - create new control 2239 * @_template: control template 2240 * @data: control private data 2241 * @long_name: control long name 2242 * @prefix: control name prefix 2243 * 2244 * Create a new mixer control from a template control. 2245 * 2246 * Returns 0 for success, else error. 2247 */ 2248 struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template, 2249 void *data, const char *long_name, 2250 const char *prefix) 2251 { 2252 struct snd_kcontrol_new template; 2253 struct snd_kcontrol *kcontrol; 2254 char *name = NULL; 2255 int name_len; 2256 2257 memcpy(&template, _template, sizeof(template)); 2258 template.index = 0; 2259 2260 if (!long_name) 2261 long_name = template.name; 2262 2263 if (prefix) { 2264 name_len = strlen(long_name) + strlen(prefix) + 2; 2265 name = kmalloc(name_len, GFP_KERNEL); 2266 if (!name) 2267 return NULL; 2268 2269 snprintf(name, name_len, "%s %s", prefix, long_name); 2270 2271 template.name = name; 2272 } else { 2273 template.name = long_name; 2274 } 2275 2276 kcontrol = snd_ctl_new1(&template, data); 2277 2278 kfree(name); 2279 2280 return kcontrol; 2281 } 2282 EXPORT_SYMBOL_GPL(snd_soc_cnew); 2283 2284 static int snd_soc_add_controls(struct snd_card *card, struct device *dev, 2285 const struct snd_kcontrol_new *controls, int num_controls, 2286 const char *prefix, void *data) 2287 { 2288 int err, i; 2289 2290 for (i = 0; i < num_controls; i++) { 2291 const struct snd_kcontrol_new *control = &controls[i]; 2292 err = snd_ctl_add(card, snd_soc_cnew(control, data, 2293 control->name, prefix)); 2294 if (err < 0) { 2295 dev_err(dev, "ASoC: Failed to add %s: %d\n", 2296 control->name, err); 2297 return err; 2298 } 2299 } 2300 2301 return 0; 2302 } 2303 2304 /** 2305 * snd_soc_add_codec_controls - add an array of controls to a codec. 2306 * Convenience function to add a list of controls. Many codecs were 2307 * duplicating this code. 2308 * 2309 * @codec: codec to add controls to 2310 * @controls: array of controls to add 2311 * @num_controls: number of elements in the array 2312 * 2313 * Return 0 for success, else error. 2314 */ 2315 int snd_soc_add_codec_controls(struct snd_soc_codec *codec, 2316 const struct snd_kcontrol_new *controls, int num_controls) 2317 { 2318 struct snd_card *card = codec->card->snd_card; 2319 2320 return snd_soc_add_controls(card, codec->dev, controls, num_controls, 2321 codec->name_prefix, codec); 2322 } 2323 EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls); 2324 2325 /** 2326 * snd_soc_add_platform_controls - add an array of controls to a platform. 2327 * Convenience function to add a list of controls. 2328 * 2329 * @platform: platform to add controls to 2330 * @controls: array of controls to add 2331 * @num_controls: number of elements in the array 2332 * 2333 * Return 0 for success, else error. 2334 */ 2335 int snd_soc_add_platform_controls(struct snd_soc_platform *platform, 2336 const struct snd_kcontrol_new *controls, int num_controls) 2337 { 2338 struct snd_card *card = platform->card->snd_card; 2339 2340 return snd_soc_add_controls(card, platform->dev, controls, num_controls, 2341 NULL, platform); 2342 } 2343 EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls); 2344 2345 /** 2346 * snd_soc_add_card_controls - add an array of controls to a SoC card. 2347 * Convenience function to add a list of controls. 2348 * 2349 * @soc_card: SoC card to add controls to 2350 * @controls: array of controls to add 2351 * @num_controls: number of elements in the array 2352 * 2353 * Return 0 for success, else error. 2354 */ 2355 int snd_soc_add_card_controls(struct snd_soc_card *soc_card, 2356 const struct snd_kcontrol_new *controls, int num_controls) 2357 { 2358 struct snd_card *card = soc_card->snd_card; 2359 2360 return snd_soc_add_controls(card, soc_card->dev, controls, num_controls, 2361 NULL, soc_card); 2362 } 2363 EXPORT_SYMBOL_GPL(snd_soc_add_card_controls); 2364 2365 /** 2366 * snd_soc_add_dai_controls - add an array of controls to a DAI. 2367 * Convienience function to add a list of controls. 2368 * 2369 * @dai: DAI to add controls to 2370 * @controls: array of controls to add 2371 * @num_controls: number of elements in the array 2372 * 2373 * Return 0 for success, else error. 2374 */ 2375 int snd_soc_add_dai_controls(struct snd_soc_dai *dai, 2376 const struct snd_kcontrol_new *controls, int num_controls) 2377 { 2378 struct snd_card *card = dai->card->snd_card; 2379 2380 return snd_soc_add_controls(card, dai->dev, controls, num_controls, 2381 NULL, dai); 2382 } 2383 EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls); 2384 2385 /** 2386 * snd_soc_info_enum_double - enumerated double mixer info callback 2387 * @kcontrol: mixer control 2388 * @uinfo: control element information 2389 * 2390 * Callback to provide information about a double enumerated 2391 * mixer control. 2392 * 2393 * Returns 0 for success. 2394 */ 2395 int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol, 2396 struct snd_ctl_elem_info *uinfo) 2397 { 2398 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2399 2400 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; 2401 uinfo->count = e->shift_l == e->shift_r ? 1 : 2; 2402 uinfo->value.enumerated.items = e->max; 2403 2404 if (uinfo->value.enumerated.item > e->max - 1) 2405 uinfo->value.enumerated.item = e->max - 1; 2406 strcpy(uinfo->value.enumerated.name, 2407 e->texts[uinfo->value.enumerated.item]); 2408 return 0; 2409 } 2410 EXPORT_SYMBOL_GPL(snd_soc_info_enum_double); 2411 2412 /** 2413 * snd_soc_get_enum_double - enumerated double mixer get callback 2414 * @kcontrol: mixer control 2415 * @ucontrol: control element information 2416 * 2417 * Callback to get the value of a double enumerated mixer. 2418 * 2419 * Returns 0 for success. 2420 */ 2421 int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol, 2422 struct snd_ctl_elem_value *ucontrol) 2423 { 2424 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2425 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2426 unsigned int val; 2427 2428 val = snd_soc_read(codec, e->reg); 2429 ucontrol->value.enumerated.item[0] 2430 = (val >> e->shift_l) & e->mask; 2431 if (e->shift_l != e->shift_r) 2432 ucontrol->value.enumerated.item[1] = 2433 (val >> e->shift_r) & e->mask; 2434 2435 return 0; 2436 } 2437 EXPORT_SYMBOL_GPL(snd_soc_get_enum_double); 2438 2439 /** 2440 * snd_soc_put_enum_double - enumerated double mixer put callback 2441 * @kcontrol: mixer control 2442 * @ucontrol: control element information 2443 * 2444 * Callback to set the value of a double enumerated mixer. 2445 * 2446 * Returns 0 for success. 2447 */ 2448 int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol, 2449 struct snd_ctl_elem_value *ucontrol) 2450 { 2451 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2452 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2453 unsigned int val; 2454 unsigned int mask; 2455 2456 if (ucontrol->value.enumerated.item[0] > e->max - 1) 2457 return -EINVAL; 2458 val = ucontrol->value.enumerated.item[0] << e->shift_l; 2459 mask = e->mask << e->shift_l; 2460 if (e->shift_l != e->shift_r) { 2461 if (ucontrol->value.enumerated.item[1] > e->max - 1) 2462 return -EINVAL; 2463 val |= ucontrol->value.enumerated.item[1] << e->shift_r; 2464 mask |= e->mask << e->shift_r; 2465 } 2466 2467 return snd_soc_update_bits_locked(codec, e->reg, mask, val); 2468 } 2469 EXPORT_SYMBOL_GPL(snd_soc_put_enum_double); 2470 2471 /** 2472 * snd_soc_get_value_enum_double - semi enumerated double mixer get callback 2473 * @kcontrol: mixer control 2474 * @ucontrol: control element information 2475 * 2476 * Callback to get the value of a double semi enumerated mixer. 2477 * 2478 * Semi enumerated mixer: the enumerated items are referred as values. Can be 2479 * used for handling bitfield coded enumeration for example. 2480 * 2481 * Returns 0 for success. 2482 */ 2483 int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol, 2484 struct snd_ctl_elem_value *ucontrol) 2485 { 2486 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2487 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2488 unsigned int reg_val, val, mux; 2489 2490 reg_val = snd_soc_read(codec, e->reg); 2491 val = (reg_val >> e->shift_l) & e->mask; 2492 for (mux = 0; mux < e->max; mux++) { 2493 if (val == e->values[mux]) 2494 break; 2495 } 2496 ucontrol->value.enumerated.item[0] = mux; 2497 if (e->shift_l != e->shift_r) { 2498 val = (reg_val >> e->shift_r) & e->mask; 2499 for (mux = 0; mux < e->max; mux++) { 2500 if (val == e->values[mux]) 2501 break; 2502 } 2503 ucontrol->value.enumerated.item[1] = mux; 2504 } 2505 2506 return 0; 2507 } 2508 EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double); 2509 2510 /** 2511 * snd_soc_put_value_enum_double - semi enumerated double mixer put callback 2512 * @kcontrol: mixer control 2513 * @ucontrol: control element information 2514 * 2515 * Callback to set the value of a double semi enumerated mixer. 2516 * 2517 * Semi enumerated mixer: the enumerated items are referred as values. Can be 2518 * used for handling bitfield coded enumeration for example. 2519 * 2520 * Returns 0 for success. 2521 */ 2522 int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol, 2523 struct snd_ctl_elem_value *ucontrol) 2524 { 2525 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2526 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2527 unsigned int val; 2528 unsigned int mask; 2529 2530 if (ucontrol->value.enumerated.item[0] > e->max - 1) 2531 return -EINVAL; 2532 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l; 2533 mask = e->mask << e->shift_l; 2534 if (e->shift_l != e->shift_r) { 2535 if (ucontrol->value.enumerated.item[1] > e->max - 1) 2536 return -EINVAL; 2537 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r; 2538 mask |= e->mask << e->shift_r; 2539 } 2540 2541 return snd_soc_update_bits_locked(codec, e->reg, mask, val); 2542 } 2543 EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double); 2544 2545 /** 2546 * snd_soc_info_enum_ext - external enumerated single mixer info callback 2547 * @kcontrol: mixer control 2548 * @uinfo: control element information 2549 * 2550 * Callback to provide information about an external enumerated 2551 * single mixer. 2552 * 2553 * Returns 0 for success. 2554 */ 2555 int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol, 2556 struct snd_ctl_elem_info *uinfo) 2557 { 2558 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2559 2560 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; 2561 uinfo->count = 1; 2562 uinfo->value.enumerated.items = e->max; 2563 2564 if (uinfo->value.enumerated.item > e->max - 1) 2565 uinfo->value.enumerated.item = e->max - 1; 2566 strcpy(uinfo->value.enumerated.name, 2567 e->texts[uinfo->value.enumerated.item]); 2568 return 0; 2569 } 2570 EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext); 2571 2572 /** 2573 * snd_soc_info_volsw_ext - external single mixer info callback 2574 * @kcontrol: mixer control 2575 * @uinfo: control element information 2576 * 2577 * Callback to provide information about a single external mixer control. 2578 * 2579 * Returns 0 for success. 2580 */ 2581 int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol, 2582 struct snd_ctl_elem_info *uinfo) 2583 { 2584 int max = kcontrol->private_value; 2585 2586 if (max == 1 && !strstr(kcontrol->id.name, " Volume")) 2587 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 2588 else 2589 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2590 2591 uinfo->count = 1; 2592 uinfo->value.integer.min = 0; 2593 uinfo->value.integer.max = max; 2594 return 0; 2595 } 2596 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext); 2597 2598 /** 2599 * snd_soc_info_volsw - single mixer info callback 2600 * @kcontrol: mixer control 2601 * @uinfo: control element information 2602 * 2603 * Callback to provide information about a single mixer control, or a double 2604 * mixer control that spans 2 registers. 2605 * 2606 * Returns 0 for success. 2607 */ 2608 int snd_soc_info_volsw(struct snd_kcontrol *kcontrol, 2609 struct snd_ctl_elem_info *uinfo) 2610 { 2611 struct soc_mixer_control *mc = 2612 (struct soc_mixer_control *)kcontrol->private_value; 2613 int platform_max; 2614 2615 if (!mc->platform_max) 2616 mc->platform_max = mc->max; 2617 platform_max = mc->platform_max; 2618 2619 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume")) 2620 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 2621 else 2622 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2623 2624 uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1; 2625 uinfo->value.integer.min = 0; 2626 uinfo->value.integer.max = platform_max; 2627 return 0; 2628 } 2629 EXPORT_SYMBOL_GPL(snd_soc_info_volsw); 2630 2631 /** 2632 * snd_soc_get_volsw - single mixer get callback 2633 * @kcontrol: mixer control 2634 * @ucontrol: control element information 2635 * 2636 * Callback to get the value of a single mixer control, or a double mixer 2637 * control that spans 2 registers. 2638 * 2639 * Returns 0 for success. 2640 */ 2641 int snd_soc_get_volsw(struct snd_kcontrol *kcontrol, 2642 struct snd_ctl_elem_value *ucontrol) 2643 { 2644 struct soc_mixer_control *mc = 2645 (struct soc_mixer_control *)kcontrol->private_value; 2646 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2647 unsigned int reg = mc->reg; 2648 unsigned int reg2 = mc->rreg; 2649 unsigned int shift = mc->shift; 2650 unsigned int rshift = mc->rshift; 2651 int max = mc->max; 2652 unsigned int mask = (1 << fls(max)) - 1; 2653 unsigned int invert = mc->invert; 2654 2655 ucontrol->value.integer.value[0] = 2656 (snd_soc_read(codec, reg) >> shift) & mask; 2657 if (invert) 2658 ucontrol->value.integer.value[0] = 2659 max - ucontrol->value.integer.value[0]; 2660 2661 if (snd_soc_volsw_is_stereo(mc)) { 2662 if (reg == reg2) 2663 ucontrol->value.integer.value[1] = 2664 (snd_soc_read(codec, reg) >> rshift) & mask; 2665 else 2666 ucontrol->value.integer.value[1] = 2667 (snd_soc_read(codec, reg2) >> shift) & mask; 2668 if (invert) 2669 ucontrol->value.integer.value[1] = 2670 max - ucontrol->value.integer.value[1]; 2671 } 2672 2673 return 0; 2674 } 2675 EXPORT_SYMBOL_GPL(snd_soc_get_volsw); 2676 2677 /** 2678 * snd_soc_put_volsw - single mixer put callback 2679 * @kcontrol: mixer control 2680 * @ucontrol: control element information 2681 * 2682 * Callback to set the value of a single mixer control, or a double mixer 2683 * control that spans 2 registers. 2684 * 2685 * Returns 0 for success. 2686 */ 2687 int snd_soc_put_volsw(struct snd_kcontrol *kcontrol, 2688 struct snd_ctl_elem_value *ucontrol) 2689 { 2690 struct soc_mixer_control *mc = 2691 (struct soc_mixer_control *)kcontrol->private_value; 2692 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2693 unsigned int reg = mc->reg; 2694 unsigned int reg2 = mc->rreg; 2695 unsigned int shift = mc->shift; 2696 unsigned int rshift = mc->rshift; 2697 int max = mc->max; 2698 unsigned int mask = (1 << fls(max)) - 1; 2699 unsigned int invert = mc->invert; 2700 int err; 2701 bool type_2r = 0; 2702 unsigned int val2 = 0; 2703 unsigned int val, val_mask; 2704 2705 val = (ucontrol->value.integer.value[0] & mask); 2706 if (invert) 2707 val = max - val; 2708 val_mask = mask << shift; 2709 val = val << shift; 2710 if (snd_soc_volsw_is_stereo(mc)) { 2711 val2 = (ucontrol->value.integer.value[1] & mask); 2712 if (invert) 2713 val2 = max - val2; 2714 if (reg == reg2) { 2715 val_mask |= mask << rshift; 2716 val |= val2 << rshift; 2717 } else { 2718 val2 = val2 << shift; 2719 type_2r = 1; 2720 } 2721 } 2722 err = snd_soc_update_bits_locked(codec, reg, val_mask, val); 2723 if (err < 0) 2724 return err; 2725 2726 if (type_2r) 2727 err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2); 2728 2729 return err; 2730 } 2731 EXPORT_SYMBOL_GPL(snd_soc_put_volsw); 2732 2733 /** 2734 * snd_soc_get_volsw_sx - single mixer get callback 2735 * @kcontrol: mixer control 2736 * @ucontrol: control element information 2737 * 2738 * Callback to get the value of a single mixer control, or a double mixer 2739 * control that spans 2 registers. 2740 * 2741 * Returns 0 for success. 2742 */ 2743 int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol, 2744 struct snd_ctl_elem_value *ucontrol) 2745 { 2746 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2747 struct soc_mixer_control *mc = 2748 (struct soc_mixer_control *)kcontrol->private_value; 2749 2750 unsigned int reg = mc->reg; 2751 unsigned int reg2 = mc->rreg; 2752 unsigned int shift = mc->shift; 2753 unsigned int rshift = mc->rshift; 2754 int max = mc->max; 2755 int min = mc->min; 2756 int mask = (1 << (fls(min + max) - 1)) - 1; 2757 2758 ucontrol->value.integer.value[0] = 2759 ((snd_soc_read(codec, reg) >> shift) - min) & mask; 2760 2761 if (snd_soc_volsw_is_stereo(mc)) 2762 ucontrol->value.integer.value[1] = 2763 ((snd_soc_read(codec, reg2) >> rshift) - min) & mask; 2764 2765 return 0; 2766 } 2767 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx); 2768 2769 /** 2770 * snd_soc_put_volsw_sx - double mixer set callback 2771 * @kcontrol: mixer control 2772 * @uinfo: control element information 2773 * 2774 * Callback to set the value of a double mixer control that spans 2 registers. 2775 * 2776 * Returns 0 for success. 2777 */ 2778 int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol, 2779 struct snd_ctl_elem_value *ucontrol) 2780 { 2781 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2782 struct soc_mixer_control *mc = 2783 (struct soc_mixer_control *)kcontrol->private_value; 2784 2785 unsigned int reg = mc->reg; 2786 unsigned int reg2 = mc->rreg; 2787 unsigned int shift = mc->shift; 2788 unsigned int rshift = mc->rshift; 2789 int max = mc->max; 2790 int min = mc->min; 2791 int mask = (1 << (fls(min + max) - 1)) - 1; 2792 int err = 0; 2793 unsigned short val, val_mask, val2 = 0; 2794 2795 val_mask = mask << shift; 2796 val = (ucontrol->value.integer.value[0] + min) & mask; 2797 val = val << shift; 2798 2799 err = snd_soc_update_bits_locked(codec, reg, val_mask, val); 2800 if (err < 0) 2801 return err; 2802 2803 if (snd_soc_volsw_is_stereo(mc)) { 2804 val_mask = mask << rshift; 2805 val2 = (ucontrol->value.integer.value[1] + min) & mask; 2806 val2 = val2 << rshift; 2807 2808 if (snd_soc_update_bits_locked(codec, reg2, val_mask, val2)) 2809 return err; 2810 } 2811 return 0; 2812 } 2813 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx); 2814 2815 /** 2816 * snd_soc_info_volsw_s8 - signed mixer info callback 2817 * @kcontrol: mixer control 2818 * @uinfo: control element information 2819 * 2820 * Callback to provide information about a signed mixer control. 2821 * 2822 * Returns 0 for success. 2823 */ 2824 int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol, 2825 struct snd_ctl_elem_info *uinfo) 2826 { 2827 struct soc_mixer_control *mc = 2828 (struct soc_mixer_control *)kcontrol->private_value; 2829 int platform_max; 2830 int min = mc->min; 2831 2832 if (!mc->platform_max) 2833 mc->platform_max = mc->max; 2834 platform_max = mc->platform_max; 2835 2836 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2837 uinfo->count = 2; 2838 uinfo->value.integer.min = 0; 2839 uinfo->value.integer.max = platform_max - min; 2840 return 0; 2841 } 2842 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8); 2843 2844 /** 2845 * snd_soc_get_volsw_s8 - signed mixer get callback 2846 * @kcontrol: mixer control 2847 * @ucontrol: control element information 2848 * 2849 * Callback to get the value of a signed mixer control. 2850 * 2851 * Returns 0 for success. 2852 */ 2853 int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol, 2854 struct snd_ctl_elem_value *ucontrol) 2855 { 2856 struct soc_mixer_control *mc = 2857 (struct soc_mixer_control *)kcontrol->private_value; 2858 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2859 unsigned int reg = mc->reg; 2860 int min = mc->min; 2861 int val = snd_soc_read(codec, reg); 2862 2863 ucontrol->value.integer.value[0] = 2864 ((signed char)(val & 0xff))-min; 2865 ucontrol->value.integer.value[1] = 2866 ((signed char)((val >> 8) & 0xff))-min; 2867 return 0; 2868 } 2869 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8); 2870 2871 /** 2872 * snd_soc_put_volsw_sgn - signed mixer put callback 2873 * @kcontrol: mixer control 2874 * @ucontrol: control element information 2875 * 2876 * Callback to set the value of a signed mixer control. 2877 * 2878 * Returns 0 for success. 2879 */ 2880 int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol, 2881 struct snd_ctl_elem_value *ucontrol) 2882 { 2883 struct soc_mixer_control *mc = 2884 (struct soc_mixer_control *)kcontrol->private_value; 2885 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2886 unsigned int reg = mc->reg; 2887 int min = mc->min; 2888 unsigned int val; 2889 2890 val = (ucontrol->value.integer.value[0]+min) & 0xff; 2891 val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8; 2892 2893 return snd_soc_update_bits_locked(codec, reg, 0xffff, val); 2894 } 2895 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8); 2896 2897 /** 2898 * snd_soc_info_volsw_range - single mixer info callback with range. 2899 * @kcontrol: mixer control 2900 * @uinfo: control element information 2901 * 2902 * Callback to provide information, within a range, about a single 2903 * mixer control. 2904 * 2905 * returns 0 for success. 2906 */ 2907 int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol, 2908 struct snd_ctl_elem_info *uinfo) 2909 { 2910 struct soc_mixer_control *mc = 2911 (struct soc_mixer_control *)kcontrol->private_value; 2912 int platform_max; 2913 int min = mc->min; 2914 2915 if (!mc->platform_max) 2916 mc->platform_max = mc->max; 2917 platform_max = mc->platform_max; 2918 2919 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 2920 uinfo->count = 1; 2921 uinfo->value.integer.min = 0; 2922 uinfo->value.integer.max = platform_max - min; 2923 2924 return 0; 2925 } 2926 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range); 2927 2928 /** 2929 * snd_soc_put_volsw_range - single mixer put value callback with range. 2930 * @kcontrol: mixer control 2931 * @ucontrol: control element information 2932 * 2933 * Callback to set the value, within a range, for a single mixer control. 2934 * 2935 * Returns 0 for success. 2936 */ 2937 int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol, 2938 struct snd_ctl_elem_value *ucontrol) 2939 { 2940 struct soc_mixer_control *mc = 2941 (struct soc_mixer_control *)kcontrol->private_value; 2942 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2943 unsigned int reg = mc->reg; 2944 unsigned int shift = mc->shift; 2945 int min = mc->min; 2946 int max = mc->max; 2947 unsigned int mask = (1 << fls(max)) - 1; 2948 unsigned int invert = mc->invert; 2949 unsigned int val, val_mask; 2950 2951 val = ((ucontrol->value.integer.value[0] + min) & mask); 2952 if (invert) 2953 val = max - val; 2954 val_mask = mask << shift; 2955 val = val << shift; 2956 2957 return snd_soc_update_bits_locked(codec, reg, val_mask, val); 2958 } 2959 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range); 2960 2961 /** 2962 * snd_soc_get_volsw_range - single mixer get callback with range 2963 * @kcontrol: mixer control 2964 * @ucontrol: control element information 2965 * 2966 * Callback to get the value, within a range, of a single mixer control. 2967 * 2968 * Returns 0 for success. 2969 */ 2970 int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol, 2971 struct snd_ctl_elem_value *ucontrol) 2972 { 2973 struct soc_mixer_control *mc = 2974 (struct soc_mixer_control *)kcontrol->private_value; 2975 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 2976 unsigned int reg = mc->reg; 2977 unsigned int shift = mc->shift; 2978 int min = mc->min; 2979 int max = mc->max; 2980 unsigned int mask = (1 << fls(max)) - 1; 2981 unsigned int invert = mc->invert; 2982 2983 ucontrol->value.integer.value[0] = 2984 (snd_soc_read(codec, reg) >> shift) & mask; 2985 if (invert) 2986 ucontrol->value.integer.value[0] = 2987 max - ucontrol->value.integer.value[0]; 2988 ucontrol->value.integer.value[0] = 2989 ucontrol->value.integer.value[0] - min; 2990 2991 return 0; 2992 } 2993 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range); 2994 2995 /** 2996 * snd_soc_limit_volume - Set new limit to an existing volume control. 2997 * 2998 * @codec: where to look for the control 2999 * @name: Name of the control 3000 * @max: new maximum limit 3001 * 3002 * Return 0 for success, else error. 3003 */ 3004 int snd_soc_limit_volume(struct snd_soc_codec *codec, 3005 const char *name, int max) 3006 { 3007 struct snd_card *card = codec->card->snd_card; 3008 struct snd_kcontrol *kctl; 3009 struct soc_mixer_control *mc; 3010 int found = 0; 3011 int ret = -EINVAL; 3012 3013 /* Sanity check for name and max */ 3014 if (unlikely(!name || max <= 0)) 3015 return -EINVAL; 3016 3017 list_for_each_entry(kctl, &card->controls, list) { 3018 if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) { 3019 found = 1; 3020 break; 3021 } 3022 } 3023 if (found) { 3024 mc = (struct soc_mixer_control *)kctl->private_value; 3025 if (max <= mc->max) { 3026 mc->platform_max = max; 3027 ret = 0; 3028 } 3029 } 3030 return ret; 3031 } 3032 EXPORT_SYMBOL_GPL(snd_soc_limit_volume); 3033 3034 int snd_soc_bytes_info(struct snd_kcontrol *kcontrol, 3035 struct snd_ctl_elem_info *uinfo) 3036 { 3037 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 3038 struct soc_bytes *params = (void *)kcontrol->private_value; 3039 3040 uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES; 3041 uinfo->count = params->num_regs * codec->val_bytes; 3042 3043 return 0; 3044 } 3045 EXPORT_SYMBOL_GPL(snd_soc_bytes_info); 3046 3047 int snd_soc_bytes_get(struct snd_kcontrol *kcontrol, 3048 struct snd_ctl_elem_value *ucontrol) 3049 { 3050 struct soc_bytes *params = (void *)kcontrol->private_value; 3051 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 3052 int ret; 3053 3054 if (codec->using_regmap) 3055 ret = regmap_raw_read(codec->control_data, params->base, 3056 ucontrol->value.bytes.data, 3057 params->num_regs * codec->val_bytes); 3058 else 3059 ret = -EINVAL; 3060 3061 /* Hide any masked bytes to ensure consistent data reporting */ 3062 if (ret == 0 && params->mask) { 3063 switch (codec->val_bytes) { 3064 case 1: 3065 ucontrol->value.bytes.data[0] &= ~params->mask; 3066 break; 3067 case 2: 3068 ((u16 *)(&ucontrol->value.bytes.data))[0] 3069 &= ~params->mask; 3070 break; 3071 case 4: 3072 ((u32 *)(&ucontrol->value.bytes.data))[0] 3073 &= ~params->mask; 3074 break; 3075 default: 3076 return -EINVAL; 3077 } 3078 } 3079 3080 return ret; 3081 } 3082 EXPORT_SYMBOL_GPL(snd_soc_bytes_get); 3083 3084 int snd_soc_bytes_put(struct snd_kcontrol *kcontrol, 3085 struct snd_ctl_elem_value *ucontrol) 3086 { 3087 struct soc_bytes *params = (void *)kcontrol->private_value; 3088 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 3089 int ret, len; 3090 unsigned int val; 3091 void *data; 3092 3093 if (!codec->using_regmap) 3094 return -EINVAL; 3095 3096 data = ucontrol->value.bytes.data; 3097 len = params->num_regs * codec->val_bytes; 3098 3099 /* 3100 * If we've got a mask then we need to preserve the register 3101 * bits. We shouldn't modify the incoming data so take a 3102 * copy. 3103 */ 3104 if (params->mask) { 3105 ret = regmap_read(codec->control_data, params->base, &val); 3106 if (ret != 0) 3107 return ret; 3108 3109 val &= params->mask; 3110 3111 data = kmemdup(data, len, GFP_KERNEL); 3112 if (!data) 3113 return -ENOMEM; 3114 3115 switch (codec->val_bytes) { 3116 case 1: 3117 ((u8 *)data)[0] &= ~params->mask; 3118 ((u8 *)data)[0] |= val; 3119 break; 3120 case 2: 3121 ((u16 *)data)[0] &= cpu_to_be16(~params->mask); 3122 ((u16 *)data)[0] |= cpu_to_be16(val); 3123 break; 3124 case 4: 3125 ((u32 *)data)[0] &= cpu_to_be32(~params->mask); 3126 ((u32 *)data)[0] |= cpu_to_be32(val); 3127 break; 3128 default: 3129 return -EINVAL; 3130 } 3131 } 3132 3133 ret = regmap_raw_write(codec->control_data, params->base, 3134 data, len); 3135 3136 if (params->mask) 3137 kfree(data); 3138 3139 return ret; 3140 } 3141 EXPORT_SYMBOL_GPL(snd_soc_bytes_put); 3142 3143 /** 3144 * snd_soc_info_xr_sx - signed multi register info callback 3145 * @kcontrol: mreg control 3146 * @uinfo: control element information 3147 * 3148 * Callback to provide information of a control that can 3149 * span multiple codec registers which together 3150 * forms a single signed value in a MSB/LSB manner. 3151 * 3152 * Returns 0 for success. 3153 */ 3154 int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol, 3155 struct snd_ctl_elem_info *uinfo) 3156 { 3157 struct soc_mreg_control *mc = 3158 (struct soc_mreg_control *)kcontrol->private_value; 3159 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 3160 uinfo->count = 1; 3161 uinfo->value.integer.min = mc->min; 3162 uinfo->value.integer.max = mc->max; 3163 3164 return 0; 3165 } 3166 EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx); 3167 3168 /** 3169 * snd_soc_get_xr_sx - signed multi register get callback 3170 * @kcontrol: mreg control 3171 * @ucontrol: control element information 3172 * 3173 * Callback to get the value of a control that can span 3174 * multiple codec registers which together forms a single 3175 * signed value in a MSB/LSB manner. The control supports 3176 * specifying total no of bits used to allow for bitfields 3177 * across the multiple codec registers. 3178 * 3179 * Returns 0 for success. 3180 */ 3181 int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol, 3182 struct snd_ctl_elem_value *ucontrol) 3183 { 3184 struct soc_mreg_control *mc = 3185 (struct soc_mreg_control *)kcontrol->private_value; 3186 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 3187 unsigned int regbase = mc->regbase; 3188 unsigned int regcount = mc->regcount; 3189 unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE; 3190 unsigned int regwmask = (1<<regwshift)-1; 3191 unsigned int invert = mc->invert; 3192 unsigned long mask = (1UL<<mc->nbits)-1; 3193 long min = mc->min; 3194 long max = mc->max; 3195 long val = 0; 3196 unsigned long regval; 3197 unsigned int i; 3198 3199 for (i = 0; i < regcount; i++) { 3200 regval = snd_soc_read(codec, regbase+i) & regwmask; 3201 val |= regval << (regwshift*(regcount-i-1)); 3202 } 3203 val &= mask; 3204 if (min < 0 && val > max) 3205 val |= ~mask; 3206 if (invert) 3207 val = max - val; 3208 ucontrol->value.integer.value[0] = val; 3209 3210 return 0; 3211 } 3212 EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx); 3213 3214 /** 3215 * snd_soc_put_xr_sx - signed multi register get callback 3216 * @kcontrol: mreg control 3217 * @ucontrol: control element information 3218 * 3219 * Callback to set the value of a control that can span 3220 * multiple codec registers which together forms a single 3221 * signed value in a MSB/LSB manner. The control supports 3222 * specifying total no of bits used to allow for bitfields 3223 * across the multiple codec registers. 3224 * 3225 * Returns 0 for success. 3226 */ 3227 int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol, 3228 struct snd_ctl_elem_value *ucontrol) 3229 { 3230 struct soc_mreg_control *mc = 3231 (struct soc_mreg_control *)kcontrol->private_value; 3232 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 3233 unsigned int regbase = mc->regbase; 3234 unsigned int regcount = mc->regcount; 3235 unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE; 3236 unsigned int regwmask = (1<<regwshift)-1; 3237 unsigned int invert = mc->invert; 3238 unsigned long mask = (1UL<<mc->nbits)-1; 3239 long max = mc->max; 3240 long val = ucontrol->value.integer.value[0]; 3241 unsigned int i, regval, regmask; 3242 int err; 3243 3244 if (invert) 3245 val = max - val; 3246 val &= mask; 3247 for (i = 0; i < regcount; i++) { 3248 regval = (val >> (regwshift*(regcount-i-1))) & regwmask; 3249 regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask; 3250 err = snd_soc_update_bits_locked(codec, regbase+i, 3251 regmask, regval); 3252 if (err < 0) 3253 return err; 3254 } 3255 3256 return 0; 3257 } 3258 EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx); 3259 3260 /** 3261 * snd_soc_get_strobe - strobe get callback 3262 * @kcontrol: mixer control 3263 * @ucontrol: control element information 3264 * 3265 * Callback get the value of a strobe mixer control. 3266 * 3267 * Returns 0 for success. 3268 */ 3269 int snd_soc_get_strobe(struct snd_kcontrol *kcontrol, 3270 struct snd_ctl_elem_value *ucontrol) 3271 { 3272 struct soc_mixer_control *mc = 3273 (struct soc_mixer_control *)kcontrol->private_value; 3274 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 3275 unsigned int reg = mc->reg; 3276 unsigned int shift = mc->shift; 3277 unsigned int mask = 1 << shift; 3278 unsigned int invert = mc->invert != 0; 3279 unsigned int val = snd_soc_read(codec, reg) & mask; 3280 3281 if (shift != 0 && val != 0) 3282 val = val >> shift; 3283 ucontrol->value.enumerated.item[0] = val ^ invert; 3284 3285 return 0; 3286 } 3287 EXPORT_SYMBOL_GPL(snd_soc_get_strobe); 3288 3289 /** 3290 * snd_soc_put_strobe - strobe put callback 3291 * @kcontrol: mixer control 3292 * @ucontrol: control element information 3293 * 3294 * Callback strobe a register bit to high then low (or the inverse) 3295 * in one pass of a single mixer enum control. 3296 * 3297 * Returns 1 for success. 3298 */ 3299 int snd_soc_put_strobe(struct snd_kcontrol *kcontrol, 3300 struct snd_ctl_elem_value *ucontrol) 3301 { 3302 struct soc_mixer_control *mc = 3303 (struct soc_mixer_control *)kcontrol->private_value; 3304 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); 3305 unsigned int reg = mc->reg; 3306 unsigned int shift = mc->shift; 3307 unsigned int mask = 1 << shift; 3308 unsigned int invert = mc->invert != 0; 3309 unsigned int strobe = ucontrol->value.enumerated.item[0] != 0; 3310 unsigned int val1 = (strobe ^ invert) ? mask : 0; 3311 unsigned int val2 = (strobe ^ invert) ? 0 : mask; 3312 int err; 3313 3314 err = snd_soc_update_bits_locked(codec, reg, mask, val1); 3315 if (err < 0) 3316 return err; 3317 3318 err = snd_soc_update_bits_locked(codec, reg, mask, val2); 3319 return err; 3320 } 3321 EXPORT_SYMBOL_GPL(snd_soc_put_strobe); 3322 3323 /** 3324 * snd_soc_dai_set_sysclk - configure DAI system or master clock. 3325 * @dai: DAI 3326 * @clk_id: DAI specific clock ID 3327 * @freq: new clock frequency in Hz 3328 * @dir: new clock direction - input/output. 3329 * 3330 * Configures the DAI master (MCLK) or system (SYSCLK) clocking. 3331 */ 3332 int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id, 3333 unsigned int freq, int dir) 3334 { 3335 if (dai->driver && dai->driver->ops->set_sysclk) 3336 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir); 3337 else if (dai->codec && dai->codec->driver->set_sysclk) 3338 return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0, 3339 freq, dir); 3340 else 3341 return -EINVAL; 3342 } 3343 EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk); 3344 3345 /** 3346 * snd_soc_codec_set_sysclk - configure CODEC system or master clock. 3347 * @codec: CODEC 3348 * @clk_id: DAI specific clock ID 3349 * @source: Source for the clock 3350 * @freq: new clock frequency in Hz 3351 * @dir: new clock direction - input/output. 3352 * 3353 * Configures the CODEC master (MCLK) or system (SYSCLK) clocking. 3354 */ 3355 int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id, 3356 int source, unsigned int freq, int dir) 3357 { 3358 if (codec->driver->set_sysclk) 3359 return codec->driver->set_sysclk(codec, clk_id, source, 3360 freq, dir); 3361 else 3362 return -EINVAL; 3363 } 3364 EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk); 3365 3366 /** 3367 * snd_soc_dai_set_clkdiv - configure DAI clock dividers. 3368 * @dai: DAI 3369 * @div_id: DAI specific clock divider ID 3370 * @div: new clock divisor. 3371 * 3372 * Configures the clock dividers. This is used to derive the best DAI bit and 3373 * frame clocks from the system or master clock. It's best to set the DAI bit 3374 * and frame clocks as low as possible to save system power. 3375 */ 3376 int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai, 3377 int div_id, int div) 3378 { 3379 if (dai->driver && dai->driver->ops->set_clkdiv) 3380 return dai->driver->ops->set_clkdiv(dai, div_id, div); 3381 else 3382 return -EINVAL; 3383 } 3384 EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv); 3385 3386 /** 3387 * snd_soc_dai_set_pll - configure DAI PLL. 3388 * @dai: DAI 3389 * @pll_id: DAI specific PLL ID 3390 * @source: DAI specific source for the PLL 3391 * @freq_in: PLL input clock frequency in Hz 3392 * @freq_out: requested PLL output clock frequency in Hz 3393 * 3394 * Configures and enables PLL to generate output clock based on input clock. 3395 */ 3396 int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source, 3397 unsigned int freq_in, unsigned int freq_out) 3398 { 3399 if (dai->driver && dai->driver->ops->set_pll) 3400 return dai->driver->ops->set_pll(dai, pll_id, source, 3401 freq_in, freq_out); 3402 else if (dai->codec && dai->codec->driver->set_pll) 3403 return dai->codec->driver->set_pll(dai->codec, pll_id, source, 3404 freq_in, freq_out); 3405 else 3406 return -EINVAL; 3407 } 3408 EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll); 3409 3410 /* 3411 * snd_soc_codec_set_pll - configure codec PLL. 3412 * @codec: CODEC 3413 * @pll_id: DAI specific PLL ID 3414 * @source: DAI specific source for the PLL 3415 * @freq_in: PLL input clock frequency in Hz 3416 * @freq_out: requested PLL output clock frequency in Hz 3417 * 3418 * Configures and enables PLL to generate output clock based on input clock. 3419 */ 3420 int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source, 3421 unsigned int freq_in, unsigned int freq_out) 3422 { 3423 if (codec->driver->set_pll) 3424 return codec->driver->set_pll(codec, pll_id, source, 3425 freq_in, freq_out); 3426 else 3427 return -EINVAL; 3428 } 3429 EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll); 3430 3431 /** 3432 * snd_soc_dai_set_fmt - configure DAI hardware audio format. 3433 * @dai: DAI 3434 * @fmt: SND_SOC_DAIFMT_ format value. 3435 * 3436 * Configures the DAI hardware format and clocking. 3437 */ 3438 int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) 3439 { 3440 if (dai->driver == NULL) 3441 return -EINVAL; 3442 if (dai->driver->ops->set_fmt == NULL) 3443 return -ENOTSUPP; 3444 return dai->driver->ops->set_fmt(dai, fmt); 3445 } 3446 EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt); 3447 3448 /** 3449 * snd_soc_dai_set_tdm_slot - configure DAI TDM. 3450 * @dai: DAI 3451 * @tx_mask: bitmask representing active TX slots. 3452 * @rx_mask: bitmask representing active RX slots. 3453 * @slots: Number of slots in use. 3454 * @slot_width: Width in bits for each slot. 3455 * 3456 * Configures a DAI for TDM operation. Both mask and slots are codec and DAI 3457 * specific. 3458 */ 3459 int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai, 3460 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width) 3461 { 3462 if (dai->driver && dai->driver->ops->set_tdm_slot) 3463 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask, 3464 slots, slot_width); 3465 else 3466 return -EINVAL; 3467 } 3468 EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot); 3469 3470 /** 3471 * snd_soc_dai_set_channel_map - configure DAI audio channel map 3472 * @dai: DAI 3473 * @tx_num: how many TX channels 3474 * @tx_slot: pointer to an array which imply the TX slot number channel 3475 * 0~num-1 uses 3476 * @rx_num: how many RX channels 3477 * @rx_slot: pointer to an array which imply the RX slot number channel 3478 * 0~num-1 uses 3479 * 3480 * configure the relationship between channel number and TDM slot number. 3481 */ 3482 int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai, 3483 unsigned int tx_num, unsigned int *tx_slot, 3484 unsigned int rx_num, unsigned int *rx_slot) 3485 { 3486 if (dai->driver && dai->driver->ops->set_channel_map) 3487 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot, 3488 rx_num, rx_slot); 3489 else 3490 return -EINVAL; 3491 } 3492 EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map); 3493 3494 /** 3495 * snd_soc_dai_set_tristate - configure DAI system or master clock. 3496 * @dai: DAI 3497 * @tristate: tristate enable 3498 * 3499 * Tristates the DAI so that others can use it. 3500 */ 3501 int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate) 3502 { 3503 if (dai->driver && dai->driver->ops->set_tristate) 3504 return dai->driver->ops->set_tristate(dai, tristate); 3505 else 3506 return -EINVAL; 3507 } 3508 EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate); 3509 3510 /** 3511 * snd_soc_dai_digital_mute - configure DAI system or master clock. 3512 * @dai: DAI 3513 * @mute: mute enable 3514 * 3515 * Mutes the DAI DAC. 3516 */ 3517 int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute) 3518 { 3519 if (dai->driver && dai->driver->ops->digital_mute) 3520 return dai->driver->ops->digital_mute(dai, mute); 3521 else 3522 return -ENOTSUPP; 3523 } 3524 EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute); 3525 3526 /** 3527 * snd_soc_register_card - Register a card with the ASoC core 3528 * 3529 * @card: Card to register 3530 * 3531 */ 3532 int snd_soc_register_card(struct snd_soc_card *card) 3533 { 3534 int i, ret; 3535 3536 if (!card->name || !card->dev) 3537 return -EINVAL; 3538 3539 for (i = 0; i < card->num_links; i++) { 3540 struct snd_soc_dai_link *link = &card->dai_link[i]; 3541 3542 /* 3543 * Codec must be specified by 1 of name or OF node, 3544 * not both or neither. 3545 */ 3546 if (!!link->codec_name == !!link->codec_of_node) { 3547 dev_err(card->dev, "ASoC: Neither/both codec" 3548 " name/of_node are set for %s\n", link->name); 3549 return -EINVAL; 3550 } 3551 /* Codec DAI name must be specified */ 3552 if (!link->codec_dai_name) { 3553 dev_err(card->dev, "ASoC: codec_dai_name not" 3554 " set for %s\n", link->name); 3555 return -EINVAL; 3556 } 3557 3558 /* 3559 * Platform may be specified by either name or OF node, but 3560 * can be left unspecified, and a dummy platform will be used. 3561 */ 3562 if (link->platform_name && link->platform_of_node) { 3563 dev_err(card->dev, "ASoC: Both platform name/of_node" 3564 " are set for %s\n", link->name); 3565 return -EINVAL; 3566 } 3567 3568 /* 3569 * CPU device may be specified by either name or OF node, but 3570 * can be left unspecified, and will be matched based on DAI 3571 * name alone.. 3572 */ 3573 if (link->cpu_name && link->cpu_of_node) { 3574 dev_err(card->dev, "ASoC: Neither/both " 3575 "cpu name/of_node are set for %s\n",link->name); 3576 return -EINVAL; 3577 } 3578 /* 3579 * At least one of CPU DAI name or CPU device name/node must be 3580 * specified 3581 */ 3582 if (!link->cpu_dai_name && 3583 !(link->cpu_name || link->cpu_of_node)) { 3584 dev_err(card->dev, "ASoC: Neither cpu_dai_name nor " 3585 "cpu_name/of_node are set for %s\n", link->name); 3586 return -EINVAL; 3587 } 3588 } 3589 3590 dev_set_drvdata(card->dev, card); 3591 3592 snd_soc_initialize_card_lists(card); 3593 3594 soc_init_card_debugfs(card); 3595 3596 card->rtd = devm_kzalloc(card->dev, 3597 sizeof(struct snd_soc_pcm_runtime) * 3598 (card->num_links + card->num_aux_devs), 3599 GFP_KERNEL); 3600 if (card->rtd == NULL) 3601 return -ENOMEM; 3602 card->num_rtd = 0; 3603 card->rtd_aux = &card->rtd[card->num_links]; 3604 3605 for (i = 0; i < card->num_links; i++) 3606 card->rtd[i].dai_link = &card->dai_link[i]; 3607 3608 INIT_LIST_HEAD(&card->list); 3609 INIT_LIST_HEAD(&card->dapm_dirty); 3610 card->instantiated = 0; 3611 mutex_init(&card->mutex); 3612 mutex_init(&card->dapm_mutex); 3613 3614 ret = snd_soc_instantiate_card(card); 3615 if (ret != 0) 3616 soc_cleanup_card_debugfs(card); 3617 3618 return ret; 3619 } 3620 EXPORT_SYMBOL_GPL(snd_soc_register_card); 3621 3622 /** 3623 * snd_soc_unregister_card - Unregister a card with the ASoC core 3624 * 3625 * @card: Card to unregister 3626 * 3627 */ 3628 int snd_soc_unregister_card(struct snd_soc_card *card) 3629 { 3630 if (card->instantiated) 3631 soc_cleanup_card_resources(card); 3632 dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name); 3633 3634 return 0; 3635 } 3636 EXPORT_SYMBOL_GPL(snd_soc_unregister_card); 3637 3638 /* 3639 * Simplify DAI link configuration by removing ".-1" from device names 3640 * and sanitizing names. 3641 */ 3642 static char *fmt_single_name(struct device *dev, int *id) 3643 { 3644 char *found, name[NAME_SIZE]; 3645 int id1, id2; 3646 3647 if (dev_name(dev) == NULL) 3648 return NULL; 3649 3650 strlcpy(name, dev_name(dev), NAME_SIZE); 3651 3652 /* are we a "%s.%d" name (platform and SPI components) */ 3653 found = strstr(name, dev->driver->name); 3654 if (found) { 3655 /* get ID */ 3656 if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) { 3657 3658 /* discard ID from name if ID == -1 */ 3659 if (*id == -1) 3660 found[strlen(dev->driver->name)] = '\0'; 3661 } 3662 3663 } else { 3664 /* I2C component devices are named "bus-addr" */ 3665 if (sscanf(name, "%x-%x", &id1, &id2) == 2) { 3666 char tmp[NAME_SIZE]; 3667 3668 /* create unique ID number from I2C addr and bus */ 3669 *id = ((id1 & 0xffff) << 16) + id2; 3670 3671 /* sanitize component name for DAI link creation */ 3672 snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name); 3673 strlcpy(name, tmp, NAME_SIZE); 3674 } else 3675 *id = 0; 3676 } 3677 3678 return kstrdup(name, GFP_KERNEL); 3679 } 3680 3681 /* 3682 * Simplify DAI link naming for single devices with multiple DAIs by removing 3683 * any ".-1" and using the DAI name (instead of device name). 3684 */ 3685 static inline char *fmt_multiple_name(struct device *dev, 3686 struct snd_soc_dai_driver *dai_drv) 3687 { 3688 if (dai_drv->name == NULL) { 3689 dev_err(dev, "ASoC: error - multiple DAI %s registered with" 3690 " no name\n", dev_name(dev)); 3691 return NULL; 3692 } 3693 3694 return kstrdup(dai_drv->name, GFP_KERNEL); 3695 } 3696 3697 /** 3698 * snd_soc_register_dai - Register a DAI with the ASoC core 3699 * 3700 * @dai: DAI to register 3701 */ 3702 int snd_soc_register_dai(struct device *dev, 3703 struct snd_soc_dai_driver *dai_drv) 3704 { 3705 struct snd_soc_codec *codec; 3706 struct snd_soc_dai *dai; 3707 3708 dev_dbg(dev, "ASoC: dai register %s\n", dev_name(dev)); 3709 3710 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL); 3711 if (dai == NULL) 3712 return -ENOMEM; 3713 3714 /* create DAI component name */ 3715 dai->name = fmt_single_name(dev, &dai->id); 3716 if (dai->name == NULL) { 3717 kfree(dai); 3718 return -ENOMEM; 3719 } 3720 3721 dai->dev = dev; 3722 dai->driver = dai_drv; 3723 dai->dapm.dev = dev; 3724 if (!dai->driver->ops) 3725 dai->driver->ops = &null_dai_ops; 3726 3727 mutex_lock(&client_mutex); 3728 3729 list_for_each_entry(codec, &codec_list, list) { 3730 if (codec->dev == dev) { 3731 dev_dbg(dev, "ASoC: Mapped DAI %s to CODEC %s\n", 3732 dai->name, codec->name); 3733 dai->codec = codec; 3734 break; 3735 } 3736 } 3737 3738 if (!dai->codec) 3739 dai->dapm.idle_bias_off = 1; 3740 3741 list_add(&dai->list, &dai_list); 3742 3743 mutex_unlock(&client_mutex); 3744 3745 dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name); 3746 3747 return 0; 3748 } 3749 EXPORT_SYMBOL_GPL(snd_soc_register_dai); 3750 3751 /** 3752 * snd_soc_unregister_dai - Unregister a DAI from the ASoC core 3753 * 3754 * @dai: DAI to unregister 3755 */ 3756 void snd_soc_unregister_dai(struct device *dev) 3757 { 3758 struct snd_soc_dai *dai; 3759 3760 list_for_each_entry(dai, &dai_list, list) { 3761 if (dev == dai->dev) 3762 goto found; 3763 } 3764 return; 3765 3766 found: 3767 mutex_lock(&client_mutex); 3768 list_del(&dai->list); 3769 mutex_unlock(&client_mutex); 3770 3771 dev_dbg(dev, "ASoC: Unregistered DAI '%s'\n", dai->name); 3772 kfree(dai->name); 3773 kfree(dai); 3774 } 3775 EXPORT_SYMBOL_GPL(snd_soc_unregister_dai); 3776 3777 /** 3778 * snd_soc_register_dais - Register multiple DAIs with the ASoC core 3779 * 3780 * @dai: Array of DAIs to register 3781 * @count: Number of DAIs 3782 */ 3783 int snd_soc_register_dais(struct device *dev, 3784 struct snd_soc_dai_driver *dai_drv, size_t count) 3785 { 3786 struct snd_soc_codec *codec; 3787 struct snd_soc_dai *dai; 3788 int i, ret = 0; 3789 3790 dev_dbg(dev, "ASoC: dai register %s #%Zu\n", dev_name(dev), count); 3791 3792 for (i = 0; i < count; i++) { 3793 3794 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL); 3795 if (dai == NULL) { 3796 ret = -ENOMEM; 3797 goto err; 3798 } 3799 3800 /* create DAI component name */ 3801 dai->name = fmt_multiple_name(dev, &dai_drv[i]); 3802 if (dai->name == NULL) { 3803 kfree(dai); 3804 ret = -EINVAL; 3805 goto err; 3806 } 3807 3808 dai->dev = dev; 3809 dai->driver = &dai_drv[i]; 3810 if (dai->driver->id) 3811 dai->id = dai->driver->id; 3812 else 3813 dai->id = i; 3814 dai->dapm.dev = dev; 3815 if (!dai->driver->ops) 3816 dai->driver->ops = &null_dai_ops; 3817 3818 mutex_lock(&client_mutex); 3819 3820 list_for_each_entry(codec, &codec_list, list) { 3821 if (codec->dev == dev) { 3822 dev_dbg(dev, "ASoC: Mapped DAI %s to " 3823 "CODEC %s\n", dai->name, codec->name); 3824 dai->codec = codec; 3825 break; 3826 } 3827 } 3828 3829 if (!dai->codec) 3830 dai->dapm.idle_bias_off = 1; 3831 3832 list_add(&dai->list, &dai_list); 3833 3834 mutex_unlock(&client_mutex); 3835 3836 dev_dbg(dai->dev, "ASoC: Registered DAI '%s'\n", dai->name); 3837 } 3838 3839 return 0; 3840 3841 err: 3842 for (i--; i >= 0; i--) 3843 snd_soc_unregister_dai(dev); 3844 3845 return ret; 3846 } 3847 EXPORT_SYMBOL_GPL(snd_soc_register_dais); 3848 3849 /** 3850 * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core 3851 * 3852 * @dai: Array of DAIs to unregister 3853 * @count: Number of DAIs 3854 */ 3855 void snd_soc_unregister_dais(struct device *dev, size_t count) 3856 { 3857 int i; 3858 3859 for (i = 0; i < count; i++) 3860 snd_soc_unregister_dai(dev); 3861 } 3862 EXPORT_SYMBOL_GPL(snd_soc_unregister_dais); 3863 3864 /** 3865 * snd_soc_register_platform - Register a platform with the ASoC core 3866 * 3867 * @platform: platform to register 3868 */ 3869 int snd_soc_register_platform(struct device *dev, 3870 struct snd_soc_platform_driver *platform_drv) 3871 { 3872 struct snd_soc_platform *platform; 3873 3874 dev_dbg(dev, "ASoC: platform register %s\n", dev_name(dev)); 3875 3876 platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL); 3877 if (platform == NULL) 3878 return -ENOMEM; 3879 3880 /* create platform component name */ 3881 platform->name = fmt_single_name(dev, &platform->id); 3882 if (platform->name == NULL) { 3883 kfree(platform); 3884 return -ENOMEM; 3885 } 3886 3887 platform->dev = dev; 3888 platform->driver = platform_drv; 3889 platform->dapm.dev = dev; 3890 platform->dapm.platform = platform; 3891 platform->dapm.stream_event = platform_drv->stream_event; 3892 mutex_init(&platform->mutex); 3893 3894 mutex_lock(&client_mutex); 3895 list_add(&platform->list, &platform_list); 3896 mutex_unlock(&client_mutex); 3897 3898 dev_dbg(dev, "ASoC: Registered platform '%s'\n", platform->name); 3899 3900 return 0; 3901 } 3902 EXPORT_SYMBOL_GPL(snd_soc_register_platform); 3903 3904 /** 3905 * snd_soc_unregister_platform - Unregister a platform from the ASoC core 3906 * 3907 * @platform: platform to unregister 3908 */ 3909 void snd_soc_unregister_platform(struct device *dev) 3910 { 3911 struct snd_soc_platform *platform; 3912 3913 list_for_each_entry(platform, &platform_list, list) { 3914 if (dev == platform->dev) 3915 goto found; 3916 } 3917 return; 3918 3919 found: 3920 mutex_lock(&client_mutex); 3921 list_del(&platform->list); 3922 mutex_unlock(&client_mutex); 3923 3924 dev_dbg(dev, "ASoC: Unregistered platform '%s'\n", platform->name); 3925 kfree(platform->name); 3926 kfree(platform); 3927 } 3928 EXPORT_SYMBOL_GPL(snd_soc_unregister_platform); 3929 3930 static u64 codec_format_map[] = { 3931 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE, 3932 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE, 3933 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE, 3934 SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE, 3935 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE, 3936 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE, 3937 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE, 3938 SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE, 3939 SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE, 3940 SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE, 3941 SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE, 3942 SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE, 3943 SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE, 3944 SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE, 3945 SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE 3946 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE, 3947 }; 3948 3949 /* Fix up the DAI formats for endianness: codecs don't actually see 3950 * the endianness of the data but we're using the CPU format 3951 * definitions which do need to include endianness so we ensure that 3952 * codec DAIs always have both big and little endian variants set. 3953 */ 3954 static void fixup_codec_formats(struct snd_soc_pcm_stream *stream) 3955 { 3956 int i; 3957 3958 for (i = 0; i < ARRAY_SIZE(codec_format_map); i++) 3959 if (stream->formats & codec_format_map[i]) 3960 stream->formats |= codec_format_map[i]; 3961 } 3962 3963 /** 3964 * snd_soc_register_codec - Register a codec with the ASoC core 3965 * 3966 * @codec: codec to register 3967 */ 3968 int snd_soc_register_codec(struct device *dev, 3969 const struct snd_soc_codec_driver *codec_drv, 3970 struct snd_soc_dai_driver *dai_drv, 3971 int num_dai) 3972 { 3973 size_t reg_size; 3974 struct snd_soc_codec *codec; 3975 int ret, i; 3976 3977 dev_dbg(dev, "codec register %s\n", dev_name(dev)); 3978 3979 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL); 3980 if (codec == NULL) 3981 return -ENOMEM; 3982 3983 /* create CODEC component name */ 3984 codec->name = fmt_single_name(dev, &codec->id); 3985 if (codec->name == NULL) { 3986 kfree(codec); 3987 return -ENOMEM; 3988 } 3989 3990 if (codec_drv->compress_type) 3991 codec->compress_type = codec_drv->compress_type; 3992 else 3993 codec->compress_type = SND_SOC_FLAT_COMPRESSION; 3994 3995 codec->write = codec_drv->write; 3996 codec->read = codec_drv->read; 3997 codec->volatile_register = codec_drv->volatile_register; 3998 codec->readable_register = codec_drv->readable_register; 3999 codec->writable_register = codec_drv->writable_register; 4000 codec->ignore_pmdown_time = codec_drv->ignore_pmdown_time; 4001 codec->dapm.bias_level = SND_SOC_BIAS_OFF; 4002 codec->dapm.dev = dev; 4003 codec->dapm.codec = codec; 4004 codec->dapm.seq_notifier = codec_drv->seq_notifier; 4005 codec->dapm.stream_event = codec_drv->stream_event; 4006 codec->dev = dev; 4007 codec->driver = codec_drv; 4008 codec->num_dai = num_dai; 4009 mutex_init(&codec->mutex); 4010 4011 /* allocate CODEC register cache */ 4012 if (codec_drv->reg_cache_size && codec_drv->reg_word_size) { 4013 reg_size = codec_drv->reg_cache_size * codec_drv->reg_word_size; 4014 codec->reg_size = reg_size; 4015 /* it is necessary to make a copy of the default register cache 4016 * because in the case of using a compression type that requires 4017 * the default register cache to be marked as the 4018 * kernel might have freed the array by the time we initialize 4019 * the cache. 4020 */ 4021 if (codec_drv->reg_cache_default) { 4022 codec->reg_def_copy = kmemdup(codec_drv->reg_cache_default, 4023 reg_size, GFP_KERNEL); 4024 if (!codec->reg_def_copy) { 4025 ret = -ENOMEM; 4026 goto fail; 4027 } 4028 } 4029 } 4030 4031 if (codec_drv->reg_access_size && codec_drv->reg_access_default) { 4032 if (!codec->volatile_register) 4033 codec->volatile_register = snd_soc_default_volatile_register; 4034 if (!codec->readable_register) 4035 codec->readable_register = snd_soc_default_readable_register; 4036 if (!codec->writable_register) 4037 codec->writable_register = snd_soc_default_writable_register; 4038 } 4039 4040 for (i = 0; i < num_dai; i++) { 4041 fixup_codec_formats(&dai_drv[i].playback); 4042 fixup_codec_formats(&dai_drv[i].capture); 4043 } 4044 4045 mutex_lock(&client_mutex); 4046 list_add(&codec->list, &codec_list); 4047 mutex_unlock(&client_mutex); 4048 4049 /* register any DAIs */ 4050 if (num_dai) { 4051 ret = snd_soc_register_dais(dev, dai_drv, num_dai); 4052 if (ret < 0) 4053 dev_err(codec->dev, "ASoC: Failed to regster" 4054 " DAIs: %d\n", ret); 4055 } 4056 4057 dev_dbg(codec->dev, "ASoC: Registered codec '%s'\n", codec->name); 4058 return 0; 4059 4060 fail: 4061 kfree(codec->name); 4062 kfree(codec); 4063 return ret; 4064 } 4065 EXPORT_SYMBOL_GPL(snd_soc_register_codec); 4066 4067 /** 4068 * snd_soc_unregister_codec - Unregister a codec from the ASoC core 4069 * 4070 * @codec: codec to unregister 4071 */ 4072 void snd_soc_unregister_codec(struct device *dev) 4073 { 4074 struct snd_soc_codec *codec; 4075 int i; 4076 4077 list_for_each_entry(codec, &codec_list, list) { 4078 if (dev == codec->dev) 4079 goto found; 4080 } 4081 return; 4082 4083 found: 4084 if (codec->num_dai) 4085 for (i = 0; i < codec->num_dai; i++) 4086 snd_soc_unregister_dai(dev); 4087 4088 mutex_lock(&client_mutex); 4089 list_del(&codec->list); 4090 mutex_unlock(&client_mutex); 4091 4092 dev_dbg(codec->dev, "ASoC: Unregistered codec '%s'\n", codec->name); 4093 4094 snd_soc_cache_exit(codec); 4095 kfree(codec->reg_def_copy); 4096 kfree(codec->name); 4097 kfree(codec); 4098 } 4099 EXPORT_SYMBOL_GPL(snd_soc_unregister_codec); 4100 4101 /* Retrieve a card's name from device tree */ 4102 int snd_soc_of_parse_card_name(struct snd_soc_card *card, 4103 const char *propname) 4104 { 4105 struct device_node *np = card->dev->of_node; 4106 int ret; 4107 4108 ret = of_property_read_string_index(np, propname, 0, &card->name); 4109 /* 4110 * EINVAL means the property does not exist. This is fine providing 4111 * card->name was previously set, which is checked later in 4112 * snd_soc_register_card. 4113 */ 4114 if (ret < 0 && ret != -EINVAL) { 4115 dev_err(card->dev, 4116 "ASoC: Property '%s' could not be read: %d\n", 4117 propname, ret); 4118 return ret; 4119 } 4120 4121 return 0; 4122 } 4123 EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name); 4124 4125 int snd_soc_of_parse_audio_routing(struct snd_soc_card *card, 4126 const char *propname) 4127 { 4128 struct device_node *np = card->dev->of_node; 4129 int num_routes; 4130 struct snd_soc_dapm_route *routes; 4131 int i, ret; 4132 4133 num_routes = of_property_count_strings(np, propname); 4134 if (num_routes < 0 || num_routes & 1) { 4135 dev_err(card->dev, "ASoC: Property '%s' does not exist or its" 4136 " length is not even\n", propname); 4137 return -EINVAL; 4138 } 4139 num_routes /= 2; 4140 if (!num_routes) { 4141 dev_err(card->dev, "ASoC: Property '%s's length is zero\n", 4142 propname); 4143 return -EINVAL; 4144 } 4145 4146 routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes), 4147 GFP_KERNEL); 4148 if (!routes) { 4149 dev_err(card->dev, 4150 "ASoC: Could not allocate DAPM route table\n"); 4151 return -EINVAL; 4152 } 4153 4154 for (i = 0; i < num_routes; i++) { 4155 ret = of_property_read_string_index(np, propname, 4156 2 * i, &routes[i].sink); 4157 if (ret) { 4158 dev_err(card->dev, "ASoC: Property '%s' index %d" 4159 " could not be read: %d\n", propname, 2 * i, 4160 ret); 4161 kfree(routes); 4162 return -EINVAL; 4163 } 4164 ret = of_property_read_string_index(np, propname, 4165 (2 * i) + 1, &routes[i].source); 4166 if (ret) { 4167 dev_err(card->dev, 4168 "ASoC: Property '%s' index %d could not be" 4169 " read: %d\n", propname, (2 * i) + 1, ret); 4170 kfree(routes); 4171 return -EINVAL; 4172 } 4173 } 4174 4175 card->num_dapm_routes = num_routes; 4176 card->dapm_routes = routes; 4177 4178 return 0; 4179 } 4180 EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing); 4181 4182 static int __init snd_soc_init(void) 4183 { 4184 #ifdef CONFIG_DEBUG_FS 4185 snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL); 4186 if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) { 4187 pr_warn("ASoC: Failed to create debugfs directory\n"); 4188 snd_soc_debugfs_root = NULL; 4189 } 4190 4191 if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL, 4192 &codec_list_fops)) 4193 pr_warn("ASoC: Failed to create CODEC list debugfs file\n"); 4194 4195 if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL, 4196 &dai_list_fops)) 4197 pr_warn("ASoC: Failed to create DAI list debugfs file\n"); 4198 4199 if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL, 4200 &platform_list_fops)) 4201 pr_warn("ASoC: Failed to create platform list debugfs file\n"); 4202 #endif 4203 4204 snd_soc_util_init(); 4205 4206 return platform_driver_register(&soc_driver); 4207 } 4208 module_init(snd_soc_init); 4209 4210 static void __exit snd_soc_exit(void) 4211 { 4212 snd_soc_util_exit(); 4213 4214 #ifdef CONFIG_DEBUG_FS 4215 debugfs_remove_recursive(snd_soc_debugfs_root); 4216 #endif 4217 platform_driver_unregister(&soc_driver); 4218 } 4219 module_exit(snd_soc_exit); 4220 4221 /* Module information */ 4222 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk"); 4223 MODULE_DESCRIPTION("ALSA SoC Core"); 4224 MODULE_LICENSE("GPL"); 4225 MODULE_ALIAS("platform:soc-audio"); 4226