sound/soc/soc-dapm.c

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