linux/sound/soc/intel/haswell/sst-haswell-pcm.c
<<
>>
Prefs
   1/*
   2 * Intel SST Haswell/Broadwell PCM Support
   3 *
   4 * Copyright (C) 2013, Intel Corporation. All rights reserved.
   5 *
   6 * This program is free software; you can redistribute it and/or
   7 * modify it under the terms of the GNU General Public License version
   8 * 2 as published by the Free Software Foundation.
   9 *
  10 * This program is distributed in the hope that it will be useful,
  11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 * GNU General Public License for more details.
  14 *
  15 */
  16
  17#include <linux/module.h>
  18#include <linux/dma-mapping.h>
  19#include <linux/slab.h>
  20#include <linux/delay.h>
  21#include <linux/pm_runtime.h>
  22#include <asm/page.h>
  23#include <asm/pgtable.h>
  24#include <sound/core.h>
  25#include <sound/pcm.h>
  26#include <sound/pcm_params.h>
  27#include <sound/dmaengine_pcm.h>
  28#include <sound/soc.h>
  29#include <sound/tlv.h>
  30#include <sound/compress_driver.h>
  31
  32#include "../haswell/sst-haswell-ipc.h"
  33#include "../common/sst-dsp-priv.h"
  34#include "../common/sst-dsp.h"
  35
  36#define HSW_PCM_COUNT           6
  37#define HSW_VOLUME_MAX          0x7FFFFFFF      /* 0dB */
  38
  39#define SST_OLD_POSITION(d, r, o) ((d) +                \
  40                        frames_to_bytes(r, o))
  41#define SST_SAMPLES(r, x) (bytes_to_samples(r,  \
  42                        frames_to_bytes(r, (x))))
  43
  44/* simple volume table */
  45static const u32 volume_map[] = {
  46        HSW_VOLUME_MAX >> 30,
  47        HSW_VOLUME_MAX >> 29,
  48        HSW_VOLUME_MAX >> 28,
  49        HSW_VOLUME_MAX >> 27,
  50        HSW_VOLUME_MAX >> 26,
  51        HSW_VOLUME_MAX >> 25,
  52        HSW_VOLUME_MAX >> 24,
  53        HSW_VOLUME_MAX >> 23,
  54        HSW_VOLUME_MAX >> 22,
  55        HSW_VOLUME_MAX >> 21,
  56        HSW_VOLUME_MAX >> 20,
  57        HSW_VOLUME_MAX >> 19,
  58        HSW_VOLUME_MAX >> 18,
  59        HSW_VOLUME_MAX >> 17,
  60        HSW_VOLUME_MAX >> 16,
  61        HSW_VOLUME_MAX >> 15,
  62        HSW_VOLUME_MAX >> 14,
  63        HSW_VOLUME_MAX >> 13,
  64        HSW_VOLUME_MAX >> 12,
  65        HSW_VOLUME_MAX >> 11,
  66        HSW_VOLUME_MAX >> 10,
  67        HSW_VOLUME_MAX >> 9,
  68        HSW_VOLUME_MAX >> 8,
  69        HSW_VOLUME_MAX >> 7,
  70        HSW_VOLUME_MAX >> 6,
  71        HSW_VOLUME_MAX >> 5,
  72        HSW_VOLUME_MAX >> 4,
  73        HSW_VOLUME_MAX >> 3,
  74        HSW_VOLUME_MAX >> 2,
  75        HSW_VOLUME_MAX >> 1,
  76        HSW_VOLUME_MAX >> 0,
  77};
  78
  79#define HSW_PCM_PERIODS_MAX     64
  80#define HSW_PCM_PERIODS_MIN     2
  81
  82#define HSW_PCM_DAI_ID_SYSTEM   0
  83#define HSW_PCM_DAI_ID_OFFLOAD0 1
  84#define HSW_PCM_DAI_ID_OFFLOAD1 2
  85#define HSW_PCM_DAI_ID_LOOPBACK 3
  86
  87
  88static const struct snd_pcm_hardware hsw_pcm_hardware = {
  89        .info                   = SNDRV_PCM_INFO_MMAP |
  90                                  SNDRV_PCM_INFO_MMAP_VALID |
  91                                  SNDRV_PCM_INFO_INTERLEAVED |
  92                                  SNDRV_PCM_INFO_PAUSE |
  93                                  SNDRV_PCM_INFO_RESUME |
  94                                  SNDRV_PCM_INFO_NO_PERIOD_WAKEUP |
  95                                  SNDRV_PCM_INFO_DRAIN_TRIGGER,
  96        .formats                = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE |
  97                                  SNDRV_PCM_FMTBIT_S32_LE,
  98        .period_bytes_min       = PAGE_SIZE,
  99        .period_bytes_max       = (HSW_PCM_PERIODS_MAX / HSW_PCM_PERIODS_MIN) * PAGE_SIZE,
 100        .periods_min            = HSW_PCM_PERIODS_MIN,
 101        .periods_max            = HSW_PCM_PERIODS_MAX,
 102        .buffer_bytes_max       = HSW_PCM_PERIODS_MAX * PAGE_SIZE,
 103};
 104
 105struct hsw_pcm_module_map {
 106        int dai_id;
 107        int stream;
 108        enum sst_hsw_module_id mod_id;
 109};
 110
 111/* private data for each PCM DSP stream */
 112struct hsw_pcm_data {
 113        int dai_id;
 114        struct sst_hsw_stream *stream;
 115        struct sst_module_runtime *runtime;
 116        struct sst_module_runtime_context context;
 117        struct snd_pcm *hsw_pcm;
 118        u32 volume[2];
 119        struct snd_pcm_substream *substream;
 120        struct snd_compr_stream *cstream;
 121        unsigned int wpos;
 122        struct mutex mutex;
 123        bool allocated;
 124        int persistent_offset;
 125};
 126
 127enum hsw_pm_state {
 128        HSW_PM_STATE_D0 = 0,
 129        HSW_PM_STATE_RTD3 = 1,
 130        HSW_PM_STATE_D3 = 2,
 131};
 132
 133/* private data for the driver */
 134struct hsw_priv_data {
 135        /* runtime DSP */
 136        struct sst_hsw *hsw;
 137        struct device *dev;
 138        enum hsw_pm_state pm_state;
 139        struct snd_soc_card *soc_card;
 140        struct sst_module_runtime *runtime_waves; /* sound effect module */
 141
 142        /* page tables */
 143        struct snd_dma_buffer dmab[HSW_PCM_COUNT][2];
 144
 145        /* DAI data */
 146        struct hsw_pcm_data pcm[HSW_PCM_COUNT][2];
 147};
 148
 149
 150/* static mappings between PCMs and modules - may be dynamic in future */
 151static struct hsw_pcm_module_map mod_map[] = {
 152        {HSW_PCM_DAI_ID_SYSTEM, 0, SST_HSW_MODULE_PCM_SYSTEM},
 153        {HSW_PCM_DAI_ID_OFFLOAD0, 0, SST_HSW_MODULE_PCM},
 154        {HSW_PCM_DAI_ID_OFFLOAD1, 0, SST_HSW_MODULE_PCM},
 155        {HSW_PCM_DAI_ID_LOOPBACK, 1, SST_HSW_MODULE_PCM_REFERENCE},
 156        {HSW_PCM_DAI_ID_SYSTEM, 1, SST_HSW_MODULE_PCM_CAPTURE},
 157};
 158
 159static u32 hsw_notify_pointer(struct sst_hsw_stream *stream, void *data);
 160
 161static inline u32 hsw_mixer_to_ipc(unsigned int value)
 162{
 163        if (value >= ARRAY_SIZE(volume_map))
 164                return volume_map[0];
 165        else
 166                return volume_map[value];
 167}
 168
 169static inline unsigned int hsw_ipc_to_mixer(u32 value)
 170{
 171        int i;
 172
 173        for (i = 0; i < ARRAY_SIZE(volume_map); i++) {
 174                if (volume_map[i] >= value)
 175                        return i;
 176        }
 177
 178        return i - 1;
 179}
 180
 181static int hsw_stream_volume_put(struct snd_kcontrol *kcontrol,
 182                                struct snd_ctl_elem_value *ucontrol)
 183{
 184        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 185        struct soc_mixer_control *mc =
 186                (struct soc_mixer_control *)kcontrol->private_value;
 187        struct hsw_priv_data *pdata =
 188                snd_soc_component_get_drvdata(component);
 189        struct hsw_pcm_data *pcm_data;
 190        struct sst_hsw *hsw = pdata->hsw;
 191        u32 volume;
 192        int dai, stream;
 193
 194        dai = mod_map[mc->reg].dai_id;
 195        stream = mod_map[mc->reg].stream;
 196        pcm_data = &pdata->pcm[dai][stream];
 197
 198        mutex_lock(&pcm_data->mutex);
 199        pm_runtime_get_sync(pdata->dev);
 200
 201        if (!pcm_data->stream) {
 202                pcm_data->volume[0] =
 203                        hsw_mixer_to_ipc(ucontrol->value.integer.value[0]);
 204                pcm_data->volume[1] =
 205                        hsw_mixer_to_ipc(ucontrol->value.integer.value[1]);
 206                pm_runtime_mark_last_busy(pdata->dev);
 207                pm_runtime_put_autosuspend(pdata->dev);
 208                mutex_unlock(&pcm_data->mutex);
 209                return 0;
 210        }
 211
 212        if (ucontrol->value.integer.value[0] ==
 213                ucontrol->value.integer.value[1]) {
 214                volume = hsw_mixer_to_ipc(ucontrol->value.integer.value[0]);
 215                /* apply volume value to all channels */
 216                sst_hsw_stream_set_volume(hsw, pcm_data->stream, 0, SST_HSW_CHANNELS_ALL, volume);
 217        } else {
 218                volume = hsw_mixer_to_ipc(ucontrol->value.integer.value[0]);
 219                sst_hsw_stream_set_volume(hsw, pcm_data->stream, 0, 0, volume);
 220                volume = hsw_mixer_to_ipc(ucontrol->value.integer.value[1]);
 221                sst_hsw_stream_set_volume(hsw, pcm_data->stream, 0, 1, volume);
 222        }
 223
 224        pm_runtime_mark_last_busy(pdata->dev);
 225        pm_runtime_put_autosuspend(pdata->dev);
 226        mutex_unlock(&pcm_data->mutex);
 227        return 0;
 228}
 229
 230static int hsw_stream_volume_get(struct snd_kcontrol *kcontrol,
 231                                struct snd_ctl_elem_value *ucontrol)
 232{
 233        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 234        struct soc_mixer_control *mc =
 235                (struct soc_mixer_control *)kcontrol->private_value;
 236        struct hsw_priv_data *pdata =
 237                snd_soc_component_get_drvdata(component);
 238        struct hsw_pcm_data *pcm_data;
 239        struct sst_hsw *hsw = pdata->hsw;
 240        u32 volume;
 241        int dai, stream;
 242
 243        dai = mod_map[mc->reg].dai_id;
 244        stream = mod_map[mc->reg].stream;
 245        pcm_data = &pdata->pcm[dai][stream];
 246
 247        mutex_lock(&pcm_data->mutex);
 248        pm_runtime_get_sync(pdata->dev);
 249
 250        if (!pcm_data->stream) {
 251                ucontrol->value.integer.value[0] =
 252                        hsw_ipc_to_mixer(pcm_data->volume[0]);
 253                ucontrol->value.integer.value[1] =
 254                        hsw_ipc_to_mixer(pcm_data->volume[1]);
 255                pm_runtime_mark_last_busy(pdata->dev);
 256                pm_runtime_put_autosuspend(pdata->dev);
 257                mutex_unlock(&pcm_data->mutex);
 258                return 0;
 259        }
 260
 261        sst_hsw_stream_get_volume(hsw, pcm_data->stream, 0, 0, &volume);
 262        ucontrol->value.integer.value[0] = hsw_ipc_to_mixer(volume);
 263        sst_hsw_stream_get_volume(hsw, pcm_data->stream, 0, 1, &volume);
 264        ucontrol->value.integer.value[1] = hsw_ipc_to_mixer(volume);
 265
 266        pm_runtime_mark_last_busy(pdata->dev);
 267        pm_runtime_put_autosuspend(pdata->dev);
 268        mutex_unlock(&pcm_data->mutex);
 269
 270        return 0;
 271}
 272
 273static int hsw_volume_put(struct snd_kcontrol *kcontrol,
 274                                struct snd_ctl_elem_value *ucontrol)
 275{
 276        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 277        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 278        struct sst_hsw *hsw = pdata->hsw;
 279        u32 volume;
 280
 281        pm_runtime_get_sync(pdata->dev);
 282
 283        if (ucontrol->value.integer.value[0] ==
 284                ucontrol->value.integer.value[1]) {
 285
 286                volume = hsw_mixer_to_ipc(ucontrol->value.integer.value[0]);
 287                sst_hsw_mixer_set_volume(hsw, 0, SST_HSW_CHANNELS_ALL, volume);
 288
 289        } else {
 290                volume = hsw_mixer_to_ipc(ucontrol->value.integer.value[0]);
 291                sst_hsw_mixer_set_volume(hsw, 0, 0, volume);
 292
 293                volume = hsw_mixer_to_ipc(ucontrol->value.integer.value[1]);
 294                sst_hsw_mixer_set_volume(hsw, 0, 1, volume);
 295        }
 296
 297        pm_runtime_mark_last_busy(pdata->dev);
 298        pm_runtime_put_autosuspend(pdata->dev);
 299        return 0;
 300}
 301
 302static int hsw_volume_get(struct snd_kcontrol *kcontrol,
 303                                struct snd_ctl_elem_value *ucontrol)
 304{
 305        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 306        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 307        struct sst_hsw *hsw = pdata->hsw;
 308        unsigned int volume = 0;
 309
 310        pm_runtime_get_sync(pdata->dev);
 311        sst_hsw_mixer_get_volume(hsw, 0, 0, &volume);
 312        ucontrol->value.integer.value[0] = hsw_ipc_to_mixer(volume);
 313
 314        sst_hsw_mixer_get_volume(hsw, 0, 1, &volume);
 315        ucontrol->value.integer.value[1] = hsw_ipc_to_mixer(volume);
 316
 317        pm_runtime_mark_last_busy(pdata->dev);
 318        pm_runtime_put_autosuspend(pdata->dev);
 319        return 0;
 320}
 321
 322static int hsw_waves_switch_get(struct snd_kcontrol *kcontrol,
 323                                struct snd_ctl_elem_value *ucontrol)
 324{
 325        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 326        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 327        struct sst_hsw *hsw = pdata->hsw;
 328        enum sst_hsw_module_id id = SST_HSW_MODULE_WAVES;
 329
 330        ucontrol->value.integer.value[0] =
 331                (sst_hsw_is_module_active(hsw, id) ||
 332                sst_hsw_is_module_enabled_rtd3(hsw, id));
 333        return 0;
 334}
 335
 336static int hsw_waves_switch_put(struct snd_kcontrol *kcontrol,
 337                                struct snd_ctl_elem_value *ucontrol)
 338{
 339        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 340        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 341        struct sst_hsw *hsw = pdata->hsw;
 342        int ret = 0;
 343        enum sst_hsw_module_id id = SST_HSW_MODULE_WAVES;
 344        bool switch_on = (bool)ucontrol->value.integer.value[0];
 345
 346        /* if module is in RAM on the DSP, apply user settings to module through
 347         * ipc. If module is not in RAM on the DSP, store user setting for
 348         * track */
 349        if (sst_hsw_is_module_loaded(hsw, id)) {
 350                if (switch_on == sst_hsw_is_module_active(hsw, id))
 351                        return 0;
 352
 353                if (switch_on)
 354                        ret = sst_hsw_module_enable(hsw, id, 0);
 355                else
 356                        ret = sst_hsw_module_disable(hsw, id, 0);
 357        } else {
 358                if (switch_on == sst_hsw_is_module_enabled_rtd3(hsw, id))
 359                        return 0;
 360
 361                if (switch_on)
 362                        sst_hsw_set_module_enabled_rtd3(hsw, id);
 363                else
 364                        sst_hsw_set_module_disabled_rtd3(hsw, id);
 365        }
 366
 367        return ret;
 368}
 369
 370static int hsw_waves_param_get(struct snd_kcontrol *kcontrol,
 371                                struct snd_ctl_elem_value *ucontrol)
 372{
 373        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 374        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 375        struct sst_hsw *hsw = pdata->hsw;
 376
 377        /* return a matching line from param buffer */
 378        return sst_hsw_load_param_line(hsw, ucontrol->value.bytes.data);
 379}
 380
 381static int hsw_waves_param_put(struct snd_kcontrol *kcontrol,
 382                                struct snd_ctl_elem_value *ucontrol)
 383{
 384        struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 385        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 386        struct sst_hsw *hsw = pdata->hsw;
 387        int ret;
 388        enum sst_hsw_module_id id = SST_HSW_MODULE_WAVES;
 389        int param_id = ucontrol->value.bytes.data[0];
 390        int param_size = WAVES_PARAM_COUNT;
 391
 392        /* clear param buffer and reset buffer index */
 393        if (param_id == 0xFF) {
 394                sst_hsw_reset_param_buf(hsw);
 395                return 0;
 396        }
 397
 398        /* store params into buffer */
 399        ret = sst_hsw_store_param_line(hsw, ucontrol->value.bytes.data);
 400        if (ret < 0)
 401                return ret;
 402
 403        if (sst_hsw_is_module_active(hsw, id))
 404                ret = sst_hsw_module_set_param(hsw, id, 0, param_id,
 405                                param_size, ucontrol->value.bytes.data);
 406        return ret;
 407}
 408
 409/* TLV used by both global and stream volumes */
 410static const DECLARE_TLV_DB_SCALE(hsw_vol_tlv, -9000, 300, 1);
 411
 412/* System Pin has no volume control */
 413static const struct snd_kcontrol_new hsw_volume_controls[] = {
 414        /* Global DSP volume */
 415        SOC_DOUBLE_EXT_TLV("Master Playback Volume", 0, 0, 8,
 416                ARRAY_SIZE(volume_map) - 1, 0,
 417                hsw_volume_get, hsw_volume_put, hsw_vol_tlv),
 418        /* Offload 0 volume */
 419        SOC_DOUBLE_EXT_TLV("Media0 Playback Volume", 1, 0, 8,
 420                ARRAY_SIZE(volume_map) - 1, 0,
 421                hsw_stream_volume_get, hsw_stream_volume_put, hsw_vol_tlv),
 422        /* Offload 1 volume */
 423        SOC_DOUBLE_EXT_TLV("Media1 Playback Volume", 2, 0, 8,
 424                ARRAY_SIZE(volume_map) - 1, 0,
 425                hsw_stream_volume_get, hsw_stream_volume_put, hsw_vol_tlv),
 426        /* Mic Capture volume */
 427        SOC_DOUBLE_EXT_TLV("Mic Capture Volume", 4, 0, 8,
 428                ARRAY_SIZE(volume_map) - 1, 0,
 429                hsw_stream_volume_get, hsw_stream_volume_put, hsw_vol_tlv),
 430        /* enable/disable module waves */
 431        SOC_SINGLE_BOOL_EXT("Waves Switch", 0,
 432                hsw_waves_switch_get, hsw_waves_switch_put),
 433        /* set parameters to module waves */
 434        SND_SOC_BYTES_EXT("Waves Set Param", WAVES_PARAM_COUNT,
 435                hsw_waves_param_get, hsw_waves_param_put),
 436};
 437
 438/* Create DMA buffer page table for DSP */
 439static int create_adsp_page_table(struct snd_pcm_substream *substream,
 440        struct hsw_priv_data *pdata, struct snd_soc_pcm_runtime *rtd,
 441        unsigned char *dma_area, size_t size, int pcm)
 442{
 443        struct snd_dma_buffer *dmab = snd_pcm_get_dma_buf(substream);
 444        int i, pages, stream = substream->stream;
 445
 446        pages = snd_sgbuf_aligned_pages(size);
 447
 448        dev_dbg(rtd->dev, "generating page table for %p size 0x%zx pages %d\n",
 449                dma_area, size, pages);
 450
 451        for (i = 0; i < pages; i++) {
 452                u32 idx = (((i << 2) + i)) >> 1;
 453                u32 pfn = snd_sgbuf_get_addr(dmab, i * PAGE_SIZE) >> PAGE_SHIFT;
 454                u32 *pg_table;
 455
 456                dev_dbg(rtd->dev, "pfn i %i idx %d pfn %x\n", i, idx, pfn);
 457
 458                pg_table = (u32 *)(pdata->dmab[pcm][stream].area + idx);
 459
 460                if (i & 1)
 461                        *pg_table |= (pfn << 4);
 462                else
 463                        *pg_table |= pfn;
 464        }
 465
 466        return 0;
 467}
 468
 469/* this may get called several times by oss emulation */
 470static int hsw_pcm_hw_params(struct snd_pcm_substream *substream,
 471                              struct snd_pcm_hw_params *params)
 472{
 473        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 474        struct snd_pcm_runtime *runtime = substream->runtime;
 475        struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
 476        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 477        struct hsw_pcm_data *pcm_data;
 478        struct sst_hsw *hsw = pdata->hsw;
 479        struct sst_module *module_data;
 480        struct sst_dsp *dsp;
 481        struct snd_dma_buffer *dmab;
 482        enum sst_hsw_stream_type stream_type;
 483        enum sst_hsw_stream_path_id path_id;
 484        u32 rate, bits, map, pages, module_id;
 485        u8 channels;
 486        int ret, dai;
 487
 488        dai = mod_map[rtd->cpu_dai->id].dai_id;
 489        pcm_data = &pdata->pcm[dai][substream->stream];
 490
 491        /* check if we are being called a subsequent time */
 492        if (pcm_data->allocated) {
 493                ret = sst_hsw_stream_reset(hsw, pcm_data->stream);
 494                if (ret < 0)
 495                        dev_dbg(rtd->dev, "error: reset stream failed %d\n",
 496                                ret);
 497
 498                ret = sst_hsw_stream_free(hsw, pcm_data->stream);
 499                if (ret < 0) {
 500                        dev_dbg(rtd->dev, "error: free stream failed %d\n",
 501                                ret);
 502                        return ret;
 503                }
 504                pcm_data->allocated = false;
 505
 506                pcm_data->stream = sst_hsw_stream_new(hsw, rtd->cpu_dai->id,
 507                        hsw_notify_pointer, pcm_data);
 508                if (pcm_data->stream == NULL) {
 509                        dev_err(rtd->dev, "error: failed to create stream\n");
 510                        return -EINVAL;
 511                }
 512        }
 513
 514        /* stream direction */
 515        if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 516                path_id = SST_HSW_STREAM_PATH_SSP0_OUT;
 517        else
 518                path_id = SST_HSW_STREAM_PATH_SSP0_IN;
 519
 520        /* DSP stream type depends on DAI ID */
 521        switch (rtd->cpu_dai->id) {
 522        case 0:
 523                if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 524                        stream_type = SST_HSW_STREAM_TYPE_SYSTEM;
 525                        module_id = SST_HSW_MODULE_PCM_SYSTEM;
 526                }
 527                else {
 528                        stream_type = SST_HSW_STREAM_TYPE_CAPTURE;
 529                        module_id = SST_HSW_MODULE_PCM_CAPTURE;
 530                }
 531                break;
 532        case 1:
 533        case 2:
 534                stream_type = SST_HSW_STREAM_TYPE_RENDER;
 535                module_id = SST_HSW_MODULE_PCM;
 536                break;
 537        case 3:
 538                /* path ID needs to be OUT for loopback */
 539                stream_type = SST_HSW_STREAM_TYPE_LOOPBACK;
 540                path_id = SST_HSW_STREAM_PATH_SSP0_OUT;
 541                module_id = SST_HSW_MODULE_PCM_REFERENCE;
 542                break;
 543        default:
 544                dev_err(rtd->dev, "error: invalid DAI ID %d\n",
 545                        rtd->cpu_dai->id);
 546                return -EINVAL;
 547        }
 548
 549        ret = sst_hsw_stream_format(hsw, pcm_data->stream,
 550                path_id, stream_type, SST_HSW_STREAM_FORMAT_PCM_FORMAT);
 551        if (ret < 0) {
 552                dev_err(rtd->dev, "error: failed to set format %d\n", ret);
 553                return ret;
 554        }
 555
 556        rate = params_rate(params);
 557        ret = sst_hsw_stream_set_rate(hsw, pcm_data->stream, rate);
 558        if (ret < 0) {
 559                dev_err(rtd->dev, "error: could not set rate %d\n", rate);
 560                return ret;
 561        }
 562
 563        switch (params_format(params)) {
 564        case SNDRV_PCM_FORMAT_S16_LE:
 565                bits = SST_HSW_DEPTH_16BIT;
 566                sst_hsw_stream_set_valid(hsw, pcm_data->stream, 16);
 567                break;
 568        case SNDRV_PCM_FORMAT_S24_LE:
 569                bits = SST_HSW_DEPTH_32BIT;
 570                sst_hsw_stream_set_valid(hsw, pcm_data->stream, 24);
 571                break;
 572        case SNDRV_PCM_FORMAT_S8:
 573                bits = SST_HSW_DEPTH_8BIT;
 574                sst_hsw_stream_set_valid(hsw, pcm_data->stream, 8);
 575                break;
 576        case SNDRV_PCM_FORMAT_S32_LE:
 577                bits = SST_HSW_DEPTH_32BIT;
 578                sst_hsw_stream_set_valid(hsw, pcm_data->stream, 32);
 579                break;
 580        default:
 581                dev_err(rtd->dev, "error: invalid format %d\n",
 582                        params_format(params));
 583                return -EINVAL;
 584        }
 585
 586        ret = sst_hsw_stream_set_bits(hsw, pcm_data->stream, bits);
 587        if (ret < 0) {
 588                dev_err(rtd->dev, "error: could not set bits %d\n", bits);
 589                return ret;
 590        }
 591
 592        channels = params_channels(params);
 593        map = create_channel_map(SST_HSW_CHANNEL_CONFIG_STEREO);
 594        sst_hsw_stream_set_map_config(hsw, pcm_data->stream,
 595                        map, SST_HSW_CHANNEL_CONFIG_STEREO);
 596
 597        ret = sst_hsw_stream_set_channels(hsw, pcm_data->stream, channels);
 598        if (ret < 0) {
 599                dev_err(rtd->dev, "error: could not set channels %d\n",
 600                        channels);
 601                return ret;
 602        }
 603
 604        ret = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
 605        if (ret < 0) {
 606                dev_err(rtd->dev, "error: could not allocate %d bytes for PCM %d\n",
 607                        params_buffer_bytes(params), ret);
 608                return ret;
 609        }
 610
 611        dmab = snd_pcm_get_dma_buf(substream);
 612
 613        ret = create_adsp_page_table(substream, pdata, rtd, runtime->dma_area,
 614                runtime->dma_bytes, rtd->cpu_dai->id);
 615        if (ret < 0)
 616                return ret;
 617
 618        sst_hsw_stream_set_style(hsw, pcm_data->stream,
 619                SST_HSW_INTERLEAVING_PER_CHANNEL);
 620
 621        if (runtime->dma_bytes % PAGE_SIZE)
 622                pages = (runtime->dma_bytes / PAGE_SIZE) + 1;
 623        else
 624                pages = runtime->dma_bytes / PAGE_SIZE;
 625
 626        ret = sst_hsw_stream_buffer(hsw, pcm_data->stream,
 627                pdata->dmab[rtd->cpu_dai->id][substream->stream].addr,
 628                pages, runtime->dma_bytes, 0,
 629                snd_sgbuf_get_addr(dmab, 0) >> PAGE_SHIFT);
 630        if (ret < 0) {
 631                dev_err(rtd->dev, "error: failed to set DMA buffer %d\n", ret);
 632                return ret;
 633        }
 634
 635        dsp = sst_hsw_get_dsp(hsw);
 636
 637        module_data = sst_module_get_from_id(dsp, module_id);
 638        if (module_data == NULL) {
 639                dev_err(rtd->dev, "error: failed to get module config\n");
 640                return -EINVAL;
 641        }
 642
 643        sst_hsw_stream_set_module_info(hsw, pcm_data->stream,
 644                pcm_data->runtime);
 645
 646        ret = sst_hsw_stream_commit(hsw, pcm_data->stream);
 647        if (ret < 0) {
 648                dev_err(rtd->dev, "error: failed to commit stream %d\n", ret);
 649                return ret;
 650        }
 651
 652        if (!pcm_data->allocated) {
 653                /* Set previous saved volume */
 654                sst_hsw_stream_set_volume(hsw, pcm_data->stream, 0,
 655                                0, pcm_data->volume[0]);
 656                sst_hsw_stream_set_volume(hsw, pcm_data->stream, 0,
 657                                1, pcm_data->volume[1]);
 658                pcm_data->allocated = true;
 659        }
 660
 661        ret = sst_hsw_stream_pause(hsw, pcm_data->stream, 1);
 662        if (ret < 0)
 663                dev_err(rtd->dev, "error: failed to pause %d\n", ret);
 664
 665        return 0;
 666}
 667
 668static int hsw_pcm_hw_free(struct snd_pcm_substream *substream)
 669{
 670        snd_pcm_lib_free_pages(substream);
 671        return 0;
 672}
 673
 674static int hsw_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
 675{
 676        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 677        struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
 678        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 679        struct hsw_pcm_data *pcm_data;
 680        struct sst_hsw_stream *sst_stream;
 681        struct sst_hsw *hsw = pdata->hsw;
 682        struct snd_pcm_runtime *runtime = substream->runtime;
 683        snd_pcm_uframes_t pos;
 684        int dai;
 685
 686        dai = mod_map[rtd->cpu_dai->id].dai_id;
 687        pcm_data = &pdata->pcm[dai][substream->stream];
 688        sst_stream = pcm_data->stream;
 689
 690        switch (cmd) {
 691        case SNDRV_PCM_TRIGGER_START:
 692        case SNDRV_PCM_TRIGGER_RESUME:
 693        case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
 694                sst_hsw_stream_set_silence_start(hsw, sst_stream, false);
 695                sst_hsw_stream_resume(hsw, pcm_data->stream, 0);
 696                break;
 697        case SNDRV_PCM_TRIGGER_STOP:
 698        case SNDRV_PCM_TRIGGER_SUSPEND:
 699        case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
 700                sst_hsw_stream_set_silence_start(hsw, sst_stream, false);
 701                sst_hsw_stream_pause(hsw, pcm_data->stream, 0);
 702                break;
 703        case SNDRV_PCM_TRIGGER_DRAIN:
 704                pos = runtime->control->appl_ptr % runtime->buffer_size;
 705                sst_hsw_stream_set_old_position(hsw, pcm_data->stream, pos);
 706                sst_hsw_stream_set_silence_start(hsw, sst_stream, true);
 707                break;
 708        default:
 709                break;
 710        }
 711
 712        return 0;
 713}
 714
 715static u32 hsw_notify_pointer(struct sst_hsw_stream *stream, void *data)
 716{
 717        struct hsw_pcm_data *pcm_data = data;
 718        struct snd_pcm_substream *substream = pcm_data->substream;
 719        struct snd_pcm_runtime *runtime = substream->runtime;
 720        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 721        struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
 722        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 723        struct sst_hsw *hsw = pdata->hsw;
 724        u32 pos;
 725        snd_pcm_uframes_t position = bytes_to_frames(runtime,
 726                 sst_hsw_get_dsp_position(hsw, pcm_data->stream));
 727        unsigned char *dma_area = runtime->dma_area;
 728        snd_pcm_uframes_t dma_frames =
 729                bytes_to_frames(runtime, runtime->dma_bytes);
 730        snd_pcm_uframes_t old_position;
 731        ssize_t samples;
 732
 733        pos = frames_to_bytes(runtime,
 734                (runtime->control->appl_ptr % runtime->buffer_size));
 735
 736        dev_vdbg(rtd->dev, "PCM: App pointer %d bytes\n", pos);
 737
 738        /* SST fw don't know where to stop dma
 739         * So, SST driver need to clean the data which has been consumed
 740         */
 741        if (dma_area == NULL || dma_frames <= 0
 742                || (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
 743                || !sst_hsw_stream_get_silence_start(hsw, stream)) {
 744                snd_pcm_period_elapsed(substream);
 745                return pos;
 746        }
 747
 748        old_position = sst_hsw_stream_get_old_position(hsw, stream);
 749        if (position > old_position) {
 750                if (position < dma_frames) {
 751                        samples = SST_SAMPLES(runtime, position - old_position);
 752                        snd_pcm_format_set_silence(runtime->format,
 753                                SST_OLD_POSITION(dma_area,
 754                                        runtime, old_position),
 755                                samples);
 756                } else
 757                        dev_err(rtd->dev, "PCM: position is wrong\n");
 758        } else {
 759                if (old_position < dma_frames) {
 760                        samples = SST_SAMPLES(runtime,
 761                                dma_frames - old_position);
 762                        snd_pcm_format_set_silence(runtime->format,
 763                                SST_OLD_POSITION(dma_area,
 764                                        runtime, old_position),
 765                                samples);
 766                } else
 767                        dev_err(rtd->dev, "PCM: dma_bytes is wrong\n");
 768                if (position < dma_frames) {
 769                        samples = SST_SAMPLES(runtime, position);
 770                        snd_pcm_format_set_silence(runtime->format,
 771                                dma_area, samples);
 772                } else
 773                        dev_err(rtd->dev, "PCM: position is wrong\n");
 774        }
 775        sst_hsw_stream_set_old_position(hsw, stream, position);
 776
 777        /* let alsa know we have play a period */
 778        snd_pcm_period_elapsed(substream);
 779        return pos;
 780}
 781
 782static snd_pcm_uframes_t hsw_pcm_pointer(struct snd_pcm_substream *substream)
 783{
 784        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 785        struct snd_pcm_runtime *runtime = substream->runtime;
 786        struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
 787        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 788        struct hsw_pcm_data *pcm_data;
 789        struct sst_hsw *hsw = pdata->hsw;
 790        snd_pcm_uframes_t offset;
 791        uint64_t ppos;
 792        u32 position;
 793        int dai;
 794
 795        dai = mod_map[rtd->cpu_dai->id].dai_id;
 796        pcm_data = &pdata->pcm[dai][substream->stream];
 797        position = sst_hsw_get_dsp_position(hsw, pcm_data->stream);
 798
 799        offset = bytes_to_frames(runtime, position);
 800        ppos = sst_hsw_get_dsp_presentation_position(hsw, pcm_data->stream);
 801
 802        dev_vdbg(rtd->dev, "PCM: DMA pointer %du bytes, pos %llu\n",
 803                position, ppos);
 804        return offset;
 805}
 806
 807static int hsw_pcm_open(struct snd_pcm_substream *substream)
 808{
 809        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 810        struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
 811        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 812        struct hsw_pcm_data *pcm_data;
 813        struct sst_hsw *hsw = pdata->hsw;
 814        int dai;
 815
 816        dai = mod_map[rtd->cpu_dai->id].dai_id;
 817        pcm_data = &pdata->pcm[dai][substream->stream];
 818
 819        mutex_lock(&pcm_data->mutex);
 820        pm_runtime_get_sync(pdata->dev);
 821
 822        pcm_data->substream = substream;
 823
 824        snd_soc_set_runtime_hwparams(substream, &hsw_pcm_hardware);
 825
 826        pcm_data->stream = sst_hsw_stream_new(hsw, rtd->cpu_dai->id,
 827                hsw_notify_pointer, pcm_data);
 828        if (pcm_data->stream == NULL) {
 829                dev_err(rtd->dev, "error: failed to create stream\n");
 830                pm_runtime_mark_last_busy(pdata->dev);
 831                pm_runtime_put_autosuspend(pdata->dev);
 832                mutex_unlock(&pcm_data->mutex);
 833                return -EINVAL;
 834        }
 835
 836        mutex_unlock(&pcm_data->mutex);
 837        return 0;
 838}
 839
 840static int hsw_pcm_close(struct snd_pcm_substream *substream)
 841{
 842        struct snd_soc_pcm_runtime *rtd = substream->private_data;
 843        struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
 844        struct hsw_priv_data *pdata = snd_soc_component_get_drvdata(component);
 845        struct hsw_pcm_data *pcm_data;
 846        struct sst_hsw *hsw = pdata->hsw;
 847        int ret, dai;
 848
 849        dai = mod_map[rtd->cpu_dai->id].dai_id;
 850        pcm_data = &pdata->pcm[dai][substream->stream];
 851
 852        mutex_lock(&pcm_data->mutex);
 853        ret = sst_hsw_stream_reset(hsw, pcm_data->stream);
 854        if (ret < 0) {
 855                dev_dbg(rtd->dev, "error: reset stream failed %d\n", ret);
 856                goto out;
 857        }
 858
 859        ret = sst_hsw_stream_free(hsw, pcm_data->stream);
 860        if (ret < 0) {
 861                dev_dbg(rtd->dev, "error: free stream failed %d\n", ret);
 862                goto out;
 863        }
 864        pcm_data->allocated = false;
 865        pcm_data->stream = NULL;
 866
 867out:
 868        pm_runtime_mark_last_busy(pdata->dev);
 869        pm_runtime_put_autosuspend(pdata->dev);
 870        mutex_unlock(&pcm_data->mutex);
 871        return ret;
 872}
 873
 874static const struct snd_pcm_ops hsw_pcm_ops = {
 875        .open           = hsw_pcm_open,
 876        .close          = hsw_pcm_close,
 877        .ioctl          = snd_pcm_lib_ioctl,
 878        .hw_params      = hsw_pcm_hw_params,
 879        .hw_free        = hsw_pcm_hw_free,
 880        .trigger        = hsw_pcm_trigger,
 881        .pointer        = hsw_pcm_pointer,
 882        .page           = snd_pcm_sgbuf_ops_page,
 883};
 884
 885static int hsw_pcm_create_modules(struct hsw_priv_data *pdata)
 886{
 887        struct sst_hsw *hsw = pdata->hsw;
 888        struct hsw_pcm_data *pcm_data;
 889        int i;
 890
 891        for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
 892                pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
 893
 894                /* create new runtime module, use same offset if recreated */
 895                pcm_data->runtime = sst_hsw_runtime_module_create(hsw,
 896                        mod_map[i].mod_id, pcm_data->persistent_offset);
 897                if (pcm_data->runtime == NULL)
 898                        goto err;
 899                pcm_data->persistent_offset =
 900                        pcm_data->runtime->persistent_offset;
 901        }
 902
 903        /* create runtime blocks for module waves */
 904        if (sst_hsw_is_module_loaded(hsw, SST_HSW_MODULE_WAVES)) {
 905                pdata->runtime_waves = sst_hsw_runtime_module_create(hsw,
 906                        SST_HSW_MODULE_WAVES, 0);
 907                if (pdata->runtime_waves == NULL)
 908                        goto err;
 909        }
 910
 911        return 0;
 912
 913err:
 914        for (--i; i >= 0; i--) {
 915                pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
 916                sst_hsw_runtime_module_free(pcm_data->runtime);
 917        }
 918
 919        return -ENODEV;
 920}
 921
 922static void hsw_pcm_free_modules(struct hsw_priv_data *pdata)
 923{
 924        struct sst_hsw *hsw = pdata->hsw;
 925        struct hsw_pcm_data *pcm_data;
 926        int i;
 927
 928        for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
 929                pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
 930                if (pcm_data->runtime){
 931                        sst_hsw_runtime_module_free(pcm_data->runtime);
 932                        pcm_data->runtime = NULL;
 933                }
 934        }
 935        if (sst_hsw_is_module_loaded(hsw, SST_HSW_MODULE_WAVES) &&
 936                                pdata->runtime_waves) {
 937                sst_hsw_runtime_module_free(pdata->runtime_waves);
 938                pdata->runtime_waves = NULL;
 939        }
 940}
 941
 942static int hsw_pcm_new(struct snd_soc_pcm_runtime *rtd)
 943{
 944        struct snd_pcm *pcm = rtd->pcm;
 945        struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, DRV_NAME);
 946        struct sst_pdata *pdata = dev_get_platdata(component->dev);
 947        struct hsw_priv_data *priv_data = dev_get_drvdata(component->dev);
 948        struct device *dev = pdata->dma_dev;
 949
 950        if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream ||
 951                        pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream) {
 952                snd_pcm_lib_preallocate_pages_for_all(pcm,
 953                        SNDRV_DMA_TYPE_DEV_SG,
 954                        dev,
 955                        hsw_pcm_hardware.buffer_bytes_max,
 956                        hsw_pcm_hardware.buffer_bytes_max);
 957        }
 958        if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream)
 959                priv_data->pcm[rtd->cpu_dai->id][SNDRV_PCM_STREAM_PLAYBACK].hsw_pcm = pcm;
 960        if (pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream)
 961                priv_data->pcm[rtd->cpu_dai->id][SNDRV_PCM_STREAM_CAPTURE].hsw_pcm = pcm;
 962
 963        return 0;
 964}
 965
 966#define HSW_FORMATS \
 967        (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE)
 968
 969static struct snd_soc_dai_driver hsw_dais[] = {
 970        {
 971                .name  = "System Pin",
 972                .id = HSW_PCM_DAI_ID_SYSTEM,
 973                .playback = {
 974                        .stream_name = "System Playback",
 975                        .channels_min = 2,
 976                        .channels_max = 2,
 977                        .rates = SNDRV_PCM_RATE_48000,
 978                        .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE,
 979                },
 980                .capture = {
 981                        .stream_name = "Analog Capture",
 982                        .channels_min = 2,
 983                        .channels_max = 4,
 984                        .rates = SNDRV_PCM_RATE_48000,
 985                        .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE,
 986                },
 987        },
 988        {
 989                /* PCM */
 990                .name  = "Offload0 Pin",
 991                .id = HSW_PCM_DAI_ID_OFFLOAD0,
 992                .playback = {
 993                        .stream_name = "Offload0 Playback",
 994                        .channels_min = 2,
 995                        .channels_max = 2,
 996                        .rates = SNDRV_PCM_RATE_8000_192000,
 997                        .formats = HSW_FORMATS,
 998                },
 999        },
1000        {
1001                /* PCM */
1002                .name  = "Offload1 Pin",
1003                .id = HSW_PCM_DAI_ID_OFFLOAD1,
1004                .playback = {
1005                        .stream_name = "Offload1 Playback",
1006                        .channels_min = 2,
1007                        .channels_max = 2,
1008                        .rates = SNDRV_PCM_RATE_8000_192000,
1009                        .formats = HSW_FORMATS,
1010                },
1011        },
1012        {
1013                .name  = "Loopback Pin",
1014                .id = HSW_PCM_DAI_ID_LOOPBACK,
1015                .capture = {
1016                        .stream_name = "Loopback Capture",
1017                        .channels_min = 2,
1018                        .channels_max = 2,
1019                        .rates = SNDRV_PCM_RATE_48000,
1020                        .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE,
1021                },
1022        },
1023};
1024
1025static const struct snd_soc_dapm_widget widgets[] = {
1026
1027        /* Backend DAIs  */
1028        SND_SOC_DAPM_AIF_IN("SSP0 CODEC IN", NULL, 0, SND_SOC_NOPM, 0, 0),
1029        SND_SOC_DAPM_AIF_OUT("SSP0 CODEC OUT", NULL, 0, SND_SOC_NOPM, 0, 0),
1030        SND_SOC_DAPM_AIF_IN("SSP1 BT IN", NULL, 0, SND_SOC_NOPM, 0, 0),
1031        SND_SOC_DAPM_AIF_OUT("SSP1 BT OUT", NULL, 0, SND_SOC_NOPM, 0, 0),
1032
1033        /* Global Playback Mixer */
1034        SND_SOC_DAPM_MIXER("Playback VMixer", SND_SOC_NOPM, 0, 0, NULL, 0),
1035};
1036
1037static const struct snd_soc_dapm_route graph[] = {
1038
1039        /* Playback Mixer */
1040        {"Playback VMixer", NULL, "System Playback"},
1041        {"Playback VMixer", NULL, "Offload0 Playback"},
1042        {"Playback VMixer", NULL, "Offload1 Playback"},
1043
1044        {"SSP0 CODEC OUT", NULL, "Playback VMixer"},
1045
1046        {"Analog Capture", NULL, "SSP0 CODEC IN"},
1047};
1048
1049static int hsw_pcm_probe(struct snd_soc_component *component)
1050{
1051        struct hsw_priv_data *priv_data = snd_soc_component_get_drvdata(component);
1052        struct sst_pdata *pdata = dev_get_platdata(component->dev);
1053        struct device *dma_dev, *dev;
1054        int i, ret = 0;
1055
1056        if (!pdata)
1057                return -ENODEV;
1058
1059        dev = component->dev;
1060        dma_dev = pdata->dma_dev;
1061
1062        priv_data->hsw = pdata->dsp;
1063        priv_data->dev = dev;
1064        priv_data->pm_state = HSW_PM_STATE_D0;
1065        priv_data->soc_card = component->card;
1066
1067        /* allocate DSP buffer page tables */
1068        for (i = 0; i < ARRAY_SIZE(hsw_dais); i++) {
1069
1070                /* playback */
1071                if (hsw_dais[i].playback.channels_min) {
1072                        mutex_init(&priv_data->pcm[i][SNDRV_PCM_STREAM_PLAYBACK].mutex);
1073                        ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, dma_dev,
1074                                PAGE_SIZE, &priv_data->dmab[i][0]);
1075                        if (ret < 0)
1076                                goto err;
1077                }
1078
1079                /* capture */
1080                if (hsw_dais[i].capture.channels_min) {
1081                        mutex_init(&priv_data->pcm[i][SNDRV_PCM_STREAM_CAPTURE].mutex);
1082                        ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, dma_dev,
1083                                PAGE_SIZE, &priv_data->dmab[i][1]);
1084                        if (ret < 0)
1085                                goto err;
1086                }
1087        }
1088
1089        /* allocate runtime modules */
1090        ret = hsw_pcm_create_modules(priv_data);
1091        if (ret < 0)
1092                goto err;
1093
1094        /* enable runtime PM with auto suspend */
1095        pm_runtime_set_autosuspend_delay(dev, SST_RUNTIME_SUSPEND_DELAY);
1096        pm_runtime_use_autosuspend(dev);
1097        pm_runtime_enable(dev);
1098        pm_runtime_idle(dev);
1099
1100        return 0;
1101
1102err:
1103        for (--i; i >= 0; i--) {
1104                if (hsw_dais[i].playback.channels_min)
1105                        snd_dma_free_pages(&priv_data->dmab[i][0]);
1106                if (hsw_dais[i].capture.channels_min)
1107                        snd_dma_free_pages(&priv_data->dmab[i][1]);
1108        }
1109        return ret;
1110}
1111
1112static void hsw_pcm_remove(struct snd_soc_component *component)
1113{
1114        struct hsw_priv_data *priv_data =
1115                snd_soc_component_get_drvdata(component);
1116        int i;
1117
1118        pm_runtime_disable(component->dev);
1119        hsw_pcm_free_modules(priv_data);
1120
1121        for (i = 0; i < ARRAY_SIZE(hsw_dais); i++) {
1122                if (hsw_dais[i].playback.channels_min)
1123                        snd_dma_free_pages(&priv_data->dmab[i][0]);
1124                if (hsw_dais[i].capture.channels_min)
1125                        snd_dma_free_pages(&priv_data->dmab[i][1]);
1126        }
1127}
1128
1129static const struct snd_soc_component_driver hsw_dai_component = {
1130        .name           = DRV_NAME,
1131        .probe          = hsw_pcm_probe,
1132        .remove         = hsw_pcm_remove,
1133        .ops            = &hsw_pcm_ops,
1134        .pcm_new        = hsw_pcm_new,
1135        .controls       = hsw_volume_controls,
1136        .num_controls   = ARRAY_SIZE(hsw_volume_controls),
1137        .dapm_widgets   = widgets,
1138        .num_dapm_widgets = ARRAY_SIZE(widgets),
1139        .dapm_routes    = graph,
1140        .num_dapm_routes = ARRAY_SIZE(graph),
1141};
1142
1143static int hsw_pcm_dev_probe(struct platform_device *pdev)
1144{
1145        struct sst_pdata *sst_pdata = dev_get_platdata(&pdev->dev);
1146        struct hsw_priv_data *priv_data;
1147        int ret;
1148
1149        if (!sst_pdata)
1150                return -EINVAL;
1151
1152        priv_data = devm_kzalloc(&pdev->dev, sizeof(*priv_data), GFP_KERNEL);
1153        if (!priv_data)
1154                return -ENOMEM;
1155
1156        ret = sst_hsw_dsp_init(&pdev->dev, sst_pdata);
1157        if (ret < 0)
1158                return -ENODEV;
1159
1160        priv_data->hsw = sst_pdata->dsp;
1161        platform_set_drvdata(pdev, priv_data);
1162
1163        ret = devm_snd_soc_register_component(&pdev->dev, &hsw_dai_component,
1164                hsw_dais, ARRAY_SIZE(hsw_dais));
1165        if (ret < 0)
1166                goto err_plat;
1167
1168        return 0;
1169
1170err_plat:
1171        sst_hsw_dsp_free(&pdev->dev, sst_pdata);
1172        return 0;
1173}
1174
1175static int hsw_pcm_dev_remove(struct platform_device *pdev)
1176{
1177        struct sst_pdata *sst_pdata = dev_get_platdata(&pdev->dev);
1178
1179        sst_hsw_dsp_free(&pdev->dev, sst_pdata);
1180
1181        return 0;
1182}
1183
1184#ifdef CONFIG_PM
1185
1186static int hsw_pcm_runtime_idle(struct device *dev)
1187{
1188        return 0;
1189}
1190
1191static int hsw_pcm_suspend(struct device *dev)
1192{
1193        struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1194        struct sst_hsw *hsw = pdata->hsw;
1195
1196        /* enter D3 state and stall */
1197        sst_hsw_dsp_runtime_suspend(hsw);
1198        /* free all runtime modules */
1199        hsw_pcm_free_modules(pdata);
1200        /* put the DSP to sleep, fw unloaded after runtime modules freed */
1201        sst_hsw_dsp_runtime_sleep(hsw);
1202        return 0;
1203}
1204
1205static int hsw_pcm_runtime_suspend(struct device *dev)
1206{
1207        struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1208        struct sst_hsw *hsw = pdata->hsw;
1209        int ret;
1210
1211        if (pdata->pm_state >= HSW_PM_STATE_RTD3)
1212                return 0;
1213
1214        /* fw modules will be unloaded on RTD3, set flag to track */
1215        if (sst_hsw_is_module_active(hsw, SST_HSW_MODULE_WAVES)) {
1216                ret = sst_hsw_module_disable(hsw, SST_HSW_MODULE_WAVES, 0);
1217                if (ret < 0)
1218                        return ret;
1219                sst_hsw_set_module_enabled_rtd3(hsw, SST_HSW_MODULE_WAVES);
1220        }
1221        hsw_pcm_suspend(dev);
1222        pdata->pm_state = HSW_PM_STATE_RTD3;
1223
1224        return 0;
1225}
1226
1227static int hsw_pcm_runtime_resume(struct device *dev)
1228{
1229        struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1230        struct sst_hsw *hsw = pdata->hsw;
1231        int ret;
1232
1233        if (pdata->pm_state != HSW_PM_STATE_RTD3)
1234                return 0;
1235
1236        ret = sst_hsw_dsp_load(hsw);
1237        if (ret < 0) {
1238                dev_err(dev, "failed to reload %d\n", ret);
1239                return ret;
1240        }
1241
1242        ret = hsw_pcm_create_modules(pdata);
1243        if (ret < 0) {
1244                dev_err(dev, "failed to create modules %d\n", ret);
1245                return ret;
1246        }
1247
1248        ret = sst_hsw_dsp_runtime_resume(hsw);
1249        if (ret < 0)
1250                return ret;
1251        else if (ret == 1) /* no action required */
1252                return 0;
1253
1254        /* check flag when resume */
1255        if (sst_hsw_is_module_enabled_rtd3(hsw, SST_HSW_MODULE_WAVES)) {
1256                ret = sst_hsw_module_enable(hsw, SST_HSW_MODULE_WAVES, 0);
1257                if (ret < 0)
1258                        return ret;
1259                /* put parameters from buffer to dsp */
1260                ret = sst_hsw_launch_param_buf(hsw);
1261                if (ret < 0)
1262                        return ret;
1263                /* unset flag */
1264                sst_hsw_set_module_disabled_rtd3(hsw, SST_HSW_MODULE_WAVES);
1265        }
1266
1267        pdata->pm_state = HSW_PM_STATE_D0;
1268        return ret;
1269}
1270
1271#else
1272#define hsw_pcm_runtime_idle            NULL
1273#define hsw_pcm_runtime_suspend         NULL
1274#define hsw_pcm_runtime_resume          NULL
1275#endif
1276
1277#ifdef CONFIG_PM
1278
1279static void hsw_pcm_complete(struct device *dev)
1280{
1281        struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1282        struct sst_hsw *hsw = pdata->hsw;
1283        struct hsw_pcm_data *pcm_data;
1284        int i, err;
1285
1286        if (pdata->pm_state != HSW_PM_STATE_D3)
1287                return;
1288
1289        err = sst_hsw_dsp_load(hsw);
1290        if (err < 0) {
1291                dev_err(dev, "failed to reload %d\n", err);
1292                return;
1293        }
1294
1295        err = hsw_pcm_create_modules(pdata);
1296        if (err < 0) {
1297                dev_err(dev, "failed to create modules %d\n", err);
1298                return;
1299        }
1300
1301        for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
1302                pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
1303
1304                if (!pcm_data->substream)
1305                        continue;
1306
1307                err = sst_module_runtime_restore(pcm_data->runtime,
1308                        &pcm_data->context);
1309                if (err < 0)
1310                        dev_err(dev, "failed to restore context for PCM %d\n", i);
1311        }
1312
1313        snd_soc_resume(pdata->soc_card->dev);
1314
1315        err = sst_hsw_dsp_runtime_resume(hsw);
1316        if (err < 0)
1317                return;
1318        else if (err == 1) /* no action required */
1319                return;
1320
1321        pdata->pm_state = HSW_PM_STATE_D0;
1322        return;
1323}
1324
1325static int hsw_pcm_prepare(struct device *dev)
1326{
1327        struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1328        struct hsw_pcm_data *pcm_data;
1329        int i, err;
1330
1331        if (pdata->pm_state == HSW_PM_STATE_D3)
1332                return 0;
1333        else if (pdata->pm_state == HSW_PM_STATE_D0) {
1334                /* suspend all active streams */
1335                for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
1336                        pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
1337
1338                        if (!pcm_data->substream)
1339                                continue;
1340                        dev_dbg(dev, "suspending pcm %d\n", i);
1341                        snd_pcm_suspend_all(pcm_data->hsw_pcm);
1342
1343                        /* We need to wait until the DSP FW stops the streams */
1344                        msleep(2);
1345                }
1346
1347                /* preserve persistent memory */
1348                for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
1349                        pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
1350
1351                        if (!pcm_data->substream)
1352                                continue;
1353
1354                        dev_dbg(dev, "saving context pcm %d\n", i);
1355                        err = sst_module_runtime_save(pcm_data->runtime,
1356                                &pcm_data->context);
1357                        if (err < 0)
1358                                dev_err(dev, "failed to save context for PCM %d\n", i);
1359                }
1360                hsw_pcm_suspend(dev);
1361        }
1362
1363        snd_soc_suspend(pdata->soc_card->dev);
1364        snd_soc_poweroff(pdata->soc_card->dev);
1365
1366        pdata->pm_state = HSW_PM_STATE_D3;
1367
1368        return 0;
1369}
1370
1371#else
1372#define hsw_pcm_prepare         NULL
1373#define hsw_pcm_complete        NULL
1374#endif
1375
1376static const struct dev_pm_ops hsw_pcm_pm = {
1377        .runtime_idle = hsw_pcm_runtime_idle,
1378        .runtime_suspend = hsw_pcm_runtime_suspend,
1379        .runtime_resume = hsw_pcm_runtime_resume,
1380        .prepare = hsw_pcm_prepare,
1381        .complete = hsw_pcm_complete,
1382};
1383
1384static struct platform_driver hsw_pcm_driver = {
1385        .driver = {
1386                .name = "haswell-pcm-audio",
1387                .pm = &hsw_pcm_pm,
1388        },
1389
1390        .probe = hsw_pcm_dev_probe,
1391        .remove = hsw_pcm_dev_remove,
1392};
1393module_platform_driver(hsw_pcm_driver);
1394
1395MODULE_AUTHOR("Liam Girdwood, Xingchao Wang");
1396MODULE_DESCRIPTION("Haswell/Lynxpoint + Broadwell/Wildcatpoint PCM");
1397MODULE_LICENSE("GPL v2");
1398MODULE_ALIAS("platform:haswell-pcm-audio");
1399