blob: bea26730873c0fffc63c27d4c913da507e71e9ca [file] [log] [blame]
Jeeja KPa40e6932015-07-09 15:20:08 +05301/*
2 * skl-pcm.c -ASoC HDA Platform driver file implementing PCM functionality
3 *
4 * Copyright (C) 2014-2015 Intel Corp
5 * Author: Jeeja KP <jeeja.kp@intel.com>
6 *
7 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; version 2 of the License.
12 *
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
17 *
18 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
19 *
20 */
21
22#include <linux/pci.h>
23#include <linux/pm_runtime.h>
24#include <sound/pcm_params.h>
25#include <sound/soc.h>
26#include "skl.h"
27
28#define HDA_MONO 1
29#define HDA_STEREO 2
30
31static struct snd_pcm_hardware azx_pcm_hw = {
32 .info = (SNDRV_PCM_INFO_MMAP |
33 SNDRV_PCM_INFO_INTERLEAVED |
34 SNDRV_PCM_INFO_BLOCK_TRANSFER |
35 SNDRV_PCM_INFO_MMAP_VALID |
36 SNDRV_PCM_INFO_PAUSE |
37 SNDRV_PCM_INFO_SYNC_START |
38 SNDRV_PCM_INFO_HAS_WALL_CLOCK | /* legacy */
39 SNDRV_PCM_INFO_HAS_LINK_ATIME |
40 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP),
41 .formats = SNDRV_PCM_FMTBIT_S16_LE,
42 .rates = SNDRV_PCM_RATE_48000,
43 .rate_min = 48000,
44 .rate_max = 48000,
45 .channels_min = 2,
46 .channels_max = 2,
47 .buffer_bytes_max = AZX_MAX_BUF_SIZE,
48 .period_bytes_min = 128,
49 .period_bytes_max = AZX_MAX_BUF_SIZE / 2,
50 .periods_min = 2,
51 .periods_max = AZX_MAX_FRAG,
52 .fifo_size = 0,
53};
54
55static inline
56struct hdac_ext_stream *get_hdac_ext_stream(struct snd_pcm_substream *substream)
57{
58 return substream->runtime->private_data;
59}
60
61static struct hdac_ext_bus *get_bus_ctx(struct snd_pcm_substream *substream)
62{
63 struct hdac_ext_stream *stream = get_hdac_ext_stream(substream);
64 struct hdac_stream *hstream = hdac_stream(stream);
65 struct hdac_bus *bus = hstream->bus;
66
67 return hbus_to_ebus(bus);
68}
69
70static int skl_substream_alloc_pages(struct hdac_ext_bus *ebus,
71 struct snd_pcm_substream *substream,
72 size_t size)
73{
74 struct hdac_ext_stream *stream = get_hdac_ext_stream(substream);
75
76 hdac_stream(stream)->bufsize = 0;
77 hdac_stream(stream)->period_bytes = 0;
78 hdac_stream(stream)->format_val = 0;
79
80 return snd_pcm_lib_malloc_pages(substream, size);
81}
82
83static int skl_substream_free_pages(struct hdac_bus *bus,
84 struct snd_pcm_substream *substream)
85{
86 return snd_pcm_lib_free_pages(substream);
87}
88
89static void skl_set_pcm_constrains(struct hdac_ext_bus *ebus,
90 struct snd_pcm_runtime *runtime)
91{
92 snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
93
94 /* avoid wrap-around with wall-clock */
95 snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_TIME,
96 20, 178000000);
97}
98
Jeeja KP05057002015-07-09 15:20:11 +053099static enum hdac_ext_stream_type skl_get_host_stream_type(struct hdac_ext_bus *ebus)
100{
101 if (ebus->ppcap)
102 return HDAC_EXT_STREAM_TYPE_HOST;
103 else
104 return HDAC_EXT_STREAM_TYPE_COUPLED;
105}
106
Jeeja KPa40e6932015-07-09 15:20:08 +0530107static int skl_pcm_open(struct snd_pcm_substream *substream,
108 struct snd_soc_dai *dai)
109{
110 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
111 struct hdac_ext_stream *stream;
112 struct snd_pcm_runtime *runtime = substream->runtime;
113 struct skl_dma_params *dma_params;
114 int ret;
115
116 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
117 ret = pm_runtime_get_sync(dai->dev);
118 if (ret)
119 return ret;
120
121 stream = snd_hdac_ext_stream_assign(ebus, substream,
Jeeja KP05057002015-07-09 15:20:11 +0530122 skl_get_host_stream_type(ebus));
Jeeja KPa40e6932015-07-09 15:20:08 +0530123 if (stream == NULL)
124 return -EBUSY;
125
126 skl_set_pcm_constrains(ebus, runtime);
127
128 /*
129 * disable WALLCLOCK timestamps for capture streams
130 * until we figure out how to handle digital inputs
131 */
132 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) {
133 runtime->hw.info &= ~SNDRV_PCM_INFO_HAS_WALL_CLOCK; /* legacy */
134 runtime->hw.info &= ~SNDRV_PCM_INFO_HAS_LINK_ATIME;
135 }
136
137 runtime->private_data = stream;
138
139 dma_params = kzalloc(sizeof(*dma_params), GFP_KERNEL);
140 if (!dma_params)
141 return -ENOMEM;
142
143 dma_params->stream_tag = hdac_stream(stream)->stream_tag;
144 snd_soc_dai_set_dma_data(dai, substream, dma_params);
145
146 dev_dbg(dai->dev, "stream tag set in dma params=%d\n",
147 dma_params->stream_tag);
148 snd_pcm_set_sync(substream);
149
150 return 0;
151}
152
153static int skl_get_format(struct snd_pcm_substream *substream,
154 struct snd_soc_dai *dai)
155{
156 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
157 struct skl_dma_params *dma_params;
Jeeja KP05057002015-07-09 15:20:11 +0530158 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
Jeeja KPa40e6932015-07-09 15:20:08 +0530159 int format_val = 0;
Jeeja KPa40e6932015-07-09 15:20:08 +0530160
Jeeja KP05057002015-07-09 15:20:11 +0530161 if (ebus->ppcap) {
162 struct snd_pcm_runtime *runtime = substream->runtime;
163
164 format_val = snd_hdac_calc_stream_format(runtime->rate,
165 runtime->channels,
166 runtime->format,
167 32, 0);
168 } else {
169 struct snd_soc_dai *codec_dai = rtd->codec_dai;
170
171 dma_params = snd_soc_dai_get_dma_data(codec_dai, substream);
172 if (dma_params)
173 format_val = dma_params->format;
174 }
Jeeja KPa40e6932015-07-09 15:20:08 +0530175
176 return format_val;
177}
178
179static int skl_pcm_prepare(struct snd_pcm_substream *substream,
180 struct snd_soc_dai *dai)
181{
182 struct hdac_ext_stream *stream = get_hdac_ext_stream(substream);
183 unsigned int format_val;
184 int err;
185
186 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
187 if (hdac_stream(stream)->prepared) {
188 dev_dbg(dai->dev, "already stream is prepared - returning\n");
189 return 0;
190 }
191
192 format_val = skl_get_format(substream, dai);
193 dev_dbg(dai->dev, "stream_tag=%d formatvalue=%d\n",
194 hdac_stream(stream)->stream_tag, format_val);
195 snd_hdac_stream_reset(hdac_stream(stream));
196
197 err = snd_hdac_stream_set_params(hdac_stream(stream), format_val);
198 if (err < 0)
199 return err;
200
201 err = snd_hdac_stream_setup(hdac_stream(stream));
202 if (err < 0)
203 return err;
204
205 hdac_stream(stream)->prepared = 1;
206
207 return err;
208}
209
210static int skl_pcm_hw_params(struct snd_pcm_substream *substream,
211 struct snd_pcm_hw_params *params,
212 struct snd_soc_dai *dai)
213{
214 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
Jeeja KP05057002015-07-09 15:20:11 +0530215 struct hdac_ext_stream *stream = get_hdac_ext_stream(substream);
Jeeja KPa40e6932015-07-09 15:20:08 +0530216 struct snd_pcm_runtime *runtime = substream->runtime;
Jeeja KP05057002015-07-09 15:20:11 +0530217 int ret, dma_id;
Jeeja KPa40e6932015-07-09 15:20:08 +0530218
219 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
220 ret = skl_substream_alloc_pages(ebus, substream,
221 params_buffer_bytes(params));
222 if (ret < 0)
223 return ret;
224
225 dev_dbg(dai->dev, "format_val, rate=%d, ch=%d, format=%d\n",
226 runtime->rate, runtime->channels, runtime->format);
227
Jeeja KP05057002015-07-09 15:20:11 +0530228 dma_id = hdac_stream(stream)->stream_tag - 1;
229 dev_dbg(dai->dev, "dma_id=%d\n", dma_id);
230
Jeeja KPa40e6932015-07-09 15:20:08 +0530231 return 0;
232}
233
234static void skl_pcm_close(struct snd_pcm_substream *substream,
235 struct snd_soc_dai *dai)
236{
237 struct hdac_ext_stream *stream = get_hdac_ext_stream(substream);
Jeeja KP05057002015-07-09 15:20:11 +0530238 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
Jeeja KPa40e6932015-07-09 15:20:08 +0530239 struct skl_dma_params *dma_params = NULL;
240
241 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
Jeeja KP05057002015-07-09 15:20:11 +0530242
243 snd_hdac_ext_stream_release(stream, skl_get_host_stream_type(ebus));
Jeeja KPa40e6932015-07-09 15:20:08 +0530244
245 dma_params = snd_soc_dai_get_dma_data(dai, substream);
246 /*
247 * now we should set this to NULL as we are freeing by the
248 * dma_params
249 */
250 snd_soc_dai_set_dma_data(dai, substream, NULL);
251
252 pm_runtime_mark_last_busy(dai->dev);
253 pm_runtime_put_autosuspend(dai->dev);
254 kfree(dma_params);
255}
256
257static int skl_pcm_hw_free(struct snd_pcm_substream *substream,
258 struct snd_soc_dai *dai)
259{
260 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
261 struct hdac_ext_stream *stream = get_hdac_ext_stream(substream);
262
263 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
264
265 snd_hdac_stream_cleanup(hdac_stream(stream));
266 hdac_stream(stream)->prepared = 0;
267
268 return skl_substream_free_pages(ebus_to_hbus(ebus), substream);
269}
270
Jeeja KP05057002015-07-09 15:20:11 +0530271static int skl_link_hw_params(struct snd_pcm_substream *substream,
272 struct snd_pcm_hw_params *params,
273 struct snd_soc_dai *dai)
274{
275 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
276 struct hdac_ext_stream *link_dev;
277 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
278 struct skl_dma_params *dma_params;
279 struct snd_soc_dai *codec_dai = rtd->codec_dai;
280 int dma_id;
281
282 pr_debug("%s\n", __func__);
283 link_dev = snd_hdac_ext_stream_assign(ebus, substream,
284 HDAC_EXT_STREAM_TYPE_LINK);
285 if (!link_dev)
286 return -EBUSY;
287
288 snd_soc_dai_set_dma_data(dai, substream, (void *)link_dev);
289
290 /* set the stream tag in the codec dai dma params */
291 dma_params = (struct skl_dma_params *)
292 snd_soc_dai_get_dma_data(codec_dai, substream);
293 if (dma_params)
294 dma_params->stream_tag = hdac_stream(link_dev)->stream_tag;
295 snd_soc_dai_set_dma_data(codec_dai, substream, (void *)dma_params);
296 dma_id = hdac_stream(link_dev)->stream_tag - 1;
297
298 return 0;
299}
300
301static int skl_link_pcm_prepare(struct snd_pcm_substream *substream,
302 struct snd_soc_dai *dai)
303{
304 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
305 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
306 struct hdac_ext_stream *link_dev =
307 snd_soc_dai_get_dma_data(dai, substream);
308 unsigned int format_val = 0;
309 struct skl_dma_params *dma_params;
310 struct snd_soc_dai *codec_dai = rtd->codec_dai;
311 struct snd_pcm_hw_params *params;
312 struct snd_interval *channels, *rate;
313 struct hdac_ext_link *link;
314
315 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
316 if (link_dev->link_prepared) {
317 dev_dbg(dai->dev, "already stream is prepared - returning\n");
318 return 0;
319 }
320 params = devm_kzalloc(dai->dev, sizeof(*params), GFP_KERNEL);
321 if (params == NULL)
322 return -ENOMEM;
323
324 channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS);
325 channels->min = channels->max = substream->runtime->channels;
326 rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE);
327 rate->min = rate->max = substream->runtime->rate;
328 snd_mask_set(&params->masks[SNDRV_PCM_HW_PARAM_FORMAT -
329 SNDRV_PCM_HW_PARAM_FIRST_MASK],
330 substream->runtime->format);
331
332
333 dma_params = (struct skl_dma_params *)
334 snd_soc_dai_get_dma_data(codec_dai, substream);
335 if (dma_params)
336 format_val = dma_params->format;
337 dev_dbg(dai->dev, "stream_tag=%d formatvalue=%d codec_dai_name=%s\n",
338 hdac_stream(link_dev)->stream_tag, format_val, codec_dai->name);
339
340 snd_hdac_ext_link_stream_reset(link_dev);
341
342 snd_hdac_ext_link_stream_setup(link_dev, format_val);
343
344 link = snd_hdac_ext_bus_get_link(ebus, rtd->codec->component.name);
345 if (!link)
346 return -EINVAL;
347
348 snd_hdac_ext_link_set_stream_id(link, hdac_stream(link_dev)->stream_tag);
349 link_dev->link_prepared = 1;
350
351 return 0;
352}
353
354static int skl_link_pcm_trigger(struct snd_pcm_substream *substream,
355 int cmd, struct snd_soc_dai *dai)
356{
357 struct hdac_ext_stream *link_dev =
358 snd_soc_dai_get_dma_data(dai, substream);
359
360 dev_dbg(dai->dev, "In %s cmd=%d\n", __func__, cmd);
361 switch (cmd) {
362 case SNDRV_PCM_TRIGGER_START:
363 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
364 case SNDRV_PCM_TRIGGER_RESUME:
365 snd_hdac_ext_link_stream_start(link_dev);
366 break;
367
368 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
369 case SNDRV_PCM_TRIGGER_SUSPEND:
370 case SNDRV_PCM_TRIGGER_STOP:
371 snd_hdac_ext_link_stream_clear(link_dev);
372 break;
373
374 default:
375 return -EINVAL;
376 }
377 return 0;
378}
379
380static int skl_link_hw_free(struct snd_pcm_substream *substream,
381 struct snd_soc_dai *dai)
382{
383 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
384 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
385 struct hdac_ext_stream *link_dev =
386 snd_soc_dai_get_dma_data(dai, substream);
387 struct hdac_ext_link *link;
388
389 dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name);
390
391 link_dev->link_prepared = 0;
392
393 link = snd_hdac_ext_bus_get_link(ebus, rtd->codec->component.name);
394 if (!link)
395 return -EINVAL;
396
397 snd_hdac_ext_link_clear_stream_id(link, hdac_stream(link_dev)->stream_tag);
398 snd_hdac_ext_stream_release(link_dev, HDAC_EXT_STREAM_TYPE_LINK);
399 return 0;
400}
401
402static int skl_hda_be_startup(struct snd_pcm_substream *substream,
403 struct snd_soc_dai *dai)
404{
405 return pm_runtime_get_sync(dai->dev);
406}
407
408static void skl_hda_be_shutdown(struct snd_pcm_substream *substream,
409 struct snd_soc_dai *dai)
410{
411 pm_runtime_mark_last_busy(dai->dev);
412 pm_runtime_put_autosuspend(dai->dev);
413}
414
Jeeja KPa40e6932015-07-09 15:20:08 +0530415static struct snd_soc_dai_ops skl_pcm_dai_ops = {
416 .startup = skl_pcm_open,
417 .shutdown = skl_pcm_close,
418 .prepare = skl_pcm_prepare,
419 .hw_params = skl_pcm_hw_params,
420 .hw_free = skl_pcm_hw_free,
421};
422
Jeeja KP05057002015-07-09 15:20:11 +0530423static struct snd_soc_dai_ops skl_dmic_dai_ops = {
424 .startup = skl_hda_be_startup,
425 .shutdown = skl_hda_be_shutdown,
426};
427
428static struct snd_soc_dai_ops skl_link_dai_ops = {
429 .startup = skl_hda_be_startup,
430 .prepare = skl_link_pcm_prepare,
431 .hw_params = skl_link_hw_params,
432 .hw_free = skl_link_hw_free,
433 .trigger = skl_link_pcm_trigger,
434 .shutdown = skl_hda_be_shutdown,
435};
436
Jeeja KPa40e6932015-07-09 15:20:08 +0530437static struct snd_soc_dai_driver skl_platform_dai[] = {
438{
439 .name = "System Pin",
440 .ops = &skl_pcm_dai_ops,
441 .playback = {
442 .stream_name = "System Playback",
443 .channels_min = HDA_MONO,
444 .channels_max = HDA_STEREO,
445 .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_8000,
446 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
447 },
448 .capture = {
449 .stream_name = "System Capture",
450 .channels_min = HDA_MONO,
451 .channels_max = HDA_STEREO,
452 .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000,
453 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
454 },
455},
456{
Jeeja KP05057002015-07-09 15:20:11 +0530457 .name = "Reference Pin",
458 .ops = &skl_pcm_dai_ops,
459 .capture = {
460 .stream_name = "Reference Capture",
461 .channels_min = HDA_MONO,
462 .channels_max = HDA_STEREO,
463 .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000,
464 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
465 },
466},
467{
Jeeja KPa40e6932015-07-09 15:20:08 +0530468 .name = "Deepbuffer Pin",
469 .ops = &skl_pcm_dai_ops,
470 .playback = {
471 .stream_name = "Deepbuffer Playback",
472 .channels_min = HDA_STEREO,
473 .channels_max = HDA_STEREO,
474 .rates = SNDRV_PCM_RATE_48000,
475 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
476 },
477},
478{
479 .name = "LowLatency Pin",
480 .ops = &skl_pcm_dai_ops,
481 .playback = {
482 .stream_name = "Low Latency Playback",
483 .channels_min = HDA_STEREO,
484 .channels_max = HDA_STEREO,
485 .rates = SNDRV_PCM_RATE_48000,
486 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
487 },
488},
Jeeja KP05057002015-07-09 15:20:11 +0530489/* BE CPU Dais */
490{
491 .name = "iDisp Pin",
492 .ops = &skl_link_dai_ops,
493 .playback = {
494 .stream_name = "iDisp Tx",
495 .channels_min = HDA_STEREO,
496 .channels_max = HDA_STEREO,
497 .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000,
498 .formats = SNDRV_PCM_FMTBIT_S16_LE,
499 },
500},
501{
502 .name = "DMIC01 Pin",
503 .ops = &skl_dmic_dai_ops,
504 .capture = {
505 .stream_name = "DMIC01 Rx",
506 .channels_min = HDA_STEREO,
507 .channels_max = HDA_STEREO,
508 .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000,
509 .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE,
510 },
511},
512{
Jeeja KP05057002015-07-09 15:20:11 +0530513 .name = "HD-Codec Pin",
514 .ops = &skl_link_dai_ops,
515 .playback = {
516 .stream_name = "HD-Codec Tx",
517 .channels_min = HDA_STEREO,
518 .channels_max = HDA_STEREO,
519 .rates = SNDRV_PCM_RATE_48000,
520 .formats = SNDRV_PCM_FMTBIT_S16_LE,
521 },
522 .capture = {
523 .stream_name = "HD-Codec Rx",
524 .channels_min = HDA_STEREO,
525 .channels_max = HDA_STEREO,
526 .rates = SNDRV_PCM_RATE_48000,
527 .formats = SNDRV_PCM_FMTBIT_S16_LE,
528 },
529},
Jeeja KPa40e6932015-07-09 15:20:08 +0530530};
531
532static int skl_platform_open(struct snd_pcm_substream *substream)
533{
534 struct snd_pcm_runtime *runtime;
535 struct snd_soc_pcm_runtime *rtd = substream->private_data;
536 struct snd_soc_dai_link *dai_link = rtd->dai_link;
537
538 dev_dbg(rtd->cpu_dai->dev, "In %s:%s\n", __func__,
539 dai_link->cpu_dai_name);
540
541 runtime = substream->runtime;
542 snd_soc_set_runtime_hwparams(substream, &azx_pcm_hw);
543
544 return 0;
545}
546
Jeeja KP05057002015-07-09 15:20:11 +0530547static int skl_pcm_trigger(struct snd_pcm_substream *substream,
Jeeja KPa40e6932015-07-09 15:20:08 +0530548 int cmd)
549{
550 struct hdac_ext_bus *ebus = get_bus_ctx(substream);
551 struct hdac_bus *bus = ebus_to_hbus(ebus);
552 struct hdac_ext_stream *stream;
553 struct snd_pcm_substream *s;
554 bool start;
555 int sbits = 0;
556 unsigned long cookie;
557 struct hdac_stream *hstr;
558
559 stream = get_hdac_ext_stream(substream);
560 hstr = hdac_stream(stream);
561
562 dev_dbg(bus->dev, "In %s cmd=%d\n", __func__, cmd);
563
564 if (!hstr->prepared)
565 return -EPIPE;
566
567 switch (cmd) {
568 case SNDRV_PCM_TRIGGER_START:
569 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
570 case SNDRV_PCM_TRIGGER_RESUME:
571 start = true;
572 break;
573
574 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
575 case SNDRV_PCM_TRIGGER_SUSPEND:
576 case SNDRV_PCM_TRIGGER_STOP:
577 start = false;
578 break;
579
580 default:
581 return -EINVAL;
582 }
583
584 snd_pcm_group_for_each_entry(s, substream) {
585 if (s->pcm->card != substream->pcm->card)
586 continue;
587 stream = get_hdac_ext_stream(s);
588 sbits |= 1 << hdac_stream(stream)->index;
589 snd_pcm_trigger_done(s, substream);
590 }
591
592 spin_lock_irqsave(&bus->reg_lock, cookie);
593
594 /* first, set SYNC bits of corresponding streams */
595 snd_hdac_stream_sync_trigger(hstr, true, sbits, AZX_REG_SSYNC);
596
597 snd_pcm_group_for_each_entry(s, substream) {
598 if (s->pcm->card != substream->pcm->card)
599 continue;
600 stream = get_hdac_ext_stream(s);
601 if (start)
602 snd_hdac_stream_start(hdac_stream(stream), true);
603 else
604 snd_hdac_stream_stop(hdac_stream(stream));
605 }
606 spin_unlock_irqrestore(&bus->reg_lock, cookie);
607
608 snd_hdac_stream_sync(hstr, start, sbits);
609
610 spin_lock_irqsave(&bus->reg_lock, cookie);
611
612 /* reset SYNC bits */
613 snd_hdac_stream_sync_trigger(hstr, false, sbits, AZX_REG_SSYNC);
614 if (start)
615 snd_hdac_stream_timecounter_init(hstr, sbits);
616 spin_unlock_irqrestore(&bus->reg_lock, cookie);
617
618 return 0;
619}
620
Jeeja KP05057002015-07-09 15:20:11 +0530621static int skl_dsp_trigger(struct snd_pcm_substream *substream,
622 int cmd)
623{
624 struct hdac_ext_bus *ebus = get_bus_ctx(substream);
625 struct hdac_bus *bus = ebus_to_hbus(ebus);
626 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
627 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
628 struct hdac_ext_stream *stream;
629 int start;
630 unsigned long cookie;
631 struct hdac_stream *hstr;
632
633 dev_dbg(bus->dev, "In %s cmd=%d streamname=%s\n", __func__, cmd, cpu_dai->name);
634
635 stream = get_hdac_ext_stream(substream);
636 hstr = hdac_stream(stream);
637
638 if (!hstr->prepared)
639 return -EPIPE;
640
641 switch (cmd) {
642 case SNDRV_PCM_TRIGGER_START:
643 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
644 case SNDRV_PCM_TRIGGER_RESUME:
645 start = 1;
646 break;
647
648 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
649 case SNDRV_PCM_TRIGGER_SUSPEND:
650 case SNDRV_PCM_TRIGGER_STOP:
651 start = 0;
652 break;
653
654 default:
655 return -EINVAL;
656 }
657
658 spin_lock_irqsave(&bus->reg_lock, cookie);
659
660 if (start)
661 snd_hdac_stream_start(hdac_stream(stream), true);
662 else
663 snd_hdac_stream_stop(hdac_stream(stream));
664
665 if (start)
666 snd_hdac_stream_timecounter_init(hstr, 0);
667
668 spin_unlock_irqrestore(&bus->reg_lock, cookie);
669
670 return 0;
671}
672static int skl_platform_pcm_trigger(struct snd_pcm_substream *substream,
673 int cmd)
674{
675 struct hdac_ext_bus *ebus = get_bus_ctx(substream);
676
677 if (ebus->ppcap)
678 return skl_dsp_trigger(substream, cmd);
679 else
680 return skl_pcm_trigger(substream, cmd);
681}
682
Jeeja KPa40e6932015-07-09 15:20:08 +0530683/* calculate runtime delay from LPIB */
684static int skl_get_delay_from_lpib(struct hdac_ext_bus *ebus,
685 struct hdac_ext_stream *sstream,
686 unsigned int pos)
687{
688 struct hdac_bus *bus = ebus_to_hbus(ebus);
689 struct hdac_stream *hstream = hdac_stream(sstream);
690 struct snd_pcm_substream *substream = hstream->substream;
691 int stream = substream->stream;
692 unsigned int lpib_pos = snd_hdac_stream_get_pos_lpib(hstream);
693 int delay;
694
695 if (stream == SNDRV_PCM_STREAM_PLAYBACK)
696 delay = pos - lpib_pos;
697 else
698 delay = lpib_pos - pos;
699
700 if (delay < 0) {
701 if (delay >= hstream->delay_negative_threshold)
702 delay = 0;
703 else
704 delay += hstream->bufsize;
705 }
706
707 if (delay >= hstream->period_bytes) {
708 dev_info(bus->dev,
709 "Unstable LPIB (%d >= %d); disabling LPIB delay counting\n",
710 delay, hstream->period_bytes);
711 delay = 0;
712 }
713
714 return bytes_to_frames(substream->runtime, delay);
715}
716
717static unsigned int skl_get_position(struct hdac_ext_stream *hstream,
718 int codec_delay)
719{
720 struct hdac_stream *hstr = hdac_stream(hstream);
721 struct snd_pcm_substream *substream = hstr->substream;
722 struct hdac_ext_bus *ebus = get_bus_ctx(substream);
723 unsigned int pos;
724 int delay;
725
726 /* use the position buffer as default */
727 pos = snd_hdac_stream_get_pos_posbuf(hdac_stream(hstream));
728
729 if (pos >= hdac_stream(hstream)->bufsize)
730 pos = 0;
731
732 if (substream->runtime) {
733 delay = skl_get_delay_from_lpib(ebus, hstream, pos)
734 + codec_delay;
735 substream->runtime->delay += delay;
736 }
737
738 return pos;
739}
740
741static snd_pcm_uframes_t skl_platform_pcm_pointer
742 (struct snd_pcm_substream *substream)
743{
744 struct hdac_ext_stream *hstream = get_hdac_ext_stream(substream);
745
746 return bytes_to_frames(substream->runtime,
747 skl_get_position(hstream, 0));
748}
749
750static u64 skl_adjust_codec_delay(struct snd_pcm_substream *substream,
751 u64 nsec)
752{
753 struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream);
754 struct snd_soc_dai *codec_dai = rtd->codec_dai;
755 u64 codec_frames, codec_nsecs;
756
757 if (!codec_dai->driver->ops->delay)
758 return nsec;
759
760 codec_frames = codec_dai->driver->ops->delay(substream, codec_dai);
761 codec_nsecs = div_u64(codec_frames * 1000000000LL,
762 substream->runtime->rate);
763
764 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
765 return nsec + codec_nsecs;
766
767 return (nsec > codec_nsecs) ? nsec - codec_nsecs : 0;
768}
769
770static int skl_get_time_info(struct snd_pcm_substream *substream,
771 struct timespec *system_ts, struct timespec *audio_ts,
772 struct snd_pcm_audio_tstamp_config *audio_tstamp_config,
773 struct snd_pcm_audio_tstamp_report *audio_tstamp_report)
774{
775 struct hdac_ext_stream *sstream = get_hdac_ext_stream(substream);
776 struct hdac_stream *hstr = hdac_stream(sstream);
777 u64 nsec;
778
779 if ((substream->runtime->hw.info & SNDRV_PCM_INFO_HAS_LINK_ATIME) &&
780 (audio_tstamp_config->type_requested == SNDRV_PCM_AUDIO_TSTAMP_TYPE_LINK)) {
781
782 snd_pcm_gettime(substream->runtime, system_ts);
783
784 nsec = timecounter_read(&hstr->tc);
785 nsec = div_u64(nsec, 3); /* can be optimized */
786 if (audio_tstamp_config->report_delay)
787 nsec = skl_adjust_codec_delay(substream, nsec);
788
789 *audio_ts = ns_to_timespec(nsec);
790
791 audio_tstamp_report->actual_type = SNDRV_PCM_AUDIO_TSTAMP_TYPE_LINK;
792 audio_tstamp_report->accuracy_report = 1; /* rest of struct is valid */
793 audio_tstamp_report->accuracy = 42; /* 24MHzWallClk == 42ns resolution */
794
795 } else {
796 audio_tstamp_report->actual_type = SNDRV_PCM_AUDIO_TSTAMP_TYPE_DEFAULT;
797 }
798
799 return 0;
800}
801
802static struct snd_pcm_ops skl_platform_ops = {
803 .open = skl_platform_open,
804 .ioctl = snd_pcm_lib_ioctl,
805 .trigger = skl_platform_pcm_trigger,
806 .pointer = skl_platform_pcm_pointer,
807 .get_time_info = skl_get_time_info,
808 .mmap = snd_pcm_lib_default_mmap,
809 .page = snd_pcm_sgbuf_ops_page,
810};
811
812static void skl_pcm_free(struct snd_pcm *pcm)
813{
814 snd_pcm_lib_preallocate_free_for_all(pcm);
815}
816
817#define MAX_PREALLOC_SIZE (32 * 1024 * 1024)
818
819static int skl_pcm_new(struct snd_soc_pcm_runtime *rtd)
820{
821 struct snd_soc_dai *dai = rtd->cpu_dai;
822 struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev);
823 struct snd_pcm *pcm = rtd->pcm;
824 unsigned int size;
825 int retval = 0;
826 struct skl *skl = ebus_to_skl(ebus);
827
828 if (dai->driver->playback.channels_min ||
829 dai->driver->capture.channels_min) {
830 /* buffer pre-allocation */
831 size = CONFIG_SND_HDA_PREALLOC_SIZE * 1024;
832 if (size > MAX_PREALLOC_SIZE)
833 size = MAX_PREALLOC_SIZE;
834 retval = snd_pcm_lib_preallocate_pages_for_all(pcm,
835 SNDRV_DMA_TYPE_DEV_SG,
836 snd_dma_pci_data(skl->pci),
837 size, MAX_PREALLOC_SIZE);
838 if (retval) {
839 dev_err(dai->dev, "dma buffer allocationf fail\n");
840 return retval;
841 }
842 }
843
844 return retval;
845}
846
847static struct snd_soc_platform_driver skl_platform_drv = {
848 .ops = &skl_platform_ops,
849 .pcm_new = skl_pcm_new,
850 .pcm_free = skl_pcm_free,
851};
852
853static const struct snd_soc_component_driver skl_component = {
854 .name = "pcm",
855};
856
857int skl_platform_register(struct device *dev)
858{
859 int ret;
860
861 ret = snd_soc_register_platform(dev, &skl_platform_drv);
862 if (ret) {
863 dev_err(dev, "soc platform registration failed %d\n", ret);
864 return ret;
865 }
866 ret = snd_soc_register_component(dev, &skl_component,
867 skl_platform_dai,
868 ARRAY_SIZE(skl_platform_dai));
869 if (ret) {
870 dev_err(dev, "soc component registration failed %d\n", ret);
871 snd_soc_unregister_platform(dev);
872 }
873
874 return ret;
875
876}
877
878int skl_platform_unregister(struct device *dev)
879{
880 snd_soc_unregister_component(dev);
881 snd_soc_unregister_platform(dev);
882 return 0;
883}