projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
ASoC: Intel: fix warning reported by static check tool smatch
[deliverable/linux.git] / sound / soc / intel / sst-haswell-pcm.c
CommitLineData
a4b12990
MB		 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>
a4b12990 20#include <linux/delay.h>
2e4f7591 21#include <linux/pm_runtime.h>
a4b12990
MB		 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 "sst-haswell-ipc.h"
33#include "sst-dsp-priv.h"
34#include "sst-dsp.h"
35
36#define HSW_PCM_COUNT 6
37#define HSW_VOLUME_MAX 0x7FFFFFFF /* 0dB */
38
1b006996
LY		 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
a4b12990
MB		 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
2e4f7591
LG		 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
2e4f7591
LG		 86
87
a4b12990
MB		 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 |
9fd37810
LY		 94 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP |
95 SNDRV_PCM_INFO_DRAIN_TRIGGER,
8e897618 96 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE |
a4b12990
MB		 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
e9600bc1
LG		 105struct hsw_pcm_module_map {
106 int dai_id;
98b9c1d2 107 int stream;
e9600bc1
LG		 108 enum sst_hsw_module_id mod_id;
109};
110
a4b12990
MB		 111/* private data for each PCM DSP stream */
112struct hsw_pcm_data {
113 int dai_id;
114 struct sst_hsw_stream *stream;
e9600bc1 115 struct sst_module_runtime *runtime;
2e4f7591
LG		 116 struct sst_module_runtime_context context;
117 struct snd_pcm *hsw_pcm;
a4b12990
MB		 118 u32 volume[2];
119 struct snd_pcm_substream *substream;
120 struct snd_compr_stream *cstream;
121 unsigned int wpos;
122 struct mutex mutex;
916152c4 123 bool allocated;
e9600bc1 124 int persistent_offset;
a4b12990
MB		 125};
126
2e4f7591 127enum hsw_pm_state {
cd311dd1
JY		 128 HSW_PM_STATE_D0 = 0,
129 HSW_PM_STATE_RTD3 = 1,
130 HSW_PM_STATE_D3 = 2,
a4b12990
MB		 131};
132
133/* private data for the driver */
134struct hsw_priv_data {
135 /* runtime DSP */
136 struct sst_hsw *hsw;
2e4f7591
LG		 137 struct device *dev;
138 enum hsw_pm_state pm_state;
139 struct snd_soc_card *soc_card;
2c0ed634 140 struct sst_module_runtime *runtime_waves; /* sound effect module */
a4b12990
MB		 141
142 /* page tables */
0b708c87 143 struct snd_dma_buffer dmab[HSW_PCM_COUNT][2];
a4b12990
MB		 144
145 /* DAI data */
7ff9d671
JY		 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},
a4b12990
MB		 157};
158
916152c4
LG		 159static u32 hsw_notify_pointer(struct sst_hsw_stream *stream, void *data);
160
a4b12990
MB		 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{
2e4f7591 184 struct snd_soc_platform *platform = snd_soc_kcontrol_platform(kcontrol);
a4b12990
MB		 185 struct soc_mixer_control *mc =
186 (struct soc_mixer_control *)kcontrol->private_value;
2e4f7591
LG		 187 struct hsw_priv_data *pdata =
188 snd_soc_platform_get_drvdata(platform);
7ff9d671 189 struct hsw_pcm_data *pcm_data;
a4b12990
MB		 190 struct sst_hsw *hsw = pdata->hsw;
191 u32 volume;
7ff9d671
JY		 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];
a4b12990
MB		 197
198 mutex_lock(&pcm_data->mutex);
2e4f7591 199 pm_runtime_get_sync(pdata->dev);
a4b12990
MB		 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]);
2e4f7591
LG		 206 pm_runtime_mark_last_busy(pdata->dev);
207 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 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]);
f1e59825
JY		 215 /* apply volume value to all channels */
216 sst_hsw_stream_set_volume(hsw, pcm_data->stream, 0, SST_HSW_CHANNELS_ALL, volume);
a4b12990
MB		 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
2e4f7591
LG		 224 pm_runtime_mark_last_busy(pdata->dev);
225 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 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{
2e4f7591 233 struct snd_soc_platform *platform = snd_soc_kcontrol_platform(kcontrol);
a4b12990
MB		 234 struct soc_mixer_control *mc =
235 (struct soc_mixer_control *)kcontrol->private_value;
2e4f7591
LG		 236 struct hsw_priv_data *pdata =
237 snd_soc_platform_get_drvdata(platform);
7ff9d671 238 struct hsw_pcm_data *pcm_data;
a4b12990
MB		 239 struct sst_hsw *hsw = pdata->hsw;
240 u32 volume;
7ff9d671
JY		 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];
a4b12990
MB		 246
247 mutex_lock(&pcm_data->mutex);
2e4f7591 248 pm_runtime_get_sync(pdata->dev);
a4b12990
MB		 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]);
2e4f7591
LG		 255 pm_runtime_mark_last_busy(pdata->dev);
256 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 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);
2e4f7591
LG		 265
266 pm_runtime_mark_last_busy(pdata->dev);
267 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 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{
2e4f7591
LG		 276 struct snd_soc_platform *platform = snd_soc_kcontrol_platform(kcontrol);
277 struct hsw_priv_data *pdata = snd_soc_platform_get_drvdata(platform);
a4b12990
MB		 278 struct sst_hsw *hsw = pdata->hsw;
279 u32 volume;
280
2e4f7591
LG		 281 pm_runtime_get_sync(pdata->dev);
282
a4b12990
MB		 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]);
f1e59825 287 sst_hsw_mixer_set_volume(hsw, 0, SST_HSW_CHANNELS_ALL, volume);
a4b12990
MB		 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
2e4f7591
LG		 297 pm_runtime_mark_last_busy(pdata->dev);
298 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 299 return 0;
300}
301
302static int hsw_volume_get(struct snd_kcontrol *kcontrol,
303 struct snd_ctl_elem_value *ucontrol)
304{
2e4f7591
LG		 305 struct snd_soc_platform *platform = snd_soc_kcontrol_platform(kcontrol);
306 struct hsw_priv_data *pdata = snd_soc_platform_get_drvdata(platform);
a4b12990
MB		 307 struct sst_hsw *hsw = pdata->hsw;
308 unsigned int volume = 0;
309
2e4f7591 310 pm_runtime_get_sync(pdata->dev);
a4b12990
MB		 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
2e4f7591
LG		 317 pm_runtime_mark_last_busy(pdata->dev);
318 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 319 return 0;
320}
321
76c07b82
LH		 322static int hsw_waves_switch_get(struct snd_kcontrol *kcontrol,
323 struct snd_ctl_elem_value *ucontrol)
324{
325 struct snd_soc_platform *platform = snd_soc_kcontrol_platform(kcontrol);
326 struct hsw_priv_data *pdata = snd_soc_platform_get_drvdata(platform);
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_platform *platform = snd_soc_kcontrol_platform(kcontrol);
340 struct hsw_priv_data *pdata = snd_soc_platform_get_drvdata(platform);
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
3814c204
LH		 370static int hsw_waves_param_get(struct snd_kcontrol *kcontrol,
371 struct snd_ctl_elem_value *ucontrol)
372{
373 struct snd_soc_platform *platform = snd_soc_kcontrol_platform(kcontrol);
374 struct hsw_priv_data *pdata = snd_soc_platform_get_drvdata(platform);
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_platform *platform = snd_soc_kcontrol_platform(kcontrol);
385 struct hsw_priv_data *pdata = snd_soc_platform_get_drvdata(platform);
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
5d5b275d 403 if (sst_hsw_is_module_active(hsw, id))
3814c204
LH		 404 ret = sst_hsw_module_set_param(hsw, id, 0, param_id,
405 param_size, ucontrol->value.bytes.data);
3814c204
LH		 406 return ret;
407}
408
a4b12990
MB		 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,
c5f0406b 416 ARRAY_SIZE(volume_map) - 1, 0,
a4b12990
MB		 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,
c5f0406b 420 ARRAY_SIZE(volume_map) - 1, 0,
a4b12990
MB		 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,
c5f0406b 424 ARRAY_SIZE(volume_map) - 1, 0,
a4b12990
MB		 425 hsw_stream_volume_get, hsw_stream_volume_put, hsw_vol_tlv),
426 /* Mic Capture volume */
7ff9d671 427 SOC_DOUBLE_EXT_TLV("Mic Capture Volume", 4, 0, 8,
c5f0406b 428 ARRAY_SIZE(volume_map) - 1, 0,
a4b12990 429 hsw_stream_volume_get, hsw_stream_volume_put, hsw_vol_tlv),
76c07b82
LH		 430 /* enable/disable module waves */
431 SOC_SINGLE_BOOL_EXT("Waves Switch", 0,
432 hsw_waves_switch_get, hsw_waves_switch_put),
3814c204
LH		 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),
a4b12990
MB		 436};
437
438/* Create DMA buffer page table for DSP */
0b708c87
LG		 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)
a4b12990 442{
0b708c87
LG		 443 struct snd_dma_buffer *dmab = snd_pcm_get_dma_buf(substream);
444 int i, pages, stream = substream->stream;
a4b12990 445
0b708c87 446 pages = snd_sgbuf_aligned_pages(size);
a4b12990
MB		 447
448 dev_dbg(rtd->dev, "generating page table for %p size 0x%zu pages %d\n",
449 dma_area, size, pages);
450
451 for (i = 0; i < pages; i++) {
452 u32 idx = (((i << 2) + i)) >> 1;
0b708c87 453 u32 pfn = snd_sgbuf_get_addr(dmab, i * PAGE_SIZE) >> PAGE_SHIFT;
a4b12990
MB		 454 u32 *pg_table;
455
456 dev_dbg(rtd->dev, "pfn i %i idx %d pfn %x\n", i, idx, pfn);
457
0b708c87 458 pg_table = (u32 *)(pdata->dmab[pcm][stream].area + idx);
a4b12990
MB		 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 hsw_priv_data *pdata =
476 snd_soc_platform_get_drvdata(rtd->platform);
7ff9d671 477 struct hsw_pcm_data *pcm_data;
a4b12990
MB		 478 struct sst_hsw *hsw = pdata->hsw;
479 struct sst_module *module_data;
480 struct sst_dsp *dsp;
0b708c87 481 struct snd_dma_buffer *dmab;
a4b12990
MB		 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;
7ff9d671
JY		 486 int ret, dai;
487
488 dai = mod_map[rtd->cpu_dai->id].dai_id;
489 pcm_data = &pdata->pcm[dai][substream->stream];
a4b12990 490
916152c4
LG		 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
a4b12990
MB		 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:
7bb73cbd
JY		 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 }
a4b12990
MB		 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;
a4b12990
MB		 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:
8e897618
JY		 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;
a4b12990
MB		 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
a4b12990 592 channels = params_channels(params);
a4b12990
MB		 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
0b708c87
LG		 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);
a4b12990
MB		 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,
0b708c87 627 pdata->dmab[rtd->cpu_dai->id][substream->stream].addr,
a4b12990 628 pages, runtime->dma_bytes, 0,
0b708c87 629 snd_sgbuf_get_addr(dmab, 0) >> PAGE_SHIFT);
a4b12990
MB		 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
e9600bc1
LG		 643 sst_hsw_stream_set_module_info(hsw, pcm_data->stream,
644 pcm_data->runtime);
a4b12990
MB		 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 }
f1e59825
JY		 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 }
a4b12990
MB		 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 hsw_priv_data *pdata =
678 snd_soc_platform_get_drvdata(rtd->platform);
7ff9d671 679 struct hsw_pcm_data *pcm_data;
1b006996 680 struct sst_hsw_stream *sst_stream;
a4b12990 681 struct sst_hsw *hsw = pdata->hsw;
1b006996
LY		 682 struct snd_pcm_runtime *runtime = substream->runtime;
683 snd_pcm_uframes_t pos;
7ff9d671
JY		 684 int dai;
685
686 dai = mod_map[rtd->cpu_dai->id].dai_id;
687 pcm_data = &pdata->pcm[dai][substream->stream];
1b006996 688 sst_stream = pcm_data->stream;
a4b12990
MB		 689
690 switch (cmd) {
691 case SNDRV_PCM_TRIGGER_START:
692 case SNDRV_PCM_TRIGGER_RESUME:
693 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
1b006996 694 sst_hsw_stream_set_silence_start(hsw, sst_stream, false);
a4b12990
MB		 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:
1b006996 700 sst_hsw_stream_set_silence_start(hsw, sst_stream, false);
a4b12990
MB		 701 sst_hsw_stream_pause(hsw, pcm_data->stream, 0);
702 break;
1b006996
LY		 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;
a4b12990
MB		 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;
1b006996
LY		 721 struct hsw_priv_data *pdata =
722 snd_soc_platform_get_drvdata(rtd->platform);
723 struct sst_hsw *hsw = pdata->hsw;
a4b12990 724 u32 pos;
1b006996
LY		 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;
a4b12990
MB		 732
733 pos = frames_to_bytes(runtime,
734 (runtime->control->appl_ptr % runtime->buffer_size));
735
8046249d 736 dev_vdbg(rtd->dev, "PCM: App pointer %d bytes\n", pos);
a4b12990 737
1b006996
LY		 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
a4b12990
MB		 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 hsw_priv_data *pdata =
787 snd_soc_platform_get_drvdata(rtd->platform);
7ff9d671 788 struct hsw_pcm_data *pcm_data;
a4b12990
MB		 789 struct sst_hsw *hsw = pdata->hsw;
790 snd_pcm_uframes_t offset;
51b4e24f 791 uint64_t ppos;
7ff9d671
JY		 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);
a4b12990 798
51b4e24f
LG		 799 offset = bytes_to_frames(runtime, position);
800 ppos = sst_hsw_get_dsp_presentation_position(hsw, pcm_data->stream);
a4b12990 801
8046249d 802 dev_vdbg(rtd->dev, "PCM: DMA pointer %du bytes, pos %llu\n",
51b4e24f 803 position, ppos);
a4b12990
MB		 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 hsw_priv_data *pdata =
811 snd_soc_platform_get_drvdata(rtd->platform);
812 struct hsw_pcm_data *pcm_data;
813 struct sst_hsw *hsw = pdata->hsw;
7ff9d671 814 int dai;
a4b12990 815
7ff9d671
JY		 816 dai = mod_map[rtd->cpu_dai->id].dai_id;
817 pcm_data = &pdata->pcm[dai][substream->stream];
a4b12990
MB		 818
819 mutex_lock(&pcm_data->mutex);
2e4f7591 820 pm_runtime_get_sync(pdata->dev);
a4b12990
MB		 821
822 snd_soc_pcm_set_drvdata(rtd, pcm_data);
823 pcm_data->substream = substream;
824
825 snd_soc_set_runtime_hwparams(substream, &hsw_pcm_hardware);
826
827 pcm_data->stream = sst_hsw_stream_new(hsw, rtd->cpu_dai->id,
828 hsw_notify_pointer, pcm_data);
829 if (pcm_data->stream == NULL) {
830 dev_err(rtd->dev, "error: failed to create stream\n");
2e4f7591
LG		 831 pm_runtime_mark_last_busy(pdata->dev);
832 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 833 mutex_unlock(&pcm_data->mutex);
834 return -EINVAL;
835 }
836
a4b12990
MB		 837 mutex_unlock(&pcm_data->mutex);
838 return 0;
839}
840
841static int hsw_pcm_close(struct snd_pcm_substream *substream)
842{
843 struct snd_soc_pcm_runtime *rtd = substream->private_data;
844 struct hsw_priv_data *pdata =
845 snd_soc_platform_get_drvdata(rtd->platform);
7ff9d671 846 struct hsw_pcm_data *pcm_data;
a4b12990 847 struct sst_hsw *hsw = pdata->hsw;
7ff9d671
JY		 848 int ret, dai;
849
850 dai = mod_map[rtd->cpu_dai->id].dai_id;
851 pcm_data = &pdata->pcm[dai][substream->stream];
a4b12990
MB		 852
853 mutex_lock(&pcm_data->mutex);
854 ret = sst_hsw_stream_reset(hsw, pcm_data->stream);
855 if (ret < 0) {
856 dev_dbg(rtd->dev, "error: reset stream failed %d\n", ret);
857 goto out;
858 }
859
860 ret = sst_hsw_stream_free(hsw, pcm_data->stream);
861 if (ret < 0) {
862 dev_dbg(rtd->dev, "error: free stream failed %d\n", ret);
863 goto out;
864 }
916152c4 865 pcm_data->allocated = 0;
a4b12990
MB		 866 pcm_data->stream = NULL;
867
868out:
2e4f7591
LG		 869 pm_runtime_mark_last_busy(pdata->dev);
870 pm_runtime_put_autosuspend(pdata->dev);
a4b12990
MB		 871 mutex_unlock(&pcm_data->mutex);
872 return ret;
873}
874
875static struct snd_pcm_ops hsw_pcm_ops = {
876 .open = hsw_pcm_open,
877 .close = hsw_pcm_close,
878 .ioctl = snd_pcm_lib_ioctl,
879 .hw_params = hsw_pcm_hw_params,
880 .hw_free = hsw_pcm_hw_free,
881 .trigger = hsw_pcm_trigger,
882 .pointer = hsw_pcm_pointer,
0b708c87 883 .page = snd_pcm_sgbuf_ops_page,
a4b12990
MB		 884};
885
e9600bc1
LG		 886static int hsw_pcm_create_modules(struct hsw_priv_data *pdata)
887{
888 struct sst_hsw *hsw = pdata->hsw;
889 struct hsw_pcm_data *pcm_data;
890 int i;
891
892 for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
7ff9d671 893 pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
e9600bc1 894
2e4f7591 895 /* create new runtime module, use same offset if recreated */
e9600bc1
LG		 896 pcm_data->runtime = sst_hsw_runtime_module_create(hsw,
897 mod_map[i].mod_id, pcm_data->persistent_offset);
898 if (pcm_data->runtime == NULL)
899 goto err;
900 pcm_data->persistent_offset =
901 pcm_data->runtime->persistent_offset;
902 }
903
8c43fc2f
LH		 904 /* create runtime blocks for module waves */
905 if (sst_hsw_is_module_loaded(hsw, SST_HSW_MODULE_WAVES)) {
2c0ed634
LH		 906 pdata->runtime_waves = sst_hsw_runtime_module_create(hsw,
907 SST_HSW_MODULE_WAVES, 0);
908 if (pdata->runtime_waves == NULL)
8c43fc2f 909 goto err;
8c43fc2f
LH		 910 }
911
e9600bc1
LG		 912 return 0;
913
914err:
915 for (--i; i >= 0; i--) {
7ff9d671 916 pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
e9600bc1
LG		 917 sst_hsw_runtime_module_free(pcm_data->runtime);
918 }
919
920 return -ENODEV;
921}
922
923static void hsw_pcm_free_modules(struct hsw_priv_data *pdata)
924{
8c43fc2f 925 struct sst_hsw *hsw = pdata->hsw;
e9600bc1
LG		 926 struct hsw_pcm_data *pcm_data;
927 int i;
928
929 for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
7ff9d671 930 pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
8c43fc2f
LH		 931 sst_hsw_runtime_module_free(pcm_data->runtime);
932 }
933 if (sst_hsw_is_module_loaded(hsw, SST_HSW_MODULE_WAVES)) {
2c0ed634 934 sst_hsw_runtime_module_free(pdata->runtime_waves);
e9600bc1
LG		 935 }
936}
937
a4b12990
MB		 938static int hsw_pcm_new(struct snd_soc_pcm_runtime *rtd)
939{
940 struct snd_pcm *pcm = rtd->pcm;
10df3509
LG		 941 struct snd_soc_platform *platform = rtd->platform;
942 struct sst_pdata *pdata = dev_get_platdata(platform->dev);
2e4f7591 943 struct hsw_priv_data *priv_data = dev_get_drvdata(platform->dev);
10df3509 944 struct device *dev = pdata->dma_dev;
a4b12990
MB		 945 int ret = 0;
946
a4b12990
MB		 947 if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream ||
948 pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream) {
949 ret = snd_pcm_lib_preallocate_pages_for_all(pcm,
0b708c87 950 SNDRV_DMA_TYPE_DEV_SG,
10df3509 951 dev,
a4b12990
MB		 952 hsw_pcm_hardware.buffer_bytes_max,
953 hsw_pcm_hardware.buffer_bytes_max);
954 if (ret) {
955 dev_err(rtd->dev, "dma buffer allocation failed %d\n",
956 ret);
957 return ret;
958 }
959 }
7ff9d671
JY		 960 if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream)
961 priv_data->pcm[rtd->cpu_dai->id][SNDRV_PCM_STREAM_PLAYBACK].hsw_pcm = pcm;
962 if (pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream)
963 priv_data->pcm[rtd->cpu_dai->id][SNDRV_PCM_STREAM_CAPTURE].hsw_pcm = pcm;
a4b12990
MB		 964
965 return ret;
966}
967
968#define HSW_FORMATS \
2ccf3bd4 969 (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE)
a4b12990
MB		 970
971static struct snd_soc_dai_driver hsw_dais[] = {
972 {
973 .name = "System Pin",
2e4f7591 974 .id = HSW_PCM_DAI_ID_SYSTEM,
a4b12990
MB		 975 .playback = {
976 .stream_name = "System Playback",
977 .channels_min = 2,
978 .channels_max = 2,
979 .rates = SNDRV_PCM_RATE_48000,
8e897618 980 .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE,
a4b12990 981 },
7bb73cbd
JY		 982 .capture = {
983 .stream_name = "Analog Capture",
984 .channels_min = 2,
985 .channels_max = 4,
986 .rates = SNDRV_PCM_RATE_48000,
987 .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE,
988 },
a4b12990
MB		 989 },
990 {
991 /* PCM */
992 .name = "Offload0 Pin",
2e4f7591 993 .id = HSW_PCM_DAI_ID_OFFLOAD0,
a4b12990
MB		 994 .playback = {
995 .stream_name = "Offload0 Playback",
996 .channels_min = 2,
997 .channels_max = 2,
998 .rates = SNDRV_PCM_RATE_8000_192000,
999 .formats = HSW_FORMATS,
1000 },
1001 },
1002 {
1003 /* PCM */
1004 .name = "Offload1 Pin",
2e4f7591 1005 .id = HSW_PCM_DAI_ID_OFFLOAD1,
a4b12990
MB		 1006 .playback = {
1007 .stream_name = "Offload1 Playback",
1008 .channels_min = 2,
1009 .channels_max = 2,
1010 .rates = SNDRV_PCM_RATE_8000_192000,
1011 .formats = HSW_FORMATS,
1012 },
1013 },
1014 {
1015 .name = "Loopback Pin",
2e4f7591 1016 .id = HSW_PCM_DAI_ID_LOOPBACK,
a4b12990
MB		 1017 .capture = {
1018 .stream_name = "Loopback Capture",
1019 .channels_min = 2,
1020 .channels_max = 2,
8e897618
JY		 1021 .rates = SNDRV_PCM_RATE_48000,
1022 .formats = SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE,
a4b12990
MB		 1023 },
1024 },
a4b12990
MB		 1025};
1026
1027static const struct snd_soc_dapm_widget widgets[] = {
1028
1029 /* Backend DAIs */
1030 SND_SOC_DAPM_AIF_IN("SSP0 CODEC IN", NULL, 0, SND_SOC_NOPM, 0, 0),
1031 SND_SOC_DAPM_AIF_OUT("SSP0 CODEC OUT", NULL, 0, SND_SOC_NOPM, 0, 0),
1032 SND_SOC_DAPM_AIF_IN("SSP1 BT IN", NULL, 0, SND_SOC_NOPM, 0, 0),
1033 SND_SOC_DAPM_AIF_OUT("SSP1 BT OUT", NULL, 0, SND_SOC_NOPM, 0, 0),
1034
1035 /* Global Playback Mixer */
1036 SND_SOC_DAPM_MIXER("Playback VMixer", SND_SOC_NOPM, 0, 0, NULL, 0),
1037};
1038
1039static const struct snd_soc_dapm_route graph[] = {
1040
1041 /* Playback Mixer */
1042 {"Playback VMixer", NULL, "System Playback"},
1043 {"Playback VMixer", NULL, "Offload0 Playback"},
1044 {"Playback VMixer", NULL, "Offload1 Playback"},
1045
1046 {"SSP0 CODEC OUT", NULL, "Playback VMixer"},
1047
1048 {"Analog Capture", NULL, "SSP0 CODEC IN"},
1049};
1050
1051static int hsw_pcm_probe(struct snd_soc_platform *platform)
1052{
bd033808 1053 struct hsw_priv_data *priv_data = snd_soc_platform_get_drvdata(platform);
a4b12990 1054 struct sst_pdata *pdata = dev_get_platdata(platform->dev);
2e4f7591 1055 struct device *dma_dev, *dev;
0b708c87 1056 int i, ret = 0;
a4b12990 1057
2e4f7591
LG		 1058 if (!pdata)
1059 return -ENODEV;
1060
1061 dev = platform->dev;
1062 dma_dev = pdata->dma_dev;
1063
2e4f7591
LG		 1064 priv_data->hsw = pdata->dsp;
1065 priv_data->dev = platform->dev;
1066 priv_data->pm_state = HSW_PM_STATE_D0;
1067 priv_data->soc_card = platform->component.card;
1068
a4b12990
MB		 1069 /* allocate DSP buffer page tables */
1070 for (i = 0; i < ARRAY_SIZE(hsw_dais); i++) {
1071
a4b12990
MB		 1072 /* playback */
1073 if (hsw_dais[i].playback.channels_min) {
7ff9d671 1074 mutex_init(&priv_data->pcm[i][SNDRV_PCM_STREAM_PLAYBACK].mutex);
0b708c87
LG		 1075 ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, dma_dev,
1076 PAGE_SIZE, &priv_data->dmab[i][0]);
1077 if (ret < 0)
a4b12990
MB		 1078 goto err;
1079 }
1080
1081 /* capture */
1082 if (hsw_dais[i].capture.channels_min) {
7ff9d671 1083 mutex_init(&priv_data->pcm[i][SNDRV_PCM_STREAM_CAPTURE].mutex);
0b708c87
LG		 1084 ret = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, dma_dev,
1085 PAGE_SIZE, &priv_data->dmab[i][1]);
1086 if (ret < 0)
a4b12990
MB		 1087 goto err;
1088 }
1089 }
1090
e9600bc1 1091 /* allocate runtime modules */
8c43fc2f
LH		 1092 ret = hsw_pcm_create_modules(priv_data);
1093 if (ret < 0)
1094 goto err;
e9600bc1 1095
2e4f7591
LG		 1096 /* enable runtime PM with auto suspend */
1097 pm_runtime_set_autosuspend_delay(platform->dev,
1098 SST_RUNTIME_SUSPEND_DELAY);
1099 pm_runtime_use_autosuspend(platform->dev);
1100 pm_runtime_enable(platform->dev);
1101 pm_runtime_idle(platform->dev);
1102
a4b12990
MB		 1103 return 0;
1104
1105err:
1106 for (;i >= 0; i--) {
1107 if (hsw_dais[i].playback.channels_min)
0b708c87 1108 snd_dma_free_pages(&priv_data->dmab[i][0]);
a4b12990 1109 if (hsw_dais[i].capture.channels_min)
0b708c87 1110 snd_dma_free_pages(&priv_data->dmab[i][1]);
a4b12990 1111 }
0b708c87 1112 return ret;
a4b12990
MB		 1113}
1114
1115static int hsw_pcm_remove(struct snd_soc_platform *platform)
1116{
1117 struct hsw_priv_data *priv_data =
1118 snd_soc_platform_get_drvdata(platform);
1119 int i;
1120
2e4f7591
LG		 1121 pm_runtime_disable(platform->dev);
1122 hsw_pcm_free_modules(priv_data);
1123
a4b12990
MB		 1124 for (i = 0; i < ARRAY_SIZE(hsw_dais); i++) {
1125 if (hsw_dais[i].playback.channels_min)
0b708c87 1126 snd_dma_free_pages(&priv_data->dmab[i][0]);
a4b12990 1127 if (hsw_dais[i].capture.channels_min)
0b708c87 1128 snd_dma_free_pages(&priv_data->dmab[i][1]);
a4b12990
MB		 1129 }
1130
1131 return 0;
1132}
1133
1134static struct snd_soc_platform_driver hsw_soc_platform = {
1135 .probe = hsw_pcm_probe,
1136 .remove = hsw_pcm_remove,
1137 .ops = &hsw_pcm_ops,
1138 .pcm_new = hsw_pcm_new,
a4b12990
MB		 1139};
1140
1141static const struct snd_soc_component_driver hsw_dai_component = {
923976a3
LPC		 1142 .name = "haswell-dai",
1143 .controls = hsw_volume_controls,
1144 .num_controls = ARRAY_SIZE(hsw_volume_controls),
1145 .dapm_widgets = widgets,
1146 .num_dapm_widgets = ARRAY_SIZE(widgets),
1147 .dapm_routes = graph,
1148 .num_dapm_routes = ARRAY_SIZE(graph),
a4b12990
MB		 1149};
1150
1151static int hsw_pcm_dev_probe(struct platform_device *pdev)
1152{
1153 struct sst_pdata *sst_pdata = dev_get_platdata(&pdev->dev);
bd033808 1154 struct hsw_priv_data *priv_data;
a4b12990
MB		 1155 int ret;
1156
bd033808
LPC		 1157 if (!sst_pdata)
1158 return -EINVAL;
1159
1160 priv_data = devm_kzalloc(&pdev->dev, sizeof(*priv_data), GFP_KERNEL);
1161 if (!priv_data)
1162 return -ENOMEM;
1163
a4b12990
MB		 1164 ret = sst_hsw_dsp_init(&pdev->dev, sst_pdata);
1165 if (ret < 0)
1166 return -ENODEV;
1167
bd033808
LPC		 1168 priv_data->hsw = sst_pdata->dsp;
1169 platform_set_drvdata(pdev, priv_data);
1170
a4b12990
MB		 1171 ret = snd_soc_register_platform(&pdev->dev, &hsw_soc_platform);
1172 if (ret < 0)
1173 goto err_plat;
1174
1175 ret = snd_soc_register_component(&pdev->dev, &hsw_dai_component,
1176 hsw_dais, ARRAY_SIZE(hsw_dais));
1177 if (ret < 0)
1178 goto err_comp;
1179
1180 return 0;
1181
1182err_comp:
1183 snd_soc_unregister_platform(&pdev->dev);
1184err_plat:
1185 sst_hsw_dsp_free(&pdev->dev, sst_pdata);
1186 return 0;
1187}
1188
1189static int hsw_pcm_dev_remove(struct platform_device *pdev)
1190{
1191 struct sst_pdata *sst_pdata = dev_get_platdata(&pdev->dev);
1192
1193 snd_soc_unregister_platform(&pdev->dev);
1194 snd_soc_unregister_component(&pdev->dev);
1195 sst_hsw_dsp_free(&pdev->dev, sst_pdata);
1196
1197 return 0;
1198}
1199
45544c88 1200#ifdef CONFIG_PM
2e4f7591
LG		 1201
1202static int hsw_pcm_runtime_idle(struct device *dev)
1203{
1204 return 0;
1205}
1206
1207static int hsw_pcm_runtime_suspend(struct device *dev)
1208{
1209 struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1210 struct sst_hsw *hsw = pdata->hsw;
76c07b82 1211 int ret;
2e4f7591 1212
cd311dd1 1213 if (pdata->pm_state >= HSW_PM_STATE_RTD3)
2e4f7591
LG		 1214 return 0;
1215
76c07b82
LH		 1216 /* fw modules will be unloaded on RTD3, set flag to track */
1217 if (sst_hsw_is_module_active(hsw, SST_HSW_MODULE_WAVES)) {
1218 ret = sst_hsw_module_disable(hsw, SST_HSW_MODULE_WAVES, 0);
1219 if (ret < 0)
1220 return ret;
1221 sst_hsw_set_module_enabled_rtd3(hsw, SST_HSW_MODULE_WAVES);
1222 }
2e4f7591
LG		 1223 sst_hsw_dsp_runtime_suspend(hsw);
1224 sst_hsw_dsp_runtime_sleep(hsw);
cd311dd1 1225 pdata->pm_state = HSW_PM_STATE_RTD3;
2e4f7591
LG		 1226
1227 return 0;
1228}
1229
1230static int hsw_pcm_runtime_resume(struct device *dev)
1231{
1232 struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1233 struct sst_hsw *hsw = pdata->hsw;
1234 int ret;
1235
cd311dd1 1236 if (pdata->pm_state != HSW_PM_STATE_RTD3)
2e4f7591
LG		 1237 return 0;
1238
1239 ret = sst_hsw_dsp_load(hsw);
1240 if (ret < 0) {
1241 dev_err(dev, "failed to reload %d\n", ret);
1242 return ret;
1243 }
1244
1245 ret = hsw_pcm_create_modules(pdata);
1246 if (ret < 0) {
1247 dev_err(dev, "failed to create modules %d\n", ret);
1248 return ret;
1249 }
1250
1251 ret = sst_hsw_dsp_runtime_resume(hsw);
1252 if (ret < 0)
1253 return ret;
1254 else if (ret == 1) /* no action required */
1255 return 0;
1256
76c07b82
LH		 1257 /* check flag when resume */
1258 if (sst_hsw_is_module_enabled_rtd3(hsw, SST_HSW_MODULE_WAVES)) {
1259 ret = sst_hsw_module_enable(hsw, SST_HSW_MODULE_WAVES, 0);
3814c204
LH		 1260 if (ret < 0)
1261 return ret;
1262 /* put parameters from buffer to dsp */
1263 ret = sst_hsw_launch_param_buf(hsw);
76c07b82
LH		 1264 if (ret < 0)
1265 return ret;
1266 /* unset flag */
1267 sst_hsw_set_module_disabled_rtd3(hsw, SST_HSW_MODULE_WAVES);
1268 }
1269
2e4f7591
LG		 1270 pdata->pm_state = HSW_PM_STATE_D0;
1271 return ret;
1272}
1273
35e03a88
LG		 1274#else
1275#define hsw_pcm_runtime_idle NULL
1276#define hsw_pcm_runtime_suspend NULL
1277#define hsw_pcm_runtime_resume NULL
1278#endif
1279
45544c88 1280#ifdef CONFIG_PM
7b8ef67a 1281
2e4f7591
LG		 1282static void hsw_pcm_complete(struct device *dev)
1283{
1284 struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1285 struct sst_hsw *hsw = pdata->hsw;
1286 struct hsw_pcm_data *pcm_data;
1287 int i, err;
1288
cd311dd1 1289 if (pdata->pm_state != HSW_PM_STATE_D3)
2e4f7591
LG		 1290 return;
1291
1292 err = sst_hsw_dsp_load(hsw);
1293 if (err < 0) {
1294 dev_err(dev, "failed to reload %d\n", err);
1295 return;
1296 }
1297
1298 err = hsw_pcm_create_modules(pdata);
1299 if (err < 0) {
1300 dev_err(dev, "failed to create modules %d\n", err);
1301 return;
1302 }
1303
98b9c1d2 1304 for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
7ff9d671 1305 pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
2e4f7591
LG		 1306
1307 if (!pcm_data->substream)
1308 continue;
1309
1310 err = sst_module_runtime_restore(pcm_data->runtime,
1311 &pcm_data->context);
1312 if (err < 0)
1313 dev_err(dev, "failed to restore context for PCM %d\n", i);
1314 }
1315
1316 snd_soc_resume(pdata->soc_card->dev);
1317
1318 err = sst_hsw_dsp_runtime_resume(hsw);
1319 if (err < 0)
1320 return;
1321 else if (err == 1) /* no action required */
1322 return;
1323
1324 pdata->pm_state = HSW_PM_STATE_D0;
1325 return;
1326}
1327
1328static int hsw_pcm_prepare(struct device *dev)
1329{
1330 struct hsw_priv_data *pdata = dev_get_drvdata(dev);
1331 struct sst_hsw *hsw = pdata->hsw;
1332 struct hsw_pcm_data *pcm_data;
1333 int i, err;
1334
1335 if (pdata->pm_state == HSW_PM_STATE_D3)
1336 return 0;
cd311dd1
JY		 1337 else if (pdata->pm_state == HSW_PM_STATE_D0) {
1338 /* suspend all active streams */
1339 for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
1340 pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
1341
1342 if (!pcm_data->substream)
1343 continue;
1344 dev_dbg(dev, "suspending pcm %d\n", i);
1345 snd_pcm_suspend_all(pcm_data->hsw_pcm);
1346
1347 /* We need to wait until the DSP FW stops the streams */
1348 msleep(2);
1349 }
2e4f7591 1350
cd311dd1
JY		 1351 /* preserve persistent memory */
1352 for (i = 0; i < ARRAY_SIZE(mod_map); i++) {
1353 pcm_data = &pdata->pcm[mod_map[i].dai_id][mod_map[i].stream];
1354
1355 if (!pcm_data->substream)
1356 continue;
2e4f7591 1357
cd311dd1
JY		 1358 dev_dbg(dev, "saving context pcm %d\n", i);
1359 err = sst_module_runtime_save(pcm_data->runtime,
1360 &pcm_data->context);
1361 if (err < 0)
1362 dev_err(dev, "failed to save context for PCM %d\n", i);
1363 }
1364 /* enter D3 state and stall */
1365 sst_hsw_dsp_runtime_suspend(hsw);
1366 /* put the DSP to sleep */
1367 sst_hsw_dsp_runtime_sleep(hsw);
2e4f7591
LG		 1368 }
1369
1370 snd_soc_suspend(pdata->soc_card->dev);
1371 snd_soc_poweroff(pdata->soc_card->dev);
1372
2e4f7591
LG		 1373 pdata->pm_state = HSW_PM_STATE_D3;
1374
1375 return 0;
1376}
1377
7b8ef67a
LG		 1378#else
1379#define hsw_pcm_prepare NULL
1380#define hsw_pcm_complete NULL
1381#endif
1382
2e4f7591
LG		 1383static const struct dev_pm_ops hsw_pcm_pm = {
1384 .runtime_idle = hsw_pcm_runtime_idle,
1385 .runtime_suspend = hsw_pcm_runtime_suspend,
1386 .runtime_resume = hsw_pcm_runtime_resume,
1387 .prepare = hsw_pcm_prepare,
1388 .complete = hsw_pcm_complete,
1389};
2e4f7591 1390
a4b12990
MB		 1391static struct platform_driver hsw_pcm_driver = {
1392 .driver = {
1393 .name = "haswell-pcm-audio",
2e4f7591 1394 .pm = &hsw_pcm_pm,
a4b12990
MB		 1395 },
1396
1397 .probe = hsw_pcm_dev_probe,
1398 .remove = hsw_pcm_dev_remove,
1399};
1400module_platform_driver(hsw_pcm_driver);
1401
1402MODULE_AUTHOR("Liam Girdwood, Xingchao Wang");
1403MODULE_DESCRIPTION("Haswell/Lynxpoint + Broadwell/Wildcatpoint PCM");
1404MODULE_LICENSE("GPL v2");
1405MODULE_ALIAS("platform:haswell-pcm-audio");
Linux kernel - Deliverables
This page took 0.167002 seconds and 5 git commands to generate.