[RFC PATCH 10/11] soundwire: intel: do sdw stream setup in setup function

[Pierre-Louis Bossart]

From: Rander Wang <rander.w...@linux.intel.com>

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

Signed-off-by: Rander Wang <rander.w...@linux.intel.com>
Signed-off-by: Pierre-Louis Bossart <pierre-louis.boss...@linux.intel.com>
---
 drivers/soundwire/intel.c | 57 ++++++++++++++++++++++++++++++++++++++-
 1 file changed, 56 insertions(+), 1 deletion(-)

diff --git a/drivers/soundwire/intel.c b/drivers/soundwire/intel.c
index f3764f67919e..336203303480 100644
--- a/drivers/soundwire/intel.c
+++ b/drivers/soundwire/intel.c
@@ -670,6 +670,58 @@ 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;
+
+       name = kzalloc(32, GFP_KERNEL);
+       if (!name)
+               return -ENOMEM;
+
+       if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
+               snprintf(name, 32, "%s-Playback", dai->name);
+       else
+               snprintf(name, 32, "%s-Capture", dai->name);
+
+       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)
 {
@@ -682,9 +734,11 @@ static int intel_startup(struct snd_pcm_substream 
*substream,
                                    "pm_runtime_get_sync failed in %s, ret 
%d\n",
                                    __func__, ret);
                pm_runtime_put_noidle(cdns->dev);
+
+               return ret;
        }
 
-       return ret;
+       return sdw_stream_setup(substream, dai);
 }
 
 static int intel_hw_params(struct snd_pcm_substream *substream,
@@ -885,6 +939,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,
-- 
2.20.1