SAFE public projects git trees. - safe/jmp/linux-2.6/blob - sound/soc/soc-dapm.c

   1 /*
   2  * soc-dapm.c  --  ALSA SoC Dynamic Audio Power Management
   3  *
   4  * Copyright 2005 Wolfson Microelectronics PLC.
   5  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
   6  *
   7  *  This program is free software; you can redistribute  it and/or modify it
   8  *  under  the terms of  the GNU General  Public License as published by the
   9  *  Free Software Foundation;  either version 2 of the  License, or (at your
  10  *  option) any later version.
  11  *
  12  *  Features:
  13  *    o Changes power status of internal codec blocks depending on the
  14  *      dynamic configuration of codec internal audio paths and active
  15  *      DACs/ADCs.
  16  *    o Platform power domain - can support external components i.e. amps and
  17  *      mic/meadphone insertion events.
  18  *    o Automatic Mic Bias support
  19  *    o Jack insertion power event initiation - e.g. hp insertion will enable
  20  *      sinks, dacs, etc
  21  *    o Delayed powerdown of audio susbsystem to reduce pops between a quick
  22  *      device reopen.
  23  *
  24  *  Todo:
  25  *    o DAPM power change sequencing - allow for configurable per
  26  *      codec sequences.
  27  *    o Support for analogue bias optimisation.
  28  *    o Support for reduced codec oversampling rates.
  29  *    o Support for reduced codec bias currents.
  30  */
  31
  32 #include <linux/module.h>
  33 #include <linux/moduleparam.h>
  34 #include <linux/init.h>
  35 #include <linux/delay.h>
  36 #include <linux/pm.h>
  37 #include <linux/bitops.h>
  38 #include <linux/platform_device.h>
  39 #include <linux/jiffies.h>
  40 #include <sound/core.h>
  41 #include <sound/pcm.h>
  42 #include <sound/pcm_params.h>
  43 #include <sound/soc-dapm.h>
  44 #include <sound/initval.h>
  45
  46 /* debug */
  47 #ifdef DEBUG
  48 #define dump_dapm(codec, action) dbg_dump_dapm(codec, action)
  49 #else
  50 #define dump_dapm(codec, action)
  51 #endif
  52
  53 /* dapm power sequences - make this per codec in the future */
  54 static int dapm_up_seq[] = {
  55         [snd_soc_dapm_pre] = 0,
  56         [snd_soc_dapm_supply] = 1,
  57         [snd_soc_dapm_micbias] = 2,
  58         [snd_soc_dapm_mic] = 3,
  59         [snd_soc_dapm_mux] = 4,
  60         [snd_soc_dapm_value_mux] = 5,
  61         [snd_soc_dapm_dac] = 6,
  62         [snd_soc_dapm_mixer] = 7,
  63         [snd_soc_dapm_mixer_named_ctl] = 8,
  64         [snd_soc_dapm_pga] = 9,
  65         [snd_soc_dapm_adc] = 10,
  66         [snd_soc_dapm_hp] = 11,
  67         [snd_soc_dapm_spk] = 12,
  68         [snd_soc_dapm_post] = 13,
  69 };
  70
  71 static int dapm_down_seq[] = {
  72         [snd_soc_dapm_pre] = 0,
  73         [snd_soc_dapm_adc] = 1,
  74         [snd_soc_dapm_hp] = 2,
  75         [snd_soc_dapm_spk] = 3,
  76         [snd_soc_dapm_pga] = 4,
  77         [snd_soc_dapm_mixer_named_ctl] = 5,
  78         [snd_soc_dapm_mixer] = 6,
  79         [snd_soc_dapm_dac] = 7,
  80         [snd_soc_dapm_mic] = 8,
  81         [snd_soc_dapm_micbias] = 9,
  82         [snd_soc_dapm_mux] = 10,
  83         [snd_soc_dapm_value_mux] = 11,
  84         [snd_soc_dapm_supply] = 12,
  85         [snd_soc_dapm_post] = 13,
  86 };
  87
  88 static void pop_wait(u32 pop_time)
  89 {
  90         if (pop_time)
  91                 schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
  92 }
  93
  94 static void pop_dbg(u32 pop_time, const char *fmt, ...)
  95 {
  96         va_list args;
  97
  98         va_start(args, fmt);
  99
 100         if (pop_time) {
 101                 vprintk(fmt, args);
 102                 pop_wait(pop_time);
 103         }
 104
 105         va_end(args);
 106 }
 107
 108 /* create a new dapm widget */
 109 static inline struct snd_soc_dapm_widget *dapm_cnew_widget(
 110         const struct snd_soc_dapm_widget *_widget)
 111 {
 112         return kmemdup(_widget, sizeof(*_widget), GFP_KERNEL);
 113 }
 114
 115 /**
 116  * snd_soc_dapm_set_bias_level - set the bias level for the system
 117  * @socdev: audio device
 118  * @level: level to configure
 119  *
 120  * Configure the bias (power) levels for the SoC audio device.
 121  *
 122  * Returns 0 for success else error.
 123  */
 124 static int snd_soc_dapm_set_bias_level(struct snd_soc_device *socdev,
 125                                        enum snd_soc_bias_level level)
 126 {
 127         struct snd_soc_card *card = socdev->card;
 128         struct snd_soc_codec *codec = socdev->card->codec;
 129         int ret = 0;
 130
 131         switch (level) {
 132         case SND_SOC_BIAS_ON:
 133                 dev_dbg(socdev->dev, "Setting full bias\n");
 134                 break;
 135         case SND_SOC_BIAS_PREPARE:
 136                 dev_dbg(socdev->dev, "Setting bias prepare\n");
 137                 break;
 138         case SND_SOC_BIAS_STANDBY:
 139                 dev_dbg(socdev->dev, "Setting standby bias\n");
 140                 break;
 141         case SND_SOC_BIAS_OFF:
 142                 dev_dbg(socdev->dev, "Setting bias off\n");
 143                 break;
 144         default:
 145                 dev_err(socdev->dev, "Setting invalid bias %d\n", level);
 146                 return -EINVAL;
 147         }
 148
 149         if (card->set_bias_level)
 150                 ret = card->set_bias_level(card, level);
 151         if (ret == 0 && codec->set_bias_level)
 152                 ret = codec->set_bias_level(codec, level);
 153
 154         return ret;
 155 }
 156
 157 /* set up initial codec paths */
 158 static void dapm_set_path_status(struct snd_soc_dapm_widget *w,
 159         struct snd_soc_dapm_path *p, int i)
 160 {
 161         switch (w->id) {
 162         case snd_soc_dapm_switch:
 163         case snd_soc_dapm_mixer:
 164         case snd_soc_dapm_mixer_named_ctl: {
 165                 int val;
 166                 struct soc_mixer_control *mc = (struct soc_mixer_control *)
 167                         w->kcontrols[i].private_value;
 168                 unsigned int reg = mc->reg;
 169                 unsigned int shift = mc->shift;
 170                 int max = mc->max;
 171                 unsigned int mask = (1 << fls(max)) - 1;
 172                 unsigned int invert = mc->invert;
 173
 174                 val = snd_soc_read(w->codec, reg);
 175                 val = (val >> shift) & mask;
 176
 177                 if ((invert && !val) || (!invert && val))
 178                         p->connect = 1;
 179                 else
 180                         p->connect = 0;
 181         }
 182         break;
 183         case snd_soc_dapm_mux: {
 184                 struct soc_enum *e = (struct soc_enum *)w->kcontrols[i].private_value;
 185                 int val, item, bitmask;
 186
 187                 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
 188                 ;
 189                 val = snd_soc_read(w->codec, e->reg);
 190                 item = (val >> e->shift_l) & (bitmask - 1);
 191
 192                 p->connect = 0;
 193                 for (i = 0; i < e->max; i++) {
 194                         if (!(strcmp(p->name, e->texts[i])) && item == i)
 195                                 p->connect = 1;
 196                 }
 197         }
 198         break;
 199         case snd_soc_dapm_value_mux: {
 200                 struct soc_enum *e = (struct soc_enum *)
 201                         w->kcontrols[i].private_value;
 202                 int val, item;
 203
 204                 val = snd_soc_read(w->codec, e->reg);
 205                 val = (val >> e->shift_l) & e->mask;
 206                 for (item = 0; item < e->max; item++) {
 207                         if (val == e->values[item])
 208                                 break;
 209                 }
 210
 211                 p->connect = 0;
 212                 for (i = 0; i < e->max; i++) {
 213                         if (!(strcmp(p->name, e->texts[i])) && item == i)
 214                                 p->connect = 1;
 215                 }
 216         }
 217         break;
 218         /* does not effect routing - always connected */
 219         case snd_soc_dapm_pga:
 220         case snd_soc_dapm_output:
 221         case snd_soc_dapm_adc:
 222         case snd_soc_dapm_input:
 223         case snd_soc_dapm_dac:
 224         case snd_soc_dapm_micbias:
 225         case snd_soc_dapm_vmid:
 226         case snd_soc_dapm_supply:
 227                 p->connect = 1;
 228         break;
 229         /* does effect routing - dynamically connected */
 230         case snd_soc_dapm_hp:
 231         case snd_soc_dapm_mic:
 232         case snd_soc_dapm_spk:
 233         case snd_soc_dapm_line:
 234         case snd_soc_dapm_pre:
 235         case snd_soc_dapm_post:
 236                 p->connect = 0;
 237         break;
 238         }
 239 }
 240
 241 /* connect mux widget to its interconnecting audio paths */
 242 static int dapm_connect_mux(struct snd_soc_codec *codec,
 243         struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
 244         struct snd_soc_dapm_path *path, const char *control_name,
 245         const struct snd_kcontrol_new *kcontrol)
 246 {
 247         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
 248         int i;
 249
 250         for (i = 0; i < e->max; i++) {
 251                 if (!(strcmp(control_name, e->texts[i]))) {
 252                         list_add(&path->list, &codec->dapm_paths);
 253                         list_add(&path->list_sink, &dest->sources);
 254                         list_add(&path->list_source, &src->sinks);
 255                         path->name = (char*)e->texts[i];
 256                         dapm_set_path_status(dest, path, 0);
 257                         return 0;
 258                 }
 259         }
 260
 261         return -ENODEV;
 262 }
 263
 264 /* connect mixer widget to its interconnecting audio paths */
 265 static int dapm_connect_mixer(struct snd_soc_codec *codec,
 266         struct snd_soc_dapm_widget *src, struct snd_soc_dapm_widget *dest,
 267         struct snd_soc_dapm_path *path, const char *control_name)
 268 {
 269         int i;
 270
 271         /* search for mixer kcontrol */
 272         for (i = 0; i < dest->num_kcontrols; i++) {
 273                 if (!strcmp(control_name, dest->kcontrols[i].name)) {
 274                         list_add(&path->list, &codec->dapm_paths);
 275                         list_add(&path->list_sink, &dest->sources);
 276                         list_add(&path->list_source, &src->sinks);
 277                         path->name = dest->kcontrols[i].name;
 278                         dapm_set_path_status(dest, path, i);
 279                         return 0;
 280                 }
 281         }
 282         return -ENODEV;
 283 }
 284
 285 /* update dapm codec register bits */
 286 static int dapm_update_bits(struct snd_soc_dapm_widget *widget)
 287 {
 288         int change, power;
 289         unsigned short old, new;
 290         struct snd_soc_codec *codec = widget->codec;
 291
 292         /* check for valid widgets */
 293         if (widget->reg < 0 || widget->id == snd_soc_dapm_input ||
 294                 widget->id == snd_soc_dapm_output ||
 295                 widget->id == snd_soc_dapm_hp ||
 296                 widget->id == snd_soc_dapm_mic ||
 297                 widget->id == snd_soc_dapm_line ||
 298                 widget->id == snd_soc_dapm_spk)
 299                 return 0;
 300
 301         power = widget->power;
 302         if (widget->invert)
 303                 power = (power ? 0:1);
 304
 305         old = snd_soc_read(codec, widget->reg);
 306         new = (old & ~(0x1 << widget->shift)) | (power << widget->shift);
 307
 308         change = old != new;
 309         if (change) {
 310                 pop_dbg(codec->pop_time, "pop test %s : %s in %d ms\n",
 311                         widget->name, widget->power ? "on" : "off",
 312                         codec->pop_time);
 313                 snd_soc_write(codec, widget->reg, new);
 314                 pop_wait(codec->pop_time);
 315         }
 316         pr_debug("reg %x old %x new %x change %d\n", widget->reg,
 317                  old, new, change);
 318         return change;
 319 }
 320
 321 /* ramps the volume up or down to minimise pops before or after a
 322  * DAPM power event */
 323 static int dapm_set_pga(struct snd_soc_dapm_widget *widget, int power)
 324 {
 325         const struct snd_kcontrol_new *k = widget->kcontrols;
 326
 327         if (widget->muted && !power)
 328                 return 0;
 329         if (!widget->muted && power)
 330                 return 0;
 331
 332         if (widget->num_kcontrols && k) {
 333                 struct soc_mixer_control *mc =
 334                         (struct soc_mixer_control *)k->private_value;
 335                 unsigned int reg = mc->reg;
 336                 unsigned int shift = mc->shift;
 337                 int max = mc->max;
 338                 unsigned int mask = (1 << fls(max)) - 1;
 339                 unsigned int invert = mc->invert;
 340
 341                 if (power) {
 342                         int i;
 343                         /* power up has happended, increase volume to last level */
 344                         if (invert) {
 345                                 for (i = max; i > widget->saved_value; i--)
 346                                         snd_soc_update_bits(widget->codec, reg, mask, i);
 347                         } else {
 348                                 for (i = 0; i < widget->saved_value; i++)
 349                                         snd_soc_update_bits(widget->codec, reg, mask, i);
 350                         }
 351                         widget->muted = 0;
 352                 } else {
 353                         /* power down is about to occur, decrease volume to mute */
 354                         int val = snd_soc_read(widget->codec, reg);
 355                         int i = widget->saved_value = (val >> shift) & mask;
 356                         if (invert) {
 357                                 for (; i < mask; i++)
 358                                         snd_soc_update_bits(widget->codec, reg, mask, i);
 359                         } else {
 360                                 for (; i > 0; i--)
 361                                         snd_soc_update_bits(widget->codec, reg, mask, i);
 362                         }
 363                         widget->muted = 1;
 364                 }
 365         }
 366         return 0;
 367 }
 368
 369 /* create new dapm mixer control */
 370 static int dapm_new_mixer(struct snd_soc_codec *codec,
 371         struct snd_soc_dapm_widget *w)
 372 {
 373         int i, ret = 0;
 374         size_t name_len;
 375         struct snd_soc_dapm_path *path;
 376
 377         /* add kcontrol */
 378         for (i = 0; i < w->num_kcontrols; i++) {
 379
 380                 /* match name */
 381                 list_for_each_entry(path, &w->sources, list_sink) {
 382
 383                         /* mixer/mux paths name must match control name */
 384                         if (path->name != (char*)w->kcontrols[i].name)
 385                                 continue;
 386
 387                         /* add dapm control with long name.
 388                          * for dapm_mixer this is the concatenation of the
 389                          * mixer and kcontrol name.
 390                          * for dapm_mixer_named_ctl this is simply the
 391                          * kcontrol name.
 392                          */
 393                         name_len = strlen(w->kcontrols[i].name) + 1;
 394                         if (w->id != snd_soc_dapm_mixer_named_ctl)
 395                                 name_len += 1 + strlen(w->name);
 396
 397                         path->long_name = kmalloc(name_len, GFP_KERNEL);
 398
 399                         if (path->long_name == NULL)
 400                                 return -ENOMEM;
 401
 402                         switch (w->id) {
 403                         default:
 404                                 snprintf(path->long_name, name_len, "%s %s",
 405                                          w->name, w->kcontrols[i].name);
 406                                 break;
 407                         case snd_soc_dapm_mixer_named_ctl:
 408                                 snprintf(path->long_name, name_len, "%s",
 409                                          w->kcontrols[i].name);
 410                                 break;
 411                         }
 412
 413                         path->long_name[name_len - 1] = '\0';
 414
 415                         path->kcontrol = snd_soc_cnew(&w->kcontrols[i], w,
 416                                 path->long_name);
 417                         ret = snd_ctl_add(codec->card, path->kcontrol);
 418                         if (ret < 0) {
 419                                 printk(KERN_ERR "asoc: failed to add dapm kcontrol %s: %d\n",
 420                                        path->long_name,
 421                                        ret);
 422                                 kfree(path->long_name);
 423                                 path->long_name = NULL;
 424                                 return ret;
 425                         }
 426                 }
 427         }
 428         return ret;
 429 }
 430
 431 /* create new dapm mux control */
 432 static int dapm_new_mux(struct snd_soc_codec *codec,
 433         struct snd_soc_dapm_widget *w)
 434 {
 435         struct snd_soc_dapm_path *path = NULL;
 436         struct snd_kcontrol *kcontrol;
 437         int ret = 0;
 438
 439         if (!w->num_kcontrols) {
 440                 printk(KERN_ERR "asoc: mux %s has no controls\n", w->name);
 441                 return -EINVAL;
 442         }
 443
 444         kcontrol = snd_soc_cnew(&w->kcontrols[0], w, w->name);
 445         ret = snd_ctl_add(codec->card, kcontrol);
 446         if (ret < 0)
 447                 goto err;
 448
 449         list_for_each_entry(path, &w->sources, list_sink)
 450                 path->kcontrol = kcontrol;
 451
 452         return ret;
 453
 454 err:
 455         printk(KERN_ERR "asoc: failed to add kcontrol %s\n", w->name);
 456         return ret;
 457 }
 458
 459 /* create new dapm volume control */
 460 static int dapm_new_pga(struct snd_soc_codec *codec,
 461         struct snd_soc_dapm_widget *w)
 462 {
 463         struct snd_kcontrol *kcontrol;
 464         int ret = 0;
 465
 466         if (!w->num_kcontrols)
 467                 return -EINVAL;
 468
 469         kcontrol = snd_soc_cnew(&w->kcontrols[0], w, w->name);
 470         ret = snd_ctl_add(codec->card, kcontrol);
 471         if (ret < 0) {
 472                 printk(KERN_ERR "asoc: failed to add kcontrol %s\n", w->name);
 473                 return ret;
 474         }
 475
 476         return ret;
 477 }
 478
 479 /* reset 'walked' bit for each dapm path */
 480 static inline void dapm_clear_walk(struct snd_soc_codec *codec)
 481 {
 482         struct snd_soc_dapm_path *p;
 483
 484         list_for_each_entry(p, &codec->dapm_paths, list)
 485                 p->walked = 0;
 486 }
 487
 488 /*
 489  * Recursively check for a completed path to an active or physically connected
 490  * output widget. Returns number of complete paths.
 491  */
 492 static int is_connected_output_ep(struct snd_soc_dapm_widget *widget)
 493 {
 494         struct snd_soc_dapm_path *path;
 495         int con = 0;
 496
 497         if (widget->id == snd_soc_dapm_supply)
 498                 return 0;
 499
 500         if (widget->id == snd_soc_dapm_adc && widget->active)
 501                 return 1;
 502
 503         if (widget->connected) {
 504                 /* connected pin ? */
 505                 if (widget->id == snd_soc_dapm_output && !widget->ext)
 506                         return 1;
 507
 508                 /* connected jack or spk ? */
 509                 if (widget->id == snd_soc_dapm_hp || widget->id == snd_soc_dapm_spk ||
 510                         widget->id == snd_soc_dapm_line)
 511                         return 1;
 512         }
 513
 514         list_for_each_entry(path, &widget->sinks, list_source) {
 515                 if (path->walked)
 516                         continue;
 517
 518                 if (path->sink && path->connect) {
 519                         path->walked = 1;
 520                         con += is_connected_output_ep(path->sink);
 521                 }
 522         }
 523
 524         return con;
 525 }
 526
 527 /*
 528  * Recursively check for a completed path to an active or physically connected
 529  * input widget. Returns number of complete paths.
 530  */
 531 static int is_connected_input_ep(struct snd_soc_dapm_widget *widget)
 532 {
 533         struct snd_soc_dapm_path *path;
 534         int con = 0;
 535
 536         if (widget->id == snd_soc_dapm_supply)
 537                 return 0;
 538
 539         /* active stream ? */
 540         if (widget->id == snd_soc_dapm_dac && widget->active)
 541                 return 1;
 542
 543         if (widget->connected) {
 544                 /* connected pin ? */
 545                 if (widget->id == snd_soc_dapm_input && !widget->ext)
 546                         return 1;
 547
 548                 /* connected VMID/Bias for lower pops */
 549                 if (widget->id == snd_soc_dapm_vmid)
 550                         return 1;
 551
 552                 /* connected jack ? */
 553                 if (widget->id == snd_soc_dapm_mic || widget->id == snd_soc_dapm_line)
 554                         return 1;
 555         }
 556
 557         list_for_each_entry(path, &widget->sources, list_sink) {
 558                 if (path->walked)
 559                         continue;
 560
 561                 if (path->source && path->connect) {
 562                         path->walked = 1;
 563                         con += is_connected_input_ep(path->source);
 564                 }
 565         }
 566
 567         return con;
 568 }
 569
 570 /*
 571  * Handler for generic register modifier widget.
 572  */
 573 int dapm_reg_event(struct snd_soc_dapm_widget *w,
 574                    struct snd_kcontrol *kcontrol, int event)
 575 {
 576         unsigned int val;
 577
 578         if (SND_SOC_DAPM_EVENT_ON(event))
 579                 val = w->on_val;
 580         else
 581                 val = w->off_val;
 582
 583         snd_soc_update_bits(w->codec, -(w->reg + 1),
 584                             w->mask << w->shift, val << w->shift);
 585
 586         return 0;
 587 }
 588 EXPORT_SYMBOL_GPL(dapm_reg_event);
 589
 590 /* Standard power change method, used to apply power changes to most
 591  * widgets.
 592  */
 593 static int dapm_generic_apply_power(struct snd_soc_dapm_widget *w)
 594 {
 595         int ret;
 596
 597         /* call any power change event handlers */
 598         if (w->event)
 599                 pr_debug("power %s event for %s flags %x\n",
 600                          w->power ? "on" : "off",
 601                          w->name, w->event_flags);
 602
 603         /* power up pre event */
 604         if (w->power && w->event &&
 605             (w->event_flags & SND_SOC_DAPM_PRE_PMU)) {
 606                 ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMU);
 607                 if (ret < 0)
 608                         return ret;
 609         }
 610
 611         /* power down pre event */
 612         if (!w->power && w->event &&
 613             (w->event_flags & SND_SOC_DAPM_PRE_PMD)) {
 614                 ret = w->event(w, NULL, SND_SOC_DAPM_PRE_PMD);
 615                 if (ret < 0)
 616                         return ret;
 617         }
 618
 619         /* Lower PGA volume to reduce pops */
 620         if (w->id == snd_soc_dapm_pga && !w->power)
 621                 dapm_set_pga(w, w->power);
 622
 623         dapm_update_bits(w);
 624
 625         /* Raise PGA volume to reduce pops */
 626         if (w->id == snd_soc_dapm_pga && w->power)
 627                 dapm_set_pga(w, w->power);
 628
 629         /* power up post event */
 630         if (w->power && w->event &&
 631             (w->event_flags & SND_SOC_DAPM_POST_PMU)) {
 632                 ret = w->event(w,
 633                                NULL, SND_SOC_DAPM_POST_PMU);
 634                 if (ret < 0)
 635                         return ret;
 636         }
 637
 638         /* power down post event */
 639         if (!w->power && w->event &&
 640             (w->event_flags & SND_SOC_DAPM_POST_PMD)) {
 641                 ret = w->event(w, NULL, SND_SOC_DAPM_POST_PMD);
 642                 if (ret < 0)
 643                         return ret;
 644         }
 645
 646         return 0;
 647 }
 648
 649 /* Generic check to see if a widget should be powered.
 650  */
 651 static int dapm_generic_check_power(struct snd_soc_dapm_widget *w)
 652 {
 653         int in, out;
 654
 655         in = is_connected_input_ep(w);
 656         dapm_clear_walk(w->codec);
 657         out = is_connected_output_ep(w);
 658         dapm_clear_walk(w->codec);
 659         return out != 0 && in != 0;
 660 }
 661
 662 /* Check to see if an ADC has power */
 663 static int dapm_adc_check_power(struct snd_soc_dapm_widget *w)
 664 {
 665         int in;
 666
 667         if (w->active) {
 668                 in = is_connected_input_ep(w);
 669                 dapm_clear_walk(w->codec);
 670                 return in != 0;
 671         } else {
 672                 return dapm_generic_check_power(w);
 673         }
 674 }
 675
 676 /* Check to see if a DAC has power */
 677 static int dapm_dac_check_power(struct snd_soc_dapm_widget *w)
 678 {
 679         int out;
 680
 681         if (w->active) {
 682                 out = is_connected_output_ep(w);
 683                 dapm_clear_walk(w->codec);
 684                 return out != 0;
 685         } else {
 686                 return dapm_generic_check_power(w);
 687         }
 688 }
 689
 690 /* Check to see if a power supply is needed */
 691 static int dapm_supply_check_power(struct snd_soc_dapm_widget *w)
 692 {
 693         struct snd_soc_dapm_path *path;
 694         int power = 0;
 695
 696         /* Check if one of our outputs is connected */
 697         list_for_each_entry(path, &w->sinks, list_source) {
 698                 if (path->sink && path->sink->power_check &&
 699                     path->sink->power_check(path->sink)) {
 700                         power = 1;
 701                         break;
 702                 }
 703         }
 704
 705         dapm_clear_walk(w->codec);
 706
 707         return power;
 708 }
 709
 710 static int dapm_seq_compare(struct snd_soc_dapm_widget *a,
 711                             struct snd_soc_dapm_widget *b,
 712                             int sort[])
 713 {
 714         if (sort[a->id] != sort[b->id])
 715                 return sort[a->id] - sort[b->id];
 716
 717         return 0;
 718 }
 719
 720 /* Insert a widget in order into a DAPM power sequence. */
 721 static void dapm_seq_insert(struct snd_soc_dapm_widget *new_widget,
 722                             struct list_head *list,
 723                             int sort[])
 724 {
 725         struct snd_soc_dapm_widget *w;
 726
 727         list_for_each_entry(w, list, power_list)
 728                 if (dapm_seq_compare(new_widget, w, sort) < 0) {
 729                         list_add_tail(&new_widget->power_list, &w->power_list);
 730                         return;
 731                 }
 732
 733         list_add_tail(&new_widget->power_list, list);
 734 }
 735
 736 /* Apply a DAPM power sequence */
 737 static void dapm_seq_run(struct snd_soc_codec *codec, struct list_head *list,
 738                          int event)
 739 {
 740         struct snd_soc_dapm_widget *w;
 741         int ret;
 742
 743         list_for_each_entry(w, list, power_list) {
 744                 switch (w->id) {
 745                 case snd_soc_dapm_pre:
 746                         if (!w->event)
 747                                 list_for_each_entry_continue(w, list,
 748                                                              power_list);
 749
 750                         if (event == SND_SOC_DAPM_STREAM_START) {
 751                                 ret = w->event(w,
 752                                                NULL, SND_SOC_DAPM_PRE_PMU);
 753                                 if (ret < 0)
 754                                         pr_err("PRE widget failed: %d\n",
 755                                                ret);
 756                         } else if (event == SND_SOC_DAPM_STREAM_STOP) {
 757                                 ret = w->event(w,
 758                                                NULL, SND_SOC_DAPM_PRE_PMD);
 759                                 if (ret < 0)
 760                                         pr_err("PRE widget failed: %d\n",
 761                                                ret);
 762                         }
 763                         break;
 764
 765                 case snd_soc_dapm_post:
 766                         if (!w->event)
 767                                 list_for_each_entry_continue(w, list,
 768                                                              power_list);
 769
 770                         if (event == SND_SOC_DAPM_STREAM_START) {
 771                                 ret = w->event(w,
 772                                                NULL, SND_SOC_DAPM_POST_PMU);
 773                                 if (ret < 0)
 774                                         pr_err("POST widget failed: %d\n",
 775                                                ret);
 776                         } else if (event == SND_SOC_DAPM_STREAM_STOP) {
 777                                 ret = w->event(w,
 778                                                NULL, SND_SOC_DAPM_POST_PMD);
 779                                 if (ret < 0)
 780                                         pr_err("POST widget failed: %d\n",
 781                                                ret);
 782                         }
 783                         break;
 784
 785                 default:
 786                         ret = dapm_generic_apply_power(w);
 787                         if (ret < 0)
 788                                 pr_err("Failed to apply widget power: %d\n",
 789                                        ret);
 790                         break;
 791                 }
 792         }
 793 }
 794
 795 /*
 796  * Scan each dapm widget for complete audio path.
 797  * A complete path is a route that has valid endpoints i.e.:-
 798  *
 799  *  o DAC to output pin.
 800  *  o Input Pin to ADC.
 801  *  o Input pin to Output pin (bypass, sidetone)
 802  *  o DAC to ADC (loopback).
 803  */
 804 static int dapm_power_widgets(struct snd_soc_codec *codec, int event)
 805 {
 806         struct snd_soc_device *socdev = codec->socdev;
 807         struct snd_soc_dapm_widget *w;
 808         int ret = 0;
 809         int power;
 810         int sys_power = 0;
 811
 812         INIT_LIST_HEAD(&codec->up_list);
 813         INIT_LIST_HEAD(&codec->down_list);
 814
 815         /* Check which widgets we need to power and store them in
 816          * lists indicating if they should be powered up or down.
 817          */
 818         list_for_each_entry(w, &codec->dapm_widgets, list) {
 819                 switch (w->id) {
 820                 case snd_soc_dapm_pre:
 821                         dapm_seq_insert(w, &codec->down_list, dapm_down_seq);
 822                         break;
 823                 case snd_soc_dapm_post:
 824                         dapm_seq_insert(w, &codec->up_list, dapm_up_seq);
 825                         break;
 826
 827                 default:
 828                         if (!w->power_check)
 829                                 continue;
 830
 831                         power = w->power_check(w);
 832                         if (power)
 833                                 sys_power = 1;
 834
 835                         if (w->power == power)
 836                                 continue;
 837
 838                         if (power)
 839                                 dapm_seq_insert(w, &codec->up_list,
 840                                                 dapm_up_seq);
 841                         else
 842                                 dapm_seq_insert(w, &codec->down_list,
 843                                                 dapm_down_seq);
 844
 845                         w->power = power;
 846                         break;
 847                 }
 848         }
 849
 850         /* If we're changing to all on or all off then prepare */
 851         if ((sys_power && codec->bias_level == SND_SOC_BIAS_STANDBY) ||
 852             (!sys_power && codec->bias_level == SND_SOC_BIAS_ON)) {
 853                 ret = snd_soc_dapm_set_bias_level(socdev,
 854                                                   SND_SOC_BIAS_PREPARE);
 855                 if (ret != 0)
 856                         pr_err("Failed to prepare bias: %d\n", ret);
 857         }
 858
 859         /* Power down widgets first; try to avoid amplifying pops. */
 860         dapm_seq_run(codec, &codec->down_list, event);
 861
 862         /* Now power up. */
 863         dapm_seq_run(codec, &codec->up_list, event);
 864
 865         /* If we just powered the last thing off drop to standby bias */
 866         if (codec->bias_level == SND_SOC_BIAS_PREPARE && !sys_power) {
 867                 ret = snd_soc_dapm_set_bias_level(socdev,
 868                                                   SND_SOC_BIAS_STANDBY);
 869                 if (ret != 0)
 870                         pr_err("Failed to apply standby bias: %d\n", ret);
 871         }
 872
 873         /* If we just powered up then move to active bias */
 874         if (codec->bias_level == SND_SOC_BIAS_PREPARE && sys_power) {
 875                 ret = snd_soc_dapm_set_bias_level(socdev,
 876                                                   SND_SOC_BIAS_ON);
 877                 if (ret != 0)
 878                         pr_err("Failed to apply active bias: %d\n", ret);
 879         }
 880
 881         return 0;
 882 }
 883
 884 #ifdef DEBUG
 885 static void dbg_dump_dapm(struct snd_soc_codec* codec, const char *action)
 886 {
 887         struct snd_soc_dapm_widget *w;
 888         struct snd_soc_dapm_path *p = NULL;
 889         int in, out;
 890
 891         printk("DAPM %s %s\n", codec->name, action);
 892
 893         list_for_each_entry(w, &codec->dapm_widgets, list) {
 894
 895                 /* only display widgets that effect routing */
 896                 switch (w->id) {
 897                 case snd_soc_dapm_pre:
 898                 case snd_soc_dapm_post:
 899                 case snd_soc_dapm_vmid:
 900                         continue;
 901                 case snd_soc_dapm_mux:
 902                 case snd_soc_dapm_value_mux:
 903                 case snd_soc_dapm_output:
 904                 case snd_soc_dapm_input:
 905                 case snd_soc_dapm_switch:
 906                 case snd_soc_dapm_hp:
 907                 case snd_soc_dapm_mic:
 908                 case snd_soc_dapm_spk:
 909                 case snd_soc_dapm_line:
 910                 case snd_soc_dapm_micbias:
 911                 case snd_soc_dapm_dac:
 912                 case snd_soc_dapm_adc:
 913                 case snd_soc_dapm_pga:
 914                 case snd_soc_dapm_mixer:
 915                 case snd_soc_dapm_mixer_named_ctl:
 916                 case snd_soc_dapm_supply:
 917                         if (w->name) {
 918                                 in = is_connected_input_ep(w);
 919                                 dapm_clear_walk(w->codec);
 920                                 out = is_connected_output_ep(w);
 921                                 dapm_clear_walk(w->codec);
 922                                 printk("%s: %s  in %d out %d\n", w->name,
 923                                         w->power ? "On":"Off",in, out);
 924
 925                                 list_for_each_entry(p, &w->sources, list_sink) {
 926                                         if (p->connect)
 927                                                 printk(" in  %s %s\n", p->name ? p->name : "static",
 928                                                         p->source->name);
 929                                 }
 930                                 list_for_each_entry(p, &w->sinks, list_source) {
 931                                         if (p->connect)
 932                                                 printk(" out %s %s\n", p->name ? p->name : "static",
 933                                                         p->sink->name);
 934                                 }
 935                         }
 936                 break;
 937                 }
 938         }
 939 }
 940 #endif
 941
 942 /* test and update the power status of a mux widget */
 943 static int dapm_mux_update_power(struct snd_soc_dapm_widget *widget,
 944                                  struct snd_kcontrol *kcontrol, int mask,
 945                                  int mux, int val, struct soc_enum *e)
 946 {
 947         struct snd_soc_dapm_path *path;
 948         int found = 0;
 949
 950         if (widget->id != snd_soc_dapm_mux &&
 951             widget->id != snd_soc_dapm_value_mux)
 952                 return -ENODEV;
 953
 954         if (!snd_soc_test_bits(widget->codec, e->reg, mask, val))
 955                 return 0;
 956
 957         /* find dapm widget path assoc with kcontrol */
 958         list_for_each_entry(path, &widget->codec->dapm_paths, list) {
 959                 if (path->kcontrol != kcontrol)
 960                         continue;
 961
 962                 if (!path->name || !e->texts[mux])
 963                         continue;
 964
 965                 found = 1;
 966                 /* we now need to match the string in the enum to the path */
 967                 if (!(strcmp(path->name, e->texts[mux])))
 968                         path->connect = 1; /* new connection */
 969                 else
 970                         path->connect = 0; /* old connection must be powered down */
 971         }
 972
 973         if (found) {
 974                 dapm_power_widgets(widget->codec, SND_SOC_DAPM_STREAM_NOP);
 975                 dump_dapm(widget->codec, "mux power update");
 976         }
 977
 978         return 0;
 979 }
 980
 981 /* test and update the power status of a mixer or switch widget */
 982 static int dapm_mixer_update_power(struct snd_soc_dapm_widget *widget,
 983                                    struct snd_kcontrol *kcontrol, int reg,
 984                                    int val_mask, int val, int invert)
 985 {
 986         struct snd_soc_dapm_path *path;
 987         int found = 0;
 988
 989         if (widget->id != snd_soc_dapm_mixer &&
 990             widget->id != snd_soc_dapm_mixer_named_ctl &&
 991             widget->id != snd_soc_dapm_switch)
 992                 return -ENODEV;
 993
 994         if (!snd_soc_test_bits(widget->codec, reg, val_mask, val))
 995                 return 0;
 996
 997         /* find dapm widget path assoc with kcontrol */
 998         list_for_each_entry(path, &widget->codec->dapm_paths, list) {
 999                 if (path->kcontrol != kcontrol)
1000                         continue;
1001
1002                 /* found, now check type */
1003                 found = 1;
1004                 if (val)
1005                         /* new connection */
1006                         path->connect = invert ? 0:1;
1007                 else
1008                         /* old connection must be powered down */
1009                         path->connect = invert ? 1:0;
1010                 break;
1011         }
1012
1013         if (found) {
1014                 dapm_power_widgets(widget->codec, SND_SOC_DAPM_STREAM_NOP);
1015                 dump_dapm(widget->codec, "mixer power update");
1016         }
1017
1018         return 0;
1019 }
1020
1021 /* show dapm widget status in sys fs */
1022 static ssize_t dapm_widget_show(struct device *dev,
1023         struct device_attribute *attr, char *buf)
1024 {
1025         struct snd_soc_device *devdata = dev_get_drvdata(dev);
1026         struct snd_soc_codec *codec = devdata->card->codec;
1027         struct snd_soc_dapm_widget *w;
1028         int count = 0;
1029         char *state = "not set";
1030
1031         list_for_each_entry(w, &codec->dapm_widgets, list) {
1032
1033                 /* only display widgets that burnm power */
1034                 switch (w->id) {
1035                 case snd_soc_dapm_hp:
1036                 case snd_soc_dapm_mic:
1037                 case snd_soc_dapm_spk:
1038                 case snd_soc_dapm_line:
1039                 case snd_soc_dapm_micbias:
1040                 case snd_soc_dapm_dac:
1041                 case snd_soc_dapm_adc:
1042                 case snd_soc_dapm_pga:
1043                 case snd_soc_dapm_mixer:
1044                 case snd_soc_dapm_mixer_named_ctl:
1045                 case snd_soc_dapm_supply:
1046                         if (w->name)
1047                                 count += sprintf(buf + count, "%s: %s\n",
1048                                         w->name, w->power ? "On":"Off");
1049                 break;
1050                 default:
1051                 break;
1052                 }
1053         }
1054
1055         switch (codec->bias_level) {
1056         case SND_SOC_BIAS_ON:
1057                 state = "On";
1058                 break;
1059         case SND_SOC_BIAS_PREPARE:
1060                 state = "Prepare";
1061                 break;
1062         case SND_SOC_BIAS_STANDBY:
1063                 state = "Standby";
1064                 break;
1065         case SND_SOC_BIAS_OFF:
1066                 state = "Off";
1067                 break;
1068         }
1069         count += sprintf(buf + count, "PM State: %s\n", state);
1070
1071         return count;
1072 }
1073
1074 static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);
1075
1076 int snd_soc_dapm_sys_add(struct device *dev)
1077 {
1078         return device_create_file(dev, &dev_attr_dapm_widget);
1079 }
1080
1081 static void snd_soc_dapm_sys_remove(struct device *dev)
1082 {
1083         device_remove_file(dev, &dev_attr_dapm_widget);
1084 }
1085
1086 /* free all dapm widgets and resources */
1087 static void dapm_free_widgets(struct snd_soc_codec *codec)
1088 {
1089         struct snd_soc_dapm_widget *w, *next_w;
1090         struct snd_soc_dapm_path *p, *next_p;
1091
1092         list_for_each_entry_safe(w, next_w, &codec->dapm_widgets, list) {
1093                 list_del(&w->list);
1094                 kfree(w);
1095         }
1096
1097         list_for_each_entry_safe(p, next_p, &codec->dapm_paths, list) {
1098                 list_del(&p->list);
1099                 kfree(p->long_name);
1100                 kfree(p);
1101         }
1102 }
1103
1104 static int snd_soc_dapm_set_pin(struct snd_soc_codec *codec,
1105                                 const char *pin, int status)
1106 {
1107         struct snd_soc_dapm_widget *w;
1108
1109         list_for_each_entry(w, &codec->dapm_widgets, list) {
1110                 if (!strcmp(w->name, pin)) {
1111                         pr_debug("dapm: %s: pin %s\n", codec->name, pin);
1112                         w->connected = status;
1113                         return 0;
1114                 }
1115         }
1116
1117         pr_err("dapm: %s: configuring unknown pin %s\n", codec->name, pin);
1118         return -EINVAL;
1119 }
1120
1121 /**
1122  * snd_soc_dapm_sync - scan and power dapm paths
1123  * @codec: audio codec
1124  *
1125  * Walks all dapm audio paths and powers widgets according to their
1126  * stream or path usage.
1127  *
1128  * Returns 0 for success.
1129  */
1130 int snd_soc_dapm_sync(struct snd_soc_codec *codec)
1131 {
1132         int ret = dapm_power_widgets(codec, SND_SOC_DAPM_STREAM_NOP);
1133         dump_dapm(codec, "sync");
1134         return ret;
1135 }
1136 EXPORT_SYMBOL_GPL(snd_soc_dapm_sync);
1137
1138 static int snd_soc_dapm_add_route(struct snd_soc_codec *codec,
1139         const char *sink, const char *control, const char *source)
1140 {
1141         struct snd_soc_dapm_path *path;
1142         struct snd_soc_dapm_widget *wsource = NULL, *wsink = NULL, *w;
1143         int ret = 0;
1144
1145         /* find src and dest widgets */
1146         list_for_each_entry(w, &codec->dapm_widgets, list) {
1147
1148                 if (!wsink && !(strcmp(w->name, sink))) {
1149                         wsink = w;
1150                         continue;
1151                 }
1152                 if (!wsource && !(strcmp(w->name, source))) {
1153                         wsource = w;
1154                 }
1155         }
1156
1157         if (wsource == NULL || wsink == NULL)
1158                 return -ENODEV;
1159
1160         path = kzalloc(sizeof(struct snd_soc_dapm_path), GFP_KERNEL);
1161         if (!path)
1162                 return -ENOMEM;
1163
1164         path->source = wsource;
1165         path->sink = wsink;
1166         INIT_LIST_HEAD(&path->list);
1167         INIT_LIST_HEAD(&path->list_source);
1168         INIT_LIST_HEAD(&path->list_sink);
1169
1170         /* check for external widgets */
1171         if (wsink->id == snd_soc_dapm_input) {
1172                 if (wsource->id == snd_soc_dapm_micbias ||
1173                         wsource->id == snd_soc_dapm_mic ||
1174                         wsink->id == snd_soc_dapm_line ||
1175                         wsink->id == snd_soc_dapm_output)
1176                         wsink->ext = 1;
1177         }
1178         if (wsource->id == snd_soc_dapm_output) {
1179                 if (wsink->id == snd_soc_dapm_spk ||
1180                         wsink->id == snd_soc_dapm_hp ||
1181                         wsink->id == snd_soc_dapm_line ||
1182                         wsink->id == snd_soc_dapm_input)
1183                         wsource->ext = 1;
1184         }
1185
1186         /* connect static paths */
1187         if (control == NULL) {
1188                 list_add(&path->list, &codec->dapm_paths);
1189                 list_add(&path->list_sink, &wsink->sources);
1190                 list_add(&path->list_source, &wsource->sinks);
1191                 path->connect = 1;
1192                 return 0;
1193         }
1194
1195         /* connect dynamic paths */
1196         switch(wsink->id) {
1197         case snd_soc_dapm_adc:
1198         case snd_soc_dapm_dac:
1199         case snd_soc_dapm_pga:
1200         case snd_soc_dapm_input:
1201         case snd_soc_dapm_output:
1202         case snd_soc_dapm_micbias:
1203         case snd_soc_dapm_vmid:
1204         case snd_soc_dapm_pre:
1205         case snd_soc_dapm_post:
1206         case snd_soc_dapm_supply:
1207                 list_add(&path->list, &codec->dapm_paths);
1208                 list_add(&path->list_sink, &wsink->sources);
1209                 list_add(&path->list_source, &wsource->sinks);
1210                 path->connect = 1;
1211                 return 0;
1212         case snd_soc_dapm_mux:
1213         case snd_soc_dapm_value_mux:
1214                 ret = dapm_connect_mux(codec, wsource, wsink, path, control,
1215                         &wsink->kcontrols[0]);
1216                 if (ret != 0)
1217                         goto err;
1218                 break;
1219         case snd_soc_dapm_switch:
1220         case snd_soc_dapm_mixer:
1221         case snd_soc_dapm_mixer_named_ctl:
1222                 ret = dapm_connect_mixer(codec, wsource, wsink, path, control);
1223                 if (ret != 0)
1224                         goto err;
1225                 break;
1226         case snd_soc_dapm_hp:
1227         case snd_soc_dapm_mic:
1228         case snd_soc_dapm_line:
1229         case snd_soc_dapm_spk:
1230                 list_add(&path->list, &codec->dapm_paths);
1231                 list_add(&path->list_sink, &wsink->sources);
1232                 list_add(&path->list_source, &wsource->sinks);
1233                 path->connect = 0;
1234                 return 0;
1235         }
1236         return 0;
1237
1238 err:
1239         printk(KERN_WARNING "asoc: no dapm match for %s --> %s --> %s\n", source,
1240                 control, sink);
1241         kfree(path);
1242         return ret;
1243 }
1244
1245 /**
1246  * snd_soc_dapm_add_routes - Add routes between DAPM widgets
1247  * @codec: codec
1248  * @route: audio routes
1249  * @num: number of routes
1250  *
1251  * Connects 2 dapm widgets together via a named audio path. The sink is
1252  * the widget receiving the audio signal, whilst the source is the sender
1253  * of the audio signal.
1254  *
1255  * Returns 0 for success else error. On error all resources can be freed
1256  * with a call to snd_soc_card_free().
1257  */
1258 int snd_soc_dapm_add_routes(struct snd_soc_codec *codec,
1259                             const struct snd_soc_dapm_route *route, int num)
1260 {
1261         int i, ret;
1262
1263         for (i = 0; i < num; i++) {
1264                 ret = snd_soc_dapm_add_route(codec, route->sink,
1265                                              route->control, route->source);
1266                 if (ret < 0) {
1267                         printk(KERN_ERR "Failed to add route %s->%s\n",
1268                                route->source,
1269                                route->sink);
1270                         return ret;
1271                 }
1272                 route++;
1273         }
1274
1275         return 0;
1276 }
1277 EXPORT_SYMBOL_GPL(snd_soc_dapm_add_routes);
1278
1279 /**
1280  * snd_soc_dapm_new_widgets - add new dapm widgets
1281  * @codec: audio codec
1282  *
1283  * Checks the codec for any new dapm widgets and creates them if found.
1284  *
1285  * Returns 0 for success.
1286  */
1287 int snd_soc_dapm_new_widgets(struct snd_soc_codec *codec)
1288 {
1289         struct snd_soc_dapm_widget *w;
1290
1291         list_for_each_entry(w, &codec->dapm_widgets, list)
1292         {
1293                 if (w->new)
1294                         continue;
1295
1296                 switch(w->id) {
1297                 case snd_soc_dapm_switch:
1298                 case snd_soc_dapm_mixer:
1299                 case snd_soc_dapm_mixer_named_ctl:
1300                         w->power_check = dapm_generic_check_power;
1301                         dapm_new_mixer(codec, w);
1302                         break;
1303                 case snd_soc_dapm_mux:
1304                 case snd_soc_dapm_value_mux:
1305                         w->power_check = dapm_generic_check_power;
1306                         dapm_new_mux(codec, w);
1307                         break;
1308                 case snd_soc_dapm_adc:
1309                         w->power_check = dapm_adc_check_power;
1310                         break;
1311                 case snd_soc_dapm_dac:
1312                         w->power_check = dapm_dac_check_power;
1313                         break;
1314                 case snd_soc_dapm_pga:
1315                         w->power_check = dapm_generic_check_power;
1316                         dapm_new_pga(codec, w);
1317                         break;
1318                 case snd_soc_dapm_input:
1319                 case snd_soc_dapm_output:
1320                 case snd_soc_dapm_micbias:
1321                 case snd_soc_dapm_spk:
1322                 case snd_soc_dapm_hp:
1323                 case snd_soc_dapm_mic:
1324                 case snd_soc_dapm_line:
1325                         w->power_check = dapm_generic_check_power;
1326                         break;
1327                 case snd_soc_dapm_supply:
1328                         w->power_check = dapm_supply_check_power;
1329                 case snd_soc_dapm_vmid:
1330                 case snd_soc_dapm_pre:
1331                 case snd_soc_dapm_post:
1332                         break;
1333                 }
1334                 w->new = 1;
1335         }
1336
1337         dapm_power_widgets(codec, SND_SOC_DAPM_STREAM_NOP);
1338         return 0;
1339 }
1340 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_widgets);
1341
1342 /**
1343  * snd_soc_dapm_get_volsw - dapm mixer get callback
1344  * @kcontrol: mixer control
1345  * @ucontrol: control element information
1346  *
1347  * Callback to get the value of a dapm mixer control.
1348  *
1349  * Returns 0 for success.
1350  */
1351 int snd_soc_dapm_get_volsw(struct snd_kcontrol *kcontrol,
1352         struct snd_ctl_elem_value *ucontrol)
1353 {
1354         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1355         struct soc_mixer_control *mc =
1356                 (struct soc_mixer_control *)kcontrol->private_value;
1357         unsigned int reg = mc->reg;
1358         unsigned int shift = mc->shift;
1359         unsigned int rshift = mc->rshift;
1360         int max = mc->max;
1361         unsigned int invert = mc->invert;
1362         unsigned int mask = (1 << fls(max)) - 1;
1363
1364         /* return the saved value if we are powered down */
1365         if (widget->id == snd_soc_dapm_pga && !widget->power) {
1366                 ucontrol->value.integer.value[0] = widget->saved_value;
1367                 return 0;
1368         }
1369
1370         ucontrol->value.integer.value[0] =
1371                 (snd_soc_read(widget->codec, reg) >> shift) & mask;
1372         if (shift != rshift)
1373                 ucontrol->value.integer.value[1] =
1374                         (snd_soc_read(widget->codec, reg) >> rshift) & mask;
1375         if (invert) {
1376                 ucontrol->value.integer.value[0] =
1377                         max - ucontrol->value.integer.value[0];
1378                 if (shift != rshift)
1379                         ucontrol->value.integer.value[1] =
1380                                 max - ucontrol->value.integer.value[1];
1381         }
1382
1383         return 0;
1384 }
1385 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_volsw);
1386
1387 /**
1388  * snd_soc_dapm_put_volsw - dapm mixer set callback
1389  * @kcontrol: mixer control
1390  * @ucontrol: control element information
1391  *
1392  * Callback to set the value of a dapm mixer control.
1393  *
1394  * Returns 0 for success.
1395  */
1396 int snd_soc_dapm_put_volsw(struct snd_kcontrol *kcontrol,
1397         struct snd_ctl_elem_value *ucontrol)
1398 {
1399         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1400         struct soc_mixer_control *mc =
1401                 (struct soc_mixer_control *)kcontrol->private_value;
1402         unsigned int reg = mc->reg;
1403         unsigned int shift = mc->shift;
1404         unsigned int rshift = mc->rshift;
1405         int max = mc->max;
1406         unsigned int mask = (1 << fls(max)) - 1;
1407         unsigned int invert = mc->invert;
1408         unsigned short val, val2, val_mask;
1409         int ret;
1410
1411         val = (ucontrol->value.integer.value[0] & mask);
1412
1413         if (invert)
1414                 val = max - val;
1415         val_mask = mask << shift;
1416         val = val << shift;
1417         if (shift != rshift) {
1418                 val2 = (ucontrol->value.integer.value[1] & mask);
1419                 if (invert)
1420                         val2 = max - val2;
1421                 val_mask |= mask << rshift;
1422                 val |= val2 << rshift;
1423         }
1424
1425         mutex_lock(&widget->codec->mutex);
1426         widget->value = val;
1427
1428         /* save volume value if the widget is powered down */
1429         if (widget->id == snd_soc_dapm_pga && !widget->power) {
1430                 widget->saved_value = val;
1431                 mutex_unlock(&widget->codec->mutex);
1432                 return 1;
1433         }
1434
1435         dapm_mixer_update_power(widget, kcontrol, reg, val_mask, val, invert);
1436         if (widget->event) {
1437                 if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
1438                         ret = widget->event(widget, kcontrol,
1439                                                 SND_SOC_DAPM_PRE_REG);
1440                         if (ret < 0) {
1441                                 ret = 1;
1442                                 goto out;
1443                         }
1444                 }
1445                 ret = snd_soc_update_bits(widget->codec, reg, val_mask, val);
1446                 if (widget->event_flags & SND_SOC_DAPM_POST_REG)
1447                         ret = widget->event(widget, kcontrol,
1448                                                 SND_SOC_DAPM_POST_REG);
1449         } else
1450                 ret = snd_soc_update_bits(widget->codec, reg, val_mask, val);
1451
1452 out:
1453         mutex_unlock(&widget->codec->mutex);
1454         return ret;
1455 }
1456 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_volsw);
1457
1458 /**
1459  * snd_soc_dapm_get_enum_double - dapm enumerated double mixer get callback
1460  * @kcontrol: mixer control
1461  * @ucontrol: control element information
1462  *
1463  * Callback to get the value of a dapm enumerated double mixer control.
1464  *
1465  * Returns 0 for success.
1466  */
1467 int snd_soc_dapm_get_enum_double(struct snd_kcontrol *kcontrol,
1468         struct snd_ctl_elem_value *ucontrol)
1469 {
1470         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1471         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1472         unsigned short val, bitmask;
1473
1474         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1475                 ;
1476         val = snd_soc_read(widget->codec, e->reg);
1477         ucontrol->value.enumerated.item[0] = (val >> e->shift_l) & (bitmask - 1);
1478         if (e->shift_l != e->shift_r)
1479                 ucontrol->value.enumerated.item[1] =
1480                         (val >> e->shift_r) & (bitmask - 1);
1481
1482         return 0;
1483 }
1484 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_enum_double);
1485
1486 /**
1487  * snd_soc_dapm_put_enum_double - dapm enumerated double mixer set callback
1488  * @kcontrol: mixer control
1489  * @ucontrol: control element information
1490  *
1491  * Callback to set the value of a dapm enumerated double mixer control.
1492  *
1493  * Returns 0 for success.
1494  */
1495 int snd_soc_dapm_put_enum_double(struct snd_kcontrol *kcontrol,
1496         struct snd_ctl_elem_value *ucontrol)
1497 {
1498         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1499         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1500         unsigned short val, mux;
1501         unsigned short mask, bitmask;
1502         int ret = 0;
1503
1504         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1505                 ;
1506         if (ucontrol->value.enumerated.item[0] > e->max - 1)
1507                 return -EINVAL;
1508         mux = ucontrol->value.enumerated.item[0];
1509         val = mux << e->shift_l;
1510         mask = (bitmask - 1) << e->shift_l;
1511         if (e->shift_l != e->shift_r) {
1512                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
1513                         return -EINVAL;
1514                 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
1515                 mask |= (bitmask - 1) << e->shift_r;
1516         }
1517
1518         mutex_lock(&widget->codec->mutex);
1519         widget->value = val;
1520         dapm_mux_update_power(widget, kcontrol, mask, mux, val, e);
1521         if (widget->event) {
1522                 if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
1523                         ret = widget->event(widget,
1524                                 kcontrol, SND_SOC_DAPM_PRE_REG);
1525                         if (ret < 0)
1526                                 goto out;
1527                 }
1528                 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1529                 if (widget->event_flags & SND_SOC_DAPM_POST_REG)
1530                         ret = widget->event(widget,
1531                                 kcontrol, SND_SOC_DAPM_POST_REG);
1532         } else
1533                 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1534
1535 out:
1536         mutex_unlock(&widget->codec->mutex);
1537         return ret;
1538 }
1539 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_enum_double);
1540
1541 /**
1542  * snd_soc_dapm_get_value_enum_double - dapm semi enumerated double mixer get
1543  *                                      callback
1544  * @kcontrol: mixer control
1545  * @ucontrol: control element information
1546  *
1547  * Callback to get the value of a dapm semi enumerated double mixer control.
1548  *
1549  * Semi enumerated mixer: the enumerated items are referred as values. Can be
1550  * used for handling bitfield coded enumeration for example.
1551  *
1552  * Returns 0 for success.
1553  */
1554 int snd_soc_dapm_get_value_enum_double(struct snd_kcontrol *kcontrol,
1555         struct snd_ctl_elem_value *ucontrol)
1556 {
1557         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1558         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1559         unsigned short reg_val, val, mux;
1560
1561         reg_val = snd_soc_read(widget->codec, e->reg);
1562         val = (reg_val >> e->shift_l) & e->mask;
1563         for (mux = 0; mux < e->max; mux++) {
1564                 if (val == e->values[mux])
1565                         break;
1566         }
1567         ucontrol->value.enumerated.item[0] = mux;
1568         if (e->shift_l != e->shift_r) {
1569                 val = (reg_val >> e->shift_r) & e->mask;
1570                 for (mux = 0; mux < e->max; mux++) {
1571                         if (val == e->values[mux])
1572                                 break;
1573                 }
1574                 ucontrol->value.enumerated.item[1] = mux;
1575         }
1576
1577         return 0;
1578 }
1579 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_value_enum_double);
1580
1581 /**
1582  * snd_soc_dapm_put_value_enum_double - dapm semi enumerated double mixer set
1583  *                                      callback
1584  * @kcontrol: mixer control
1585  * @ucontrol: control element information
1586  *
1587  * Callback to set the value of a dapm semi enumerated double mixer control.
1588  *
1589  * Semi enumerated mixer: the enumerated items are referred as values. Can be
1590  * used for handling bitfield coded enumeration for example.
1591  *
1592  * Returns 0 for success.
1593  */
1594 int snd_soc_dapm_put_value_enum_double(struct snd_kcontrol *kcontrol,
1595         struct snd_ctl_elem_value *ucontrol)
1596 {
1597         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
1598         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1599         unsigned short val, mux;
1600         unsigned short mask;
1601         int ret = 0;
1602
1603         if (ucontrol->value.enumerated.item[0] > e->max - 1)
1604                 return -EINVAL;
1605         mux = ucontrol->value.enumerated.item[0];
1606         val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
1607         mask = e->mask << e->shift_l;
1608         if (e->shift_l != e->shift_r) {
1609                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
1610                         return -EINVAL;
1611                 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
1612                 mask |= e->mask << e->shift_r;
1613         }
1614
1615         mutex_lock(&widget->codec->mutex);
1616         widget->value = val;
1617         dapm_mux_update_power(widget, kcontrol, mask, mux, val, e);
1618         if (widget->event) {
1619                 if (widget->event_flags & SND_SOC_DAPM_PRE_REG) {
1620                         ret = widget->event(widget,
1621                                 kcontrol, SND_SOC_DAPM_PRE_REG);
1622                         if (ret < 0)
1623                                 goto out;
1624                 }
1625                 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1626                 if (widget->event_flags & SND_SOC_DAPM_POST_REG)
1627                         ret = widget->event(widget,
1628                                 kcontrol, SND_SOC_DAPM_POST_REG);
1629         } else
1630                 ret = snd_soc_update_bits(widget->codec, e->reg, mask, val);
1631
1632 out:
1633         mutex_unlock(&widget->codec->mutex);
1634         return ret;
1635 }
1636 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_value_enum_double);
1637
1638 /**
1639  * snd_soc_dapm_info_pin_switch - Info for a pin switch
1640  *
1641  * @kcontrol: mixer control
1642  * @uinfo: control element information
1643  *
1644  * Callback to provide information about a pin switch control.
1645  */
1646 int snd_soc_dapm_info_pin_switch(struct snd_kcontrol *kcontrol,
1647                                  struct snd_ctl_elem_info *uinfo)
1648 {
1649         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1650         uinfo->count = 1;
1651         uinfo->value.integer.min = 0;
1652         uinfo->value.integer.max = 1;
1653
1654         return 0;
1655 }
1656 EXPORT_SYMBOL_GPL(snd_soc_dapm_info_pin_switch);
1657
1658 /**
1659  * snd_soc_dapm_get_pin_switch - Get information for a pin switch
1660  *
1661  * @kcontrol: mixer control
1662  * @ucontrol: Value
1663  */
1664 int snd_soc_dapm_get_pin_switch(struct snd_kcontrol *kcontrol,
1665                                 struct snd_ctl_elem_value *ucontrol)
1666 {
1667         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1668         const char *pin = (const char *)kcontrol->private_value;
1669
1670         mutex_lock(&codec->mutex);
1671
1672         ucontrol->value.integer.value[0] =
1673                 snd_soc_dapm_get_pin_status(codec, pin);
1674
1675         mutex_unlock(&codec->mutex);
1676
1677         return 0;
1678 }
1679 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_switch);
1680
1681 /**
1682  * snd_soc_dapm_put_pin_switch - Set information for a pin switch
1683  *
1684  * @kcontrol: mixer control
1685  * @ucontrol: Value
1686  */
1687 int snd_soc_dapm_put_pin_switch(struct snd_kcontrol *kcontrol,
1688                                 struct snd_ctl_elem_value *ucontrol)
1689 {
1690         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1691         const char *pin = (const char *)kcontrol->private_value;
1692
1693         mutex_lock(&codec->mutex);
1694
1695         if (ucontrol->value.integer.value[0])
1696                 snd_soc_dapm_enable_pin(codec, pin);
1697         else
1698                 snd_soc_dapm_disable_pin(codec, pin);
1699
1700         snd_soc_dapm_sync(codec);
1701
1702         mutex_unlock(&codec->mutex);
1703
1704         return 0;
1705 }
1706 EXPORT_SYMBOL_GPL(snd_soc_dapm_put_pin_switch);
1707
1708 /**
1709  * snd_soc_dapm_new_control - create new dapm control
1710  * @codec: audio codec
1711  * @widget: widget template
1712  *
1713  * Creates a new dapm control based upon the template.
1714  *
1715  * Returns 0 for success else error.
1716  */
1717 int snd_soc_dapm_new_control(struct snd_soc_codec *codec,
1718         const struct snd_soc_dapm_widget *widget)
1719 {
1720         struct snd_soc_dapm_widget *w;
1721
1722         if ((w = dapm_cnew_widget(widget)) == NULL)
1723                 return -ENOMEM;
1724
1725         w->codec = codec;
1726         INIT_LIST_HEAD(&w->sources);
1727         INIT_LIST_HEAD(&w->sinks);
1728         INIT_LIST_HEAD(&w->list);
1729         list_add(&w->list, &codec->dapm_widgets);
1730
1731         /* machine layer set ups unconnected pins and insertions */
1732         w->connected = 1;
1733         return 0;
1734 }
1735 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_control);
1736
1737 /**
1738  * snd_soc_dapm_new_controls - create new dapm controls
1739  * @codec: audio codec
1740  * @widget: widget array
1741  * @num: number of widgets
1742  *
1743  * Creates new DAPM controls based upon the templates.
1744  *
1745  * Returns 0 for success else error.
1746  */
1747 int snd_soc_dapm_new_controls(struct snd_soc_codec *codec,
1748         const struct snd_soc_dapm_widget *widget,
1749         int num)
1750 {
1751         int i, ret;
1752
1753         for (i = 0; i < num; i++) {
1754                 ret = snd_soc_dapm_new_control(codec, widget);
1755                 if (ret < 0) {
1756                         printk(KERN_ERR
1757                                "ASoC: Failed to create DAPM control %s: %d\n",
1758                                widget->name, ret);
1759                         return ret;
1760                 }
1761                 widget++;
1762         }
1763         return 0;
1764 }
1765 EXPORT_SYMBOL_GPL(snd_soc_dapm_new_controls);
1766
1767
1768 /**
1769  * snd_soc_dapm_stream_event - send a stream event to the dapm core
1770  * @codec: audio codec
1771  * @stream: stream name
1772  * @event: stream event
1773  *
1774  * Sends a stream event to the dapm core. The core then makes any
1775  * necessary widget power changes.
1776  *
1777  * Returns 0 for success else error.
1778  */
1779 int snd_soc_dapm_stream_event(struct snd_soc_codec *codec,
1780         char *stream, int event)
1781 {
1782         struct snd_soc_dapm_widget *w;
1783
1784         if (stream == NULL)
1785                 return 0;
1786
1787         mutex_lock(&codec->mutex);
1788         list_for_each_entry(w, &codec->dapm_widgets, list)
1789         {
1790                 if (!w->sname)
1791                         continue;
1792                 pr_debug("widget %s\n %s stream %s event %d\n",
1793                          w->name, w->sname, stream, event);
1794                 if (strstr(w->sname, stream)) {
1795                         switch(event) {
1796                         case SND_SOC_DAPM_STREAM_START:
1797                                 w->active = 1;
1798                                 break;
1799                         case SND_SOC_DAPM_STREAM_STOP:
1800                                 w->active = 0;
1801                                 break;
1802                         case SND_SOC_DAPM_STREAM_SUSPEND:
1803                                 if (w->active)
1804                                         w->suspend = 1;
1805                                 w->active = 0;
1806                                 break;
1807                         case SND_SOC_DAPM_STREAM_RESUME:
1808                                 if (w->suspend) {
1809                                         w->active = 1;
1810                                         w->suspend = 0;
1811                                 }
1812                                 break;
1813                         case SND_SOC_DAPM_STREAM_PAUSE_PUSH:
1814                                 break;
1815                         case SND_SOC_DAPM_STREAM_PAUSE_RELEASE:
1816                                 break;
1817                         }
1818                 }
1819         }
1820         mutex_unlock(&codec->mutex);
1821
1822         dapm_power_widgets(codec, event);
1823         dump_dapm(codec, __func__);
1824         return 0;
1825 }
1826 EXPORT_SYMBOL_GPL(snd_soc_dapm_stream_event);
1827
1828 /**
1829  * snd_soc_dapm_enable_pin - enable pin.
1830  * @codec: SoC codec
1831  * @pin: pin name
1832  *
1833  * Enables input/output pin and its parents or children widgets iff there is
1834  * a valid audio route and active audio stream.
1835  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
1836  * do any widget power switching.
1837  */
1838 int snd_soc_dapm_enable_pin(struct snd_soc_codec *codec, const char *pin)
1839 {
1840         return snd_soc_dapm_set_pin(codec, pin, 1);
1841 }
1842 EXPORT_SYMBOL_GPL(snd_soc_dapm_enable_pin);
1843
1844 /**
1845  * snd_soc_dapm_disable_pin - disable pin.
1846  * @codec: SoC codec
1847  * @pin: pin name
1848  *
1849  * Disables input/output pin and its parents or children widgets.
1850  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
1851  * do any widget power switching.
1852  */
1853 int snd_soc_dapm_disable_pin(struct snd_soc_codec *codec, const char *pin)
1854 {
1855         return snd_soc_dapm_set_pin(codec, pin, 0);
1856 }
1857 EXPORT_SYMBOL_GPL(snd_soc_dapm_disable_pin);
1858
1859 /**
1860  * snd_soc_dapm_nc_pin - permanently disable pin.
1861  * @codec: SoC codec
1862  * @pin: pin name
1863  *
1864  * Marks the specified pin as being not connected, disabling it along
1865  * any parent or child widgets.  At present this is identical to
1866  * snd_soc_dapm_disable_pin() but in future it will be extended to do
1867  * additional things such as disabling controls which only affect
1868  * paths through the pin.
1869  *
1870  * NOTE: snd_soc_dapm_sync() needs to be called after this for DAPM to
1871  * do any widget power switching.
1872  */
1873 int snd_soc_dapm_nc_pin(struct snd_soc_codec *codec, const char *pin)
1874 {
1875         return snd_soc_dapm_set_pin(codec, pin, 0);
1876 }
1877 EXPORT_SYMBOL_GPL(snd_soc_dapm_nc_pin);
1878
1879 /**
1880  * snd_soc_dapm_get_pin_status - get audio pin status
1881  * @codec: audio codec
1882  * @pin: audio signal pin endpoint (or start point)
1883  *
1884  * Get audio pin status - connected or disconnected.
1885  *
1886  * Returns 1 for connected otherwise 0.
1887  */
1888 int snd_soc_dapm_get_pin_status(struct snd_soc_codec *codec, const char *pin)
1889 {
1890         struct snd_soc_dapm_widget *w;
1891
1892         list_for_each_entry(w, &codec->dapm_widgets, list) {
1893                 if (!strcmp(w->name, pin))
1894                         return w->connected;
1895         }
1896
1897         return 0;
1898 }
1899 EXPORT_SYMBOL_GPL(snd_soc_dapm_get_pin_status);
1900
1901 /**
1902  * snd_soc_dapm_free - free dapm resources
1903  * @socdev: SoC device
1904  *
1905  * Free all dapm widgets and resources.
1906  */
1907 void snd_soc_dapm_free(struct snd_soc_device *socdev)
1908 {
1909         struct snd_soc_codec *codec = socdev->card->codec;
1910
1911         snd_soc_dapm_sys_remove(socdev->dev);
1912         dapm_free_widgets(codec);
1913 }
1914 EXPORT_SYMBOL_GPL(snd_soc_dapm_free);
1915
1916 /* Module information */
1917 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
1918 MODULE_DESCRIPTION("Dynamic Audio Power Management core for ALSA SoC");
1919 MODULE_LICENSE("GPL");