soundwire: intel: add sdw_stream_setup helper for .startup callback

The sdw stream is allocated and stored in dai to share the sdw runtime
information.

Signed-off-by: Pierre-Louis Bossart <pierre-louis.bossart@linux.intel.com>
Signed-off-by: Rander Wang <rander.wang@linux.intel.com>
Acked-by: Sanyog Kale <sanyog.r.kale@intel.com>
Link: https://lore.kernel.org/r/20200215014740.27580-5-pierre-louis.bossart@linux.intel.com
Signed-off-by: Vinod Koul <vkoul@kernel.org>

diff --git a/drivers/soundwire/intel.c b/drivers/soundwire/intel.c
index 999aa2c..c498812 100644 (file)
--- a/drivers/soundwire/intel.c
+++ b/drivers/soundwire/intel.c
@@ -617,6 +617,68 @@ static int intel_post_bank_switch(struct sdw_bus *bus)
  * DAI routines
  */
 
+static int sdw_stream_setup(struct snd_pcm_substream *substream,
+                           struct snd_soc_dai *dai)
+{
+       struct snd_soc_pcm_runtime *rtd = substream->private_data;
+       struct sdw_stream_runtime *sdw_stream = NULL;
+       char *name;
+       int i, ret;
+
+       if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
+               name = kasprintf(GFP_KERNEL, "%s-Playback", dai->name);
+       else
+               name = kasprintf(GFP_KERNEL, "%s-Capture", dai->name);
+
+       if (!name)
+               return -ENOMEM;
+
+       sdw_stream = sdw_alloc_stream(name);
+       if (!sdw_stream) {
+               dev_err(dai->dev, "alloc stream failed for DAI %s", dai->name);
+               ret = -ENOMEM;
+               goto error;
+       }
+
+       /* Set stream pointer on CPU DAI */
+       ret = snd_soc_dai_set_sdw_stream(dai, sdw_stream, substream->stream);
+       if (ret < 0) {
+               dev_err(dai->dev, "failed to set stream pointer on cpu dai %s",
+                       dai->name);
+               goto release_stream;
+       }
+
+       /* Set stream pointer on all CODEC DAIs */
+       for (i = 0; i < rtd->num_codecs; i++) {
+               ret = snd_soc_dai_set_sdw_stream(rtd->codec_dais[i], sdw_stream,
+                                                substream->stream);
+               if (ret < 0) {
+                       dev_err(dai->dev, "failed to set stream pointer on codec dai %s",
+                               rtd->codec_dais[i]->name);
+                       goto release_stream;
+               }
+       }
+
+       return 0;
+
+release_stream:
+       sdw_release_stream(sdw_stream);
+error:
+       kfree(name);
+       return ret;
+}
+
+static int intel_startup(struct snd_pcm_substream *substream,
+                        struct snd_soc_dai *dai)
+{
+       /*
+        * TODO: add pm_runtime support here, the startup callback
+        * will make sure the IP is 'active'
+        */
+
+       return sdw_stream_setup(substream, dai);
+}
+
 static int intel_hw_params(struct snd_pcm_substream *substream,
                           struct snd_pcm_hw_params *params,
                           struct snd_soc_dai *dai)
@@ -796,6 +858,7 @@ static int intel_pdm_set_sdw_stream(struct snd_soc_dai *dai,
 }
 
 static const struct snd_soc_dai_ops intel_pcm_dai_ops = {
+       .startup = intel_startup,
        .hw_params = intel_hw_params,
        .prepare = intel_prepare,
        .trigger = intel_trigger,
@@ -805,6 +868,7 @@ static const struct snd_soc_dai_ops intel_pcm_dai_ops = {
 };
 
 static const struct snd_soc_dai_ops intel_pdm_dai_ops = {
+       .startup = intel_startup,
        .hw_params = intel_hw_params,
        .prepare = intel_prepare,
        .trigger = intel_trigger,