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