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