linux/sound/soc/soc-dapm.c
<<
>>
Prefs
   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
  50static 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));
  55static struct snd_soc_dapm_widget *
  56snd_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 */
  60static 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
  89static 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
 118static void pop_wait(u32 pop_time)
 119{
 120        if (pop_time)
 121                schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
 122}
 123
 124static 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
 144static bool dapm_dirty_widget(struct snd_soc_dapm_widget *w)
 145{
 146        return !list_empty(&w->dirty);
 147}
 148
 149void 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}
 157EXPORT_SYMBOL_GPL(dapm_mark_dirty);
 158
 159void 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}
 179EXPORT_SYMBOL_GPL(dapm_mark_io_dirty);
 180
 181/* create a new dapm widget */
 182static 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
 188struct 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
 195static 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
 251static 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
 259static 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
 267static 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
 292static 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
 305static 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
 315static 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
 327static 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
 334static 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 */
 354struct snd_soc_codec *snd_soc_dapm_kcontrol_codec(struct snd_kcontrol *kcontrol)
 355{
 356        return dapm_kcontrol_get_wlist(kcontrol)->widgets[0]->codec;
 357}
 358EXPORT_SYMBOL_GPL(snd_soc_dapm_kcontrol_codec);
 359
 360static 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
 374static 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
 385static 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
 396static 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
 404static 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
 412static 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 */
 457static 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);
 485out:
 486        trace_snd_soc_bias_level_done(card, level);
 487
 488        return ret;
 489}
 490
 491/* set up initial codec paths */
 492static 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 */
 597static 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 */
 620static 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
 640static 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 */
 669static 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 */
 776static 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 */
 806static 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 */
 835static 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 */
 845static 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
 858static 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 */
 876static 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 */
 893static 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 */
 935static 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 */
1031static 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 */
1147int 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 */
1175int 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}
1190EXPORT_SYMBOL_GPL(dapm_reg_event);
1191
1192/*
1193 * Handler for regulator supply widget.
1194 */
1195int 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}
1222EXPORT_SYMBOL_GPL(dapm_regulator_event);
1223
1224/*
1225 * Handler for clock supply widget.
1226 */
1227int 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}
1243EXPORT_SYMBOL_GPL(dapm_clock_event);
1244
1245static 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 */
1262static 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 */
1276static 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 */
1292static 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 */
1308static 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
1335static int dapm_always_on_check_power(struct snd_soc_dapm_widget *w)
1336{
1337        return 1;
1338}
1339
1340static 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. */
1368static 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
1383static 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 */
1435static 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 */
1493static 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
1587static 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 */
1635static 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 */
1664static 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
1701static 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
1716static 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
1759static 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 */
1790static 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
1916static 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->source))
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
1978static 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
1984static 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
2013static const struct file_operations dapm_bias_fops = {
2014        .open = simple_open,
2015        .read = dapm_bias_read_file,
2016        .llseek = default_llseek,
2017};
2018
2019void 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
2040static 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
2057static void dapm_debugfs_cleanup(struct snd_soc_dapm_context *dapm)
2058{
2059        debugfs_remove_recursive(dapm->debugfs_dapm);
2060}
2061
2062#else
2063void snd_soc_dapm_debugfs_init(struct snd_soc_dapm_context *dapm,
2064        struct dentry *parent)
2065{
2066}
2067
2068static inline void dapm_debugfs_add_widget(struct snd_soc_dapm_widget *w)
2069{
2070}
2071
2072static 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 */
2079static 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
2110int 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}
2126EXPORT_SYMBOL_GPL(snd_soc_dapm_mux_update_power);
2127
2128/* test and update the power status of a mixer or switch widget */
2129static 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
2149int 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}
2165EXPORT_SYMBOL_GPL(snd_soc_dapm_mixer_update_power);
2166
2167/* show dapm widget status in sys fs */
2168static 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
2225static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
2226
2227int snd_soc_dapm_sys_add(struct device *dev)
2228{
2229        return device_create_file(dev, &dev_attr_dapm_widget);
2230}
2231
2232static void snd_soc_dapm_sys_remove(struct device *dev)
2233{
2234        device_remove_file(dev, &dev_attr_dapm_widget);
2235}
2236
2237static 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 */
2247static 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
2273static 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
2295static 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 */
2324int 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}
2340EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
2341
2342static 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;
2445err:
2446        kfree(path);
2447        return ret;
2448}
2449
2450static 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;
2513err:
2514        dev_warn(dapm->dev, "ASoC: no dapm match for %s --> %s --> %s\n",
2515                 source, route->control, sink);
2516        return ret;
2517}
2518
2519static 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 */
2582int 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}
2603EXPORT_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 */
2613int 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}
2627EXPORT_SYMBOL_GPL(snd_soc_dapm_del_routes);
2628
2629static 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 */
2690int 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}
2707EXPORT_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 */
2717int 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}
2776EXPORT_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 */
2787int 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}
2820EXPORT_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 */
2831int 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}
2882EXPORT_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 */
2893int 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}
2908EXPORT_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 */
2919int 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}
2959EXPORT_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 */
2968int 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}
2974EXPORT_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 */
2983int 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}
3006EXPORT_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 */
3021int 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}
3046EXPORT_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 */
3061int 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}
3101EXPORT_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 */
3111int 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}
3121EXPORT_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 */
3129int 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}
3144EXPORT_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 */
3152int 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}
3170EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
3171
3172static struct snd_soc_dapm_widget *
3173snd_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 */
3296int 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}
3319EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
3320
3321static 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
3423out:
3424        kfree(params);
3425        return ret;
3426}
3427
3428int 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
3475int 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                        return -ENOMEM;
3499                }
3500
3501                w->priv = dai;
3502                dai->playback_widget = w;
3503        }
3504
3505        if (dai->driver->capture.stream_name) {
3506                template.id = snd_soc_dapm_dai_out;
3507                template.name = dai->driver->capture.stream_name;
3508                template.sname = dai->driver->capture.stream_name;
3509
3510                dev_dbg(dai->dev, "ASoC: adding %s widget\n",
3511                        template.name);
3512
3513                w = snd_soc_dapm_new_control(dapm, &template);
3514                if (!w) {
3515                        dev_err(dapm->dev, "ASoC: Failed to create %s widget\n",
3516                                dai->driver->capture.stream_name);
3517                        return -ENOMEM;
3518                }
3519
3520                w->priv = dai;
3521                dai->capture_widget = w;
3522        }
3523
3524        return 0;
3525}
3526
3527int snd_soc_dapm_link_dai_widgets(struct snd_soc_card *card)
3528{
3529        struct snd_soc_dapm_widget *dai_w, *w;
3530        struct snd_soc_dai *dai;
3531
3532        /* For each DAI widget... */
3533        list_for_each_entry(dai_w, &card->widgets, list) {
3534                switch (dai_w->id) {
3535                case snd_soc_dapm_dai_in:
3536                case snd_soc_dapm_dai_out:
3537                        break;
3538                default:
3539                        continue;
3540                }
3541
3542                dai = dai_w->priv;
3543
3544                /* ...find all widgets with the same stream and link them */
3545                list_for_each_entry(w, &card->widgets, list) {
3546                        if (w->dapm != dai_w->dapm)
3547                                continue;
3548
3549                        switch (w->id) {
3550                        case snd_soc_dapm_dai_in:
3551                        case snd_soc_dapm_dai_out:
3552                                continue;
3553                        default:
3554                                break;
3555                        }
3556
3557                        if (!w->sname || !strstr(w->sname, dai_w->name))
3558                                continue;
3559
3560                        if (dai->driver->playback.stream_name &&
3561                            strstr(w->sname,
3562                                   dai->driver->playback.stream_name)) {
3563                                dev_dbg(dai->dev, "%s -> %s\n",
3564                                         dai->playback_widget->name, w->name);
3565
3566                                snd_soc_dapm_add_path(w->dapm,
3567                                        dai->playback_widget, w, NULL, NULL);
3568                        }
3569
3570                        if (dai->driver->capture.stream_name &&
3571                            strstr(w->sname,
3572                                   dai->driver->capture.stream_name)) {
3573                                dev_dbg(dai->dev, "%s -> %s\n",
3574                                        w->name, dai->capture_widget->name);
3575
3576                                snd_soc_dapm_add_path(w->dapm, w,
3577                                        dai->capture_widget, NULL, NULL);
3578                        }
3579                }
3580        }
3581
3582        return 0;
3583}
3584
3585static void soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
3586        int event)
3587{
3588
3589        struct snd_soc_dapm_widget *w_cpu, *w_codec;
3590        struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
3591        struct snd_soc_dai *codec_dai = rtd->codec_dai;
3592
3593        if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
3594                w_cpu = cpu_dai->playback_widget;
3595                w_codec = codec_dai->playback_widget;
3596        } else {
3597                w_cpu = cpu_dai->capture_widget;
3598                w_codec = codec_dai->capture_widget;
3599        }
3600
3601        if (w_cpu) {
3602
3603                dapm_mark_dirty(w_cpu, "stream event");
3604
3605                switch (event) {
3606                case SND_SOC_DAPM_STREAM_START:
3607                        w_cpu->active = 1;
3608                        break;
3609                case SND_SOC_DAPM_STREAM_STOP:
3610                        w_cpu->active = 0;
3611                        break;
3612                case SND_SOC_DAPM_STREAM_SUSPEND:
3613                case SND_SOC_DAPM_STREAM_RESUME:
3614                case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
3615                case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
3616                        break;
3617                }
3618        }
3619
3620        if (w_codec) {
3621
3622                dapm_mark_dirty(w_codec, "stream event");
3623
3624                switch (event) {
3625                case SND_SOC_DAPM_STREAM_START:
3626                        w_codec->active = 1;
3627                        break;
3628                case SND_SOC_DAPM_STREAM_STOP:
3629                        w_codec->active = 0;
3630                        break;
3631                case SND_SOC_DAPM_STREAM_SUSPEND:
3632                case SND_SOC_DAPM_STREAM_RESUME:
3633                case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
3634                case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
3635                        break;
3636                }
3637        }
3638
3639        dapm_power_widgets(rtd->card, event);
3640}
3641
3642/**
3643 * snd_soc_dapm_stream_event - send a stream event to the dapm core
3644 * @rtd: PCM runtime data
3645 * @stream: stream name
3646 * @event: stream event
3647 *
3648 * Sends a stream event to the dapm core. The core then makes any
3649 * necessary widget power changes.
3650 *
3651 * Returns 0 for success else error.
3652 */
3653void snd_soc_dapm_stream_event(struct snd_soc_pcm_runtime *rtd, int stream,
3654                              int event)
3655{
3656        struct snd_soc_card *card = rtd->card;
3657
3658        mutex_lock_nested(&card->dapm_mutex, SND_SOC_DAPM_CLASS_RUNTIME);
3659        soc_dapm_stream_event(rtd, stream, event);
3660        mutex_unlock(&card->dapm_mutex);
3661}
3662
3663/**
3664 * snd_soc_dapm_enable_pin - enable pin.
3665 * @dapm: DAPM context
3666 * @pin: pin name
3667 *
3668 * Enables input/output pin and its parents or children widgets iff there is
3669 * a valid audio route and active audio stream.
3670 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3671 * do any widget power switching.
3672 */
3673int snd_soc_dapm_enable_pin(struct snd_soc_dapm_context *dapm, const char *pin)
3674{
3675        return snd_soc_dapm_set_pin(dapm, pin, 1);
3676}
3677EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
3678
3679/**
3680 * snd_soc_dapm_force_enable_pin - force a pin to be enabled
3681 * @dapm: DAPM context
3682 * @pin: pin name
3683 *
3684 * Enables input/output pin regardless of any other state.  This is
3685 * intended for use with microphone bias supplies used in microphone
3686 * jack detection.
3687 *
3688 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3689 * do any widget power switching.
3690 */
3691int snd_soc_dapm_force_enable_pin(struct snd_soc_dapm_context *dapm,
3692                                  const char *pin)
3693{
3694        struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
3695
3696        if (!w) {
3697                dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
3698                return -EINVAL;
3699        }
3700
3701        dev_dbg(w->dapm->dev, "ASoC: force enable pin %s\n", pin);
3702        w->connected = 1;
3703        w->force = 1;
3704        dapm_mark_dirty(w, "force enable");
3705
3706        return 0;
3707}
3708EXPORT_SYMBOL_GPL(snd_soc_dapm_force_enable_pin);
3709
3710/**
3711 * snd_soc_dapm_disable_pin - disable pin.
3712 * @dapm: DAPM context
3713 * @pin: pin name
3714 *
3715 * Disables input/output pin and its parents or children widgets.
3716 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3717 * do any widget power switching.
3718 */
3719int snd_soc_dapm_disable_pin(struct snd_soc_dapm_context *dapm,
3720                             const char *pin)
3721{
3722        return snd_soc_dapm_set_pin(dapm, pin, 0);
3723}
3724EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
3725
3726/**
3727 * snd_soc_dapm_nc_pin - permanently disable pin.
3728 * @dapm: DAPM context
3729 * @pin: pin name
3730 *
3731 * Marks the specified pin as being not connected, disabling it along
3732 * any parent or child widgets.  At present this is identical to
3733 * snd_soc_dapm_disable_pin() but in future it will be extended to do
3734 * additional things such as disabling controls which only affect
3735 * paths through the pin.
3736 *
3737 * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
3738 * do any widget power switching.
3739 */
3740int snd_soc_dapm_nc_pin(struct snd_soc_dapm_context *dapm, const char *pin)
3741{
3742        return snd_soc_dapm_set_pin(dapm, pin, 0);
3743}
3744EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
3745
3746/**
3747 * snd_soc_dapm_get_pin_status - get audio pin status
3748 * @dapm: DAPM context
3749 * @pin: audio signal pin endpoint (or start point)
3750 *
3751 * Get audio pin status - connected or disconnected.
3752 *
3753 * Returns 1 for connected otherwise 0.
3754 */
3755int snd_soc_dapm_get_pin_status(struct snd_soc_dapm_context *dapm,
3756                                const char *pin)
3757{
3758        struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, true);
3759
3760        if (w)
3761                return w->connected;
3762
3763        return 0;
3764}
3765EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
3766
3767/**
3768 * snd_soc_dapm_ignore_suspend - ignore suspend status for DAPM endpoint
3769 * @dapm: DAPM context
3770 * @pin: audio signal pin endpoint (or start point)
3771 *
3772 * Mark the given endpoint or pin as ignoring suspend.  When the
3773 * system is disabled a path between two endpoints flagged as ignoring
3774 * suspend will not be disabled.  The path must already be enabled via
3775 * normal means at suspend time, it will not be turned on if it was not
3776 * already enabled.
3777 */
3778int snd_soc_dapm_ignore_suspend(struct snd_soc_dapm_context *dapm,
3779                                const char *pin)
3780{
3781        struct snd_soc_dapm_widget *w = dapm_find_widget(dapm, pin, false);
3782
3783        if (!w) {
3784                dev_err(dapm->dev, "ASoC: unknown pin %s\n", pin);
3785                return -EINVAL;
3786        }
3787
3788        w->ignore_suspend = 1;
3789
3790        return 0;
3791}
3792EXPORT_SYMBOL_GPL(snd_soc_dapm_ignore_suspend);
3793
3794static bool snd_soc_dapm_widget_in_card_paths(struct snd_soc_card *card,
3795                                              struct snd_soc_dapm_widget *w)
3796{
3797        struct snd_soc_dapm_path *p;
3798
3799        list_for_each_entry(p, &card->paths, list) {
3800                if ((p->source == w) || (p->sink == w)) {
3801                        dev_dbg(card->dev,
3802                            "... Path %s(id:%d dapm:%p) - %s(id:%d dapm:%p)\n",
3803                            p->source->name, p->source->id, p->source->dapm,
3804                            p->sink->name, p->sink->id, p->sink->dapm);
3805
3806                        /* Connected to something other than the codec */
3807                        if (p->source->dapm != p->sink->dapm)
3808                                return true;
3809                        /*
3810                         * Loopback connection from codec external pin to
3811                         * codec external pin
3812                         */
3813                        if (p->sink->id == snd_soc_dapm_input) {
3814                                switch (p->source->id) {
3815                                case snd_soc_dapm_output:
3816                                case snd_soc_dapm_micbias:
3817                                        return true;
3818                                default:
3819                                        break;
3820                                }
3821                        }
3822                }
3823        }
3824
3825        return false;
3826}
3827
3828/**
3829 * snd_soc_dapm_auto_nc_codec_pins - call snd_soc_dapm_nc_pin for unused pins
3830 * @codec: The codec whose pins should be processed
3831 *
3832 * Automatically call snd_soc_dapm_nc_pin() for any external pins in the codec
3833 * which are unused. Pins are used if they are connected externally to the
3834 * codec, whether that be to some other device, or a loop-back connection to
3835 * the codec itself.
3836 */
3837void snd_soc_dapm_auto_nc_codec_pins(struct snd_soc_codec *codec)
3838{
3839        struct snd_soc_card *card = codec->card;
3840        struct snd_soc_dapm_context *dapm = &codec->dapm;
3841        struct snd_soc_dapm_widget *w;
3842
3843        dev_dbg(codec->dev, "ASoC: Auto NC: DAPMs: card:%p codec:%p\n",
3844                &card->dapm, &codec->dapm);
3845
3846        list_for_each_entry(w, &card->widgets, list) {
3847                if (w->dapm != dapm)
3848                        continue;
3849                switch (w->id) {
3850                case snd_soc_dapm_input:
3851                case snd_soc_dapm_output:
3852                case snd_soc_dapm_micbias:
3853                        dev_dbg(codec->dev, "ASoC: Auto NC: Checking widget %s\n",
3854                                w->name);
3855                        if (!snd_soc_dapm_widget_in_card_paths(card, w)) {
3856                                dev_dbg(codec->dev,
3857                                        "... Not in map; disabling\n");
3858                                snd_soc_dapm_nc_pin(dapm, w->name);
3859                        }
3860                        break;
3861                default:
3862                        break;
3863                }
3864        }
3865}
3866
3867/**
3868 * snd_soc_dapm_free - free dapm resources
3869 * @dapm: DAPM context
3870 *
3871 * Free all dapm widgets and resources.
3872 */
3873void snd_soc_dapm_free(struct snd_soc_dapm_context *dapm)
3874{
3875        snd_soc_dapm_sys_remove(dapm->dev);
3876        dapm_debugfs_cleanup(dapm);
3877        dapm_free_widgets(dapm);
3878        list_del(&dapm->list);
3879}
3880EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
3881
3882static void soc_dapm_shutdown_codec(struct snd_soc_dapm_context *dapm)
3883{
3884        struct snd_soc_card *card = dapm->card;
3885        struct snd_soc_dapm_widget *w;
3886        LIST_HEAD(down_list);
3887        int powerdown = 0;
3888
3889        mutex_lock(&card->dapm_mutex);
3890
3891        list_for_each_entry(w, &dapm->card->widgets, list) {
3892                if (w->dapm != dapm)
3893                        continue;
3894                if (w->power) {
3895                        dapm_seq_insert(w, &down_list, false);
3896                        w->power = 0;
3897                        powerdown = 1;
3898                }
3899        }
3900
3901        /* If there were no widgets to power down we're already in
3902         * standby.
3903         */
3904        if (powerdown) {
3905                if (dapm->bias_level == SND_SOC_BIAS_ON)
3906                        snd_soc_dapm_set_bias_level(dapm,
3907                                                    SND_SOC_BIAS_PREPARE);
3908                dapm_seq_run(card, &down_list, 0, false);
3909                if (dapm->bias_level == SND_SOC_BIAS_PREPARE)
3910                        snd_soc_dapm_set_bias_level(dapm,
3911                                                    SND_SOC_BIAS_STANDBY);
3912        }
3913
3914        mutex_unlock(&card->dapm_mutex);
3915}
3916
3917/*
3918 * snd_soc_dapm_shutdown - callback for system shutdown
3919 */
3920void snd_soc_dapm_shutdown(struct snd_soc_card *card)
3921{
3922        struct snd_soc_codec *codec;
3923
3924        list_for_each_entry(codec, &card->codec_dev_list, card_list) {
3925                soc_dapm_shutdown_codec(&codec->dapm);
3926                if (codec->dapm.bias_level == SND_SOC_BIAS_STANDBY)
3927                        snd_soc_dapm_set_bias_level(&codec->dapm,
3928                                                    SND_SOC_BIAS_OFF);
3929        }
3930}
3931
3932/* Module information */
3933MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
3934MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
3935MODULE_LICENSE("GPL");
3936