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 if (widget->sname) 3106 w->sname = kasprintf(GFP_KERNEL, "%s %s", prefix, 3107 widget->sname); 3108 } else { 3109 w->name = kasprintf(GFP_KERNEL, "%s", widget->name); 3110 if (widget->sname) 3111 w->sname = kasprintf(GFP_KERNEL, "%s", widget->sname); 3112 } 3113 if (w->name == NULL) { 3114 kfree(w); 3115 return NULL; 3116 } 3117 3118 switch (w->id) { 3119 case snd_soc_dapm_mic: 3120 w->is_source = 1; 3121 w->power_check = dapm_generic_check_power; 3122 break; 3123 case snd_soc_dapm_input: 3124 if (!dapm->card->fully_routed) 3125 w->is_source = 1; 3126 w->power_check = dapm_generic_check_power; 3127 break; 3128 case snd_soc_dapm_spk: 3129 case snd_soc_dapm_hp: 3130 w->is_sink = 1; 3131 w->power_check = dapm_generic_check_power; 3132 break; 3133 case snd_soc_dapm_output: 3134 if (!dapm->card->fully_routed) 3135 w->is_sink = 1; 3136 w->power_check = dapm_generic_check_power; 3137 break; 3138 case snd_soc_dapm_vmid: 3139 case snd_soc_dapm_siggen: 3140 w->is_source = 1; 3141 w->power_check = dapm_always_on_check_power; 3142 break; 3143 case snd_soc_dapm_mux: 3144 case snd_soc_dapm_switch: 3145 case snd_soc_dapm_mixer: 3146 case snd_soc_dapm_mixer_named_ctl: 3147 case snd_soc_dapm_adc: 3148 case snd_soc_dapm_aif_out: 3149 case snd_soc_dapm_dac: 3150 case snd_soc_dapm_aif_in: 3151 case snd_soc_dapm_pga: 3152 case snd_soc_dapm_out_drv: 3153 case snd_soc_dapm_micbias: 3154 case snd_soc_dapm_line: 3155 case snd_soc_dapm_dai_link: 3156 case snd_soc_dapm_dai_out: 3157 case snd_soc_dapm_dai_in: 3158 w->power_check = dapm_generic_check_power; 3159 break; 3160 case snd_soc_dapm_supply: 3161 case snd_soc_dapm_regulator_supply: 3162 case snd_soc_dapm_clock_supply: 3163 case snd_soc_dapm_kcontrol: 3164 w->is_supply = 1; 3165 w->power_check = dapm_supply_check_power; 3166 break; 3167 default: 3168 w->power_check = dapm_always_on_check_power; 3169 break; 3170 } 3171 3172 w->dapm = dapm; 3173 INIT_LIST_HEAD(&w->sources); 3174 INIT_LIST_HEAD(&w->sinks); 3175 INIT_LIST_HEAD(&w->list); 3176 INIT_LIST_HEAD(&w->dirty); 3177 list_add(&w->list, &dapm->card->widgets); 3178 3179 w->inputs = -1; 3180 w->outputs = -1; 3181 3182 /* machine layer set ups unconnected pins and insertions */ 3183 w->connected = 1; 3184 return w; 3185 } 3186 3187 /** 3188 * snd_soc_dapm_new_controls - create new dapm controls 3189 * @dapm: DAPM context 3190 * @widget: widget array 3191 * @num: number of widgets 3192 * 3193 * Creates new DAPM controls based upon the templates. 3194 * 3195 * Returns 0 for success else error. 3196 */ 3197 int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm, 3198 const struct snd_soc_dapm_widget *widget, 3199 int num) 3200 { 3201 struct snd_soc_dapm_widget *w; 3202 int i; 3203 int ret = 0; 3204 3205 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_INIT); 3206 for (i = 0; i < num; i++) { 3207 w = snd_soc_dapm_new_control(dapm, widget); 3208 if (!w) { 3209 dev_err(dapm->dev, 3210 "ASoC: Failed to create DAPM control %s\n", 3211 widget->name); 3212 ret = -ENOMEM; 3213 break; 3214 } 3215 widget++; 3216 } 3217 mutex_unlock(&dapm->card->dapm_mutex); 3218 return ret; 3219 } 3220 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls); 3221 3222 static int snd_soc_dai_link_event(struct snd_soc_dapm_widget *w, 3223 struct snd_kcontrol *kcontrol, int event) 3224 { 3225 struct snd_soc_dapm_path *source_p, *sink_p; 3226 struct snd_soc_dai *source, *sink; 3227 const struct snd_soc_pcm_stream *config = w->params + w->params_select; 3228 struct snd_pcm_substream substream; 3229 struct snd_pcm_hw_params *params = NULL; 3230 u64 fmt; 3231 int ret; 3232 3233 if (WARN_ON(!config) || 3234 WARN_ON(list_empty(&w->sources) || list_empty(&w->sinks))) 3235 return -EINVAL; 3236 3237 /* We only support a single source and sink, pick the first */ 3238 source_p = list_first_entry(&w->sources, struct snd_soc_dapm_path, 3239 list_sink); 3240 sink_p = list_first_entry(&w->sinks, struct snd_soc_dapm_path, 3241 list_source); 3242 3243 if (WARN_ON(!source_p || !sink_p) || 3244 WARN_ON(!sink_p->source || !source_p->sink) || 3245 WARN_ON(!source_p->source || !sink_p->sink)) 3246 return -EINVAL; 3247 3248 source = source_p->source->priv; 3249 sink = sink_p->sink->priv; 3250 3251 /* Be a little careful as we don't want to overflow the mask array */ 3252 if (config->formats) { 3253 fmt = ffs(config->formats) - 1; 3254 } else { 3255 dev_warn(w->dapm->dev, "ASoC: Invalid format %llx specified\n", 3256 config->formats); 3257 fmt = 0; 3258 } 3259 3260 /* Currently very limited parameter selection */ 3261 params = kzalloc(sizeof(*params), GFP_KERNEL); 3262 if (!params) { 3263 ret = -ENOMEM; 3264 goto out; 3265 } 3266 snd_mask_set(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), fmt); 3267 3268 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->min = 3269 config->rate_min; 3270 hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE)->max = 3271 config->rate_max; 3272 3273 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->min 3274 = config->channels_min; 3275 hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS)->max 3276 = config->channels_max; 3277 3278 memset(&substream, 0, sizeof(substream)); 3279 3280 switch (event) { 3281 case SND_SOC_DAPM_PRE_PMU: 3282 substream.stream = SNDRV_PCM_STREAM_CAPTURE; 3283 ret = soc_dai_hw_params(&substream, params, source); 3284 if (ret < 0) 3285 goto out; 3286 3287 substream.stream = SNDRV_PCM_STREAM_PLAYBACK; 3288 ret = soc_dai_hw_params(&substream, params, sink); 3289 if (ret < 0) 3290 goto out; 3291 break; 3292 3293 case SND_SOC_DAPM_POST_PMU: 3294 ret = snd_soc_dai_digital_mute(sink, 0, 3295 SNDRV_PCM_STREAM_PLAYBACK); 3296 if (ret != 0 && ret != -ENOTSUPP) 3297 dev_warn(sink->dev, "ASoC: Failed to unmute: %d\n", ret); 3298 ret = 0; 3299 break; 3300 3301 case SND_SOC_DAPM_PRE_PMD: 3302 ret = snd_soc_dai_digital_mute(sink, 1, 3303 SNDRV_PCM_STREAM_PLAYBACK); 3304 if (ret != 0 && ret != -ENOTSUPP) 3305 dev_warn(sink->dev, "ASoC: Failed to mute: %d\n", ret); 3306 ret = 0; 3307 break; 3308 3309 default: 3310 WARN(1, "Unknown event %d\n", event); 3311 return -EINVAL; 3312 } 3313 3314 out: 3315 kfree(params); 3316 return ret; 3317 } 3318 3319 static int snd_soc_dapm_dai_link_get(struct snd_kcontrol *kcontrol, 3320 struct snd_ctl_elem_value *ucontrol) 3321 { 3322 struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol); 3323 3324 ucontrol->value.integer.value[0] = w->params_select; 3325 3326 return 0; 3327 } 3328 3329 static int snd_soc_dapm_dai_link_put(struct snd_kcontrol *kcontrol, 3330 struct snd_ctl_elem_value *ucontrol) 3331 { 3332 struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol); 3333 3334 /* Can't change the config when widget is already powered */ 3335 if (w->power) 3336 return -EBUSY; 3337 3338 if (ucontrol->value.integer.value[0] == w->params_select) 3339 return 0; 3340 3341 if (ucontrol->value.integer.value[0] >= w->num_params) 3342 return -EINVAL; 3343 3344 w->params_select = ucontrol->value.integer.value[0]; 3345 3346 return 0; 3347 } 3348 3349 int snd_soc_dapm_new_pcm(struct snd_soc_card *card, 3350 const struct snd_soc_pcm_stream *params, 3351 unsigned int num_params, 3352 struct snd_soc_dapm_widget *source, 3353 struct snd_soc_dapm_widget *sink) 3354 { 3355 struct snd_soc_dapm_widget template; 3356 struct snd_soc_dapm_widget *w; 3357 char *link_name; 3358 int ret, count; 3359 unsigned long private_value; 3360 const char **w_param_text; 3361 struct soc_enum w_param_enum[] = { 3362 SOC_ENUM_SINGLE(0, 0, 0, NULL), 3363 }; 3364 struct snd_kcontrol_new kcontrol_dai_link[] = { 3365 SOC_ENUM_EXT(NULL, w_param_enum[0], 3366 snd_soc_dapm_dai_link_get, 3367 snd_soc_dapm_dai_link_put), 3368 }; 3369 const struct snd_soc_pcm_stream *config = params; 3370 3371 w_param_text = devm_kcalloc(card->dev, num_params, 3372 sizeof(char *), GFP_KERNEL); 3373 if (!w_param_text) 3374 return -ENOMEM; 3375 3376 link_name = devm_kasprintf(card->dev, GFP_KERNEL, "%s-%s", 3377 source->name, sink->name); 3378 if (!link_name) { 3379 ret = -ENOMEM; 3380 goto outfree_w_param; 3381 } 3382 3383 for (count = 0 ; count < num_params; count++) { 3384 if (!config->stream_name) { 3385 dev_warn(card->dapm.dev, 3386 "ASoC: anonymous config %d for dai link %s\n", 3387 count, link_name); 3388 w_param_text[count] = 3389 devm_kasprintf(card->dev, GFP_KERNEL, 3390 "Anonymous Configuration %d", 3391 count); 3392 if (!w_param_text[count]) { 3393 ret = -ENOMEM; 3394 goto outfree_link_name; 3395 } 3396 } else { 3397 w_param_text[count] = devm_kmemdup(card->dev, 3398 config->stream_name, 3399 strlen(config->stream_name) + 1, 3400 GFP_KERNEL); 3401 if (!w_param_text[count]) { 3402 ret = -ENOMEM; 3403 goto outfree_link_name; 3404 } 3405 } 3406 config++; 3407 } 3408 w_param_enum[0].items = num_params; 3409 w_param_enum[0].texts = w_param_text; 3410 3411 memset(&template, 0, sizeof(template)); 3412 template.reg = SND_SOC_NOPM; 3413 template.id = snd_soc_dapm_dai_link; 3414 template.name = link_name; 3415 template.event = snd_soc_dai_link_event; 3416 template.event_flags = SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | 3417 SND_SOC_DAPM_PRE_PMD; 3418 template.num_kcontrols = 1; 3419 /* duplicate w_param_enum on heap so that memory persists */ 3420 private_value = 3421 (unsigned long) devm_kmemdup(card->dev, 3422 (void *)(kcontrol_dai_link[0].private_value), 3423 sizeof(struct soc_enum), GFP_KERNEL); 3424 if (!private_value) { 3425 dev_err(card->dev, "ASoC: Failed to create control for %s widget\n", 3426 link_name); 3427 ret = -ENOMEM; 3428 goto outfree_link_name; 3429 } 3430 kcontrol_dai_link[0].private_value = private_value; 3431 /* duplicate kcontrol_dai_link on heap so that memory persists */ 3432 template.kcontrol_news = 3433 devm_kmemdup(card->dev, &kcontrol_dai_link[0], 3434 sizeof(struct snd_kcontrol_new), 3435 GFP_KERNEL); 3436 if (!template.kcontrol_news) { 3437 dev_err(card->dev, "ASoC: Failed to create control for %s widget\n", 3438 link_name); 3439 ret = -ENOMEM; 3440 goto outfree_private_value; 3441 } 3442 3443 dev_dbg(card->dev, "ASoC: adding %s widget\n", link_name); 3444 3445 w = snd_soc_dapm_new_control(&card->dapm, &template); 3446 if (!w) { 3447 dev_err(card->dev, "ASoC: Failed to create %s widget\n", 3448 link_name); 3449 ret = -ENOMEM; 3450 goto outfree_kcontrol_news; 3451 } 3452 3453 w->params = params; 3454 w->num_params = num_params; 3455 3456 ret = snd_soc_dapm_add_path(&card->dapm, source, w, NULL, NULL); 3457 if (ret) 3458 goto outfree_w; 3459 return snd_soc_dapm_add_path(&card->dapm, w, sink, NULL, NULL); 3460 3461 outfree_w: 3462 devm_kfree(card->dev, w); 3463 outfree_kcontrol_news: 3464 devm_kfree(card->dev, (void *)template.kcontrol_news); 3465 outfree_private_value: 3466 devm_kfree(card->dev, (void *)private_value); 3467 outfree_link_name: 3468 devm_kfree(card->dev, link_name); 3469 outfree_w_param: 3470 for (count = 0 ; count < num_params; count++) 3471 devm_kfree(card->dev, (void *)w_param_text[count]); 3472 devm_kfree(card->dev, w_param_text); 3473 3474 return ret; 3475 } 3476 3477 int snd_soc_dapm_new_dai_widgets(struct snd_soc_dapm_context *dapm, 3478 struct snd_soc_dai *dai) 3479 { 3480 struct snd_soc_dapm_widget template; 3481 struct snd_soc_dapm_widget *w; 3482 3483 WARN_ON(dapm->dev != dai->dev); 3484 3485 memset(&template, 0, sizeof(template)); 3486 template.reg = SND_SOC_NOPM; 3487 3488 if (dai->driver->playback.stream_name) { 3489 template.id = snd_soc_dapm_dai_in; 3490 template.name = dai->driver->playback.stream_name; 3491 template.sname = dai->driver->playback.stream_name; 3492 3493 dev_dbg(dai->dev, "ASoC: adding %s widget\n", 3494 template.name); 3495 3496 w = snd_soc_dapm_new_control(dapm, &template); 3497 if (!w) { 3498 dev_err(dapm->dev, "ASoC: Failed to create %s widget\n", 3499 dai->driver->playback.stream_name); 3500 return -ENOMEM; 3501 } 3502 3503 w->priv = dai; 3504 dai->playback_widget = w; 3505 } 3506 3507 if (dai->driver->capture.stream_name) { 3508 template.id = snd_soc_dapm_dai_out; 3509 template.name = dai->driver->capture.stream_name; 3510 template.sname = dai->driver->capture.stream_name; 3511 3512 dev_dbg(dai->dev, "ASoC: adding %s widget\n", 3513 template.name); 3514 3515 w = snd_soc_dapm_new_control(dapm, &template); 3516 if (!w) { 3517 dev_err(dapm->dev, "ASoC: Failed to create %s widget\n", 3518 dai->driver->capture.stream_name); 3519 return -ENOMEM; 3520 } 3521 3522 w->priv = dai; 3523 dai->capture_widget = w; 3524 } 3525 3526 return 0; 3527 } 3528 3529 int snd_soc_dapm_link_dai_widgets(struct snd_soc_card *card) 3530 { 3531 struct snd_soc_dapm_widget *dai_w, *w; 3532 struct snd_soc_dapm_widget *src, *sink; 3533 struct snd_soc_dai *dai; 3534 3535 /* For each DAI widget... */ 3536 list_for_each_entry(dai_w, &card->widgets, list) { 3537 switch (dai_w->id) { 3538 case snd_soc_dapm_dai_in: 3539 case snd_soc_dapm_dai_out: 3540 break; 3541 default: 3542 continue; 3543 } 3544 3545 dai = dai_w->priv; 3546 3547 /* ...find all widgets with the same stream and link them */ 3548 list_for_each_entry(w, &card->widgets, list) { 3549 if (w->dapm != dai_w->dapm) 3550 continue; 3551 3552 switch (w->id) { 3553 case snd_soc_dapm_dai_in: 3554 case snd_soc_dapm_dai_out: 3555 continue; 3556 default: 3557 break; 3558 } 3559 3560 if (!w->sname || !strstr(w->sname, dai_w->name)) 3561 continue; 3562 3563 if (dai_w->id == snd_soc_dapm_dai_in) { 3564 src = dai_w; 3565 sink = w; 3566 } else { 3567 src = w; 3568 sink = dai_w; 3569 } 3570 dev_dbg(dai->dev, "%s -> %s\n", src->name, sink->name); 3571 snd_soc_dapm_add_path(w->dapm, src, sink, NULL, NULL); 3572 } 3573 } 3574 3575 return 0; 3576 } 3577 3578 static void dapm_connect_dai_link_widgets(struct snd_soc_card *card, 3579 struct snd_soc_pcm_runtime *rtd) 3580 { 3581 struct snd_soc_dai *cpu_dai = rtd->cpu_dai; 3582 struct snd_soc_dapm_widget *sink, *source; 3583 int i; 3584 3585 for (i = 0; i < rtd->num_codecs; i++) { 3586 struct snd_soc_dai *codec_dai = rtd->codec_dais[i]; 3587 3588 /* there is no point in connecting BE DAI links with dummies */ 3589 if (snd_soc_dai_is_dummy(codec_dai) || 3590 snd_soc_dai_is_dummy(cpu_dai)) 3591 continue; 3592 3593 /* connect BE DAI playback if widgets are valid */ 3594 if (codec_dai->playback_widget && cpu_dai->playback_widget) { 3595 source = cpu_dai->playback_widget; 3596 sink = codec_dai->playback_widget; 3597 dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n", 3598 cpu_dai->component->name, source->name, 3599 codec_dai->component->name, sink->name); 3600 3601 snd_soc_dapm_add_path(&card->dapm, source, sink, 3602 NULL, NULL); 3603 } 3604 3605 /* connect BE DAI capture if widgets are valid */ 3606 if (codec_dai->capture_widget && cpu_dai->capture_widget) { 3607 source = codec_dai->capture_widget; 3608 sink = cpu_dai->capture_widget; 3609 dev_dbg(rtd->dev, "connected DAI link %s:%s -> %s:%s\n", 3610 codec_dai->component->name, source->name, 3611 cpu_dai->component->name, sink->name); 3612 3613 snd_soc_dapm_add_path(&card->dapm, source, sink, 3614 NULL, NULL); 3615 } 3616 } 3617 } 3618 3619 static void soc_dapm_dai_stream_event(struct snd_soc_dai *dai, int stream, 3620 int event) 3621 { 3622 struct snd_soc_dapm_widget *w; 3623 3624 if (stream == SNDRV_PCM_STREAM_PLAYBACK) 3625 w = dai->playback_widget; 3626 else 3627 w = dai->capture_widget; 3628 3629 if (w) { 3630 dapm_mark_dirty(w, "stream event"); 3631 3632 switch (event) { 3633 case SND_SOC_DAPM_STREAM_START: 3634 w->active = 1; 3635 break; 3636 case SND_SOC_DAPM_STREAM_STOP: 3637 w->active = 0; 3638 break; 3639 case SND_SOC_DAPM_STREAM_SUSPEND: 3640 case SND_SOC_DAPM_STREAM_RESUME: 3641 case SND_SOC_DAPM_STREAM_PAUSE_PUSH: 3642 case SND_SOC_DAPM_STREAM_PAUSE_RELEASE: 3643 break; 3644 } 3645 3646 if (w->id == snd_soc_dapm_dai_in) { 3647 w->is_source = w->active; 3648 dapm_widget_invalidate_input_paths(w); 3649 } else { 3650 w->is_sink = w->active; 3651 dapm_widget_invalidate_output_paths(w); 3652 } 3653 } 3654 } 3655 3656 void snd_soc_dapm_connect_dai_link_widgets(struct snd_soc_card *card) 3657 { 3658 struct snd_soc_pcm_runtime *rtd = card->rtd; 3659 int i; 3660 3661 /* for each BE DAI link... */ 3662 for (i = 0; i < card->num_rtd; i++) { 3663 rtd = &card->rtd[i]; 3664 3665 /* 3666 * dynamic FE links have no fixed DAI mapping. 3667 * CODEC<->CODEC links have no direct connection. 3668 */ 3669 if (rtd->dai_link->dynamic || rtd->dai_link->params) 3670 continue; 3671 3672 dapm_connect_dai_link_widgets(card, rtd); 3673 } 3674 } 3675 3676 static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream, 3677 int event) 3678 { 3679 int i; 3680 3681 soc_dapm_dai_stream_event(rtd->cpu_dai, stream, event); 3682 for (i = 0; i < rtd->num_codecs; i++) 3683 soc_dapm_dai_stream_event(rtd->codec_dais[i], stream, event); 3684 3685 dapm_power_widgets(rtd->card, event); 3686 } 3687 3688 /** 3689 * snd_soc_dapm_stream_event - send a stream event to the dapm core 3690 * @rtd: PCM runtime data 3691 * @stream: stream name 3692 * @event: stream event 3693 * 3694 * Sends a stream event to the dapm core. The core then makes any 3695 * necessary widget power changes. 3696 * 3697 * Returns 0 for success else error. 3698 */ 3699 void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream, 3700 int event) 3701 { 3702 struct snd_soc_card *card = rtd->card; 3703 3704 mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3705 soc_dapm_stream_event(rtd, stream, event); 3706 mutex_unlock(&card->dapm_mutex); 3707 } 3708 3709 /** 3710 * snd_soc_dapm_enable_pin_unlocked - enable pin. 3711 * @dapm: DAPM context 3712 * @pin: pin name 3713 * 3714 * Enables input/output pin and its parents or children widgets iff there is 3715 * a valid audio route and active audio stream. 3716 * 3717 * Requires external locking. 3718 * 3719 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3720 * do any widget power switching. 3721 */ 3722 int snd_soc_dapm_enable_pin_unlocked(struct snd_soc_dapm_context *dapm, 3723 const char *pin) 3724 { 3725 return snd_soc_dapm_set_pin(dapm, pin, 1); 3726 } 3727 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin_unlocked); 3728 3729 /** 3730 * snd_soc_dapm_enable_pin - enable pin. 3731 * @dapm: DAPM context 3732 * @pin: pin name 3733 * 3734 * Enables input/output pin and its parents or children widgets iff there is 3735 * a valid audio route and active audio stream. 3736 * 3737 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3738 * do any widget power switching. 3739 */ 3740 int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin) 3741 { 3742 int ret; 3743 3744 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3745 3746 ret = snd_soc_dapm_set_pin(dapm, pin, 1); 3747 3748 mutex_unlock(&dapm->card->dapm_mutex); 3749 3750 return ret; 3751 } 3752 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin); 3753 3754 /** 3755 * snd_soc_dapm_force_enable_pin_unlocked - force a pin to be enabled 3756 * @dapm: DAPM context 3757 * @pin: pin name 3758 * 3759 * Enables input/output pin regardless of any other state. This is 3760 * intended for use with microphone bias supplies used in microphone 3761 * jack detection. 3762 * 3763 * Requires external locking. 3764 * 3765 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3766 * do any widget power switching. 3767 */ 3768 int snd_soc_dapm_force_enable_pin_unlocked(struct snd_soc_dapm_context *dapm, 3769 const char *pin) 3770 { 3771 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true); 3772 3773 if (!w) { 3774 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin); 3775 return -EINVAL; 3776 } 3777 3778 dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin); 3779 if (!w->connected) { 3780 /* 3781 * w->force does not affect the number of input or output paths, 3782 * so we only have to recheck if w->connected is changed 3783 */ 3784 dapm_widget_invalidate_input_paths(w); 3785 dapm_widget_invalidate_output_paths(w); 3786 w->connected = 1; 3787 } 3788 w->force = 1; 3789 dapm_mark_dirty(w, "force enable"); 3790 3791 return 0; 3792 } 3793 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin_unlocked); 3794 3795 /** 3796 * snd_soc_dapm_force_enable_pin - force a pin to be enabled 3797 * @dapm: DAPM context 3798 * @pin: pin name 3799 * 3800 * Enables input/output pin regardless of any other state. This is 3801 * intended for use with microphone bias supplies used in microphone 3802 * jack detection. 3803 * 3804 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3805 * do any widget power switching. 3806 */ 3807 int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm, 3808 const char *pin) 3809 { 3810 int ret; 3811 3812 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3813 3814 ret = snd_soc_dapm_force_enable_pin_unlocked(dapm, pin); 3815 3816 mutex_unlock(&dapm->card->dapm_mutex); 3817 3818 return ret; 3819 } 3820 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin); 3821 3822 /** 3823 * snd_soc_dapm_disable_pin_unlocked - disable pin. 3824 * @dapm: DAPM context 3825 * @pin: pin name 3826 * 3827 * Disables input/output pin and its parents or children widgets. 3828 * 3829 * Requires external locking. 3830 * 3831 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3832 * do any widget power switching. 3833 */ 3834 int snd_soc_dapm_disable_pin_unlocked(struct snd_soc_dapm_context *dapm, 3835 const char *pin) 3836 { 3837 return snd_soc_dapm_set_pin(dapm, pin, 0); 3838 } 3839 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin_unlocked); 3840 3841 /** 3842 * snd_soc_dapm_disable_pin - disable pin. 3843 * @dapm: DAPM context 3844 * @pin: pin name 3845 * 3846 * Disables input/output pin and its parents or children widgets. 3847 * 3848 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3849 * do any widget power switching. 3850 */ 3851 int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm, 3852 const char *pin) 3853 { 3854 int ret; 3855 3856 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3857 3858 ret = snd_soc_dapm_set_pin(dapm, pin, 0); 3859 3860 mutex_unlock(&dapm->card->dapm_mutex); 3861 3862 return ret; 3863 } 3864 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin); 3865 3866 /** 3867 * snd_soc_dapm_nc_pin_unlocked - permanently disable pin. 3868 * @dapm: DAPM context 3869 * @pin: pin name 3870 * 3871 * Marks the specified pin as being not connected, disabling it along 3872 * any parent or child widgets. At present this is identical to 3873 * snd_soc_dapm_disable_pin() but in future it will be extended to do 3874 * additional things such as disabling controls which only affect 3875 * paths through the pin. 3876 * 3877 * Requires external locking. 3878 * 3879 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3880 * do any widget power switching. 3881 */ 3882 int snd_soc_dapm_nc_pin_unlocked(struct snd_soc_dapm_context *dapm, 3883 const char *pin) 3884 { 3885 return snd_soc_dapm_set_pin(dapm, pin, 0); 3886 } 3887 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin_unlocked); 3888 3889 /** 3890 * snd_soc_dapm_nc_pin - permanently disable pin. 3891 * @dapm: DAPM context 3892 * @pin: pin name 3893 * 3894 * Marks the specified pin as being not connected, disabling it along 3895 * any parent or child widgets. At present this is identical to 3896 * snd_soc_dapm_disable_pin() but in future it will be extended to do 3897 * additional things such as disabling controls which only affect 3898 * paths through the pin. 3899 * 3900 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to 3901 * do any widget power switching. 3902 */ 3903 int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin) 3904 { 3905 int ret; 3906 3907 mutex_lock_nested(&dapm->card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME); 3908 3909 ret = snd_soc_dapm_set_pin(dapm, pin, 0); 3910 3911 mutex_unlock(&dapm->card->dapm_mutex); 3912 3913 return ret; 3914 } 3915 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin); 3916 3917 /** 3918 * snd_soc_dapm_get_pin_status - get audio pin status 3919 * @dapm: DAPM context 3920 * @pin: audio signal pin endpoint (or start point) 3921 * 3922 * Get audio pin status - connected or disconnected. 3923 * 3924 * Returns 1 for connected otherwise 0. 3925 */ 3926 int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm, 3927 const char *pin) 3928 { 3929 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true); 3930 3931 if (w) 3932 return w->connected; 3933 3934 return 0; 3935 } 3936 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status); 3937 3938 /** 3939 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint 3940 * @dapm: DAPM context 3941 * @pin: audio signal pin endpoint (or start point) 3942 * 3943 * Mark the given endpoint or pin as ignoring suspend. When the 3944 * system is disabled a path between two endpoints flagged as ignoring 3945 * suspend will not be disabled. The path must already be enabled via 3946 * normal means at suspend time, it will not be turned on if it was not 3947 * already enabled. 3948 */ 3949 int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm, 3950 const char *pin) 3951 { 3952 struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false); 3953 3954 if (!w) { 3955 dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin); 3956 return -EINVAL; 3957 } 3958 3959 w->ignore_suspend = 1; 3960 3961 return 0; 3962 } 3963 EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend); 3964 3965 /** 3966 * snd_soc_dapm_free - free dapm resources 3967 * @dapm: DAPM context 3968 * 3969 * Free all dapm widgets and resources. 3970 */ 3971 void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm) 3972 { 3973 dapm_debugfs_cleanup(dapm); 3974 dapm_free_widgets(dapm); 3975 list_del(&dapm->list); 3976 } 3977 EXPORT_SYMBOL_GPL(snd_soc_dapm_free); 3978 3979 static void soc_dapm_shutdown_dapm(struct snd_soc_dapm_context *dapm) 3980 { 3981 struct snd_soc_card *card = dapm->card; 3982 struct snd_soc_dapm_widget *w; 3983 LIST_HEAD(down_list); 3984 int powerdown = 0; 3985 3986 mutex_lock(&card->dapm_mutex); 3987 3988 list_for_each_entry(w, &dapm->card->widgets, list) { 3989 if (w->dapm != dapm) 3990 continue; 3991 if (w->power) { 3992 dapm_seq_insert(w, &down_list, false); 3993 w->power = 0; 3994 powerdown = 1; 3995 } 3996 } 3997 3998 /* If there were no widgets to power down we're already in 3999 * standby. 4000 */ 4001 if (powerdown) { 4002 if (dapm->bias_level == SND_SOC_BIAS_ON) 4003 snd_soc_dapm_set_bias_level(dapm, 4004 SND_SOC_BIAS_PREPARE); 4005 dapm_seq_run(card, &down_list, 0, false); 4006 if (dapm->bias_level == SND_SOC_BIAS_PREPARE) 4007 snd_soc_dapm_set_bias_level(dapm, 4008 SND_SOC_BIAS_STANDBY); 4009 } 4010 4011 mutex_unlock(&card->dapm_mutex); 4012 } 4013 4014 /* 4015 * snd_soc_dapm_shutdown - callback for system shutdown 4016 */ 4017 void snd_soc_dapm_shutdown(struct snd_soc_card *card) 4018 { 4019 struct snd_soc_dapm_context *dapm; 4020 4021 list_for_each_entry(dapm, &card->dapm_list, list) { 4022 if (dapm != &card->dapm) { 4023 soc_dapm_shutdown_dapm(dapm); 4024 if (dapm->bias_level == SND_SOC_BIAS_STANDBY) 4025 snd_soc_dapm_set_bias_level(dapm, 4026 SND_SOC_BIAS_OFF); 4027 } 4028 } 4029 4030 soc_dapm_shutdown_dapm(&card->dapm); 4031 if (card->dapm.bias_level == SND_SOC_BIAS_STANDBY) 4032 snd_soc_dapm_set_bias_level(&card->dapm, 4033 SND_SOC_BIAS_OFF); 4034 } 4035 4036 /* Module information */ 4037 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk"); 4038 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC"); 4039 MODULE_LICENSE("GPL"); 4040