sound/soc/soc-dapm.c

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