1 /* 2 * soc-dapm.c -- ALSA SoC Dynamic Audio Power Management 3 * 4 * Copyright 2005 Wolfson Microelectronics PLC. 5 * Author: Liam Girdwood <lrg@slimlogic.co.uk> 6 * 7 * This program is free software; you can redistribute it and/or modify it 8 * under the terms of the GNU General Public License as published by the 9 * Free Software Foundation; either version 2 of the License, or (at your 10 * option) any later version. 11 * 12 * Features: 13 * o Changes power status of internal codec blocks depending on the 14 * dynamic configuration of codec internal audio paths and active 15 * DACs/ADCs. 16 * o Platform power domain - can support external components i.e. amps and 17 * mic/headphone insertion events. 18 * o Automatic Mic Bias support 19 * o Jack insertion power event initiation - e.g. hp insertion will enable 20 * sinks, dacs, etc 21 * o Delayed power down of audio subsystem to reduce pops between a quick 22 * device reopen. 23 * 24 */ 25 26 #include <linux/module.h> 27 #include <linux/moduleparam.h> 28 #include <linux/init.h> 29 #include <linux/async.h> 30 #include <linux/delay.h> 31 #include <linux/pm.h> 32 #include <linux/bitops.h> 33 #include <linux/platform_device.h> 34 #include <linux/jiffies.h> 35 #include <linux/debugfs.h> 36 #include <linux/pm_runtime.h> 37 #include <linux/regulator/consumer.h> 38 #include <linux/clk.h> 39 #include <linux/slab.h> 40 #include <sound/core.h> 41 #include <sound/pcm.h> 42 #include <sound/pcm_params.h> 43 #include <sound/soc.h> 44 #include <sound/initval.h> 45 46 #include <trace/events/asoc.h> 47 48 #define DAPM_UPDATE_STAT(widget, val) widget->dapm->card->dapm_stats.val++; 49 50 static int snd_soc_dapm_add_path(struct snd_soc_dapm_context *dapm, 51 struct snd_soc_dapm_widget *wsource, struct snd_soc_dapm_widget *wsink, 52 const char *control, 53 int (*connected)(struct snd_soc_dapm_widget *source, 54 struct snd_soc_dapm_widget *sink)); 55 static struct snd_soc_dapm_widget * 56 snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm, 57 const struct snd_soc_dapm_widget *widget); 58 59 /* dapm power sequences - make this per codec in the future */ 60 static int dapm_up_seq[] = { 61 [snd_soc_dapm_pre] = 0, 62 [snd_soc_dapm_regulator_supply] = 1, 63 [snd_soc_dapm_clock_supply] = 1, 64 [snd_soc_dapm_supply] = 2, 65 [snd_soc_dapm_micbias] = 3, 66 [snd_soc_dapm_dai_link] = 2, 67 [snd_soc_dapm_dai_in] = 4, 68 [snd_soc_dapm_dai_out] = 4, 69 [snd_soc_dapm_aif_in] = 4, 70 [snd_soc_dapm_aif_out] = 4, 71 [snd_soc_dapm_mic] = 5, 72 [snd_soc_dapm_mux] = 6, 73 [snd_soc_dapm_dac] = 7, 74 [snd_soc_dapm_switch] = 8, 75 [snd_soc_dapm_mixer] = 8, 76 [snd_soc_dapm_mixer_named_ctl] = 8, 77 [snd_soc_dapm_pga] = 9, 78 [snd_soc_dapm_adc] = 10, 79 [snd_soc_dapm_out_drv] = 11, 80 [snd_soc_dapm_hp] = 11, 81 [snd_soc_dapm_spk] = 11, 82 [snd_soc_dapm_line] = 11, 83 [snd_soc_dapm_kcontrol] = 12, 84 [snd_soc_dapm_post] = 13, 85 }; 86 87 static int dapm_down_seq[] = { 88 [snd_soc_dapm_pre] = 0, 89 [snd_soc_dapm_kcontrol] = 1, 90 [snd_soc_dapm_adc] = 2, 91 [snd_soc_dapm_hp] = 3, 92 [snd_soc_dapm_spk] = 3, 93 [snd_soc_dapm_line] = 3, 94 [snd_soc_dapm_out_drv] = 3, 95 [snd_soc_dapm_pga] = 4, 96 [snd_soc_dapm_switch] = 5, 97 [snd_soc_dapm_mixer_named_ctl] = 5, 98 [snd_soc_dapm_mixer] = 5, 99 [snd_soc_dapm_dac] = 6, 100 [snd_soc_dapm_mic] = 7, 101 [snd_soc_dapm_micbias] = 8, 102 [snd_soc_dapm_mux] = 9, 103 [snd_soc_dapm_aif_in] = 10, 104 [snd_soc_dapm_aif_out] = 10, 105 [snd_soc_dapm_dai_in] = 10, 106 [snd_soc_dapm_dai_out] = 10, 107 [snd_soc_dapm_dai_link] = 11, 108 [snd_soc_dapm_supply] = 12, 109 [snd_soc_dapm_clock_supply] = 13, 110 [snd_soc_dapm_regulator_supply] = 13, 111 [snd_soc_dapm_post] = 14, 112 }; 113 114 static void dapm_assert_locked(struct snd_soc_dapm_context *dapm) 115 { 116 if (dapm->card && dapm->card->instantiated) 117 lockdep_assert_held(&dapm->card->dapm_mutex); 118 } 119 120 static void pop_wait(u32 pop_time) 121 { 122 if (pop_time) 123 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time)); 124 } 125 126 static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...) 127 { 128 va_list args; 129 char *buf; 130 131 if (!pop_time) 132 return; 133 134 buf = kmalloc(PAGE_SIZE, GFP_KERNEL); 135 if (buf == NULL) 136 return; 137 138 va_start(args, fmt); 139 vsnprintf(buf, PAGE_SIZE, fmt, args); 140 dev_info(dev, "%s", buf); 141 va_end(args); 142 143 kfree(buf); 144 } 145 146 static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w) 147 { 148 return !list_empty(&w->dirty); 149 } 150 151 static void dapm_mark_dirty(struct snd_soc_dapm_widget *w, const char *reason) 152 { 153 dapm_assert_locked(w->dapm); 154 155 if (!dapm_dirty_widget(w)) { 156 dev_vdbg(w->dapm->dev, "Marking %s dirty due to %s\n", 157 w->name, reason); 158 list_add_tail(&w->dirty, &w->dapm->card->dapm_dirty); 159 } 160 } 161 162 /* 163 * dapm_widget_invalidate_input_paths() - Invalidate the cached number of input 164 * paths 165 * @w: The widget for which to invalidate the cached number of input paths 166 * 167 * The function resets the cached number of inputs for the specified widget and 168 * all widgets that can be reached via outgoing paths from the widget. 169 * 170 * This function must be called if the number of input paths for a widget might 171 * have changed. E.g. if the source state of a widget changes or a path is added 172 * or activated with the widget as the sink. 173 */ 174 static void dapm_widget_invalidate_input_paths(struct snd_soc_dapm_widget *w) 175 { 176 struct snd_soc_dapm_widget *sink; 177 struct snd_soc_dapm_path *p; 178 LIST_HEAD(list); 179 180 dapm_assert_locked(w->dapm); 181 182 if (w->inputs == -1) 183 return; 184 185 w->inputs = -1; 186 list_add_tail(&w->work_list, &list); 187 188 list_for_each_entry(w, &list, work_list) { 189 list_for_each_entry(p, &w->sinks, list_source) { 190 if (p->is_supply || p->weak || !p->connect) 191 continue; 192 sink = p->sink; 193 if (sink->inputs != -1) { 194 sink->inputs = -1; 195 list_add_tail(&sink->work_list, &list); 196 } 197 } 198 } 199 } 200 201 /* 202 * dapm_widget_invalidate_output_paths() - Invalidate the cached number of 203 * output paths 204 * @w: The widget for which to invalidate the cached number of output paths 205 * 206 * Resets the cached number of outputs for the specified widget and all widgets 207 * that can be reached via incoming paths from the widget. 208 * 209 * This function must be called if the number of output paths for a widget might 210 * have changed. E.g. if the sink state of a widget changes or a path is added 211 * or activated with the widget as the source. 212 */ 213 static void dapm_widget_invalidate_output_paths(struct snd_soc_dapm_widget *w) 214 { 215 struct snd_soc_dapm_widget *source; 216 struct snd_soc_dapm_path *p; 217 LIST_HEAD(list); 218 219 dapm_assert_locked(w->dapm); 220 221 if (w->outputs == -1) 222 return; 223 224 w->outputs = -1; 225 list_add_tail(&w->work_list, &list); 226 227 list_for_each_entry(w, &list, work_list) { 228 list_for_each_entry(p, &w->sources, list_sink) { 229 if (p->is_supply || p->weak || !p->connect) 230 continue; 231 source = p->source; 232 if (source->outputs != -1) { 233 source->outputs = -1; 234 list_add_tail(&source->work_list, &list); 235 } 236 } 237 } 238 } 239 240 /* 241 * dapm_path_invalidate() - Invalidates the cached number of inputs and outputs 242 * for the widgets connected to a path 243 * @p: The path to invalidate 244 * 245 * Resets the cached number of inputs for the sink of the path and the cached 246 * number of outputs for the source of the path. 247 * 248 * This function must be called when a path is added, removed or the connected 249 * state changes. 250 */ 251 static void dapm_path_invalidate(struct snd_soc_dapm_path *p) 252 { 253 /* 254 * Weak paths or supply paths do not influence the number of input or 255 * output paths of their neighbors. 256 */ 257 if (p->weak || p->is_supply) 258 return; 259 260 /* 261 * The number of connected endpoints is the sum of the number of 262 * connected endpoints of all neighbors. If a node with 0 connected 263 * endpoints is either connected or disconnected that sum won't change, 264 * so there is no need to re-check the path. 265 */ 266 if (p->source->inputs != 0) 267 dapm_widget_invalidate_input_paths(p->sink); 268 if (p->sink->outputs != 0) 269 dapm_widget_invalidate_output_paths(p->source); 270 } 271 272 void dapm_mark_endpoints_dirty(struct snd_soc_card *card) 273 { 274 struct snd_soc_dapm_widget *w; 275 276 mutex_lock(&card->dapm_mutex); 277 278 list_for_each_entry(w, &card->widgets, list) { 279 if (w->is_sink || w->is_source) { 280 dapm_mark_dirty(w, "Rechecking endpoints"); 281 if (w->is_sink) 282 dapm_widget_invalidate_output_paths(w); 283 if (w->is_source) 284 dapm_widget_invalidate_input_paths(w); 285 } 286 } 287 288 mutex_unlock(&card->dapm_mutex); 289 } 290 EXPORT_SYMBOL_GPL(dapm_mark_endpoints_dirty); 291 292 /* create a new dapm widget */ 293 static inline struct snd_soc_dapm_widget *dapm_cnew_widget( 294 const struct snd_soc_dapm_widget *_widget) 295 { 296 return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL); 297 } 298 299 struct dapm_kcontrol_data { 300 unsigned int value; 301 struct snd_soc_dapm_widget *widget; 302 struct list_head paths; 303 struct snd_soc_dapm_widget_list *wlist; 304 }; 305 306 static int dapm_kcontrol_data_alloc(struct snd_soc_dapm_widget *widget, 307 struct snd_kcontrol *kcontrol) 308 { 309 struct dapm_kcontrol_data *data; 310 struct soc_mixer_control *mc; 311 312 data = kzalloc(sizeof(*data), GFP_KERNEL); 313 if (!data) { 314 dev_err(widget->dapm->dev, 315 "ASoC: can't allocate kcontrol data for %s\n", 316 widget->name); 317 return -ENOMEM; 318 } 319 320 INIT_LIST_HEAD(&data->paths); 321 322 switch (widget->id) { 323 case snd_soc_dapm_switch: 324 case snd_soc_dapm_mixer: 325 case snd_soc_dapm_mixer_named_ctl: 326 mc = (struct soc_mixer_control *)kcontrol->private_value; 327 328 if (mc->autodisable) { 329 struct snd_soc_dapm_widget template; 330 331 memset(&template, 0, sizeof(template)); 332 template.reg = mc->reg; 333 template.mask = (1 << fls(mc->max)) - 1; 334 template.shift = mc->shift; 335 if (mc->invert) 336 template.off_val = mc->max; 337 else 338 template.off_val = 0; 339 template.on_val = template.off_val; 340 template.id = snd_soc_dapm_kcontrol; 341 template.name = kcontrol->id.name; 342 343 data->value = template.on_val; 344 345 data->widget = snd_soc_dapm_new_control(widget->dapm, 346 &template); 347 if (!data->widget) { 348 kfree(data); 349 return -ENOMEM; 350 } 351 } 352 break; 353 default: 354 break; 355 } 356 357 kcontrol->private_data = data; 358 359 return 0; 360 } 361 362 static void dapm_kcontrol_free(struct snd_kcontrol *kctl) 363 { 364 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kctl); 365 kfree(data->wlist); 366 kfree(data); 367 } 368 369 static struct snd_soc_dapm_widget_list *dapm_kcontrol_get_wlist( 370 const struct snd_kcontrol *kcontrol) 371 { 372 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol); 373 374 return data->wlist; 375 } 376 377 static int dapm_kcontrol_add_widget(struct snd_kcontrol *kcontrol, 378 struct snd_soc_dapm_widget *widget) 379 { 380 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol); 381 struct snd_soc_dapm_widget_list *new_wlist; 382 unsigned int n; 383 384 if (data->wlist) 385 n = data->wlist->num_widgets + 1; 386 else 387 n = 1; 388 389 new_wlist = krealloc(data->wlist, 390 sizeof(*new_wlist) + sizeof(widget) * n, GFP_KERNEL); 391 if (!new_wlist) 392 return -ENOMEM; 393 394 new_wlist->widgets[n - 1] = widget; 395 new_wlist->num_widgets = n; 396 397 data->wlist = new_wlist; 398 399 return 0; 400 } 401 402 static void dapm_kcontrol_add_path(const struct snd_kcontrol *kcontrol, 403 struct snd_soc_dapm_path *path) 404 { 405 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol); 406 407 list_add_tail(&path->list_kcontrol, &data->paths); 408 409 if (data->widget) { 410 snd_soc_dapm_add_path(data->widget->dapm, data->widget, 411 path->source, NULL, NULL); 412 } 413 } 414 415 static bool dapm_kcontrol_is_powered(const struct snd_kcontrol *kcontrol) 416 { 417 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol); 418 419 if (!data->widget) 420 return true; 421 422 return data->widget->power; 423 } 424 425 static struct list_head *dapm_kcontrol_get_path_list( 426 const struct snd_kcontrol *kcontrol) 427 { 428 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol); 429 430 return &data->paths; 431 } 432 433 #define dapm_kcontrol_for_each_path(path, kcontrol) \ 434 list_for_each_entry(path, dapm_kcontrol_get_path_list(kcontrol), \ 435 list_kcontrol) 436 437 unsigned int dapm_kcontrol_get_value(const struct snd_kcontrol *kcontrol) 438 { 439 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol); 440 441 return data->value; 442 } 443 EXPORT_SYMBOL_GPL(dapm_kcontrol_get_value); 444 445 static bool dapm_kcontrol_set_value(const struct snd_kcontrol *kcontrol, 446 unsigned int value) 447 { 448 struct dapm_kcontrol_data *data = snd_kcontrol_chip(kcontrol); 449 450 if (data->value == value) 451 return false; 452 453 if (data->widget) 454 data->widget->on_val = value; 455 456 data->value = value; 457 458 return true; 459 } 460 461 /** 462 * snd_soc_dapm_kcontrol_dapm() - Returns the dapm context associated to a 463 * kcontrol 464 * @kcontrol: The kcontrol 465 * 466 * Note: This function must only be used on kcontrols that are known to have 467 * been registered for a CODEC. Otherwise the behaviour is undefined. 468 */ 469 struct snd_soc_dapm_context *snd_soc_dapm_kcontrol_dapm( 470 struct snd_kcontrol *kcontrol) 471 { 472 return dapm_kcontrol_get_wlist(kcontrol)->widgets[0]->dapm; 473 } 474 EXPORT_SYMBOL_GPL(snd_soc_dapm_kcontrol_dapm); 475 476 static void dapm_reset(struct snd_soc_card *card) 477 { 478 struct snd_soc_dapm_widget *w; 479 480 lockdep_assert_held(&card->dapm_mutex); 481 482 memset(&card->dapm_stats, 0, sizeof(card->dapm_stats)); 483 484 list_for_each_entry(w, &card->widgets, list) { 485 w->new_power = w->power; 486 w->power_checked = false; 487 } 488 } 489 490 static const char *soc_dapm_prefix(struct snd_soc_dapm_context *dapm) 491 { 492 if (!dapm->component) 493 return NULL; 494 return dapm->component->name_prefix; 495 } 496 497 static int soc_dapm_read(struct snd_soc_dapm_context *dapm, int reg, 498 unsigned int *value) 499 { 500 if (!dapm->component) 501 return -EIO; 502 return snd_soc_component_read(dapm->component, reg, value); 503 } 504 505 static int soc_dapm_update_bits(struct snd_soc_dapm_context *dapm, 506 int reg, unsigned int mask, unsigned int value) 507 { 508 if (!dapm->component) 509 return -EIO; 510 return snd_soc_component_update_bits(dapm->component, reg, 511 mask, value); 512 } 513 514 static int soc_dapm_test_bits(struct snd_soc_dapm_context *dapm, 515 int reg, unsigned int mask, unsigned int value) 516 { 517 if (!dapm->component) 518 return -EIO; 519 return snd_soc_component_test_bits(dapm->component, reg, mask, value); 520 } 521 522 static void soc_dapm_async_complete(struct snd_soc_dapm_context *dapm) 523 { 524 if (dapm->component) 525 snd_soc_component_async_complete(dapm->component); 526 } 527 528 /** 529 * snd_soc_dapm_set_bias_level - set the bias level for the system 530 * @dapm: DAPM context 531 * @level: level to configure 532 * 533 * Configure the bias (power) levels for the SoC audio device. 534 * 535 * Returns 0 for success else error. 536 */ 537 static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm, 538 enum snd_soc_bias_level level) 539 { 540 struct snd_soc_card *card = dapm->card; 541 int ret = 0; 542 543 trace_snd_soc_bias_level_start(card, level); 544 545 if (card && card->set_bias_level) 546 ret = card->set_bias_level(card, dapm, level); 547 if (ret != 0) 548 goto out; 549 550 if (dapm->set_bias_level) 551 ret = dapm->set_bias_level(dapm, level); 552 else if (!card || dapm != &card->dapm) 553 dapm->bias_level = level; 554 555 if (ret != 0) 556 goto out; 557 558 if (card && card->set_bias_level_post) 559 ret = card->set_bias_level_post(card, dapm, level); 560 out: 561 trace_snd_soc_bias_level_done(card, level); 562 563 return ret; 564 } 565 566 /* connect mux widget to its interconnecting audio paths */ 567 static int dapm_connect_mux(struct snd_soc_dapm_context *dapm, 568 struct snd_soc_dapm_path *path, const char *control_name) 569 { 570 const struct snd_kcontrol_new *kcontrol = &path->sink->kcontrol_news[0]; 571 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 572 unsigned int val, item; 573 int i; 574 575 if (e->reg != SND_SOC_NOPM) { 576 soc_dapm_read(dapm, e->reg, &val); 577 val = (val >> e->shift_l) & e->mask; 578 item = snd_soc_enum_val_to_item(e, val); 579 } else { 580 /* since a virtual mux has no backing registers to 581 * decide which path to connect, it will try to match 582 * with the first enumeration. This is to ensure 583 * that the default mux choice (the first) will be 584 * correctly powered up during initialization. 585 */ 586 item = 0; 587 } 588 589 for (i = 0; i < e->items; i++) { 590 if (!(strcmp(control_name, e->texts[i]))) { 591 path->name = e->texts[i]; 592 if (i == item) 593 path->connect = 1; 594 else 595 path->connect = 0; 596 return 0; 597 } 598 } 599 600 return -ENODEV; 601 } 602 603 /* set up initial codec paths */ 604 static void dapm_set_mixer_path_status(struct snd_soc_dapm_path *p, int i) 605 { 606 struct soc_mixer_control *mc = (struct soc_mixer_control *) 607 p->sink->kcontrol_news[i].private_value; 608 unsigned int reg = mc->reg; 609 unsigned int shift = mc->shift; 610 unsigned int max = mc->max; 611 unsigned int mask = (1 << fls(max)) - 1; 612 unsigned int invert = mc->invert; 613 unsigned int val; 614 615 if (reg != SND_SOC_NOPM) { 616 soc_dapm_read(p->sink->dapm, reg, &val); 617 val = (val >> shift) & mask; 618 if (invert) 619 val = max - val; 620 p->connect = !!val; 621 } else { 622 p->connect = 0; 623 } 624 } 625 626 /* connect mixer widget to its interconnecting audio paths */ 627 static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm, 628 struct snd_soc_dapm_path *path, const char *control_name) 629 { 630 int i; 631 632 /* search for mixer kcontrol */ 633 for (i = 0; i < path->sink->num_kcontrols; i++) { 634 if (!strcmp(control_name, path->sink->kcontrol_news[i].name)) { 635 path->name = path->sink->kcontrol_news[i].name; 636 dapm_set_mixer_path_status(path, i); 637 return 0; 638 } 639 } 640 return -ENODEV; 641 } 642 643 static int dapm_is_shared_kcontrol(struct snd_soc_dapm_context *dapm, 644 struct snd_soc_dapm_widget *kcontrolw, 645 const struct snd_kcontrol_new *kcontrol_new, 646 struct snd_kcontrol **kcontrol) 647 { 648 struct snd_soc_dapm_widget *w; 649 int i; 650 651 *kcontrol = NULL; 652 653 list_for_each_entry(w, &dapm->card->widgets, list) { 654 if (w == kcontrolw || w->dapm != kcontrolw->dapm) 655 continue; 656 for (i = 0; i < w->num_kcontrols; i++) { 657 if (&w->kcontrol_news[i] == kcontrol_new) { 658 if (w->kcontrols) 659 *kcontrol = w->kcontrols[i]; 660 return 1; 661 } 662 } 663 } 664 665 return 0; 666 } 667 668 /* 669 * Determine if a kcontrol is shared. If it is, look it up. If it isn't, 670 * create it. Either way, add the widget into the control's widget list 671 */ 672 static int dapm_create_or_share_mixmux_kcontrol(struct snd_soc_dapm_widget *w, 673 int kci) 674 { 675 struct snd_soc_dapm_context *dapm = w->dapm; 676 struct snd_card *card = dapm->card->snd_card; 677 const char *prefix; 678 size_t prefix_len; 679 int shared; 680 struct snd_kcontrol *kcontrol; 681 bool wname_in_long_name, kcname_in_long_name; 682 char *long_name = NULL; 683 const char *name; 684 int ret = 0; 685 686 prefix = soc_dapm_prefix(dapm); 687 if (prefix) 688 prefix_len = strlen(prefix) + 1; 689 else 690 prefix_len = 0; 691 692 shared = dapm_is_shared_kcontrol(dapm, w, &w->kcontrol_news[kci], 693 &kcontrol); 694 695 if (!kcontrol) { 696 if (shared) { 697 wname_in_long_name = false; 698 kcname_in_long_name = true; 699 } else { 700 switch (w->id) { 701 case snd_soc_dapm_switch: 702 case snd_soc_dapm_mixer: 703 wname_in_long_name = true; 704 kcname_in_long_name = true; 705 break; 706 case snd_soc_dapm_mixer_named_ctl: 707 wname_in_long_name = false; 708 kcname_in_long_name = true; 709 break; 710 case snd_soc_dapm_mux: 711 wname_in_long_name = true; 712 kcname_in_long_name = false; 713 break; 714 default: 715 return -EINVAL; 716 } 717 } 718 719 if (wname_in_long_name && kcname_in_long_name) { 720 /* 721 * The control will get a prefix from the control 722 * creation process but we're also using the same 723 * prefix for widgets so cut the prefix off the 724 * front of the widget name. 725 */ 726 long_name = kasprintf(GFP_KERNEL, "%s %s", 727 w->name + prefix_len, 728 w->kcontrol_news[kci].name); 729 if (long_name == NULL) 730 return -ENOMEM; 731 732 name = long_name; 733 } else if (wname_in_long_name) { 734 long_name = NULL; 735 name = w->name + prefix_len; 736 } else { 737 long_name = NULL; 738 name = w->kcontrol_news[kci].name; 739 } 740 741 kcontrol = snd_soc_cnew(&w->kcontrol_news[kci], NULL, name, 742 prefix); 743 if (!kcontrol) { 744 ret = -ENOMEM; 745 goto exit_free; 746 } 747 748 kcontrol->private_free = dapm_kcontrol_free; 749 750 ret = dapm_kcontrol_data_alloc(w, kcontrol); 751 if (ret) { 752 snd_ctl_free_one(kcontrol); 753 goto exit_free; 754 } 755 756 ret = snd_ctl_add(card, kcontrol); 757 if (ret < 0) { 758 dev_err(dapm->dev, 759 "ASoC: failed to add widget %s dapm kcontrol %s: %d\n", 760 w->name, name, ret); 761 goto exit_free; 762 } 763 } 764 765 ret = dapm_kcontrol_add_widget(kcontrol, w); 766 if (ret == 0) 767 w->kcontrols[kci] = kcontrol; 768 769 exit_free: 770 kfree(long_name); 771 772 return ret; 773 } 774 775 /* create new dapm mixer control */ 776 static int dapm_new_mixer(struct snd_soc_dapm_widget *w) 777 { 778 int i, ret; 779 struct snd_soc_dapm_path *path; 780 781 /* add kcontrol */ 782 for (i = 0; i < w->num_kcontrols; i++) { 783 /* match name */ 784 list_for_each_entry(path, &w->sources, list_sink) { 785 /* mixer/mux paths name must match control name */ 786 if (path->name != (char *)w->kcontrol_news[i].name) 787 continue; 788 789 if (w->kcontrols[i]) { 790 dapm_kcontrol_add_path(w->kcontrols[i], path); 791 continue; 792 } 793 794 ret = dapm_create_or_share_mixmux_kcontrol(w, i); 795 if (ret < 0) 796 return ret; 797 798 dapm_kcontrol_add_path(w->kcontrols[i], path); 799 } 800 } 801 802 return 0; 803 } 804 805 /* create new dapm mux control */ 806 static int dapm_new_mux(struct snd_soc_dapm_widget *w) 807 { 808 struct snd_soc_dapm_context *dapm = w->dapm; 809 struct snd_soc_dapm_path *path; 810 int ret; 811 812 if (w->num_kcontrols != 1) { 813 dev_err(dapm->dev, 814 "ASoC: mux %s has incorrect number of controls\n", 815 w->name); 816 return -EINVAL; 817 } 818 819 if (list_empty(&w->sources)) { 820 dev_err(dapm->dev, "ASoC: mux %s has no paths\n", w->name); 821 return -EINVAL; 822 } 823 824 ret = dapm_create_or_share_mixmux_kcontrol(w, 0); 825 if (ret < 0) 826 return ret; 827 828 list_for_each_entry(path, &w->sources, list_sink) { 829 if (path->name) 830 dapm_kcontrol_add_path(w->kcontrols[0], path); 831 } 832 833 return 0; 834 } 835 836 /* create new dapm volume control */ 837 static int dapm_new_pga(struct snd_soc_dapm_widget *w) 838 { 839 if (w->num_kcontrols) 840 dev_err(w->dapm->dev, 841 "ASoC: PGA controls not supported: '%s'\n", w->name); 842 843 return 0; 844 } 845 846 /* create new dapm dai link control */ 847 static int dapm_new_dai_link(struct snd_soc_dapm_widget *w) 848 { 849 int i, ret; 850 struct snd_kcontrol *kcontrol; 851 struct snd_soc_dapm_context *dapm = w->dapm; 852 struct snd_card *card = dapm->card->snd_card; 853 854 /* create control for links with > 1 config */ 855 if (w->num_params <= 1) 856 return 0; 857 858 /* add kcontrol */ 859 for (i = 0; i < w->num_kcontrols; i++) { 860 kcontrol = snd_soc_cnew(&w->kcontrol_news[i], w, 861 w->name, NULL); 862 ret = snd_ctl_add(card, kcontrol); 863 if (ret < 0) { 864 dev_err(dapm->dev, 865 "ASoC: failed to add widget %s dapm kcontrol %s: %d\n", 866 w->name, w->kcontrol_news[i].name, ret); 867 return ret; 868 } 869 kcontrol->private_data = w; 870 w->kcontrols[i] = kcontrol; 871 } 872 873 return 0; 874 } 875 876 /* We implement power down on suspend by checking the power state of 877 * the ALSA card - when we are suspending the ALSA state for the card 878 * is set to D3. 879 */ 880 static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget) 881 { 882 int level = snd_power_get_state(widget->dapm->card->snd_card); 883 884 switch (level) { 885 case SNDRV_CTL_POWER_D3hot: 886 case SNDRV_CTL_POWER_D3cold: 887 if (widget->ignore_suspend) 888 dev_dbg(widget->dapm->dev, "ASoC: %s ignoring suspend\n", 889 widget->name); 890 return widget->ignore_suspend; 891 default: 892 return 1; 893 } 894 } 895 896 /* add widget to list if it's not already in the list */ 897 static int dapm_list_add_widget(struct snd_soc_dapm_widget_list **list, 898 struct snd_soc_dapm_widget *w) 899 { 900 struct snd_soc_dapm_widget_list *wlist; 901 int wlistsize, wlistentries, i; 902 903 if (*list == NULL) 904 return -EINVAL; 905 906 wlist = *list; 907 908 /* is this widget already in the list */ 909 for (i = 0; i < wlist->num_widgets; i++) { 910 if (wlist->widgets[i] == w) 911 return 0; 912 } 913 914 /* allocate some new space */ 915 wlistentries = wlist->num_widgets + 1; 916 wlistsize = sizeof(struct snd_soc_dapm_widget_list) + 917 wlistentries * sizeof(struct snd_soc_dapm_widget *); 918 *list = krealloc(wlist, wlistsize, GFP_KERNEL); 919 if (*list == NULL) { 920 dev_err(w->dapm->dev, "ASoC: can't allocate widget list for %s\n", 921 w->name); 922 return -ENOMEM; 923 } 924 wlist = *list; 925 926 /* insert the widget */ 927 dev_dbg(w->dapm->dev, "ASoC: added %s in widget list pos %d\n", 928 w->name, wlist->num_widgets); 929 930 wlist->widgets[wlist->num_widgets] = w; 931 wlist->num_widgets++; 932 return 1; 933 } 934 935 /* 936 * Recursively check for a completed path to an active or physically connected 937 * output widget. Returns number of complete paths. 938 */ 939 static int is_connected_output_ep(struct snd_soc_dapm_widget *widget, 940 struct snd_soc_dapm_widget_list **list) 941 { 942 struct snd_soc_dapm_path *path; 943 int con = 0; 944 945 if (widget->outputs >= 0) 946 return widget->outputs; 947 948 DAPM_UPDATE_STAT(widget, path_checks); 949 950 if (widget->is_sink && widget->connected) { 951 widget->outputs = snd_soc_dapm_suspend_check(widget); 952 return widget->outputs; 953 } 954 955 list_for_each_entry(path, &widget->sinks, list_source) { 956 DAPM_UPDATE_STAT(widget, neighbour_checks); 957 958 if (path->weak || path->is_supply) 959 continue; 960 961 if (path->walking) 962 return 1; 963 964 trace_snd_soc_dapm_output_path(widget, path); 965 966 if (path->connect) { 967 path->walking = 1; 968 969 /* do we need to add this widget to the list ? */ 970 if (list) { 971 int err; 972 err = dapm_list_add_widget(list, path->sink); 973 if (err < 0) { 974 dev_err(widget->dapm->dev, 975 "ASoC: could not add widget %s\n", 976 widget->name); 977 path->walking = 0; 978 return con; 979 } 980 } 981 982 con += is_connected_output_ep(path->sink, list); 983 984 path->walking = 0; 985 } 986 } 987 988 widget->outputs = con; 989 990 return con; 991 } 992 993 /* 994 * Recursively check for a completed path to an active or physically connected 995 * input widget. Returns number of complete paths. 996 */ 997 static int is_connected_input_ep(struct snd_soc_dapm_widget *widget, 998 struct snd_soc_dapm_widget_list **list) 999 { 1000 struct snd_soc_dapm_path *path; 1001 int con = 0; 1002 1003 if (widget->inputs >= 0) 1004 return widget->inputs; 1005 1006 DAPM_UPDATE_STAT(widget, path_checks); 1007 1008 if (widget->is_source && widget->connected) { 1009 widget->inputs = snd_soc_dapm_suspend_check(widget); 1010 return widget->inputs; 1011 } 1012 1013 list_for_each_entry(path, &widget->sources, list_sink) { 1014 DAPM_UPDATE_STAT(widget, neighbour_checks); 1015 1016 if (path->weak || path->is_supply) 1017 continue; 1018 1019 if (path->walking) 1020 return 1; 1021 1022 trace_snd_soc_dapm_input_path(widget, path); 1023 1024 if (path->connect) { 1025 path->walking = 1; 1026 1027 /* do we need to add this widget to the list ? */ 1028 if (list) { 1029 int err; 1030 err = dapm_list_add_widget(list, path->source); 1031 if (err < 0) { 1032 dev_err(widget->dapm->dev, 1033 "ASoC: could not add widget %s\n", 1034 widget->name); 1035 path->walking = 0; 1036 return con; 1037 } 1038 } 1039 1040 con += is_connected_input_ep(path->source, list); 1041 1042 path->walking = 0; 1043 } 1044 } 1045 1046 widget->inputs = con; 1047 1048 return con; 1049 } 1050 1051 /** 1052 * snd_soc_dapm_get_connected_widgets - query audio path and it's widgets. 1053 * @dai: the soc DAI. 1054 * @stream: stream direction. 1055 * @list: list of active widgets for this stream. 1056 * 1057 * Queries DAPM graph as to whether an valid audio stream path exists for 1058 * the initial stream specified by name. This takes into account 1059 * current mixer and mux kcontrol settings. Creates list of valid widgets. 1060 * 1061 * Returns the number of valid paths or negative error. 1062 */ 1063 int snd_soc_dapm_dai_get_connected_widgets(struct snd_soc_dai *dai, int stream, 1064 struct snd_soc_dapm_widget_list **list) 1065 { 1066 struct snd_soc_card *card = dai->component->card; 1067 struct snd_soc_dapm_widget *w; 1068 int paths; 1069 1070 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 1071 1072 /* 1073 * For is_connected_{output,input}_ep fully discover the graph we need 1074 * to reset the cached number of inputs and outputs. 1075 */ 1076 list_for_each_entry(w, &card->widgets, list) { 1077 w->inputs = -1; 1078 w->outputs = -1; 1079 } 1080 1081 if (stream == SNDRV_PCM_STREAM_PLAYBACK) 1082 paths = is_connected_output_ep(dai->playback_widget, list); 1083 else 1084 paths = is_connected_input_ep(dai->capture_widget, list); 1085 1086 trace_snd_soc_dapm_connected(paths, stream); 1087 mutex_unlock(&card->dapm_mutex); 1088 1089 return paths; 1090 } 1091 1092 /* 1093 * Handler for regulator supply widget. 1094 */ 1095 int dapm_regulator_event(struct snd_soc_dapm_widget *w, 1096 struct snd_kcontrol *kcontrol, int event) 1097 { 1098 int ret; 1099 1100 soc_dapm_async_complete(w->dapm); 1101 1102 if (SND_SOC_DAPM_EVENT_ON(event)) { 1103 if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) { 1104 ret = regulator_allow_bypass(w->regulator, false); 1105 if (ret != 0) 1106 dev_warn(w->dapm->dev, 1107 "ASoC: Failed to unbypass %s: %d\n", 1108 w->name, ret); 1109 } 1110 1111 return regulator_enable(w->regulator); 1112 } else { 1113 if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) { 1114 ret = regulator_allow_bypass(w->regulator, true); 1115 if (ret != 0) 1116 dev_warn(w->dapm->dev, 1117 "ASoC: Failed to bypass %s: %d\n", 1118 w->name, ret); 1119 } 1120 1121 return regulator_disable_deferred(w->regulator, w->shift); 1122 } 1123 } 1124 EXPORT_SYMBOL_GPL(dapm_regulator_event); 1125 1126 /* 1127 * Handler for clock supply widget. 1128 */ 1129 int dapm_clock_event(struct snd_soc_dapm_widget *w, 1130 struct snd_kcontrol *kcontrol, int event) 1131 { 1132 if (!w->clk) 1133 return -EIO; 1134 1135 soc_dapm_async_complete(w->dapm); 1136 1137 #ifdef CONFIG_HAVE_CLK 1138 if (SND_SOC_DAPM_EVENT_ON(event)) { 1139 return clk_prepare_enable(w->clk); 1140 } else { 1141 clk_disable_unprepare(w->clk); 1142 return 0; 1143 } 1144 #endif 1145 return 0; 1146 } 1147 EXPORT_SYMBOL_GPL(dapm_clock_event); 1148 1149 static int dapm_widget_power_check(struct snd_soc_dapm_widget *w) 1150 { 1151 if (w->power_checked) 1152 return w->new_power; 1153 1154 if (w->force) 1155 w->new_power = 1; 1156 else 1157 w->new_power = w->power_check(w); 1158 1159 w->power_checked = true; 1160 1161 return w->new_power; 1162 } 1163 1164 /* Generic check to see if a widget should be powered. 1165 */ 1166 static int dapm_generic_check_power(struct snd_soc_dapm_widget *w) 1167 { 1168 int in, out; 1169 1170 DAPM_UPDATE_STAT(w, power_checks); 1171 1172 in = is_connected_input_ep(w, NULL); 1173 out = is_connected_output_ep(w, NULL); 1174 return out != 0 && in != 0; 1175 } 1176 1177 /* Check to see if a power supply is needed */ 1178 static int dapm_supply_check_power(struct snd_soc_dapm_widget *w) 1179 { 1180 struct snd_soc_dapm_path *path; 1181 1182 DAPM_UPDATE_STAT(w, power_checks); 1183 1184 /* Check if one of our outputs is connected */ 1185 list_for_each_entry(path, &w->sinks, list_source) { 1186 DAPM_UPDATE_STAT(w, neighbour_checks); 1187 1188 if (path->weak) 1189 continue; 1190 1191 if (path->connected && 1192 !path->connected(path->source, path->sink)) 1193 continue; 1194 1195 if (dapm_widget_power_check(path->sink)) 1196 return 1; 1197 } 1198 1199 return 0; 1200 } 1201 1202 static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w) 1203 { 1204 return 1; 1205 } 1206 1207 static int dapm_seq_compare(struct snd_soc_dapm_widget *a, 1208 struct snd_soc_dapm_widget *b, 1209 bool power_up) 1210 { 1211 int *sort; 1212 1213 if (power_up) 1214 sort = dapm_up_seq; 1215 else 1216 sort = dapm_down_seq; 1217 1218 if (sort[a->id] != sort[b->id]) 1219 return sort[a->id] - sort[b->id]; 1220 if (a->subseq != b->subseq) { 1221 if (power_up) 1222 return a->subseq - b->subseq; 1223 else 1224 return b->subseq - a->subseq; 1225 } 1226 if (a->reg != b->reg) 1227 return a->reg - b->reg; 1228 if (a->dapm != b->dapm) 1229 return (unsigned long)a->dapm - (unsigned long)b->dapm; 1230 1231 return 0; 1232 } 1233 1234 /* Insert a widget in order into a DAPM power sequence. */ 1235 static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget, 1236 struct list_head *list, 1237 bool power_up) 1238 { 1239 struct snd_soc_dapm_widget *w; 1240 1241 list_for_each_entry(w, list, power_list) 1242 if (dapm_seq_compare(new_widget, w, power_up) < 0) { 1243 list_add_tail(&new_widget->power_list, &w->power_list); 1244 return; 1245 } 1246 1247 list_add_tail(&new_widget->power_list, list); 1248 } 1249 1250 static void dapm_seq_check_event(struct snd_soc_card *card, 1251 struct snd_soc_dapm_widget *w, int event) 1252 { 1253 const char *ev_name; 1254 int power, ret; 1255 1256 switch (event) { 1257 case SND_SOC_DAPM_PRE_PMU: 1258 ev_name = "PRE_PMU"; 1259 power = 1; 1260 break; 1261 case SND_SOC_DAPM_POST_PMU: 1262 ev_name = "POST_PMU"; 1263 power = 1; 1264 break; 1265 case SND_SOC_DAPM_PRE_PMD: 1266 ev_name = "PRE_PMD"; 1267 power = 0; 1268 break; 1269 case SND_SOC_DAPM_POST_PMD: 1270 ev_name = "POST_PMD"; 1271 power = 0; 1272 break; 1273 case SND_SOC_DAPM_WILL_PMU: 1274 ev_name = "WILL_PMU"; 1275 power = 1; 1276 break; 1277 case SND_SOC_DAPM_WILL_PMD: 1278 ev_name = "WILL_PMD"; 1279 power = 0; 1280 break; 1281 default: 1282 WARN(1, "Unknown event %d\n", event); 1283 return; 1284 } 1285 1286 if (w->new_power != power) 1287 return; 1288 1289 if (w->event && (w->event_flags & event)) { 1290 pop_dbg(w->dapm->dev, card->pop_time, "pop test : %s %s\n", 1291 w->name, ev_name); 1292 soc_dapm_async_complete(w->dapm); 1293 trace_snd_soc_dapm_widget_event_start(w, event); 1294 ret = w->event(w, NULL, event); 1295 trace_snd_soc_dapm_widget_event_done(w, event); 1296 if (ret < 0) 1297 dev_err(w->dapm->dev, "ASoC: %s: %s event failed: %d\n", 1298 ev_name, w->name, ret); 1299 } 1300 } 1301 1302 /* Apply the coalesced changes from a DAPM sequence */ 1303 static void dapm_seq_run_coalesced(struct snd_soc_card *card, 1304 struct list_head *pending) 1305 { 1306 struct snd_soc_dapm_context *dapm; 1307 struct snd_soc_dapm_widget *w; 1308 int reg; 1309 unsigned int value = 0; 1310 unsigned int mask = 0; 1311 1312 w = list_first_entry(pending, struct snd_soc_dapm_widget, power_list); 1313 reg = w->reg; 1314 dapm = w->dapm; 1315 1316 list_for_each_entry(w, pending, power_list) { 1317 WARN_ON(reg != w->reg || dapm != w->dapm); 1318 w->power = w->new_power; 1319 1320 mask |= w->mask << w->shift; 1321 if (w->power) 1322 value |= w->on_val << w->shift; 1323 else 1324 value |= w->off_val << w->shift; 1325 1326 pop_dbg(dapm->dev, card->pop_time, 1327 "pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n", 1328 w->name, reg, value, mask); 1329 1330 /* Check for events */ 1331 dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMU); 1332 dapm_seq_check_event(card, w, SND_SOC_DAPM_PRE_PMD); 1333 } 1334 1335 if (reg >= 0) { 1336 /* Any widget will do, they should all be updating the 1337 * same register. 1338 */ 1339 1340 pop_dbg(dapm->dev, card->pop_time, 1341 "pop test : Applying 0x%x/0x%x to %x in %dms\n", 1342 value, mask, reg, card->pop_time); 1343 pop_wait(card->pop_time); 1344 soc_dapm_update_bits(dapm, reg, mask, value); 1345 } 1346 1347 list_for_each_entry(w, pending, power_list) { 1348 dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMU); 1349 dapm_seq_check_event(card, w, SND_SOC_DAPM_POST_PMD); 1350 } 1351 } 1352 1353 /* Apply a DAPM power sequence. 1354 * 1355 * We walk over a pre-sorted list of widgets to apply power to. In 1356 * order to minimise the number of writes to the device required 1357 * multiple widgets will be updated in a single write where possible. 1358 * Currently anything that requires more than a single write is not 1359 * handled. 1360 */ 1361 static void dapm_seq_run(struct snd_soc_card *card, 1362 struct list_head *list, int event, bool power_up) 1363 { 1364 struct snd_soc_dapm_widget *w, *n; 1365 struct snd_soc_dapm_context *d; 1366 LIST_HEAD(pending); 1367 int cur_sort = -1; 1368 int cur_subseq = -1; 1369 int cur_reg = SND_SOC_NOPM; 1370 struct snd_soc_dapm_context *cur_dapm = NULL; 1371 int ret, i; 1372 int *sort; 1373 1374 if (power_up) 1375 sort = dapm_up_seq; 1376 else 1377 sort = dapm_down_seq; 1378 1379 list_for_each_entry_safe(w, n, list, power_list) { 1380 ret = 0; 1381 1382 /* Do we need to apply any queued changes? */ 1383 if (sort[w->id] != cur_sort || w->reg != cur_reg || 1384 w->dapm != cur_dapm || w->subseq != cur_subseq) { 1385 if (!list_empty(&pending)) 1386 dapm_seq_run_coalesced(card, &pending); 1387 1388 if (cur_dapm && cur_dapm->seq_notifier) { 1389 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++) 1390 if (sort[i] == cur_sort) 1391 cur_dapm->seq_notifier(cur_dapm, 1392 i, 1393 cur_subseq); 1394 } 1395 1396 if (cur_dapm && w->dapm != cur_dapm) 1397 soc_dapm_async_complete(cur_dapm); 1398 1399 INIT_LIST_HEAD(&pending); 1400 cur_sort = -1; 1401 cur_subseq = INT_MIN; 1402 cur_reg = SND_SOC_NOPM; 1403 cur_dapm = NULL; 1404 } 1405 1406 switch (w->id) { 1407 case snd_soc_dapm_pre: 1408 if (!w->event) 1409 list_for_each_entry_safe_continue(w, n, list, 1410 power_list); 1411 1412 if (event == SND_SOC_DAPM_STREAM_START) 1413 ret = w->event(w, 1414 NULL, SND_SOC_DAPM_PRE_PMU); 1415 else if (event == SND_SOC_DAPM_STREAM_STOP) 1416 ret = w->event(w, 1417 NULL, SND_SOC_DAPM_PRE_PMD); 1418 break; 1419 1420 case snd_soc_dapm_post: 1421 if (!w->event) 1422 list_for_each_entry_safe_continue(w, n, list, 1423 power_list); 1424 1425 if (event == SND_SOC_DAPM_STREAM_START) 1426 ret = w->event(w, 1427 NULL, SND_SOC_DAPM_POST_PMU); 1428 else if (event == SND_SOC_DAPM_STREAM_STOP) 1429 ret = w->event(w, 1430 NULL, SND_SOC_DAPM_POST_PMD); 1431 break; 1432 1433 default: 1434 /* Queue it up for application */ 1435 cur_sort = sort[w->id]; 1436 cur_subseq = w->subseq; 1437 cur_reg = w->reg; 1438 cur_dapm = w->dapm; 1439 list_move(&w->power_list, &pending); 1440 break; 1441 } 1442 1443 if (ret < 0) 1444 dev_err(w->dapm->dev, 1445 "ASoC: Failed to apply widget power: %d\n", ret); 1446 } 1447 1448 if (!list_empty(&pending)) 1449 dapm_seq_run_coalesced(card, &pending); 1450 1451 if (cur_dapm && cur_dapm->seq_notifier) { 1452 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++) 1453 if (sort[i] == cur_sort) 1454 cur_dapm->seq_notifier(cur_dapm, 1455 i, cur_subseq); 1456 } 1457 1458 list_for_each_entry(d, &card->dapm_list, list) { 1459 soc_dapm_async_complete(d); 1460 } 1461 } 1462 1463 static void dapm_widget_update(struct snd_soc_card *card) 1464 { 1465 struct snd_soc_dapm_update *update = card->update; 1466 struct snd_soc_dapm_widget_list *wlist; 1467 struct snd_soc_dapm_widget *w = NULL; 1468 unsigned int wi; 1469 int ret; 1470 1471 if (!update || !dapm_kcontrol_is_powered(update->kcontrol)) 1472 return; 1473 1474 wlist = dapm_kcontrol_get_wlist(update->kcontrol); 1475 1476 for (wi = 0; wi < wlist->num_widgets; wi++) { 1477 w = wlist->widgets[wi]; 1478 1479 if (w->event && (w->event_flags & SND_SOC_DAPM_PRE_REG)) { 1480 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG); 1481 if (ret != 0) 1482 dev_err(w->dapm->dev, "ASoC: %s DAPM pre-event failed: %d\n", 1483 w->name, ret); 1484 } 1485 } 1486 1487 if (!w) 1488 return; 1489 1490 ret = soc_dapm_update_bits(w->dapm, update->reg, update->mask, 1491 update->val); 1492 if (ret < 0) 1493 dev_err(w->dapm->dev, "ASoC: %s DAPM update failed: %d\n", 1494 w->name, ret); 1495 1496 for (wi = 0; wi < wlist->num_widgets; wi++) { 1497 w = wlist->widgets[wi]; 1498 1499 if (w->event && (w->event_flags & SND_SOC_DAPM_POST_REG)) { 1500 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG); 1501 if (ret != 0) 1502 dev_err(w->dapm->dev, "ASoC: %s DAPM post-event failed: %d\n", 1503 w->name, ret); 1504 } 1505 } 1506 } 1507 1508 /* Async callback run prior to DAPM sequences - brings to _PREPARE if 1509 * they're changing state. 1510 */ 1511 static void dapm_pre_sequence_async(void *data, async_cookie_t cookie) 1512 { 1513 struct snd_soc_dapm_context *d = data; 1514 int ret; 1515 1516 /* If we're off and we're not supposed to be go into STANDBY */ 1517 if (d->bias_level == SND_SOC_BIAS_OFF && 1518 d->target_bias_level != SND_SOC_BIAS_OFF) { 1519 if (d->dev) 1520 pm_runtime_get_sync(d->dev); 1521 1522 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY); 1523 if (ret != 0) 1524 dev_err(d->dev, 1525 "ASoC: Failed to turn on bias: %d\n", ret); 1526 } 1527 1528 /* Prepare for a transition to ON or away from ON */ 1529 if ((d->target_bias_level == SND_SOC_BIAS_ON && 1530 d->bias_level != SND_SOC_BIAS_ON) || 1531 (d->target_bias_level != SND_SOC_BIAS_ON && 1532 d->bias_level == SND_SOC_BIAS_ON)) { 1533 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE); 1534 if (ret != 0) 1535 dev_err(d->dev, 1536 "ASoC: Failed to prepare bias: %d\n", ret); 1537 } 1538 } 1539 1540 /* Async callback run prior to DAPM sequences - brings to their final 1541 * state. 1542 */ 1543 static void dapm_post_sequence_async(void *data, async_cookie_t cookie) 1544 { 1545 struct snd_soc_dapm_context *d = data; 1546 int ret; 1547 1548 /* If we just powered the last thing off drop to standby bias */ 1549 if (d->bias_level == SND_SOC_BIAS_PREPARE && 1550 (d->target_bias_level == SND_SOC_BIAS_STANDBY || 1551 d->target_bias_level == SND_SOC_BIAS_OFF)) { 1552 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY); 1553 if (ret != 0) 1554 dev_err(d->dev, "ASoC: Failed to apply standby bias: %d\n", 1555 ret); 1556 } 1557 1558 /* If we're in standby and can support bias off then do that */ 1559 if (d->bias_level == SND_SOC_BIAS_STANDBY && 1560 d->target_bias_level == SND_SOC_BIAS_OFF) { 1561 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF); 1562 if (ret != 0) 1563 dev_err(d->dev, "ASoC: Failed to turn off bias: %d\n", 1564 ret); 1565 1566 if (d->dev) 1567 pm_runtime_put(d->dev); 1568 } 1569 1570 /* If we just powered up then move to active bias */ 1571 if (d->bias_level == SND_SOC_BIAS_PREPARE && 1572 d->target_bias_level == SND_SOC_BIAS_ON) { 1573 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON); 1574 if (ret != 0) 1575 dev_err(d->dev, "ASoC: Failed to apply active bias: %d\n", 1576 ret); 1577 } 1578 } 1579 1580 static void dapm_widget_set_peer_power(struct snd_soc_dapm_widget *peer, 1581 bool power, bool connect) 1582 { 1583 /* If a connection is being made or broken then that update 1584 * will have marked the peer dirty, otherwise the widgets are 1585 * not connected and this update has no impact. */ 1586 if (!connect) 1587 return; 1588 1589 /* If the peer is already in the state we're moving to then we 1590 * won't have an impact on it. */ 1591 if (power != peer->power) 1592 dapm_mark_dirty(peer, "peer state change"); 1593 } 1594 1595 static void dapm_widget_set_power(struct snd_soc_dapm_widget *w, bool power, 1596 struct list_head *up_list, 1597 struct list_head *down_list) 1598 { 1599 struct snd_soc_dapm_path *path; 1600 1601 if (w->power == power) 1602 return; 1603 1604 trace_snd_soc_dapm_widget_power(w, power); 1605 1606 /* If we changed our power state perhaps our neigbours changed 1607 * also. 1608 */ 1609 list_for_each_entry(path, &w->sources, list_sink) 1610 dapm_widget_set_peer_power(path->source, power, path->connect); 1611 1612 /* Supplies can't affect their outputs, only their inputs */ 1613 if (!w->is_supply) { 1614 list_for_each_entry(path, &w->sinks, list_source) 1615 dapm_widget_set_peer_power(path->sink, power, 1616 path->connect); 1617 } 1618 1619 if (power) 1620 dapm_seq_insert(w, up_list, true); 1621 else 1622 dapm_seq_insert(w, down_list, false); 1623 } 1624 1625 static void dapm_power_one_widget(struct snd_soc_dapm_widget *w, 1626 struct list_head *up_list, 1627 struct list_head *down_list) 1628 { 1629 int power; 1630 1631 switch (w->id) { 1632 case snd_soc_dapm_pre: 1633 dapm_seq_insert(w, down_list, false); 1634 break; 1635 case snd_soc_dapm_post: 1636 dapm_seq_insert(w, up_list, true); 1637 break; 1638 1639 default: 1640 power = dapm_widget_power_check(w); 1641 1642 dapm_widget_set_power(w, power, up_list, down_list); 1643 break; 1644 } 1645 } 1646 1647 static bool dapm_idle_bias_off(struct snd_soc_dapm_context *dapm) 1648 { 1649 if (dapm->idle_bias_off) 1650 return true; 1651 1652 switch (snd_power_get_state(dapm->card->snd_card)) { 1653 case SNDRV_CTL_POWER_D3hot: 1654 case SNDRV_CTL_POWER_D3cold: 1655 return dapm->suspend_bias_off; 1656 default: 1657 break; 1658 } 1659 1660 return false; 1661 } 1662 1663 /* 1664 * Scan each dapm widget for complete audio path. 1665 * A complete path is a route that has valid endpoints i.e.:- 1666 * 1667 * o DAC to output pin. 1668 * o Input Pin to ADC. 1669 * o Input pin to Output pin (bypass, sidetone) 1670 * o DAC to ADC (loopback). 1671 */ 1672 static int dapm_power_widgets(struct snd_soc_card *card, int event) 1673 { 1674 struct snd_soc_dapm_widget *w; 1675 struct snd_soc_dapm_context *d; 1676 LIST_HEAD(up_list); 1677 LIST_HEAD(down_list); 1678 ASYNC_DOMAIN_EXCLUSIVE(async_domain); 1679 enum snd_soc_bias_level bias; 1680 1681 lockdep_assert_held(&card->dapm_mutex); 1682 1683 trace_snd_soc_dapm_start(card); 1684 1685 list_for_each_entry(d, &card->dapm_list, list) { 1686 if (dapm_idle_bias_off(d)) 1687 d->target_bias_level = SND_SOC_BIAS_OFF; 1688 else 1689 d->target_bias_level = SND_SOC_BIAS_STANDBY; 1690 } 1691 1692 dapm_reset(card); 1693 1694 /* Check which widgets we need to power and store them in 1695 * lists indicating if they should be powered up or down. We 1696 * only check widgets that have been flagged as dirty but note 1697 * that new widgets may be added to the dirty list while we 1698 * iterate. 1699 */ 1700 list_for_each_entry(w, &card->dapm_dirty, dirty) { 1701 dapm_power_one_widget(w, &up_list, &down_list); 1702 } 1703 1704 list_for_each_entry(w, &card->widgets, list) { 1705 switch (w->id) { 1706 case snd_soc_dapm_pre: 1707 case snd_soc_dapm_post: 1708 /* These widgets always need to be powered */ 1709 break; 1710 default: 1711 list_del_init(&w->dirty); 1712 break; 1713 } 1714 1715 if (w->new_power) { 1716 d = w->dapm; 1717 1718 /* Supplies and micbiases only bring the 1719 * context up to STANDBY as unless something 1720 * else is active and passing audio they 1721 * generally don't require full power. Signal 1722 * generators are virtual pins and have no 1723 * power impact themselves. 1724 */ 1725 switch (w->id) { 1726 case snd_soc_dapm_siggen: 1727 case snd_soc_dapm_vmid: 1728 break; 1729 case snd_soc_dapm_supply: 1730 case snd_soc_dapm_regulator_supply: 1731 case snd_soc_dapm_clock_supply: 1732 case snd_soc_dapm_micbias: 1733 if (d->target_bias_level < SND_SOC_BIAS_STANDBY) 1734 d->target_bias_level = SND_SOC_BIAS_STANDBY; 1735 break; 1736 default: 1737 d->target_bias_level = SND_SOC_BIAS_ON; 1738 break; 1739 } 1740 } 1741 1742 } 1743 1744 /* Force all contexts in the card to the same bias state if 1745 * they're not ground referenced. 1746 */ 1747 bias = SND_SOC_BIAS_OFF; 1748 list_for_each_entry(d, &card->dapm_list, list) 1749 if (d->target_bias_level > bias) 1750 bias = d->target_bias_level; 1751 list_for_each_entry(d, &card->dapm_list, list) 1752 if (!dapm_idle_bias_off(d)) 1753 d->target_bias_level = bias; 1754 1755 trace_snd_soc_dapm_walk_done(card); 1756 1757 /* Run card bias changes at first */ 1758 dapm_pre_sequence_async(&card->dapm, 0); 1759 /* Run other bias changes in parallel */ 1760 list_for_each_entry(d, &card->dapm_list, list) { 1761 if (d != &card->dapm) 1762 async_schedule_domain(dapm_pre_sequence_async, d, 1763 &async_domain); 1764 } 1765 async_synchronize_full_domain(&async_domain); 1766 1767 list_for_each_entry(w, &down_list, power_list) { 1768 dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMD); 1769 } 1770 1771 list_for_each_entry(w, &up_list, power_list) { 1772 dapm_seq_check_event(card, w, SND_SOC_DAPM_WILL_PMU); 1773 } 1774 1775 /* Power down widgets first; try to avoid amplifying pops. */ 1776 dapm_seq_run(card, &down_list, event, false); 1777 1778 dapm_widget_update(card); 1779 1780 /* Now power up. */ 1781 dapm_seq_run(card, &up_list, event, true); 1782 1783 /* Run all the bias changes in parallel */ 1784 list_for_each_entry(d, &card->dapm_list, list) { 1785 if (d != &card->dapm) 1786 async_schedule_domain(dapm_post_sequence_async, d, 1787 &async_domain); 1788 } 1789 async_synchronize_full_domain(&async_domain); 1790 /* Run card bias changes at last */ 1791 dapm_post_sequence_async(&card->dapm, 0); 1792 1793 /* do we need to notify any clients that DAPM event is complete */ 1794 list_for_each_entry(d, &card->dapm_list, list) { 1795 if (d->stream_event) 1796 d->stream_event(d, event); 1797 } 1798 1799 pop_dbg(card->dev, card->pop_time, 1800 "DAPM sequencing finished, waiting %dms\n", card->pop_time); 1801 pop_wait(card->pop_time); 1802 1803 trace_snd_soc_dapm_done(card); 1804 1805 return 0; 1806 } 1807 1808 #ifdef CONFIG_DEBUG_FS 1809 static ssize_t dapm_widget_power_read_file(struct file *file, 1810 char __user *user_buf, 1811 size_t count, loff_t *ppos) 1812 { 1813 struct snd_soc_dapm_widget *w = file->private_data; 1814 char *buf; 1815 int in, out; 1816 ssize_t ret; 1817 struct snd_soc_dapm_path *p = NULL; 1818 1819 buf = kmalloc(PAGE_SIZE, GFP_KERNEL); 1820 if (!buf) 1821 return -ENOMEM; 1822 1823 /* Supply widgets are not handled by is_connected_{input,output}_ep() */ 1824 if (w->is_supply) { 1825 in = 0; 1826 out = 0; 1827 } else { 1828 in = is_connected_input_ep(w, NULL); 1829 out = is_connected_output_ep(w, NULL); 1830 } 1831 1832 ret = snprintf(buf, PAGE_SIZE, "%s: %s%s in %d out %d", 1833 w->name, w->power ? "On" : "Off", 1834 w->force ? " (forced)" : "", in, out); 1835 1836 if (w->reg >= 0) 1837 ret += snprintf(buf + ret, PAGE_SIZE - ret, 1838 " - R%d(0x%x) mask 0x%x", 1839 w->reg, w->reg, w->mask << w->shift); 1840 1841 ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n"); 1842 1843 if (w->sname) 1844 ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n", 1845 w->sname, 1846 w->active ? "active" : "inactive"); 1847 1848 list_for_each_entry(p, &w->sources, list_sink) { 1849 if (p->connected && !p->connected(w, p->source)) 1850 continue; 1851 1852 if (p->connect) 1853 ret += snprintf(buf + ret, PAGE_SIZE - ret, 1854 " in \"%s\" \"%s\"\n", 1855 p->name ? p->name : "static", 1856 p->source->name); 1857 } 1858 list_for_each_entry(p, &w->sinks, list_source) { 1859 if (p->connected && !p->connected(w, p->sink)) 1860 continue; 1861 1862 if (p->connect) 1863 ret += snprintf(buf + ret, PAGE_SIZE - ret, 1864 " out \"%s\" \"%s\"\n", 1865 p->name ? p->name : "static", 1866 p->sink->name); 1867 } 1868 1869 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret); 1870 1871 kfree(buf); 1872 return ret; 1873 } 1874 1875 static const struct file_operations dapm_widget_power_fops = { 1876 .open = simple_open, 1877 .read = dapm_widget_power_read_file, 1878 .llseek = default_llseek, 1879 }; 1880 1881 static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf, 1882 size_t count, loff_t *ppos) 1883 { 1884 struct snd_soc_dapm_context *dapm = file->private_data; 1885 char *level; 1886 1887 switch (dapm->bias_level) { 1888 case SND_SOC_BIAS_ON: 1889 level = "On\n"; 1890 break; 1891 case SND_SOC_BIAS_PREPARE: 1892 level = "Prepare\n"; 1893 break; 1894 case SND_SOC_BIAS_STANDBY: 1895 level = "Standby\n"; 1896 break; 1897 case SND_SOC_BIAS_OFF: 1898 level = "Off\n"; 1899 break; 1900 default: 1901 WARN(1, "Unknown bias_level %d\n", dapm->bias_level); 1902 level = "Unknown\n"; 1903 break; 1904 } 1905 1906 return simple_read_from_buffer(user_buf, count, ppos, level, 1907 strlen(level)); 1908 } 1909 1910 static const struct file_operations dapm_bias_fops = { 1911 .open = simple_open, 1912 .read = dapm_bias_read_file, 1913 .llseek = default_llseek, 1914 }; 1915 1916 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm, 1917 struct dentry *parent) 1918 { 1919 struct dentry *d; 1920 1921 if (!parent) 1922 return; 1923 1924 dapm->debugfs_dapm = debugfs_create_dir("dapm", parent); 1925 1926 if (!dapm->debugfs_dapm) { 1927 dev_warn(dapm->dev, 1928 "ASoC: Failed to create DAPM debugfs directory\n"); 1929 return; 1930 } 1931 1932 d = debugfs_create_file("bias_level", 0444, 1933 dapm->debugfs_dapm, dapm, 1934 &dapm_bias_fops); 1935 if (!d) 1936 dev_warn(dapm->dev, 1937 "ASoC: Failed to create bias level debugfs file\n"); 1938 } 1939 1940 static void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w) 1941 { 1942 struct snd_soc_dapm_context *dapm = w->dapm; 1943 struct dentry *d; 1944 1945 if (!dapm->debugfs_dapm || !w->name) 1946 return; 1947 1948 d = debugfs_create_file(w->name, 0444, 1949 dapm->debugfs_dapm, w, 1950 &dapm_widget_power_fops); 1951 if (!d) 1952 dev_warn(w->dapm->dev, 1953 "ASoC: Failed to create %s debugfs file\n", 1954 w->name); 1955 } 1956 1957 static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm) 1958 { 1959 debugfs_remove_recursive(dapm->debugfs_dapm); 1960 } 1961 1962 #else 1963 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm, 1964 struct dentry *parent) 1965 { 1966 } 1967 1968 static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w) 1969 { 1970 } 1971 1972 static inline void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm) 1973 { 1974 } 1975 1976 #endif 1977 1978 /* 1979 * soc_dapm_connect_path() - Connects or disconnects a path 1980 * @path: The path to update 1981 * @connect: The new connect state of the path. True if the path is connected, 1982 * false if it is disconneted. 1983 * @reason: The reason why the path changed (for debugging only) 1984 */ 1985 static void soc_dapm_connect_path(struct snd_soc_dapm_path *path, 1986 bool connect, const char *reason) 1987 { 1988 if (path->connect == connect) 1989 return; 1990 1991 path->connect = connect; 1992 dapm_mark_dirty(path->source, reason); 1993 dapm_mark_dirty(path->sink, reason); 1994 dapm_path_invalidate(path); 1995 } 1996 1997 /* test and update the power status of a mux widget */ 1998 static int soc_dapm_mux_update_power(struct snd_soc_card *card, 1999 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e) 2000 { 2001 struct snd_soc_dapm_path *path; 2002 int found = 0; 2003 bool connect; 2004 2005 lockdep_assert_held(&card->dapm_mutex); 2006 2007 /* find dapm widget path assoc with kcontrol */ 2008 dapm_kcontrol_for_each_path(path, kcontrol) { 2009 found = 1; 2010 /* we now need to match the string in the enum to the path */ 2011 if (!(strcmp(path->name, e->texts[mux]))) 2012 connect = true; 2013 else 2014 connect = false; 2015 2016 soc_dapm_connect_path(path, connect, "mux update"); 2017 } 2018 2019 if (found) 2020 dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP); 2021 2022 return found; 2023 } 2024 2025 int snd_soc_dapm_mux_update_power(struct snd_soc_dapm_context *dapm, 2026 struct snd_kcontrol *kcontrol, int mux, struct soc_enum *e, 2027 struct snd_soc_dapm_update *update) 2028 { 2029 struct snd_soc_card *card = dapm->card; 2030 int ret; 2031 2032 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 2033 card->update = update; 2034 ret = soc_dapm_mux_update_power(card, kcontrol, mux, e); 2035 card->update = NULL; 2036 mutex_unlock(&card->dapm_mutex); 2037 if (ret > 0) 2038 soc_dpcm_runtime_update(card); 2039 return ret; 2040 } 2041 EXPORT_SYMBOL_GPL(snd_soc_dapm_mux_update_power); 2042 2043 /* test and update the power status of a mixer or switch widget */ 2044 static int soc_dapm_mixer_update_power(struct snd_soc_card *card, 2045 struct snd_kcontrol *kcontrol, int connect) 2046 { 2047 struct snd_soc_dapm_path *path; 2048 int found = 0; 2049 2050 lockdep_assert_held(&card->dapm_mutex); 2051 2052 /* find dapm widget path assoc with kcontrol */ 2053 dapm_kcontrol_for_each_path(path, kcontrol) { 2054 found = 1; 2055 soc_dapm_connect_path(path, connect, "mixer update"); 2056 } 2057 2058 if (found) 2059 dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP); 2060 2061 return found; 2062 } 2063 2064 int snd_soc_dapm_mixer_update_power(struct snd_soc_dapm_context *dapm, 2065 struct snd_kcontrol *kcontrol, int connect, 2066 struct snd_soc_dapm_update *update) 2067 { 2068 struct snd_soc_card *card = dapm->card; 2069 int ret; 2070 2071 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 2072 card->update = update; 2073 ret = soc_dapm_mixer_update_power(card, kcontrol, connect); 2074 card->update = NULL; 2075 mutex_unlock(&card->dapm_mutex); 2076 if (ret > 0) 2077 soc_dpcm_runtime_update(card); 2078 return ret; 2079 } 2080 EXPORT_SYMBOL_GPL(snd_soc_dapm_mixer_update_power); 2081 2082 static ssize_t dapm_widget_show_codec(struct snd_soc_codec *codec, char *buf) 2083 { 2084 struct snd_soc_dapm_widget *w; 2085 int count = 0; 2086 char *state = "not set"; 2087 2088 list_for_each_entry(w, &codec->component.card->widgets, list) { 2089 if (w->dapm != &codec->dapm) 2090 continue; 2091 2092 /* only display widgets that burnm power */ 2093 switch (w->id) { 2094 case snd_soc_dapm_hp: 2095 case snd_soc_dapm_mic: 2096 case snd_soc_dapm_spk: 2097 case snd_soc_dapm_line: 2098 case snd_soc_dapm_micbias: 2099 case snd_soc_dapm_dac: 2100 case snd_soc_dapm_adc: 2101 case snd_soc_dapm_pga: 2102 case snd_soc_dapm_out_drv: 2103 case snd_soc_dapm_mixer: 2104 case snd_soc_dapm_mixer_named_ctl: 2105 case snd_soc_dapm_supply: 2106 case snd_soc_dapm_regulator_supply: 2107 case snd_soc_dapm_clock_supply: 2108 if (w->name) 2109 count += sprintf(buf + count, "%s: %s\n", 2110 w->name, w->power ? "On":"Off"); 2111 break; 2112 default: 2113 break; 2114 } 2115 } 2116 2117 switch (codec->dapm.bias_level) { 2118 case SND_SOC_BIAS_ON: 2119 state = "On"; 2120 break; 2121 case SND_SOC_BIAS_PREPARE: 2122 state = "Prepare"; 2123 break; 2124 case SND_SOC_BIAS_STANDBY: 2125 state = "Standby"; 2126 break; 2127 case SND_SOC_BIAS_OFF: 2128 state = "Off"; 2129 break; 2130 } 2131 count += sprintf(buf + count, "PM State: %s\n", state); 2132 2133 return count; 2134 } 2135 2136 /* show dapm widget status in sys fs */ 2137 static ssize_t dapm_widget_show(struct device *dev, 2138 struct device_attribute *attr, char *buf) 2139 { 2140 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev); 2141 int i, count = 0; 2142 2143 for (i = 0; i < rtd->num_codecs; i++) { 2144 struct snd_soc_codec *codec = rtd->codec_dais[i]->codec; 2145 count += dapm_widget_show_codec(codec, buf + count); 2146 } 2147 2148 return count; 2149 } 2150 2151 static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL); 2152 2153 struct attribute *soc_dapm_dev_attrs[] = { 2154 &dev_attr_dapm_widget.attr, 2155 NULL 2156 }; 2157 2158 static void dapm_free_path(struct snd_soc_dapm_path *path) 2159 { 2160 list_del(&path->list_sink); 2161 list_del(&path->list_source); 2162 list_del(&path->list_kcontrol); 2163 list_del(&path->list); 2164 kfree(path); 2165 } 2166 2167 /* free all dapm widgets and resources */ 2168 static void dapm_free_widgets(struct snd_soc_dapm_context *dapm) 2169 { 2170 struct snd_soc_dapm_widget *w, *next_w; 2171 struct snd_soc_dapm_path *p, *next_p; 2172 2173 list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) { 2174 if (w->dapm != dapm) 2175 continue; 2176 list_del(&w->list); 2177 /* 2178 * remove source and sink paths associated to this widget. 2179 * While removing the path, remove reference to it from both 2180 * source and sink widgets so that path is removed only once. 2181 */ 2182 list_for_each_entry_safe(p, next_p, &w->sources, list_sink) 2183 dapm_free_path(p); 2184 2185 list_for_each_entry_safe(p, next_p, &w->sinks, list_source) 2186 dapm_free_path(p); 2187 2188 kfree(w->kcontrols); 2189 kfree(w->name); 2190 kfree(w); 2191 } 2192 } 2193 2194 static struct snd_soc_dapm_widget *dapm_find_widget( 2195 struct snd_soc_dapm_context *dapm, const char *pin, 2196 bool search_other_contexts) 2197 { 2198 struct snd_soc_dapm_widget *w; 2199 struct snd_soc_dapm_widget *fallback = NULL; 2200 2201 list_for_each_entry(w, &dapm->card->widgets, list) { 2202 if (!strcmp(w->name, pin)) { 2203 if (w->dapm == dapm) 2204 return w; 2205 else 2206 fallback = w; 2207 } 2208 } 2209 2210 if (search_other_contexts) 2211 return fallback; 2212 2213 return NULL; 2214 } 2215 2216 static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm, 2217 const char *pin, int status) 2218 { 2219 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true); 2220 2221 dapm_assert_locked(dapm); 2222 2223 if (!w) { 2224 dev_err(dapm->dev, "ASoC: DAPM unknown pin %s\n", pin); 2225 return -EINVAL; 2226 } 2227 2228 if (w->connected != status) { 2229 dapm_mark_dirty(w, "pin configuration"); 2230 dapm_widget_invalidate_input_paths(w); 2231 dapm_widget_invalidate_output_paths(w); 2232 } 2233 2234 w->connected = status; 2235 if (status == 0) 2236 w->force = 0; 2237 2238 return 0; 2239 } 2240 2241 /** 2242 * snd_soc_dapm_sync_unlocked - scan and power dapm paths 2243 * @dapm: DAPM context 2244 * 2245 * Walks all dapm audio paths and powers widgets according to their 2246 * stream or path usage. 2247 * 2248 * Requires external locking. 2249 * 2250 * Returns 0 for success. 2251 */ 2252 int snd_soc_dapm_sync_unlocked(struct snd_soc_dapm_context *dapm) 2253 { 2254 /* 2255 * Suppress early reports (eg, jacks syncing their state) to avoid 2256 * silly DAPM runs during card startup. 2257 */ 2258 if (!dapm->card || !dapm->card->instantiated) 2259 return 0; 2260 2261 return dapm_power_widgets(dapm->card, SND_SOC_DAPM_STREAM_NOP); 2262 } 2263 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync_unlocked); 2264 2265 /** 2266 * snd_soc_dapm_sync - scan and power dapm paths 2267 * @dapm: DAPM context 2268 * 2269 * Walks all dapm audio paths and powers widgets according to their 2270 * stream or path usage. 2271 * 2272 * Returns 0 for success. 2273 */ 2274 int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm) 2275 { 2276 int ret; 2277 2278 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 2279 ret = snd_soc_dapm_sync_unlocked(dapm); 2280 mutex_unlock(&dapm->card->dapm_mutex); 2281 return ret; 2282 } 2283 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync); 2284 2285 /* 2286 * dapm_update_widget_flags() - Re-compute widget sink and source flags 2287 * @w: The widget for which to update the flags 2288 * 2289 * Some widgets have a dynamic category which depends on which neighbors they 2290 * are connected to. This function update the category for these widgets. 2291 * 2292 * This function must be called whenever a path is added or removed to a widget. 2293 */ 2294 static void dapm_update_widget_flags(struct snd_soc_dapm_widget *w) 2295 { 2296 struct snd_soc_dapm_path *p; 2297 2298 switch (w->id) { 2299 case snd_soc_dapm_input: 2300 /* On a fully routed card a input is never a source */ 2301 if (w->dapm->card->fully_routed) 2302 break; 2303 w->is_source = 1; 2304 list_for_each_entry(p, &w->sources, list_sink) { 2305 if (p->source->id == snd_soc_dapm_micbias || 2306 p->source->id == snd_soc_dapm_mic || 2307 p->source->id == snd_soc_dapm_line || 2308 p->source->id == snd_soc_dapm_output) { 2309 w->is_source = 0; 2310 break; 2311 } 2312 } 2313 break; 2314 case snd_soc_dapm_output: 2315 /* On a fully routed card a output is never a sink */ 2316 if (w->dapm->card->fully_routed) 2317 break; 2318 w->is_sink = 1; 2319 list_for_each_entry(p, &w->sinks, list_source) { 2320 if (p->sink->id == snd_soc_dapm_spk || 2321 p->sink->id == snd_soc_dapm_hp || 2322 p->sink->id == snd_soc_dapm_line || 2323 p->sink->id == snd_soc_dapm_input) { 2324 w->is_sink = 0; 2325 break; 2326 } 2327 } 2328 break; 2329 case snd_soc_dapm_line: 2330 w->is_sink = !list_empty(&w->sources); 2331 w->is_source = !list_empty(&w->sinks); 2332 break; 2333 default: 2334 break; 2335 } 2336 } 2337 2338 static int snd_soc_dapm_add_path(struct snd_soc_dapm_context *dapm, 2339 struct snd_soc_dapm_widget *wsource, struct snd_soc_dapm_widget *wsink, 2340 const char *control, 2341 int (*connected)(struct snd_soc_dapm_widget *source, 2342 struct snd_soc_dapm_widget *sink)) 2343 { 2344 struct snd_soc_dapm_path *path; 2345 int ret; 2346 2347 if (wsink->is_supply && !wsource->is_supply) { 2348 dev_err(dapm->dev, 2349 "Connecting non-supply widget to supply widget is not supported (%s -> %s)\n", 2350 wsource->name, wsink->name); 2351 return -EINVAL; 2352 } 2353 2354 if (connected && !wsource->is_supply) { 2355 dev_err(dapm->dev, 2356 "connected() callback only supported for supply widgets (%s -> %s)\n", 2357 wsource->name, wsink->name); 2358 return -EINVAL; 2359 } 2360 2361 if (wsource->is_supply && control) { 2362 dev_err(dapm->dev, 2363 "Conditional paths are not supported for supply widgets (%s -> [%s] -> %s)\n", 2364 wsource->name, control, wsink->name); 2365 return -EINVAL; 2366 } 2367 2368 path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL); 2369 if (!path) 2370 return -ENOMEM; 2371 2372 path->source = wsource; 2373 path->sink = wsink; 2374 path->connected = connected; 2375 INIT_LIST_HEAD(&path->list); 2376 INIT_LIST_HEAD(&path->list_kcontrol); 2377 INIT_LIST_HEAD(&path->list_source); 2378 INIT_LIST_HEAD(&path->list_sink); 2379 2380 if (wsource->is_supply || wsink->is_supply) 2381 path->is_supply = 1; 2382 2383 /* connect static paths */ 2384 if (control == NULL) { 2385 path->connect = 1; 2386 } else { 2387 /* connect dynamic paths */ 2388 switch (wsink->id) { 2389 case snd_soc_dapm_mux: 2390 ret = dapm_connect_mux(dapm, path, control); 2391 if (ret != 0) 2392 goto err; 2393 break; 2394 case snd_soc_dapm_switch: 2395 case snd_soc_dapm_mixer: 2396 case snd_soc_dapm_mixer_named_ctl: 2397 ret = dapm_connect_mixer(dapm, path, control); 2398 if (ret != 0) 2399 goto err; 2400 break; 2401 default: 2402 dev_err(dapm->dev, 2403 "Control not supported for path %s -> [%s] -> %s\n", 2404 wsource->name, control, wsink->name); 2405 ret = -EINVAL; 2406 goto err; 2407 } 2408 } 2409 2410 list_add(&path->list, &dapm->card->paths); 2411 list_add(&path->list_sink, &wsink->sources); 2412 list_add(&path->list_source, &wsource->sinks); 2413 2414 dapm_update_widget_flags(wsource); 2415 dapm_update_widget_flags(wsink); 2416 2417 dapm_mark_dirty(wsource, "Route added"); 2418 dapm_mark_dirty(wsink, "Route added"); 2419 2420 if (dapm->card->instantiated && path->connect) 2421 dapm_path_invalidate(path); 2422 2423 return 0; 2424 err: 2425 kfree(path); 2426 return ret; 2427 } 2428 2429 static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm, 2430 const struct snd_soc_dapm_route *route) 2431 { 2432 struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w; 2433 struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL; 2434 const char *sink; 2435 const char *source; 2436 char prefixed_sink[80]; 2437 char prefixed_source[80]; 2438 const char *prefix; 2439 int ret; 2440 2441 prefix = soc_dapm_prefix(dapm); 2442 if (prefix) { 2443 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s", 2444 prefix, route->sink); 2445 sink = prefixed_sink; 2446 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s", 2447 prefix, route->source); 2448 source = prefixed_source; 2449 } else { 2450 sink = route->sink; 2451 source = route->source; 2452 } 2453 2454 /* 2455 * find src and dest widgets over all widgets but favor a widget from 2456 * current DAPM context 2457 */ 2458 list_for_each_entry(w, &dapm->card->widgets, list) { 2459 if (!wsink && !(strcmp(w->name, sink))) { 2460 wtsink = w; 2461 if (w->dapm == dapm) 2462 wsink = w; 2463 continue; 2464 } 2465 if (!wsource && !(strcmp(w->name, source))) { 2466 wtsource = w; 2467 if (w->dapm == dapm) 2468 wsource = w; 2469 } 2470 } 2471 /* use widget from another DAPM context if not found from this */ 2472 if (!wsink) 2473 wsink = wtsink; 2474 if (!wsource) 2475 wsource = wtsource; 2476 2477 if (wsource == NULL) { 2478 dev_err(dapm->dev, "ASoC: no source widget found for %s\n", 2479 route->source); 2480 return -ENODEV; 2481 } 2482 if (wsink == NULL) { 2483 dev_err(dapm->dev, "ASoC: no sink widget found for %s\n", 2484 route->sink); 2485 return -ENODEV; 2486 } 2487 2488 ret = snd_soc_dapm_add_path(dapm, wsource, wsink, route->control, 2489 route->connected); 2490 if (ret) 2491 goto err; 2492 2493 return 0; 2494 err: 2495 dev_warn(dapm->dev, "ASoC: no dapm match for %s --> %s --> %s\n", 2496 source, route->control, sink); 2497 return ret; 2498 } 2499 2500 static int snd_soc_dapm_del_route(struct snd_soc_dapm_context *dapm, 2501 const struct snd_soc_dapm_route *route) 2502 { 2503 struct snd_soc_dapm_widget *wsource, *wsink; 2504 struct snd_soc_dapm_path *path, *p; 2505 const char *sink; 2506 const char *source; 2507 char prefixed_sink[80]; 2508 char prefixed_source[80]; 2509 const char *prefix; 2510 2511 if (route->control) { 2512 dev_err(dapm->dev, 2513 "ASoC: Removal of routes with controls not supported\n"); 2514 return -EINVAL; 2515 } 2516 2517 prefix = soc_dapm_prefix(dapm); 2518 if (prefix) { 2519 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s", 2520 prefix, route->sink); 2521 sink = prefixed_sink; 2522 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s", 2523 prefix, route->source); 2524 source = prefixed_source; 2525 } else { 2526 sink = route->sink; 2527 source = route->source; 2528 } 2529 2530 path = NULL; 2531 list_for_each_entry(p, &dapm->card->paths, list) { 2532 if (strcmp(p->source->name, source) != 0) 2533 continue; 2534 if (strcmp(p->sink->name, sink) != 0) 2535 continue; 2536 path = p; 2537 break; 2538 } 2539 2540 if (path) { 2541 wsource = path->source; 2542 wsink = path->sink; 2543 2544 dapm_mark_dirty(wsource, "Route removed"); 2545 dapm_mark_dirty(wsink, "Route removed"); 2546 if (path->connect) 2547 dapm_path_invalidate(path); 2548 2549 dapm_free_path(path); 2550 2551 /* Update any path related flags */ 2552 dapm_update_widget_flags(wsource); 2553 dapm_update_widget_flags(wsink); 2554 } else { 2555 dev_warn(dapm->dev, "ASoC: Route %s->%s does not exist\n", 2556 source, sink); 2557 } 2558 2559 return 0; 2560 } 2561 2562 /** 2563 * snd_soc_dapm_add_routes - Add routes between DAPM widgets 2564 * @dapm: DAPM context 2565 * @route: audio routes 2566 * @num: number of routes 2567 * 2568 * Connects 2 dapm widgets together via a named audio path. The sink is 2569 * the widget receiving the audio signal, whilst the source is the sender 2570 * of the audio signal. 2571 * 2572 * Returns 0 for success else error. On error all resources can be freed 2573 * with a call to snd_soc_card_free(). 2574 */ 2575 int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm, 2576 const struct snd_soc_dapm_route *route, int num) 2577 { 2578 int i, r, ret = 0; 2579 2580 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT); 2581 for (i = 0; i < num; i++) { 2582 r = snd_soc_dapm_add_route(dapm, route); 2583 if (r < 0) { 2584 dev_err(dapm->dev, "ASoC: Failed to add route %s -> %s -> %s\n", 2585 route->source, 2586 route->control ? route->control : "direct", 2587 route->sink); 2588 ret = r; 2589 } 2590 route++; 2591 } 2592 mutex_unlock(&dapm->card->dapm_mutex); 2593 2594 return ret; 2595 } 2596 EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes); 2597 2598 /** 2599 * snd_soc_dapm_del_routes - Remove routes between DAPM widgets 2600 * @dapm: DAPM context 2601 * @route: audio routes 2602 * @num: number of routes 2603 * 2604 * Removes routes from the DAPM context. 2605 */ 2606 int snd_soc_dapm_del_routes(struct snd_soc_dapm_context *dapm, 2607 const struct snd_soc_dapm_route *route, int num) 2608 { 2609 int i, ret = 0; 2610 2611 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT); 2612 for (i = 0; i < num; i++) { 2613 snd_soc_dapm_del_route(dapm, route); 2614 route++; 2615 } 2616 mutex_unlock(&dapm->card->dapm_mutex); 2617 2618 return ret; 2619 } 2620 EXPORT_SYMBOL_GPL(snd_soc_dapm_del_routes); 2621 2622 static int snd_soc_dapm_weak_route(struct snd_soc_dapm_context *dapm, 2623 const struct snd_soc_dapm_route *route) 2624 { 2625 struct snd_soc_dapm_widget *source = dapm_find_widget(dapm, 2626 route->source, 2627 true); 2628 struct snd_soc_dapm_widget *sink = dapm_find_widget(dapm, 2629 route->sink, 2630 true); 2631 struct snd_soc_dapm_path *path; 2632 int count = 0; 2633 2634 if (!source) { 2635 dev_err(dapm->dev, "ASoC: Unable to find source %s for weak route\n", 2636 route->source); 2637 return -ENODEV; 2638 } 2639 2640 if (!sink) { 2641 dev_err(dapm->dev, "ASoC: Unable to find sink %s for weak route\n", 2642 route->sink); 2643 return -ENODEV; 2644 } 2645 2646 if (route->control || route->connected) 2647 dev_warn(dapm->dev, "ASoC: Ignoring control for weak route %s->%s\n", 2648 route->source, route->sink); 2649 2650 list_for_each_entry(path, &source->sinks, list_source) { 2651 if (path->sink == sink) { 2652 path->weak = 1; 2653 count++; 2654 } 2655 } 2656 2657 if (count == 0) 2658 dev_err(dapm->dev, "ASoC: No path found for weak route %s->%s\n", 2659 route->source, route->sink); 2660 if (count > 1) 2661 dev_warn(dapm->dev, "ASoC: %d paths found for weak route %s->%s\n", 2662 count, route->source, route->sink); 2663 2664 return 0; 2665 } 2666 2667 /** 2668 * snd_soc_dapm_weak_routes - Mark routes between DAPM widgets as weak 2669 * @dapm: DAPM context 2670 * @route: audio routes 2671 * @num: number of routes 2672 * 2673 * Mark existing routes matching those specified in the passed array 2674 * as being weak, meaning that they are ignored for the purpose of 2675 * power decisions. The main intended use case is for sidetone paths 2676 * which couple audio between other independent paths if they are both 2677 * active in order to make the combination work better at the user 2678 * level but which aren't intended to be "used". 2679 * 2680 * Note that CODEC drivers should not use this as sidetone type paths 2681 * can frequently also be used as bypass paths. 2682 */ 2683 int snd_soc_dapm_weak_routes(struct snd_soc_dapm_context *dapm, 2684 const struct snd_soc_dapm_route *route, int num) 2685 { 2686 int i, err; 2687 int ret = 0; 2688 2689 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT); 2690 for (i = 0; i < num; i++) { 2691 err = snd_soc_dapm_weak_route(dapm, route); 2692 if (err) 2693 ret = err; 2694 route++; 2695 } 2696 mutex_unlock(&dapm->card->dapm_mutex); 2697 2698 return ret; 2699 } 2700 EXPORT_SYMBOL_GPL(snd_soc_dapm_weak_routes); 2701 2702 /** 2703 * snd_soc_dapm_new_widgets - add new dapm widgets 2704 * @dapm: DAPM context 2705 * 2706 * Checks the codec for any new dapm widgets and creates them if found. 2707 * 2708 * Returns 0 for success. 2709 */ 2710 int snd_soc_dapm_new_widgets(struct snd_soc_card *card) 2711 { 2712 struct snd_soc_dapm_widget *w; 2713 unsigned int val; 2714 2715 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT); 2716 2717 list_for_each_entry(w, &card->widgets, list) 2718 { 2719 if (w->new) 2720 continue; 2721 2722 if (w->num_kcontrols) { 2723 w->kcontrols = kzalloc(w->num_kcontrols * 2724 sizeof(struct snd_kcontrol *), 2725 GFP_KERNEL); 2726 if (!w->kcontrols) { 2727 mutex_unlock(&card->dapm_mutex); 2728 return -ENOMEM; 2729 } 2730 } 2731 2732 switch(w->id) { 2733 case snd_soc_dapm_switch: 2734 case snd_soc_dapm_mixer: 2735 case snd_soc_dapm_mixer_named_ctl: 2736 dapm_new_mixer(w); 2737 break; 2738 case snd_soc_dapm_mux: 2739 dapm_new_mux(w); 2740 break; 2741 case snd_soc_dapm_pga: 2742 case snd_soc_dapm_out_drv: 2743 dapm_new_pga(w); 2744 break; 2745 case snd_soc_dapm_dai_link: 2746 dapm_new_dai_link(w); 2747 break; 2748 default: 2749 break; 2750 } 2751 2752 /* Read the initial power state from the device */ 2753 if (w->reg >= 0) { 2754 soc_dapm_read(w->dapm, w->reg, &val); 2755 val = val >> w->shift; 2756 val &= w->mask; 2757 if (val == w->on_val) 2758 w->power = 1; 2759 } 2760 2761 w->new = 1; 2762 2763 dapm_mark_dirty(w, "new widget"); 2764 dapm_debugfs_add_widget(w); 2765 } 2766 2767 dapm_power_widgets(card, SND_SOC_DAPM_STREAM_NOP); 2768 mutex_unlock(&card->dapm_mutex); 2769 return 0; 2770 } 2771 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets); 2772 2773 /** 2774 * snd_soc_dapm_get_volsw - dapm mixer get callback 2775 * @kcontrol: mixer control 2776 * @ucontrol: control element information 2777 * 2778 * Callback to get the value of a dapm mixer control. 2779 * 2780 * Returns 0 for success. 2781 */ 2782 int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol, 2783 struct snd_ctl_elem_value *ucontrol) 2784 { 2785 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol); 2786 struct snd_soc_card *card = dapm->card; 2787 struct soc_mixer_control *mc = 2788 (struct soc_mixer_control *)kcontrol->private_value; 2789 int reg = mc->reg; 2790 unsigned int shift = mc->shift; 2791 int max = mc->max; 2792 unsigned int mask = (1 << fls(max)) - 1; 2793 unsigned int invert = mc->invert; 2794 unsigned int val; 2795 int ret = 0; 2796 2797 if (snd_soc_volsw_is_stereo(mc)) 2798 dev_warn(dapm->dev, 2799 "ASoC: Control '%s' is stereo, which is not supported\n", 2800 kcontrol->id.name); 2801 2802 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 2803 if (dapm_kcontrol_is_powered(kcontrol) && reg != SND_SOC_NOPM) { 2804 ret = soc_dapm_read(dapm, reg, &val); 2805 val = (val >> shift) & mask; 2806 } else { 2807 val = dapm_kcontrol_get_value(kcontrol); 2808 } 2809 mutex_unlock(&card->dapm_mutex); 2810 2811 if (invert) 2812 ucontrol->value.integer.value[0] = max - val; 2813 else 2814 ucontrol->value.integer.value[0] = val; 2815 2816 return ret; 2817 } 2818 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw); 2819 2820 /** 2821 * snd_soc_dapm_put_volsw - dapm mixer set callback 2822 * @kcontrol: mixer control 2823 * @ucontrol: control element information 2824 * 2825 * Callback to set the value of a dapm mixer control. 2826 * 2827 * Returns 0 for success. 2828 */ 2829 int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol, 2830 struct snd_ctl_elem_value *ucontrol) 2831 { 2832 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol); 2833 struct snd_soc_card *card = dapm->card; 2834 struct soc_mixer_control *mc = 2835 (struct soc_mixer_control *)kcontrol->private_value; 2836 int reg = mc->reg; 2837 unsigned int shift = mc->shift; 2838 int max = mc->max; 2839 unsigned int mask = (1 << fls(max)) - 1; 2840 unsigned int invert = mc->invert; 2841 unsigned int val; 2842 int connect, change, reg_change = 0; 2843 struct snd_soc_dapm_update update; 2844 int ret = 0; 2845 2846 if (snd_soc_volsw_is_stereo(mc)) 2847 dev_warn(dapm->dev, 2848 "ASoC: Control '%s' is stereo, which is not supported\n", 2849 kcontrol->id.name); 2850 2851 val = (ucontrol->value.integer.value[0] & mask); 2852 connect = !!val; 2853 2854 if (invert) 2855 val = max - val; 2856 2857 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 2858 2859 change = dapm_kcontrol_set_value(kcontrol, val); 2860 2861 if (reg != SND_SOC_NOPM) { 2862 mask = mask << shift; 2863 val = val << shift; 2864 2865 reg_change = soc_dapm_test_bits(dapm, reg, mask, val); 2866 } 2867 2868 if (change || reg_change) { 2869 if (reg_change) { 2870 update.kcontrol = kcontrol; 2871 update.reg = reg; 2872 update.mask = mask; 2873 update.val = val; 2874 card->update = &update; 2875 } 2876 change |= reg_change; 2877 2878 ret = soc_dapm_mixer_update_power(card, kcontrol, connect); 2879 2880 card->update = NULL; 2881 } 2882 2883 mutex_unlock(&card->dapm_mutex); 2884 2885 if (ret > 0) 2886 soc_dpcm_runtime_update(card); 2887 2888 return change; 2889 } 2890 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw); 2891 2892 /** 2893 * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback 2894 * @kcontrol: mixer control 2895 * @ucontrol: control element information 2896 * 2897 * Callback to get the value of a dapm enumerated double mixer control. 2898 * 2899 * Returns 0 for success. 2900 */ 2901 int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol, 2902 struct snd_ctl_elem_value *ucontrol) 2903 { 2904 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol); 2905 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2906 unsigned int reg_val, val; 2907 2908 if (e->reg != SND_SOC_NOPM) { 2909 int ret = soc_dapm_read(dapm, e->reg, ®_val); 2910 if (ret) 2911 return ret; 2912 } else { 2913 reg_val = dapm_kcontrol_get_value(kcontrol); 2914 } 2915 2916 val = (reg_val >> e->shift_l) & e->mask; 2917 ucontrol->value.enumerated.item[0] = snd_soc_enum_val_to_item(e, val); 2918 if (e->shift_l != e->shift_r) { 2919 val = (reg_val >> e->shift_r) & e->mask; 2920 val = snd_soc_enum_val_to_item(e, val); 2921 ucontrol->value.enumerated.item[1] = val; 2922 } 2923 2924 return 0; 2925 } 2926 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double); 2927 2928 /** 2929 * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback 2930 * @kcontrol: mixer control 2931 * @ucontrol: control element information 2932 * 2933 * Callback to set the value of a dapm enumerated double mixer control. 2934 * 2935 * Returns 0 for success. 2936 */ 2937 int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol, 2938 struct snd_ctl_elem_value *ucontrol) 2939 { 2940 struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol); 2941 struct snd_soc_card *card = dapm->card; 2942 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 2943 unsigned int *item = ucontrol->value.enumerated.item; 2944 unsigned int val, change; 2945 unsigned int mask; 2946 struct snd_soc_dapm_update update; 2947 int ret = 0; 2948 2949 if (item[0] >= e->items) 2950 return -EINVAL; 2951 2952 val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l; 2953 mask = e->mask << e->shift_l; 2954 if (e->shift_l != e->shift_r) { 2955 if (item[1] > e->items) 2956 return -EINVAL; 2957 val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_l; 2958 mask |= e->mask << e->shift_r; 2959 } 2960 2961 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 2962 2963 if (e->reg != SND_SOC_NOPM) 2964 change = soc_dapm_test_bits(dapm, e->reg, mask, val); 2965 else 2966 change = dapm_kcontrol_set_value(kcontrol, val); 2967 2968 if (change) { 2969 if (e->reg != SND_SOC_NOPM) { 2970 update.kcontrol = kcontrol; 2971 update.reg = e->reg; 2972 update.mask = mask; 2973 update.val = val; 2974 card->update = &update; 2975 } 2976 2977 ret = soc_dapm_mux_update_power(card, kcontrol, item[0], e); 2978 2979 card->update = NULL; 2980 } 2981 2982 mutex_unlock(&card->dapm_mutex); 2983 2984 if (ret > 0) 2985 soc_dpcm_runtime_update(card); 2986 2987 return change; 2988 } 2989 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double); 2990 2991 /** 2992 * snd_soc_dapm_info_pin_switch - Info for a pin switch 2993 * 2994 * @kcontrol: mixer control 2995 * @uinfo: control element information 2996 * 2997 * Callback to provide information about a pin switch control. 2998 */ 2999 int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol, 3000 struct snd_ctl_elem_info *uinfo) 3001 { 3002 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 3003 uinfo->count = 1; 3004 uinfo->value.integer.min = 0; 3005 uinfo->value.integer.max = 1; 3006 3007 return 0; 3008 } 3009 EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch); 3010 3011 /** 3012 * snd_soc_dapm_get_pin_switch - Get information for a pin switch 3013 * 3014 * @kcontrol: mixer control 3015 * @ucontrol: Value 3016 */ 3017 int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol, 3018 struct snd_ctl_elem_value *ucontrol) 3019 { 3020 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol); 3021 const char *pin = (const char *)kcontrol->private_value; 3022 3023 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3024 3025 ucontrol->value.integer.value[0] = 3026 snd_soc_dapm_get_pin_status(&card->dapm, pin); 3027 3028 mutex_unlock(&card->dapm_mutex); 3029 3030 return 0; 3031 } 3032 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch); 3033 3034 /** 3035 * snd_soc_dapm_put_pin_switch - Set information for a pin switch 3036 * 3037 * @kcontrol: mixer control 3038 * @ucontrol: Value 3039 */ 3040 int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol, 3041 struct snd_ctl_elem_value *ucontrol) 3042 { 3043 struct snd_soc_card *card = snd_kcontrol_chip(kcontrol); 3044 const char *pin = (const char *)kcontrol->private_value; 3045 3046 if (ucontrol->value.integer.value[0]) 3047 snd_soc_dapm_enable_pin(&card->dapm, pin); 3048 else 3049 snd_soc_dapm_disable_pin(&card->dapm, pin); 3050 3051 snd_soc_dapm_sync(&card->dapm); 3052 return 0; 3053 } 3054 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch); 3055 3056 static struct snd_soc_dapm_widget * 3057 snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm, 3058 const struct snd_soc_dapm_widget *widget) 3059 { 3060 struct snd_soc_dapm_widget *w; 3061 const char *prefix; 3062 int ret; 3063 3064 if ((w = dapm_cnew_widget(widget)) == NULL) 3065 return NULL; 3066 3067 switch (w->id) { 3068 case snd_soc_dapm_regulator_supply: 3069 w->regulator = devm_regulator_get(dapm->dev, w->name); 3070 if (IS_ERR(w->regulator)) { 3071 ret = PTR_ERR(w->regulator); 3072 dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n", 3073 w->name, ret); 3074 return NULL; 3075 } 3076 3077 if (w->on_val & SND_SOC_DAPM_REGULATOR_BYPASS) { 3078 ret = regulator_allow_bypass(w->regulator, true); 3079 if (ret != 0) 3080 dev_warn(w->dapm->dev, 3081 "ASoC: Failed to bypass %s: %d\n", 3082 w->name, ret); 3083 } 3084 break; 3085 case snd_soc_dapm_clock_supply: 3086 #ifdef CONFIG_CLKDEV_LOOKUP 3087 w->clk = devm_clk_get(dapm->dev, w->name); 3088 if (IS_ERR(w->clk)) { 3089 ret = PTR_ERR(w->clk); 3090 dev_err(dapm->dev, "ASoC: Failed to request %s: %d\n", 3091 w->name, ret); 3092 return NULL; 3093 } 3094 #else 3095 return NULL; 3096 #endif 3097 break; 3098 default: 3099 break; 3100 } 3101 3102 prefix = soc_dapm_prefix(dapm); 3103 if (prefix) 3104 w->name = kasprintf(GFP_KERNEL, "%s %s", prefix, widget->name); 3105 else 3106 w->name = kasprintf(GFP_KERNEL, "%s", widget->name); 3107 3108 if (w->name == NULL) { 3109 kfree(w); 3110 return NULL; 3111 } 3112 3113 switch (w->id) { 3114 case snd_soc_dapm_mic: 3115 w->is_source = 1; 3116 w->power_check = dapm_generic_check_power; 3117 break; 3118 case snd_soc_dapm_input: 3119 if (!dapm->card->fully_routed) 3120 w->is_source = 1; 3121 w->power_check = dapm_generic_check_power; 3122 break; 3123 case snd_soc_dapm_spk: 3124 case snd_soc_dapm_hp: 3125 w->is_sink = 1; 3126 w->power_check = dapm_generic_check_power; 3127 break; 3128 case snd_soc_dapm_output: 3129 if (!dapm->card->fully_routed) 3130 w->is_sink = 1; 3131 w->power_check = dapm_generic_check_power; 3132 break; 3133 case snd_soc_dapm_vmid: 3134 case snd_soc_dapm_siggen: 3135 w->is_source = 1; 3136 w->power_check = dapm_always_on_check_power; 3137 break; 3138 case snd_soc_dapm_mux: 3139 case snd_soc_dapm_switch: 3140 case snd_soc_dapm_mixer: 3141 case snd_soc_dapm_mixer_named_ctl: 3142 case snd_soc_dapm_adc: 3143 case snd_soc_dapm_aif_out: 3144 case snd_soc_dapm_dac: 3145 case snd_soc_dapm_aif_in: 3146 case snd_soc_dapm_pga: 3147 case snd_soc_dapm_out_drv: 3148 case snd_soc_dapm_micbias: 3149 case snd_soc_dapm_line: 3150 case snd_soc_dapm_dai_link: 3151 case snd_soc_dapm_dai_out: 3152 case snd_soc_dapm_dai_in: 3153 w->power_check = dapm_generic_check_power; 3154 break; 3155 case snd_soc_dapm_supply: 3156 case snd_soc_dapm_regulator_supply: 3157 case snd_soc_dapm_clock_supply: 3158 case snd_soc_dapm_kcontrol: 3159 w->is_supply = 1; 3160 w->power_check = dapm_supply_check_power; 3161 break; 3162 default: 3163 w->power_check = dapm_always_on_check_power; 3164 break; 3165 } 3166 3167 w->dapm = dapm; 3168 INIT_LIST_HEAD(&w->sources); 3169 INIT_LIST_HEAD(&w->sinks); 3170 INIT_LIST_HEAD(&w->list); 3171 INIT_LIST_HEAD(&w->dirty); 3172 list_add(&w->list, &dapm->card->widgets); 3173 3174 w->inputs = -1; 3175 w->outputs = -1; 3176 3177 /* machine layer set ups unconnected pins and insertions */ 3178 w->connected = 1; 3179 return w; 3180 } 3181 3182 /** 3183 * snd_soc_dapm_new_controls - create new dapm controls 3184 * @dapm: DAPM context 3185 * @widget: widget array 3186 * @num: number of widgets 3187 * 3188 * Creates new DAPM controls based upon the templates. 3189 * 3190 * Returns 0 for success else error. 3191 */ 3192 int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm, 3193 const struct snd_soc_dapm_widget *widget, 3194 int num) 3195 { 3196 struct snd_soc_dapm_widget *w; 3197 int i; 3198 int ret = 0; 3199 3200 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT); 3201 for (i = 0; i < num; i++) { 3202 w = snd_soc_dapm_new_control(dapm, widget); 3203 if (!w) { 3204 dev_err(dapm->dev, 3205 "ASoC: Failed to create DAPM control %s\n", 3206 widget->name); 3207 ret = -ENOMEM; 3208 break; 3209 } 3210 widget++; 3211 } 3212 mutex_unlock(&dapm->card->dapm_mutex); 3213 return ret; 3214 } 3215 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls); 3216 3217 static int snd_soc_dai_link_event(struct snd_soc_dapm_widget *w, 3218 struct snd_kcontrol *kcontrol, int event) 3219 { 3220 struct snd_soc_dapm_path *source_p, *sink_p; 3221 struct snd_soc_dai *source, *sink; 3222 const struct snd_soc_pcm_stream *config = w->params + w->params_select; 3223 struct snd_pcm_substream substream; 3224 struct snd_pcm_hw_params *params = NULL; 3225 u64 fmt; 3226 int ret; 3227 3228 if (WARN_ON(!config) || 3229 WARN_ON(list_empty(&w->sources) || list_empty(&w->sinks))) 3230 return -EINVAL; 3231 3232 /* We only support a single source and sink, pick the first */ 3233 source_p = list_first_entry(&w->sources, struct snd_soc_dapm_path, 3234 list_sink); 3235 sink_p = list_first_entry(&w->sinks, struct snd_soc_dapm_path, 3236 list_source); 3237 3238 if (WARN_ON(!source_p || !sink_p) || 3239 WARN_ON(!sink_p->source || !source_p->sink) || 3240 WARN_ON(!source_p->source || !sink_p->sink)) 3241 return -EINVAL; 3242 3243 source = source_p->source->priv; 3244 sink = sink_p->sink->priv; 3245 3246 /* Be a little careful as we don't want to overflow the mask array */ 3247 if (config->formats) { 3248 fmt = ffs(config->formats) - 1; 3249 } else { 3250 dev_warn(w->dapm->dev, "ASoC: Invalid format %llx specified\n", 3251 config->formats); 3252 fmt = 0; 3253 } 3254 3255 /* Currently very limited parameter selection */ 3256 params = kzalloc(sizeof(*params), GFP_KERNEL); 3257 if (!params) { 3258 ret = -ENOMEM; 3259 goto out; 3260 } 3261 snd_mask_set(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), fmt); 3262 3263 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->min = 3264 config->rate_min; 3265 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->max = 3266 config->rate_max; 3267 3268 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->min 3269 = config->channels_min; 3270 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->max 3271 = config->channels_max; 3272 3273 memset(&substream, 0, sizeof(substream)); 3274 3275 switch (event) { 3276 case SND_SOC_DAPM_PRE_PMU: 3277 substream.stream = SNDRV_PCM_STREAM_CAPTURE; 3278 ret = soc_dai_hw_params(&substream, params, source); 3279 if (ret < 0) 3280 goto out; 3281 3282 substream.stream = SNDRV_PCM_STREAM_PLAYBACK; 3283 ret = soc_dai_hw_params(&substream, params, sink); 3284 if (ret < 0) 3285 goto out; 3286 break; 3287 3288 case SND_SOC_DAPM_POST_PMU: 3289 ret = snd_soc_dai_digital_mute(sink, 0, 3290 SNDRV_PCM_STREAM_PLAYBACK); 3291 if (ret != 0 && ret != -ENOTSUPP) 3292 dev_warn(sink->dev, "ASoC: Failed to unmute: %d\n", ret); 3293 ret = 0; 3294 break; 3295 3296 case SND_SOC_DAPM_PRE_PMD: 3297 ret = snd_soc_dai_digital_mute(sink, 1, 3298 SNDRV_PCM_STREAM_PLAYBACK); 3299 if (ret != 0 && ret != -ENOTSUPP) 3300 dev_warn(sink->dev, "ASoC: Failed to mute: %d\n", ret); 3301 ret = 0; 3302 break; 3303 3304 default: 3305 WARN(1, "Unknown event %d\n", event); 3306 return -EINVAL; 3307 } 3308 3309 out: 3310 kfree(params); 3311 return ret; 3312 } 3313 3314 static int snd_soc_dapm_dai_link_get(struct snd_kcontrol *kcontrol, 3315 struct snd_ctl_elem_value *ucontrol) 3316 { 3317 struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol); 3318 3319 ucontrol->value.integer.value[0] = w->params_select; 3320 3321 return 0; 3322 } 3323 3324 static int snd_soc_dapm_dai_link_put(struct snd_kcontrol *kcontrol, 3325 struct snd_ctl_elem_value *ucontrol) 3326 { 3327 struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol); 3328 3329 /* Can't change the config when widget is already powered */ 3330 if (w->power) 3331 return -EBUSY; 3332 3333 if (ucontrol->value.integer.value[0] == w->params_select) 3334 return 0; 3335 3336 if (ucontrol->value.integer.value[0] >= w->num_params) 3337 return -EINVAL; 3338 3339 w->params_select = ucontrol->value.integer.value[0]; 3340 3341 return 0; 3342 } 3343 3344 int snd_soc_dapm_new_pcm(struct snd_soc_card *card, 3345 const struct snd_soc_pcm_stream *params, 3346 unsigned int num_params, 3347 struct snd_soc_dapm_widget *source, 3348 struct snd_soc_dapm_widget *sink) 3349 { 3350 struct snd_soc_dapm_widget template; 3351 struct snd_soc_dapm_widget *w; 3352 char *link_name; 3353 int ret, count; 3354 unsigned long private_value; 3355 const char **w_param_text; 3356 struct soc_enum w_param_enum[] = { 3357 SOC_ENUM_SINGLE(0, 0, 0, NULL), 3358 }; 3359 struct snd_kcontrol_new kcontrol_dai_link[] = { 3360 SOC_ENUM_EXT(NULL, w_param_enum[0], 3361 snd_soc_dapm_dai_link_get, 3362 snd_soc_dapm_dai_link_put), 3363 }; 3364 const struct snd_soc_pcm_stream *config = params; 3365 3366 w_param_text = devm_kcalloc(card->dev, num_params, 3367 sizeof(char *), GFP_KERNEL); 3368 if (!w_param_text) 3369 return -ENOMEM; 3370 3371 link_name = devm_kasprintf(card->dev, GFP_KERNEL, "%s-%s", 3372 source->name, sink->name); 3373 if (!link_name) { 3374 ret = -ENOMEM; 3375 goto outfree_w_param; 3376 } 3377 3378 for (count = 0 ; count < num_params; count++) { 3379 if (!config->stream_name) { 3380 dev_warn(card->dapm.dev, 3381 "ASoC: anonymous config %d for dai link %s\n", 3382 count, link_name); 3383 w_param_text[count] = 3384 devm_kasprintf(card->dev, GFP_KERNEL, 3385 "Anonymous Configuration %d", 3386 count); 3387 if (!w_param_text[count]) { 3388 ret = -ENOMEM; 3389 goto outfree_link_name; 3390 } 3391 } else { 3392 w_param_text[count] = devm_kmemdup(card->dev, 3393 config->stream_name, 3394 strlen(config->stream_name) + 1, 3395 GFP_KERNEL); 3396 if (!w_param_text[count]) { 3397 ret = -ENOMEM; 3398 goto outfree_link_name; 3399 } 3400 } 3401 config++; 3402 } 3403 w_param_enum[0].items = num_params; 3404 w_param_enum[0].texts = w_param_text; 3405 3406 memset(&template, 0, sizeof(template)); 3407 template.reg = SND_SOC_NOPM; 3408 template.id = snd_soc_dapm_dai_link; 3409 template.name = link_name; 3410 template.event = snd_soc_dai_link_event; 3411 template.event_flags = SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | 3412 SND_SOC_DAPM_PRE_PMD; 3413 template.num_kcontrols = 1; 3414 /* duplicate w_param_enum on heap so that memory persists */ 3415 private_value = 3416 (unsigned long) devm_kmemdup(card->dev, 3417 (void *)(kcontrol_dai_link[0].private_value), 3418 sizeof(struct soc_enum), GFP_KERNEL); 3419 if (!private_value) { 3420 dev_err(card->dev, "ASoC: Failed to create control for %s widget\n", 3421 link_name); 3422 ret = -ENOMEM; 3423 goto outfree_link_name; 3424 } 3425 kcontrol_dai_link[0].private_value = private_value; 3426 /* duplicate kcontrol_dai_link on heap so that memory persists */ 3427 template.kcontrol_news = 3428 devm_kmemdup(card->dev, &kcontrol_dai_link[0], 3429 sizeof(struct snd_kcontrol_new), 3430 GFP_KERNEL); 3431 if (!template.kcontrol_news) { 3432 dev_err(card->dev, "ASoC: Failed to create control for %s widget\n", 3433 link_name); 3434 ret = -ENOMEM; 3435 goto outfree_private_value; 3436 } 3437 3438 dev_dbg(card->dev, "ASoC: adding %s widget\n", link_name); 3439 3440 w = snd_soc_dapm_new_control(&card->dapm, &template); 3441 if (!w) { 3442 dev_err(card->dev, "ASoC: Failed to create %s widget\n", 3443 link_name); 3444 ret = -ENOMEM; 3445 goto outfree_kcontrol_news; 3446 } 3447 3448 w->params = params; 3449 w->num_params = num_params; 3450 3451 ret = snd_soc_dapm_add_path(&card->dapm, source, w, NULL, NULL); 3452 if (ret) 3453 goto outfree_w; 3454 return snd_soc_dapm_add_path(&card->dapm, w, sink, NULL, NULL); 3455 3456 outfree_w: 3457 devm_kfree(card->dev, w); 3458 outfree_kcontrol_news: 3459 devm_kfree(card->dev, (void *)template.kcontrol_news); 3460 outfree_private_value: 3461 devm_kfree(card->dev, (void *)private_value); 3462 outfree_link_name: 3463 devm_kfree(card->dev, link_name); 3464 outfree_w_param: 3465 for (count = 0 ; count < num_params; count++) 3466 devm_kfree(card->dev, (void *)w_param_text[count]); 3467 devm_kfree(card->dev, w_param_text); 3468 3469 return ret; 3470 } 3471 3472 int snd_soc_dapm_new_dai_widgets(struct snd_soc_dapm_context *dapm, 3473 struct snd_soc_dai *dai) 3474 { 3475 struct snd_soc_dapm_widget template; 3476 struct snd_soc_dapm_widget *w; 3477 3478 WARN_ON(dapm->dev != dai->dev); 3479 3480 memset(&template, 0, sizeof(template)); 3481 template.reg = SND_SOC_NOPM; 3482 3483 if (dai->driver->playback.stream_name) { 3484 template.id = snd_soc_dapm_dai_in; 3485 template.name = dai->driver->playback.stream_name; 3486 template.sname = dai->driver->playback.stream_name; 3487 3488 dev_dbg(dai->dev, "ASoC: adding %s widget\n", 3489 template.name); 3490 3491 w = snd_soc_dapm_new_control(dapm, &template); 3492 if (!w) { 3493 dev_err(dapm->dev, "ASoC: Failed to create %s widget\n", 3494 dai->driver->playback.stream_name); 3495 return -ENOMEM; 3496 } 3497 3498 w->priv = dai; 3499 dai->playback_widget = w; 3500 } 3501 3502 if (dai->driver->capture.stream_name) { 3503 template.id = snd_soc_dapm_dai_out; 3504 template.name = dai->driver->capture.stream_name; 3505 template.sname = dai->driver->capture.stream_name; 3506 3507 dev_dbg(dai->dev, "ASoC: adding %s widget\n", 3508 template.name); 3509 3510 w = snd_soc_dapm_new_control(dapm, &template); 3511 if (!w) { 3512 dev_err(dapm->dev, "ASoC: Failed to create %s widget\n", 3513 dai->driver->capture.stream_name); 3514 return -ENOMEM; 3515 } 3516 3517 w->priv = dai; 3518 dai->capture_widget = w; 3519 } 3520 3521 return 0; 3522 } 3523 3524 int snd_soc_dapm_link_dai_widgets(struct snd_soc_card *card) 3525 { 3526 struct snd_soc_dapm_widget *dai_w, *w; 3527 struct snd_soc_dapm_widget *src, *sink; 3528 struct snd_soc_dai *dai; 3529 3530 /* For each DAI widget... */ 3531 list_for_each_entry(dai_w, &card->widgets, list) { 3532 switch (dai_w->id) { 3533 case snd_soc_dapm_dai_in: 3534 case snd_soc_dapm_dai_out: 3535 break; 3536 default: 3537 continue; 3538 } 3539 3540 dai = dai_w->priv; 3541 3542 /* ...find all widgets with the same stream and link them */ 3543 list_for_each_entry(w, &card->widgets, list) { 3544 if (w->dapm != dai_w->dapm) 3545 continue; 3546 3547 switch (w->id) { 3548 case snd_soc_dapm_dai_in: 3549 case snd_soc_dapm_dai_out: 3550 continue; 3551 default: 3552 break; 3553 } 3554 3555 if (!w->sname || !strstr(w->sname, dai_w->name)) 3556 continue; 3557 3558 if (dai_w->id == snd_soc_dapm_dai_in) { 3559 src = dai_w; 3560 sink = w; 3561 } else { 3562 src = w; 3563 sink = dai_w; 3564 } 3565 dev_dbg(dai->dev, "%s -> %s\n", src->name, sink->name); 3566 snd_soc_dapm_add_path(w->dapm, src, sink, NULL, NULL); 3567 } 3568 } 3569 3570 return 0; 3571 } 3572 3573 static void dapm_connect_dai_link_widgets(struct snd_soc_card *card, 3574 struct snd_soc_pcm_runtime *rtd) 3575 { 3576 struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 3577 struct snd_soc_dapm_widget *sink, *source; 3578 int i; 3579 3580 for (i = 0; i < rtd->num_codecs; i++) { 3581 struct snd_soc_dai *codec_dai = rtd->codec_dais[i]; 3582 3583 /* there is no point in connecting BE DAI links with dummies */ 3584 if (snd_soc_dai_is_dummy(codec_dai) || 3585 snd_soc_dai_is_dummy(cpu_dai)) 3586 continue; 3587 3588 /* connect BE DAI playback if widgets are valid */ 3589 if (codec_dai->playback_widget && cpu_dai->playback_widget) { 3590 source = cpu_dai->playback_widget; 3591 sink = codec_dai->playback_widget; 3592 dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n", 3593 cpu_dai->component->name, source->name, 3594 codec_dai->component->name, sink->name); 3595 3596 snd_soc_dapm_add_path(&card->dapm, source, sink, 3597 NULL, NULL); 3598 } 3599 3600 /* connect BE DAI capture if widgets are valid */ 3601 if (codec_dai->capture_widget && cpu_dai->capture_widget) { 3602 source = codec_dai->capture_widget; 3603 sink = cpu_dai->capture_widget; 3604 dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n", 3605 codec_dai->component->name, source->name, 3606 cpu_dai->component->name, sink->name); 3607 3608 snd_soc_dapm_add_path(&card->dapm, source, sink, 3609 NULL, NULL); 3610 } 3611 } 3612 } 3613 3614 static void soc_dapm_dai_stream_event(struct snd_soc_dai *dai, int stream, 3615 int event) 3616 { 3617 struct snd_soc_dapm_widget *w; 3618 3619 if (stream == SNDRV_PCM_STREAM_PLAYBACK) 3620 w = dai->playback_widget; 3621 else 3622 w = dai->capture_widget; 3623 3624 if (w) { 3625 dapm_mark_dirty(w, "stream event"); 3626 3627 switch (event) { 3628 case SND_SOC_DAPM_STREAM_START: 3629 w->active = 1; 3630 break; 3631 case SND_SOC_DAPM_STREAM_STOP: 3632 w->active = 0; 3633 break; 3634 case SND_SOC_DAPM_STREAM_SUSPEND: 3635 case SND_SOC_DAPM_STREAM_RESUME: 3636 case SND_SOC_DAPM_STREAM_PAUSE_PUSH: 3637 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE: 3638 break; 3639 } 3640 3641 if (w->id == snd_soc_dapm_dai_in) { 3642 w->is_source = w->active; 3643 dapm_widget_invalidate_input_paths(w); 3644 } else { 3645 w->is_sink = w->active; 3646 dapm_widget_invalidate_output_paths(w); 3647 } 3648 } 3649 } 3650 3651 void snd_soc_dapm_connect_dai_link_widgets(struct snd_soc_card *card) 3652 { 3653 struct snd_soc_pcm_runtime *rtd = card->rtd; 3654 int i; 3655 3656 /* for each BE DAI link... */ 3657 for (i = 0; i < card->num_rtd; i++) { 3658 rtd = &card->rtd[i]; 3659 3660 /* 3661 * dynamic FE links have no fixed DAI mapping. 3662 * CODEC<->CODEC links have no direct connection. 3663 */ 3664 if (rtd->dai_link->dynamic || rtd->dai_link->params) 3665 continue; 3666 3667 dapm_connect_dai_link_widgets(card, rtd); 3668 } 3669 } 3670 3671 static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream, 3672 int event) 3673 { 3674 int i; 3675 3676 soc_dapm_dai_stream_event(rtd->cpu_dai, stream, event); 3677 for (i = 0; i < rtd->num_codecs; i++) 3678 soc_dapm_dai_stream_event(rtd->codec_dais[i], stream, event); 3679 3680 dapm_power_widgets(rtd->card, event); 3681 } 3682 3683 /** 3684 * snd_soc_dapm_stream_event - send a stream event to the dapm core 3685 * @rtd: PCM runtime data 3686 * @stream: stream name 3687 * @event: stream event 3688 * 3689 * Sends a stream event to the dapm core. The core then makes any 3690 * necessary widget power changes. 3691 * 3692 * Returns 0 for success else error. 3693 */ 3694 void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream, 3695 int event) 3696 { 3697 struct snd_soc_card *card = rtd->card; 3698 3699 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3700 soc_dapm_stream_event(rtd, stream, event); 3701 mutex_unlock(&card->dapm_mutex); 3702 } 3703 3704 /** 3705 * snd_soc_dapm_enable_pin_unlocked - enable pin. 3706 * @dapm: DAPM context 3707 * @pin: pin name 3708 * 3709 * Enables input/output pin and its parents or children widgets iff there is 3710 * a valid audio route and active audio stream. 3711 * 3712 * Requires external locking. 3713 * 3714 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3715 * do any widget power switching. 3716 */ 3717 int snd_soc_dapm_enable_pin_unlocked(struct snd_soc_dapm_context *dapm, 3718 const char *pin) 3719 { 3720 return snd_soc_dapm_set_pin(dapm, pin, 1); 3721 } 3722 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin_unlocked); 3723 3724 /** 3725 * snd_soc_dapm_enable_pin - enable pin. 3726 * @dapm: DAPM context 3727 * @pin: pin name 3728 * 3729 * Enables input/output pin and its parents or children widgets iff there is 3730 * a valid audio route and active audio stream. 3731 * 3732 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3733 * do any widget power switching. 3734 */ 3735 int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin) 3736 { 3737 int ret; 3738 3739 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3740 3741 ret = snd_soc_dapm_set_pin(dapm, pin, 1); 3742 3743 mutex_unlock(&dapm->card->dapm_mutex); 3744 3745 return ret; 3746 } 3747 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin); 3748 3749 /** 3750 * snd_soc_dapm_force_enable_pin_unlocked - force a pin to be enabled 3751 * @dapm: DAPM context 3752 * @pin: pin name 3753 * 3754 * Enables input/output pin regardless of any other state. This is 3755 * intended for use with microphone bias supplies used in microphone 3756 * jack detection. 3757 * 3758 * Requires external locking. 3759 * 3760 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3761 * do any widget power switching. 3762 */ 3763 int snd_soc_dapm_force_enable_pin_unlocked(struct snd_soc_dapm_context *dapm, 3764 const char *pin) 3765 { 3766 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true); 3767 3768 if (!w) { 3769 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin); 3770 return -EINVAL; 3771 } 3772 3773 dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin); 3774 if (!w->connected) { 3775 /* 3776 * w->force does not affect the number of input or output paths, 3777 * so we only have to recheck if w->connected is changed 3778 */ 3779 dapm_widget_invalidate_input_paths(w); 3780 dapm_widget_invalidate_output_paths(w); 3781 w->connected = 1; 3782 } 3783 w->force = 1; 3784 dapm_mark_dirty(w, "force enable"); 3785 3786 return 0; 3787 } 3788 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin_unlocked); 3789 3790 /** 3791 * snd_soc_dapm_force_enable_pin - force a pin to be enabled 3792 * @dapm: DAPM context 3793 * @pin: pin name 3794 * 3795 * Enables input/output pin regardless of any other state. This is 3796 * intended for use with microphone bias supplies used in microphone 3797 * jack detection. 3798 * 3799 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3800 * do any widget power switching. 3801 */ 3802 int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm, 3803 const char *pin) 3804 { 3805 int ret; 3806 3807 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3808 3809 ret = snd_soc_dapm_force_enable_pin_unlocked(dapm, pin); 3810 3811 mutex_unlock(&dapm->card->dapm_mutex); 3812 3813 return ret; 3814 } 3815 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin); 3816 3817 /** 3818 * snd_soc_dapm_disable_pin_unlocked - disable pin. 3819 * @dapm: DAPM context 3820 * @pin: pin name 3821 * 3822 * Disables input/output pin and its parents or children widgets. 3823 * 3824 * Requires external locking. 3825 * 3826 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3827 * do any widget power switching. 3828 */ 3829 int snd_soc_dapm_disable_pin_unlocked(struct snd_soc_dapm_context *dapm, 3830 const char *pin) 3831 { 3832 return snd_soc_dapm_set_pin(dapm, pin, 0); 3833 } 3834 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin_unlocked); 3835 3836 /** 3837 * snd_soc_dapm_disable_pin - disable pin. 3838 * @dapm: DAPM context 3839 * @pin: pin name 3840 * 3841 * Disables input/output pin and its parents or children widgets. 3842 * 3843 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3844 * do any widget power switching. 3845 */ 3846 int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm, 3847 const char *pin) 3848 { 3849 int ret; 3850 3851 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3852 3853 ret = snd_soc_dapm_set_pin(dapm, pin, 0); 3854 3855 mutex_unlock(&dapm->card->dapm_mutex); 3856 3857 return ret; 3858 } 3859 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin); 3860 3861 /** 3862 * snd_soc_dapm_nc_pin_unlocked - permanently disable pin. 3863 * @dapm: DAPM context 3864 * @pin: pin name 3865 * 3866 * Marks the specified pin as being not connected, disabling it along 3867 * any parent or child widgets. At present this is identical to 3868 * snd_soc_dapm_disable_pin() but in future it will be extended to do 3869 * additional things such as disabling controls which only affect 3870 * paths through the pin. 3871 * 3872 * Requires external locking. 3873 * 3874 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3875 * do any widget power switching. 3876 */ 3877 int snd_soc_dapm_nc_pin_unlocked(struct snd_soc_dapm_context *dapm, 3878 const char *pin) 3879 { 3880 return snd_soc_dapm_set_pin(dapm, pin, 0); 3881 } 3882 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin_unlocked); 3883 3884 /** 3885 * snd_soc_dapm_nc_pin - permanently disable pin. 3886 * @dapm: DAPM context 3887 * @pin: pin name 3888 * 3889 * Marks the specified pin as being not connected, disabling it along 3890 * any parent or child widgets. At present this is identical to 3891 * snd_soc_dapm_disable_pin() but in future it will be extended to do 3892 * additional things such as disabling controls which only affect 3893 * paths through the pin. 3894 * 3895 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3896 * do any widget power switching. 3897 */ 3898 int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin) 3899 { 3900 int ret; 3901 3902 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3903 3904 ret = snd_soc_dapm_set_pin(dapm, pin, 0); 3905 3906 mutex_unlock(&dapm->card->dapm_mutex); 3907 3908 return ret; 3909 } 3910 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin); 3911 3912 /** 3913 * snd_soc_dapm_get_pin_status - get audio pin status 3914 * @dapm: DAPM context 3915 * @pin: audio signal pin endpoint (or start point) 3916 * 3917 * Get audio pin status - connected or disconnected. 3918 * 3919 * Returns 1 for connected otherwise 0. 3920 */ 3921 int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm, 3922 const char *pin) 3923 { 3924 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true); 3925 3926 if (w) 3927 return w->connected; 3928 3929 return 0; 3930 } 3931 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status); 3932 3933 /** 3934 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint 3935 * @dapm: DAPM context 3936 * @pin: audio signal pin endpoint (or start point) 3937 * 3938 * Mark the given endpoint or pin as ignoring suspend. When the 3939 * system is disabled a path between two endpoints flagged as ignoring 3940 * suspend will not be disabled. The path must already be enabled via 3941 * normal means at suspend time, it will not be turned on if it was not 3942 * already enabled. 3943 */ 3944 int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm, 3945 const char *pin) 3946 { 3947 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false); 3948 3949 if (!w) { 3950 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin); 3951 return -EINVAL; 3952 } 3953 3954 w->ignore_suspend = 1; 3955 3956 return 0; 3957 } 3958 EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend); 3959 3960 /** 3961 * snd_soc_dapm_free - free dapm resources 3962 * @dapm: DAPM context 3963 * 3964 * Free all dapm widgets and resources. 3965 */ 3966 void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm) 3967 { 3968 dapm_debugfs_cleanup(dapm); 3969 dapm_free_widgets(dapm); 3970 list_del(&dapm->list); 3971 } 3972 EXPORT_SYMBOL_GPL(snd_soc_dapm_free); 3973 3974 static void soc_dapm_shutdown_dapm(struct snd_soc_dapm_context *dapm) 3975 { 3976 struct snd_soc_card *card = dapm->card; 3977 struct snd_soc_dapm_widget *w; 3978 LIST_HEAD(down_list); 3979 int powerdown = 0; 3980 3981 mutex_lock(&card->dapm_mutex); 3982 3983 list_for_each_entry(w, &dapm->card->widgets, list) { 3984 if (w->dapm != dapm) 3985 continue; 3986 if (w->power) { 3987 dapm_seq_insert(w, &down_list, false); 3988 w->power = 0; 3989 powerdown = 1; 3990 } 3991 } 3992 3993 /* If there were no widgets to power down we're already in 3994 * standby. 3995 */ 3996 if (powerdown) { 3997 if (dapm->bias_level == SND_SOC_BIAS_ON) 3998 snd_soc_dapm_set_bias_level(dapm, 3999 SND_SOC_BIAS_PREPARE); 4000 dapm_seq_run(card, &down_list, 0, false); 4001 if (dapm->bias_level == SND_SOC_BIAS_PREPARE) 4002 snd_soc_dapm_set_bias_level(dapm, 4003 SND_SOC_BIAS_STANDBY); 4004 } 4005 4006 mutex_unlock(&card->dapm_mutex); 4007 } 4008 4009 /* 4010 * snd_soc_dapm_shutdown - callback for system shutdown 4011 */ 4012 void snd_soc_dapm_shutdown(struct snd_soc_card *card) 4013 { 4014 struct snd_soc_dapm_context *dapm; 4015 4016 list_for_each_entry(dapm, &card->dapm_list, list) { 4017 if (dapm != &card->dapm) { 4018 soc_dapm_shutdown_dapm(dapm); 4019 if (dapm->bias_level == SND_SOC_BIAS_STANDBY) 4020 snd_soc_dapm_set_bias_level(dapm, 4021 SND_SOC_BIAS_OFF); 4022 } 4023 } 4024 4025 soc_dapm_shutdown_dapm(&card->dapm); 4026 if (card->dapm.bias_level == SND_SOC_BIAS_STANDBY) 4027 snd_soc_dapm_set_bias_level(&card->dapm, 4028 SND_SOC_BIAS_OFF); 4029 } 4030 4031 /* Module information */ 4032 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk"); 4033 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC"); 4034 MODULE_LICENSE("GPL"); 4035