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/meadphone 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 powerdown of audio susbsystem to reduce pops between a quick
  22  *      device reopen.
  23  *
  24  *  Todo:
  25  *    o DAPM power change sequencing - allow for configurable per
  26  *      codec sequences.
  27  *    o Support for analogue bias optimisation.
  28  *    o Support for reduced codec oversampling rates.
  29  *    o Support for reduced codec bias currents.
  30  */
  31
  32 #include <linux/module.h>
  33 #include <linux/moduleparam.h>
  34 #include <linux/init.h>
  35 #include <linux/async.h>
  36 #include <linux/delay.h>
  37 #include <linux/pm.h>
  38 #include <linux/bitops.h>
  39 #include <linux/platform_device.h>
  40 #include <linux/jiffies.h>
  41 #include <linux/debugfs.h>
  42 #include <linux/slab.h>
  43 #include <sound/core.h>
  44 #include <sound/pcm.h>
  45 #include <sound/pcm_params.h>
  46 #include <sound/soc.h>
  47 #include <sound/initval.h>
  48
  49 #include <trace/events/asoc.h>
  50
  51 /* dapm power sequences - make this per codec in the future */
  52 static int dapm_up_seq[] = {
  53         [snd_soc_dapm_pre] = 0,
  54         [snd_soc_dapm_supply] = 1,
  55         [snd_soc_dapm_micbias] = 2,
  56         [snd_soc_dapm_aif_in] = 3,
  57         [snd_soc_dapm_aif_out] = 3,
  58         [snd_soc_dapm_mic] = 4,
  59         [snd_soc_dapm_mux] = 5,
  60         [snd_soc_dapm_virt_mux] = 5,
  61         [snd_soc_dapm_value_mux] = 5,
  62         [snd_soc_dapm_dac] = 6,
  63         [snd_soc_dapm_mixer] = 7,
  64         [snd_soc_dapm_mixer_named_ctl] = 7,
  65         [snd_soc_dapm_pga] = 8,
  66         [snd_soc_dapm_adc] = 9,
  67         [snd_soc_dapm_out_drv] = 10,
  68         [snd_soc_dapm_hp] = 10,
  69         [snd_soc_dapm_spk] = 10,
  70         [snd_soc_dapm_post] = 11,
  71 };
  72
  73 static int dapm_down_seq[] = {
  74         [snd_soc_dapm_pre] = 0,
  75         [snd_soc_dapm_adc] = 1,
  76         [snd_soc_dapm_hp] = 2,
  77         [snd_soc_dapm_spk] = 2,
  78         [snd_soc_dapm_out_drv] = 2,
  79         [snd_soc_dapm_pga] = 4,
  80         [snd_soc_dapm_mixer_named_ctl] = 5,
  81         [snd_soc_dapm_mixer] = 5,
  82         [snd_soc_dapm_dac] = 6,
  83         [snd_soc_dapm_mic] = 7,
  84         [snd_soc_dapm_micbias] = 8,
  85         [snd_soc_dapm_mux] = 9,
  86         [snd_soc_dapm_virt_mux] = 9,
  87         [snd_soc_dapm_value_mux] = 9,
  88         [snd_soc_dapm_aif_in] = 10,
  89         [snd_soc_dapm_aif_out] = 10,
  90         [snd_soc_dapm_supply] = 11,
  91         [snd_soc_dapm_post] = 12,
  92 };
  93
  94 static void pop_wait(u32 pop_time)
  95 {
  96         if (pop_time)
  97                 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
  98 }
  99
 100 static void pop_dbg(struct device *dev, u32 pop_time, const char *fmt, ...)
 101 {
 102         va_list args;
 103         char *buf;
 104
 105         if (!pop_time)
 106                 return;
 107
 108         buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
 109         if (buf == NULL)
 110                 return;
 111
 112         va_start(args, fmt);
 113         vsnprintf(buf, PAGE_SIZE, fmt, args);
 114         dev_info(dev, "%s", buf);
 115         va_end(args);
 116
 117         kfree(buf);
 118 }
 119
 120 /* create a new dapm widget */
 121 static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
 122         const struct snd_soc_dapm_widget *_widget)
 123 {
 124         return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
 125 }
 126
 127 /**
 128  * snd_soc_dapm_set_bias_level - set the bias level for the system
 129  * @dapm: DAPM context
 130  * @level: level to configure
 131  *
 132  * Configure the bias (power) levels for the SoC audio device.
 133  *
 134  * Returns 0 for success else error.
 135  */
 136 static int snd_soc_dapm_set_bias_level(struct snd_soc_dapm_context *dapm,
 137                                        enum snd_soc_bias_level level)
 138 {
 139         struct snd_soc_card *card = dapm->card;
 140         int ret = 0;
 141
 142         switch (level) {
 143         case SND_SOC_BIAS_ON:
 144                 dev_dbg(dapm->dev, "Setting full bias\n");
 145                 break;
 146         case SND_SOC_BIAS_PREPARE:
 147                 dev_dbg(dapm->dev, "Setting bias prepare\n");
 148                 break;
 149         case SND_SOC_BIAS_STANDBY:
 150                 dev_dbg(dapm->dev, "Setting standby bias\n");
 151                 break;
 152         case SND_SOC_BIAS_OFF:
 153                 dev_dbg(dapm->dev, "Setting bias off\n");
 154                 break;
 155         default:
 156                 dev_err(dapm->dev, "Setting invalid bias %d\n", level);
 157                 return -EINVAL;
 158         }
 159
 160         trace_snd_soc_bias_level_start(card, level);
 161
 162         if (card && card->set_bias_level)
 163                 ret = card->set_bias_level(card, level);
 164         if (ret == 0) {
 165                 if (dapm->codec && dapm->codec->driver->set_bias_level)
 166                         ret = dapm->codec->driver->set_bias_level(dapm->codec, level);
 167                 else
 168                         dapm->bias_level = level;
 169         }
 170         if (ret == 0) {
 171                 if (card && card->set_bias_level_post)
 172                         ret = card->set_bias_level_post(card, level);
 173         }
 174
 175         trace_snd_soc_bias_level_done(card, level);
 176
 177         return ret;
 178 }
 179
 180 /* set up initial codec paths */
 181 static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
 182         struct snd_soc_dapm_path *p, int i)
 183 {
 184         switch (w->id) {
 185         case snd_soc_dapm_switch:
 186         case snd_soc_dapm_mixer:
 187         case snd_soc_dapm_mixer_named_ctl: {
 188                 int val;
 189                 struct soc_mixer_control *mc = (struct soc_mixer_control *)
 190                         w->kcontrols[i].private_value;
 191                 unsigned int reg = mc->reg;
 192                 unsigned int shift = mc->shift;
 193                 int max = mc->max;
 194                 unsigned int mask = (1 << fls(max)) - 1;
 195                 unsigned int invert = mc->invert;
 196
 197                 val = snd_soc_read(w->codec, reg);
 198                 val = (val >> shift) & mask;
 199
 200                 if ((invert && !val) || (!invert && val))
 201                         p->connect = 1;
 202                 else
 203                         p->connect = 0;
 204         }
 205         break;
 206         case snd_soc_dapm_mux: {
 207                 struct soc_enum *e = (struct soc_enum *)w->kcontrols[i].private_value;
 208                 int val, item, bitmask;
 209
 210                 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
 211                 ;
 212                 val = snd_soc_read(w->codec, e->reg);
 213                 item = (val >> e->shift_l) & (bitmask - 1);
 214
 215                 p->connect = 0;
 216                 for (i = 0; i < e->max; i++) {
 217                         if (!(strcmp(p->name, e->texts[i])) && item == i)
 218                                 p->connect = 1;
 219                 }
 220         }
 221         break;
 222         case snd_soc_dapm_virt_mux: {
 223                 struct soc_enum *e = (struct soc_enum *)w->kcontrols[i].private_value;
 224
 225                 p->connect = 0;
 226                 /* since a virtual mux has no backing registers to
 227                  * decide which path to connect, it will try to match
 228                  * with the first enumeration.  This is to ensure
 229                  * that the default mux choice (the first) will be
 230                  * correctly powered up during initialization.
 231                  */
 232                 if (!strcmp(p->name, e->texts[0]))
 233                         p->connect = 1;
 234         }
 235         break;
 236         case snd_soc_dapm_value_mux: {
 237                 struct soc_enum *e = (struct soc_enum *)
 238                         w->kcontrols[i].private_value;
 239                 int val, item;
 240
 241                 val = snd_soc_read(w->codec, e->reg);
 242                 val = (val >> e->shift_l) & e->mask;
 243                 for (item = 0; item < e->max; item++) {
 244                         if (val == e->values[item])
 245                                 break;
 246                 }
 247
 248                 p->connect = 0;
 249                 for (i = 0; i < e->max; i++) {
 250                         if (!(strcmp(p->name, e->texts[i])) && item == i)
 251                                 p->connect = 1;
 252                 }
 253         }
 254         break;
 255         /* does not effect routing - always connected */
 256         case snd_soc_dapm_pga:
 257         case snd_soc_dapm_out_drv:
 258         case snd_soc_dapm_output:
 259         case snd_soc_dapm_adc:
 260         case snd_soc_dapm_input:
 261         case snd_soc_dapm_dac:
 262         case snd_soc_dapm_micbias:
 263         case snd_soc_dapm_vmid:
 264         case snd_soc_dapm_supply:
 265         case snd_soc_dapm_aif_in:
 266         case snd_soc_dapm_aif_out:
 267                 p->connect = 1;
 268         break;
 269         /* does effect routing - dynamically connected */
 270         case snd_soc_dapm_hp:
 271         case snd_soc_dapm_mic:
 272         case snd_soc_dapm_spk:
 273         case snd_soc_dapm_line:
 274         case snd_soc_dapm_pre:
 275         case snd_soc_dapm_post:
 276                 p->connect = 0;
 277         break;
 278         }
 279 }
 280
 281 /* connect mux widget to its interconnecting audio paths */
 282 static int dapm_connect_mux(struct snd_soc_dapm_context *dapm,
 283         struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
 284         struct snd_soc_dapm_path *path, const char *control_name,
 285         const struct snd_kcontrol_new *kcontrol)
 286 {
 287         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
 288         int i;
 289
 290         for (i = 0; i < e->max; i++) {
 291                 if (!(strcmp(control_name, e->texts[i]))) {
 292                         list_add(&path->list, &dapm->card->paths);
 293                         list_add(&path->list_sink, &dest->sources);
 294                         list_add(&path->list_source, &src->sinks);
 295                         path->name = (char*)e->texts[i];
 296                         dapm_set_path_status(dest, path, 0);
 297                         return 0;
 298                 }
 299         }
 300
 301         return -ENODEV;
 302 }
 303
 304 /* connect mixer widget to its interconnecting audio paths */
 305 static int dapm_connect_mixer(struct snd_soc_dapm_context *dapm,
 306         struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
 307         struct snd_soc_dapm_path *path, const char *control_name)
 308 {
 309         int i;
 310
 311         /* search for mixer kcontrol */
 312         for (i = 0; i < dest->num_kcontrols; i++) {
 313                 if (!strcmp(control_name, dest->kcontrols[i].name)) {
 314                         list_add(&path->list, &dapm->card->paths);
 315                         list_add(&path->list_sink, &dest->sources);
 316                         list_add(&path->list_source, &src->sinks);
 317                         path->name = dest->kcontrols[i].name;
 318                         dapm_set_path_status(dest, path, i);
 319                         return 0;
 320                 }
 321         }
 322         return -ENODEV;
 323 }
 324
 325 /* update dapm codec register bits */
 326 static int dapm_update_bits(struct snd_soc_dapm_widget *widget)
 327 {
 328         int change, power;
 329         unsigned int old, new;
 330         struct snd_soc_codec *codec = widget->codec;
 331         struct snd_soc_dapm_context *dapm = widget->dapm;
 332         struct snd_soc_card *card = dapm->card;
 333
 334         /* check for valid widgets */
 335         if (widget->reg < 0 || widget->id == snd_soc_dapm_input ||
 336                 widget->id == snd_soc_dapm_output ||
 337                 widget->id == snd_soc_dapm_hp ||
 338                 widget->id == snd_soc_dapm_mic ||
 339                 widget->id == snd_soc_dapm_line ||
 340                 widget->id == snd_soc_dapm_spk)
 341                 return 0;
 342
 343         power = widget->power;
 344         if (widget->invert)
 345                 power = (power ? 0:1);
 346
 347         old = snd_soc_read(codec, widget->reg);
 348         new = (old & ~(0x1 << widget->shift)) | (power << widget->shift);
 349
 350         change = old != new;
 351         if (change) {
 352                 pop_dbg(dapm->dev, card->pop_time,
 353                         "pop test %s : %s in %d ms\n",
 354                         widget->name, widget->power ? "on" : "off",
 355                         card->pop_time);
 356                 pop_wait(card->pop_time);
 357                 snd_soc_write(codec, widget->reg, new);
 358         }
 359         dev_dbg(dapm->dev, "reg %x old %x new %x change %d\n", widget->reg,
 360                 old, new, change);
 361         return change;
 362 }
 363
 364 /* create new dapm mixer control */
 365 static int dapm_new_mixer(struct snd_soc_dapm_context *dapm,
 366         struct snd_soc_dapm_widget *w)
 367 {
 368         int i, ret = 0;
 369         size_t name_len, prefix_len;
 370         struct snd_soc_dapm_path *path;
 371         struct snd_card *card = dapm->card->snd_card;
 372         const char *prefix;
 373
 374         if (dapm->codec)
 375                 prefix = dapm->codec->name_prefix;
 376         else
 377                 prefix = NULL;
 378
 379         if (prefix)
 380                 prefix_len = strlen(prefix) + 1;
 381         else
 382                 prefix_len = 0;
 383
 384         /* add kcontrol */
 385         for (i = 0; i < w->num_kcontrols; i++) {
 386
 387                 /* match name */
 388                 list_for_each_entry(path, &w->sources, list_sink) {
 389
 390                         /* mixer/mux paths name must match control name */
 391                         if (path->name != (char*)w->kcontrols[i].name)
 392                                 continue;
 393
 394                         /* add dapm control with long name.
 395                          * for dapm_mixer this is the concatenation of the
 396                          * mixer and kcontrol name.
 397                          * for dapm_mixer_named_ctl this is simply the
 398                          * kcontrol name.
 399                          */
 400                         name_len = strlen(w->kcontrols[i].name) + 1;
 401                         if (w->id != snd_soc_dapm_mixer_named_ctl)
 402                                 name_len += 1 + strlen(w->name);
 403
 404                         path->long_name = kmalloc(name_len, GFP_KERNEL);
 405
 406                         if (path->long_name == NULL)
 407                                 return -ENOMEM;
 408
 409                         switch (w->id) {
 410                         default:
 411                                 /* The control will get a prefix from
 412                                  * the control creation process but
 413                                  * we're also using the same prefix
 414                                  * for widgets so cut the prefix off
 415                                  * the front of the widget name.
 416                                  */
 417                                 snprintf(path->long_name, name_len, "%s %s",
 418                                          w->name + prefix_len,
 419                                          w->kcontrols[i].name);
 420                                 break;
 421                         case snd_soc_dapm_mixer_named_ctl:
 422                                 snprintf(path->long_name, name_len, "%s",
 423                                          w->kcontrols[i].name);
 424                                 break;
 425                         }
 426
 427                         path->long_name[name_len - 1] = '\0';
 428
 429                         path->kcontrol = snd_soc_cnew(&w->kcontrols[i], w,
 430                                                       path->long_name, prefix);
 431                         ret = snd_ctl_add(card, path->kcontrol);
 432                         if (ret < 0) {
 433                                 dev_err(dapm->dev,
 434                                         "asoc: failed to add dapm kcontrol %s: %d\n",
 435                                         path->long_name, ret);
 436                                 kfree(path->long_name);
 437                                 path->long_name = NULL;
 438                                 return ret;
 439                         }
 440                 }
 441         }
 442         return ret;
 443 }
 444
 445 /* create new dapm mux control */
 446 static int dapm_new_mux(struct snd_soc_dapm_context *dapm,
 447         struct snd_soc_dapm_widget *w)
 448 {
 449         struct snd_soc_dapm_path *path = NULL;
 450         struct snd_kcontrol *kcontrol;
 451         struct snd_card *card = dapm->card->snd_card;
 452         const char *prefix;
 453         size_t prefix_len;
 454         int ret = 0;
 455
 456         if (!w->num_kcontrols) {
 457                 dev_err(dapm->dev, "asoc: mux %s has no controls\n", w->name);
 458                 return -EINVAL;
 459         }
 460
 461         if (dapm->codec)
 462                 prefix = dapm->codec->name_prefix;
 463         else
 464                 prefix = NULL;
 465
 466         if (prefix)
 467                 prefix_len = strlen(prefix) + 1;
 468         else
 469                 prefix_len = 0;
 470
 471         /* The control will get a prefix from the control creation
 472          * process but we're also using the same prefix for widgets so
 473          * cut the prefix off the front of the widget name.
 474          */
 475         kcontrol = snd_soc_cnew(&w->kcontrols[0], w, w->name + prefix_len,
 476                                 prefix);
 477         ret = snd_ctl_add(card, kcontrol);
 478
 479         if (ret < 0)
 480                 goto err;
 481
 482         list_for_each_entry(path, &w->sources, list_sink)
 483                 path->kcontrol = kcontrol;
 484
 485         return ret;
 486
 487 err:
 488         dev_err(dapm->dev, "asoc: failed to add kcontrol %s\n", w->name);
 489         return ret;
 490 }
 491
 492 /* create new dapm volume control */
 493 static int dapm_new_pga(struct snd_soc_dapm_context *dapm,
 494         struct snd_soc_dapm_widget *w)
 495 {
 496         if (w->num_kcontrols)
 497                 dev_err(w->dapm->dev,
 498                         "asoc: PGA controls not supported: '%s'\n", w->name);
 499
 500         return 0;
 501 }
 502
 503 /* reset 'walked' bit for each dapm path */
 504 static inline void dapm_clear_walk(struct snd_soc_dapm_context *dapm)
 505 {
 506         struct snd_soc_dapm_path *p;
 507
 508         list_for_each_entry(p, &dapm->card->paths, list)
 509                 p->walked = 0;
 510 }
 511
 512 /* We implement power down on suspend by checking the power state of
 513  * the ALSA card - when we are suspending the ALSA state for the card
 514  * is set to D3.
 515  */
 516 static int snd_soc_dapm_suspend_check(struct snd_soc_dapm_widget *widget)
 517 {
 518         int level = snd_power_get_state(widget->dapm->card->snd_card);
 519
 520         switch (level) {
 521         case SNDRV_CTL_POWER_D3hot:
 522         case SNDRV_CTL_POWER_D3cold:
 523                 if (widget->ignore_suspend)
 524                         dev_dbg(widget->dapm->dev, "%s ignoring suspend\n",
 525                                 widget->name);
 526                 return widget->ignore_suspend;
 527         default:
 528                 return 1;
 529         }
 530 }
 531
 532 /*
 533  * Recursively check for a completed path to an active or physically connected
 534  * output widget. Returns number of complete paths.
 535  */
 536 static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
 537 {
 538         struct snd_soc_dapm_path *path;
 539         int con = 0;
 540
 541         if (widget->id == snd_soc_dapm_supply)
 542                 return 0;
 543
 544         switch (widget->id) {
 545         case snd_soc_dapm_adc:
 546         case snd_soc_dapm_aif_out:
 547                 if (widget->active)
 548                         return snd_soc_dapm_suspend_check(widget);
 549         default:
 550                 break;
 551         }
 552
 553         if (widget->connected) {
 554                 /* connected pin ? */
 555                 if (widget->id == snd_soc_dapm_output && !widget->ext)
 556                         return snd_soc_dapm_suspend_check(widget);
 557
 558                 /* connected jack or spk ? */
 559                 if (widget->id == snd_soc_dapm_hp || widget->id == snd_soc_dapm_spk ||
 560                     (widget->id == snd_soc_dapm_line && !list_empty(&widget->sources)))
 561                         return snd_soc_dapm_suspend_check(widget);
 562         }
 563
 564         list_for_each_entry(path, &widget->sinks, list_source) {
 565                 if (path->walked)
 566                         continue;
 567
 568                 if (path->sink && path->connect) {
 569                         path->walked = 1;
 570                         con += is_connected_output_ep(path->sink);
 571                 }
 572         }
 573
 574         return con;
 575 }
 576
 577 /*
 578  * Recursively check for a completed path to an active or physically connected
 579  * input widget. Returns number of complete paths.
 580  */
 581 static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
 582 {
 583         struct snd_soc_dapm_path *path;
 584         int con = 0;
 585
 586         if (widget->id == snd_soc_dapm_supply)
 587                 return 0;
 588
 589         /* active stream ? */
 590         switch (widget->id) {
 591         case snd_soc_dapm_dac:
 592         case snd_soc_dapm_aif_in:
 593                 if (widget->active)
 594                         return snd_soc_dapm_suspend_check(widget);
 595         default:
 596                 break;
 597         }
 598
 599         if (widget->connected) {
 600                 /* connected pin ? */
 601                 if (widget->id == snd_soc_dapm_input && !widget->ext)
 602                         return snd_soc_dapm_suspend_check(widget);
 603
 604                 /* connected VMID/Bias for lower pops */
 605                 if (widget->id == snd_soc_dapm_vmid)
 606                         return snd_soc_dapm_suspend_check(widget);
 607
 608                 /* connected jack ? */
 609                 if (widget->id == snd_soc_dapm_mic ||
 610                     (widget->id == snd_soc_dapm_line && !list_empty(&widget->sinks)))
 611                         return snd_soc_dapm_suspend_check(widget);
 612         }
 613
 614         list_for_each_entry(path, &widget->sources, list_sink) {
 615                 if (path->walked)
 616                         continue;
 617
 618                 if (path->source && path->connect) {
 619                         path->walked = 1;
 620                         con += is_connected_input_ep(path->source);
 621                 }
 622         }
 623
 624         return con;
 625 }
 626
 627 /*
 628  * Handler for generic register modifier widget.
 629  */
 630 int dapm_reg_event(struct snd_soc_dapm_widget *w,
 631                    struct snd_kcontrol *kcontrol, int event)
 632 {
 633         unsigned int val;
 634
 635         if (SND_SOC_DAPM_EVENT_ON(event))
 636                 val = w->on_val;
 637         else
 638                 val = w->off_val;
 639
 640         snd_soc_update_bits(w->codec, -(w->reg + 1),
 641                             w->mask << w->shift, val << w->shift);
 642
 643         return 0;
 644 }
 645 EXPORT_SYMBOL_GPL(dapm_reg_event);
 646
 647 /* Standard power change method, used to apply power changes to most
 648  * widgets.
 649  */
 650 static int dapm_generic_apply_power(struct snd_soc_dapm_widget *w)
 651 {
 652         int ret;
 653
 654         /* call any power change event handlers */
 655         if (w->event)
 656                 dev_dbg(w->dapm->dev, "power %s event for %s flags %x\n",
 657                          w->power ? "on" : "off",
 658                          w->name, w->event_flags);
 659
 660         /* power up pre event */
 661         if (w->power && w->event &&
 662             (w->event_flags & SND_SOC_DAPM_PRE_PMU)) {
 663                 ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMU);
 664                 if (ret < 0)
 665                         return ret;
 666         }
 667
 668         /* power down pre event */
 669         if (!w->power && w->event &&
 670             (w->event_flags & SND_SOC_DAPM_PRE_PMD)) {
 671                 ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMD);
 672                 if (ret < 0)
 673                         return ret;
 674         }
 675
 676         dapm_update_bits(w);
 677
 678         /* power up post event */
 679         if (w->power && w->event &&
 680             (w->event_flags & SND_SOC_DAPM_POST_PMU)) {
 681                 ret = w->event(w,
 682                                NULL, SND_SOC_DAPM_POST_PMU);
 683                 if (ret < 0)
 684                         return ret;
 685         }
 686
 687         /* power down post event */
 688         if (!w->power && w->event &&
 689             (w->event_flags & SND_SOC_DAPM_POST_PMD)) {
 690                 ret = w->event(w, NULL, SND_SOC_DAPM_POST_PMD);
 691                 if (ret < 0)
 692                         return ret;
 693         }
 694
 695         return 0;
 696 }
 697
 698 /* Generic check to see if a widget should be powered.
 699  */
 700 static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
 701 {
 702         int in, out;
 703
 704         in = is_connected_input_ep(w);
 705         dapm_clear_walk(w->dapm);
 706         out = is_connected_output_ep(w);
 707         dapm_clear_walk(w->dapm);
 708         return out != 0 && in != 0;
 709 }
 710
 711 /* Check to see if an ADC has power */
 712 static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
 713 {
 714         int in;
 715
 716         if (w->active) {
 717                 in = is_connected_input_ep(w);
 718                 dapm_clear_walk(w->dapm);
 719                 return in != 0;
 720         } else {
 721                 return dapm_generic_check_power(w);
 722         }
 723 }
 724
 725 /* Check to see if a DAC has power */
 726 static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
 727 {
 728         int out;
 729
 730         if (w->active) {
 731                 out = is_connected_output_ep(w);
 732                 dapm_clear_walk(w->dapm);
 733                 return out != 0;
 734         } else {
 735                 return dapm_generic_check_power(w);
 736         }
 737 }
 738
 739 /* Check to see if a power supply is needed */
 740 static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
 741 {
 742         struct snd_soc_dapm_path *path;
 743         int power = 0;
 744
 745         /* Check if one of our outputs is connected */
 746         list_for_each_entry(path, &w->sinks, list_source) {
 747                 if (path->connected &&
 748                     !path->connected(path->source, path->sink))
 749                         continue;
 750
 751                 if (!path->sink)
 752                         continue;
 753
 754                 if (path->sink->force) {
 755                         power = 1;
 756                         break;
 757                 }
 758
 759                 if (path->sink->power_check &&
 760                     path->sink->power_check(path->sink)) {
 761                         power = 1;
 762                         break;
 763                 }
 764         }
 765
 766         dapm_clear_walk(w->dapm);
 767
 768         return power;
 769 }
 770
 771 static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
 772                             struct snd_soc_dapm_widget *b,
 773                             bool power_up)
 774 {
 775         int *sort;
 776
 777         if (power_up)
 778                 sort = dapm_up_seq;
 779         else
 780                 sort = dapm_down_seq;
 781
 782         if (sort[a->id] != sort[b->id])
 783                 return sort[a->id] - sort[b->id];
 784         if (a->subseq != b->subseq) {
 785                 if (power_up)
 786                         return a->subseq - b->subseq;
 787                 else
 788                         return b->subseq - a->subseq;
 789         }
 790         if (a->reg != b->reg)
 791                 return a->reg - b->reg;
 792         if (a->dapm != b->dapm)
 793                 return (unsigned long)a->dapm - (unsigned long)b->dapm;
 794
 795         return 0;
 796 }
 797
 798 /* Insert a widget in order into a DAPM power sequence. */
 799 static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
 800                             struct list_head *list,
 801                             bool power_up)
 802 {
 803         struct snd_soc_dapm_widget *w;
 804
 805         list_for_each_entry(w, list, power_list)
 806                 if (dapm_seq_compare(new_widget, w, power_up) < 0) {
 807                         list_add_tail(&new_widget->power_list, &w->power_list);
 808                         return;
 809                 }
 810
 811         list_add_tail(&new_widget->power_list, list);
 812 }
 813
 814 static void dapm_seq_check_event(struct snd_soc_dapm_context *dapm,
 815                                  struct snd_soc_dapm_widget *w, int event)
 816 {
 817         struct snd_soc_card *card = dapm->card;
 818         const char *ev_name;
 819         int power, ret;
 820
 821         switch (event) {
 822         case SND_SOC_DAPM_PRE_PMU:
 823                 ev_name = "PRE_PMU";
 824                 power = 1;
 825                 break;
 826         case SND_SOC_DAPM_POST_PMU:
 827                 ev_name = "POST_PMU";
 828                 power = 1;
 829                 break;
 830         case SND_SOC_DAPM_PRE_PMD:
 831                 ev_name = "PRE_PMD";
 832                 power = 0;
 833                 break;
 834         case SND_SOC_DAPM_POST_PMD:
 835                 ev_name = "POST_PMD";
 836                 power = 0;
 837                 break;
 838         default:
 839                 BUG();
 840                 return;
 841         }
 842
 843         if (w->power != power)
 844                 return;
 845
 846         if (w->event && (w->event_flags & event)) {
 847                 pop_dbg(dapm->dev, card->pop_time, "pop test : %s %s\n",
 848                         w->name, ev_name);
 849                 trace_snd_soc_dapm_widget_event_start(w, event);
 850                 ret = w->event(w, NULL, event);
 851                 trace_snd_soc_dapm_widget_event_done(w, event);
 852                 if (ret < 0)
 853                         pr_err("%s: %s event failed: %d\n",
 854                                ev_name, w->name, ret);
 855         }
 856 }
 857
 858 /* Apply the coalesced changes from a DAPM sequence */
 859 static void dapm_seq_run_coalesced(struct snd_soc_dapm_context *dapm,
 860                                    struct list_head *pending)
 861 {
 862         struct snd_soc_card *card = dapm->card;
 863         struct snd_soc_dapm_widget *w;
 864         int reg, power;
 865         unsigned int value = 0;
 866         unsigned int mask = 0;
 867         unsigned int cur_mask;
 868
 869         reg = list_first_entry(pending, struct snd_soc_dapm_widget,
 870                                power_list)->reg;
 871
 872         list_for_each_entry(w, pending, power_list) {
 873                 cur_mask = 1 << w->shift;
 874                 BUG_ON(reg != w->reg);
 875
 876                 if (w->invert)
 877                         power = !w->power;
 878                 else
 879                         power = w->power;
 880
 881                 mask |= cur_mask;
 882                 if (power)
 883                         value |= cur_mask;
 884
 885                 pop_dbg(dapm->dev, card->pop_time,
 886                         "pop test : Queue %s: reg=0x%x, 0x%x/0x%x\n",
 887                         w->name, reg, value, mask);
 888
 889                 /* Check for events */
 890                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMU);
 891                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_PRE_PMD);
 892         }
 893
 894         if (reg >= 0) {
 895                 pop_dbg(dapm->dev, card->pop_time,
 896                         "pop test : Applying 0x%x/0x%x to %x in %dms\n",
 897                         value, mask, reg, card->pop_time);
 898                 pop_wait(card->pop_time);
 899                 snd_soc_update_bits(dapm->codec, reg, mask, value);
 900         }
 901
 902         list_for_each_entry(w, pending, power_list) {
 903                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMU);
 904                 dapm_seq_check_event(dapm, w, SND_SOC_DAPM_POST_PMD);
 905         }
 906 }
 907
 908 /* Apply a DAPM power sequence.
 909  *
 910  * We walk over a pre-sorted list of widgets to apply power to.  In
 911  * order to minimise the number of writes to the device required
 912  * multiple widgets will be updated in a single write where possible.
 913  * Currently anything that requires more than a single write is not
 914  * handled.
 915  */
 916 static void dapm_seq_run(struct snd_soc_dapm_context *dapm,
 917                          struct list_head *list, int event, bool power_up)
 918 {
 919         struct snd_soc_dapm_widget *w, *n;
 920         LIST_HEAD(pending);
 921         int cur_sort = -1;
 922         int cur_subseq = -1;
 923         int cur_reg = SND_SOC_NOPM;
 924         struct snd_soc_dapm_context *cur_dapm = NULL;
 925         int ret, i;
 926         int *sort;
 927
 928         if (power_up)
 929                 sort = dapm_up_seq;
 930         else
 931                 sort = dapm_down_seq;
 932
 933         list_for_each_entry_safe(w, n, list, power_list) {
 934                 ret = 0;
 935
 936                 /* Do we need to apply any queued changes? */
 937                 if (sort[w->id] != cur_sort || w->reg != cur_reg ||
 938                     w->dapm != cur_dapm || w->subseq != cur_subseq) {
 939                         if (!list_empty(&pending))
 940                                 dapm_seq_run_coalesced(cur_dapm, &pending);
 941
 942                         if (cur_dapm && cur_dapm->seq_notifier) {
 943                                 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
 944                                         if (sort[i] == cur_sort)
 945                                                 cur_dapm->seq_notifier(cur_dapm,
 946                                                                        i,
 947                                                                        cur_subseq);
 948                         }
 949
 950                         INIT_LIST_HEAD(&pending);
 951                         cur_sort = -1;
 952                         cur_subseq = -1;
 953                         cur_reg = SND_SOC_NOPM;
 954                         cur_dapm = NULL;
 955                 }
 956
 957                 switch (w->id) {
 958                 case snd_soc_dapm_pre:
 959                         if (!w->event)
 960                                 list_for_each_entry_safe_continue(w, n, list,
 961                                                                   power_list);
 962
 963                         if (event == SND_SOC_DAPM_STREAM_START)
 964                                 ret = w->event(w,
 965                                                NULL, SND_SOC_DAPM_PRE_PMU);
 966                         else if (event == SND_SOC_DAPM_STREAM_STOP)
 967                                 ret = w->event(w,
 968                                                NULL, SND_SOC_DAPM_PRE_PMD);
 969                         break;
 970
 971                 case snd_soc_dapm_post:
 972                         if (!w->event)
 973                                 list_for_each_entry_safe_continue(w, n, list,
 974                                                                   power_list);
 975
 976                         if (event == SND_SOC_DAPM_STREAM_START)
 977                                 ret = w->event(w,
 978                                                NULL, SND_SOC_DAPM_POST_PMU);
 979                         else if (event == SND_SOC_DAPM_STREAM_STOP)
 980                                 ret = w->event(w,
 981                                                NULL, SND_SOC_DAPM_POST_PMD);
 982                         break;
 983
 984                 case snd_soc_dapm_input:
 985                 case snd_soc_dapm_output:
 986                 case snd_soc_dapm_hp:
 987                 case snd_soc_dapm_mic:
 988                 case snd_soc_dapm_line:
 989                 case snd_soc_dapm_spk:
 990                         /* No register support currently */
 991                         ret = dapm_generic_apply_power(w);
 992                         break;
 993
 994                 default:
 995                         /* Queue it up for application */
 996                         cur_sort = sort[w->id];
 997                         cur_subseq = w->subseq;
 998                         cur_reg = w->reg;
 999                         cur_dapm = w->dapm;
1000                         list_move(&w->power_list, &pending);
1001                         break;
1002                 }
1003
1004                 if (ret < 0)
1005                         dev_err(w->dapm->dev,
1006                                 "Failed to apply widget power: %d\n", ret);
1007         }
1008
1009         if (!list_empty(&pending))
1010                 dapm_seq_run_coalesced(cur_dapm, &pending);
1011
1012         if (cur_dapm && cur_dapm->seq_notifier) {
1013                 for (i = 0; i < ARRAY_SIZE(dapm_up_seq); i++)
1014                         if (sort[i] == cur_sort)
1015                                 cur_dapm->seq_notifier(cur_dapm,
1016                                                        i, cur_subseq);
1017         }
1018 }
1019
1020 static void dapm_widget_update(struct snd_soc_dapm_context *dapm)
1021 {
1022         struct snd_soc_dapm_update *update = dapm->update;
1023         struct snd_soc_dapm_widget *w;
1024         int ret;
1025
1026         if (!update)
1027                 return;
1028
1029         w = update->widget;
1030
1031         if (w->event &&
1032             (w->event_flags & SND_SOC_DAPM_PRE_REG)) {
1033                 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_PRE_REG);
1034                 if (ret != 0)
1035                         pr_err("%s DAPM pre-event failed: %d\n",
1036                                w->name, ret);
1037         }
1038
1039         ret = snd_soc_update_bits(w->codec, update->reg, update->mask,
1040                                   update->val);
1041         if (ret < 0)
1042                 pr_err("%s DAPM update failed: %d\n", w->name, ret);
1043
1044         if (w->event &&
1045             (w->event_flags & SND_SOC_DAPM_POST_REG)) {
1046                 ret = w->event(w, update->kcontrol, SND_SOC_DAPM_POST_REG);
1047                 if (ret != 0)
1048                         pr_err("%s DAPM post-event failed: %d\n",
1049                                w->name, ret);
1050         }
1051 }
1052
1053 /* Async callback run prior to DAPM sequences - brings to _PREPARE if
1054  * they're changing state.
1055  */
1056 static void dapm_pre_sequence_async(void *data, async_cookie_t cookie)
1057 {
1058         struct snd_soc_dapm_context *d = data;
1059         int ret;
1060
1061         if (d->dev_power && d->bias_level == SND_SOC_BIAS_OFF) {
1062                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1063                 if (ret != 0)
1064                         dev_err(d->dev,
1065                                 "Failed to turn on bias: %d\n", ret);
1066         }
1067
1068         /* If we're changing to all on or all off then prepare */
1069         if ((d->dev_power && d->bias_level == SND_SOC_BIAS_STANDBY) ||
1070             (!d->dev_power && d->bias_level == SND_SOC_BIAS_ON)) {
1071                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_PREPARE);
1072                 if (ret != 0)
1073                         dev_err(d->dev,
1074                                 "Failed to prepare bias: %d\n", ret);
1075         }
1076 }
1077
1078 /* Async callback run prior to DAPM sequences - brings to their final
1079  * state.
1080  */
1081 static void dapm_post_sequence_async(void *data, async_cookie_t cookie)
1082 {
1083         struct snd_soc_dapm_context *d = data;
1084         int ret;
1085
1086         /* If we just powered the last thing off drop to standby bias */
1087         if (d->bias_level == SND_SOC_BIAS_PREPARE && !d->dev_power) {
1088                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_STANDBY);
1089                 if (ret != 0)
1090                         dev_err(d->dev, "Failed to apply standby bias: %d\n",
1091                                 ret);
1092         }
1093
1094         /* If we're in standby and can support bias off then do that */
1095         if (d->bias_level == SND_SOC_BIAS_STANDBY && d->idle_bias_off) {
1096                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_OFF);
1097                 if (ret != 0)
1098                         dev_err(d->dev, "Failed to turn off bias: %d\n", ret);
1099         }
1100
1101         /* If we just powered up then move to active bias */
1102         if (d->bias_level == SND_SOC_BIAS_PREPARE && d->dev_power) {
1103                 ret = snd_soc_dapm_set_bias_level(d, SND_SOC_BIAS_ON);
1104                 if (ret != 0)
1105                         dev_err(d->dev, "Failed to apply active bias: %d\n",
1106                                 ret);
1107         }
1108 }
1109
1110 /*
1111  * Scan each dapm widget for complete audio path.
1112  * A complete path is a route that has valid endpoints i.e.:-
1113  *
1114  *  o DAC to output pin.
1115  *  o Input Pin to ADC.
1116  *  o Input pin to Output pin (bypass, sidetone)
1117  *  o DAC to ADC (loopback).
1118  */
1119 static int dapm_power_widgets(struct snd_soc_dapm_context *dapm, int event)
1120 {
1121         struct snd_soc_card *card = dapm->card;
1122         struct snd_soc_dapm_widget *w;
1123         struct snd_soc_dapm_context *d;
1124         LIST_HEAD(up_list);
1125         LIST_HEAD(down_list);
1126         LIST_HEAD(async_domain);
1127         int power;
1128
1129         trace_snd_soc_dapm_start(card);
1130
1131         list_for_each_entry(d, &card->dapm_list, list)
1132                 if (d->n_widgets)
1133                         d->dev_power = 0;
1134
1135         /* Check which widgets we need to power and store them in
1136          * lists indicating if they should be powered up or down.
1137          */
1138         list_for_each_entry(w, &card->widgets, list) {
1139                 switch (w->id) {
1140                 case snd_soc_dapm_pre:
1141                         dapm_seq_insert(w, &down_list, false);
1142                         break;
1143                 case snd_soc_dapm_post:
1144                         dapm_seq_insert(w, &up_list, true);
1145                         break;
1146
1147                 default:
1148                         if (!w->power_check)
1149                                 continue;
1150
1151                         if (!w->force)
1152                                 power = w->power_check(w);
1153                         else
1154                                 power = 1;
1155                         if (power)
1156                                 w->dapm->dev_power = 1;
1157
1158                         if (w->power == power)
1159                                 continue;
1160
1161                         trace_snd_soc_dapm_widget_power(w, power);
1162
1163                         if (power)
1164                                 dapm_seq_insert(w, &up_list, true);
1165                         else
1166                                 dapm_seq_insert(w, &down_list, false);
1167
1168                         w->power = power;
1169                         break;
1170                 }
1171         }
1172
1173         /* If there are no DAPM widgets then try to figure out power from the
1174          * event type.
1175          */
1176         if (!dapm->n_widgets) {
1177                 switch (event) {
1178                 case SND_SOC_DAPM_STREAM_START:
1179                 case SND_SOC_DAPM_STREAM_RESUME:
1180                         dapm->dev_power = 1;
1181                         break;
1182                 case SND_SOC_DAPM_STREAM_STOP:
1183                         dapm->dev_power = !!dapm->codec->active;
1184                         break;
1185                 case SND_SOC_DAPM_STREAM_SUSPEND:
1186                         dapm->dev_power = 0;
1187                         break;
1188                 case SND_SOC_DAPM_STREAM_NOP:
1189                         switch (dapm->bias_level) {
1190                                 case SND_SOC_BIAS_STANDBY:
1191                                 case SND_SOC_BIAS_OFF:
1192                                         dapm->dev_power = 0;
1193                                         break;
1194                                 default:
1195                                         dapm->dev_power = 1;
1196                                         break;
1197                         }
1198                         break;
1199                 default:
1200                         break;
1201                 }
1202         }
1203
1204         /* Run all the bias changes in parallel */
1205         list_for_each_entry(d, &dapm->card->dapm_list, list)
1206                 async_schedule_domain(dapm_pre_sequence_async, d,
1207                                         &async_domain);
1208         async_synchronize_full_domain(&async_domain);
1209
1210         /* Power down widgets first; try to avoid amplifying pops. */
1211         dapm_seq_run(dapm, &down_list, event, false);
1212
1213         dapm_widget_update(dapm);
1214
1215         /* Now power up. */
1216         dapm_seq_run(dapm, &up_list, event, true);
1217
1218         /* Run all the bias changes in parallel */
1219         list_for_each_entry(d, &dapm->card->dapm_list, list)
1220                 async_schedule_domain(dapm_post_sequence_async, d,
1221                                         &async_domain);
1222         async_synchronize_full_domain(&async_domain);
1223
1224         pop_dbg(dapm->dev, card->pop_time,
1225                 "DAPM sequencing finished, waiting %dms\n", card->pop_time);
1226         pop_wait(card->pop_time);
1227
1228         trace_snd_soc_dapm_done(card);
1229
1230         return 0;
1231 }
1232
1233 #ifdef CONFIG_DEBUG_FS
1234 static int dapm_widget_power_open_file(struct inode *inode, struct file *file)
1235 {
1236         file->private_data = inode->i_private;
1237         return 0;
1238 }
1239
1240 static ssize_t dapm_widget_power_read_file(struct file *file,
1241                                            char __user *user_buf,
1242                                            size_t count, loff_t *ppos)
1243 {
1244         struct snd_soc_dapm_widget *w = file->private_data;
1245         char *buf;
1246         int in, out;
1247         ssize_t ret;
1248         struct snd_soc_dapm_path *p = NULL;
1249
1250         buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
1251         if (!buf)
1252                 return -ENOMEM;
1253
1254         in = is_connected_input_ep(w);
1255         dapm_clear_walk(w->dapm);
1256         out = is_connected_output_ep(w);
1257         dapm_clear_walk(w->dapm);
1258
1259         ret = snprintf(buf, PAGE_SIZE, "%s: %s  in %d out %d",
1260                        w->name, w->power ? "On" : "Off", in, out);
1261
1262         if (w->reg >= 0)
1263                 ret += snprintf(buf + ret, PAGE_SIZE - ret,
1264                                 " - R%d(0x%x) bit %d",
1265                                 w->reg, w->reg, w->shift);
1266
1267         ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n");
1268
1269         if (w->sname)
1270                 ret += snprintf(buf + ret, PAGE_SIZE - ret, " stream %s %s\n",
1271                                 w->sname,
1272                                 w->active ? "active" : "inactive");
1273
1274         list_for_each_entry(p, &w->sources, list_sink) {
1275                 if (p->connected && !p->connected(w, p->sink))
1276                         continue;
1277
1278                 if (p->connect)
1279                         ret += snprintf(buf + ret, PAGE_SIZE - ret,
1280                                         " in  \"%s\" \"%s\"\n",
1281                                         p->name ? p->name : "static",
1282                                         p->source->name);
1283         }
1284         list_for_each_entry(p, &w->sinks, list_source) {
1285                 if (p->connected && !p->connected(w, p->sink))
1286                         continue;
1287
1288                 if (p->connect)
1289                         ret += snprintf(buf + ret, PAGE_SIZE - ret,
1290                                         " out \"%s\" \"%s\"\n",
1291                                         p->name ? p->name : "static",
1292                                         p->sink->name);
1293         }
1294
1295         ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
1296
1297         kfree(buf);
1298         return ret;
1299 }
1300
1301 static const struct file_operations dapm_widget_power_fops = {
1302         .open = dapm_widget_power_open_file,
1303         .read = dapm_widget_power_read_file,
1304         .llseek = default_llseek,
1305 };
1306
1307 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm)
1308 {
1309         struct snd_soc_dapm_widget *w;
1310         struct dentry *d;
1311
1312         if (!dapm->debugfs_dapm)
1313                 return;
1314
1315         list_for_each_entry(w, &dapm->card->widgets, list) {
1316                 if (!w->name || w->dapm != dapm)
1317                         continue;
1318
1319                 d = debugfs_create_file(w->name, 0444,
1320                                         dapm->debugfs_dapm, w,
1321                                         &dapm_widget_power_fops);
1322                 if (!d)
1323                         dev_warn(w->dapm->dev,
1324                                 "ASoC: Failed to create %s debugfs file\n",
1325                                 w->name);
1326         }
1327 }
1328 #else
1329 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm)
1330 {
1331 }
1332 #endif
1333
1334 /* test and update the power status of a mux widget */
1335 static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
1336                                  struct snd_kcontrol *kcontrol, int change,
1337                                  int mux, struct soc_enum *e)
1338 {
1339         struct snd_soc_dapm_path *path;
1340         int found = 0;
1341
1342         if (widget->id != snd_soc_dapm_mux &&
1343             widget->id != snd_soc_dapm_virt_mux &&
1344             widget->id != snd_soc_dapm_value_mux)
1345                 return -ENODEV;
1346
1347         if (!change)
1348                 return 0;
1349
1350         /* find dapm widget path assoc with kcontrol */
1351         list_for_each_entry(path, &widget->dapm->card->paths, list) {
1352                 if (path->kcontrol != kcontrol)
1353                         continue;
1354
1355                 if (!path->name || !e->texts[mux])
1356                         continue;
1357
1358                 found = 1;
1359                 /* we now need to match the string in the enum to the path */
1360                 if (!(strcmp(path->name, e->texts[mux])))
1361                         path->connect = 1; /* new connection */
1362                 else
1363                         path->connect = 0; /* old connection must be powered down */
1364         }
1365
1366         if (found)
1367                 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1368
1369         return 0;
1370 }
1371
1372 /* test and update the power status of a mixer or switch widget */
1373 static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
1374                                    struct snd_kcontrol *kcontrol, int connect)
1375 {
1376         struct snd_soc_dapm_path *path;
1377         int found = 0;
1378
1379         if (widget->id != snd_soc_dapm_mixer &&
1380             widget->id != snd_soc_dapm_mixer_named_ctl &&
1381             widget->id != snd_soc_dapm_switch)
1382                 return -ENODEV;
1383
1384         /* find dapm widget path assoc with kcontrol */
1385         list_for_each_entry(path, &widget->dapm->card->paths, list) {
1386                 if (path->kcontrol != kcontrol)
1387                         continue;
1388
1389                 /* found, now check type */
1390                 found = 1;
1391                 path->connect = connect;
1392                 break;
1393         }
1394
1395         if (found)
1396                 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1397
1398         return 0;
1399 }
1400
1401 /* show dapm widget status in sys fs */
1402 static ssize_t dapm_widget_show(struct device *dev,
1403         struct device_attribute *attr, char *buf)
1404 {
1405         struct snd_soc_pcm_runtime *rtd =
1406                         container_of(dev, struct snd_soc_pcm_runtime, dev);
1407         struct snd_soc_codec *codec =rtd->codec;
1408         struct snd_soc_dapm_widget *w;
1409         int count = 0;
1410         char *state = "not set";
1411
1412         list_for_each_entry(w, &codec->card->widgets, list) {
1413                 if (w->dapm != &codec->dapm)
1414                         continue;
1415
1416                 /* only display widgets that burnm power */
1417                 switch (w->id) {
1418                 case snd_soc_dapm_hp:
1419                 case snd_soc_dapm_mic:
1420                 case snd_soc_dapm_spk:
1421                 case snd_soc_dapm_line:
1422                 case snd_soc_dapm_micbias:
1423                 case snd_soc_dapm_dac:
1424                 case snd_soc_dapm_adc:
1425                 case snd_soc_dapm_pga:
1426                 case snd_soc_dapm_out_drv:
1427                 case snd_soc_dapm_mixer:
1428                 case snd_soc_dapm_mixer_named_ctl:
1429                 case snd_soc_dapm_supply:
1430                         if (w->name)
1431                                 count += sprintf(buf + count, "%s: %s\n",
1432                                         w->name, w->power ? "On":"Off");
1433                 break;
1434                 default:
1435                 break;
1436                 }
1437         }
1438
1439         switch (codec->dapm.bias_level) {
1440         case SND_SOC_BIAS_ON:
1441                 state = "On";
1442                 break;
1443         case SND_SOC_BIAS_PREPARE:
1444                 state = "Prepare";
1445                 break;
1446         case SND_SOC_BIAS_STANDBY:
1447                 state = "Standby";
1448                 break;
1449         case SND_SOC_BIAS_OFF:
1450                 state = "Off";
1451                 break;
1452         }
1453         count += sprintf(buf + count, "PM State: %s\n", state);
1454
1455         return count;
1456 }
1457
1458 static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
1459
1460 int snd_soc_dapm_sys_add(struct device *dev)
1461 {
1462         return device_create_file(dev, &dev_attr_dapm_widget);
1463 }
1464
1465 static void snd_soc_dapm_sys_remove(struct device *dev)
1466 {
1467         device_remove_file(dev, &dev_attr_dapm_widget);
1468 }
1469
1470 /* free all dapm widgets and resources */
1471 static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
1472 {
1473         struct snd_soc_dapm_widget *w, *next_w;
1474         struct snd_soc_dapm_path *p, *next_p;
1475
1476         list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
1477                 if (w->dapm != dapm)
1478                         continue;
1479                 list_del(&w->list);
1480                 /*
1481                  * remove source and sink paths associated to this widget.
1482                  * While removing the path, remove reference to it from both
1483                  * source and sink widgets so that path is removed only once.
1484                  */
1485                 list_for_each_entry_safe(p, next_p, &w->sources, list_sink) {
1486                         list_del(&p->list_sink);
1487                         list_del(&p->list_source);
1488                         list_del(&p->list);
1489                         kfree(p->long_name);
1490                         kfree(p);
1491                 }
1492                 list_for_each_entry_safe(p, next_p, &w->sinks, list_source) {
1493                         list_del(&p->list_sink);
1494                         list_del(&p->list_source);
1495                         list_del(&p->list);
1496                         kfree(p->long_name);
1497                         kfree(p);
1498                 }
1499                 kfree(w->name);
1500                 kfree(w);
1501         }
1502 }
1503
1504 static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
1505                                 const char *pin, int status)
1506 {
1507         struct snd_soc_dapm_widget *w;
1508
1509         list_for_each_entry(w, &dapm->card->widgets, list) {
1510                 if (w->dapm != dapm)
1511                         continue;
1512                 if (!strcmp(w->name, pin)) {
1513                         dev_dbg(w->dapm->dev, "dapm: pin %s = %d\n",
1514                                 pin, status);
1515                         w->connected = status;
1516                         /* Allow disabling of forced pins */
1517                         if (status == 0)
1518                                 w->force = 0;
1519                         return 0;
1520                 }
1521         }
1522
1523         dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
1524         return -EINVAL;
1525 }
1526
1527 /**
1528  * snd_soc_dapm_sync - scan and power dapm paths
1529  * @dapm: DAPM context
1530  *
1531  * Walks all dapm audio paths and powers widgets according to their
1532  * stream or path usage.
1533  *
1534  * Returns 0 for success.
1535  */
1536 int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
1537 {
1538         return dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1539 }
1540 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
1541
1542 static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
1543                                   const struct snd_soc_dapm_route *route)
1544 {
1545         struct snd_soc_dapm_path *path;
1546         struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
1547         struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
1548         const char *sink;
1549         const char *control = route->control;
1550         const char *source;
1551         char prefixed_sink[80];
1552         char prefixed_source[80];
1553         int ret = 0;
1554
1555         if (dapm->codec && dapm->codec->name_prefix) {
1556                 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
1557                          dapm->codec->name_prefix, route->sink);
1558                 sink = prefixed_sink;
1559                 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
1560                          dapm->codec->name_prefix, route->source);
1561                 source = prefixed_source;
1562         } else {
1563                 sink = route->sink;
1564                 source = route->source;
1565         }
1566
1567         /*
1568          * find src and dest widgets over all widgets but favor a widget from
1569          * current DAPM context
1570          */
1571         list_for_each_entry(w, &dapm->card->widgets, list) {
1572                 if (!wsink && !(strcmp(w->name, sink))) {
1573                         wtsink = w;
1574                         if (w->dapm == dapm)
1575                                 wsink = w;
1576                         continue;
1577                 }
1578                 if (!wsource && !(strcmp(w->name, source))) {
1579                         wtsource = w;
1580                         if (w->dapm == dapm)
1581                                 wsource = w;
1582                 }
1583         }
1584         /* use widget from another DAPM context if not found from this */
1585         if (!wsink)
1586                 wsink = wtsink;
1587         if (!wsource)
1588                 wsource = wtsource;
1589
1590         if (wsource == NULL || wsink == NULL)
1591                 return -ENODEV;
1592
1593         path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
1594         if (!path)
1595                 return -ENOMEM;
1596
1597         path->source = wsource;
1598         path->sink = wsink;
1599         path->connected = route->connected;
1600         INIT_LIST_HEAD(&path->list);
1601         INIT_LIST_HEAD(&path->list_source);
1602         INIT_LIST_HEAD(&path->list_sink);
1603
1604         /* check for external widgets */
1605         if (wsink->id == snd_soc_dapm_input) {
1606                 if (wsource->id == snd_soc_dapm_micbias ||
1607                         wsource->id == snd_soc_dapm_mic ||
1608                         wsource->id == snd_soc_dapm_line ||
1609                         wsource->id == snd_soc_dapm_output)
1610                         wsink->ext = 1;
1611         }
1612         if (wsource->id == snd_soc_dapm_output) {
1613                 if (wsink->id == snd_soc_dapm_spk ||
1614                         wsink->id == snd_soc_dapm_hp ||
1615                         wsink->id == snd_soc_dapm_line ||
1616                         wsink->id == snd_soc_dapm_input)
1617                         wsource->ext = 1;
1618         }
1619
1620         /* connect static paths */
1621         if (control == NULL) {
1622                 list_add(&path->list, &dapm->card->paths);
1623                 list_add(&path->list_sink, &wsink->sources);
1624                 list_add(&path->list_source, &wsource->sinks);
1625                 path->connect = 1;
1626                 return 0;
1627         }
1628
1629         /* connect dynamic paths */
1630         switch(wsink->id) {
1631         case snd_soc_dapm_adc:
1632         case snd_soc_dapm_dac:
1633         case snd_soc_dapm_pga:
1634         case snd_soc_dapm_out_drv:
1635         case snd_soc_dapm_input:
1636         case snd_soc_dapm_output:
1637         case snd_soc_dapm_micbias:
1638         case snd_soc_dapm_vmid:
1639         case snd_soc_dapm_pre:
1640         case snd_soc_dapm_post:
1641         case snd_soc_dapm_supply:
1642         case snd_soc_dapm_aif_in:
1643         case snd_soc_dapm_aif_out:
1644                 list_add(&path->list, &dapm->card->paths);
1645                 list_add(&path->list_sink, &wsink->sources);
1646                 list_add(&path->list_source, &wsource->sinks);
1647                 path->connect = 1;
1648                 return 0;
1649         case snd_soc_dapm_mux:
1650         case snd_soc_dapm_virt_mux:
1651         case snd_soc_dapm_value_mux:
1652                 ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
1653                         &wsink->kcontrols[0]);
1654                 if (ret != 0)
1655                         goto err;
1656                 break;
1657         case snd_soc_dapm_switch:
1658         case snd_soc_dapm_mixer:
1659         case snd_soc_dapm_mixer_named_ctl:
1660                 ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
1661                 if (ret != 0)
1662                         goto err;
1663                 break;
1664         case snd_soc_dapm_hp:
1665         case snd_soc_dapm_mic:
1666         case snd_soc_dapm_line:
1667         case snd_soc_dapm_spk:
1668                 list_add(&path->list, &dapm->card->paths);
1669                 list_add(&path->list_sink, &wsink->sources);
1670                 list_add(&path->list_source, &wsource->sinks);
1671                 path->connect = 0;
1672                 return 0;
1673         }
1674         return 0;
1675
1676 err:
1677         dev_warn(dapm->dev, "asoc: no dapm match for %s --> %s --> %s\n",
1678                  source, control, sink);
1679         kfree(path);
1680         return ret;
1681 }
1682
1683 /**
1684  * snd_soc_dapm_add_routes - Add routes between DAPM widgets
1685  * @dapm: DAPM context
1686  * @route: audio routes
1687  * @num: number of routes
1688  *
1689  * Connects 2 dapm widgets together via a named audio path. The sink is
1690  * the widget receiving the audio signal, whilst the source is the sender
1691  * of the audio signal.
1692  *
1693  * Returns 0 for success else error. On error all resources can be freed
1694  * with a call to snd_soc_card_free().
1695  */
1696 int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
1697                             const struct snd_soc_dapm_route *route, int num)
1698 {
1699         int i, ret;
1700
1701         for (i = 0; i < num; i++) {
1702                 ret = snd_soc_dapm_add_route(dapm, route);
1703                 if (ret < 0) {
1704                         dev_err(dapm->dev, "Failed to add route %s->%s\n",
1705                                 route->source, route->sink);
1706                         return ret;
1707                 }
1708                 route++;
1709         }
1710
1711         return 0;
1712 }
1713 EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
1714
1715 /**
1716  * snd_soc_dapm_new_widgets - add new dapm widgets
1717  * @dapm: DAPM context
1718  *
1719  * Checks the codec for any new dapm widgets and creates them if found.
1720  *
1721  * Returns 0 for success.
1722  */
1723 int snd_soc_dapm_new_widgets(struct snd_soc_dapm_context *dapm)
1724 {
1725         struct snd_soc_dapm_widget *w;
1726         unsigned int val;
1727
1728         list_for_each_entry(w, &dapm->card->widgets, list)
1729         {
1730                 if (w->new)
1731                         continue;
1732
1733                 switch(w->id) {
1734                 case snd_soc_dapm_switch:
1735                 case snd_soc_dapm_mixer:
1736                 case snd_soc_dapm_mixer_named_ctl:
1737                         w->power_check = dapm_generic_check_power;
1738                         dapm_new_mixer(dapm, w);
1739                         break;
1740                 case snd_soc_dapm_mux:
1741                 case snd_soc_dapm_virt_mux:
1742                 case snd_soc_dapm_value_mux:
1743                         w->power_check = dapm_generic_check_power;
1744                         dapm_new_mux(dapm, w);
1745                         break;
1746                 case snd_soc_dapm_adc:
1747                 case snd_soc_dapm_aif_out:
1748                         w->power_check = dapm_adc_check_power;
1749                         break;
1750                 case snd_soc_dapm_dac:
1751                 case snd_soc_dapm_aif_in:
1752                         w->power_check = dapm_dac_check_power;
1753                         break;
1754                 case snd_soc_dapm_pga:
1755                 case snd_soc_dapm_out_drv:
1756                         w->power_check = dapm_generic_check_power;
1757                         dapm_new_pga(dapm, w);
1758                         break;
1759                 case snd_soc_dapm_input:
1760                 case snd_soc_dapm_output:
1761                 case snd_soc_dapm_micbias:
1762                 case snd_soc_dapm_spk:
1763                 case snd_soc_dapm_hp:
1764                 case snd_soc_dapm_mic:
1765                 case snd_soc_dapm_line:
1766                         w->power_check = dapm_generic_check_power;
1767                         break;
1768                 case snd_soc_dapm_supply:
1769                         w->power_check = dapm_supply_check_power;
1770                 case snd_soc_dapm_vmid:
1771                 case snd_soc_dapm_pre:
1772                 case snd_soc_dapm_post:
1773                         break;
1774                 }
1775
1776                 /* Read the initial power state from the device */
1777                 if (w->reg >= 0) {
1778                         val = snd_soc_read(w->codec, w->reg);
1779                         val &= 1 << w->shift;
1780                         if (w->invert)
1781                                 val = !val;
1782
1783                         if (val)
1784                                 w->power = 1;
1785                 }
1786
1787                 w->new = 1;
1788         }
1789
1790         dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1791         return 0;
1792 }
1793 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
1794
1795 /**
1796  * snd_soc_dapm_get_volsw - dapm mixer get callback
1797  * @kcontrol: mixer control
1798  * @ucontrol: control element information
1799  *
1800  * Callback to get the value of a dapm mixer control.
1801  *
1802  * Returns 0 for success.
1803  */
1804 int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
1805         struct snd_ctl_elem_value *ucontrol)
1806 {
1807         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1808         struct soc_mixer_control *mc =
1809                 (struct soc_mixer_control *)kcontrol->private_value;
1810         unsigned int reg = mc->reg;
1811         unsigned int shift = mc->shift;
1812         unsigned int rshift = mc->rshift;
1813         int max = mc->max;
1814         unsigned int invert = mc->invert;
1815         unsigned int mask = (1 << fls(max)) - 1;
1816
1817         ucontrol->value.integer.value[0] =
1818                 (snd_soc_read(widget->codec, reg) >> shift) & mask;
1819         if (shift != rshift)
1820                 ucontrol->value.integer.value[1] =
1821                         (snd_soc_read(widget->codec, reg) >> rshift) & mask;
1822         if (invert) {
1823                 ucontrol->value.integer.value[0] =
1824                         max - ucontrol->value.integer.value[0];
1825                 if (shift != rshift)
1826                         ucontrol->value.integer.value[1] =
1827                                 max - ucontrol->value.integer.value[1];
1828         }
1829
1830         return 0;
1831 }
1832 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
1833
1834 /**
1835  * snd_soc_dapm_put_volsw - dapm mixer set callback
1836  * @kcontrol: mixer control
1837  * @ucontrol: control element information
1838  *
1839  * Callback to set the value of a dapm mixer control.
1840  *
1841  * Returns 0 for success.
1842  */
1843 int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
1844         struct snd_ctl_elem_value *ucontrol)
1845 {
1846         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1847         struct soc_mixer_control *mc =
1848                 (struct soc_mixer_control *)kcontrol->private_value;
1849         unsigned int reg = mc->reg;
1850         unsigned int shift = mc->shift;
1851         int max = mc->max;
1852         unsigned int mask = (1 << fls(max)) - 1;
1853         unsigned int invert = mc->invert;
1854         unsigned int val;
1855         int connect, change;
1856         struct snd_soc_dapm_update update;
1857
1858         val = (ucontrol->value.integer.value[0] & mask);
1859
1860         if (invert)
1861                 val = max - val;
1862         mask = mask << shift;
1863         val = val << shift;
1864
1865         mutex_lock(&widget->codec->mutex);
1866         widget->value = val;
1867
1868         change = snd_soc_test_bits(widget->codec, reg, mask, val);
1869         if (change) {
1870                 if (val)
1871                         /* new connection */
1872                         connect = invert ? 0:1;
1873                 else
1874                         /* old connection must be powered down */
1875                         connect = invert ? 1:0;
1876
1877                 update.kcontrol = kcontrol;
1878                 update.widget = widget;
1879                 update.reg = reg;
1880                 update.mask = mask;
1881                 update.val = val;
1882                 widget->dapm->update = &update;
1883
1884                 dapm_mixer_update_power(widget, kcontrol, connect);
1885
1886                 widget->dapm->update = NULL;
1887         }
1888
1889         mutex_unlock(&widget->codec->mutex);
1890         return 0;
1891 }
1892 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
1893
1894 /**
1895  * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
1896  * @kcontrol: mixer control
1897  * @ucontrol: control element information
1898  *
1899  * Callback to get the value of a dapm enumerated double mixer control.
1900  *
1901  * Returns 0 for success.
1902  */
1903 int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
1904         struct snd_ctl_elem_value *ucontrol)
1905 {
1906         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1907         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1908         unsigned int val, bitmask;
1909
1910         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1911                 ;
1912         val = snd_soc_read(widget->codec, e->reg);
1913         ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
1914         if (e->shift_l != e->shift_r)
1915                 ucontrol->value.enumerated.item[1] =
1916                         (val >> e->shift_r) & (bitmask - 1);
1917
1918         return 0;
1919 }
1920 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
1921
1922 /**
1923  * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
1924  * @kcontrol: mixer control
1925  * @ucontrol: control element information
1926  *
1927  * Callback to set the value of a dapm enumerated double mixer control.
1928  *
1929  * Returns 0 for success.
1930  */
1931 int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
1932         struct snd_ctl_elem_value *ucontrol)
1933 {
1934         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1935         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1936         unsigned int val, mux, change;
1937         unsigned int mask, bitmask;
1938         struct snd_soc_dapm_update update;
1939
1940         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1941                 ;
1942         if (ucontrol->value.enumerated.item[0] > e->max - 1)
1943                 return -EINVAL;
1944         mux = ucontrol->value.enumerated.item[0];
1945         val = mux << e->shift_l;
1946         mask = (bitmask - 1) << e->shift_l;
1947         if (e->shift_l != e->shift_r) {
1948                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
1949                         return -EINVAL;
1950                 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
1951                 mask |= (bitmask - 1) << e->shift_r;
1952         }
1953
1954         mutex_lock(&widget->codec->mutex);
1955         widget->value = val;
1956         change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
1957
1958         update.kcontrol = kcontrol;
1959         update.widget = widget;
1960         update.reg = e->reg;
1961         update.mask = mask;
1962         update.val = val;
1963         widget->dapm->update = &update;
1964
1965         dapm_mux_update_power(widget, kcontrol, change, mux, e);
1966
1967         widget->dapm->update = NULL;
1968
1969         mutex_unlock(&widget->codec->mutex);
1970         return change;
1971 }
1972 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
1973
1974 /**
1975  * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
1976  * @kcontrol: mixer control
1977  * @ucontrol: control element information
1978  *
1979  * Returns 0 for success.
1980  */
1981 int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
1982                                struct snd_ctl_elem_value *ucontrol)
1983 {
1984         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1985
1986         ucontrol->value.enumerated.item[0] = widget->value;
1987
1988         return 0;
1989 }
1990 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);
1991
1992 /**
1993  * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
1994  * @kcontrol: mixer control
1995  * @ucontrol: control element information
1996  *
1997  * Returns 0 for success.
1998  */
1999 int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
2000                                struct snd_ctl_elem_value *ucontrol)
2001 {
2002         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
2003         struct soc_enum *e =
2004                 (struct soc_enum *)kcontrol->private_value;
2005         int change;
2006         int ret = 0;
2007
2008         if (ucontrol->value.enumerated.item[0] >= e->max)
2009                 return -EINVAL;
2010
2011         mutex_lock(&widget->codec->mutex);
2012
2013         change = widget->value != ucontrol->value.enumerated.item[0];
2014         widget->value = ucontrol->value.enumerated.item[0];
2015         dapm_mux_update_power(widget, kcontrol, change, widget->value, e);
2016
2017         mutex_unlock(&widget->codec->mutex);
2018         return ret;
2019 }
2020 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);
2021
2022 /**
2023  * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
2024  *                                      callback
2025  * @kcontrol: mixer control
2026  * @ucontrol: control element information
2027  *
2028  * Callback to get the value of a dapm semi enumerated double mixer control.
2029  *
2030  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2031  * used for handling bitfield coded enumeration for example.
2032  *
2033  * Returns 0 for success.
2034  */
2035 int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
2036         struct snd_ctl_elem_value *ucontrol)
2037 {
2038         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
2039         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2040         unsigned int reg_val, val, mux;
2041
2042         reg_val = snd_soc_read(widget->codec, e->reg);
2043         val = (reg_val >> e->shift_l) & e->mask;
2044         for (mux = 0; mux < e->max; mux++) {
2045                 if (val == e->values[mux])
2046                         break;
2047         }
2048         ucontrol->value.enumerated.item[0] = mux;
2049         if (e->shift_l != e->shift_r) {
2050                 val = (reg_val >> e->shift_r) & e->mask;
2051                 for (mux = 0; mux < e->max; mux++) {
2052                         if (val == e->values[mux])
2053                                 break;
2054                 }
2055                 ucontrol->value.enumerated.item[1] = mux;
2056         }
2057
2058         return 0;
2059 }
2060 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
2061
2062 /**
2063  * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
2064  *                                      callback
2065  * @kcontrol: mixer control
2066  * @ucontrol: control element information
2067  *
2068  * Callback to set the value of a dapm semi enumerated double mixer control.
2069  *
2070  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2071  * used for handling bitfield coded enumeration for example.
2072  *
2073  * Returns 0 for success.
2074  */
2075 int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
2076         struct snd_ctl_elem_value *ucontrol)
2077 {
2078         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
2079         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2080         unsigned int val, mux, change;
2081         unsigned int mask;
2082         struct snd_soc_dapm_update update;
2083
2084         if (ucontrol->value.enumerated.item[0] > e->max - 1)
2085                 return -EINVAL;
2086         mux = ucontrol->value.enumerated.item[0];
2087         val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2088         mask = e->mask << e->shift_l;
2089         if (e->shift_l != e->shift_r) {
2090                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2091                         return -EINVAL;
2092                 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2093                 mask |= e->mask << e->shift_r;
2094         }
2095
2096         mutex_lock(&widget->codec->mutex);
2097         widget->value = val;
2098         change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2099
2100         update.kcontrol = kcontrol;
2101         update.widget = widget;
2102         update.reg = e->reg;
2103         update.mask = mask;
2104         update.val = val;
2105         widget->dapm->update = &update;
2106
2107         dapm_mux_update_power(widget, kcontrol, change, mux, e);
2108
2109         widget->dapm->update = NULL;
2110
2111         mutex_unlock(&widget->codec->mutex);
2112         return change;
2113 }
2114 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
2115
2116 /**
2117  * snd_soc_dapm_info_pin_switch - Info for a pin switch
2118  *
2119  * @kcontrol: mixer control
2120  * @uinfo: control element information
2121  *
2122  * Callback to provide information about a pin switch control.
2123  */
2124 int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
2125                                  struct snd_ctl_elem_info *uinfo)
2126 {
2127         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2128         uinfo->count = 1;
2129         uinfo->value.integer.min = 0;
2130         uinfo->value.integer.max = 1;
2131
2132         return 0;
2133 }
2134 EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
2135
2136 /**
2137  * snd_soc_dapm_get_pin_switch - Get information for a pin switch
2138  *
2139  * @kcontrol: mixer control
2140  * @ucontrol: Value
2141  */
2142 int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
2143                                 struct snd_ctl_elem_value *ucontrol)
2144 {
2145         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2146         const char *pin = (const char *)kcontrol->private_value;
2147
2148         mutex_lock(&codec->mutex);
2149
2150         ucontrol->value.integer.value[0] =
2151                 snd_soc_dapm_get_pin_status(&codec->dapm, pin);
2152
2153         mutex_unlock(&codec->mutex);
2154
2155         return 0;
2156 }
2157 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
2158
2159 /**
2160  * snd_soc_dapm_put_pin_switch - Set information for a pin switch
2161  *
2162  * @kcontrol: mixer control
2163  * @ucontrol: Value
2164  */
2165 int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
2166                                 struct snd_ctl_elem_value *ucontrol)
2167 {
2168         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2169         const char *pin = (const char *)kcontrol->private_value;
2170
2171         mutex_lock(&codec->mutex);
2172
2173         if (ucontrol->value.integer.value[0])
2174                 snd_soc_dapm_enable_pin(&codec->dapm, pin);
2175         else
2176                 snd_soc_dapm_disable_pin(&codec->dapm, pin);
2177
2178         snd_soc_dapm_sync(&codec->dapm);
2179
2180         mutex_unlock(&codec->mutex);
2181
2182         return 0;
2183 }
2184 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
2185
2186 /**
2187  * snd_soc_dapm_new_control - create new dapm control
2188  * @dapm: DAPM context
2189  * @widget: widget template
2190  *
2191  * Creates a new dapm control based upon the template.
2192  *
2193  * Returns 0 for success else error.
2194  */
2195 int snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
2196         const struct snd_soc_dapm_widget *widget)
2197 {
2198         struct snd_soc_dapm_widget *w;
2199         size_t name_len;
2200
2201         if ((w = dapm_cnew_widget(widget)) == NULL)
2202                 return -ENOMEM;
2203
2204         name_len = strlen(widget->name) + 1;
2205         if (dapm->codec && dapm->codec->name_prefix)
2206                 name_len += 1 + strlen(dapm->codec->name_prefix);
2207         w->name = kmalloc(name_len, GFP_KERNEL);
2208         if (w->name == NULL) {
2209                 kfree(w);
2210                 return -ENOMEM;
2211         }
2212         if (dapm->codec && dapm->codec->name_prefix)
2213                 snprintf(w->name, name_len, "%s %s",
2214                         dapm->codec->name_prefix, widget->name);
2215         else
2216                 snprintf(w->name, name_len, "%s", widget->name);
2217
2218         dapm->n_widgets++;
2219         w->dapm = dapm;
2220         w->codec = dapm->codec;
2221         INIT_LIST_HEAD(&w->sources);
2222         INIT_LIST_HEAD(&w->sinks);
2223         INIT_LIST_HEAD(&w->list);
2224         list_add(&w->list, &dapm->card->widgets);
2225
2226         /* machine layer set ups unconnected pins and insertions */
2227         w->connected = 1;
2228         return 0;
2229 }
2230 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
2231
2232 /**
2233  * snd_soc_dapm_new_controls - create new dapm controls
2234  * @dapm: DAPM context
2235  * @widget: widget array
2236  * @num: number of widgets
2237  *
2238  * Creates new DAPM controls based upon the templates.
2239  *
2240  * Returns 0 for success else error.
2241  */
2242 int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
2243         const struct snd_soc_dapm_widget *widget,
2244         int num)
2245 {
2246         int i, ret;
2247
2248         for (i = 0; i < num; i++) {
2249                 ret = snd_soc_dapm_new_control(dapm, widget);
2250                 if (ret < 0) {
2251                         dev_err(dapm->dev,
2252                                 "ASoC: Failed to create DAPM control %s: %d\n",
2253                                 widget->name, ret);
2254                         return ret;
2255                 }
2256                 widget++;
2257         }
2258         return 0;
2259 }
2260 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
2261
2262 static void soc_dapm_stream_event(struct snd_soc_dapm_context *dapm,
2263         const char *stream, int event)
2264 {
2265         struct snd_soc_dapm_widget *w;
2266
2267         list_for_each_entry(w, &dapm->card->widgets, list)
2268         {
2269                 if (!w->sname || w->dapm != dapm)
2270                         continue;
2271                 dev_dbg(w->dapm->dev, "widget %s\n %s stream %s event %d\n",
2272                         w->name, w->sname, stream, event);
2273                 if (strstr(w->sname, stream)) {
2274                         switch(event) {
2275                         case SND_SOC_DAPM_STREAM_START:
2276                                 w->active = 1;
2277                                 break;
2278                         case SND_SOC_DAPM_STREAM_STOP:
2279                                 w->active = 0;
2280                                 break;
2281                         case SND_SOC_DAPM_STREAM_SUSPEND:
2282                         case SND_SOC_DAPM_STREAM_RESUME:
2283                         case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
2284                         case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
2285                                 break;
2286                         }
2287                 }
2288         }
2289
2290         dapm_power_widgets(dapm, event);
2291 }
2292
2293 /**
2294  * snd_soc_dapm_stream_event - send a stream event to the dapm core
2295  * @rtd: PCM runtime data
2296  * @stream: stream name
2297  * @event: stream event
2298  *
2299  * Sends a stream event to the dapm core. The core then makes any
2300  * necessary widget power changes.
2301  *
2302  * Returns 0 for success else error.
2303  */
2304 int snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd,
2305         const char *stream, int event)
2306 {
2307         struct snd_soc_codec *codec = rtd->codec;
2308
2309         if (stream == NULL)
2310                 return 0;
2311
2312         mutex_lock(&codec->mutex);
2313         soc_dapm_stream_event(&codec->dapm, stream, event);
2314         mutex_unlock(&codec->mutex);
2315         return 0;
2316 }
2317
2318 /**
2319  * snd_soc_dapm_enable_pin - enable pin.
2320  * @dapm: DAPM context
2321  * @pin: pin name
2322  *
2323  * Enables input/output pin and its parents or children widgets iff there is
2324  * a valid audio route and active audio stream.
2325  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2326  * do any widget power switching.
2327  */
2328 int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2329 {
2330         return snd_soc_dapm_set_pin(dapm, pin, 1);
2331 }
2332 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
2333
2334 /**
2335  * snd_soc_dapm_force_enable_pin - force a pin to be enabled
2336  * @dapm: DAPM context
2337  * @pin: pin name
2338  *
2339  * Enables input/output pin regardless of any other state.  This is
2340  * intended for use with microphone bias supplies used in microphone
2341  * jack detection.
2342  *
2343  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2344  * do any widget power switching.
2345  */
2346 int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
2347                                   const char *pin)
2348 {
2349         struct snd_soc_dapm_widget *w;
2350
2351         list_for_each_entry(w, &dapm->card->widgets, list) {
2352                 if (w->dapm != dapm)
2353                         continue;
2354                 if (!strcmp(w->name, pin)) {
2355                         dev_dbg(w->dapm->dev,
2356                                 "dapm: force enable pin %s\n", pin);
2357                         w->connected = 1;
2358                         w->force = 1;
2359                         return 0;
2360                 }
2361         }
2362
2363         dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2364         return -EINVAL;
2365 }
2366 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
2367
2368 /**
2369  * snd_soc_dapm_disable_pin - disable pin.
2370  * @dapm: DAPM context
2371  * @pin: pin name
2372  *
2373  * Disables input/output pin and its parents or children widgets.
2374  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2375  * do any widget power switching.
2376  */
2377 int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
2378                              const char *pin)
2379 {
2380         return snd_soc_dapm_set_pin(dapm, pin, 0);
2381 }
2382 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
2383
2384 /**
2385  * snd_soc_dapm_nc_pin - permanently disable pin.
2386  * @dapm: DAPM context
2387  * @pin: pin name
2388  *
2389  * Marks the specified pin as being not connected, disabling it along
2390  * any parent or child widgets.  At present this is identical to
2391  * snd_soc_dapm_disable_pin() but in future it will be extended to do
2392  * additional things such as disabling controls which only affect
2393  * paths through the pin.
2394  *
2395  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2396  * do any widget power switching.
2397  */
2398 int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2399 {
2400         return snd_soc_dapm_set_pin(dapm, pin, 0);
2401 }
2402 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
2403
2404 /**
2405  * snd_soc_dapm_get_pin_status - get audio pin status
2406  * @dapm: DAPM context
2407  * @pin: audio signal pin endpoint (or start point)
2408  *
2409  * Get audio pin status - connected or disconnected.
2410  *
2411  * Returns 1 for connected otherwise 0.
2412  */
2413 int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
2414                                 const char *pin)
2415 {
2416         struct snd_soc_dapm_widget *w;
2417
2418         list_for_each_entry(w, &dapm->card->widgets, list) {
2419                 if (w->dapm != dapm)
2420                         continue;
2421                 if (!strcmp(w->name, pin))
2422                         return w->connected;
2423         }
2424
2425         return 0;
2426 }
2427 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
2428
2429 /**
2430  * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
2431  * @dapm: DAPM context
2432  * @pin: audio signal pin endpoint (or start point)
2433  *
2434  * Mark the given endpoint or pin as ignoring suspend.  When the
2435  * system is disabled a path between two endpoints flagged as ignoring
2436  * suspend will not be disabled.  The path must already be enabled via
2437  * normal means at suspend time, it will not be turned on if it was not
2438  * already enabled.
2439  */
2440 int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
2441                                 const char *pin)
2442 {
2443         struct snd_soc_dapm_widget *w;
2444
2445         list_for_each_entry(w, &dapm->card->widgets, list) {
2446                 if (w->dapm != dapm)
2447                         continue;
2448                 if (!strcmp(w->name, pin)) {
2449                         w->ignore_suspend = 1;
2450                         return 0;
2451                 }
2452         }
2453
2454         dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2455         return -EINVAL;
2456 }
2457 EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
2458
2459 /**
2460  * snd_soc_dapm_free - free dapm resources
2461  * @card: SoC device
2462  *
2463  * Free all dapm widgets and resources.
2464  */
2465 void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
2466 {
2467         snd_soc_dapm_sys_remove(dapm->dev);
2468         dapm_free_widgets(dapm);
2469         list_del(&dapm->list);
2470 }
2471 EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
2472
2473 static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
2474 {
2475         struct snd_soc_dapm_widget *w;
2476         LIST_HEAD(down_list);
2477         int powerdown = 0;
2478
2479         list_for_each_entry(w, &dapm->card->widgets, list) {
2480                 if (w->dapm != dapm)
2481                         continue;
2482                 if (w->power) {
2483                         dapm_seq_insert(w, &down_list, false);
2484                         w->power = 0;
2485                         powerdown = 1;
2486                 }
2487         }
2488
2489         /* If there were no widgets to power down we're already in
2490          * standby.
2491          */
2492         if (powerdown) {
2493                 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_PREPARE);
2494                 dapm_seq_run(dapm, &down_list, 0, false);
2495                 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_STANDBY);
2496         }
2497 }
2498
2499 /*
2500  * snd_soc_dapm_shutdown - callback for system shutdown
2501  */
2502 void snd_soc_dapm_shutdown(struct snd_soc_card *card)
2503 {
2504         struct snd_soc_codec *codec;
2505
2506         list_for_each_entry(codec, &card->codec_dev_list, list) {
2507                 soc_dapm_shutdown_codec(&codec->dapm);
2508                 snd_soc_dapm_set_bias_level(&codec->dapm, SND_SOC_BIAS_OFF);
2509         }
2510 }
2511
2512 /* Module information */
2513 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
2514 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
2515 MODULE_LICENSE("GPL");