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