sound/soc/soc-compress.c

   1 /*
   2  * soc-compress.c  --  ALSA SoC Compress
   3  *
   4  * Copyright (C) 2012 Intel Corp.
   5  *
   6  * Authors: Namarta Kohli <namartax.kohli@intel.com>
   7  *          Ramesh Babu K V <ramesh.babu@linux.intel.com>
   8  *          Vinod Koul <vinod.koul@linux.intel.com>
   9  *
  10  *  This program is free software; you can redistribute  it and/or modify it
  11  *  under  the terms of  the GNU General  Public License as published by the
  12  *  Free Software Foundation;  either version 2 of the  License, or (at your
  13  *  option) any later version.
  14  *
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include <linux/init.h>
  19 #include <linux/delay.h>
  20 #include <linux/slab.h>
  21 #include <linux/workqueue.h>
  22 #include <sound/core.h>
  23 #include <sound/compress_params.h>
  24 #include <sound/compress_driver.h>
  25 #include <sound/soc.h>
  26 #include <sound/initval.h>
  27 #include <sound/soc-dpcm.h>
  28
  29 static int soc_compr_open(struct snd_compr_stream *cstream)
  30 {
  31         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
  32         struct snd_soc_platform *platform = rtd->platform;
  33         int ret = 0;
  34
  35         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
  36
  37         if (platform->driver->compr_ops && platform->driver->compr_ops->open) {
  38                 ret = platform->driver->compr_ops->open(cstream);
  39                 if (ret < 0) {
  40                         pr_err("compress asoc: can't open platform %s\n",
  41                                 platform->component.name);
  42                         goto out;
  43                 }
  44         }
  45
  46         if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->startup) {
  47                 ret = rtd->dai_link->compr_ops->startup(cstream);
  48                 if (ret < 0) {
  49                         pr_err("compress asoc: %s startup failed\n", rtd->dai_link->name);
  50                         goto machine_err;
  51                 }
  52         }
  53
  54         snd_soc_runtime_activate(rtd, cstream->direction);
  55
  56         mutex_unlock(&rtd->pcm_mutex);
  57
  58         return 0;
  59
  60 machine_err:
  61         if (platform->driver->compr_ops && platform->driver->compr_ops->free)
  62                 platform->driver->compr_ops->free(cstream);
  63 out:
  64         mutex_unlock(&rtd->pcm_mutex);
  65         return ret;
  66 }
  67
  68 static int soc_compr_open_fe(struct snd_compr_stream *cstream)
  69 {
  70         struct snd_soc_pcm_runtime *fe = cstream->private_data;
  71         struct snd_pcm_substream *fe_substream =
  72                  fe->pcm->streams[cstream->direction].substream;
  73         struct snd_soc_platform *platform = fe->platform;
  74         struct snd_soc_dpcm *dpcm;
  75         struct snd_soc_dapm_widget_list *list;
  76         int stream;
  77         int ret = 0;
  78
  79         if (cstream->direction == SND_COMPRESS_PLAYBACK)
  80                 stream = SNDRV_PCM_STREAM_PLAYBACK;
  81         else
  82                 stream = SNDRV_PCM_STREAM_CAPTURE;
  83
  84         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
  85
  86         if (platform->driver->compr_ops && platform->driver->compr_ops->open) {
  87                 ret = platform->driver->compr_ops->open(cstream);
  88                 if (ret < 0) {
  89                         pr_err("compress asoc: can't open platform %s\n",
  90                                 platform->component.name);
  91                         goto out;
  92                 }
  93         }
  94
  95         if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->startup) {
  96                 ret = fe->dai_link->compr_ops->startup(cstream);
  97                 if (ret < 0) {
  98                         pr_err("compress asoc: %s startup failed\n", fe->dai_link->name);
  99                         goto machine_err;
 100                 }
 101         }
 102
 103         fe->dpcm[stream].runtime = fe_substream->runtime;
 104
 105         ret = dpcm_path_get(fe, stream, &list);
 106         if (ret < 0)
 107                 goto fe_err;
 108         else if (ret == 0)
 109                 dev_dbg(fe->dev, "ASoC: %s no valid %s route\n",
 110                         fe->dai_link->name, stream ? "capture" : "playback");
 111
 112         /* calculate valid and active FE <-> BE dpcms */
 113         dpcm_process_paths(fe, stream, &list, 1);
 114
 115         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
 116
 117         ret = dpcm_be_dai_startup(fe, stream);
 118         if (ret < 0) {
 119                 /* clean up all links */
 120                 list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
 121                         dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
 122
 123                 dpcm_be_disconnect(fe, stream);
 124                 fe->dpcm[stream].runtime = NULL;
 125                 goto fe_err;
 126         }
 127
 128         dpcm_clear_pending_state(fe, stream);
 129         dpcm_path_put(&list);
 130
 131         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_OPEN;
 132         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
 133
 134         snd_soc_runtime_activate(fe, stream);
 135
 136         mutex_unlock(&fe->card->mutex);
 137
 138         return 0;
 139
 140 fe_err:
 141         if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->shutdown)
 142                 fe->dai_link->compr_ops->shutdown(cstream);
 143 machine_err:
 144         if (platform->driver->compr_ops && platform->driver->compr_ops->free)
 145                 platform->driver->compr_ops->free(cstream);
 146 out:
 147         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
 148         mutex_unlock(&fe->card->mutex);
 149         return ret;
 150 }
 151
 152 /*
 153  * Power down the audio subsystem pmdown_time msecs after close is called.
 154  * This is to ensure there are no pops or clicks in between any music tracks
 155  * due to DAPM power cycling.
 156  */
 157 static void close_delayed_work(struct work_struct *work)
 158 {
 159         struct snd_soc_pcm_runtime *rtd =
 160                         container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
 161         struct snd_soc_dai *codec_dai = rtd->codec_dai;
 162
 163         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 164
 165         dev_dbg(rtd->dev, "ASoC: pop wq checking: %s status: %s waiting: %s\n",
 166                  codec_dai->driver->playback.stream_name,
 167                  codec_dai->playback_active ? "active" : "inactive",
 168                  rtd->pop_wait ? "yes" : "no");
 169
 170         /* are we waiting on this codec DAI stream */
 171         if (rtd->pop_wait == 1) {
 172                 rtd->pop_wait = 0;
 173                 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
 174                                           SND_SOC_DAPM_STREAM_STOP);
 175         }
 176
 177         mutex_unlock(&rtd->pcm_mutex);
 178 }
 179
 180 static int soc_compr_free(struct snd_compr_stream *cstream)
 181 {
 182         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 183         struct snd_soc_platform *platform = rtd->platform;
 184         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 185         struct snd_soc_dai *codec_dai = rtd->codec_dai;
 186         int stream;
 187
 188         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 189
 190         if (cstream->direction == SND_COMPRESS_PLAYBACK)
 191                 stream = SNDRV_PCM_STREAM_PLAYBACK;
 192         else
 193                 stream = SNDRV_PCM_STREAM_CAPTURE;
 194
 195         snd_soc_runtime_deactivate(rtd, stream);
 196
 197         snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
 198
 199         if (!cpu_dai->active)
 200                 cpu_dai->rate = 0;
 201
 202         if (!codec_dai->active)
 203                 codec_dai->rate = 0;
 204
 205
 206         if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->shutdown)
 207                 rtd->dai_link->compr_ops->shutdown(cstream);
 208
 209         if (platform->driver->compr_ops && platform->driver->compr_ops->free)
 210                 platform->driver->compr_ops->free(cstream);
 211
 212         if (cstream->direction == SND_COMPRESS_PLAYBACK) {
 213                 if (snd_soc_runtime_ignore_pmdown_time(rtd)) {
 214                         snd_soc_dapm_stream_event(rtd,
 215                                         SNDRV_PCM_STREAM_PLAYBACK,
 216                                         SND_SOC_DAPM_STREAM_STOP);
 217                 } else {
 218                         rtd->pop_wait = 1;
 219                         queue_delayed_work(system_power_efficient_wq,
 220                                            &rtd->delayed_work,
 221                                            msecs_to_jiffies(rtd->pmdown_time));
 222                 }
 223         } else {
 224                 /* capture streams can be powered down now */
 225                 snd_soc_dapm_stream_event(rtd,
 226                         SNDRV_PCM_STREAM_CAPTURE,
 227                         SND_SOC_DAPM_STREAM_STOP);
 228         }
 229
 230         mutex_unlock(&rtd->pcm_mutex);
 231         return 0;
 232 }
 233
 234 static int soc_compr_free_fe(struct snd_compr_stream *cstream)
 235 {
 236         struct snd_soc_pcm_runtime *fe = cstream->private_data;
 237         struct snd_soc_platform *platform = fe->platform;
 238         struct snd_soc_dpcm *dpcm;
 239         int stream, ret;
 240
 241         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
 242
 243         if (cstream->direction == SND_COMPRESS_PLAYBACK)
 244                 stream = SNDRV_PCM_STREAM_PLAYBACK;
 245         else
 246                 stream = SNDRV_PCM_STREAM_CAPTURE;
 247
 248         snd_soc_runtime_deactivate(fe, stream);
 249
 250         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
 251
 252         ret = dpcm_be_dai_hw_free(fe, stream);
 253         if (ret < 0)
 254                 dev_err(fe->dev, "compressed hw_free failed %d\n", ret);
 255
 256         ret = dpcm_be_dai_shutdown(fe, stream);
 257
 258         /* mark FE's links ready to prune */
 259         list_for_each_entry(dpcm, &fe->dpcm[stream].be_clients, list_be)
 260                 dpcm->state = SND_SOC_DPCM_LINK_STATE_FREE;
 261
 262         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_STOP);
 263
 264         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_CLOSE;
 265         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
 266
 267         dpcm_be_disconnect(fe, stream);
 268
 269         fe->dpcm[stream].runtime = NULL;
 270
 271         if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->shutdown)
 272                 fe->dai_link->compr_ops->shutdown(cstream);
 273
 274         if (platform->driver->compr_ops && platform->driver->compr_ops->free)
 275                 platform->driver->compr_ops->free(cstream);
 276
 277         mutex_unlock(&fe->card->mutex);
 278         return 0;
 279 }
 280
 281 static int soc_compr_trigger(struct snd_compr_stream *cstream, int cmd)
 282 {
 283
 284         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 285         struct snd_soc_platform *platform = rtd->platform;
 286         struct snd_soc_dai *codec_dai = rtd->codec_dai;
 287         int ret = 0;
 288
 289         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 290
 291         if (platform->driver->compr_ops && platform->driver->compr_ops->trigger) {
 292                 ret = platform->driver->compr_ops->trigger(cstream, cmd);
 293                 if (ret < 0)
 294                         goto out;
 295         }
 296
 297         switch (cmd) {
 298         case SNDRV_PCM_TRIGGER_START:
 299                 snd_soc_dai_digital_mute(codec_dai, 0, cstream->direction);
 300                 break;
 301         case SNDRV_PCM_TRIGGER_STOP:
 302                 snd_soc_dai_digital_mute(codec_dai, 1, cstream->direction);
 303                 break;
 304         }
 305
 306 out:
 307         mutex_unlock(&rtd->pcm_mutex);
 308         return ret;
 309 }
 310
 311 static int soc_compr_trigger_fe(struct snd_compr_stream *cstream, int cmd)
 312 {
 313         struct snd_soc_pcm_runtime *fe = cstream->private_data;
 314         struct snd_soc_platform *platform = fe->platform;
 315         int ret = 0, stream;
 316
 317         if (cmd == SND_COMPR_TRIGGER_PARTIAL_DRAIN ||
 318                 cmd == SND_COMPR_TRIGGER_DRAIN) {
 319
 320                 if (platform->driver->compr_ops &&
 321                     platform->driver->compr_ops->trigger)
 322                         return platform->driver->compr_ops->trigger(cstream,
 323                                                                     cmd);
 324         }
 325
 326         if (cstream->direction == SND_COMPRESS_PLAYBACK)
 327                 stream = SNDRV_PCM_STREAM_PLAYBACK;
 328         else
 329                 stream = SNDRV_PCM_STREAM_CAPTURE;
 330
 331
 332         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
 333
 334         if (platform->driver->compr_ops && platform->driver->compr_ops->trigger) {
 335                 ret = platform->driver->compr_ops->trigger(cstream, cmd);
 336                 if (ret < 0)
 337                         goto out;
 338         }
 339
 340         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
 341
 342         ret = dpcm_be_dai_trigger(fe, stream, cmd);
 343
 344         switch (cmd) {
 345         case SNDRV_PCM_TRIGGER_START:
 346         case SNDRV_PCM_TRIGGER_RESUME:
 347         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 348                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_START;
 349                 break;
 350         case SNDRV_PCM_TRIGGER_STOP:
 351         case SNDRV_PCM_TRIGGER_SUSPEND:
 352                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_STOP;
 353                 break;
 354         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 355                 fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PAUSED;
 356                 break;
 357         }
 358
 359 out:
 360         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
 361         mutex_unlock(&fe->card->mutex);
 362         return ret;
 363 }
 364
 365 static int soc_compr_set_params(struct snd_compr_stream *cstream,
 366                                         struct snd_compr_params *params)
 367 {
 368         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 369         struct snd_soc_platform *platform = rtd->platform;
 370         int ret = 0;
 371
 372         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 373
 374         /* first we call set_params for the platform driver
 375          * this should configure the soc side
 376          * if the machine has compressed ops then we call that as well
 377          * expectation is that platform and machine will configure everything
 378          * for this compress path, like configuring pcm port for codec
 379          */
 380         if (platform->driver->compr_ops && platform->driver->compr_ops->set_params) {
 381                 ret = platform->driver->compr_ops->set_params(cstream, params);
 382                 if (ret < 0)
 383                         goto err;
 384         }
 385
 386         if (rtd->dai_link->compr_ops && rtd->dai_link->compr_ops->set_params) {
 387                 ret = rtd->dai_link->compr_ops->set_params(cstream);
 388                 if (ret < 0)
 389                         goto err;
 390         }
 391
 392         if (cstream->direction == SND_COMPRESS_PLAYBACK)
 393                 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_PLAYBACK,
 394                                         SND_SOC_DAPM_STREAM_START);
 395         else
 396                 snd_soc_dapm_stream_event(rtd, SNDRV_PCM_STREAM_CAPTURE,
 397                                         SND_SOC_DAPM_STREAM_START);
 398
 399         /* cancel any delayed stream shutdown that is pending */
 400         rtd->pop_wait = 0;
 401         mutex_unlock(&rtd->pcm_mutex);
 402
 403         cancel_delayed_work_sync(&rtd->delayed_work);
 404
 405         return ret;
 406
 407 err:
 408         mutex_unlock(&rtd->pcm_mutex);
 409         return ret;
 410 }
 411
 412 static int soc_compr_set_params_fe(struct snd_compr_stream *cstream,
 413                                         struct snd_compr_params *params)
 414 {
 415         struct snd_soc_pcm_runtime *fe = cstream->private_data;
 416         struct snd_pcm_substream *fe_substream =
 417                  fe->pcm->streams[cstream->direction].substream;
 418         struct snd_soc_platform *platform = fe->platform;
 419         int ret = 0, stream;
 420
 421         if (cstream->direction == SND_COMPRESS_PLAYBACK)
 422                 stream = SNDRV_PCM_STREAM_PLAYBACK;
 423         else
 424                 stream = SNDRV_PCM_STREAM_CAPTURE;
 425
 426         mutex_lock_nested(&fe->card->mutex, SND_SOC_CARD_CLASS_RUNTIME);
 427
 428         if (platform->driver->compr_ops && platform->driver->compr_ops->set_params) {
 429                 ret = platform->driver->compr_ops->set_params(cstream, params);
 430                 if (ret < 0)
 431                         goto out;
 432         }
 433
 434         if (fe->dai_link->compr_ops && fe->dai_link->compr_ops->set_params) {
 435                 ret = fe->dai_link->compr_ops->set_params(cstream);
 436                 if (ret < 0)
 437                         goto out;
 438         }
 439
 440         /*
 441          * Create an empty hw_params for the BE as the machine driver must
 442          * fix this up to match DSP decoder and ASRC configuration.
 443          * I.e. machine driver fixup for compressed BE is mandatory.
 444          */
 445         memset(&fe->dpcm[fe_substream->stream].hw_params, 0,
 446                 sizeof(struct snd_pcm_hw_params));
 447
 448         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_FE;
 449
 450         ret = dpcm_be_dai_hw_params(fe, stream);
 451         if (ret < 0)
 452                 goto out;
 453
 454         ret = dpcm_be_dai_prepare(fe, stream);
 455         if (ret < 0)
 456                 goto out;
 457
 458         dpcm_dapm_stream_event(fe, stream, SND_SOC_DAPM_STREAM_START);
 459         fe->dpcm[stream].state = SND_SOC_DPCM_STATE_PREPARE;
 460
 461 out:
 462         fe->dpcm[stream].runtime_update = SND_SOC_DPCM_UPDATE_NO;
 463         mutex_unlock(&fe->card->mutex);
 464         return ret;
 465 }
 466
 467 static int soc_compr_get_params(struct snd_compr_stream *cstream,
 468                                         struct snd_codec *params)
 469 {
 470         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 471         struct snd_soc_platform *platform = rtd->platform;
 472         int ret = 0;
 473
 474         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 475
 476         if (platform->driver->compr_ops && platform->driver->compr_ops->get_params)
 477                 ret = platform->driver->compr_ops->get_params(cstream, params);
 478
 479         mutex_unlock(&rtd->pcm_mutex);
 480         return ret;
 481 }
 482
 483 static int soc_compr_get_caps(struct snd_compr_stream *cstream,
 484                                 struct snd_compr_caps *caps)
 485 {
 486         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 487         struct snd_soc_platform *platform = rtd->platform;
 488         int ret = 0;
 489
 490         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 491
 492         if (platform->driver->compr_ops && platform->driver->compr_ops->get_caps)
 493                 ret = platform->driver->compr_ops->get_caps(cstream, caps);
 494
 495         mutex_unlock(&rtd->pcm_mutex);
 496         return ret;
 497 }
 498
 499 static int soc_compr_get_codec_caps(struct snd_compr_stream *cstream,
 500                                 struct snd_compr_codec_caps *codec)
 501 {
 502         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 503         struct snd_soc_platform *platform = rtd->platform;
 504         int ret = 0;
 505
 506         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 507
 508         if (platform->driver->compr_ops && platform->driver->compr_ops->get_codec_caps)
 509                 ret = platform->driver->compr_ops->get_codec_caps(cstream, codec);
 510
 511         mutex_unlock(&rtd->pcm_mutex);
 512         return ret;
 513 }
 514
 515 static int soc_compr_ack(struct snd_compr_stream *cstream, size_t bytes)
 516 {
 517         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 518         struct snd_soc_platform *platform = rtd->platform;
 519         int ret = 0;
 520
 521         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 522
 523         if (platform->driver->compr_ops && platform->driver->compr_ops->ack)
 524                 ret = platform->driver->compr_ops->ack(cstream, bytes);
 525
 526         mutex_unlock(&rtd->pcm_mutex);
 527         return ret;
 528 }
 529
 530 static int soc_compr_pointer(struct snd_compr_stream *cstream,
 531                         struct snd_compr_tstamp *tstamp)
 532 {
 533         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 534         struct snd_soc_platform *platform = rtd->platform;
 535
 536         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 537
 538         if (platform->driver->compr_ops && platform->driver->compr_ops->pointer)
 539                  platform->driver->compr_ops->pointer(cstream, tstamp);
 540
 541         mutex_unlock(&rtd->pcm_mutex);
 542         return 0;
 543 }
 544
 545 static int soc_compr_copy(struct snd_compr_stream *cstream,
 546                           char __user *buf, size_t count)
 547 {
 548         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 549         struct snd_soc_platform *platform = rtd->platform;
 550         int ret = 0;
 551
 552         mutex_lock_nested(&rtd->pcm_mutex, rtd->pcm_subclass);
 553
 554         if (platform->driver->compr_ops && platform->driver->compr_ops->copy)
 555                 ret = platform->driver->compr_ops->copy(cstream, buf, count);
 556
 557         mutex_unlock(&rtd->pcm_mutex);
 558         return ret;
 559 }
 560
 561 static int soc_compr_set_metadata(struct snd_compr_stream *cstream,
 562                                 struct snd_compr_metadata *metadata)
 563 {
 564         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 565         struct snd_soc_platform *platform = rtd->platform;
 566         int ret = 0;
 567
 568         if (platform->driver->compr_ops && platform->driver->compr_ops->set_metadata)
 569                 ret = platform->driver->compr_ops->set_metadata(cstream, metadata);
 570
 571         return ret;
 572 }
 573
 574 static int soc_compr_get_metadata(struct snd_compr_stream *cstream,
 575                                 struct snd_compr_metadata *metadata)
 576 {
 577         struct snd_soc_pcm_runtime *rtd = cstream->private_data;
 578         struct snd_soc_platform *platform = rtd->platform;
 579         int ret = 0;
 580
 581         if (platform->driver->compr_ops && platform->driver->compr_ops->get_metadata)
 582                 ret = platform->driver->compr_ops->get_metadata(cstream, metadata);
 583
 584         return ret;
 585 }
 586
 587 /* ASoC Compress operations */
 588 static struct snd_compr_ops soc_compr_ops = {
 589         .open           = soc_compr_open,
 590         .free           = soc_compr_free,
 591         .set_params     = soc_compr_set_params,
 592         .set_metadata   = soc_compr_set_metadata,
 593         .get_metadata   = soc_compr_get_metadata,
 594         .get_params     = soc_compr_get_params,
 595         .trigger        = soc_compr_trigger,
 596         .pointer        = soc_compr_pointer,
 597         .ack            = soc_compr_ack,
 598         .get_caps       = soc_compr_get_caps,
 599         .get_codec_caps = soc_compr_get_codec_caps
 600 };
 601
 602 /* ASoC Dynamic Compress operations */
 603 static struct snd_compr_ops soc_compr_dyn_ops = {
 604         .open           = soc_compr_open_fe,
 605         .free           = soc_compr_free_fe,
 606         .set_params     = soc_compr_set_params_fe,
 607         .get_params     = soc_compr_get_params,
 608         .set_metadata   = soc_compr_set_metadata,
 609         .get_metadata   = soc_compr_get_metadata,
 610         .trigger        = soc_compr_trigger_fe,
 611         .pointer        = soc_compr_pointer,
 612         .ack            = soc_compr_ack,
 613         .get_caps       = soc_compr_get_caps,
 614         .get_codec_caps = soc_compr_get_codec_caps
 615 };
 616
 617 /**
 618  * snd_soc_new_compress - create a new compress.
 619  *
 620  * @rtd: The runtime for which we will create compress
 621  * @num: the device index number (zero based - shared with normal PCMs)
 622  *
 623  * Return: 0 for success, else error.
 624  */
 625 int snd_soc_new_compress(struct snd_soc_pcm_runtime *rtd, int num)
 626 {
 627         struct snd_soc_codec *codec = rtd->codec;
 628         struct snd_soc_platform *platform = rtd->platform;
 629         struct snd_soc_dai *codec_dai = rtd->codec_dai;
 630         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
 631         struct snd_compr *compr;
 632         struct snd_pcm *be_pcm;
 633         char new_name[64];
 634         int ret = 0, direction = 0;
 635         int playback = 0, capture = 0;
 636
 637         if (rtd->num_codecs > 1) {
 638                 dev_err(rtd->card->dev, "Multicodec not supported for compressed stream\n");
 639                 return -EINVAL;
 640         }
 641
 642         /* check client and interface hw capabilities */
 643         snprintf(new_name, sizeof(new_name), "%s %s-%d",
 644                         rtd->dai_link->stream_name, codec_dai->name, num);
 645
 646         if (codec_dai->driver->playback.channels_min)
 647                 playback = 1;
 648         if (codec_dai->driver->capture.channels_min)
 649                 capture = 1;
 650
 651         capture = capture && cpu_dai->driver->capture.channels_min;
 652         playback = playback && cpu_dai->driver->playback.channels_min;
 653
 654         /*
 655          * Compress devices are unidirectional so only one of the directions
 656          * should be set, check for that (xor)
 657          */
 658         if (playback + capture != 1) {
 659                 dev_err(rtd->card->dev, "Invalid direction for compress P %d, C %d\n",
 660                                 playback, capture);
 661                 return -EINVAL;
 662         }
 663
 664         if(playback)
 665                 direction = SND_COMPRESS_PLAYBACK;
 666         else
 667                 direction = SND_COMPRESS_CAPTURE;
 668
 669         compr = kzalloc(sizeof(*compr), GFP_KERNEL);
 670         if (compr == NULL) {
 671                 snd_printk(KERN_ERR "Cannot allocate compr\n");
 672                 return -ENOMEM;
 673         }
 674
 675         compr->ops = devm_kzalloc(rtd->card->dev, sizeof(soc_compr_ops),
 676                                   GFP_KERNEL);
 677         if (compr->ops == NULL) {
 678                 dev_err(rtd->card->dev, "Cannot allocate compressed ops\n");
 679                 ret = -ENOMEM;
 680                 goto compr_err;
 681         }
 682
 683         if (rtd->dai_link->dynamic) {
 684                 snprintf(new_name, sizeof(new_name), "(%s)",
 685                         rtd->dai_link->stream_name);
 686
 687                 ret = snd_pcm_new_internal(rtd->card->snd_card, new_name, num,
 688                                 rtd->dai_link->dpcm_playback,
 689                                 rtd->dai_link->dpcm_capture, &be_pcm);
 690                 if (ret < 0) {
 691                         dev_err(rtd->card->dev, "ASoC: can't create compressed for %s\n",
 692                                 rtd->dai_link->name);
 693                         goto compr_err;
 694                 }
 695
 696                 rtd->pcm = be_pcm;
 697                 rtd->fe_compr = 1;
 698                 if (rtd->dai_link->dpcm_playback)
 699                         be_pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream->private_data = rtd;
 700                 else if (rtd->dai_link->dpcm_capture)
 701                         be_pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream->private_data = rtd;
 702                 memcpy(compr->ops, &soc_compr_dyn_ops, sizeof(soc_compr_dyn_ops));
 703         } else
 704                 memcpy(compr->ops, &soc_compr_ops, sizeof(soc_compr_ops));
 705
 706         /* Add copy callback for not memory mapped DSPs */
 707         if (platform->driver->compr_ops && platform->driver->compr_ops->copy)
 708                 compr->ops->copy = soc_compr_copy;
 709
 710         mutex_init(&compr->lock);
 711         ret = snd_compress_new(rtd->card->snd_card, num, direction, compr);
 712         if (ret < 0) {
 713                 pr_err("compress asoc: can't create compress for codec %s\n",
 714                         codec->component.name);
 715                 goto compr_err;
 716         }
 717
 718         /* DAPM dai link stream work */
 719         INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
 720
 721         rtd->compr = compr;
 722         compr->private_data = rtd;
 723
 724         printk(KERN_INFO "compress asoc: %s <-> %s mapping ok\n", codec_dai->name,
 725                 cpu_dai->name);
 726         return ret;
 727
 728 compr_err:
 729         kfree(compr);
 730         return ret;
 731 }
 732 EXPORT_SYMBOL_GPL(snd_soc_new_compress);