sound/soc/soc-pcm.c

   1 /*
   2  * soc-pcm.c  --  ALSA SoC PCM
   3  *
   4  * Copyright 2005 Wolfson Microelectronics PLC.
   5  * Copyright 2005 Openedhand Ltd.
   6  * Copyright (C) 2010 Slimlogic Ltd.
   7  * Copyright (C) 2010 Texas Instruments Inc.
   8  *
   9  * Authors: Liam Girdwood <lrg@ti.com>
  10  *          Mark Brown <broonie@opensource.wolfsonmicro.com>
  11  *
  12  *  This program is free software; you can redistribute  it and/or modify it
  13  *  under  the terms of  the GNU General  Public License as published by the
  14  *  Free Software Foundation;  either version 2 of the  License, or (at your
  15  *  option) any later version.
  16  *
  17  */
  18
  19 #include <linux/kernel.h>
  20 #include <linux/init.h>
  21 #include <linux/delay.h>
  22 #include <linux/pinctrl/consumer.h>
  23 #include <linux/pm_runtime.h>
  24 #include <linux/slab.h>
  25 #include <linux/workqueue.h>
  26 #include <linux/export.h>
  27 #include <linux/debugfs.h>
  28 #include <sound/core.h>
  29 #include <sound/pcm.h>
  30 #include <sound/pcm_params.h>
  31 #include <sound/soc.h>
  32 #include <sound/soc-dpcm.h>
  33 #include <sound/initval.h>
  34
  35 #define DPCM_MAX_BE_USERS       8
  36
  37 /*
  38  * snd_soc_dai_stream_valid() - check if a DAI supports the given stream
  39  *
  40  * Returns true if the DAI supports the indicated stream type.
  41  */
  42 static bool snd_soc_dai_stream_valid(struct snd_soc_dai *dai, int stream)
  43 {
  44         struct snd_soc_pcm_stream *codec_stream;
  45
  46         if (stream == SNDRV_PCM_STREAM_PLAYBACK)
  47                 codec_stream = &dai->driver->playback;
  48         else
  49                 codec_stream = &dai->driver->capture;
  50
  51         /* If the codec specifies any rate at all, it supports the stream. */
  52         return codec_stream->rates;
  53 }
  54
  55 /**
  56  * snd_soc_runtime_activate() - Increment active count for PCM runtime components
  57  * @rtd: ASoC PCM runtime that is activated
  58  * @stream: Direction of the PCM stream
  59  *
  60  * Increments the active count for all the DAIs and components attached to a PCM
  61  * runtime. Should typically be called when a stream is opened.
  62  *
  63  * Must be called with the rtd->pcm_mutex being held
  64  */
  65 void snd_soc_runtime_activate(struct snd_soc_pcm_runtime *rtd, int stream)
  66 {
  67         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
  68         int i;
  69
  70         lockdep_assert_held(&rtd->pcm_mutex);
  71
  72         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
  73                 cpu_dai->playback_active++;
  74                 for (i = 0; i < rtd->num_codecs; i++)
  75                         rtd->codec_dais[i]->playback_active++;
  76         } else {
  77                 cpu_dai->capture_active++;
  78                 for (i = 0; i < rtd->num_codecs; i++)
  79                         rtd->codec_dais[i]->capture_active++;
  80         }
  81
  82         cpu_dai->active++;
  83         cpu_dai->component->active++;
  84         for (i = 0; i < rtd->num_codecs; i++) {
  85                 rtd->codec_dais[i]->active++;
  86                 rtd->codec_dais[i]->component->active++;
  87         }
  88 }
  89
  90 /**
  91  * snd_soc_runtime_deactivate() - Decrement active count for PCM runtime components
  92  * @rtd: ASoC PCM runtime that is deactivated
  93  * @stream: Direction of the PCM stream
  94  *
  95  * Decrements the active count for all the DAIs and components attached to a PCM
  96  * runtime. Should typically be called when a stream is closed.
  97  *
  98  * Must be called with the rtd->pcm_mutex being held
  99  */
 100 void snd_soc_runtime_deactivate(struct snd_soc_pcm_runtime *rtd, int stream)
 101 {
 102         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 103         int i;
 104
 105         lockdep_assert_held(&rtd->pcm_mutex);
 106
 107         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
 108                 cpu_dai->playback_active--;
 109                 for (i = 0; i < rtd->num_codecs; i++)
 110                         rtd->codec_dais[i]->playback_active--;
 111         } else {
 112                 cpu_dai->capture_active--;
 113                 for (i = 0; i < rtd->num_codecs; i++)
 114                         rtd->codec_dais[i]->capture_active--;
 115         }
 116
 117         cpu_dai->active--;
 118         cpu_dai->component->active--;
 119         for (i = 0; i < rtd->num_codecs; i++) {
 120                 rtd->codec_dais[i]->component->active--;
 121                 rtd->codec_dais[i]->active--;
 122         }
 123 }
 124
 125 /**
 126  * snd_soc_runtime_ignore_pmdown_time() - Check whether to ignore the power down delay
 127  * @rtd: The ASoC PCM runtime that should be checked.
 128  *
 129  * This function checks whether the power down delay should be ignored for a
 130  * specific PCM runtime. Returns true if the delay is 0, if it the DAI link has
 131  * been configured to ignore the delay, or if none of the components benefits
 132  * from having the delay.
 133  */
 134 bool snd_soc_runtime_ignore_pmdown_time(struct snd_soc_pcm_runtime *rtd)
 135 {
 136         struct snd_soc_rtdcom_list *rtdcom;
 137         struct snd_soc_component *component;
 138         bool ignore = true;
 139
 140         if (!rtd->pmdown_time || rtd->dai_link->ignore_pmdown_time)
 141                 return true;
 142
 143         for_each_rtdcom(rtd, rtdcom) {
 144                 component = rtdcom->component;
 145
 146                 ignore &= !component->driver->use_pmdown_time;
 147         }
 148
 149         return ignore;
 150 }
 151
 152 /**
 153  * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
 154  * @substream: the pcm substream
 155  * @hw: the hardware parameters
 156  *
 157  * Sets the substream runtime hardware parameters.
 158  */
 159 int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
 160         const struct snd_pcm_hardware *hw)
 161 {
 162         struct snd_pcm_runtime *runtime = substream->runtime;
 163         runtime->hw.info = hw->info;
 164         runtime->hw.formats = hw->formats;
 165         runtime->hw.period_bytes_min = hw->period_bytes_min;
 166         runtime->hw.period_bytes_max = hw->period_bytes_max;
 167         runtime->hw.periods_min = hw->periods_min;
 168         runtime->hw.periods_max = hw->periods_max;
 169         runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
 170         runtime->hw.fifo_size = hw->fifo_size;
 171         return 0;
 172 }
 173 EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
 174
 175 /* DPCM stream event, send event to FE and all active BEs. */
 176 int dpcm_dapm_stream_event(struct snd_soc_pcm_runtime *fe, int dir,
 177         int event)
 178 {
 179         struct snd_soc_dpcm *dpcm;
 180
 181         list_for_each_entry(dpcm, &fe->dpcm[dir].be_clients, list_be) {
 182
 183                 struct snd_soc_pcm_runtime *be = dpcm->be;
 184
 185                 dev_dbg(be->dev, "ASoC: BE %s event %d dir %d\n",
 186                                 be->dai_link->name, event, dir);
 187
 188                 if ((event == SND_SOC_DAPM_STREAM_STOP) &&
 189                     (be->dpcm[dir].users >= 1))
 190                         continue;
 191
 192                 snd_soc_dapm_stream_event(be, dir, event);
 193         }
 194
 195         snd_soc_dapm_stream_event(fe, dir, event);
 196
 197         return 0;
 198 }
 199
 200 static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream,
 201                                         struct snd_soc_dai *soc_dai)
 202 {
 203         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 204         int ret;
 205
 206         if (soc_dai->rate && (soc_dai->driver->symmetric_rates ||
 207                                 rtd->dai_link->symmetric_rates)) {
 208                 dev_dbg(soc_dai->dev, "ASoC: Symmetry forces %dHz rate\n",
 209                                 soc_dai->rate);
 210
 211                 ret = snd_pcm_hw_constraint_single(substream->runtime,
 212                                                 SNDRV_PCM_HW_PARAM_RATE,
 213                                                 soc_dai->rate);
 214                 if (ret < 0) {
 215                         dev_err(soc_dai->dev,
 216                                 "ASoC: Unable to apply rate constraint: %d\n",
 217                                 ret);
 218                         return ret;
 219                 }
 220         }
 221
 222         if (soc_dai->channels && (soc_dai->driver->symmetric_channels ||
 223                                 rtd->dai_link->symmetric_channels)) {
 224                 dev_dbg(soc_dai->dev, "ASoC: Symmetry forces %d channel(s)\n",
 225                                 soc_dai->channels);
 226
 227                 ret = snd_pcm_hw_constraint_single(substream->runtime,
 228                                                 SNDRV_PCM_HW_PARAM_CHANNELS,
 229                                                 soc_dai->channels);
 230                 if (ret < 0) {
 231                         dev_err(soc_dai->dev,
 232                                 "ASoC: Unable to apply channel symmetry constraint: %d\n",
 233                                 ret);
 234                         return ret;
 235                 }
 236         }
 237
 238         if (soc_dai->sample_bits && (soc_dai->driver->symmetric_samplebits ||
 239                                 rtd->dai_link->symmetric_samplebits)) {
 240                 dev_dbg(soc_dai->dev, "ASoC: Symmetry forces %d sample bits\n",
 241                                 soc_dai->sample_bits);
 242
 243                 ret = snd_pcm_hw_constraint_single(substream->runtime,
 244                                                 SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
 245                                                 soc_dai->sample_bits);
 246                 if (ret < 0) {
 247                         dev_err(soc_dai->dev,
 248                                 "ASoC: Unable to apply sample bits symmetry constraint: %d\n",
 249                                 ret);
 250                         return ret;
 251                 }
 252         }
 253
 254         return 0;
 255 }
 256
 257 static int soc_pcm_params_symmetry(struct snd_pcm_substream *substream,
 258                                 struct snd_pcm_hw_params *params)
 259 {
 260         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 261         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 262         unsigned int rate, channels, sample_bits, symmetry, i;
 263
 264         rate = params_rate(params);
 265         channels = params_channels(params);
 266         sample_bits = snd_pcm_format_physical_width(params_format(params));
 267
 268         /* reject unmatched parameters when applying symmetry */
 269         symmetry = cpu_dai->driver->symmetric_rates ||
 270                 rtd->dai_link->symmetric_rates;
 271
 272         for (i = 0; i < rtd->num_codecs; i++)
 273                 symmetry |= rtd->codec_dais[i]->driver->symmetric_rates;
 274
 275         if (symmetry && cpu_dai->rate && cpu_dai->rate != rate) {
 276                 dev_err(rtd->dev, "ASoC: unmatched rate symmetry: %d - %d\n",
 277                                 cpu_dai->rate, rate);
 278                 return -EINVAL;
 279         }
 280
 281         symmetry = cpu_dai->driver->symmetric_channels ||
 282                 rtd->dai_link->symmetric_channels;
 283
 284         for (i = 0; i < rtd->num_codecs; i++)
 285                 symmetry |= rtd->codec_dais[i]->driver->symmetric_channels;
 286
 287         if (symmetry && cpu_dai->channels && cpu_dai->channels != channels) {
 288                 dev_err(rtd->dev, "ASoC: unmatched channel symmetry: %d - %d\n",
 289                                 cpu_dai->channels, channels);
 290                 return -EINVAL;
 291         }
 292
 293         symmetry = cpu_dai->driver->symmetric_samplebits ||
 294                 rtd->dai_link->symmetric_samplebits;
 295
 296         for (i = 0; i < rtd->num_codecs; i++)
 297                 symmetry |= rtd->codec_dais[i]->driver->symmetric_samplebits;
 298
 299         if (symmetry && cpu_dai->sample_bits && cpu_dai->sample_bits != sample_bits) {
 300                 dev_err(rtd->dev, "ASoC: unmatched sample bits symmetry: %d - %d\n",
 301                                 cpu_dai->sample_bits, sample_bits);
 302                 return -EINVAL;
 303         }
 304
 305         return 0;
 306 }
 307
 308 static bool soc_pcm_has_symmetry(struct snd_pcm_substream *substream)
 309 {
 310         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 311         struct snd_soc_dai_driver *cpu_driver = rtd->cpu_dai->driver;
 312         struct snd_soc_dai_link *link = rtd->dai_link;
 313         unsigned int symmetry, i;
 314
 315         symmetry = cpu_driver->symmetric_rates || link->symmetric_rates ||
 316                 cpu_driver->symmetric_channels || link->symmetric_channels ||
 317                 cpu_driver->symmetric_samplebits || link->symmetric_samplebits;
 318
 319         for (i = 0; i < rtd->num_codecs; i++)
 320                 symmetry = symmetry ||
 321                         rtd->codec_dais[i]->driver->symmetric_rates ||
 322                         rtd->codec_dais[i]->driver->symmetric_channels ||
 323                         rtd->codec_dais[i]->driver->symmetric_samplebits;
 324
 325         return symmetry;
 326 }
 327
 328 static void soc_pcm_set_msb(struct snd_pcm_substream *substream, int bits)
 329 {
 330         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 331         int ret;
 332
 333         if (!bits)
 334                 return;
 335
 336         ret = snd_pcm_hw_constraint_msbits(substream->runtime, 0, 0, bits);
 337         if (ret != 0)
 338                 dev_warn(rtd->dev, "ASoC: Failed to set MSB %d: %d\n",
 339                                  bits, ret);
 340 }
 341
 342 static void soc_pcm_apply_msb(struct snd_pcm_substream *substream)
 343 {
 344         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 345         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 346         struct snd_soc_dai *codec_dai;
 347         int i;
 348         unsigned int bits = 0, cpu_bits;
 349
 350         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 351                 for (i = 0; i < rtd->num_codecs; i++) {
 352                         codec_dai = rtd->codec_dais[i];
 353                         if (codec_dai->driver->playback.sig_bits == 0) {
 354                                 bits = 0;
 355                                 break;
 356                         }
 357                         bits = max(codec_dai->driver->playback.sig_bits, bits);
 358                 }
 359                 cpu_bits = cpu_dai->driver->playback.sig_bits;
 360         } else {
 361                 for (i = 0; i < rtd->num_codecs; i++) {
 362                         codec_dai = rtd->codec_dais[i];
 363                         if (codec_dai->driver->capture.sig_bits == 0) {
 364                                 bits = 0;
 365                                 break;
 366                         }
 367                         bits = max(codec_dai->driver->capture.sig_bits, bits);
 368                 }
 369                 cpu_bits = cpu_dai->driver->capture.sig_bits;
 370         }
 371
 372         soc_pcm_set_msb(substream, bits);
 373         soc_pcm_set_msb(substream, cpu_bits);
 374 }
 375
 376 static void soc_pcm_init_runtime_hw(struct snd_pcm_substream *substream)
 377 {
 378         struct snd_pcm_runtime *runtime = substream->runtime;
 379         struct snd_pcm_hardware *hw = &runtime->hw;
 380         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 381         struct snd_soc_dai_driver *cpu_dai_drv = rtd->cpu_dai->driver;
 382         struct snd_soc_dai_driver *codec_dai_drv;
 383         struct snd_soc_pcm_stream *codec_stream;
 384         struct snd_soc_pcm_stream *cpu_stream;
 385         unsigned int chan_min = 0, chan_max = UINT_MAX;
 386         unsigned int rate_min = 0, rate_max = UINT_MAX;
 387         unsigned int rates = UINT_MAX;
 388         u64 formats = ULLONG_MAX;
 389         int i;
 390
 391         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 392                 cpu_stream = &cpu_dai_drv->playback;
 393         else
 394                 cpu_stream = &cpu_dai_drv->capture;
 395
 396         /* first calculate min/max only for CODECs in the DAI link */
 397         for (i = 0; i < rtd->num_codecs; i++) {
 398
 399                 /*
 400                  * Skip CODECs which don't support the current stream type.
 401                  * Otherwise, since the rate, channel, and format values will
 402                  * zero in that case, we would have no usable settings left,
 403                  * causing the resulting setup to fail.
 404                  * At least one CODEC should match, otherwise we should have
 405                  * bailed out on a higher level, since there would be no
 406                  * CODEC to support the transfer direction in that case.
 407                  */
 408                 if (!snd_soc_dai_stream_valid(rtd->codec_dais[i],
 409                                               substream->stream))
 410                         continue;
 411
 412                 codec_dai_drv = rtd->codec_dais[i]->driver;
 413                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 414                         codec_stream = &codec_dai_drv->playback;
 415                 else
 416                         codec_stream = &codec_dai_drv->capture;
 417                 chan_min = max(chan_min, codec_stream->channels_min);
 418                 chan_max = min(chan_max, codec_stream->channels_max);
 419                 rate_min = max(rate_min, codec_stream->rate_min);
 420                 rate_max = min_not_zero(rate_max, codec_stream->rate_max);
 421                 formats &= codec_stream->formats;
 422                 rates = snd_pcm_rate_mask_intersect(codec_stream->rates, rates);
 423         }
 424
 425         /*
 426          * chan min/max cannot be enforced if there are multiple CODEC DAIs
 427          * connected to a single CPU DAI, use CPU DAI's directly and let
 428          * channel allocation be fixed up later
 429          */
 430         if (rtd->num_codecs > 1) {
 431                 chan_min = cpu_stream->channels_min;
 432                 chan_max = cpu_stream->channels_max;
 433         }
 434
 435         hw->channels_min = max(chan_min, cpu_stream->channels_min);
 436         hw->channels_max = min(chan_max, cpu_stream->channels_max);
 437         if (hw->formats)
 438                 hw->formats &= formats & cpu_stream->formats;
 439         else
 440                 hw->formats = formats & cpu_stream->formats;
 441         hw->rates = snd_pcm_rate_mask_intersect(rates, cpu_stream->rates);
 442
 443         snd_pcm_limit_hw_rates(runtime);
 444
 445         hw->rate_min = max(hw->rate_min, cpu_stream->rate_min);
 446         hw->rate_min = max(hw->rate_min, rate_min);
 447         hw->rate_max = min_not_zero(hw->rate_max, cpu_stream->rate_max);
 448         hw->rate_max = min_not_zero(hw->rate_max, rate_max);
 449 }
 450
 451 /*
 452  * Called by ALSA when a PCM substream is opened, the runtime->hw record is
 453  * then initialized and any private data can be allocated. This also calls
 454  * startup for the cpu DAI, component, machine and codec DAI.
 455  */
 456 static int soc_pcm_open(struct snd_pcm_substream *substream)
 457 {
 458         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 459         struct snd_pcm_runtime *runtime = substream->runtime;
 460         struct snd_soc_component *component;
 461         struct snd_soc_rtdcom_list *rtdcom;
 462         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 463         struct snd_soc_dai *codec_dai;
 464         const char *codec_dai_name = "multicodec";
 465         int i, ret = 0, __ret;
 466
 467         pinctrl_pm_select_default_state(cpu_dai->dev);
 468         for (i = 0; i < rtd->num_codecs; i++)
 469                 pinctrl_pm_select_default_state(rtd->codec_dais[i]->dev);
 470
 471         for_each_rtdcom(rtd, rtdcom) {
 472                 component = rtdcom->component;
 473
 474                 pm_runtime_get_sync(component->dev);
 475         }
 476
 477         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 478
 479         /* startup the audio subsystem */
 480         if (cpu_dai->driver->ops->startup) {
 481                 ret = cpu_dai->driver->ops->startup(substream, cpu_dai);
 482                 if (ret < 0) {
 483                         dev_err(cpu_dai->dev, "ASoC: can't open interface"
 484                                 " %s: %d\n", cpu_dai->name, ret);
 485                         goto out;
 486                 }
 487         }
 488
 489         ret = 0;
 490         for_each_rtdcom(rtd, rtdcom) {
 491                 component = rtdcom->component;
 492
 493                 if (!component->driver->ops ||
 494                     !component->driver->ops->open)
 495                         continue;
 496
 497                 __ret = component->driver->ops->open(substream);
 498                 if (__ret < 0) {
 499                         dev_err(component->dev,
 500                                 "ASoC: can't open component %s: %d\n",
 501                                 component->name, __ret);
 502                         ret = __ret;
 503                 }
 504         }
 505         if (ret < 0)
 506                 goto component_err;
 507
 508         for (i = 0; i < rtd->num_codecs; i++) {
 509                 codec_dai = rtd->codec_dais[i];
 510                 if (codec_dai->driver->ops->startup) {
 511                         ret = codec_dai->driver->ops->startup(substream,
 512                                                               codec_dai);
 513                         if (ret < 0) {
 514                                 dev_err(codec_dai->dev,
 515                                         "ASoC: can't open codec %s: %d\n",
 516                                         codec_dai->name, ret);
 517                                 goto codec_dai_err;
 518                         }
 519                 }
 520
 521                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 522                         codec_dai->tx_mask = 0;
 523                 else
 524                         codec_dai->rx_mask = 0;
 525         }
 526
 527         if (rtd->dai_link->ops->startup) {
 528                 ret = rtd->dai_link->ops->startup(substream);
 529                 if (ret < 0) {
 530                         pr_err("ASoC: %s startup failed: %d\n",
 531                                rtd->dai_link->name, ret);
 532                         goto machine_err;
 533                 }
 534         }
 535
 536         /* Dynamic PCM DAI links compat checks use dynamic capabilities */
 537         if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm)
 538                 goto dynamic;
 539
 540         /* Check that the codec and cpu DAIs are compatible */
 541         soc_pcm_init_runtime_hw(substream);
 542
 543         if (rtd->num_codecs == 1)
 544                 codec_dai_name = rtd->codec_dai->name;
 545
 546         if (soc_pcm_has_symmetry(substream))
 547                 runtime->hw.info |= SNDRV_PCM_INFO_JOINT_DUPLEX;
 548
 549         ret = -EINVAL;
 550         if (!runtime->hw.rates) {
 551                 printk(KERN_ERR "ASoC: %s <-> %s No matching rates\n",
 552                         codec_dai_name, cpu_dai->name);
 553                 goto config_err;
 554         }
 555         if (!runtime->hw.formats) {
 556                 printk(KERN_ERR "ASoC: %s <-> %s No matching formats\n",
 557                         codec_dai_name, cpu_dai->name);
 558                 goto config_err;
 559         }
 560         if (!runtime->hw.channels_min || !runtime->hw.channels_max ||
 561             runtime->hw.channels_min > runtime->hw.channels_max) {
 562                 printk(KERN_ERR "ASoC: %s <-> %s No matching channels\n",
 563                                 codec_dai_name, cpu_dai->name);
 564                 goto config_err;
 565         }
 566
 567         soc_pcm_apply_msb(substream);
 568
 569         /* Symmetry only applies if we've already got an active stream. */
 570         if (cpu_dai->active) {
 571                 ret = soc_pcm_apply_symmetry(substream, cpu_dai);
 572                 if (ret != 0)
 573                         goto config_err;
 574         }
 575
 576         for (i = 0; i < rtd->num_codecs; i++) {
 577                 if (rtd->codec_dais[i]->active) {
 578                         ret = soc_pcm_apply_symmetry(substream,
 579                                                      rtd->codec_dais[i]);
 580                         if (ret != 0)
 581                                 goto config_err;
 582                 }
 583         }
 584
 585         pr_debug("ASoC: %s <-> %s info:\n",
 586                         codec_dai_name, cpu_dai->name);
 587         pr_debug("ASoC: rate mask 0x%x\n", runtime->hw.rates);
 588         pr_debug("ASoC: min ch %d max ch %d\n", runtime->hw.channels_min,
 589                  runtime->hw.channels_max);
 590         pr_debug("ASoC: min rate %d max rate %d\n", runtime->hw.rate_min,
 591                  runtime->hw.rate_max);
 592
 593 dynamic:
 594
 595         snd_soc_runtime_activate(rtd, substream->stream);
 596
 597         mutex_unlock(&rtd->pcm_mutex);
 598         return 0;
 599
 600 config_err:
 601         if (rtd->dai_link->ops->shutdown)
 602                 rtd->dai_link->ops->shutdown(substream);
 603
 604 machine_err:
 605         i = rtd->num_codecs;
 606
 607 codec_dai_err:
 608         while (--i >= 0) {
 609                 codec_dai = rtd->codec_dais[i];
 610                 if (codec_dai->driver->ops->shutdown)
 611                         codec_dai->driver->ops->shutdown(substream, codec_dai);
 612         }
 613
 614 component_err:
 615         for_each_rtdcom(rtd, rtdcom) {
 616                 component = rtdcom->component;
 617
 618                 if (!component->driver->ops ||
 619                     !component->driver->ops->close)
 620                         continue;
 621
 622                 component->driver->ops->close(substream);
 623         }
 624
 625         if (cpu_dai->driver->ops->shutdown)
 626                 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
 627 out:
 628         mutex_unlock(&rtd->pcm_mutex);
 629
 630         for_each_rtdcom(rtd, rtdcom) {
 631                 component = rtdcom->component;
 632
 633                 pm_runtime_mark_last_busy(component->dev);
 634                 pm_runtime_put_autosuspend(component->dev);
 635         }
 636
 637         for (i = 0; i < rtd->num_codecs; i++) {
 638                 if (!rtd->codec_dais[i]->active)
 639                         pinctrl_pm_select_sleep_state(rtd->codec_dais[i]->dev);
 640         }
 641         if (!cpu_dai->active)
 642                 pinctrl_pm_select_sleep_state(cpu_dai->dev);
 643
 644         return ret;
 645 }
 646
 647 /*
 648  * Power down the audio subsystem pmdown_time msecs after close is called.
 649  * This is to ensure there are no pops or clicks in between any music tracks
 650  * due to DAPM power cycling.
 651  */
 652 static void close_delayed_work(struct work_struct *work)
 653 {
 654         struct snd_soc_pcm_runtime *rtd =
 655                         container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
 656         struct snd_soc_dai *codec_dai = rtd->codec_dais[0];
 657
 658         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 659
 660         dev_dbg(rtd->dev, "ASoC: pop wq checking: %s status: %s waiting: %s\n",
 661                  codec_dai->driver->playback.stream_name,
 662                  codec_dai->playback_active ? "active" : "inactive",
 663                  rtd->pop_wait ? "yes" : "no");
 664
 665         /* are we waiting on this codec DAI stream */
 666         if (rtd->pop_wait == 1) {
 667                 rtd->pop_wait = 0;
 668                 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
 669                                           SND_SOC_DAPM_STREAM_STOP);
 670         }
 671
 672         mutex_unlock(&rtd->pcm_mutex);
 673 }
 674
 675 /*
 676  * Called by ALSA when a PCM substream is closed. Private data can be
 677  * freed here. The cpu DAI, codec DAI, machine and components are also
 678  * shutdown.
 679  */
 680 static int soc_pcm_close(struct snd_pcm_substream *substream)
 681 {
 682         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 683         struct snd_soc_component *component;
 684         struct snd_soc_rtdcom_list *rtdcom;
 685         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 686         struct snd_soc_dai *codec_dai;
 687         int i;
 688
 689         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 690
 691         snd_soc_runtime_deactivate(rtd, substream->stream);
 692
 693         /* clear the corresponding DAIs rate when inactive */
 694         if (!cpu_dai->active)
 695                 cpu_dai->rate = 0;
 696
 697         for (i = 0; i < rtd->num_codecs; i++) {
 698                 codec_dai = rtd->codec_dais[i];
 699                 if (!codec_dai->active)
 700                         codec_dai->rate = 0;
 701         }
 702
 703         snd_soc_dai_digital_mute(cpu_dai, 1, substream->stream);
 704
 705         if (cpu_dai->driver->ops->shutdown)
 706                 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
 707
 708         for (i = 0; i < rtd->num_codecs; i++) {
 709                 codec_dai = rtd->codec_dais[i];
 710                 if (codec_dai->driver->ops->shutdown)
 711                         codec_dai->driver->ops->shutdown(substream, codec_dai);
 712         }
 713
 714         if (rtd->dai_link->ops->shutdown)
 715                 rtd->dai_link->ops->shutdown(substream);
 716
 717         for_each_rtdcom(rtd, rtdcom) {
 718                 component = rtdcom->component;
 719
 720                 if (!component->driver->ops ||
 721                     !component->driver->ops->close)
 722                         continue;
 723
 724                 component->driver->ops->close(substream);
 725         }
 726
 727         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 728                 if (snd_soc_runtime_ignore_pmdown_time(rtd)) {
 729                         /* powered down playback stream now */
 730                         snd_soc_dapm_stream_event(rtd,
 731                                                   SNDRV_PCM_STREAM_PLAYBACK,
 732                                                   SND_SOC_DAPM_STREAM_STOP);
 733                 } else {
 734                         /* start delayed pop wq here for playback streams */
 735                         rtd->pop_wait = 1;
 736                         queue_delayed_work(system_power_efficient_wq,
 737                                            &rtd->delayed_work,
 738                                            msecs_to_jiffies(rtd->pmdown_time));
 739                 }
 740         } else {
 741                 /* capture streams can be powered down now */
 742                 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_CAPTURE,
 743                                           SND_SOC_DAPM_STREAM_STOP);
 744         }
 745
 746         mutex_unlock(&rtd->pcm_mutex);
 747
 748         for_each_rtdcom(rtd, rtdcom) {
 749                 component = rtdcom->component;
 750
 751                 pm_runtime_mark_last_busy(component->dev);
 752                 pm_runtime_put_autosuspend(component->dev);
 753         }
 754
 755         for (i = 0; i < rtd->num_codecs; i++) {
 756                 if (!rtd->codec_dais[i]->active)
 757                         pinctrl_pm_select_sleep_state(rtd->codec_dais[i]->dev);
 758         }
 759         if (!cpu_dai->active)
 760                 pinctrl_pm_select_sleep_state(cpu_dai->dev);
 761
 762         return 0;
 763 }
 764
 765 /*
 766  * Called by ALSA when the PCM substream is prepared, can set format, sample
 767  * rate, etc.  This function is non atomic and can be called multiple times,
 768  * it can refer to the runtime info.
 769  */
 770 static int soc_pcm_prepare(struct snd_pcm_substream *substream)
 771 {
 772         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 773         struct snd_soc_component *component;
 774         struct snd_soc_rtdcom_list *rtdcom;
 775         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 776         struct snd_soc_dai *codec_dai;
 777         int i, ret = 0;
 778
 779         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 780
 781         if (rtd->dai_link->ops->prepare) {
 782                 ret = rtd->dai_link->ops->prepare(substream);
 783                 if (ret < 0) {
 784                         dev_err(rtd->card->dev, "ASoC: machine prepare error:"
 785                                 " %d\n", ret);
 786                         goto out;
 787                 }
 788         }
 789
 790         for_each_rtdcom(rtd, rtdcom) {
 791                 component = rtdcom->component;
 792
 793                 if (!component->driver->ops ||
 794                     !component->driver->ops->prepare)
 795                         continue;
 796
 797                 ret = component->driver->ops->prepare(substream);
 798                 if (ret < 0) {
 799                         dev_err(component->dev,
 800                                 "ASoC: platform prepare error: %d\n", ret);
 801                         goto out;
 802                 }
 803         }
 804
 805         for (i = 0; i < rtd->num_codecs; i++) {
 806                 codec_dai = rtd->codec_dais[i];
 807                 if (codec_dai->driver->ops->prepare) {
 808                         ret = codec_dai->driver->ops->prepare(substream,
 809                                                               codec_dai);
 810                         if (ret < 0) {
 811                                 dev_err(codec_dai->dev,
 812                                         "ASoC: codec DAI prepare error: %d\n",
 813                                         ret);
 814                                 goto out;
 815                         }
 816                 }
 817         }
 818
 819         if (cpu_dai->driver->ops->prepare) {
 820                 ret = cpu_dai->driver->ops->prepare(substream, cpu_dai);
 821                 if (ret < 0) {
 822                         dev_err(cpu_dai->dev,
 823                                 "ASoC: cpu DAI prepare error: %d\n", ret);
 824                         goto out;
 825                 }
 826         }
 827
 828         /* cancel any delayed stream shutdown that is pending */
 829         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
 830             rtd->pop_wait) {
 831                 rtd->pop_wait = 0;
 832                 cancel_delayed_work(&rtd->delayed_work);
 833         }
 834
 835         snd_soc_dapm_stream_event(rtd, substream->stream,
 836                         SND_SOC_DAPM_STREAM_START);
 837
 838         for (i = 0; i < rtd->num_codecs; i++)
 839                 snd_soc_dai_digital_mute(rtd->codec_dais[i], 0,
 840                                          substream->stream);
 841         snd_soc_dai_digital_mute(cpu_dai, 0, substream->stream);
 842
 843 out:
 844         mutex_unlock(&rtd->pcm_mutex);
 845         return ret;
 846 }
 847
 848 static void soc_pcm_codec_params_fixup(struct snd_pcm_hw_params *params,
 849                                        unsigned int mask)
 850 {
 851         struct snd_interval *interval;
 852         int channels = hweight_long(mask);
 853
 854         interval = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
 855         interval->min = channels;
 856         interval->max = channels;
 857 }
 858
 859 int soc_dai_hw_params(struct snd_pcm_substream *substream,
 860                       struct snd_pcm_hw_params *params,
 861                       struct snd_soc_dai *dai)
 862 {
 863         int ret;
 864
 865         if (dai->driver->ops->hw_params) {
 866                 ret = dai->driver->ops->hw_params(substream, params, dai);
 867                 if (ret < 0) {
 868                         dev_err(dai->dev, "ASoC: can't set %s hw params: %d\n",
 869                                 dai->name, ret);
 870                         return ret;
 871                 }
 872         }
 873
 874         return 0;
 875 }
 876
 877 /*
 878  * Called by ALSA when the hardware params are set by application. This
 879  * function can also be called multiple times and can allocate buffers
 880  * (using snd_pcm_lib_* ). It's non-atomic.
 881  */
 882 static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
 883                                 struct snd_pcm_hw_params *params)
 884 {
 885         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 886         struct snd_soc_component *component;
 887         struct snd_soc_rtdcom_list *rtdcom;
 888         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 889         int i, ret = 0, __ret;
 890
 891         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 892         if (rtd->dai_link->ops->hw_params) {
 893                 ret = rtd->dai_link->ops->hw_params(substream, params);
 894                 if (ret < 0) {
 895                         dev_err(rtd->card->dev, "ASoC: machine hw_params"
 896                                 " failed: %d\n", ret);
 897                         goto out;
 898                 }
 899         }
 900
 901         for (i = 0; i < rtd->num_codecs; i++) {
 902                 struct snd_soc_dai *codec_dai = rtd->codec_dais[i];
 903                 struct snd_pcm_hw_params codec_params;
 904
 905                 /*
 906                  * Skip CODECs which don't support the current stream type,
 907                  * the idea being that if a CODEC is not used for the currently
 908                  * set up transfer direction, it should not need to be
 909                  * configured, especially since the configuration used might
 910                  * not even be supported by that CODEC. There may be cases
 911                  * however where a CODEC needs to be set up although it is
 912                  * actually not being used for the transfer, e.g. if a
 913                  * capture-only CODEC is acting as an LRCLK and/or BCLK master
 914                  * for the DAI link including a playback-only CODEC.
 915                  * If this becomes necessary, we will have to augment the
 916                  * machine driver setup with information on how to act, so
 917                  * we can do the right thing here.
 918                  */
 919                 if (!snd_soc_dai_stream_valid(codec_dai, substream->stream))
 920                         continue;
 921
 922                 /* copy params for each codec */
 923                 codec_params = *params;
 924
 925                 /* fixup params based on TDM slot masks */
 926                 if (codec_dai->tx_mask)
 927                         soc_pcm_codec_params_fixup(&codec_params,
 928                                                    codec_dai->tx_mask);
 929                 if (codec_dai->rx_mask)
 930                         soc_pcm_codec_params_fixup(&codec_params,
 931                                                    codec_dai->rx_mask);
 932
 933                 ret = soc_dai_hw_params(substream, &codec_params, codec_dai);
 934                 if(ret < 0)
 935                         goto codec_err;
 936
 937                 codec_dai->rate = params_rate(&codec_params);
 938                 codec_dai->channels = params_channels(&codec_params);
 939                 codec_dai->sample_bits = snd_pcm_format_physical_width(
 940                                                 params_format(&codec_params));
 941         }
 942
 943         ret = soc_dai_hw_params(substream, params, cpu_dai);
 944         if (ret < 0)
 945                 goto interface_err;
 946
 947         ret = 0;
 948         for_each_rtdcom(rtd, rtdcom) {
 949                 component = rtdcom->component;
 950
 951                 if (!component->driver->ops ||
 952                     !component->driver->ops->hw_params)
 953                         continue;
 954
 955                 __ret = component->driver->ops->hw_params(substream, params);
 956                 if (__ret < 0) {
 957                         dev_err(component->dev,
 958                                 "ASoC: %s hw params failed: %d\n",
 959                                 component->name, __ret);
 960                         ret = __ret;
 961                 }
 962         }
 963         if (ret < 0)
 964                 goto component_err;
 965
 966         /* store the parameters for each DAIs */
 967         cpu_dai->rate = params_rate(params);
 968         cpu_dai->channels = params_channels(params);
 969         cpu_dai->sample_bits =
 970                 snd_pcm_format_physical_width(params_format(params));
 971
 972         ret = soc_pcm_params_symmetry(substream, params);
 973         if (ret)
 974                 goto component_err;
 975 out:
 976         mutex_unlock(&rtd->pcm_mutex);
 977         return ret;
 978
 979 component_err:
 980         for_each_rtdcom(rtd, rtdcom) {
 981                 component = rtdcom->component;
 982
 983                 if (!component->driver->ops ||
 984                     !component->driver->ops->hw_free)
 985                         continue;
 986
 987                 component->driver->ops->hw_free(substream);
 988         }
 989
 990         if (cpu_dai->driver->ops->hw_free)
 991                 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
 992
 993 interface_err:
 994         i = rtd->num_codecs;
 995
 996 codec_err:
 997         while (--i >= 0) {
 998                 struct snd_soc_dai *codec_dai = rtd->codec_dais[i];
 999                 if (codec_dai->driver->ops->hw_free)
1000                         codec_dai->driver->ops->hw_free(substream, codec_dai);
1001                 codec_dai->rate = 0;
1002         }
1003
1004         if (rtd->dai_link->ops->hw_free)
1005                 rtd->dai_link->ops->hw_free(substream);
1006
1007         mutex_unlock(&rtd->pcm_mutex);
1008         return ret;
1009 }
1010
1011 /*
1012  * Frees resources allocated by hw_params, can be called multiple times
1013  */
1014 static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
1015 {
1016         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1017         struct snd_soc_component *component;
1018         struct snd_soc_rtdcom_list *rtdcom;
1019         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1020         struct snd_soc_dai *codec_dai;
1021         bool playback = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
1022         int i;
1023
1024         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
1025
1026         /* clear the corresponding DAIs parameters when going to be inactive */
1027         if (cpu_dai->active == 1) {
1028                 cpu_dai->rate = 0;
1029                 cpu_dai->channels = 0;
1030                 cpu_dai->sample_bits = 0;
1031         }
1032
1033         for (i = 0; i < rtd->num_codecs; i++) {
1034                 codec_dai = rtd->codec_dais[i];
1035                 if (codec_dai->active == 1) {
1036                         codec_dai->rate = 0;
1037                         codec_dai->channels = 0;
1038                         codec_dai->sample_bits = 0;
1039                 }
1040         }
1041
1042         /* apply codec digital mute */
1043         for (i = 0; i < rtd->num_codecs; i++) {
1044                 if ((playback && rtd->codec_dais[i]->playback_active == 1) ||
1045                     (!playback && rtd->codec_dais[i]->capture_active == 1))
1046                         snd_soc_dai_digital_mute(rtd->codec_dais[i], 1,
1047                                                  substream->stream);
1048         }
1049
1050         /* free any machine hw params */
1051         if (rtd->dai_link->ops->hw_free)
1052                 rtd->dai_link->ops->hw_free(substream);
1053
1054         /* free any component resources */
1055         for_each_rtdcom(rtd, rtdcom) {
1056                 component = rtdcom->component;
1057
1058                 if (!component->driver->ops ||
1059                     !component->driver->ops->hw_free)
1060                         continue;
1061
1062                 component->driver->ops->hw_free(substream);
1063         }
1064
1065         /* now free hw params for the DAIs  */
1066         for (i = 0; i < rtd->num_codecs; i++) {
1067                 codec_dai = rtd->codec_dais[i];
1068                 if (codec_dai->driver->ops->hw_free)
1069                         codec_dai->driver->ops->hw_free(substream, codec_dai);
1070         }
1071
1072         if (cpu_dai->driver->ops->hw_free)
1073                 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
1074
1075         mutex_unlock(&rtd->pcm_mutex);
1076         return 0;
1077 }
1078
1079 static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
1080 {
1081         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1082         struct snd_soc_component *component;
1083         struct snd_soc_rtdcom_list *rtdcom;
1084         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1085         struct snd_soc_dai *codec_dai;
1086         int i, ret;
1087
1088         for (i = 0; i < rtd->num_codecs; i++) {
1089                 codec_dai = rtd->codec_dais[i];
1090                 if (codec_dai->driver->ops->trigger) {
1091                         ret = codec_dai->driver->ops->trigger(substream,
1092                                                               cmd, codec_dai);
1093                         if (ret < 0)
1094                                 return ret;
1095                 }
1096         }
1097
1098         for_each_rtdcom(rtd, rtdcom) {
1099                 component = rtdcom->component;
1100
1101                 if (!component->driver->ops ||
1102                     !component->driver->ops->trigger)
1103                         continue;
1104
1105                 ret = component->driver->ops->trigger(substream, cmd);
1106                 if (ret < 0)
1107                         return ret;
1108         }
1109
1110         if (cpu_dai->driver->ops->trigger) {
1111                 ret = cpu_dai->driver->ops->trigger(substream, cmd, cpu_dai);
1112                 if (ret < 0)
1113                         return ret;
1114         }
1115
1116         if (rtd->dai_link->ops->trigger) {
1117                 ret = rtd->dai_link->ops->trigger(substream, cmd);
1118                 if (ret < 0)
1119                         return ret;
1120         }
1121
1122         return 0;
1123 }
1124
1125 static int soc_pcm_bespoke_trigger(struct snd_pcm_substream *substream,
1126                                    int cmd)
1127 {
1128         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1129         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1130         struct snd_soc_dai *codec_dai;
1131         int i, ret;
1132
1133         for (i = 0; i < rtd->num_codecs; i++) {
1134                 codec_dai = rtd->codec_dais[i];
1135                 if (codec_dai->driver->ops->bespoke_trigger) {
1136                         ret = codec_dai->driver->ops->bespoke_trigger(substream,
1137                                                                 cmd, codec_dai);
1138                         if (ret < 0)
1139                                 return ret;
1140                 }
1141         }
1142
1143         if (cpu_dai->driver->ops->bespoke_trigger) {
1144                 ret = cpu_dai->driver->ops->bespoke_trigger(substream, cmd, cpu_dai);
1145                 if (ret < 0)
1146                         return ret;
1147         }
1148         return 0;
1149 }
1150 /*
1151  * soc level wrapper for pointer callback
1152  * If cpu_dai, codec_dai, component driver has the delay callback, then
1153  * the runtime->delay will be updated accordingly.
1154  */
1155 static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream)
1156 {
1157         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1158         struct snd_soc_component *component;
1159         struct snd_soc_rtdcom_list *rtdcom;
1160         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1161         struct snd_soc_dai *codec_dai;
1162         struct snd_pcm_runtime *runtime = substream->runtime;
1163         snd_pcm_uframes_t offset = 0;
1164         snd_pcm_sframes_t delay = 0;
1165         snd_pcm_sframes_t codec_delay = 0;
1166         int i;
1167
1168         for_each_rtdcom(rtd, rtdcom) {
1169                 component = rtdcom->component;
1170
1171                 if (!component->driver->ops ||
1172                     !component->driver->ops->pointer)
1173                         continue;
1174
1175                 /* FIXME: use 1st pointer */
1176                 offset = component->driver->ops->pointer(substream);
1177                 break;
1178         }
1179
1180         if (cpu_dai->driver->ops->delay)
1181                 delay += cpu_dai->driver->ops->delay(substream, cpu_dai);
1182
1183         for (i = 0; i < rtd->num_codecs; i++) {
1184                 codec_dai = rtd->codec_dais[i];
1185                 if (codec_dai->driver->ops->delay)
1186                         codec_delay = max(codec_delay,
1187                                         codec_dai->driver->ops->delay(substream,
1188                                                                     codec_dai));
1189         }
1190         delay += codec_delay;
1191
1192         runtime->delay = delay;
1193
1194         return offset;
1195 }
1196
1197 /* connect a FE and BE */
1198 static int dpcm_be_connect(struct snd_soc_pcm_runtime *fe,
1199                 struct snd_soc_pcm_runtime *be, int stream)
1200 {
1201         struct snd_soc_dpcm *dpcm;
1202
1203         /* only add new dpcms */
1204         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1205                 if (dpcm->be == be && dpcm->fe == fe)
1206                         return 0;
1207         }
1208
1209         dpcm = kzalloc(sizeof(struct snd_soc_dpcm), GFP_KERNEL);
1210         if (!dpcm)
1211                 return -ENOMEM;
1212
1213         dpcm->be = be;
1214         dpcm->fe = fe;
1215         be->dpcm[stream].runtime = fe->dpcm[stream].runtime;
1216         dpcm->state = SND_SOC_DPCM_LINK_STATE_NEW;
1217         list_add(&dpcm->list_be, &fe->dpcm[stream].be_clients);
1218         list_add(&dpcm->list_fe, &be->dpcm[stream].fe_clients);
1219
1220         dev_dbg(fe->dev, "connected new DPCM %s path %s %s %s\n",
1221                         stream ? "capture" : "playback",  fe->dai_link->name,
1222                         stream ? "<-" : "->", be->dai_link->name);
1223
1224 #ifdef CONFIG_DEBUG_FS
1225         if (fe->debugfs_dpcm_root)
1226                 dpcm->debugfs_state = debugfs_create_u32(be->dai_link->name, 0644,
1227                                 fe->debugfs_dpcm_root, &dpcm->state);
1228 #endif
1229         return 1;
1230 }
1231
1232 /* reparent a BE onto another FE */
1233 static void dpcm_be_reparent(struct snd_soc_pcm_runtime *fe,
1234                         struct snd_soc_pcm_runtime *be, int stream)
1235 {
1236         struct snd_soc_dpcm *dpcm;
1237         struct snd_pcm_substream *fe_substream, *be_substream;
1238
1239         /* reparent if BE is connected to other FEs */
1240         if (!be->dpcm[stream].users)
1241                 return;
1242
1243         be_substream = snd_soc_dpcm_get_substream(be, stream);
1244
1245         list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
1246                 if (dpcm->fe == fe)
1247                         continue;
1248
1249                 dev_dbg(fe->dev, "reparent %s path %s %s %s\n",
1250                         stream ? "capture" : "playback",
1251                         dpcm->fe->dai_link->name,
1252                         stream ? "<-" : "->", dpcm->be->dai_link->name);
1253
1254                 fe_substream = snd_soc_dpcm_get_substream(dpcm->fe, stream);
1255                 be_substream->runtime = fe_substream->runtime;
1256                 break;
1257         }
1258 }
1259
1260 /* disconnect a BE and FE */
1261 void dpcm_be_disconnect(struct snd_soc_pcm_runtime *fe, int stream)
1262 {
1263         struct snd_soc_dpcm *dpcm, *d;
1264
1265         list_for_each_entry_safe(dpcm, d, &fe->dpcm[stream].be_clients, list_be) {
1266                 dev_dbg(fe->dev, "ASoC: BE %s disconnect check for %s\n",
1267                                 stream ? "capture" : "playback",
1268                                 dpcm->be->dai_link->name);
1269
1270                 if (dpcm->state != SND_SOC_DPCM_LINK_STATE_FREE)
1271                         continue;
1272
1273                 dev_dbg(fe->dev, "freed DSP %s path %s %s %s\n",
1274                         stream ? "capture" : "playback", fe->dai_link->name,
1275                         stream ? "<-" : "->", dpcm->be->dai_link->name);
1276
1277                 /* BEs still alive need new FE */
1278                 dpcm_be_reparent(fe, dpcm->be, stream);
1279
1280 #ifdef CONFIG_DEBUG_FS
1281                 debugfs_remove(dpcm->debugfs_state);
1282 #endif
1283                 list_del(&dpcm->list_be);
1284                 list_del(&dpcm->list_fe);
1285                 kfree(dpcm);
1286         }
1287 }
1288
1289 /* get BE for DAI widget and stream */
1290 static struct snd_soc_pcm_runtime *dpcm_get_be(struct snd_soc_card *card,
1291                 struct snd_soc_dapm_widget *widget, int stream)
1292 {
1293         struct snd_soc_pcm_runtime *be;
1294         int i;
1295
1296         dev_dbg(card->dev, "ASoC: find BE for widget %s\n", widget->name);
1297
1298         if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1299                 list_for_each_entry(be, &card->rtd_list, list) {
1300
1301                         if (!be->dai_link->no_pcm)
1302                                 continue;
1303
1304                         dev_dbg(card->dev, "ASoC: try BE : %s\n",
1305                                 be->cpu_dai->playback_widget ?
1306                                 be->cpu_dai->playback_widget->name : "(not set)");
1307
1308                         if (be->cpu_dai->playback_widget == widget)
1309                                 return be;
1310
1311                         for (i = 0; i < be->num_codecs; i++) {
1312                                 struct snd_soc_dai *dai = be->codec_dais[i];
1313                                 if (dai->playback_widget == widget)
1314                                         return be;
1315                         }
1316                 }
1317         } else {
1318
1319                 list_for_each_entry(be, &card->rtd_list, list) {
1320
1321                         if (!be->dai_link->no_pcm)
1322                                 continue;
1323
1324                         dev_dbg(card->dev, "ASoC: try BE %s\n",
1325                                 be->cpu_dai->capture_widget ?
1326                                 be->cpu_dai->capture_widget->name : "(not set)");
1327
1328                         if (be->cpu_dai->capture_widget == widget)
1329                                 return be;
1330
1331                         for (i = 0; i < be->num_codecs; i++) {
1332                                 struct snd_soc_dai *dai = be->codec_dais[i];
1333                                 if (dai->capture_widget == widget)
1334                                         return be;
1335                         }
1336                 }
1337         }
1338
1339         /* dai link name and stream name set correctly ? */
1340         dev_err(card->dev, "ASoC: can't get %s BE for %s\n",
1341                 stream ? "capture" : "playback", widget->name);
1342         return NULL;
1343 }
1344
1345 static inline struct snd_soc_dapm_widget *
1346         dai_get_widget(struct snd_soc_dai *dai, int stream)
1347 {
1348         if (stream == SNDRV_PCM_STREAM_PLAYBACK)
1349                 return dai->playback_widget;
1350         else
1351                 return dai->capture_widget;
1352 }
1353
1354 static int widget_in_list(struct snd_soc_dapm_widget_list *list,
1355                 struct snd_soc_dapm_widget *widget)
1356 {
1357         int i;
1358
1359         for (i = 0; i < list->num_widgets; i++) {
1360                 if (widget == list->widgets[i])
1361                         return 1;
1362         }
1363
1364         return 0;
1365 }
1366
1367 static bool dpcm_end_walk_at_be(struct snd_soc_dapm_widget *widget,
1368                 enum snd_soc_dapm_direction dir)
1369 {
1370         struct snd_soc_card *card = widget->dapm->card;
1371         struct snd_soc_pcm_runtime *rtd;
1372         int i;
1373
1374         if (dir == SND_SOC_DAPM_DIR_OUT) {
1375                 list_for_each_entry(rtd, &card->rtd_list, list) {
1376                         if (!rtd->dai_link->no_pcm)
1377                                 continue;
1378
1379                         if (rtd->cpu_dai->playback_widget == widget)
1380                                 return true;
1381
1382                         for (i = 0; i < rtd->num_codecs; ++i) {
1383                                 struct snd_soc_dai *dai = rtd->codec_dais[i];
1384                                 if (dai->playback_widget == widget)
1385                                         return true;
1386                         }
1387                 }
1388         } else { /* SND_SOC_DAPM_DIR_IN */
1389                 list_for_each_entry(rtd, &card->rtd_list, list) {
1390                         if (!rtd->dai_link->no_pcm)
1391                                 continue;
1392
1393                         if (rtd->cpu_dai->capture_widget == widget)
1394                                 return true;
1395
1396                         for (i = 0; i < rtd->num_codecs; ++i) {
1397                                 struct snd_soc_dai *dai = rtd->codec_dais[i];
1398                                 if (dai->capture_widget == widget)
1399                                         return true;
1400                         }
1401                 }
1402         }
1403
1404         return false;
1405 }
1406
1407 int dpcm_path_get(struct snd_soc_pcm_runtime *fe,
1408         int stream, struct snd_soc_dapm_widget_list **list)
1409 {
1410         struct snd_soc_dai *cpu_dai = fe->cpu_dai;
1411         int paths;
1412
1413         /* get number of valid DAI paths and their widgets */
1414         paths = snd_soc_dapm_dai_get_connected_widgets(cpu_dai, stream, list,
1415                         dpcm_end_walk_at_be);
1416
1417         dev_dbg(fe->dev, "ASoC: found %d audio %s paths\n", paths,
1418                         stream ? "capture" : "playback");
1419
1420         return paths;
1421 }
1422
1423 static int dpcm_prune_paths(struct snd_soc_pcm_runtime *fe, int stream,
1424         struct snd_soc_dapm_widget_list **list_)
1425 {
1426         struct snd_soc_dpcm *dpcm;
1427         struct snd_soc_dapm_widget_list *list = *list_;
1428         struct snd_soc_dapm_widget *widget;
1429         int prune = 0;
1430
1431         /* Destroy any old FE <--> BE connections */
1432         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1433                 unsigned int i;
1434
1435                 /* is there a valid CPU DAI widget for this BE */
1436                 widget = dai_get_widget(dpcm->be->cpu_dai, stream);
1437
1438                 /* prune the BE if it's no longer in our active list */
1439                 if (widget && widget_in_list(list, widget))
1440                         continue;
1441
1442                 /* is there a valid CODEC DAI widget for this BE */
1443                 for (i = 0; i < dpcm->be->num_codecs; i++) {
1444                         struct snd_soc_dai *dai = dpcm->be->codec_dais[i];
1445                         widget = dai_get_widget(dai, stream);
1446
1447                         /* prune the BE if it's no longer in our active list */
1448                         if (widget && widget_in_list(list, widget))
1449                                 continue;
1450                 }
1451
1452                 dev_dbg(fe->dev, "ASoC: pruning %s BE %s for %s\n",
1453                         stream ? "capture" : "playback",
1454                         dpcm->be->dai_link->name, fe->dai_link->name);
1455                 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
1456                 dpcm->be->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
1457                 prune++;
1458         }
1459
1460         dev_dbg(fe->dev, "ASoC: found %d old BE paths for pruning\n", prune);
1461         return prune;
1462 }
1463
1464 static int dpcm_add_paths(struct snd_soc_pcm_runtime *fe, int stream,
1465         struct snd_soc_dapm_widget_list **list_)
1466 {
1467         struct snd_soc_card *card = fe->card;
1468         struct snd_soc_dapm_widget_list *list = *list_;
1469         struct snd_soc_pcm_runtime *be;
1470         int i, new = 0, err;
1471
1472         /* Create any new FE <--> BE connections */
1473         for (i = 0; i < list->num_widgets; i++) {
1474
1475                 switch (list->widgets[i]->id) {
1476                 case snd_soc_dapm_dai_in:
1477                         if (stream != SNDRV_PCM_STREAM_PLAYBACK)
1478                                 continue;
1479                         break;
1480                 case snd_soc_dapm_dai_out:
1481                         if (stream != SNDRV_PCM_STREAM_CAPTURE)
1482                                 continue;
1483                         break;
1484                 default:
1485                         continue;
1486                 }
1487
1488                 /* is there a valid BE rtd for this widget */
1489                 be = dpcm_get_be(card, list->widgets[i], stream);
1490                 if (!be) {
1491                         dev_err(fe->dev, "ASoC: no BE found for %s\n",
1492                                         list->widgets[i]->name);
1493                         continue;
1494                 }
1495
1496                 /* make sure BE is a real BE */
1497                 if (!be->dai_link->no_pcm)
1498                         continue;
1499
1500                 /* don't connect if FE is not running */
1501                 if (!fe->dpcm[stream].runtime && !fe->fe_compr)
1502                         continue;
1503
1504                 /* newly connected FE and BE */
1505                 err = dpcm_be_connect(fe, be, stream);
1506                 if (err < 0) {
1507                         dev_err(fe->dev, "ASoC: can't connect %s\n",
1508                                 list->widgets[i]->name);
1509                         break;
1510                 } else if (err == 0) /* already connected */
1511                         continue;
1512
1513                 /* new */
1514                 be->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_BE;
1515                 new++;
1516         }
1517
1518         dev_dbg(fe->dev, "ASoC: found %d new BE paths\n", new);
1519         return new;
1520 }
1521
1522 /*
1523  * Find the corresponding BE DAIs that source or sink audio to this
1524  * FE substream.
1525  */
1526 int dpcm_process_paths(struct snd_soc_pcm_runtime *fe,
1527         int stream, struct snd_soc_dapm_widget_list **list, int new)
1528 {
1529         if (new)
1530                 return dpcm_add_paths(fe, stream, list);
1531         else
1532                 return dpcm_prune_paths(fe, stream, list);
1533 }
1534
1535 void dpcm_clear_pending_state(struct snd_soc_pcm_runtime *fe, int stream)
1536 {
1537         struct snd_soc_dpcm *dpcm;
1538
1539         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
1540                 dpcm->be->dpcm[stream].runtime_update =
1541                                                 SND_SOC_DPCM_UPDATE_NO;
1542 }
1543
1544 static void dpcm_be_dai_startup_unwind(struct snd_soc_pcm_runtime *fe,
1545         int stream)
1546 {
1547         struct snd_soc_dpcm *dpcm;
1548
1549         /* disable any enabled and non active backends */
1550         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1551
1552                 struct snd_soc_pcm_runtime *be = dpcm->be;
1553                 struct snd_pcm_substream *be_substream =
1554                         snd_soc_dpcm_get_substream(be, stream);
1555
1556                 if (be->dpcm[stream].users == 0)
1557                         dev_err(be->dev, "ASoC: no users %s at close - state %d\n",
1558                                 stream ? "capture" : "playback",
1559                                 be->dpcm[stream].state);
1560
1561                 if (--be->dpcm[stream].users != 0)
1562                         continue;
1563
1564                 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN)
1565                         continue;
1566
1567                 soc_pcm_close(be_substream);
1568                 be_substream->runtime = NULL;
1569                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1570         }
1571 }
1572
1573 int dpcm_be_dai_startup(struct snd_soc_pcm_runtime *fe, int stream)
1574 {
1575         struct snd_soc_dpcm *dpcm;
1576         int err, count = 0;
1577
1578         /* only startup BE DAIs that are either sinks or sources to this FE DAI */
1579         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1580
1581                 struct snd_soc_pcm_runtime *be = dpcm->be;
1582                 struct snd_pcm_substream *be_substream =
1583                         snd_soc_dpcm_get_substream(be, stream);
1584
1585                 if (!be_substream) {
1586                         dev_err(be->dev, "ASoC: no backend %s stream\n",
1587                                 stream ? "capture" : "playback");
1588                         continue;
1589                 }
1590
1591                 /* is this op for this BE ? */
1592                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1593                         continue;
1594
1595                 /* first time the dpcm is open ? */
1596                 if (be->dpcm[stream].users == DPCM_MAX_BE_USERS)
1597                         dev_err(be->dev, "ASoC: too many users %s at open %d\n",
1598                                 stream ? "capture" : "playback",
1599                                 be->dpcm[stream].state);
1600
1601                 if (be->dpcm[stream].users++ != 0)
1602                         continue;
1603
1604                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_NEW) &&
1605                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_CLOSE))
1606                         continue;
1607
1608                 dev_dbg(be->dev, "ASoC: open %s BE %s\n",
1609                         stream ? "capture" : "playback", be->dai_link->name);
1610
1611                 be_substream->runtime = be->dpcm[stream].runtime;
1612                 err = soc_pcm_open(be_substream);
1613                 if (err < 0) {
1614                         dev_err(be->dev, "ASoC: BE open failed %d\n", err);
1615                         be->dpcm[stream].users--;
1616                         if (be->dpcm[stream].users < 0)
1617                                 dev_err(be->dev, "ASoC: no users %s at unwind %d\n",
1618                                         stream ? "capture" : "playback",
1619                                         be->dpcm[stream].state);
1620
1621                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1622                         goto unwind;
1623                 }
1624
1625                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
1626                 count++;
1627         }
1628
1629         return count;
1630
1631 unwind:
1632         /* disable any enabled and non active backends */
1633         list_for_each_entry_continue_reverse(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1634                 struct snd_soc_pcm_runtime *be = dpcm->be;
1635                 struct snd_pcm_substream *be_substream =
1636                         snd_soc_dpcm_get_substream(be, stream);
1637
1638                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1639                         continue;
1640
1641                 if (be->dpcm[stream].users == 0)
1642                         dev_err(be->dev, "ASoC: no users %s at close %d\n",
1643                                 stream ? "capture" : "playback",
1644                                 be->dpcm[stream].state);
1645
1646                 if (--be->dpcm[stream].users != 0)
1647                         continue;
1648
1649                 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN)
1650                         continue;
1651
1652                 soc_pcm_close(be_substream);
1653                 be_substream->runtime = NULL;
1654                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1655         }
1656
1657         return err;
1658 }
1659
1660 static void dpcm_init_runtime_hw(struct snd_pcm_runtime *runtime,
1661                                  struct snd_soc_pcm_stream *stream,
1662                                  u64 formats)
1663 {
1664         runtime->hw.rate_min = stream->rate_min;
1665         runtime->hw.rate_max = stream->rate_max;
1666         runtime->hw.channels_min = stream->channels_min;
1667         runtime->hw.channels_max = stream->channels_max;
1668         if (runtime->hw.formats)
1669                 runtime->hw.formats &= formats & stream->formats;
1670         else
1671                 runtime->hw.formats = formats & stream->formats;
1672         runtime->hw.rates = stream->rates;
1673 }
1674
1675 static u64 dpcm_runtime_base_format(struct snd_pcm_substream *substream)
1676 {
1677         struct snd_soc_pcm_runtime *fe = substream->private_data;
1678         struct snd_soc_dpcm *dpcm;
1679         u64 formats = ULLONG_MAX;
1680         int stream = substream->stream;
1681
1682         if (!fe->dai_link->dpcm_merged_format)
1683                 return formats;
1684
1685         /*
1686          * It returns merged BE codec format
1687          * if FE want to use it (= dpcm_merged_format)
1688          */
1689
1690         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1691                 struct snd_soc_pcm_runtime *be = dpcm->be;
1692                 struct snd_soc_dai_driver *codec_dai_drv;
1693                 struct snd_soc_pcm_stream *codec_stream;
1694                 int i;
1695
1696                 for (i = 0; i < be->num_codecs; i++) {
1697                         /*
1698                          * Skip CODECs which don't support the current stream
1699                          * type. See soc_pcm_init_runtime_hw() for more details
1700                          */
1701                         if (!snd_soc_dai_stream_valid(be->codec_dais[i],
1702                                                       stream))
1703                                 continue;
1704
1705                         codec_dai_drv = be->codec_dais[i]->driver;
1706                         if (stream == SNDRV_PCM_STREAM_PLAYBACK)
1707                                 codec_stream = &codec_dai_drv->playback;
1708                         else
1709                                 codec_stream = &codec_dai_drv->capture;
1710
1711                         formats &= codec_stream->formats;
1712                 }
1713         }
1714
1715         return formats;
1716 }
1717
1718 static void dpcm_set_fe_runtime(struct snd_pcm_substream *substream)
1719 {
1720         struct snd_pcm_runtime *runtime = substream->runtime;
1721         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1722         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1723         struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver;
1724         u64 format = dpcm_runtime_base_format(substream);
1725
1726         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1727                 dpcm_init_runtime_hw(runtime, &cpu_dai_drv->playback, format);
1728         else
1729                 dpcm_init_runtime_hw(runtime, &cpu_dai_drv->capture, format);
1730 }
1731
1732 static int dpcm_fe_dai_do_trigger(struct snd_pcm_substream *substream, int cmd);
1733
1734 /* Set FE's runtime_update state; the state is protected via PCM stream lock
1735  * for avoiding the race with trigger callback.
1736  * If the state is unset and a trigger is pending while the previous operation,
1737  * process the pending trigger action here.
1738  */
1739 static void dpcm_set_fe_update_state(struct snd_soc_pcm_runtime *fe,
1740                                      int stream, enum snd_soc_dpcm_update state)
1741 {
1742         struct snd_pcm_substream *substream =
1743                 snd_soc_dpcm_get_substream(fe, stream);
1744
1745         snd_pcm_stream_lock_irq(substream);
1746         if (state == SND_SOC_DPCM_UPDATE_NO && fe->dpcm[stream].trigger_pending) {
1747                 dpcm_fe_dai_do_trigger(substream,
1748                                        fe->dpcm[stream].trigger_pending - 1);
1749                 fe->dpcm[stream].trigger_pending = 0;
1750         }
1751         fe->dpcm[stream].runtime_update = state;
1752         snd_pcm_stream_unlock_irq(substream);
1753 }
1754
1755 static int dpcm_apply_symmetry(struct snd_pcm_substream *fe_substream,
1756                                int stream)
1757 {
1758         struct snd_soc_dpcm *dpcm;
1759         struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1760         struct snd_soc_dai *fe_cpu_dai = fe->cpu_dai;
1761         int err;
1762
1763         /* apply symmetry for FE */
1764         if (soc_pcm_has_symmetry(fe_substream))
1765                 fe_substream->runtime->hw.info |= SNDRV_PCM_INFO_JOINT_DUPLEX;
1766
1767         /* Symmetry only applies if we've got an active stream. */
1768         if (fe_cpu_dai->active) {
1769                 err = soc_pcm_apply_symmetry(fe_substream, fe_cpu_dai);
1770                 if (err < 0)
1771                         return err;
1772         }
1773
1774         /* apply symmetry for BE */
1775         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1776                 struct snd_soc_pcm_runtime *be = dpcm->be;
1777                 struct snd_pcm_substream *be_substream =
1778                         snd_soc_dpcm_get_substream(be, stream);
1779                 struct snd_soc_pcm_runtime *rtd = be_substream->private_data;
1780                 int i;
1781
1782                 if (rtd->dai_link->be_hw_params_fixup)
1783                         continue;
1784
1785                 if (soc_pcm_has_symmetry(be_substream))
1786                         be_substream->runtime->hw.info |= SNDRV_PCM_INFO_JOINT_DUPLEX;
1787
1788                 /* Symmetry only applies if we've got an active stream. */
1789                 if (rtd->cpu_dai->active) {
1790                         err = soc_pcm_apply_symmetry(fe_substream,
1791                                                      rtd->cpu_dai);
1792                         if (err < 0)
1793                                 return err;
1794                 }
1795
1796                 for (i = 0; i < rtd->num_codecs; i++) {
1797                         if (rtd->codec_dais[i]->active) {
1798                                 err = soc_pcm_apply_symmetry(fe_substream,
1799                                                              rtd->codec_dais[i]);
1800                                 if (err < 0)
1801                                         return err;
1802                         }
1803                 }
1804         }
1805
1806         return 0;
1807 }
1808
1809 static int dpcm_fe_dai_startup(struct snd_pcm_substream *fe_substream)
1810 {
1811         struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
1812         struct snd_pcm_runtime *runtime = fe_substream->runtime;
1813         int stream = fe_substream->stream, ret = 0;
1814
1815         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
1816
1817         ret = dpcm_be_dai_startup(fe, fe_substream->stream);
1818         if (ret < 0) {
1819                 dev_err(fe->dev,"ASoC: failed to start some BEs %d\n", ret);
1820                 goto be_err;
1821         }
1822
1823         dev_dbg(fe->dev, "ASoC: open FE %s\n", fe->dai_link->name);
1824
1825         /* start the DAI frontend */
1826         ret = soc_pcm_open(fe_substream);
1827         if (ret < 0) {
1828                 dev_err(fe->dev,"ASoC: failed to start FE %d\n", ret);
1829                 goto unwind;
1830         }
1831
1832         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
1833
1834         dpcm_set_fe_runtime(fe_substream);
1835         snd_pcm_limit_hw_rates(runtime);
1836
1837         ret = dpcm_apply_symmetry(fe_substream, stream);
1838         if (ret < 0) {
1839                 dev_err(fe->dev, "ASoC: failed to apply dpcm symmetry %d\n",
1840                         ret);
1841                 goto unwind;
1842         }
1843
1844         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
1845         return 0;
1846
1847 unwind:
1848         dpcm_be_dai_startup_unwind(fe, fe_substream->stream);
1849 be_err:
1850         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
1851         return ret;
1852 }
1853
1854 int dpcm_be_dai_shutdown(struct snd_soc_pcm_runtime *fe, int stream)
1855 {
1856         struct snd_soc_dpcm *dpcm;
1857
1858         /* only shutdown BEs that are either sinks or sources to this FE DAI */
1859         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1860
1861                 struct snd_soc_pcm_runtime *be = dpcm->be;
1862                 struct snd_pcm_substream *be_substream =
1863                         snd_soc_dpcm_get_substream(be, stream);
1864
1865                 /* is this op for this BE ? */
1866                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1867                         continue;
1868
1869                 if (be->dpcm[stream].users == 0)
1870                         dev_err(be->dev, "ASoC: no users %s at close - state %d\n",
1871                                 stream ? "capture" : "playback",
1872                                 be->dpcm[stream].state);
1873
1874                 if (--be->dpcm[stream].users != 0)
1875                         continue;
1876
1877                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1878                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN)) {
1879                         soc_pcm_hw_free(be_substream);
1880                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1881                 }
1882
1883                 dev_dbg(be->dev, "ASoC: close BE %s\n",
1884                         be->dai_link->name);
1885
1886                 soc_pcm_close(be_substream);
1887                 be_substream->runtime = NULL;
1888
1889                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1890         }
1891         return 0;
1892 }
1893
1894 static int dpcm_fe_dai_shutdown(struct snd_pcm_substream *substream)
1895 {
1896         struct snd_soc_pcm_runtime *fe = substream->private_data;
1897         int stream = substream->stream;
1898
1899         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
1900
1901         /* shutdown the BEs */
1902         dpcm_be_dai_shutdown(fe, substream->stream);
1903
1904         dev_dbg(fe->dev, "ASoC: close FE %s\n", fe->dai_link->name);
1905
1906         /* now shutdown the frontend */
1907         soc_pcm_close(substream);
1908
1909         /* run the stream event for each BE */
1910         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
1911
1912         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
1913         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
1914         return 0;
1915 }
1916
1917 int dpcm_be_dai_hw_free(struct snd_soc_pcm_runtime *fe, int stream)
1918 {
1919         struct snd_soc_dpcm *dpcm;
1920
1921         /* only hw_params backends that are either sinks or sources
1922          * to this frontend DAI */
1923         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1924
1925                 struct snd_soc_pcm_runtime *be = dpcm->be;
1926                 struct snd_pcm_substream *be_substream =
1927                         snd_soc_dpcm_get_substream(be, stream);
1928
1929                 /* is this op for this BE ? */
1930                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
1931                         continue;
1932
1933                 /* only free hw when no longer used - check all FEs */
1934                 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
1935                                 continue;
1936
1937                 /* do not free hw if this BE is used by other FE */
1938                 if (be->dpcm[stream].users > 1)
1939                         continue;
1940
1941                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
1942                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) &&
1943                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
1944                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED) &&
1945                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP) &&
1946                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
1947                         continue;
1948
1949                 dev_dbg(be->dev, "ASoC: hw_free BE %s\n",
1950                         be->dai_link->name);
1951
1952                 soc_pcm_hw_free(be_substream);
1953
1954                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1955         }
1956
1957         return 0;
1958 }
1959
1960 static int dpcm_fe_dai_hw_free(struct snd_pcm_substream *substream)
1961 {
1962         struct snd_soc_pcm_runtime *fe = substream->private_data;
1963         int err, stream = substream->stream;
1964
1965         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
1966         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
1967
1968         dev_dbg(fe->dev, "ASoC: hw_free FE %s\n", fe->dai_link->name);
1969
1970         /* call hw_free on the frontend */
1971         err = soc_pcm_hw_free(substream);
1972         if (err < 0)
1973                 dev_err(fe->dev,"ASoC: hw_free FE %s failed\n",
1974                         fe->dai_link->name);
1975
1976         /* only hw_params backends that are either sinks or sources
1977          * to this frontend DAI */
1978         err = dpcm_be_dai_hw_free(fe, stream);
1979
1980         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_FREE;
1981         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
1982
1983         mutex_unlock(&fe->card->mutex);
1984         return 0;
1985 }
1986
1987 int dpcm_be_dai_hw_params(struct snd_soc_pcm_runtime *fe, int stream)
1988 {
1989         struct snd_soc_dpcm *dpcm;
1990         int ret;
1991
1992         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
1993
1994                 struct snd_soc_pcm_runtime *be = dpcm->be;
1995                 struct snd_pcm_substream *be_substream =
1996                         snd_soc_dpcm_get_substream(be, stream);
1997
1998                 /* is this op for this BE ? */
1999                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
2000                         continue;
2001
2002                 /* copy params for each dpcm */
2003                 memcpy(&dpcm->hw_params, &fe->dpcm[stream].hw_params,
2004                                 sizeof(struct snd_pcm_hw_params));
2005
2006                 /* perform any hw_params fixups */
2007                 if (be->dai_link->be_hw_params_fixup) {
2008                         ret = be->dai_link->be_hw_params_fixup(be,
2009                                         &dpcm->hw_params);
2010                         if (ret < 0) {
2011                                 dev_err(be->dev,
2012                                         "ASoC: hw_params BE fixup failed %d\n",
2013                                         ret);
2014                                 goto unwind;
2015                         }
2016                 }
2017
2018                 /* only allow hw_params() if no connected FEs are running */
2019                 if (!snd_soc_dpcm_can_be_params(fe, be, stream))
2020                         continue;
2021
2022                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
2023                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
2024                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE))
2025                         continue;
2026
2027                 dev_dbg(be->dev, "ASoC: hw_params BE %s\n",
2028                         be->dai_link->name);
2029
2030                 ret = soc_pcm_hw_params(be_substream, &dpcm->hw_params);
2031                 if (ret < 0) {
2032                         dev_err(dpcm->be->dev,
2033                                 "ASoC: hw_params BE failed %d\n", ret);
2034                         goto unwind;
2035                 }
2036
2037                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
2038         }
2039         return 0;
2040
2041 unwind:
2042         /* disable any enabled and non active backends */
2043         list_for_each_entry_continue_reverse(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2044                 struct snd_soc_pcm_runtime *be = dpcm->be;
2045                 struct snd_pcm_substream *be_substream =
2046                         snd_soc_dpcm_get_substream(be, stream);
2047
2048                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
2049                         continue;
2050
2051                 /* only allow hw_free() if no connected FEs are running */
2052                 if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
2053                         continue;
2054
2055                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_OPEN) &&
2056                    (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
2057                    (be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_FREE) &&
2058                    (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
2059                         continue;
2060
2061                 soc_pcm_hw_free(be_substream);
2062         }
2063
2064         return ret;
2065 }
2066
2067 static int dpcm_fe_dai_hw_params(struct snd_pcm_substream *substream,
2068                                  struct snd_pcm_hw_params *params)
2069 {
2070         struct snd_soc_pcm_runtime *fe = substream->private_data;
2071         int ret, stream = substream->stream;
2072
2073         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2074         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
2075
2076         memcpy(&fe->dpcm[substream->stream].hw_params, params,
2077                         sizeof(struct snd_pcm_hw_params));
2078         ret = dpcm_be_dai_hw_params(fe, substream->stream);
2079         if (ret < 0) {
2080                 dev_err(fe->dev,"ASoC: hw_params BE failed %d\n", ret);
2081                 goto out;
2082         }
2083
2084         dev_dbg(fe->dev, "ASoC: hw_params FE %s rate %d chan %x fmt %d\n",
2085                         fe->dai_link->name, params_rate(params),
2086                         params_channels(params), params_format(params));
2087
2088         /* call hw_params on the frontend */
2089         ret = soc_pcm_hw_params(substream, params);
2090         if (ret < 0) {
2091                 dev_err(fe->dev,"ASoC: hw_params FE failed %d\n", ret);
2092                 dpcm_be_dai_hw_free(fe, stream);
2093          } else
2094                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_HW_PARAMS;
2095
2096 out:
2097         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
2098         mutex_unlock(&fe->card->mutex);
2099         return ret;
2100 }
2101
2102 static int dpcm_do_trigger(struct snd_soc_dpcm *dpcm,
2103                 struct snd_pcm_substream *substream, int cmd)
2104 {
2105         int ret;
2106
2107         dev_dbg(dpcm->be->dev, "ASoC: trigger BE %s cmd %d\n",
2108                         dpcm->be->dai_link->name, cmd);
2109
2110         ret = soc_pcm_trigger(substream, cmd);
2111         if (ret < 0)
2112                 dev_err(dpcm->be->dev,"ASoC: trigger BE failed %d\n", ret);
2113
2114         return ret;
2115 }
2116
2117 int dpcm_be_dai_trigger(struct snd_soc_pcm_runtime *fe, int stream,
2118                                int cmd)
2119 {
2120         struct snd_soc_dpcm *dpcm;
2121         int ret = 0;
2122
2123         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2124
2125                 struct snd_soc_pcm_runtime *be = dpcm->be;
2126                 struct snd_pcm_substream *be_substream =
2127                         snd_soc_dpcm_get_substream(be, stream);
2128
2129                 /* is this op for this BE ? */
2130                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
2131                         continue;
2132
2133                 switch (cmd) {
2134                 case SNDRV_PCM_TRIGGER_START:
2135                         if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PREPARE) &&
2136                             (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP))
2137                                 continue;
2138
2139                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2140                         if (ret)
2141                                 return ret;
2142
2143                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2144                         break;
2145                 case SNDRV_PCM_TRIGGER_RESUME:
2146                         if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
2147                                 continue;
2148
2149                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2150                         if (ret)
2151                                 return ret;
2152
2153                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2154                         break;
2155                 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
2156                         if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_PAUSED))
2157                                 continue;
2158
2159                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2160                         if (ret)
2161                                 return ret;
2162
2163                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2164                         break;
2165                 case SNDRV_PCM_TRIGGER_STOP:
2166                         if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2167                                 continue;
2168
2169                         if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
2170                                 continue;
2171
2172                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2173                         if (ret)
2174                                 return ret;
2175
2176                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
2177                         break;
2178                 case SNDRV_PCM_TRIGGER_SUSPEND:
2179                         if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2180                                 continue;
2181
2182                         if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
2183                                 continue;
2184
2185                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2186                         if (ret)
2187                                 return ret;
2188
2189                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_SUSPEND;
2190                         break;
2191                 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
2192                         if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2193                                 continue;
2194
2195                         if (!snd_soc_dpcm_can_be_free_stop(fe, be, stream))
2196                                 continue;
2197
2198                         ret = dpcm_do_trigger(dpcm, be_substream, cmd);
2199                         if (ret)
2200                                 return ret;
2201
2202                         be->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
2203                         break;
2204                 }
2205         }
2206
2207         return ret;
2208 }
2209 EXPORT_SYMBOL_GPL(dpcm_be_dai_trigger);
2210
2211 static int dpcm_fe_dai_do_trigger(struct snd_pcm_substream *substream, int cmd)
2212 {
2213         struct snd_soc_pcm_runtime *fe = substream->private_data;
2214         int stream = substream->stream, ret;
2215         enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
2216
2217         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
2218
2219         switch (trigger) {
2220         case SND_SOC_DPCM_TRIGGER_PRE:
2221                 /* call trigger on the frontend before the backend. */
2222
2223                 dev_dbg(fe->dev, "ASoC: pre trigger FE %s cmd %d\n",
2224                                 fe->dai_link->name, cmd);
2225
2226                 ret = soc_pcm_trigger(substream, cmd);
2227                 if (ret < 0) {
2228                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2229                         goto out;
2230                 }
2231
2232                 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
2233                 break;
2234         case SND_SOC_DPCM_TRIGGER_POST:
2235                 /* call trigger on the frontend after the backend. */
2236
2237                 ret = dpcm_be_dai_trigger(fe, substream->stream, cmd);
2238                 if (ret < 0) {
2239                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2240                         goto out;
2241                 }
2242
2243                 dev_dbg(fe->dev, "ASoC: post trigger FE %s cmd %d\n",
2244                                 fe->dai_link->name, cmd);
2245
2246                 ret = soc_pcm_trigger(substream, cmd);
2247                 break;
2248         case SND_SOC_DPCM_TRIGGER_BESPOKE:
2249                 /* bespoke trigger() - handles both FE and BEs */
2250
2251                 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd %d\n",
2252                                 fe->dai_link->name, cmd);
2253
2254                 ret = soc_pcm_bespoke_trigger(substream, cmd);
2255                 if (ret < 0) {
2256                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2257                         goto out;
2258                 }
2259                 break;
2260         default:
2261                 dev_err(fe->dev, "ASoC: invalid trigger cmd %d for %s\n", cmd,
2262                                 fe->dai_link->name);
2263                 ret = -EINVAL;
2264                 goto out;
2265         }
2266
2267         switch (cmd) {
2268         case SNDRV_PCM_TRIGGER_START:
2269         case SNDRV_PCM_TRIGGER_RESUME:
2270         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
2271                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
2272                 break;
2273         case SNDRV_PCM_TRIGGER_STOP:
2274         case SNDRV_PCM_TRIGGER_SUSPEND:
2275                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
2276                 break;
2277         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
2278                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
2279                 break;
2280         }
2281
2282 out:
2283         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
2284         return ret;
2285 }
2286
2287 static int dpcm_fe_dai_trigger(struct snd_pcm_substream *substream, int cmd)
2288 {
2289         struct snd_soc_pcm_runtime *fe = substream->private_data;
2290         int stream = substream->stream;
2291
2292         /* if FE's runtime_update is already set, we're in race;
2293          * process this trigger later at exit
2294          */
2295         if (fe->dpcm[stream].runtime_update != SND_SOC_DPCM_UPDATE_NO) {
2296                 fe->dpcm[stream].trigger_pending = cmd + 1;
2297                 return 0; /* delayed, assuming it's successful */
2298         }
2299
2300         /* we're alone, let's trigger */
2301         return dpcm_fe_dai_do_trigger(substream, cmd);
2302 }
2303
2304 int dpcm_be_dai_prepare(struct snd_soc_pcm_runtime *fe, int stream)
2305 {
2306         struct snd_soc_dpcm *dpcm;
2307         int ret = 0;
2308
2309         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2310
2311                 struct snd_soc_pcm_runtime *be = dpcm->be;
2312                 struct snd_pcm_substream *be_substream =
2313                         snd_soc_dpcm_get_substream(be, stream);
2314
2315                 /* is this op for this BE ? */
2316                 if (!snd_soc_dpcm_be_can_update(fe, be, stream))
2317                         continue;
2318
2319                 if ((be->dpcm[stream].state != SND_SOC_DPCM_STATE_HW_PARAMS) &&
2320                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_STOP) &&
2321                     (be->dpcm[stream].state != SND_SOC_DPCM_STATE_SUSPEND))
2322                         continue;
2323
2324                 dev_dbg(be->dev, "ASoC: prepare BE %s\n",
2325                         be->dai_link->name);
2326
2327                 ret = soc_pcm_prepare(be_substream);
2328                 if (ret < 0) {
2329                         dev_err(be->dev, "ASoC: backend prepare failed %d\n",
2330                                 ret);
2331                         break;
2332                 }
2333
2334                 be->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
2335         }
2336         return ret;
2337 }
2338
2339 static int dpcm_fe_dai_prepare(struct snd_pcm_substream *substream)
2340 {
2341         struct snd_soc_pcm_runtime *fe = substream->private_data;
2342         int stream = substream->stream, ret = 0;
2343
2344         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2345
2346         dev_dbg(fe->dev, "ASoC: prepare FE %s\n", fe->dai_link->name);
2347
2348         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_FE);
2349
2350         /* there is no point preparing this FE if there are no BEs */
2351         if (list_empty(&fe->dpcm[stream].be_clients)) {
2352                 dev_err(fe->dev, "ASoC: no backend DAIs enabled for %s\n",
2353                                 fe->dai_link->name);
2354                 ret = -EINVAL;
2355                 goto out;
2356         }
2357
2358         ret = dpcm_be_dai_prepare(fe, substream->stream);
2359         if (ret < 0)
2360                 goto out;
2361
2362         /* call prepare on the frontend */
2363         ret = soc_pcm_prepare(substream);
2364         if (ret < 0) {
2365                 dev_err(fe->dev,"ASoC: prepare FE %s failed\n",
2366                         fe->dai_link->name);
2367                 goto out;
2368         }
2369
2370         /* run the stream event for each BE */
2371         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
2372         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
2373
2374 out:
2375         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
2376         mutex_unlock(&fe->card->mutex);
2377
2378         return ret;
2379 }
2380
2381 static int soc_pcm_ioctl(struct snd_pcm_substream *substream,
2382                      unsigned int cmd, void *arg)
2383 {
2384         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2385         struct snd_soc_component *component;
2386         struct snd_soc_rtdcom_list *rtdcom;
2387
2388         for_each_rtdcom(rtd, rtdcom) {
2389                 component = rtdcom->component;
2390
2391                 if (!component->driver->ops ||
2392                     !component->driver->ops->ioctl)
2393                         continue;
2394
2395                 /* FIXME: use 1st ioctl */
2396                 return component->driver->ops->ioctl(substream, cmd, arg);
2397         }
2398
2399         return snd_pcm_lib_ioctl(substream, cmd, arg);
2400 }
2401
2402 static int dpcm_run_update_shutdown(struct snd_soc_pcm_runtime *fe, int stream)
2403 {
2404         struct snd_pcm_substream *substream =
2405                 snd_soc_dpcm_get_substream(fe, stream);
2406         enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
2407         int err;
2408
2409         dev_dbg(fe->dev, "ASoC: runtime %s close on FE %s\n",
2410                         stream ? "capture" : "playback", fe->dai_link->name);
2411
2412         if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
2413                 /* call bespoke trigger - FE takes care of all BE triggers */
2414                 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd stop\n",
2415                                 fe->dai_link->name);
2416
2417                 err = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_STOP);
2418                 if (err < 0)
2419                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
2420         } else {
2421                 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd stop\n",
2422                         fe->dai_link->name);
2423
2424                 err = dpcm_be_dai_trigger(fe, stream, SNDRV_PCM_TRIGGER_STOP);
2425                 if (err < 0)
2426                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", err);
2427         }
2428
2429         err = dpcm_be_dai_hw_free(fe, stream);
2430         if (err < 0)
2431                 dev_err(fe->dev,"ASoC: hw_free FE failed %d\n", err);
2432
2433         err = dpcm_be_dai_shutdown(fe, stream);
2434         if (err < 0)
2435                 dev_err(fe->dev,"ASoC: shutdown FE failed %d\n", err);
2436
2437         /* run the stream event for each BE */
2438         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
2439
2440         return 0;
2441 }
2442
2443 static int dpcm_run_update_startup(struct snd_soc_pcm_runtime *fe, int stream)
2444 {
2445         struct snd_pcm_substream *substream =
2446                 snd_soc_dpcm_get_substream(fe, stream);
2447         struct snd_soc_dpcm *dpcm;
2448         enum snd_soc_dpcm_trigger trigger = fe->dai_link->trigger[stream];
2449         int ret;
2450
2451         dev_dbg(fe->dev, "ASoC: runtime %s open on FE %s\n",
2452                         stream ? "capture" : "playback", fe->dai_link->name);
2453
2454         /* Only start the BE if the FE is ready */
2455         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_FREE ||
2456                 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_CLOSE)
2457                 return -EINVAL;
2458
2459         /* startup must always be called for new BEs */
2460         ret = dpcm_be_dai_startup(fe, stream);
2461         if (ret < 0)
2462                 goto disconnect;
2463
2464         /* keep going if FE state is > open */
2465         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_OPEN)
2466                 return 0;
2467
2468         ret = dpcm_be_dai_hw_params(fe, stream);
2469         if (ret < 0)
2470                 goto close;
2471
2472         /* keep going if FE state is > hw_params */
2473         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_HW_PARAMS)
2474                 return 0;
2475
2476
2477         ret = dpcm_be_dai_prepare(fe, stream);
2478         if (ret < 0)
2479                 goto hw_free;
2480
2481         /* run the stream event for each BE */
2482         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_NOP);
2483
2484         /* keep going if FE state is > prepare */
2485         if (fe->dpcm[stream].state == SND_SOC_DPCM_STATE_PREPARE ||
2486                 fe->dpcm[stream].state == SND_SOC_DPCM_STATE_STOP)
2487                 return 0;
2488
2489         if (trigger == SND_SOC_DPCM_TRIGGER_BESPOKE) {
2490                 /* call trigger on the frontend - FE takes care of all BE triggers */
2491                 dev_dbg(fe->dev, "ASoC: bespoke trigger FE %s cmd start\n",
2492                                 fe->dai_link->name);
2493
2494                 ret = soc_pcm_bespoke_trigger(substream, SNDRV_PCM_TRIGGER_START);
2495                 if (ret < 0) {
2496                         dev_err(fe->dev,"ASoC: bespoke trigger FE failed %d\n", ret);
2497                         goto hw_free;
2498                 }
2499         } else {
2500                 dev_dbg(fe->dev, "ASoC: trigger FE %s cmd start\n",
2501                         fe->dai_link->name);
2502
2503                 ret = dpcm_be_dai_trigger(fe, stream,
2504                                         SNDRV_PCM_TRIGGER_START);
2505                 if (ret < 0) {
2506                         dev_err(fe->dev,"ASoC: trigger FE failed %d\n", ret);
2507                         goto hw_free;
2508                 }
2509         }
2510
2511         return 0;
2512
2513 hw_free:
2514         dpcm_be_dai_hw_free(fe, stream);
2515 close:
2516         dpcm_be_dai_shutdown(fe, stream);
2517 disconnect:
2518         /* disconnect any non started BEs */
2519         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
2520                 struct snd_soc_pcm_runtime *be = dpcm->be;
2521                 if (be->dpcm[stream].state != SND_SOC_DPCM_STATE_START)
2522                                 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
2523         }
2524
2525         return ret;
2526 }
2527
2528 static int dpcm_run_new_update(struct snd_soc_pcm_runtime *fe, int stream)
2529 {
2530         int ret;
2531
2532         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_BE);
2533         ret = dpcm_run_update_startup(fe, stream);
2534         if (ret < 0)
2535                 dev_err(fe->dev, "ASoC: failed to startup some BEs\n");
2536         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
2537
2538         return ret;
2539 }
2540
2541 static int dpcm_run_old_update(struct snd_soc_pcm_runtime *fe, int stream)
2542 {
2543         int ret;
2544
2545         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_BE);
2546         ret = dpcm_run_update_shutdown(fe, stream);
2547         if (ret < 0)
2548                 dev_err(fe->dev, "ASoC: failed to shutdown some BEs\n");
2549         dpcm_set_fe_update_state(fe, stream, SND_SOC_DPCM_UPDATE_NO);
2550
2551         return ret;
2552 }
2553
2554 /* Called by DAPM mixer/mux changes to update audio routing between PCMs and
2555  * any DAI links.
2556  */
2557 int soc_dpcm_runtime_update(struct snd_soc_card *card)
2558 {
2559         struct snd_soc_pcm_runtime *fe;
2560         int old, new, paths;
2561
2562         mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2563         list_for_each_entry(fe, &card->rtd_list, list) {
2564                 struct snd_soc_dapm_widget_list *list;
2565
2566                 /* make sure link is FE */
2567                 if (!fe->dai_link->dynamic)
2568                         continue;
2569
2570                 /* only check active links */
2571                 if (!fe->cpu_dai->active)
2572                         continue;
2573
2574                 /* DAPM sync will call this to update DSP paths */
2575                 dev_dbg(fe->dev, "ASoC: DPCM runtime update for FE %s\n",
2576                         fe->dai_link->name);
2577
2578                 /* skip if FE doesn't have playback capability */
2579                 if (!fe->cpu_dai->driver->playback.channels_min
2580                     || !fe->codec_dai->driver->playback.channels_min)
2581                         goto capture;
2582
2583                 /* skip if FE isn't currently playing */
2584                 if (!fe->cpu_dai->playback_active
2585                     || !fe->codec_dai->playback_active)
2586                         goto capture;
2587
2588                 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_PLAYBACK, &list);
2589                 if (paths < 0) {
2590                         dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
2591                                         fe->dai_link->name,  "playback");
2592                         mutex_unlock(&card->mutex);
2593                         return paths;
2594                 }
2595
2596                 /* update any new playback paths */
2597                 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 1);
2598                 if (new) {
2599                         dpcm_run_new_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
2600                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
2601                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
2602                 }
2603
2604                 /* update any old playback paths */
2605                 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_PLAYBACK, &list, 0);
2606                 if (old) {
2607                         dpcm_run_old_update(fe, SNDRV_PCM_STREAM_PLAYBACK);
2608                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_PLAYBACK);
2609                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_PLAYBACK);
2610                 }
2611
2612                 dpcm_path_put(&list);
2613 capture:
2614                 /* skip if FE doesn't have capture capability */
2615                 if (!fe->cpu_dai->driver->capture.channels_min
2616                     || !fe->codec_dai->driver->capture.channels_min)
2617                         continue;
2618
2619                 /* skip if FE isn't currently capturing */
2620                 if (!fe->cpu_dai->capture_active
2621                     || !fe->codec_dai->capture_active)
2622                         continue;
2623
2624                 paths = dpcm_path_get(fe, SNDRV_PCM_STREAM_CAPTURE, &list);
2625                 if (paths < 0) {
2626                         dev_warn(fe->dev, "ASoC: %s no valid %s path\n",
2627                                         fe->dai_link->name,  "capture");
2628                         mutex_unlock(&card->mutex);
2629                         return paths;
2630                 }
2631
2632                 /* update any new capture paths */
2633                 new = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 1);
2634                 if (new) {
2635                         dpcm_run_new_update(fe, SNDRV_PCM_STREAM_CAPTURE);
2636                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
2637                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
2638                 }
2639
2640                 /* update any old capture paths */
2641                 old = dpcm_process_paths(fe, SNDRV_PCM_STREAM_CAPTURE, &list, 0);
2642                 if (old) {
2643                         dpcm_run_old_update(fe, SNDRV_PCM_STREAM_CAPTURE);
2644                         dpcm_clear_pending_state(fe, SNDRV_PCM_STREAM_CAPTURE);
2645                         dpcm_be_disconnect(fe, SNDRV_PCM_STREAM_CAPTURE);
2646                 }
2647
2648                 dpcm_path_put(&list);
2649         }
2650
2651         mutex_unlock(&card->mutex);
2652         return 0;
2653 }
2654 int soc_dpcm_be_digital_mute(struct snd_soc_pcm_runtime *fe, int mute)
2655 {
2656         struct snd_soc_dpcm *dpcm;
2657         struct list_head *clients =
2658                 &fe->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients;
2659
2660         list_for_each_entry(dpcm, clients, list_be) {
2661
2662                 struct snd_soc_pcm_runtime *be = dpcm->be;
2663                 int i;
2664
2665                 if (be->dai_link->ignore_suspend)
2666                         continue;
2667
2668                 for (i = 0; i < be->num_codecs; i++) {
2669                         struct snd_soc_dai *dai = be->codec_dais[i];
2670                         struct snd_soc_dai_driver *drv = dai->driver;
2671
2672                         dev_dbg(be->dev, "ASoC: BE digital mute %s\n",
2673                                          be->dai_link->name);
2674
2675                         if (drv->ops && drv->ops->digital_mute &&
2676                                                         dai->playback_active)
2677                                 drv->ops->digital_mute(dai, mute);
2678                 }
2679         }
2680
2681         return 0;
2682 }
2683
2684 static int dpcm_fe_dai_open(struct snd_pcm_substream *fe_substream)
2685 {
2686         struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
2687         struct snd_soc_dpcm *dpcm;
2688         struct snd_soc_dapm_widget_list *list;
2689         int ret;
2690         int stream = fe_substream->stream;
2691
2692         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2693         fe->dpcm[stream].runtime = fe_substream->runtime;
2694
2695         ret = dpcm_path_get(fe, stream, &list);
2696         if (ret < 0) {
2697                 mutex_unlock(&fe->card->mutex);
2698                 return ret;
2699         } else if (ret == 0) {
2700                 dev_dbg(fe->dev, "ASoC: %s no valid %s route\n",
2701                         fe->dai_link->name, stream ? "capture" : "playback");
2702         }
2703
2704         /* calculate valid and active FE <-> BE dpcms */
2705         dpcm_process_paths(fe, stream, &list, 1);
2706
2707         ret = dpcm_fe_dai_startup(fe_substream);
2708         if (ret < 0) {
2709                 /* clean up all links */
2710                 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
2711                         dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
2712
2713                 dpcm_be_disconnect(fe, stream);
2714                 fe->dpcm[stream].runtime = NULL;
2715         }
2716
2717         dpcm_clear_pending_state(fe, stream);
2718         dpcm_path_put(&list);
2719         mutex_unlock(&fe->card->mutex);
2720         return ret;
2721 }
2722
2723 static int dpcm_fe_dai_close(struct snd_pcm_substream *fe_substream)
2724 {
2725         struct snd_soc_pcm_runtime *fe = fe_substream->private_data;
2726         struct snd_soc_dpcm *dpcm;
2727         int stream = fe_substream->stream, ret;
2728
2729         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
2730         ret = dpcm_fe_dai_shutdown(fe_substream);
2731
2732         /* mark FE's links ready to prune */
2733         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
2734                 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
2735
2736         dpcm_be_disconnect(fe, stream);
2737
2738         fe->dpcm[stream].runtime = NULL;
2739         mutex_unlock(&fe->card->mutex);
2740         return ret;
2741 }
2742
2743 static void soc_pcm_private_free(struct snd_pcm *pcm)
2744 {
2745         struct snd_soc_pcm_runtime *rtd = pcm->private_data;
2746         struct snd_soc_rtdcom_list *rtdcom;
2747         struct snd_soc_component *component;
2748
2749         /* need to sync the delayed work before releasing resources */
2750         flush_delayed_work(&rtd->delayed_work);
2751         for_each_rtdcom(rtd, rtdcom) {
2752                 component = rtdcom->component;
2753
2754                 if (component->driver->pcm_free)
2755                         component->driver->pcm_free(pcm);
2756         }
2757 }
2758
2759 static int soc_rtdcom_ack(struct snd_pcm_substream *substream)
2760 {
2761         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2762         struct snd_soc_rtdcom_list *rtdcom;
2763         struct snd_soc_component *component;
2764
2765         for_each_rtdcom(rtd, rtdcom) {
2766                 component = rtdcom->component;
2767
2768                 if (!component->driver->ops ||
2769                     !component->driver->ops->ack)
2770                         continue;
2771
2772                 /* FIXME. it returns 1st ask now */
2773                 return component->driver->ops->ack(substream);
2774         }
2775
2776         return -EINVAL;
2777 }
2778
2779 static int soc_rtdcom_copy_user(struct snd_pcm_substream *substream, int channel,
2780                                 unsigned long pos, void __user *buf,
2781                                 unsigned long bytes)
2782 {
2783         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2784         struct snd_soc_rtdcom_list *rtdcom;
2785         struct snd_soc_component *component;
2786
2787         for_each_rtdcom(rtd, rtdcom) {
2788                 component = rtdcom->component;
2789
2790                 if (!component->driver->ops ||
2791                     !component->driver->ops->copy_user)
2792                         continue;
2793
2794                 /* FIXME. it returns 1st copy now */
2795                 return component->driver->ops->copy_user(substream, channel,
2796                                                          pos, buf, bytes);
2797         }
2798
2799         return -EINVAL;
2800 }
2801
2802 static int soc_rtdcom_copy_kernel(struct snd_pcm_substream *substream, int channel,
2803                                   unsigned long pos, void *buf, unsigned long bytes)
2804 {
2805         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2806         struct snd_soc_rtdcom_list *rtdcom;
2807         struct snd_soc_component *component;
2808
2809         for_each_rtdcom(rtd, rtdcom) {
2810                 component = rtdcom->component;
2811
2812                 if (!component->driver->ops ||
2813                     !component->driver->ops->copy_kernel)
2814                         continue;
2815
2816                 /* FIXME. it returns 1st copy now */
2817                 return component->driver->ops->copy_kernel(substream, channel,
2818                                                            pos, buf, bytes);
2819         }
2820
2821         return -EINVAL;
2822 }
2823
2824 static int soc_rtdcom_fill_silence(struct snd_pcm_substream *substream, int channel,
2825                                    unsigned long pos, unsigned long bytes)
2826 {
2827         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2828         struct snd_soc_rtdcom_list *rtdcom;
2829         struct snd_soc_component *component;
2830
2831         for_each_rtdcom(rtd, rtdcom) {
2832                 component = rtdcom->component;
2833
2834                 if (!component->driver->ops ||
2835                     !component->driver->ops->fill_silence)
2836                         continue;
2837
2838                 /* FIXME. it returns 1st silence now */
2839                 return component->driver->ops->fill_silence(substream, channel,
2840                                                             pos, bytes);
2841         }
2842
2843         return -EINVAL;
2844 }
2845
2846 static struct page *soc_rtdcom_page(struct snd_pcm_substream *substream,
2847                                     unsigned long offset)
2848 {
2849         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2850         struct snd_soc_rtdcom_list *rtdcom;
2851         struct snd_soc_component *component;
2852         struct page *page;
2853
2854         for_each_rtdcom(rtd, rtdcom) {
2855                 component = rtdcom->component;
2856
2857                 if (!component->driver->ops ||
2858                     !component->driver->ops->page)
2859                         continue;
2860
2861                 /* FIXME. it returns 1st page now */
2862                 page = component->driver->ops->page(substream, offset);
2863                 if (page)
2864                         return page;
2865         }
2866
2867         return NULL;
2868 }
2869
2870 static int soc_rtdcom_mmap(struct snd_pcm_substream *substream,
2871                            struct vm_area_struct *vma)
2872 {
2873         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2874         struct snd_soc_rtdcom_list *rtdcom;
2875         struct snd_soc_component *component;
2876
2877         for_each_rtdcom(rtd, rtdcom) {
2878                 component = rtdcom->component;
2879
2880                 if (!component->driver->ops ||
2881                     !component->driver->ops->mmap)
2882                         continue;
2883
2884                 /* FIXME. it returns 1st mmap now */
2885                 return component->driver->ops->mmap(substream, vma);
2886         }
2887
2888         return -EINVAL;
2889 }
2890
2891 /* create a new pcm */
2892 int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
2893 {
2894         struct snd_soc_dai *codec_dai;
2895         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
2896         struct snd_soc_component *component;
2897         struct snd_soc_rtdcom_list *rtdcom;
2898         struct snd_pcm *pcm;
2899         char new_name[64];
2900         int ret = 0, playback = 0, capture = 0;
2901         int i;
2902
2903         if (rtd->dai_link->dynamic || rtd->dai_link->no_pcm) {
2904                 playback = rtd->dai_link->dpcm_playback;
2905                 capture = rtd->dai_link->dpcm_capture;
2906         } else {
2907                 for (i = 0; i < rtd->num_codecs; i++) {
2908                         codec_dai = rtd->codec_dais[i];
2909                         if (codec_dai->driver->playback.channels_min)
2910                                 playback = 1;
2911                         if (codec_dai->driver->capture.channels_min)
2912                                 capture = 1;
2913                 }
2914
2915                 capture = capture && cpu_dai->driver->capture.channels_min;
2916                 playback = playback && cpu_dai->driver->playback.channels_min;
2917         }
2918
2919         if (rtd->dai_link->playback_only) {
2920                 playback = 1;
2921                 capture = 0;
2922         }
2923
2924         if (rtd->dai_link->capture_only) {
2925                 playback = 0;
2926                 capture = 1;
2927         }
2928
2929         /* create the PCM */
2930         if (rtd->dai_link->no_pcm) {
2931                 snprintf(new_name, sizeof(new_name), "(%s)",
2932                         rtd->dai_link->stream_name);
2933
2934                 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
2935                                 playback, capture, &pcm);
2936         } else {
2937                 if (rtd->dai_link->dynamic)
2938                         snprintf(new_name, sizeof(new_name), "%s (*)",
2939                                 rtd->dai_link->stream_name);
2940                 else
2941                         snprintf(new_name, sizeof(new_name), "%s %s-%d",
2942                                 rtd->dai_link->stream_name,
2943                                 (rtd->num_codecs > 1) ?
2944                                 "multicodec" : rtd->codec_dai->name, num);
2945
2946                 ret = snd_pcm_new(rtd->card->snd_card, new_name, num, playback,
2947                         capture, &pcm);
2948         }
2949         if (ret < 0) {
2950                 dev_err(rtd->card->dev, "ASoC: can't create pcm for %s\n",
2951                         rtd->dai_link->name);
2952                 return ret;
2953         }
2954         dev_dbg(rtd->card->dev, "ASoC: registered pcm #%d %s\n",num, new_name);
2955
2956         /* DAPM dai link stream work */
2957         INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
2958
2959         pcm->nonatomic = rtd->dai_link->nonatomic;
2960         rtd->pcm = pcm;
2961         pcm->private_data = rtd;
2962
2963         if (rtd->dai_link->no_pcm) {
2964                 if (playback)
2965                         pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
2966                 if (capture)
2967                         pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
2968                 goto out;
2969         }
2970
2971         /* ASoC PCM operations */
2972         if (rtd->dai_link->dynamic) {
2973                 rtd->ops.open           = dpcm_fe_dai_open;
2974                 rtd->ops.hw_params      = dpcm_fe_dai_hw_params;
2975                 rtd->ops.prepare        = dpcm_fe_dai_prepare;
2976                 rtd->ops.trigger        = dpcm_fe_dai_trigger;
2977                 rtd->ops.hw_free        = dpcm_fe_dai_hw_free;
2978                 rtd->ops.close          = dpcm_fe_dai_close;
2979                 rtd->ops.pointer        = soc_pcm_pointer;
2980                 rtd->ops.ioctl          = soc_pcm_ioctl;
2981         } else {
2982                 rtd->ops.open           = soc_pcm_open;
2983                 rtd->ops.hw_params      = soc_pcm_hw_params;
2984                 rtd->ops.prepare        = soc_pcm_prepare;
2985                 rtd->ops.trigger        = soc_pcm_trigger;
2986                 rtd->ops.hw_free        = soc_pcm_hw_free;
2987                 rtd->ops.close          = soc_pcm_close;
2988                 rtd->ops.pointer        = soc_pcm_pointer;
2989                 rtd->ops.ioctl          = soc_pcm_ioctl;
2990         }
2991
2992         for_each_rtdcom(rtd, rtdcom) {
2993                 const struct snd_pcm_ops *ops = rtdcom->component->driver->ops;
2994
2995                 if (!ops)
2996                         continue;
2997
2998                 if (ops->ack)
2999                         rtd->ops.ack            = soc_rtdcom_ack;
3000                 if (ops->copy_user)
3001                         rtd->ops.copy_user      = soc_rtdcom_copy_user;
3002                 if (ops->copy_kernel)
3003                         rtd->ops.copy_kernel    = soc_rtdcom_copy_kernel;
3004                 if (ops->fill_silence)
3005                         rtd->ops.fill_silence   = soc_rtdcom_fill_silence;
3006                 if (ops->page)
3007                         rtd->ops.page           = soc_rtdcom_page;
3008                 if (ops->mmap)
3009                         rtd->ops.mmap           = soc_rtdcom_mmap;
3010         }
3011
3012         if (playback)
3013                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &rtd->ops);
3014
3015         if (capture)
3016                 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &rtd->ops);
3017
3018         for_each_rtdcom(rtd, rtdcom) {
3019                 component = rtdcom->component;
3020
3021                 if (!component->driver->pcm_new)
3022                         continue;
3023
3024                 ret = component->driver->pcm_new(rtd);
3025                 if (ret < 0) {
3026                         dev_err(component->dev,
3027                                 "ASoC: pcm constructor failed: %d\n",
3028                                 ret);
3029                         return ret;
3030                 }
3031         }
3032
3033         pcm->private_free = soc_pcm_private_free;
3034 out:
3035         dev_info(rtd->card->dev, "%s <-> %s mapping ok\n",
3036                  (rtd->num_codecs > 1) ? "multicodec" : rtd->codec_dai->name,
3037                  cpu_dai->name);
3038         return ret;
3039 }
3040
3041 /* is the current PCM operation for this FE ? */
3042 int snd_soc_dpcm_fe_can_update(struct snd_soc_pcm_runtime *fe, int stream)
3043 {
3044         if (fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE)
3045                 return 1;
3046         return 0;
3047 }
3048 EXPORT_SYMBOL_GPL(snd_soc_dpcm_fe_can_update);
3049
3050 /* is the current PCM operation for this BE ? */
3051 int snd_soc_dpcm_be_can_update(struct snd_soc_pcm_runtime *fe,
3052                 struct snd_soc_pcm_runtime *be, int stream)
3053 {
3054         if ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_FE) ||
3055            ((fe->dpcm[stream].runtime_update == SND_SOC_DPCM_UPDATE_BE) &&
3056                   be->dpcm[stream].runtime_update))
3057                 return 1;
3058         return 0;
3059 }
3060 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_can_update);
3061
3062 /* get the substream for this BE */
3063 struct snd_pcm_substream *
3064         snd_soc_dpcm_get_substream(struct snd_soc_pcm_runtime *be, int stream)
3065 {
3066         return be->pcm->streams[stream].substream;
3067 }
3068 EXPORT_SYMBOL_GPL(snd_soc_dpcm_get_substream);
3069
3070 /* get the BE runtime state */
3071 enum snd_soc_dpcm_state
3072         snd_soc_dpcm_be_get_state(struct snd_soc_pcm_runtime *be, int stream)
3073 {
3074         return be->dpcm[stream].state;
3075 }
3076 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_get_state);
3077
3078 /* set the BE runtime state */
3079 void snd_soc_dpcm_be_set_state(struct snd_soc_pcm_runtime *be,
3080                 int stream, enum snd_soc_dpcm_state state)
3081 {
3082         be->dpcm[stream].state = state;
3083 }
3084 EXPORT_SYMBOL_GPL(snd_soc_dpcm_be_set_state);
3085
3086 /*
3087  * We can only hw_free, stop, pause or suspend a BE DAI if any of it's FE
3088  * are not running, paused or suspended for the specified stream direction.
3089  */
3090 int snd_soc_dpcm_can_be_free_stop(struct snd_soc_pcm_runtime *fe,
3091                 struct snd_soc_pcm_runtime *be, int stream)
3092 {
3093         struct snd_soc_dpcm *dpcm;
3094         int state;
3095
3096         list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
3097
3098                 if (dpcm->fe == fe)
3099                         continue;
3100
3101                 state = dpcm->fe->dpcm[stream].state;
3102                 if (state == SND_SOC_DPCM_STATE_START ||
3103                         state == SND_SOC_DPCM_STATE_PAUSED ||
3104                         state == SND_SOC_DPCM_STATE_SUSPEND)
3105                         return 0;
3106         }
3107
3108         /* it's safe to free/stop this BE DAI */
3109         return 1;
3110 }
3111 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_free_stop);
3112
3113 /*
3114  * We can only change hw params a BE DAI if any of it's FE are not prepared,
3115  * running, paused or suspended for the specified stream direction.
3116  */
3117 int snd_soc_dpcm_can_be_params(struct snd_soc_pcm_runtime *fe,
3118                 struct snd_soc_pcm_runtime *be, int stream)
3119 {
3120         struct snd_soc_dpcm *dpcm;
3121         int state;
3122
3123         list_for_each_entry(dpcm, &be->dpcm[stream].fe_clients, list_fe) {
3124
3125                 if (dpcm->fe == fe)
3126                         continue;
3127
3128                 state = dpcm->fe->dpcm[stream].state;
3129                 if (state == SND_SOC_DPCM_STATE_START ||
3130                         state == SND_SOC_DPCM_STATE_PAUSED ||
3131                         state == SND_SOC_DPCM_STATE_SUSPEND ||
3132                         state == SND_SOC_DPCM_STATE_PREPARE)
3133                         return 0;
3134         }
3135
3136         /* it's safe to change hw_params */
3137         return 1;
3138 }
3139 EXPORT_SYMBOL_GPL(snd_soc_dpcm_can_be_params);
3140
3141 #ifdef CONFIG_DEBUG_FS
3142 static const char *dpcm_state_string(enum snd_soc_dpcm_state state)
3143 {
3144         switch (state) {
3145         case SND_SOC_DPCM_STATE_NEW:
3146                 return "new";
3147         case SND_SOC_DPCM_STATE_OPEN:
3148                 return "open";
3149         case SND_SOC_DPCM_STATE_HW_PARAMS:
3150                 return "hw_params";
3151         case SND_SOC_DPCM_STATE_PREPARE:
3152                 return "prepare";
3153         case SND_SOC_DPCM_STATE_START:
3154                 return "start";
3155         case SND_SOC_DPCM_STATE_STOP:
3156                 return "stop";
3157         case SND_SOC_DPCM_STATE_SUSPEND:
3158                 return "suspend";
3159         case SND_SOC_DPCM_STATE_PAUSED:
3160                 return "paused";
3161         case SND_SOC_DPCM_STATE_HW_FREE:
3162                 return "hw_free";
3163         case SND_SOC_DPCM_STATE_CLOSE:
3164                 return "close";
3165         }
3166
3167         return "unknown";
3168 }
3169
3170 static ssize_t dpcm_show_state(struct snd_soc_pcm_runtime *fe,
3171                                 int stream, char *buf, size_t size)
3172 {
3173         struct snd_pcm_hw_params *params = &fe->dpcm[stream].hw_params;
3174         struct snd_soc_dpcm *dpcm;
3175         ssize_t offset = 0;
3176
3177         /* FE state */
3178         offset += snprintf(buf + offset, size - offset,
3179                         "[%s - %s]\n", fe->dai_link->name,
3180                         stream ? "Capture" : "Playback");
3181
3182         offset += snprintf(buf + offset, size - offset, "State: %s\n",
3183                         dpcm_state_string(fe->dpcm[stream].state));
3184
3185         if ((fe->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
3186             (fe->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
3187                 offset += snprintf(buf + offset, size - offset,
3188                                 "Hardware Params: "
3189                                 "Format = %s, Channels = %d, Rate = %d\n",
3190                                 snd_pcm_format_name(params_format(params)),
3191                                 params_channels(params),
3192                                 params_rate(params));
3193
3194         /* BEs state */
3195         offset += snprintf(buf + offset, size - offset, "Backends:\n");
3196
3197         if (list_empty(&fe->dpcm[stream].be_clients)) {
3198                 offset += snprintf(buf + offset, size - offset,
3199                                 " No active DSP links\n");
3200                 goto out;
3201         }
3202
3203         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be) {
3204                 struct snd_soc_pcm_runtime *be = dpcm->be;
3205                 params = &dpcm->hw_params;
3206
3207                 offset += snprintf(buf + offset, size - offset,
3208                                 "- %s\n", be->dai_link->name);
3209
3210                 offset += snprintf(buf + offset, size - offset,
3211                                 "   State: %s\n",
3212                                 dpcm_state_string(be->dpcm[stream].state));
3213
3214                 if ((be->dpcm[stream].state >= SND_SOC_DPCM_STATE_HW_PARAMS) &&
3215                     (be->dpcm[stream].state <= SND_SOC_DPCM_STATE_STOP))
3216                         offset += snprintf(buf + offset, size - offset,
3217                                 "   Hardware Params: "
3218                                 "Format = %s, Channels = %d, Rate = %d\n",
3219                                 snd_pcm_format_name(params_format(params)),
3220                                 params_channels(params),
3221                                 params_rate(params));
3222         }
3223
3224 out:
3225         return offset;
3226 }
3227
3228 static ssize_t dpcm_state_read_file(struct file *file, char __user *user_buf,
3229                                 size_t count, loff_t *ppos)
3230 {
3231         struct snd_soc_pcm_runtime *fe = file->private_data;
3232         ssize_t out_count = PAGE_SIZE, offset = 0, ret = 0;
3233         char *buf;
3234
3235         buf = kmalloc(out_count, GFP_KERNEL);
3236         if (!buf)
3237                 return -ENOMEM;
3238
3239         if (fe->cpu_dai->driver->playback.channels_min)
3240                 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_PLAYBACK,
3241                                         buf + offset, out_count - offset);
3242
3243         if (fe->cpu_dai->driver->capture.channels_min)
3244                 offset += dpcm_show_state(fe, SNDRV_PCM_STREAM_CAPTURE,
3245                                         buf + offset, out_count - offset);
3246
3247         ret = simple_read_from_buffer(user_buf, count, ppos, buf, offset);
3248
3249         kfree(buf);
3250         return ret;
3251 }
3252
3253 static const struct file_operations dpcm_state_fops = {
3254         .open = simple_open,
3255         .read = dpcm_state_read_file,
3256         .llseek = default_llseek,
3257 };
3258
3259 void soc_dpcm_debugfs_add(struct snd_soc_pcm_runtime *rtd)
3260 {
3261         if (!rtd->dai_link)
3262                 return;
3263
3264         if (!rtd->card->debugfs_card_root)
3265                 return;
3266
3267         rtd->debugfs_dpcm_root = debugfs_create_dir(rtd->dai_link->name,
3268                         rtd->card->debugfs_card_root);
3269         if (!rtd->debugfs_dpcm_root) {
3270                 dev_dbg(rtd->dev,
3271                          "ASoC: Failed to create dpcm debugfs directory %s\n",
3272                          rtd->dai_link->name);
3273                 return;
3274         }
3275
3276         debugfs_create_file("state", 0444, rtd->debugfs_dpcm_root,
3277                             rtd, &dpcm_state_fops);
3278 }
3279 #endif