| /* |
| * skl-pcm.c -ASoC HDA Platform driver file implementing PCM functionality |
| * |
| * Copyright (C) 2014-2015 Intel Corp |
| * Author: Jeeja KP <jeeja.kp@intel.com> |
| * |
| * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; version 2 of the License. |
| * |
| * This program is distributed in the hope that it will be useful, but |
| * WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| * General Public License for more details. |
| * |
| * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| * |
| */ |
| |
| #include <linux/pci.h> |
| #include <linux/pm_runtime.h> |
| #include <sound/pcm_params.h> |
| #include <sound/soc.h> |
| #include "skl.h" |
| |
| #define HDA_MONO 1 |
| #define HDA_STEREO 2 |
| |
| static struct snd_pcm_hardware azx_pcm_hw = { |
| .info = (SNDRV_PCM_INFO_MMAP | |
| SNDRV_PCM_INFO_INTERLEAVED | |
| SNDRV_PCM_INFO_BLOCK_TRANSFER | |
| SNDRV_PCM_INFO_MMAP_VALID | |
| SNDRV_PCM_INFO_PAUSE | |
| SNDRV_PCM_INFO_SYNC_START | |
| SNDRV_PCM_INFO_HAS_WALL_CLOCK | /* legacy */ |
| SNDRV_PCM_INFO_HAS_LINK_ATIME | |
| SNDRV_PCM_INFO_NO_PERIOD_WAKEUP), |
| .formats = SNDRV_PCM_FMTBIT_S16_LE, |
| .rates = SNDRV_PCM_RATE_48000, |
| .rate_min = 48000, |
| .rate_max = 48000, |
| .channels_min = 2, |
| .channels_max = 2, |
| .buffer_bytes_max = AZX_MAX_BUF_SIZE, |
| .period_bytes_min = 128, |
| .period_bytes_max = AZX_MAX_BUF_SIZE / 2, |
| .periods_min = 2, |
| .periods_max = AZX_MAX_FRAG, |
| .fifo_size = 0, |
| }; |
| |
| static inline |
| struct hdac_ext_stream *get_hdac_ext_stream(struct snd_pcm_substream *substream) |
| { |
| return substream->runtime->private_data; |
| } |
| |
| static struct hdac_ext_bus *get_bus_ctx(struct snd_pcm_substream *substream) |
| { |
| struct hdac_ext_stream *stream = get_hdac_ext_stream(substream); |
| struct hdac_stream *hstream = hdac_stream(stream); |
| struct hdac_bus *bus = hstream->bus; |
| |
| return hbus_to_ebus(bus); |
| } |
| |
| static int skl_substream_alloc_pages(struct hdac_ext_bus *ebus, |
| struct snd_pcm_substream *substream, |
| size_t size) |
| { |
| struct hdac_ext_stream *stream = get_hdac_ext_stream(substream); |
| |
| hdac_stream(stream)->bufsize = 0; |
| hdac_stream(stream)->period_bytes = 0; |
| hdac_stream(stream)->format_val = 0; |
| |
| return snd_pcm_lib_malloc_pages(substream, size); |
| } |
| |
| static int skl_substream_free_pages(struct hdac_bus *bus, |
| struct snd_pcm_substream *substream) |
| { |
| return snd_pcm_lib_free_pages(substream); |
| } |
| |
| static void skl_set_pcm_constrains(struct hdac_ext_bus *ebus, |
| struct snd_pcm_runtime *runtime) |
| { |
| snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); |
| |
| /* avoid wrap-around with wall-clock */ |
| snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_BUFFER_TIME, |
| 20, 178000000); |
| } |
| |
| static enum hdac_ext_stream_type skl_get_host_stream_type(struct hdac_ext_bus *ebus) |
| { |
| if (ebus->ppcap) |
| return HDAC_EXT_STREAM_TYPE_HOST; |
| else |
| return HDAC_EXT_STREAM_TYPE_COUPLED; |
| } |
| |
| static int skl_pcm_open(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct hdac_ext_stream *stream; |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| struct skl_dma_params *dma_params; |
| int ret; |
| |
| dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); |
| ret = pm_runtime_get_sync(dai->dev); |
| if (ret) |
| return ret; |
| |
| stream = snd_hdac_ext_stream_assign(ebus, substream, |
| skl_get_host_stream_type(ebus)); |
| if (stream == NULL) |
| return -EBUSY; |
| |
| skl_set_pcm_constrains(ebus, runtime); |
| |
| /* |
| * disable WALLCLOCK timestamps for capture streams |
| * until we figure out how to handle digital inputs |
| */ |
| if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) { |
| runtime->hw.info &= ~SNDRV_PCM_INFO_HAS_WALL_CLOCK; /* legacy */ |
| runtime->hw.info &= ~SNDRV_PCM_INFO_HAS_LINK_ATIME; |
| } |
| |
| runtime->private_data = stream; |
| |
| dma_params = kzalloc(sizeof(*dma_params), GFP_KERNEL); |
| if (!dma_params) |
| return -ENOMEM; |
| |
| dma_params->stream_tag = hdac_stream(stream)->stream_tag; |
| snd_soc_dai_set_dma_data(dai, substream, dma_params); |
| |
| dev_dbg(dai->dev, "stream tag set in dma params=%d\n", |
| dma_params->stream_tag); |
| snd_pcm_set_sync(substream); |
| |
| return 0; |
| } |
| |
| static int skl_get_format(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); |
| struct skl_dma_params *dma_params; |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| int format_val = 0; |
| |
| if (ebus->ppcap) { |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| |
| format_val = snd_hdac_calc_stream_format(runtime->rate, |
| runtime->channels, |
| runtime->format, |
| 32, 0); |
| } else { |
| struct snd_soc_dai *codec_dai = rtd->codec_dai; |
| |
| dma_params = snd_soc_dai_get_dma_data(codec_dai, substream); |
| if (dma_params) |
| format_val = dma_params->format; |
| } |
| |
| return format_val; |
| } |
| |
| static int skl_pcm_prepare(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_stream *stream = get_hdac_ext_stream(substream); |
| unsigned int format_val; |
| int err; |
| |
| dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); |
| if (hdac_stream(stream)->prepared) { |
| dev_dbg(dai->dev, "already stream is prepared - returning\n"); |
| return 0; |
| } |
| |
| format_val = skl_get_format(substream, dai); |
| dev_dbg(dai->dev, "stream_tag=%d formatvalue=%d\n", |
| hdac_stream(stream)->stream_tag, format_val); |
| snd_hdac_stream_reset(hdac_stream(stream)); |
| |
| err = snd_hdac_stream_set_params(hdac_stream(stream), format_val); |
| if (err < 0) |
| return err; |
| |
| err = snd_hdac_stream_setup(hdac_stream(stream)); |
| if (err < 0) |
| return err; |
| |
| hdac_stream(stream)->prepared = 1; |
| |
| return err; |
| } |
| |
| static int skl_pcm_hw_params(struct snd_pcm_substream *substream, |
| struct snd_pcm_hw_params *params, |
| struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct hdac_ext_stream *stream = get_hdac_ext_stream(substream); |
| struct snd_pcm_runtime *runtime = substream->runtime; |
| int ret, dma_id; |
| |
| dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); |
| ret = skl_substream_alloc_pages(ebus, substream, |
| params_buffer_bytes(params)); |
| if (ret < 0) |
| return ret; |
| |
| dev_dbg(dai->dev, "format_val, rate=%d, ch=%d, format=%d\n", |
| runtime->rate, runtime->channels, runtime->format); |
| |
| dma_id = hdac_stream(stream)->stream_tag - 1; |
| dev_dbg(dai->dev, "dma_id=%d\n", dma_id); |
| |
| return 0; |
| } |
| |
| static void skl_pcm_close(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_stream *stream = get_hdac_ext_stream(substream); |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct skl_dma_params *dma_params = NULL; |
| |
| dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); |
| |
| snd_hdac_ext_stream_release(stream, skl_get_host_stream_type(ebus)); |
| |
| dma_params = snd_soc_dai_get_dma_data(dai, substream); |
| /* |
| * now we should set this to NULL as we are freeing by the |
| * dma_params |
| */ |
| snd_soc_dai_set_dma_data(dai, substream, NULL); |
| |
| pm_runtime_mark_last_busy(dai->dev); |
| pm_runtime_put_autosuspend(dai->dev); |
| kfree(dma_params); |
| } |
| |
| static int skl_pcm_hw_free(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct hdac_ext_stream *stream = get_hdac_ext_stream(substream); |
| |
| dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); |
| |
| snd_hdac_stream_cleanup(hdac_stream(stream)); |
| hdac_stream(stream)->prepared = 0; |
| |
| return skl_substream_free_pages(ebus_to_hbus(ebus), substream); |
| } |
| |
| static int skl_link_hw_params(struct snd_pcm_substream *substream, |
| struct snd_pcm_hw_params *params, |
| struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct hdac_ext_stream *link_dev; |
| struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); |
| struct skl_dma_params *dma_params; |
| struct snd_soc_dai *codec_dai = rtd->codec_dai; |
| int dma_id; |
| |
| pr_debug("%s\n", __func__); |
| link_dev = snd_hdac_ext_stream_assign(ebus, substream, |
| HDAC_EXT_STREAM_TYPE_LINK); |
| if (!link_dev) |
| return -EBUSY; |
| |
| snd_soc_dai_set_dma_data(dai, substream, (void *)link_dev); |
| |
| /* set the stream tag in the codec dai dma params */ |
| dma_params = (struct skl_dma_params *) |
| snd_soc_dai_get_dma_data(codec_dai, substream); |
| if (dma_params) |
| dma_params->stream_tag = hdac_stream(link_dev)->stream_tag; |
| snd_soc_dai_set_dma_data(codec_dai, substream, (void *)dma_params); |
| dma_id = hdac_stream(link_dev)->stream_tag - 1; |
| |
| return 0; |
| } |
| |
| static int skl_link_pcm_prepare(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct hdac_ext_stream *link_dev = |
| snd_soc_dai_get_dma_data(dai, substream); |
| unsigned int format_val = 0; |
| struct skl_dma_params *dma_params; |
| struct snd_soc_dai *codec_dai = rtd->codec_dai; |
| struct snd_pcm_hw_params *params; |
| struct snd_interval *channels, *rate; |
| struct hdac_ext_link *link; |
| |
| dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); |
| if (link_dev->link_prepared) { |
| dev_dbg(dai->dev, "already stream is prepared - returning\n"); |
| return 0; |
| } |
| params = devm_kzalloc(dai->dev, sizeof(*params), GFP_KERNEL); |
| if (params == NULL) |
| return -ENOMEM; |
| |
| channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); |
| channels->min = channels->max = substream->runtime->channels; |
| rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); |
| rate->min = rate->max = substream->runtime->rate; |
| snd_mask_set(¶ms->masks[SNDRV_PCM_HW_PARAM_FORMAT - |
| SNDRV_PCM_HW_PARAM_FIRST_MASK], |
| substream->runtime->format); |
| |
| |
| dma_params = (struct skl_dma_params *) |
| snd_soc_dai_get_dma_data(codec_dai, substream); |
| if (dma_params) |
| format_val = dma_params->format; |
| dev_dbg(dai->dev, "stream_tag=%d formatvalue=%d codec_dai_name=%s\n", |
| hdac_stream(link_dev)->stream_tag, format_val, codec_dai->name); |
| |
| snd_hdac_ext_link_stream_reset(link_dev); |
| |
| snd_hdac_ext_link_stream_setup(link_dev, format_val); |
| |
| link = snd_hdac_ext_bus_get_link(ebus, rtd->codec->component.name); |
| if (!link) |
| return -EINVAL; |
| |
| snd_hdac_ext_link_set_stream_id(link, hdac_stream(link_dev)->stream_tag); |
| link_dev->link_prepared = 1; |
| |
| return 0; |
| } |
| |
| static int skl_link_pcm_trigger(struct snd_pcm_substream *substream, |
| int cmd, struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_stream *link_dev = |
| snd_soc_dai_get_dma_data(dai, substream); |
| |
| dev_dbg(dai->dev, "In %s cmd=%d\n", __func__, cmd); |
| switch (cmd) { |
| case SNDRV_PCM_TRIGGER_START: |
| case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: |
| case SNDRV_PCM_TRIGGER_RESUME: |
| snd_hdac_ext_link_stream_start(link_dev); |
| break; |
| |
| case SNDRV_PCM_TRIGGER_PAUSE_PUSH: |
| case SNDRV_PCM_TRIGGER_SUSPEND: |
| case SNDRV_PCM_TRIGGER_STOP: |
| snd_hdac_ext_link_stream_clear(link_dev); |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| return 0; |
| } |
| |
| static int skl_link_hw_free(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); |
| struct hdac_ext_stream *link_dev = |
| snd_soc_dai_get_dma_data(dai, substream); |
| struct hdac_ext_link *link; |
| |
| dev_dbg(dai->dev, "%s: %s\n", __func__, dai->name); |
| |
| link_dev->link_prepared = 0; |
| |
| link = snd_hdac_ext_bus_get_link(ebus, rtd->codec->component.name); |
| if (!link) |
| return -EINVAL; |
| |
| snd_hdac_ext_link_clear_stream_id(link, hdac_stream(link_dev)->stream_tag); |
| snd_hdac_ext_stream_release(link_dev, HDAC_EXT_STREAM_TYPE_LINK); |
| return 0; |
| } |
| |
| static int skl_hda_be_startup(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| return pm_runtime_get_sync(dai->dev); |
| } |
| |
| static void skl_hda_be_shutdown(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| pm_runtime_mark_last_busy(dai->dev); |
| pm_runtime_put_autosuspend(dai->dev); |
| } |
| |
| static struct snd_soc_dai_ops skl_pcm_dai_ops = { |
| .startup = skl_pcm_open, |
| .shutdown = skl_pcm_close, |
| .prepare = skl_pcm_prepare, |
| .hw_params = skl_pcm_hw_params, |
| .hw_free = skl_pcm_hw_free, |
| }; |
| |
| static struct snd_soc_dai_ops skl_dmic_dai_ops = { |
| .startup = skl_hda_be_startup, |
| .shutdown = skl_hda_be_shutdown, |
| }; |
| |
| static struct snd_soc_dai_ops skl_link_dai_ops = { |
| .startup = skl_hda_be_startup, |
| .prepare = skl_link_pcm_prepare, |
| .hw_params = skl_link_hw_params, |
| .hw_free = skl_link_hw_free, |
| .trigger = skl_link_pcm_trigger, |
| .shutdown = skl_hda_be_shutdown, |
| }; |
| |
| static struct snd_soc_dai_driver skl_platform_dai[] = { |
| { |
| .name = "System Pin", |
| .ops = &skl_pcm_dai_ops, |
| .playback = { |
| .stream_name = "System Playback", |
| .channels_min = HDA_MONO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_8000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, |
| }, |
| .capture = { |
| .stream_name = "System Capture", |
| .channels_min = HDA_MONO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, |
| }, |
| }, |
| { |
| .name = "Reference Pin", |
| .ops = &skl_pcm_dai_ops, |
| .capture = { |
| .stream_name = "Reference Capture", |
| .channels_min = HDA_MONO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, |
| }, |
| }, |
| { |
| .name = "Deepbuffer Pin", |
| .ops = &skl_pcm_dai_ops, |
| .playback = { |
| .stream_name = "Deepbuffer Playback", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, |
| }, |
| }, |
| { |
| .name = "LowLatency Pin", |
| .ops = &skl_pcm_dai_ops, |
| .playback = { |
| .stream_name = "Low Latency Playback", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, |
| }, |
| }, |
| /* BE CPU Dais */ |
| { |
| .name = "iDisp Pin", |
| .ops = &skl_link_dai_ops, |
| .playback = { |
| .stream_name = "iDisp Tx", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_8000|SNDRV_PCM_RATE_16000|SNDRV_PCM_RATE_48000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE, |
| }, |
| }, |
| { |
| .name = "DMIC01 Pin", |
| .ops = &skl_dmic_dai_ops, |
| .capture = { |
| .stream_name = "DMIC01 Rx", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, |
| }, |
| }, |
| { |
| .name = "DMIC23 Pin", |
| .ops = &skl_dmic_dai_ops, |
| .capture = { |
| .stream_name = "DMIC23 Rx", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_16000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE, |
| }, |
| }, |
| { |
| .name = "HD-Codec Pin", |
| .ops = &skl_link_dai_ops, |
| .playback = { |
| .stream_name = "HD-Codec Tx", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE, |
| }, |
| .capture = { |
| .stream_name = "HD-Codec Rx", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE, |
| }, |
| }, |
| { |
| .name = "HD-Codec-SPK Pin", |
| .ops = &skl_link_dai_ops, |
| .playback = { |
| .stream_name = "HD-Codec-SPK Tx", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE, |
| }, |
| }, |
| { |
| .name = "HD-Codec-AMIC Pin", |
| .ops = &skl_link_dai_ops, |
| .capture = { |
| .stream_name = "HD-Codec-AMIC Rx", |
| .channels_min = HDA_STEREO, |
| .channels_max = HDA_STEREO, |
| .rates = SNDRV_PCM_RATE_48000, |
| .formats = SNDRV_PCM_FMTBIT_S16_LE, |
| }, |
| }, |
| }; |
| |
| static int skl_platform_open(struct snd_pcm_substream *substream) |
| { |
| struct snd_pcm_runtime *runtime; |
| struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| struct snd_soc_dai_link *dai_link = rtd->dai_link; |
| |
| dev_dbg(rtd->cpu_dai->dev, "In %s:%s\n", __func__, |
| dai_link->cpu_dai_name); |
| |
| runtime = substream->runtime; |
| snd_soc_set_runtime_hwparams(substream, &azx_pcm_hw); |
| |
| return 0; |
| } |
| |
| static int skl_pcm_trigger(struct snd_pcm_substream *substream, |
| int cmd) |
| { |
| struct hdac_ext_bus *ebus = get_bus_ctx(substream); |
| struct hdac_bus *bus = ebus_to_hbus(ebus); |
| struct hdac_ext_stream *stream; |
| struct snd_pcm_substream *s; |
| bool start; |
| int sbits = 0; |
| unsigned long cookie; |
| struct hdac_stream *hstr; |
| |
| stream = get_hdac_ext_stream(substream); |
| hstr = hdac_stream(stream); |
| |
| dev_dbg(bus->dev, "In %s cmd=%d\n", __func__, cmd); |
| |
| if (!hstr->prepared) |
| return -EPIPE; |
| |
| switch (cmd) { |
| case SNDRV_PCM_TRIGGER_START: |
| case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: |
| case SNDRV_PCM_TRIGGER_RESUME: |
| start = true; |
| break; |
| |
| case SNDRV_PCM_TRIGGER_PAUSE_PUSH: |
| case SNDRV_PCM_TRIGGER_SUSPEND: |
| case SNDRV_PCM_TRIGGER_STOP: |
| start = false; |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| |
| snd_pcm_group_for_each_entry(s, substream) { |
| if (s->pcm->card != substream->pcm->card) |
| continue; |
| stream = get_hdac_ext_stream(s); |
| sbits |= 1 << hdac_stream(stream)->index; |
| snd_pcm_trigger_done(s, substream); |
| } |
| |
| spin_lock_irqsave(&bus->reg_lock, cookie); |
| |
| /* first, set SYNC bits of corresponding streams */ |
| snd_hdac_stream_sync_trigger(hstr, true, sbits, AZX_REG_SSYNC); |
| |
| snd_pcm_group_for_each_entry(s, substream) { |
| if (s->pcm->card != substream->pcm->card) |
| continue; |
| stream = get_hdac_ext_stream(s); |
| if (start) |
| snd_hdac_stream_start(hdac_stream(stream), true); |
| else |
| snd_hdac_stream_stop(hdac_stream(stream)); |
| } |
| spin_unlock_irqrestore(&bus->reg_lock, cookie); |
| |
| snd_hdac_stream_sync(hstr, start, sbits); |
| |
| spin_lock_irqsave(&bus->reg_lock, cookie); |
| |
| /* reset SYNC bits */ |
| snd_hdac_stream_sync_trigger(hstr, false, sbits, AZX_REG_SSYNC); |
| if (start) |
| snd_hdac_stream_timecounter_init(hstr, sbits); |
| spin_unlock_irqrestore(&bus->reg_lock, cookie); |
| |
| return 0; |
| } |
| |
| static int skl_dsp_trigger(struct snd_pcm_substream *substream, |
| int cmd) |
| { |
| struct hdac_ext_bus *ebus = get_bus_ctx(substream); |
| struct hdac_bus *bus = ebus_to_hbus(ebus); |
| struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| struct hdac_ext_stream *stream; |
| int start; |
| unsigned long cookie; |
| struct hdac_stream *hstr; |
| |
| dev_dbg(bus->dev, "In %s cmd=%d streamname=%s\n", __func__, cmd, cpu_dai->name); |
| |
| stream = get_hdac_ext_stream(substream); |
| hstr = hdac_stream(stream); |
| |
| if (!hstr->prepared) |
| return -EPIPE; |
| |
| switch (cmd) { |
| case SNDRV_PCM_TRIGGER_START: |
| case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: |
| case SNDRV_PCM_TRIGGER_RESUME: |
| start = 1; |
| break; |
| |
| case SNDRV_PCM_TRIGGER_PAUSE_PUSH: |
| case SNDRV_PCM_TRIGGER_SUSPEND: |
| case SNDRV_PCM_TRIGGER_STOP: |
| start = 0; |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| |
| spin_lock_irqsave(&bus->reg_lock, cookie); |
| |
| if (start) |
| snd_hdac_stream_start(hdac_stream(stream), true); |
| else |
| snd_hdac_stream_stop(hdac_stream(stream)); |
| |
| if (start) |
| snd_hdac_stream_timecounter_init(hstr, 0); |
| |
| spin_unlock_irqrestore(&bus->reg_lock, cookie); |
| |
| return 0; |
| } |
| static int skl_platform_pcm_trigger(struct snd_pcm_substream *substream, |
| int cmd) |
| { |
| struct hdac_ext_bus *ebus = get_bus_ctx(substream); |
| |
| if (ebus->ppcap) |
| return skl_dsp_trigger(substream, cmd); |
| else |
| return skl_pcm_trigger(substream, cmd); |
| } |
| |
| /* calculate runtime delay from LPIB */ |
| static int skl_get_delay_from_lpib(struct hdac_ext_bus *ebus, |
| struct hdac_ext_stream *sstream, |
| unsigned int pos) |
| { |
| struct hdac_bus *bus = ebus_to_hbus(ebus); |
| struct hdac_stream *hstream = hdac_stream(sstream); |
| struct snd_pcm_substream *substream = hstream->substream; |
| int stream = substream->stream; |
| unsigned int lpib_pos = snd_hdac_stream_get_pos_lpib(hstream); |
| int delay; |
| |
| if (stream == SNDRV_PCM_STREAM_PLAYBACK) |
| delay = pos - lpib_pos; |
| else |
| delay = lpib_pos - pos; |
| |
| if (delay < 0) { |
| if (delay >= hstream->delay_negative_threshold) |
| delay = 0; |
| else |
| delay += hstream->bufsize; |
| } |
| |
| if (delay >= hstream->period_bytes) { |
| dev_info(bus->dev, |
| "Unstable LPIB (%d >= %d); disabling LPIB delay counting\n", |
| delay, hstream->period_bytes); |
| delay = 0; |
| } |
| |
| return bytes_to_frames(substream->runtime, delay); |
| } |
| |
| static unsigned int skl_get_position(struct hdac_ext_stream *hstream, |
| int codec_delay) |
| { |
| struct hdac_stream *hstr = hdac_stream(hstream); |
| struct snd_pcm_substream *substream = hstr->substream; |
| struct hdac_ext_bus *ebus = get_bus_ctx(substream); |
| unsigned int pos; |
| int delay; |
| |
| /* use the position buffer as default */ |
| pos = snd_hdac_stream_get_pos_posbuf(hdac_stream(hstream)); |
| |
| if (pos >= hdac_stream(hstream)->bufsize) |
| pos = 0; |
| |
| if (substream->runtime) { |
| delay = skl_get_delay_from_lpib(ebus, hstream, pos) |
| + codec_delay; |
| substream->runtime->delay += delay; |
| } |
| |
| return pos; |
| } |
| |
| static snd_pcm_uframes_t skl_platform_pcm_pointer |
| (struct snd_pcm_substream *substream) |
| { |
| struct hdac_ext_stream *hstream = get_hdac_ext_stream(substream); |
| |
| return bytes_to_frames(substream->runtime, |
| skl_get_position(hstream, 0)); |
| } |
| |
| static u64 skl_adjust_codec_delay(struct snd_pcm_substream *substream, |
| u64 nsec) |
| { |
| struct snd_soc_pcm_runtime *rtd = snd_pcm_substream_chip(substream); |
| struct snd_soc_dai *codec_dai = rtd->codec_dai; |
| u64 codec_frames, codec_nsecs; |
| |
| if (!codec_dai->driver->ops->delay) |
| return nsec; |
| |
| codec_frames = codec_dai->driver->ops->delay(substream, codec_dai); |
| codec_nsecs = div_u64(codec_frames * 1000000000LL, |
| substream->runtime->rate); |
| |
| if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) |
| return nsec + codec_nsecs; |
| |
| return (nsec > codec_nsecs) ? nsec - codec_nsecs : 0; |
| } |
| |
| static int skl_get_time_info(struct snd_pcm_substream *substream, |
| struct timespec *system_ts, struct timespec *audio_ts, |
| struct snd_pcm_audio_tstamp_config *audio_tstamp_config, |
| struct snd_pcm_audio_tstamp_report *audio_tstamp_report) |
| { |
| struct hdac_ext_stream *sstream = get_hdac_ext_stream(substream); |
| struct hdac_stream *hstr = hdac_stream(sstream); |
| u64 nsec; |
| |
| if ((substream->runtime->hw.info & SNDRV_PCM_INFO_HAS_LINK_ATIME) && |
| (audio_tstamp_config->type_requested == SNDRV_PCM_AUDIO_TSTAMP_TYPE_LINK)) { |
| |
| snd_pcm_gettime(substream->runtime, system_ts); |
| |
| nsec = timecounter_read(&hstr->tc); |
| nsec = div_u64(nsec, 3); /* can be optimized */ |
| if (audio_tstamp_config->report_delay) |
| nsec = skl_adjust_codec_delay(substream, nsec); |
| |
| *audio_ts = ns_to_timespec(nsec); |
| |
| audio_tstamp_report->actual_type = SNDRV_PCM_AUDIO_TSTAMP_TYPE_LINK; |
| audio_tstamp_report->accuracy_report = 1; /* rest of struct is valid */ |
| audio_tstamp_report->accuracy = 42; /* 24MHzWallClk == 42ns resolution */ |
| |
| } else { |
| audio_tstamp_report->actual_type = SNDRV_PCM_AUDIO_TSTAMP_TYPE_DEFAULT; |
| } |
| |
| return 0; |
| } |
| |
| static struct snd_pcm_ops skl_platform_ops = { |
| .open = skl_platform_open, |
| .ioctl = snd_pcm_lib_ioctl, |
| .trigger = skl_platform_pcm_trigger, |
| .pointer = skl_platform_pcm_pointer, |
| .get_time_info = skl_get_time_info, |
| .mmap = snd_pcm_lib_default_mmap, |
| .page = snd_pcm_sgbuf_ops_page, |
| }; |
| |
| static void skl_pcm_free(struct snd_pcm *pcm) |
| { |
| snd_pcm_lib_preallocate_free_for_all(pcm); |
| } |
| |
| #define MAX_PREALLOC_SIZE (32 * 1024 * 1024) |
| |
| static int skl_pcm_new(struct snd_soc_pcm_runtime *rtd) |
| { |
| struct snd_soc_dai *dai = rtd->cpu_dai; |
| struct hdac_ext_bus *ebus = dev_get_drvdata(dai->dev); |
| struct snd_pcm *pcm = rtd->pcm; |
| unsigned int size; |
| int retval = 0; |
| struct skl *skl = ebus_to_skl(ebus); |
| |
| if (dai->driver->playback.channels_min || |
| dai->driver->capture.channels_min) { |
| /* buffer pre-allocation */ |
| size = CONFIG_SND_HDA_PREALLOC_SIZE * 1024; |
| if (size > MAX_PREALLOC_SIZE) |
| size = MAX_PREALLOC_SIZE; |
| retval = snd_pcm_lib_preallocate_pages_for_all(pcm, |
| SNDRV_DMA_TYPE_DEV_SG, |
| snd_dma_pci_data(skl->pci), |
| size, MAX_PREALLOC_SIZE); |
| if (retval) { |
| dev_err(dai->dev, "dma buffer allocationf fail\n"); |
| return retval; |
| } |
| } |
| |
| return retval; |
| } |
| |
| static struct snd_soc_platform_driver skl_platform_drv = { |
| .ops = &skl_platform_ops, |
| .pcm_new = skl_pcm_new, |
| .pcm_free = skl_pcm_free, |
| }; |
| |
| static const struct snd_soc_component_driver skl_component = { |
| .name = "pcm", |
| }; |
| |
| int skl_platform_register(struct device *dev) |
| { |
| int ret; |
| |
| ret = snd_soc_register_platform(dev, &skl_platform_drv); |
| if (ret) { |
| dev_err(dev, "soc platform registration failed %d\n", ret); |
| return ret; |
| } |
| ret = snd_soc_register_component(dev, &skl_component, |
| skl_platform_dai, |
| ARRAY_SIZE(skl_platform_dai)); |
| if (ret) { |
| dev_err(dev, "soc component registration failed %d\n", ret); |
| snd_soc_unregister_platform(dev); |
| } |
| |
| return ret; |
| |
| } |
| |
| int skl_platform_unregister(struct device *dev) |
| { |
| snd_soc_unregister_component(dev); |
| snd_soc_unregister_platform(dev); |
| return 0; |
| } |