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 static int dapm_bias_open_file(struct inode *inode, struct file *file)
1308 {
1309         file->private_data = inode->i_private;
1310         return 0;
1311 }
1312
1313 static ssize_t dapm_bias_read_file(struct file *file, char __user *user_buf,
1314                                    size_t count, loff_t *ppos)
1315 {
1316         struct snd_soc_dapm_context *dapm = file->private_data;
1317         char *level;
1318
1319         switch (dapm->bias_level) {
1320         case SND_SOC_BIAS_ON:
1321                 level = "On\n";
1322                 break;
1323         case SND_SOC_BIAS_PREPARE:
1324                 level = "Prepare\n";
1325                 break;
1326         case SND_SOC_BIAS_STANDBY:
1327                 level = "Standby\n";
1328                 break;
1329         case SND_SOC_BIAS_OFF:
1330                 level = "Off\n";
1331                 break;
1332         default:
1333                 BUG();
1334                 level = "Unknown\n";
1335                 break;
1336         }
1337
1338         return simple_read_from_buffer(user_buf, count, ppos, level,
1339                                        strlen(level));
1340 }
1341
1342 static const struct file_operations dapm_bias_fops = {
1343         .open = dapm_bias_open_file,
1344         .read = dapm_bias_read_file,
1345         .llseek = default_llseek,
1346 };
1347
1348 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm)
1349 {
1350         struct snd_soc_dapm_widget *w;
1351         struct dentry *d;
1352
1353         if (!dapm->debugfs_dapm)
1354                 return;
1355
1356         d = debugfs_create_file("bias_level", 0444,
1357                                 dapm->debugfs_dapm, dapm,
1358                                 &dapm_bias_fops);
1359         if (!d)
1360                 dev_warn(dapm->dev,
1361                          "ASoC: Failed to create bias level debugfs file\n");
1362
1363         list_for_each_entry(w, &dapm->card->widgets, list) {
1364                 if (!w->name || w->dapm != dapm)
1365                         continue;
1366
1367                 d = debugfs_create_file(w->name, 0444,
1368                                         dapm->debugfs_dapm, w,
1369                                         &dapm_widget_power_fops);
1370                 if (!d)
1371                         dev_warn(w->dapm->dev,
1372                                 "ASoC: Failed to create %s debugfs file\n",
1373                                 w->name);
1374         }
1375 }
1376 #else
1377 void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm)
1378 {
1379 }
1380 #endif
1381
1382 /* test and update the power status of a mux widget */
1383 static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
1384                                  struct snd_kcontrol *kcontrol, int change,
1385                                  int mux, struct soc_enum *e)
1386 {
1387         struct snd_soc_dapm_path *path;
1388         int found = 0;
1389
1390         if (widget->id != snd_soc_dapm_mux &&
1391             widget->id != snd_soc_dapm_virt_mux &&
1392             widget->id != snd_soc_dapm_value_mux)
1393                 return -ENODEV;
1394
1395         if (!change)
1396                 return 0;
1397
1398         /* find dapm widget path assoc with kcontrol */
1399         list_for_each_entry(path, &widget->dapm->card->paths, list) {
1400                 if (path->kcontrol != kcontrol)
1401                         continue;
1402
1403                 if (!path->name || !e->texts[mux])
1404                         continue;
1405
1406                 found = 1;
1407                 /* we now need to match the string in the enum to the path */
1408                 if (!(strcmp(path->name, e->texts[mux])))
1409                         path->connect = 1; /* new connection */
1410                 else
1411                         path->connect = 0; /* old connection must be powered down */
1412         }
1413
1414         if (found)
1415                 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1416
1417         return 0;
1418 }
1419
1420 /* test and update the power status of a mixer or switch widget */
1421 static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
1422                                    struct snd_kcontrol *kcontrol, int connect)
1423 {
1424         struct snd_soc_dapm_path *path;
1425         int found = 0;
1426
1427         if (widget->id != snd_soc_dapm_mixer &&
1428             widget->id != snd_soc_dapm_mixer_named_ctl &&
1429             widget->id != snd_soc_dapm_switch)
1430                 return -ENODEV;
1431
1432         /* find dapm widget path assoc with kcontrol */
1433         list_for_each_entry(path, &widget->dapm->card->paths, list) {
1434                 if (path->kcontrol != kcontrol)
1435                         continue;
1436
1437                 /* found, now check type */
1438                 found = 1;
1439                 path->connect = connect;
1440                 break;
1441         }
1442
1443         if (found)
1444                 dapm_power_widgets(widget->dapm, SND_SOC_DAPM_STREAM_NOP);
1445
1446         return 0;
1447 }
1448
1449 /* show dapm widget status in sys fs */
1450 static ssize_t dapm_widget_show(struct device *dev,
1451         struct device_attribute *attr, char *buf)
1452 {
1453         struct snd_soc_pcm_runtime *rtd =
1454                         container_of(dev, struct snd_soc_pcm_runtime, dev);
1455         struct snd_soc_codec *codec =rtd->codec;
1456         struct snd_soc_dapm_widget *w;
1457         int count = 0;
1458         char *state = "not set";
1459
1460         list_for_each_entry(w, &codec->card->widgets, list) {
1461                 if (w->dapm != &codec->dapm)
1462                         continue;
1463
1464                 /* only display widgets that burnm power */
1465                 switch (w->id) {
1466                 case snd_soc_dapm_hp:
1467                 case snd_soc_dapm_mic:
1468                 case snd_soc_dapm_spk:
1469                 case snd_soc_dapm_line:
1470                 case snd_soc_dapm_micbias:
1471                 case snd_soc_dapm_dac:
1472                 case snd_soc_dapm_adc:
1473                 case snd_soc_dapm_pga:
1474                 case snd_soc_dapm_out_drv:
1475                 case snd_soc_dapm_mixer:
1476                 case snd_soc_dapm_mixer_named_ctl:
1477                 case snd_soc_dapm_supply:
1478                         if (w->name)
1479                                 count += sprintf(buf + count, "%s: %s\n",
1480                                         w->name, w->power ? "On":"Off");
1481                 break;
1482                 default:
1483                 break;
1484                 }
1485         }
1486
1487         switch (codec->dapm.bias_level) {
1488         case SND_SOC_BIAS_ON:
1489                 state = "On";
1490                 break;
1491         case SND_SOC_BIAS_PREPARE:
1492                 state = "Prepare";
1493                 break;
1494         case SND_SOC_BIAS_STANDBY:
1495                 state = "Standby";
1496                 break;
1497         case SND_SOC_BIAS_OFF:
1498                 state = "Off";
1499                 break;
1500         }
1501         count += sprintf(buf + count, "PM State: %s\n", state);
1502
1503         return count;
1504 }
1505
1506 static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
1507
1508 int snd_soc_dapm_sys_add(struct device *dev)
1509 {
1510         return device_create_file(dev, &dev_attr_dapm_widget);
1511 }
1512
1513 static void snd_soc_dapm_sys_remove(struct device *dev)
1514 {
1515         device_remove_file(dev, &dev_attr_dapm_widget);
1516 }
1517
1518 /* free all dapm widgets and resources */
1519 static void dapm_free_widgets(struct snd_soc_dapm_context *dapm)
1520 {
1521         struct snd_soc_dapm_widget *w, *next_w;
1522         struct snd_soc_dapm_path *p, *next_p;
1523
1524         list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
1525                 if (w->dapm != dapm)
1526                         continue;
1527                 list_del(&w->list);
1528                 /*
1529                  * remove source and sink paths associated to this widget.
1530                  * While removing the path, remove reference to it from both
1531                  * source and sink widgets so that path is removed only once.
1532                  */
1533                 list_for_each_entry_safe(p, next_p, &w->sources, list_sink) {
1534                         list_del(&p->list_sink);
1535                         list_del(&p->list_source);
1536                         list_del(&p->list);
1537                         kfree(p->long_name);
1538                         kfree(p);
1539                 }
1540                 list_for_each_entry_safe(p, next_p, &w->sinks, list_source) {
1541                         list_del(&p->list_sink);
1542                         list_del(&p->list_source);
1543                         list_del(&p->list);
1544                         kfree(p->long_name);
1545                         kfree(p);
1546                 }
1547                 kfree(w->name);
1548                 kfree(w);
1549         }
1550 }
1551
1552 static int snd_soc_dapm_set_pin(struct snd_soc_dapm_context *dapm,
1553                                 const char *pin, int status)
1554 {
1555         struct snd_soc_dapm_widget *w;
1556
1557         list_for_each_entry(w, &dapm->card->widgets, list) {
1558                 if (w->dapm != dapm)
1559                         continue;
1560                 if (!strcmp(w->name, pin)) {
1561                         dev_dbg(w->dapm->dev, "dapm: pin %s = %d\n",
1562                                 pin, status);
1563                         w->connected = status;
1564                         /* Allow disabling of forced pins */
1565                         if (status == 0)
1566                                 w->force = 0;
1567                         return 0;
1568                 }
1569         }
1570
1571         dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
1572         return -EINVAL;
1573 }
1574
1575 /**
1576  * snd_soc_dapm_sync - scan and power dapm paths
1577  * @dapm: DAPM context
1578  *
1579  * Walks all dapm audio paths and powers widgets according to their
1580  * stream or path usage.
1581  *
1582  * Returns 0 for success.
1583  */
1584 int snd_soc_dapm_sync(struct snd_soc_dapm_context *dapm)
1585 {
1586         return dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1587 }
1588 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
1589
1590 static int snd_soc_dapm_add_route(struct snd_soc_dapm_context *dapm,
1591                                   const struct snd_soc_dapm_route *route)
1592 {
1593         struct snd_soc_dapm_path *path;
1594         struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
1595         struct snd_soc_dapm_widget *wtsource = NULL, *wtsink = NULL;
1596         const char *sink;
1597         const char *control = route->control;
1598         const char *source;
1599         char prefixed_sink[80];
1600         char prefixed_source[80];
1601         int ret = 0;
1602
1603         if (dapm->codec && dapm->codec->name_prefix) {
1604                 snprintf(prefixed_sink, sizeof(prefixed_sink), "%s %s",
1605                          dapm->codec->name_prefix, route->sink);
1606                 sink = prefixed_sink;
1607                 snprintf(prefixed_source, sizeof(prefixed_source), "%s %s",
1608                          dapm->codec->name_prefix, route->source);
1609                 source = prefixed_source;
1610         } else {
1611                 sink = route->sink;
1612                 source = route->source;
1613         }
1614
1615         /*
1616          * find src and dest widgets over all widgets but favor a widget from
1617          * current DAPM context
1618          */
1619         list_for_each_entry(w, &dapm->card->widgets, list) {
1620                 if (!wsink && !(strcmp(w->name, sink))) {
1621                         wtsink = w;
1622                         if (w->dapm == dapm)
1623                                 wsink = w;
1624                         continue;
1625                 }
1626                 if (!wsource && !(strcmp(w->name, source))) {
1627                         wtsource = w;
1628                         if (w->dapm == dapm)
1629                                 wsource = w;
1630                 }
1631         }
1632         /* use widget from another DAPM context if not found from this */
1633         if (!wsink)
1634                 wsink = wtsink;
1635         if (!wsource)
1636                 wsource = wtsource;
1637
1638         if (wsource == NULL || wsink == NULL)
1639                 return -ENODEV;
1640
1641         path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
1642         if (!path)
1643                 return -ENOMEM;
1644
1645         path->source = wsource;
1646         path->sink = wsink;
1647         path->connected = route->connected;
1648         INIT_LIST_HEAD(&path->list);
1649         INIT_LIST_HEAD(&path->list_source);
1650         INIT_LIST_HEAD(&path->list_sink);
1651
1652         /* check for external widgets */
1653         if (wsink->id == snd_soc_dapm_input) {
1654                 if (wsource->id == snd_soc_dapm_micbias ||
1655                         wsource->id == snd_soc_dapm_mic ||
1656                         wsource->id == snd_soc_dapm_line ||
1657                         wsource->id == snd_soc_dapm_output)
1658                         wsink->ext = 1;
1659         }
1660         if (wsource->id == snd_soc_dapm_output) {
1661                 if (wsink->id == snd_soc_dapm_spk ||
1662                         wsink->id == snd_soc_dapm_hp ||
1663                         wsink->id == snd_soc_dapm_line ||
1664                         wsink->id == snd_soc_dapm_input)
1665                         wsource->ext = 1;
1666         }
1667
1668         /* connect static paths */
1669         if (control == NULL) {
1670                 list_add(&path->list, &dapm->card->paths);
1671                 list_add(&path->list_sink, &wsink->sources);
1672                 list_add(&path->list_source, &wsource->sinks);
1673                 path->connect = 1;
1674                 return 0;
1675         }
1676
1677         /* connect dynamic paths */
1678         switch(wsink->id) {
1679         case snd_soc_dapm_adc:
1680         case snd_soc_dapm_dac:
1681         case snd_soc_dapm_pga:
1682         case snd_soc_dapm_out_drv:
1683         case snd_soc_dapm_input:
1684         case snd_soc_dapm_output:
1685         case snd_soc_dapm_micbias:
1686         case snd_soc_dapm_vmid:
1687         case snd_soc_dapm_pre:
1688         case snd_soc_dapm_post:
1689         case snd_soc_dapm_supply:
1690         case snd_soc_dapm_aif_in:
1691         case snd_soc_dapm_aif_out:
1692                 list_add(&path->list, &dapm->card->paths);
1693                 list_add(&path->list_sink, &wsink->sources);
1694                 list_add(&path->list_source, &wsource->sinks);
1695                 path->connect = 1;
1696                 return 0;
1697         case snd_soc_dapm_mux:
1698         case snd_soc_dapm_virt_mux:
1699         case snd_soc_dapm_value_mux:
1700                 ret = dapm_connect_mux(dapm, wsource, wsink, path, control,
1701                         &wsink->kcontrols[0]);
1702                 if (ret != 0)
1703                         goto err;
1704                 break;
1705         case snd_soc_dapm_switch:
1706         case snd_soc_dapm_mixer:
1707         case snd_soc_dapm_mixer_named_ctl:
1708                 ret = dapm_connect_mixer(dapm, wsource, wsink, path, control);
1709                 if (ret != 0)
1710                         goto err;
1711                 break;
1712         case snd_soc_dapm_hp:
1713         case snd_soc_dapm_mic:
1714         case snd_soc_dapm_line:
1715         case snd_soc_dapm_spk:
1716                 list_add(&path->list, &dapm->card->paths);
1717                 list_add(&path->list_sink, &wsink->sources);
1718                 list_add(&path->list_source, &wsource->sinks);
1719                 path->connect = 0;
1720                 return 0;
1721         }
1722         return 0;
1723
1724 err:
1725         dev_warn(dapm->dev, "asoc: no dapm match for %s --> %s --> %s\n",
1726                  source, control, sink);
1727         kfree(path);
1728         return ret;
1729 }
1730
1731 /**
1732  * snd_soc_dapm_add_routes - Add routes between DAPM widgets
1733  * @dapm: DAPM context
1734  * @route: audio routes
1735  * @num: number of routes
1736  *
1737  * Connects 2 dapm widgets together via a named audio path. The sink is
1738  * the widget receiving the audio signal, whilst the source is the sender
1739  * of the audio signal.
1740  *
1741  * Returns 0 for success else error. On error all resources can be freed
1742  * with a call to snd_soc_card_free().
1743  */
1744 int snd_soc_dapm_add_routes(struct snd_soc_dapm_context *dapm,
1745                             const struct snd_soc_dapm_route *route, int num)
1746 {
1747         int i, ret;
1748
1749         for (i = 0; i < num; i++) {
1750                 ret = snd_soc_dapm_add_route(dapm, route);
1751                 if (ret < 0) {
1752                         dev_err(dapm->dev, "Failed to add route %s->%s\n",
1753                                 route->source, route->sink);
1754                         return ret;
1755                 }
1756                 route++;
1757         }
1758
1759         return 0;
1760 }
1761 EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
1762
1763 /**
1764  * snd_soc_dapm_new_widgets - add new dapm widgets
1765  * @dapm: DAPM context
1766  *
1767  * Checks the codec for any new dapm widgets and creates them if found.
1768  *
1769  * Returns 0 for success.
1770  */
1771 int snd_soc_dapm_new_widgets(struct snd_soc_dapm_context *dapm)
1772 {
1773         struct snd_soc_dapm_widget *w;
1774         unsigned int val;
1775
1776         list_for_each_entry(w, &dapm->card->widgets, list)
1777         {
1778                 if (w->new)
1779                         continue;
1780
1781                 switch(w->id) {
1782                 case snd_soc_dapm_switch:
1783                 case snd_soc_dapm_mixer:
1784                 case snd_soc_dapm_mixer_named_ctl:
1785                         w->power_check = dapm_generic_check_power;
1786                         dapm_new_mixer(dapm, w);
1787                         break;
1788                 case snd_soc_dapm_mux:
1789                 case snd_soc_dapm_virt_mux:
1790                 case snd_soc_dapm_value_mux:
1791                         w->power_check = dapm_generic_check_power;
1792                         dapm_new_mux(dapm, w);
1793                         break;
1794                 case snd_soc_dapm_adc:
1795                 case snd_soc_dapm_aif_out:
1796                         w->power_check = dapm_adc_check_power;
1797                         break;
1798                 case snd_soc_dapm_dac:
1799                 case snd_soc_dapm_aif_in:
1800                         w->power_check = dapm_dac_check_power;
1801                         break;
1802                 case snd_soc_dapm_pga:
1803                 case snd_soc_dapm_out_drv:
1804                         w->power_check = dapm_generic_check_power;
1805                         dapm_new_pga(dapm, w);
1806                         break;
1807                 case snd_soc_dapm_input:
1808                 case snd_soc_dapm_output:
1809                 case snd_soc_dapm_micbias:
1810                 case snd_soc_dapm_spk:
1811                 case snd_soc_dapm_hp:
1812                 case snd_soc_dapm_mic:
1813                 case snd_soc_dapm_line:
1814                         w->power_check = dapm_generic_check_power;
1815                         break;
1816                 case snd_soc_dapm_supply:
1817                         w->power_check = dapm_supply_check_power;
1818                 case snd_soc_dapm_vmid:
1819                 case snd_soc_dapm_pre:
1820                 case snd_soc_dapm_post:
1821                         break;
1822                 }
1823
1824                 /* Read the initial power state from the device */
1825                 if (w->reg >= 0) {
1826                         val = snd_soc_read(w->codec, w->reg);
1827                         val &= 1 << w->shift;
1828                         if (w->invert)
1829                                 val = !val;
1830
1831                         if (val)
1832                                 w->power = 1;
1833                 }
1834
1835                 w->new = 1;
1836         }
1837
1838         dapm_power_widgets(dapm, SND_SOC_DAPM_STREAM_NOP);
1839         return 0;
1840 }
1841 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
1842
1843 /**
1844  * snd_soc_dapm_get_volsw - dapm mixer get callback
1845  * @kcontrol: mixer control
1846  * @ucontrol: control element information
1847  *
1848  * Callback to get the value of a dapm mixer control.
1849  *
1850  * Returns 0 for success.
1851  */
1852 int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
1853         struct snd_ctl_elem_value *ucontrol)
1854 {
1855         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1856         struct soc_mixer_control *mc =
1857                 (struct soc_mixer_control *)kcontrol->private_value;
1858         unsigned int reg = mc->reg;
1859         unsigned int shift = mc->shift;
1860         unsigned int rshift = mc->rshift;
1861         int max = mc->max;
1862         unsigned int invert = mc->invert;
1863         unsigned int mask = (1 << fls(max)) - 1;
1864
1865         ucontrol->value.integer.value[0] =
1866                 (snd_soc_read(widget->codec, reg) >> shift) & mask;
1867         if (shift != rshift)
1868                 ucontrol->value.integer.value[1] =
1869                         (snd_soc_read(widget->codec, reg) >> rshift) & mask;
1870         if (invert) {
1871                 ucontrol->value.integer.value[0] =
1872                         max - ucontrol->value.integer.value[0];
1873                 if (shift != rshift)
1874                         ucontrol->value.integer.value[1] =
1875                                 max - ucontrol->value.integer.value[1];
1876         }
1877
1878         return 0;
1879 }
1880 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
1881
1882 /**
1883  * snd_soc_dapm_put_volsw - dapm mixer set callback
1884  * @kcontrol: mixer control
1885  * @ucontrol: control element information
1886  *
1887  * Callback to set the value of a dapm mixer control.
1888  *
1889  * Returns 0 for success.
1890  */
1891 int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
1892         struct snd_ctl_elem_value *ucontrol)
1893 {
1894         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1895         struct soc_mixer_control *mc =
1896                 (struct soc_mixer_control *)kcontrol->private_value;
1897         unsigned int reg = mc->reg;
1898         unsigned int shift = mc->shift;
1899         int max = mc->max;
1900         unsigned int mask = (1 << fls(max)) - 1;
1901         unsigned int invert = mc->invert;
1902         unsigned int val;
1903         int connect, change;
1904         struct snd_soc_dapm_update update;
1905
1906         val = (ucontrol->value.integer.value[0] & mask);
1907
1908         if (invert)
1909                 val = max - val;
1910         mask = mask << shift;
1911         val = val << shift;
1912
1913         mutex_lock(&widget->codec->mutex);
1914         widget->value = val;
1915
1916         change = snd_soc_test_bits(widget->codec, reg, mask, val);
1917         if (change) {
1918                 if (val)
1919                         /* new connection */
1920                         connect = invert ? 0:1;
1921                 else
1922                         /* old connection must be powered down */
1923                         connect = invert ? 1:0;
1924
1925                 update.kcontrol = kcontrol;
1926                 update.widget = widget;
1927                 update.reg = reg;
1928                 update.mask = mask;
1929                 update.val = val;
1930                 widget->dapm->update = &update;
1931
1932                 dapm_mixer_update_power(widget, kcontrol, connect);
1933
1934                 widget->dapm->update = NULL;
1935         }
1936
1937         mutex_unlock(&widget->codec->mutex);
1938         return 0;
1939 }
1940 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
1941
1942 /**
1943  * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
1944  * @kcontrol: mixer control
1945  * @ucontrol: control element information
1946  *
1947  * Callback to get the value of a dapm enumerated double mixer control.
1948  *
1949  * Returns 0 for success.
1950  */
1951 int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
1952         struct snd_ctl_elem_value *ucontrol)
1953 {
1954         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1955         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1956         unsigned int val, bitmask;
1957
1958         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1959                 ;
1960         val = snd_soc_read(widget->codec, e->reg);
1961         ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
1962         if (e->shift_l != e->shift_r)
1963                 ucontrol->value.enumerated.item[1] =
1964                         (val >> e->shift_r) & (bitmask - 1);
1965
1966         return 0;
1967 }
1968 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
1969
1970 /**
1971  * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
1972  * @kcontrol: mixer control
1973  * @ucontrol: control element information
1974  *
1975  * Callback to set the value of a dapm enumerated double mixer control.
1976  *
1977  * Returns 0 for success.
1978  */
1979 int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
1980         struct snd_ctl_elem_value *ucontrol)
1981 {
1982         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1983         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1984         unsigned int val, mux, change;
1985         unsigned int mask, bitmask;
1986         struct snd_soc_dapm_update update;
1987
1988         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1989                 ;
1990         if (ucontrol->value.enumerated.item[0] > e->max - 1)
1991                 return -EINVAL;
1992         mux = ucontrol->value.enumerated.item[0];
1993         val = mux << e->shift_l;
1994         mask = (bitmask - 1) << e->shift_l;
1995         if (e->shift_l != e->shift_r) {
1996                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
1997                         return -EINVAL;
1998                 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
1999                 mask |= (bitmask - 1) << e->shift_r;
2000         }
2001
2002         mutex_lock(&widget->codec->mutex);
2003         widget->value = val;
2004         change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2005
2006         update.kcontrol = kcontrol;
2007         update.widget = widget;
2008         update.reg = e->reg;
2009         update.mask = mask;
2010         update.val = val;
2011         widget->dapm->update = &update;
2012
2013         dapm_mux_update_power(widget, kcontrol, change, mux, e);
2014
2015         widget->dapm->update = NULL;
2016
2017         mutex_unlock(&widget->codec->mutex);
2018         return change;
2019 }
2020 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
2021
2022 /**
2023  * snd_soc_dapm_get_enum_virt - Get virtual DAPM mux
2024  * @kcontrol: mixer control
2025  * @ucontrol: control element information
2026  *
2027  * Returns 0 for success.
2028  */
2029 int snd_soc_dapm_get_enum_virt(struct snd_kcontrol *kcontrol,
2030                                struct snd_ctl_elem_value *ucontrol)
2031 {
2032         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
2033
2034         ucontrol->value.enumerated.item[0] = widget->value;
2035
2036         return 0;
2037 }
2038 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_virt);
2039
2040 /**
2041  * snd_soc_dapm_put_enum_virt - Set virtual DAPM mux
2042  * @kcontrol: mixer control
2043  * @ucontrol: control element information
2044  *
2045  * Returns 0 for success.
2046  */
2047 int snd_soc_dapm_put_enum_virt(struct snd_kcontrol *kcontrol,
2048                                struct snd_ctl_elem_value *ucontrol)
2049 {
2050         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
2051         struct soc_enum *e =
2052                 (struct soc_enum *)kcontrol->private_value;
2053         int change;
2054         int ret = 0;
2055
2056         if (ucontrol->value.enumerated.item[0] >= e->max)
2057                 return -EINVAL;
2058
2059         mutex_lock(&widget->codec->mutex);
2060
2061         change = widget->value != ucontrol->value.enumerated.item[0];
2062         widget->value = ucontrol->value.enumerated.item[0];
2063         dapm_mux_update_power(widget, kcontrol, change, widget->value, e);
2064
2065         mutex_unlock(&widget->codec->mutex);
2066         return ret;
2067 }
2068 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_virt);
2069
2070 /**
2071  * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
2072  *                                      callback
2073  * @kcontrol: mixer control
2074  * @ucontrol: control element information
2075  *
2076  * Callback to get the value of a dapm semi enumerated double mixer control.
2077  *
2078  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2079  * used for handling bitfield coded enumeration for example.
2080  *
2081  * Returns 0 for success.
2082  */
2083 int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
2084         struct snd_ctl_elem_value *ucontrol)
2085 {
2086         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
2087         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2088         unsigned int reg_val, val, mux;
2089
2090         reg_val = snd_soc_read(widget->codec, e->reg);
2091         val = (reg_val >> e->shift_l) & e->mask;
2092         for (mux = 0; mux < e->max; mux++) {
2093                 if (val == e->values[mux])
2094                         break;
2095         }
2096         ucontrol->value.enumerated.item[0] = mux;
2097         if (e->shift_l != e->shift_r) {
2098                 val = (reg_val >> e->shift_r) & e->mask;
2099                 for (mux = 0; mux < e->max; mux++) {
2100                         if (val == e->values[mux])
2101                                 break;
2102                 }
2103                 ucontrol->value.enumerated.item[1] = mux;
2104         }
2105
2106         return 0;
2107 }
2108 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
2109
2110 /**
2111  * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
2112  *                                      callback
2113  * @kcontrol: mixer control
2114  * @ucontrol: control element information
2115  *
2116  * Callback to set the value of a dapm semi enumerated double mixer control.
2117  *
2118  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2119  * used for handling bitfield coded enumeration for example.
2120  *
2121  * Returns 0 for success.
2122  */
2123 int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
2124         struct snd_ctl_elem_value *ucontrol)
2125 {
2126         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
2127         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2128         unsigned int val, mux, change;
2129         unsigned int mask;
2130         struct snd_soc_dapm_update update;
2131
2132         if (ucontrol->value.enumerated.item[0] > e->max - 1)
2133                 return -EINVAL;
2134         mux = ucontrol->value.enumerated.item[0];
2135         val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2136         mask = e->mask << e->shift_l;
2137         if (e->shift_l != e->shift_r) {
2138                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2139                         return -EINVAL;
2140                 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2141                 mask |= e->mask << e->shift_r;
2142         }
2143
2144         mutex_lock(&widget->codec->mutex);
2145         widget->value = val;
2146         change = snd_soc_test_bits(widget->codec, e->reg, mask, val);
2147
2148         update.kcontrol = kcontrol;
2149         update.widget = widget;
2150         update.reg = e->reg;
2151         update.mask = mask;
2152         update.val = val;
2153         widget->dapm->update = &update;
2154
2155         dapm_mux_update_power(widget, kcontrol, change, mux, e);
2156
2157         widget->dapm->update = NULL;
2158
2159         mutex_unlock(&widget->codec->mutex);
2160         return change;
2161 }
2162 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
2163
2164 /**
2165  * snd_soc_dapm_info_pin_switch - Info for a pin switch
2166  *
2167  * @kcontrol: mixer control
2168  * @uinfo: control element information
2169  *
2170  * Callback to provide information about a pin switch control.
2171  */
2172 int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
2173                                  struct snd_ctl_elem_info *uinfo)
2174 {
2175         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2176         uinfo->count = 1;
2177         uinfo->value.integer.min = 0;
2178         uinfo->value.integer.max = 1;
2179
2180         return 0;
2181 }
2182 EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
2183
2184 /**
2185  * snd_soc_dapm_get_pin_switch - Get information for a pin switch
2186  *
2187  * @kcontrol: mixer control
2188  * @ucontrol: Value
2189  */
2190 int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
2191                                 struct snd_ctl_elem_value *ucontrol)
2192 {
2193         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2194         const char *pin = (const char *)kcontrol->private_value;
2195
2196         mutex_lock(&codec->mutex);
2197
2198         ucontrol->value.integer.value[0] =
2199                 snd_soc_dapm_get_pin_status(&codec->dapm, pin);
2200
2201         mutex_unlock(&codec->mutex);
2202
2203         return 0;
2204 }
2205 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
2206
2207 /**
2208  * snd_soc_dapm_put_pin_switch - Set information for a pin switch
2209  *
2210  * @kcontrol: mixer control
2211  * @ucontrol: Value
2212  */
2213 int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
2214                                 struct snd_ctl_elem_value *ucontrol)
2215 {
2216         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2217         const char *pin = (const char *)kcontrol->private_value;
2218
2219         mutex_lock(&codec->mutex);
2220
2221         if (ucontrol->value.integer.value[0])
2222                 snd_soc_dapm_enable_pin(&codec->dapm, pin);
2223         else
2224                 snd_soc_dapm_disable_pin(&codec->dapm, pin);
2225
2226         snd_soc_dapm_sync(&codec->dapm);
2227
2228         mutex_unlock(&codec->mutex);
2229
2230         return 0;
2231 }
2232 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
2233
2234 /**
2235  * snd_soc_dapm_new_control - create new dapm control
2236  * @dapm: DAPM context
2237  * @widget: widget template
2238  *
2239  * Creates a new dapm control based upon the template.
2240  *
2241  * Returns 0 for success else error.
2242  */
2243 int snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
2244         const struct snd_soc_dapm_widget *widget)
2245 {
2246         struct snd_soc_dapm_widget *w;
2247         size_t name_len;
2248
2249         if ((w = dapm_cnew_widget(widget)) == NULL)
2250                 return -ENOMEM;
2251
2252         name_len = strlen(widget->name) + 1;
2253         if (dapm->codec && dapm->codec->name_prefix)
2254                 name_len += 1 + strlen(dapm->codec->name_prefix);
2255         w->name = kmalloc(name_len, GFP_KERNEL);
2256         if (w->name == NULL) {
2257                 kfree(w);
2258                 return -ENOMEM;
2259         }
2260         if (dapm->codec && dapm->codec->name_prefix)
2261                 snprintf(w->name, name_len, "%s %s",
2262                         dapm->codec->name_prefix, widget->name);
2263         else
2264                 snprintf(w->name, name_len, "%s", widget->name);
2265
2266         dapm->n_widgets++;
2267         w->dapm = dapm;
2268         w->codec = dapm->codec;
2269         INIT_LIST_HEAD(&w->sources);
2270         INIT_LIST_HEAD(&w->sinks);
2271         INIT_LIST_HEAD(&w->list);
2272         list_add(&w->list, &dapm->card->widgets);
2273
2274         /* machine layer set ups unconnected pins and insertions */
2275         w->connected = 1;
2276         return 0;
2277 }
2278 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
2279
2280 /**
2281  * snd_soc_dapm_new_controls - create new dapm controls
2282  * @dapm: DAPM context
2283  * @widget: widget array
2284  * @num: number of widgets
2285  *
2286  * Creates new DAPM controls based upon the templates.
2287  *
2288  * Returns 0 for success else error.
2289  */
2290 int snd_soc_dapm_new_controls(struct snd_soc_dapm_context *dapm,
2291         const struct snd_soc_dapm_widget *widget,
2292         int num)
2293 {
2294         int i, ret;
2295
2296         for (i = 0; i < num; i++) {
2297                 ret = snd_soc_dapm_new_control(dapm, widget);
2298                 if (ret < 0) {
2299                         dev_err(dapm->dev,
2300                                 "ASoC: Failed to create DAPM control %s: %d\n",
2301                                 widget->name, ret);
2302                         return ret;
2303                 }
2304                 widget++;
2305         }
2306         return 0;
2307 }
2308 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
2309
2310 static void soc_dapm_stream_event(struct snd_soc_dapm_context *dapm,
2311         const char *stream, int event)
2312 {
2313         struct snd_soc_dapm_widget *w;
2314
2315         list_for_each_entry(w, &dapm->card->widgets, list)
2316         {
2317                 if (!w->sname || w->dapm != dapm)
2318                         continue;
2319                 dev_dbg(w->dapm->dev, "widget %s\n %s stream %s event %d\n",
2320                         w->name, w->sname, stream, event);
2321                 if (strstr(w->sname, stream)) {
2322                         switch(event) {
2323                         case SND_SOC_DAPM_STREAM_START:
2324                                 w->active = 1;
2325                                 break;
2326                         case SND_SOC_DAPM_STREAM_STOP:
2327                                 w->active = 0;
2328                                 break;
2329                         case SND_SOC_DAPM_STREAM_SUSPEND:
2330                         case SND_SOC_DAPM_STREAM_RESUME:
2331                         case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
2332                         case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
2333                                 break;
2334                         }
2335                 }
2336         }
2337
2338         dapm_power_widgets(dapm, event);
2339 }
2340
2341 /**
2342  * snd_soc_dapm_stream_event - send a stream event to the dapm core
2343  * @rtd: PCM runtime data
2344  * @stream: stream name
2345  * @event: stream event
2346  *
2347  * Sends a stream event to the dapm core. The core then makes any
2348  * necessary widget power changes.
2349  *
2350  * Returns 0 for success else error.
2351  */
2352 int snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd,
2353         const char *stream, int event)
2354 {
2355         struct snd_soc_codec *codec = rtd->codec;
2356
2357         if (stream == NULL)
2358                 return 0;
2359
2360         mutex_lock(&codec->mutex);
2361         soc_dapm_stream_event(&codec->dapm, stream, event);
2362         mutex_unlock(&codec->mutex);
2363         return 0;
2364 }
2365
2366 /**
2367  * snd_soc_dapm_enable_pin - enable pin.
2368  * @dapm: DAPM context
2369  * @pin: pin name
2370  *
2371  * Enables input/output pin and its parents or children widgets iff there is
2372  * a valid audio route and active audio stream.
2373  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2374  * do any widget power switching.
2375  */
2376 int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2377 {
2378         return snd_soc_dapm_set_pin(dapm, pin, 1);
2379 }
2380 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
2381
2382 /**
2383  * snd_soc_dapm_force_enable_pin - force a pin to be enabled
2384  * @dapm: DAPM context
2385  * @pin: pin name
2386  *
2387  * Enables input/output pin regardless of any other state.  This is
2388  * intended for use with microphone bias supplies used in microphone
2389  * jack detection.
2390  *
2391  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2392  * do any widget power switching.
2393  */
2394 int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
2395                                   const char *pin)
2396 {
2397         struct snd_soc_dapm_widget *w;
2398
2399         list_for_each_entry(w, &dapm->card->widgets, list) {
2400                 if (w->dapm != dapm)
2401                         continue;
2402                 if (!strcmp(w->name, pin)) {
2403                         dev_dbg(w->dapm->dev,
2404                                 "dapm: force enable pin %s\n", pin);
2405                         w->connected = 1;
2406                         w->force = 1;
2407                         return 0;
2408                 }
2409         }
2410
2411         dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2412         return -EINVAL;
2413 }
2414 EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
2415
2416 /**
2417  * snd_soc_dapm_disable_pin - disable pin.
2418  * @dapm: DAPM context
2419  * @pin: pin name
2420  *
2421  * Disables input/output pin and its parents or children widgets.
2422  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2423  * do any widget power switching.
2424  */
2425 int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
2426                              const char *pin)
2427 {
2428         return snd_soc_dapm_set_pin(dapm, pin, 0);
2429 }
2430 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
2431
2432 /**
2433  * snd_soc_dapm_nc_pin - permanently disable pin.
2434  * @dapm: DAPM context
2435  * @pin: pin name
2436  *
2437  * Marks the specified pin as being not connected, disabling it along
2438  * any parent or child widgets.  At present this is identical to
2439  * snd_soc_dapm_disable_pin() but in future it will be extended to do
2440  * additional things such as disabling controls which only affect
2441  * paths through the pin.
2442  *
2443  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
2444  * do any widget power switching.
2445  */
2446 int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
2447 {
2448         return snd_soc_dapm_set_pin(dapm, pin, 0);
2449 }
2450 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
2451
2452 /**
2453  * snd_soc_dapm_get_pin_status - get audio pin status
2454  * @dapm: DAPM context
2455  * @pin: audio signal pin endpoint (or start point)
2456  *
2457  * Get audio pin status - connected or disconnected.
2458  *
2459  * Returns 1 for connected otherwise 0.
2460  */
2461 int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
2462                                 const char *pin)
2463 {
2464         struct snd_soc_dapm_widget *w;
2465
2466         list_for_each_entry(w, &dapm->card->widgets, list) {
2467                 if (w->dapm != dapm)
2468                         continue;
2469                 if (!strcmp(w->name, pin))
2470                         return w->connected;
2471         }
2472
2473         return 0;
2474 }
2475 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
2476
2477 /**
2478  * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
2479  * @dapm: DAPM context
2480  * @pin: audio signal pin endpoint (or start point)
2481  *
2482  * Mark the given endpoint or pin as ignoring suspend.  When the
2483  * system is disabled a path between two endpoints flagged as ignoring
2484  * suspend will not be disabled.  The path must already be enabled via
2485  * normal means at suspend time, it will not be turned on if it was not
2486  * already enabled.
2487  */
2488 int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
2489                                 const char *pin)
2490 {
2491         struct snd_soc_dapm_widget *w;
2492
2493         list_for_each_entry(w, &dapm->card->widgets, list) {
2494                 if (w->dapm != dapm)
2495                         continue;
2496                 if (!strcmp(w->name, pin)) {
2497                         w->ignore_suspend = 1;
2498                         return 0;
2499                 }
2500         }
2501
2502         dev_err(dapm->dev, "dapm: unknown pin %s\n", pin);
2503         return -EINVAL;
2504 }
2505 EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
2506
2507 /**
2508  * snd_soc_dapm_free - free dapm resources
2509  * @card: SoC device
2510  *
2511  * Free all dapm widgets and resources.
2512  */
2513 void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
2514 {
2515         snd_soc_dapm_sys_remove(dapm->dev);
2516         dapm_free_widgets(dapm);
2517         list_del(&dapm->list);
2518 }
2519 EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
2520
2521 static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
2522 {
2523         struct snd_soc_dapm_widget *w;
2524         LIST_HEAD(down_list);
2525         int powerdown = 0;
2526
2527         list_for_each_entry(w, &dapm->card->widgets, list) {
2528                 if (w->dapm != dapm)
2529                         continue;
2530                 if (w->power) {
2531                         dapm_seq_insert(w, &down_list, false);
2532                         w->power = 0;
2533                         powerdown = 1;
2534                 }
2535         }
2536
2537         /* If there were no widgets to power down we're already in
2538          * standby.
2539          */
2540         if (powerdown) {
2541                 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_PREPARE);
2542                 dapm_seq_run(dapm, &down_list, 0, false);
2543                 snd_soc_dapm_set_bias_level(dapm, SND_SOC_BIAS_STANDBY);
2544         }
2545 }
2546
2547 /*
2548  * snd_soc_dapm_shutdown - callback for system shutdown
2549  */
2550 void snd_soc_dapm_shutdown(struct snd_soc_card *card)
2551 {
2552         struct snd_soc_codec *codec;
2553
2554         list_for_each_entry(codec, &card->codec_dev_list, list) {
2555                 soc_dapm_shutdown_codec(&codec->dapm);
2556                 snd_soc_dapm_set_bias_level(&codec->dapm, SND_SOC_BIAS_OFF);
2557         }
2558 }
2559
2560 /* Module information */
2561 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
2562 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
2563 MODULE_LICENSE("GPL");