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